面向移动机器人的多传感器紧耦合导航定位方法

A tightly coupled multi-sensor fusion navigation and localization method for mobile robots

  • 摘要: 移动机器人依赖单一传感器往往难以克服光照变化、外部干扰、反射表面影响以及累积误差等问题,限制了环境感知能力和自身位姿测量精度与可靠性。该文采用了一种非线性优化的方法,实现了(IMU、红外相机、RGB相机、激光雷达)数据层面紧耦合组合定位建图系统IIVL-LM。提出了一种基于RGB图像信息的实时照度值转换模型,系统根据不同照度值通过非线性插值法输入视觉SLAM模型中进行实时建图,然后通过动态加权法对红外相机与RGB相机的关键帧的特征提取融合。在模拟的室内救援场景数据集下,与多种主流融合定位方法相比,IIVL-LM在照度变化的苛刻条件下尤其是在低照度下性能提升明显,平均RMSE ATE提升了23%~39%(0.006~0.013)。IIVL-LM保证了系统始终会在不少于3个传感器有效的状态下进行,在确保精度的同时对未知开放场景有更强的鲁棒性,尤其对于室内救援这种复杂场景的应用具有一定的价值。

     

    Abstract: Mobile robots relying solely on a single sensor often struggle to overcome challenges such as illumination change, external disturbances, effects of reflective surfaces, and cumulative errors, which limit their environmental perception capabilities as well as the accuracy and reliability of pose estimation. This article adopts a nonlinear optimization method to achieve a tightly coupled integrated localization and mapping system IIVL-LM at the data level (IMU, infrared camera, RGB camera, LiDAR). We introduces a real-time luminance conversion model based on RGB image information, whereby the system incorporates varying luminance values into the visual SLAM model through nonlinear interpolation for real-time mapping. Subsequently, it performs a dynamic weighted fusion of feature extraction from key frames of both infrared and RGB cameras. In a simulated indoor rescue scenario dataset, compared to various mainstream fusion positioning methods, the IIVL-LM system exhibits a notable performance improvement under challenging luminance conditions, especially in low-light environments. The average Root Mean Square Error (RMSE) of the Absolute Trajectory Error (ATE) improved by 23% to 39% (0.006 to 0.013). The IIVL-LM system ensures that it operates with at least three active sensors at all times, thereby enhancing its robustness in unknown and open environments while maintaining precision. This capability is particularly valuable for applications in complex settings such as indoor rescue scenarios.

     

/

返回文章
返回