机械臂逆逆运动学求解是指在已知工具坐标系相对于工作台坐标系的期望位置和姿态如何计算一系列满足期望要求的关节角?该问题与机械臂正逆运动学求解互为逆问題
为求出要求的关节角以放置相对于工作台坐标系{S}的工具坐标系{T},可将这个问题分为两部分:首先进行坐标系变换求出相对于基坐标系{B}的腕部坐标系{W};然后应用逆逆运动学求解求关节角。
操作臂的逆逆运动学求解解法:
按照机械臂正逆运动学求解知识可以解出
由变换矩阵的含义可得到四个方程
进行合适的代数变换,可以求解出cos θ2.
对于实线表示的三角形利用余弦萣理求解θ2
再用余弦定理,求出ψ
平面内角度相加可以求得θ3.