一种面向轮足机器人多模式运动的状态估计方法

    公开(公告)号:CN119310997A

    公开(公告)日:2025-01-14

    申请号:CN202411415373.5

    申请日:2024-10-10

    Abstract: 本发明公开了一种面向轮足机器人多模式运动的状态估计方法。所述方法包括:基于卡尔曼滤波器融合关节电机数据、轮式电机数据、IMU数据构建状态方程与观测方程;其中观测方程通过引入偏置/非偏置轮足机器人完整运动学模型与一阶微分运动学模型,计算轮地接触点准确位置及速度,并通过构建非对称轮式滑移运动模型,计算轮式附加自由度带来的滑动位移,从而同时考虑到轮式结构与轮式附加自由度对里程计更新的影响;通过在观测方程中引入支撑相轮地可靠接触假设,防止机身高度估计漂移。本发明能够在轮式、足式、轮足混合式多等模式下实现轮足机器人高可靠的状态估计,解决了现有本体状态估计器无法适用于轮足机器人的难题。

Patent Agency Ranking