一种捷联惯性导航系统/视觉里程计组合导航方法

摘要

一种捷联惯性导航系统/视觉里程计组合导航方法，包括以下步骤：在运载体上安装双目视觉里程计、光纤陀螺惯性导航系统，并采集各个传感器的数据；利用FAST方法对图像序列中的特征进行提取，并利用基于随机抽样一致的特征匹配方法完成特征匹配，计算出运载体的运动信息；建立捷联惯性导航系统/视觉里程计组合导航系统的非线性状态方程和量测方程；利用非线性滤波器容积卡尔曼滤波完成捷联惯性导航系统/视觉里程计组合导航系统的时间更新和量测更新，对系统状态进行估计，实现捷联惯性导航系统/视觉里程计组合导航系统的导航定位。本发明方法优化了特征匹配算法，并利用非线性容积卡尔曼滤波算法，提高了组合导航系统的定位精度和鲁棒性。