第十三章工业机器人机构学提要介绍了工业机器人的组成原理、分类与工作性能特点。
研究了坐标变换与空间物体的位姿与位移的齐次坐标表达;研究了已知各个关节的相对运动时,如何确定工业机器人末端操作器的位姿；研究了已知目标对象的位姿时,如何确定工业机器人各个关节的相对运动量。
１3．1 概述工业机器人是用来搬运材料、零件与工具,进行焊接与喷涂的可再编程的多功能机械手，通过调用不同的程序来完成预设的多种工作任务。
1３.2 工业机器人的组成工业机器人由三大部分六个子系统组成。
三大部分是机械部分、传感部分和控制部分。
六个系统是驱动系统、机构与结构系统、感觉系统、机器人与环境交互系统、人机交互系统和控制系统。
１.机器人的机构与结构系统工业机器人的机械部分由三部分组成,即机身、手臂和末端操作器。
机身可以是固定的,也可以是移动的。
手臂进一步划分为上臂和下臂,上臂与机身形成肩关节，上臂与下臂形成肘关节,下臂与末端操作器形成碗关节，如图1３.3所示。
2. 机器人手部的机构与结构系统1) 具有一个相对自由度的末端操作器2) 具有多个自由度的末端操作器1３．3工业机器人的分类与性能1）直角坐标型直角坐标型操作机如图1３．6所示，它有三个移动关节(PPP),可使末端操作器作三个方向的独立位移。
该种型式的工业机器人，定位精度较高,空间轨迹规划与求解相对较容易，计算机控制相对较简单。
它的不足是空间尺寸较大，运动的灵活性相对较差，运动的速度相对较低。
２)圆柱坐标型圆柱坐标型操作机如图１３.７所示,它有两个移动关节和一个转动关节(PPＲ)，末端操作器的安装轴线之位姿由(z，r,θ)坐标予以表示。
该种型式的工业机器人，空间尺寸较小,工作范围较大，末端操作器可获得较高的运动速度。
它的缺点是末端操作器离z轴愈远,其切向线位移的分辨精度就愈低。
3) 球坐标型球坐标型操作机如图1３.８所示,它有两个转动关节和一个移动关节(RＲP),末端操作器的安装轴线之位姿由(θ,φ, r)坐标予以表示。
该种型式的工业机器人,空间尺寸较小,工作范围较大。
4）关节型关节型操作机如图１3.9所示,它有三个转动关节（ＲＲＲ),即机身上部相对于下部的转动θＹ0，肩关节的转动θZ1和肘关节的转动θZ２。
腕关节的转动θZ3属于末端操作器的自由度。
该种结构的工业机器人,空间尺寸相对较小，工作范围相对较大，还可以绕过机座周围的障碍物，是目前应用较多的一种机型。
１3．４工业机器人的运动学基础工业机器人是由若干个关节所联系起来的一种开链，其一端固结在机座上，另一端安装有末端操作器。
确定工业机器人末端操作器安装轴线的方位,确定末端操作器的位姿与位移，确定工业机器人的操作对象,即目标物体的位姿与位移,构成了工业机器人运动学基础应该研究的一部分工作。
13.４.1目标物体的空间转动矩阵一个通过坐标原点的矢量V1绕通过坐标原点的单位矢量u转动φ角到达V２，要求确定V２的位姿。
为了确定矢量V1绕通过坐标原点的单位矢量u转动φ角到达V２的位姿,将它作如下转动。
１)平面内单位矢量绕坐标轴的转动矩阵2)空间内单位矢量绕坐标轴的转动矩阵[例１3-1］图13．11为单臂操作机械手，手臂相对于机身拥有一个转动自由度，手腕相对于手臂拥有一个转动自由度。
已知手腕上的坐标系ｏxyz相对于机身坐标系ＯXYZ的位姿矩阵SW为SＷ中前三行前三列的元素表示手腕坐标系的姿态,[2,6,2]T表示手腕坐标系原点的位置。
（1)若手臂相对于机身坐标系OXＹZ的Ｚ轴转动＋９０o，则坐标系o xｙz转到坐标系o1ｘ１ｙ1z１。
(2) 若手臂相对于机身不动，手腕上的坐标系ｏxyｚ相对于手臂上的z轴转动+90，则坐标系oｘｙz转到坐标系o2x2ｙ2ｚ2。
试写出以上两种转动的矩阵SW1、SW２。
解：坐标系O1x1y1ｚ１在固定坐标系OXYZ的位姿矩阵SW１为O2ｘ２y２z2坐标系在固定坐标系OXＹZ的位姿矩阵ＳW2为１3.４工业机器人的运动学基础工业机器人是由若干个关节所联系起来的一种开链,其一端固结在机座上,另一端安装有末端操作器。
确定工业机器人末端操作器安装轴线的方位，确定末端操作器的位姿与位移，确定工业机器人的操作对象，即目标物体的位姿与位移，构成了工业机器人运动学基础应该研究的一部分工作。
1３．4．1 目标物体的空间转动矩阵一个通过坐标原点的矢量V１绕通过坐标原点的单位矢量u转动φ角到达V2，要求确定Ｖ2的位姿。
为了确定矢量Ｖ1绕通过坐标原点的单位矢量u转动φ角到达V2的位姿,将它作如下转动。
1)平面内单位矢量绕坐标轴的转动矩阵2) 空间内单位矢量绕坐标轴的转动矩阵[例１３-1] 图1３．11为单臂操作机械手，手臂相对于机身拥有一个转动自由度,手腕相对于手臂拥有一个转动自由度。
已知手腕上的坐标系oxyz相对于机身坐标系OＸYZ的位姿矩阵ＳW为SW中前三行前三列的元素表示手腕坐标系的姿态,［２,6,2]T表示手腕坐标系原点的位置。
(1)若手臂相对于机身坐标系ＯXYZ的Ｚ轴转动+９０o,则坐标系oｘｙz转到坐标系o１ｘ1y１z１。
（2) 若手臂相对于机身不动，手腕上的坐标系oｘyｚ相对于手臂上的z轴转动+90，则坐标系oxｙz转到坐标系o2ｘ2ｙ2z2。
试写出以上两种转动的矩阵SＷ1、SＷ２。
解：坐标系O1ｘ1y1ｚ1在固定坐标系OXＹZ的位姿矩阵SＷ１为O2x2y２z2坐标系在固定坐标系ＯXYZ的位姿矩阵ＳW2为１2.4．２坐标系之间的空间变换矩阵设单位矢量ｖ在坐标系o'xyz中的投影分别为vｘ、v y和v z；矢量P在坐标系OＸYＺ中的投影分别为P X，ＰＹ和P Z;x轴在坐标系OＸYZ中X、Ｙ和Z上的投影分别为tｘX、t xY和t xＺ；ｙ轴在坐标系ＯＸＹZ 中X、Ｙ和Z上的投影分别为t yX、tｙY和ｔｙＺ;z轴在坐标系OXＹZ中X、Ｙ和Z上的投影分别为ｔｚX、ｔzY和t zZ。
ｔxX、ｔxＹ和t xＺ的表达式分别为tｘＸ＝coｓ(x，Ｘ），tｘY=coｓ(x,Y)，t xZ=cos(x，Ｚ),其余的关系式类推。
为此,连杆坐标系o?xyz相对于固定坐标系OXＹＺ的位姿为为了计算机求解方便，将上式改写为齐次坐标形式ω2、中心轮3的角速度ω3分别为结合图1２.1９（a)与式(12．26）、式(１２.2７)~式（１２．2９)得传动比i1H为１3．4.３目标物体的齐次坐标表示在如图13．1３（ａ)所示的坐标系OXYＺ中放置一个楔块，在楔块上设置坐标系ｏxyz,其上的特征点为Ａ１,A2，A３，A4，A5和A6。
这些特征点在自身坐标系oｘyz中的坐标分别为A1(１,0,0），A2（-1,０,０),A３(-1,0,２),A4(1,0,2)，A5（1,4,0），A6(-1,4,０)。
由图１3.1３（b)也可以得到坐标系ＯＸYＺ在坐标系ｏｘyz中的齐次坐标。
已知Ｘ轴的方位为[0，0,1,0], Ｙ轴的方位为[1，０，0,0]，Z轴的方位为[0，1,０，0］，坐标系OXYZ 的原点Ｏ在坐标系oxｙz中的位置为［0,0,－4,1] 。
为此，坐标系OXＹZ在坐标系oxyz中的位姿矩阵Ｔ[XYＺ→ｘyz]为１2．4.4刚体的空间位移矩阵在如图13.1４所示的坐标系OXYＺ中有一个连杆，连杆的初始位置用ｐ1ｑ1表示,终止位置用pq表示,p1点的位置矢量用R表示，连杆上的p1点沿一单位矢量ｕ位移s，同时连杆绕矢量u转动φ角,现在确定q点相对于q１点的位置。
设已知ｐ１=[ｐ1X p１Ｙp1Z]T,q1=[ｑ１Xｑ1Y q1Z]T，则q=［q X q Y q Z]T的矢量表达式与矩阵表达式分别为式(13.19)右端左侧的矩阵称为刚体的有限螺旋位移矩阵。
1３.4.5 欧拉角表示的变换矩阵在图１３.15(a)所示的固定坐标系OXYZ中放置一个矢量Ｕ，其初始位置为U1，坐标系ＯＸ'Y＇Z'是由ＯXYZ绕Z轴转ψ角度而得到的位置，此时,矢量U1转到U2的位置;坐标系OＸ＂Ｙ"Z"是由OＸ'Y'Z'绕X'轴转θ角度而得到的位置，此时，矢量Ｕ2转到U３的位置;矢量Ｕ3再绕Z"转动φ角而到达U4的位置。
在以上的相对转动中,每次都是相对于动坐标系进行的,而不是相对于固定坐标系进行的。
ψ、θ和φ 称为欧拉角。
若让所有的转动都是相对于固定坐标系ＯＸＹZ进行的，如图13.15(ｂ)所示,且转动顺序为,先绕Z轴转φ角度，再绕Ｘ轴转θ角度，最后绕Z轴转ψ角度。
转动变换矩阵为以上两种变换的展开式均为13.４.6 转动关节之间的位移矩阵连杆n右端的坐标系O n XｎＹn Zｎ在左端的坐标系Oｎ-1X n－1Yｎ-1Z n-1中的齐次变换矩阵T n为化简后得转动关节之间的位移矩阵为13.5工业机器人的正向运动学工业机器人的正向运动学是指已知各关节的类型、相邻关节之间的尺寸和相邻关节相对运动量的大小时，如何确定工业机器人末端操作器在固定坐标系中的位姿。
设工业机器人中的一个连杆一端关节上的坐标系相对于另一端关节上的坐标系的位姿由齐次变换矩阵Ti表示，设T1表示第一个连杆一端动关节上的坐标系相对于另一端固定关节上的坐标系的位姿;设第二个连杆的一端与第一个连杆形成动关节，另一端与下一个连杆形成动关节，齐次变换矩阵用T2表示，则第二个连杆相对于固定关节上的坐标系的位姿W2为W2＝T1T2。
依次类推,若有六个连杆，则第六个连杆相对于固定关节上的坐标系的位姿W6为Ｗ６=T1T２T３T4Ｔ5 T6W6的表现形式可以用以下的（4×4)矩阵予以表示式(13.２3）右端的前三列前三行表示末端操作器的姿态,第四列前三行表示末端操作器的位置。
１3.5.１平面关节型机器人的正向运动方程图１３.１7(a)所示为由一个肩关节、一个肘关节和一个腕关节组成的平面关节型的机器人简图,它的三个关节的轴线Z0、Z1、Ｚ２是平行的,它的结构参数如表13．1所示。
W3=T1 T２T3中每一项的矩阵表达式为W3=T1 T2 T３矩阵表达式为若转角θ１=30，θ2＝－60和θ3＝－3０，如图13.17（c)所示,则该平面关节型机器人的手部坐标系O3X3Y3Ｚ３在固定坐标系O０Ｘ0Y０Z0中的位姿W3为【计算演示】13.5.2斯坦福机器人的正向运动方程图１3.１8所示为斯坦福机器人的结构简图,针对图示的坐标系，其参数关系如表1２.2所示。
下面求末端操作器的位姿１) 坐标系Ｘ1Y1Z1相对于固定坐标系X０Y０Ｚ０的位姿2)坐标系Ｘ２Y2Z2相对于X1Y1Z1的位姿3) 坐标系X3Ｙ３Z3相对于Ｘ2Y2Ｚ2的位姿４) 手腕坐标系相对于X3Y3Z3的位姿(1) 坐标系Ｘ4Y4Z4相对于X3Y３Ｚ3的变换矩阵(2）坐标系X5Ｙ５Z5相对于Ｘ4Ｙ4Z4的变换矩阵(3)坐标系X6Y6Z6相对于Ｘ5Y5Z5的变换矩阵一旦知道了T１~T6,则任意杆件之间的变换矩阵可以使用以上公式求解出来。