一种针对运动学冗余双臂空间机器人的协同路径规划方法

摘要

本发明公开了一种针对运动学冗余双臂空间机器人的协同路径规划方法，包括以下步骤：建立空间机器人系统的动力学方程和运动学方程；求解末端执行器逆运动学方程冗余解，通过动量守恒方程得到系统非完整约束方程；通过系统非完整约束方程，得到末端执行器运动和基座姿态关系的任务空间约束方程；使用五阶贝塞尔曲线得到任务空间中末端执行器路径规划，通过末端执行器的速度和加速度边界确定路径执行时间；通过末端执行器运动方程和任务空间约束方程，得到对应不同任务优先级的关节运动轨迹规划。实现了空间双臂机器人的协同路径规划方法，可以根据任务的优先级执行各类不同的任务，多臂协同任务，动态平衡任务等，大大拓展了空间机械臂的操作能力。