基于轮式里程计辅助视觉的无人车重定位算法OA
Relocalization algorithm for unmanned vehicles based on wheel odometry assisted vision
针对无人车在视觉退化环境中视觉同步定位与地图构建(simultaneous localization and mapping,SLAM)重定位失效的问题,提出一种轮式里程计(wheel odometry,WO)辅助视觉里程计(visual odometry,VO)的自适应协同重定位算法.该算法构建了基于误差状态卡尔曼滤波(error-state Kalman filter,ES-KF)的WO/VO融合模型,提升无人车路径规划的定位精度.针对无人车运行中存在视觉特征点不足导致的难以重定位的问题,提出了一种WO/VO自适应协同重定位算法,通过设计WO/VO系统与WO的切换机制,提升无人车的定位连续性和路径规划的可靠性.利用搭建的无人车平台,在不同情况下对算法进行实验验证与对比.研究结果表明,基于ES-KF的WO/VO融合方法提升了无人车定位性能,绝对轨迹误差(abso-lute trajectory error,ATE)较单一VO和单一WO分别降低了39.1%和59.2%,路径重合度分别提高了9.2%和11.5%;并在视觉退化场景下实现了WO辅助的自适应协同重定位.ES-KF相较扩展卡尔曼滤波(extended Kalman filter,EKF)与无迹卡尔曼滤波(unscented Kalman fil-ter,UKF)在轨迹精度与位姿估计稳定性方面均表现更优,显著增强了路径融合效果与系统鲁棒性.
To address the issue of SLAM-based visual relocalization failure in unmanned vehicles under visual degradation conditions,an adaptive collaborative relocalization algorithm was proposed,which combined wheel odometry(WO)with visual odometry(VO).This algorithm constructed a WO/VO fusion model based on error-state Kalman filter(ES-KF),enhancing the positioning accuracy of the unmanned vehicle's path planning.To tackle the challenge of insufficient visual feature points that hinder relocalization during unmaned vehicle operation,an adaptive collaborative relocalization algorithm for WO/VO was proposed.The system included a switching mechanism between WO/VO and WO,improving the continuity of the unmanned vehicle's localization and the reliability of path planning.Experiments were conducted and compared on the developed unmanned vehicle platform under various conditions.The results demonstrate that the ES-KF-based WO/VO fusion method significantly improves localization performance.The absolute trajectory error(ATE)is reduced by 39.1%and 59.2%,respectively,compared to VO-only and WO-only methods,and path overlap is increased by 9.2%and 11.5%,respectively.The algorithm also successfully achieves WO-assisted adaptive collaborative relocalization in visual degradation scenarios.Compared to the extended Kalman filter(EKF)and the unscented Kalman filter(UKF),the ES-KF demonstrates superior performance in both trajectory accuracy and pose estimation stability,significantly enhancing path fusion effectiveness and system robustness.
曲萍萍;于浩楠;于腾丽;陈云浩;周忠鸿;霍文强;王尔申
沈阳航空航天大学,电子信息工程学院,沈阳 110136沈阳航空航天大学,电子信息工程学院,沈阳 110136沈阳航空航天大学,航空宇航学院,沈阳 110136云南民族大学 电气信息工程学院,昆明 650500||云南民族大学 云南省无人自主系统重点实验室,昆明 650500沈阳航空航天大学,电子信息工程学院,沈阳 110136沈阳航空航天大学,电子信息工程学院,沈阳 110136沈阳航空航天大学,电子信息工程学院,沈阳 110136||沈阳航空航天大学,民用航空学院,沈阳 110136
信息技术与安全科学
重定位视觉里程计轮式里程计无人车误差状态卡尔曼滤波
relocalizationvisual odometrywheel odometryunmanned vehicleerror-state Kalman filter
《沈阳航空航天大学学报》 2026 (3)
61-68,8
国家自然科学基金(项目编号:62173237)云南省无人自主系统重点实验室开放课题(项目编号:202501ZD02).
评论