7自由度SRS型机械臂逆解的解析方法、装置及电子设备

摘要

本发明公开了一种7自由度SRS型机械臂逆解的解析方法、装置及电子设备，所述方法包括：建立机械臂的世界坐标系、肩部固定坐标系以及各关节的局部坐标系；将机械臂腕部在世界坐标系下的第一位置和第一姿态转换为在肩部固定坐标系下的第二位置和第二姿态；根据第二位置、机械臂的上臂长和下臂长，计算肘关节的关节角；在肩部的三个关节中，选择一个关节的关节角作为优化变量；根据肘关节的关节角、优化变量、第二位置、第一坐标和第二坐标，计算肩部其余两个关节的关节角；根据优化变量、肩部其余两个关节的关节角、肘关节的关节角和第二姿态，计算腕部三个关节的关节角。