科研之友
微信
新浪微博
Facebook
分享链接
摘要
提出了一种改进的多状态约束卡尔曼滤波器(IMSCKF)双目视觉惯性导航算法。该算法在初始阶段采用Sigma滤波器和三焦点张量约束快速完成初始化,产生的状态向量与MSCKF一致,可以实现初始化和后续导航之间的无缝过渡,提高了系统状态估计的精度和鲁棒性。实验结果表明,本文提出的IMSCKF方法位置跟踪误差维持在±1 mm,角度误差维持在±1°,可以提高双目视觉惯性导航的鲁棒性和精度。
- 单位
提出了一种改进的多状态约束卡尔曼滤波器(IMSCKF)双目视觉惯性导航算法。该算法在初始阶段采用Sigma滤波器和三焦点张量约束快速完成初始化,产生的状态向量与MSCKF一致,可以实现初始化和后续导航之间的无缝过渡,提高了系统状态估计的精度和鲁棒性。实验结果表明,本文提出的IMSCKF方法位置跟踪误差维持在±1 mm,角度误差维持在±1°,可以提高双目视觉惯性导航的鲁棒性和精度。
