摘要:针对四足机器人在卫星信号缺失和环境感知退化时定位精度陡降的问题,提出一种足端惯性信息辅助的四足机器人 惯性导航算法。 首先,基于足端惯性信息和关节编码器数据构建腿部里程计观测模型,以补偿因接触静止假设导致的速度损 失;然后,通过时域卷积网络(TCN)和双向门控循环单元(BiGRU)提取足端惯性信息和关节数据的长短时域特征,实现鲁棒的 平稳区间接触事件估计。 将所提出的里程计观测模型作为不变扩展卡尔曼滤波器( InEKF)的量测信息,在平稳区间内修正惯 性导航误差。 最后,在室外场景进行了长距离定位实验,数据显示,所提算法的平稳区间估计准确率超过 96% ,无闭环实验的终 点误差仅为总里程的 0. 93% ,混合地形闭环实验的东、北向平均误差分别为 1. 07 和 0. 74 m,验证了所提算法在不依赖外部信息 的条件下能长时间保持较高的定位精度。