基于快速踝部调节的双足机器人平衡控制器

摘要

本发明提供了一种基于快速踝部调节的双足机器人平衡控制器，包括质心控制器、状态判别器、零力矩点跟踪器、临稳状态控制器和力/力矩跟踪器；质心控制器根据机器人质心的位置和速度反馈，计算得到期望零力矩点位置；状态判别器对期望零力矩点的状态进行判断：当期望零力矩点位置处于稳定域内时，零力矩点跟踪器根据实际零力矩点位置和期望零力矩点位置，计算出双足期望接触力/力矩大小，随后使用力/力矩跟踪器实现期望接触力/力矩的跟踪；当期望零力矩点位置处于临界稳定域时，临稳状态控制器，将期望零力矩点拉回到稳定域内；当期望零力矩点位置处于发散域时，触发落脚点控制。本发明能使机器人实现快速的平衡响应，实现稳定的运动。