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

    公开(公告)号:CN107796391A

    公开(公告)日:2018-03-13

    申请号:CN201711026822.7

    申请日:2017-10-27

    CPC classification number: G01C21/165

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

Patent Agency Ranking