基于IMU和运动学的四足机器人对角支撑状态估计算法
CSTR:
作者:
作者单位:

西安交通大学 自动化科学与工程学院,西安 710049

作者简介:

通讯作者:

E-mail: renzg@xjtu.edu.cn.

中图分类号:

TP242.6

基金项目:

国家自然科学基金项目(62373296).


State estimation for diagonal support of quadruped robot based on IMU and kinematics
Author:
Affiliation:

School of Automation Science and Engineering,Xián Jiaotong University,Xián 710049,China

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    对角支撑是四足机器人复杂动态以及线性行走必备的一种状态.然而,目前鲜有有效的状态估计算法,无法支撑相应控制策略.为此,提出一种融合惯性测量单元(inertial measurement unit, IMU)和运动学约束的状态估计算法.首先,针对对角支撑状态下运动学模型欠约束带来的位姿估计难题,通过分解机身坐标系到参考坐标系的变换矩阵,简化运动学方程,并利用IMU提供的可信俯仰和横滚角测量值,推导获得其余4个位姿量的解析式;然后,进一步基于腿部微分运动学和IMU提供的俯仰和横滚角速率,结合位姿量的导数获得线速度和偏航角速率的解析式;最后,通过仿真分析验证所提出算法的有效性.实验结果表明:位姿估计值准确、无漂移,偏航角速率和线速度的均方根误差分别小于2deg/s和9mm/s,优于现有算法且满足实际控制需求.

    Abstract:

    Diagonal support is necessary for complex dynamic gait and linear walking of quadruped robots. However, no state estimation method currently supports the corresponding control strategy. In this paper, a state estimation algorithm that fuses inertial measurement units(IMUs) and kinematic constraints is proposed. Firstly, aiming at the pose estimation problem caused by under-constrained kinematics of diagonal support, the kinematic equations are simplified by decomposing the transformation matrix from the body coordinate system to the reference coordinate system, and the analytical formulas of the remaining four pose states are obtained by using the credible pitch and roll measurements of the IMU. Then, based on the differential kinematics of the leg and the pitch and roll angular rates of the IMU, the analytical formulas of the linear velocity and the yaw angular rate are obtained by combining the derivative of pose. Simulation analysis verifies the effectiveness of the proposed algorithm. The experimental results show that the pose estimation values are accurate and drift-free, and the root mean square errors of yaw angular rate and linear velocity are less than 2deg/s and 9mm/s respectively, which outperform existing algorithms and meet the practical control requirements.

    参考文献
    相似文献
    引证文献
引用本文

陈辉,任志刚,冯祖仁,等.基于IMU和运动学的四足机器人对角支撑状态估计算法[J].控制与决策,2024,39(9):2894-2902

复制
分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2024-08-07
  • 出版日期: 2024-09-20
文章二维码