仅用惯性与电机数据,实现无视觉腿式机器人的精准定位。
Contact-Anchored Proprioceptive Odometry for Legged and Wheel-Legged Robots
- 以可靠接触点为运动锚,结合足端受力与落地记录抑制漂移。
- 通过高度聚类与时间衰减修正,有效控制长时间运行中的垂直漂移。
- 适用于四足与轮腿机器人,适合无摄像头/激光雷达的复杂地形导航。
无摄像头或激光雷达的腿式机器人可靠里程计仍面临挑战,主要源于惯性测量单元(IMU)漂移和关节速度传感噪声。本文提出一种纯本体感知状态估计器,仅依赖IMU与电机数据,即可估计机体位姿与速度,统一适用于四足及轮腿机器人,并可拓展至其他腿式构型。核心思想是将每个可靠接触视为运动学锚点:基于关节扭矩的足端受力估计用于识别支撑接触,对应的足部落地记录提供间歇性的世界坐标约束,从而抑制长期漂移。为防止长时间行进中的高程漂移,引入轻量级高度聚类与时间衰减校正机制,将新记录的足部高度对齐至先前观测的支持平面。对于轮腿平台,进一步通过有效轮滚动位移并结合腿段运动补偿和坡度感知的滚动方向,传播接触信息。为改善编码器量化下的足端速度观测,保留一个逆运动学立方卡尔曼滤波器作为可选的速度增强模块,从关节角度与速度中滤出足端速度。此外,通过多接触几何一致性注入软航向先验,而非硬重置姿态状态,进一步缓解偏航漂移。方法在四台四足机器人平台上进行了评估。
原文摘要 · Abstract (English)
Reliable odometry for legged robots without cameras or LiDAR remains challenging due to IMU drift and noisy joint velocity sensing. This paper presents a purely proprioceptive state estimator that uses only IMU and motor measurements to estimate body pose and velocity, with a unified formulation applicable to quadruped and wheel-legged robots and extensible to other legged morphologies. The key idea is to treat each reliable contact as a kinematic anchor: joint-torque--based foot wrench estimation selects stance contacts, and the corresponding footfall records provide intermittent world-frame constraints that suppress long-term drift. To prevent elevation drift during extended traversal, we introduce a lightweight height clustering and time-decay correction that snaps newly recorded footfall heights to previously observed support planes. For wheel-legged platforms, the recorded contact is further propagated by effective wheel rolling displacement with shank-motion compensation and a slope-aware rolling direction. To improve foot velocity observations under encoder quantization, we retain an inverse-kinematics cubature Kalman filter as an optional velocity-enhancement module that filters foot-end velocities from joint angles and velocities. The implementation further mitigates yaw drift through multi-contact geometric consistency, which is injected as a soft heading prior rather than as a hard reset of the attitude state. The method is evaluated on four quadruped platforms.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。