基于运动发散分量的四足机器人步态规划

Gait planning of quadruped robot based on divergence component of motion

为了使四足机器人在出现较大的轨迹跟踪误差时仍然可以稳定运动,提出基于运动发散分量(DCM)的在线步态规划方法.将四足机器人抽象成三维线性倒立摆模型(LIPM),根据离线规划的落脚点,应用DCM方法论递推出保持DCM有界的参考轨迹;在满足步幅约束、零力矩点(ZMP)约束的条件下,步态规划运用宽松初始状态模型预测控制在线优化出可快速收敛到参考轨迹上的落脚点以及期望状态轨迹;全身运动控制器通过构建二次规划优化出满足运动约束、动力学约束、摩擦力约束等条件下跟踪期望状态轨迹的力矩.通过仿真验证以上算法,仿真结果表明:与经典模型预测控制相比,宽松初始状态模型预测控制可以承受较大的轨迹跟踪误差,四足机器人可以在出现较大的轨迹跟踪误差时以troting步态稳定运动并尽快收敛到离线规划的轨迹上.

An online gait planning method based on the divergence component of motion(DCM)was proposed in order to make the quadruped robot move stably when a large trajectory tracking error occurs.The quadruped robot was simplified into a 3D linear inverted pendulum model(LIPM).The DCM methodology was used to calculate the reference trajectory that keeps the DCM bounded according to the footprint of offline planning.Gait planning applied loose initial state model predictive control to optimize the footprint and desired state trajectory that can quickly converge to the reference trajectory online,under the condition of satisfying the stride constraints and zero moment point(ZMP)constraints.The whole body control was used to optimize the torque to track the trajectory of the desired state under the conditions of motion constraints,dynamic constraints,and friction constraints by constructing a quadratic program.The above algorithm was verified by simulation and results show that loose initial state model predictive control can tolerate larger trajectory tracking errors compared with traditional model predictive control and the quadruped robot can move steadily in troting gait and converge to the reference trajectory as soon as possible when a large trajectory tracking error of DCM occurs.