一种融合语义特征的视觉惯性组合导航方法
摘要:
本发明公开了一种融合语义特征的视觉惯性组合导航方法,采集k时刻RGBD视觉传感器数据S(k)、加速度计数据和陀螺仪数据根据视觉传感器数据S(k)利用视觉里程计解算得到相机当前位姿T(k);利用视觉传感器数据S(k)进行相邻两图像帧之间的语义平面特征提取和匹配;利用惯性传感器数据进行相邻两图像帧之间的预积分;联合语义平面观测残差、视觉里程计相对位姿观测残差和惯性预积分残差优化求解载体导航信息;输出载体导航信息和相机内参。本发明可以有效提高导航系统定位的精确度及鲁棒性。
公开/授权文献
0/0