arXiv:2510.15220cs.RO2025-10被引 6

四足机器人多传感器融合定位,抗干扰更强更稳定。

LVI-Q: Robust LiDAR-Visual-Inertial-Kinematic Odometry for Quadruped Robots Using Tightly-Coupled and Efficient Alternating Optimization

  • 采用紧耦合交替优化,融合视觉、激光、惯性与关节编码器数据。
  • 在公开长时数据集上定位误差低于0.15%,显著降低漂移。
  • 适合复杂动态环境下的四足机器人自主导航,工程落地性强。

在复杂动态环境中,自主导航依赖于鲁棒的同步定位与地图构建(SLAM)系统来准确建图并定位机器人,以确保安全高效运行。尽管已有基于多传感器融合的SLAM方法通过整合多种传感器提升鲁棒性,但在挑战性环境下仍易受不合适的融合策略影响而产生估计漂移。为此,本文提出一种鲁棒的激光-视觉-惯性-运动学里程计系统(LVI-Q),融合相机、激光雷达、惯性测量单元(IMU)及关节编码器信息,用于视觉与激光雷达基里程计估计。系统采用基于可用测量的融合姿态估计策略,运行基于优化的视觉-惯性-运动学里程计(VIKO)和基于滤波的激光-惯性-运动学里程计(LIKO)。在VIKO中,采用足端预积分技术与基于超像素簇的鲁棒激光-视觉深度一致性;在LIKO中,引入足部运动学模型,并在误差状态迭代卡尔曼滤波(ESIKF)中使用点到平面残差。相比其他传感器融合式SLAM算法,本方法在公共及长期数据集上均表现出优异的鲁棒性。

原文摘要 · Abstract (English)

Autonomous navigation for legged robots in complex and dynamic environments relies on robust simultaneous localization and mapping (SLAM) systems to accurately map surroundings and localize the robot, ensuring safe and efficient operation. While prior sensor fusion-based SLAM approaches have integrated various sensor modalities to improve their robustness, these algorithms are still susceptible to estimation drift in challenging environments due to their reliance on unsuitable fusion strategies. Therefore, we propose a robust LiDAR-visual-inertial-kinematic odometry system that integrates information from multiple sensors, such as a camera, LiDAR, inertial measurement unit (IMU), and joint encoders, for visual and LiDAR-based odometry estimation. Our system employs a fusion-based pose estimation approach that runs optimization-based visual-inertial-kinematic odometry (VIKO) and filter-based LiDAR-inertial-kinematic odometry (LIKO) based on measurement availability. In VIKO, we utilize the footpreintegration technique and robust LiDAR-visual depth consistency using superpixel clusters in a sliding window optimization. In LIKO, we incorporate foot kinematics and employ a point-toplane residual in an error-state iterative Kalman filter (ESIKF). Compared with other sensor fusion-based SLAM algorithms, our approach shows robust performance across public and longterm datasets.

四足机器人多传感器融合定位导航里程计

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。