Mitigation of attitude and gyro errors through vision aiding

Accurate positioning of first responders, electronic monitoring, and military personnel is often critical in GNSS denied environments. In such environments, inertial navigation systems (INS) are typically the preferred tool to be used for navigation. However, the gyros suffer from errors including biases, scale factors and g-dependent errors being the most significant ones. In order to sustain an accurate navigation solution for long durations, the gyroscope errors have to be measured and mitigated. Ideally, this calibration is done in situ. The attitude obtained using visual information is independent of the errors affecting the gyroscope. Human-made environments are commonly full of straight and parallel lines found in orthogonal directions. Perspective projection mapping transforms three-dimensional scenes into two-dimensional images. The process maintains the straight lines but modifies their parallelism resulting in an apparent point intersection of the lines. This point is called the vanishing point. Lines in three orthogonal directions constitute three vanishing points. The vanishing point locations are dependent on the camera rotation, but not camera translation. By monitoring the motion of the vanishing point locations in consecutive images, the relative roll, heading and pitch attitudes may be obtained. The absolute attitude, known from some a priori knowledge of the building layout, is then used to update the inertial navigation filter. Over time the visual measurements mitigate the cumulative errors of the gyro bias, scale factor and g-dependent bias. The performance of the vision-aided INS based navigation approach is evaluated herein. A camera is attached to a backpack and foot of a user moving through typical pedestrian based environments. The case of a foot-mounted camera is unique because of the high accelerations experienced during the human gait. The visual-aiding correction is found to significantly improve the attitude accuracy, especially the - eading. Using the body solution, namely the camera and INS attached to a backpack, the vision-aiding yielded a 93 % improvement in the heading error during evaluation tests. With a foot-mounted solution, namely the INS and camera attached to the ankle of the user, the horizontal position error decreased by 34 %.