（4）将zn轴绕xn?1轴旋转?n?1，使得zn轴与zn?1轴对准（如图2.25（f）所示）。这时坐标系n和n+1完全相同（如图2.25（g）所示）。至此，我们成功地从一个坐标系变换到了下一个坐标
系。
在n+1和n+2坐标系间严格地按照同样的四个运动顺序可以将一个坐标变换到下一个坐标系。如有必要，可以重复以上步骤，就可以实现一系列相邻坐标系之间的变换。从参考坐标系开始，我们可以将其转换到机器人的基座，然后到第一个关节，第二个关节??，直至末端执行器。这里比较好的一点是，在任何两个坐标系之间的变换均可采用与前面相同的运动步骤。 通过右乘表示四个运动的四个矩阵就可以得到变换矩阵A，矩阵A表示了四个依次的运动。由于所有的变换都是相对于当前坐标系的（即他们都是相对于当前的本地坐标系来测量与执行），因此所有的矩阵都是右乘。从而得到结果如下：
nTn?1?An?1?Rot?z,?n?1??Tran?0,0,dn?1??Tran?an?1,0,0??Rot?x,an?1?
?C?n?1?S?n?1?S?C?n?1??n?1?00?0?0?1?0???0??0010000100??1?00????0??0??1??0010000?00?? 1dn?1??01?0?0?? （2.51） 0??1?0an?1??100?0C?00??S?n?1n?1???10??0S?n?1C?n?1??01??000?C?n?1?S?n?1C?n?1S?n?1S?n?1an?1C?n?1??S??C?C??C?S?aS?n?1n?1n?1n?1n?1n?1n?1? （2.52） An?1???0S?n?1C?n?1dn?1???0001??比如，一般机器人的关节2与关节3之间的变换可以简化为：
a3C?3?a3S?3?? （2.53） d3??1? 在机器人的基座上，可以从第一个关节开始变换到第二个关节，然后到第三个??，再到机器人的手，最终到末端执行器。若把每个变换定义为，则可以得到许多表示变换的矩阵。在机器人的基座与手之间的总变换则为：
RTH?RT11T22T3?n?1Tn?A1A2A3?An （2.54）
其中n是关节数。对于一个具有六个自由度的机器人而言，有6个A矩阵。 为了简化A矩阵的计算，可以制作一张关节和连杆参数的表格，其中每个连杆和关节的参数值可从机器人的原理示意图上确定，并且可将这些参数代入A矩阵。表2.1可用于这个目的。 在以下几个例子中，我们将建立必要的坐标系，填写参数表，并将这些数值代入A矩阵。首先从简单的机器人开始，以后再考虑复杂的机器人。
表2.1 D-H参数表 ?C?3?S? 2T3?A3??3?0??0?S?3C?3C?3C?3S?30S?3S?3?C?3S?3C?30# 1 2 3 ? d a ? 例2.19 对于如图2.26所示的简单机器人，根据D-H表示法，建立必要的坐标系，并填写相应的参数表。
解：
为方便起见，在此例中，假设关节2，3和4在同一平面内，即它们的dn值为0。为建立机器人的坐标系，首先寻找关节（如图2.26所示）。该机器人有六个自由度，在这个简单机器人中，所有的关节都是旋转的。第一个关节（关节1）在连杆0（固定基座）和连杆1之间，关节2在连杆1和连杆2之间，等等。首先，如前面已经讨论过的那样，对每个关节建立z轴，接着建立z轴。观察图2.27和图2.28所示的坐标可以发现，图2.28是图2.27的简化线图。应注意每个坐标系原点3在它所在位置的原因。
4 5 6
图2.26 具有六个自由度的简单链式机器人
图2.27 简单六个自由度链式机器人的参考坐标系
图2.28 简单六个自由度链式机器人的参考坐标系线图
从关节1开始，z0表示第一个关节，它是一个旋转关节。选择x0与参考坐标系的x轴平行，这样做仅仅是为了方便，x0是一个固定的坐标轴，表示机器人的基座，它是不动的。第一个关节的运动
是围绕着z0-x0轴进行的，但这两个轴并不运动。接下来，在关节2处设定z1，因为坐标轴z0和z1是相交的，所以x1垂直于z0和z1。x2在z1和z2之间的公垂线方向上，x3在z2和z3之间的公垂线方向上，类似地，x4在z3和z4之间的公垂线方向上。最后，z5和z6是平行且共线的。z5表示关节6的运动，而z6表示末端执行的运动。通常在运动方程中不包含末端执行器，但应包含末端执行器的坐标系，这是因为它可以容许进行从坐标系z5?x5出发的变换。同时也要注意第一个和最后一个坐标系的原点的位置，它们将决定机器人的总编换方程。可以在第一个和最后的坐标系之间建立其他的（或不同的）中间坐标系，但只要第一个和最后的坐标系没有改变，机器人的总变换便是不变的。应注意的是，第一个关节的原点并不在关节的实际位置，但证明这样做是没有问题的，因为无论实际关节是高一点还是低一点，机器人的运动并不会有任何差异。因此，考虑原点位置时可不用考虑基座上关节的实际位置。
接下来，我们将根据已建立的坐标系来填写表2.2中的参数。参考前一节中任意两个坐标系之间的四个运动的顺序。从z0?x0开始，有一个旋转运动将x0转到了x1，为使得x0与x1轴重合，需要沿z1和沿x1的平移均为零，还需要一个旋转将z0转到z1，注意旋转是根据右手规则进行的，即将右手手指按旋转的方向弯曲，大拇指的方向则为旋转坐标轴的方向。到了这时，z0?x0就变换到了z1?x1。
接下来，绕z1旋转?2，将x1转到了x2，然后沿x2轴移动距离a2，使坐标系原点重合。由于前后两个z轴是平行的，所以没有必要绕x轴旋转。按照这样的步骤继续做下去，就能得到所需要的结果。 必须要认识到，与其他机械类似，机器人也不会保持原理图中所示的一种构型不变。尽管机器人的原理图是二维的，但必须要想象出机器人的运动，也就是说，机器人的不同连杆和关节在运动时，与之相连的坐标系也随之运动。如果这时原理图所示机器人构型的坐标轴处于特殊的位姿状态，当机器人移动时它们又会处于其他的点和姿态上。比如，x3总是沿着关节3与关节4之间连线a3的方向。当机器人的下臂绕关节2旋转而运动。在确定参数时，必须记住这一点。
表2.2 例2.19机器人的参数 # 1 2 3 4 5 6 ? ?1 d 0 0 0 0 0 0 a 0 ? 90 0 0 -90 90 0 ?2 a2 ?3 ?4 a3 a4 0 0 ?5 ?6 ?表示旋转关节的关节变量，d表示滑动关节的关节变量。因为这个机器人的关节全是旋转的，因此所有关节变量都是角度。
通过简单地从参数表中选取参数代入A矩阵，便可写出每两个相邻关节之间的变换。例如，在坐
标系0和1之间的变换矩阵A1可通过将?（sin90?=1,cos90?=0, ?=90?）以及指定C1为?1等代入A矩阵得到，对其他关节的A2~A6矩阵也是这样，最后得：
?C1?SA1??1?0??00S10?C11000?S3C3000??C2?S0?? A2??2?00???1??0?S2C2000C2a2?0S2a2?? 10??01?C4a4?S4a4?? （2.55） 0??1?0?0?? 0??1??C3?SA3??3?0??0?C5?SA5??5?0??00C3a3??C4?S0S3a3?? A4??4?010???01??00?S40C4?1000?S6C60000100??C6?S0?? A6??6?00???1??0特别注意：为简化最后的解，将用到下列三角函数关系式：
0S50?C51000S?1C?2?C?1S?2?S(?1??2)?S12C?1C?2?S?1S?2?C(?1??2)?C12在机器人的基座和手之间的总变换为：
R （2.56）
TH?A1A2A3A4A5A6 （2.57）
C1(C234a4??C1(C234C5C6?S234S6)C1(?C234C5C6?S234C6)C1(C234S5)???SSC??SSS?SCCa?Ca)1561523322?156?S1(C234C5C6?S234S6)S1(?C234C5C6?S234C6)S1(C234S5)S1(C234a4?? ????CSS?C1S5S6?C1C5C23a3?C2a2)?156??SCC?SCC?CCSSSa?Sa?Sa234562345623462345234423322????0001??例2.20 斯坦福机械手臂。在斯坦福机械手臂上指定坐标系（如图2.29所示），并填写参数表。斯坦福机械手臂是一个球坐标手臂，即开始的两个关节是旋转的，第三个关节是滑动的，最后三个腕关节全是旋转关节。
图2.29 斯坦福机械手臂示意图
解：
在看本题解答之前，现根据自己的理解来做，问题的答案在本章的最后。建议在看解答中建立的坐标系和机械手臂的解之前，先试着自己做。
机器手臂最后的正运动学解是相邻关节之间的6个变换矩阵的乘积：
RTHSTANGORD?nx?n?0T6??y?nz??0oxoyoz0axayaz0px?py?? pz??1?其中
nx?C1?C2?C4C5C6?S4S6??S2S5C6??S1?S4C5C6?C4S6?nz??S2?C4C5C6?S4S6??C2S5C6ny?S1?C2?C4C5C6?S4S6??S2S5C6??C1?S4C5C6?C4S6? ox?C1??C2?C4C5C6?S4S6??S2S5C6??S1??S4C5C6?C4S6?oz?S2?C4C5C6?S4S6??C2S5C6ax?C1?C2C4S5?S2C6??S1S4S5ay?S1?C2C4S5?S2C6??C1S4S5 （2.58） az??S2C4S5?C2C5px?C1S2d3?S1d2py?S1S2d3?C1d2 pz?C2d3 oy?S1??C2?C4C5C6?S4S6??S2S5C6??C1??S4C5C6?C4S6?
2.9 机器人的你运动学解
如前所述，这里真正重要的是你运动学解。为了使机器人手臂处于期望的位姿，如果有了逆运动学解就能确定每个关节的值。前面已对特定坐标系统的逆运动学解作了介绍。在这一部分，将研究求解逆运动方程的一般步骤。
现在你可能已经注意到，前面的运动方程中有许多角度的耦合，比如C234，这就使得无法从矩阵中提取足够的元素来求解单个的正弦和余弦项以计算角度。为使角度解耦，可例行地用单个RTH矩阵
?1左乘An矩阵，使得方程右边不再包括这个角度，于是可以找到产生角度的正弦值和余弦值的元素，
并进而求得相应的角度。
这里概要地给出了这个方法，并将其用于例2.19中的简单机械手臂。虽然所给出的解决方法只针对这一给定构型的机器人，但也可以类似地用于其它机器人。正如在例2.19中看到的，表示机器人的最后方程为：
RTH?A1A2A3A4A5A6C1(?C234C5C6?S234C6)C1(C234S5)?S1S5S6?S1C5S1(?C234C5C6?S234C6)S1(C234S5)?C1S5S6?S234C5C6?C234C60?C1C5S234S50?C23a3?C2a2)?? S1(C234a4??C23a3?C2a2)??S234a4?S23a3?S2a2??1?C1(C234a4??C1(C234C5C6?S234S6)??SSC?156S1(C234C5C6?S234S6)????CSS?156?S234C5C6?C234C6?0?为了书写方便，将上面的矩阵表示为[RHS](Right-Hand Side)。这里再次将机器人的期望位姿表示
为：