[发明专利]基于闭环控制的仿人机器人全向行走方法

摘要

本发明提供一种基于闭环控制的仿人机器人全向行走方法，包括足部落脚点规划、机器人躯干运动轨迹、足部空间轨迹规划、关节角度计算和反馈控制策略，首先规划出机器人足部在二维空间下的落脚点并计算出机器人的零力矩点ZMP值；由ZMP值建立带预测控制的双线性倒立摆模型并得到机器人躯干的参考位姿；由规划得出的落脚点使用三次样条插值法，得出每两个落脚点在三维空间中的最佳运行轨迹，即可获得足部参考位姿；由上述得出躯干和足部的参考位姿利用逆运动学知识计算出机器人各个关节的角度。本发明在仿人机器人行走过程中，利用闭环控制实现机器人的全向行走。相比现有技术，本发明的机器人行走方法具有鲁棒性强、稳定性好的优点。

主权项

一种基于闭环控制的仿人机器人全向行走方法，其特征在于：包括足部落脚点规划、机器人躯干运动轨迹、足部空间轨迹规划、关节角度计算和反馈控制策略，步骤一，足部落脚点规划：采用蚁群算法进行路径规划得出机器人足部在二维空间下的落脚点，并计算出机器人的零力矩点ZMP值；步骤二，机器人躯干运动轨迹：由步骤一得出的ZMP值建立带预测控制的双线性倒立摆模型并得到机器人躯干的参考位姿；步骤三，足部空间轨迹规划：由步骤一的足部落脚点规划得出的落脚点使用三次样条插值法，得出每两个落脚点在三维空间中的最佳运行轨迹，即可获得足部参考位姿；步骤四，关节角度计算：由步骤二、步骤三得出躯干和足部的参考位姿利用逆运动学知识计算出机器人的膝盖处的关节角，踝关节的滚动角和俯仰角，股关节的偏摆角、滚动角和俯仰角；步骤五，反馈控制策略：采用PID控制算法精确各个关节角度值并应用于实体机器人，由陀螺仪传感器信息值计算出机器人行走过程中的真实躯干位置，并与双线性倒立摆结合形成反馈控制，形成对整个行走过程的闭环控制。