Arrangement for and method of two dimensional and three dimensional precision location and orientation determination

Abstract

In one embodiment of the present invention, a method of and apparatus for determining inaccurate GPS samples in a set of GPS samples is disclosed, according to the following actions: a) obtaining GPS samples as taken by a global positioning system on board a vehicle when traveling along a trajectory; b) obtaining a first estimation of the trajectory based on the GPS samples; c) obtaining a second estimation of the trajectory at least based on measurements made by an inertial measurement unit on board vehicle when traveling along the trajectory; d) comparing the first and second estimations; e) establishing locations where the first estimation shows a variation compared with the second estimation above a predetermined threshold; f) if no such locations can be established continue with action j), otherwise continue with action g); g) removing GPS samples associated with the locations of high variation as being inaccurate GPS samples, thus forming a set of remaining GPS samples; h) calculating the first estimation anew of the trajectory based on the remaining GPS samples and calculating the second estimation anew; i) repeating actions d) to h); j) ending the actions.