一种基于合作控制机制的机器人滚动优化控制方法

本发明涉及一种基于合作控制机制的机器人滚动优化控制方法。本发明首先引入虚拟机器人，建立虚拟机器人的动力学模型。该虚拟机器人可沿障碍物的边缘运动；然后，根据合作控制理论，在滚动优化的框架下，通过实际机器人与虚拟机器人之间的安全距离，实际机器人与虚拟机器人速度一致性、以及实际机器人到达目标位置的距离，构建成本函数；求解成本函数获得机器人的运动控制序列，并将第一个控制信号作用到机器人上，控制机器人安全有效运行。本发明弥补了传统局部路径规划方法的不足，降低了传统局部路径规划方法的复杂性，避免了机器人“陷入”环境中非目标位置，可以在动态不确定环境下，免碰撞的到达指定的目标位置。