Invention Publication

仿人机器人的控制方法
Abstract:
本发明公开了一种实时性高、工程实用性强的仿人机器人的控制方法,(1)建立桌子一小车数学模型,并简化为系统状态方程;(2)选定基函数;(3)由仿人机器人的传感器按采样周期采样并计算仿人机器人的实际ZMP,记该实际ZMP的位置为p;(4)在每个采样周期都将p与步骤(1)中所述系统状态方程输出的p m 进行比较,得到误差,记该误差为e,由表达式e=p-p m 确定,并进行模型反馈校正,最终使e趋向于零;(5)将反馈校正后的模型代入预测函数控制优化算法;(6)经预测函数控制优化运算后输出控制量去控制仿人机器人的伺服驱动器;(7)重复步骤(3)~(7),得到每个采样周期的实际控制量,实时控制所述仿人机器人的运动。
Patent Agency Ranking
0/0