基于李群的视觉/惯性自适应组合导航算法

An Adaptive Visual/Inertial Integrated Navigation Algorithm Based on Lie Groups

  • 摘要: 为了改善数据突变情况下视觉/惯性组合导航中系统的估计精度及稳定性,本文提出了一种基于李群的自适应无迹卡尔曼滤波组合导航算法:基于李群/李代数对位姿和运动状态进行建模,并采用无迹卡尔曼滤波对位姿状态进行估计;在滤波过程中,引入了渐消因子,自适应地修正位姿和状态估计的协方差,提高了数据突变条件下组合导航算法的鲁棒性.同时为了保证滤波过程中的数值稳定性,本文给出了所提出算法基于平方根无迹卡尔曼滤波的实现方式.对比仿真结果证明了本文所提出算法的有效性和优越性.

     

    Abstract: To improve the accuracy and stability of the visual/inertial integrated navigation system under the condition of data's abrupt change, we propose an adaptive integrated navigation algorithm based on Lie group and unscented Kalman filter. The pose and motion state were modeled based on Lie group/Lie algebra, and then the position and state are estimated using unscented Kalman filter. In the filtering process, the fading factor is introduced to adaptively correct the state estimation covariance, thereby improving the robustness of the integrated navigation algorithm under data jumping. Moreover, to ensure numerical stability in the process of filtering, the square root-based implementation of the proposed algorithm is given. Experimental results demonstrate the effectiveness and superiority of the proposed algorithm.

     

/

返回文章
返回