一种基于双阈值法ZMP的六足机器人失稳调节算法

摘要

本发明公开了一种基于双阈值法ZMP的六足机器人失稳调节算法，涉及六足机器人技术领域，其包括以下步骤：S1，设定足端压力阈值N1和机身姿态角的阈值N2，当六足机器人足端压力的输出值大于N1且机身姿态角大于N2时，则判定为机器人失稳状态，否则为稳定状态，稳定状态下的六足机器人以三足行走步态运动；S2，当六足机器人被判定为失稳状态后，将三足行走步态转换为五足行走步态，六足机器人的六条腿单个依次循环运动，无论何时都至少有五条腿支撑地面；S3，同时利用ZMP法构建六足机器人稳定判据，通过得到的六足机器人机身的姿态信息，本发明的有益效果是：在提高失稳判定准确度的同时优化了失稳判定的效率。