Research on Relative Navigation Method Based on INS/Vision Using Sigma-Point Kalman Filter

Nai-gang CUI,Xiao-gang WANG,Ji-feng GUO
DOI: https://doi.org/10.3873/j.issn.1000-1328.2009.06.028
2009-01-01
Abstract:According to the leader-follower flight mode of unmanned aerial vehicle, the relative navigation method based on INS/Vision is presented considering the measurement of vision navigation equipment with time delay. The relative inertial equation and line of sight between leader and follower is derived. Because of the strong nonlinearity of INS/Vision relative navigation sys-tem, the unscented kalman fiher is used to estimate the relative position, relative velocity and relative attitude by fusing the relative inertial information and line of sight. For the quatemion normalization, an unconstrained three-component vector is used to pre-sented an attitude error quaternion. For the time delay problem of vision navigation equipment, the method of fusing the inertial navigation information and the measurement with time delay is provided.
What problem does this paper attempt to address?