一种机器人手臂多关节的运动规划方法及系统

本发明公开了一种机器人手臂多关节的运动规划方法及系统，属于认知发展与机器人运动控制交叉领域。本发明针对机械臂建立正向模型和对应各个关节的多个反向模型，正向模型用于建立机械臂的各关节的角度到机械臂末端位姿的映射，每个反向模型用于建立机械臂末端位姿到对应关节的角度的映射，通过借鉴人的手臂运动规划机理，机械臂在远距离趋近的时以靠近肩关节的关节为主，在近距离趋近时以肘部关节为主，并通过贪心策略和优化的辅助损失函数对模型进行优化。本发明可以根据机械臂的末端在笛卡尔空间中移动的位移大小，选择合适的关节指令来执行，以实现更有效的运动规划。