一种对机械臂路径冗余节点的反向拆分计算的方法及系统

摘要

本发明公开了一种对机械臂路径冗余节点的反向拆分计算的方法及系统，属于机器人运动规划技术领域。本发明方法包括：对机械臂R进行运动规划，确定运动路径，作为动态障碍物，并确定无碰撞运动路径；对机械臂R去除冗余节点，记录运动轨迹中对应的时间，对机无碰撞运动路径去除冗余节点，记录对应的时间；对运动路径做反向拆分操作，确定无碰撞路径；做碰撞检测，确定首次碰撞时间，并确定发生碰撞时刻的关节构型；根据关节构型，确定最优节点轨迹；重复机械臂R及机械臂L运动路径的反向拆分操作，获取机械臂R及机械臂L最优节点轨迹的路径，直到机械臂R及机械臂L优化后的路径不再发生碰撞，确定反向拆分路径。