一种两关节绳驱连续型机械臂逆运动学求解方法

摘要

本发明公开了一种两关节绳驱连续型机械臂逆运动学求解方法，包括以下步骤：首先利用分段常曲率假设建立两关节绳驱连续型机械臂的参数化模型；其次，求解机械臂末端位置点到目标位置点在位置和姿态上的误差，并作为目标函数；然后，利用粒子群算法快速找到使目标函数达到最小的关节变量；最后，分析得到两个关节之间的运动耦合量，并在关节空间到驱动空间的映射中进行解耦，得到绳长变化量。本发明能够快速的得到绳驱连续型机械臂的逆运动学解，并且考虑了两关节之间的耦合，使得逆运动学模型更加精确。