如前所述,这里真正重要的是你运动学解。为了使机器人手臂处于期望的位姿,如果有了逆运动学解就能确定每个关节的值。前面已对特定坐标系统的逆运动学解作了介绍。在这一部分,将研究求解逆运动方程的一般步骤。
现在你可能已经注意到,前面的运动方程中有许多角度的耦合,比如,这就使得无法从矩阵中提取足够的元素来求解单个的正弦和余弦项以计算角度。为使角度解耦,可例行地用单个矩阵左乘矩阵,使得方程右边不再包括这个角度,于是可以找到产生角度的正弦值和余弦值的元素,并进而求得相应的角度。
这里概要地给出了这个方法,并将其用于例2.19中的简单机械手臂。虽然所给出的解决方法只针对这一给定构型的机器人,但也可以类似地用于其它机器人。正如在例2.19中看到的,表示机器人的最后方程为:
为了书写方便,将上面的矩阵表示为[RHS](Right-Hand Side)。这里再次将机器人的期望位姿表示为: