摘要
本发明提供一种双足轮式机器人平衡控制方法,解耦双足轮式机器人机身运动与腿部运动,提高了双足轮式机器人的稳定性。包括如下步骤:步骤一:令双足轮式机器人的两条腿分别为腿A和腿B;先控制腿A按规划值移动,然后计算腿A按规划值移动后其质心的位移;步骤二:依据步骤一所计算的腿A质心的位移,基于零力矩点平衡判定和腿部质心‑步长方程计算腿B的期望质心位移和期望迈步长度;步骤3:根据步骤2所计算的腿B的期望迈步长度,计算腿B中两个关节的转角,进而通过控制对应关节处的电机实现对腿B运动的控制,使腿B的迈步长度为所计算的期望迈步长度。