第2章机器人位置运动学
2.1 引言
本章将研究机器人正逆运动学。当已知所有的关节变量时，可用正运动学来确定机器人末端手的位姿。如果要使机器人末端手放在特定的点上并且具有特定的姿态，可用逆运动学来计算出每一关节变量的值。首先利用矩阵建立物体、位置、姿态以及运动的表示方法，然后研究直角坐标型、圆柱坐标型以及球坐标型等不同构型机器人的正逆运动学，最后利用Denavit-Hartenberg(D-H表示法来推导机器人所有可能构型的正逆运动学方程。
实际上，机器手型的机器人没有末端执行器，多数情况下，机器人上附有一个抓持器。根据实际应用，用户可为机器人附加不同的末端执行器。显然，末端执行器的大小和长度决定了机器人的末端位置，即如果末端执行器的长短不同，那么机器人的末端位置也不同。在这一章中，假设机器人的末端是一个平板面，如有必要可在其上附加末端执行器，以后便称该平板面为机器人的“手”或“端面”。如有必要，这里还可以将末端执行器的长度加到机器人的末端来确定末端执行器的位姿。
2.2 机器人机构
机器手型的机器人具有多个自由度（DOF），并有三维开环链式机构。
在具有单自由度的系统中，当变量设定为特定值时，机器人机构就完全确定了，所有其他变量也就随之而定。如图2.1所示的四杆机构，当曲柄转角设定为120°时，则连杆与摇杆的角度也就确定了。然而在一个多自由度机构中，必须独立设定所有的输入变量才能知道其余的参数。机器人就是这样的多自由度机构，必须知道每一关节变量才能知道机器人的手处在什么位置。
图2.1 具有单自由度闭环的四杆机构
如果机器人要在空间运动，那么机器人就需要具有三维的结构。虽然也可能有二维多自由度的机器人，但它们并不常见。
机器人是开环机构，它与闭环机构不同（例如四杆机构），即使设定所有的关节变量，也不能确保机器人的手准确地处于给定的位置。这是因为如果关节或连杆有丝毫的偏差，该关节之后的所有关节的位置都会改变且没有反馈。例如，在图2.2所示的四杆机构中，如果连杆AB偏
移，它将影响杆。而在开环系统中（例如机器人），由于没有反馈，之后的所有构件都会发生偏移。于是，在开环系统中，必须不断测量所有关节和连杆的参数，或者监控系统的末
端，以便知道机器的运动位置。通过比较如下的两个连杆机构的向量方程，可以表示出这种差别，该向量方程表示了不同连杆之间的关系。
（2.1）
（2.2）
可见，如果连杆AB偏移，连杆也会相应地移动，式（2.1）的两边随连杆的变化而改变。而另一方面，如果机器人的连杆AB偏移，所有的后续连杆也会
移动，除非有其他方法测量，否则这种变化是未知的。
为了弥补开环机器人的这一缺陷，机器人手的位置可由类似摄像机的装置来进行不断测量，于是机器人需借助外部手段（比如辅助手臂或激光束）来构成闭环系统。或者按照常规做法，也可通过增加机器人连杆和关节强度来减少偏移，采用这种方法将导致机器人重量重、体积大、动作慢，而且它的额定负载与实际负载相比非常小。
图2.2 (a闭环机构；(b开环机构
2.3 机器人运动学的矩阵表示
矩阵可用来表示点、向量、坐标系、平移、旋转以及变换，还可以表示坐标系中的物体和其他运动元件。
2.3.1 空间点的表示
空间点P（如图2.3所示）可以用它的相对于参考坐标系的三个坐标来表示：
(2.3
其中，是参考坐标系中表示该点的坐标。显然，也可以用其他坐标来表示
空间点的
位置。
图2.3 空间点的表示
2.3.2 空间向量的表示
向量可以由三个起始和终止的坐标来表示。如果一个向量起始于点A，终止于点
B，那么它可以表示为。特殊情况下，如果一个向量起始于原点（如图2.4所示），则有：
（2.4）
其中是该向量在参考坐标系中的三个分量。实际上，前一节的点P就是用连接到该点的向量来表示的，具体地说，也就是用该向量的三个坐标来表示。
图2.4 空间向量的表示
向量的三个分量也可以写成矩阵的形式，如式（2.5）所示。在本书中将用这种形式来表示运动分量：
（2.5）
这种表示法也可以稍做变化：加入一个比例因子w,如果x, y, z各除以w,则得到。于是，这时向量可以写为：
，其中等等（2.6）
变量w可以为任意数，而且随着它的变化，向量的大小也会发生变化，这与在计算机图形学中缩放一张图片十分类似。随着w值的改变，向量的大小也相应地变化。如果w大于1，向量的所有分量都变大；如果w小于1，向量的所有分量都变小。这种方法也用于计算机图形学中改变图形与画片的大小。
如果w是1，各分量的大小保持不变。但是，如果w=0，则为无穷大。在
这种情况下，x，y和z（以及）表示一个长度为无穷大的向量，它的方向即为该向量所表示的方向。这就意味着方向向量可以由比例因子w=0的向量来表示，这里向量的长度并不重要，而其方向由该向量的三个分量来表示。
例2.1 有一个向量P=3i+5j+2k,按如下要求将其表示成矩阵形式：
（1）比例因子为2
（2）将它表示为方向的单位向量
解：
该向量可以表示为比例因子为2的矩阵形式，当比例因子为0时，则可以表示为方向向量，结果如下：
和
然而，为了将方向向量变为单位向量，须将该向量归一化使之长度等于1。这样，向量的每一个分量都要除以三个分量平方和的开方：
，等等和
2.3.3 坐标系在固定参考坐标系原点的表示
一个中心位于参考坐标系原点的坐标系由三个向量表示，通常着三个向量相互垂
直，称为单位向量，分别表示法线（normal）、指向（orientation）和接近（approach）向量（如图2.5所示）。正如2.3.3节所述，每一个单位向量都由它们所在参考坐标系着的三个分量表示。这样，坐标系F可以由三个向量以矩阵的形式表示为：
（2.7）
图2.5 坐标系在参考坐标系原点的表示
2.3.4 坐标系在固定参考坐标系中的表示
如果一个坐标系不再固定参考坐标系的原点（实际上也可包括在原点的情况），那么该坐标系的原点相对于参考坐标系的位置也必须表示出来。为此，在该坐标系原点与参考坐标系原点之间做一个向量来表示该坐标系的位置（如图2.6所示）。这个向量由相对于参考坐标系的三个向量来表示。这样，这个坐标系就可以由三个表示方向的单位向量以及第四个位置向量来表示。
（2.8）
图2.6 一个坐标系在另一个坐标系中的表示
如式（2.8）所示，前三个向量是w=0的方向向量，表示该坐标系的三个单位向量
的方向，而第四个w=1的向量表示该坐标系原点相对于参考坐标系的位置。与单位向量不同，向量P的长度十分重要，因而使用比例因子为1。坐标系也可以由一个没有比例因子的34矩阵表示，但不常用。
例2.2如图2.7所示的F坐标系位于参考坐标系中3，5，7的位置，它的n轴与x 轴平行，o轴相对于y轴的角度为45°，a轴相对于z轴的角度为45°。该坐标系可以表示为：
图2.7 坐标系在空间的表示举例
2.3.5 刚体的表示
一个物体在空间的表示可以这样实现：通过在它上面固连一个坐标系，再将该固连的坐标系在空间表示出来。由于这个坐标系一直固连在该物体上，所以该物体相对于坐标系的位姿是已知的。因此，只要这个坐标系可以在空间表示出来，那么这个物体相对于固定坐标系的位姿也就已知了（如图2.8所示）。如前所述，空间坐标
系可以用矩阵表示，其中坐标原点以及相对于参考坐标系的表示该坐标系姿态的三个向量也可以由该矩阵表示出来。于是有：
（2.9）
如第1章所述，空间中的一个点只有三个自由度，它只能沿三条参考坐标轴移动。但在空间的一个钢体有六个自由度，也就是说，它不仅可以沿着X,Y,Z三轴移动，而且还可绕这三个轴转动。因此，要全面地定义空间以物体，需要用6条独立的信息来描述物体原点在参考坐标系中相对于三个参考坐标轴的位置，以及物体关于这三个坐标轴的姿态。而式（2.9）给出了12条信息，其中9条为姿态信息，三条为位置信息（排除矩阵中最后一行的比例因子，因为它们没有附加信息）。显然，在该表达式中必定存在一定的约束条件将上述信息数限制为6。因此，需要用6个约束方程将12条信息减少到6条信息。这些约束条件来自于目前尚未利用的已知的坐标系特性，即：
三个向量相互垂直
每个单位向量的长度必须为1
图2.8 空间物体的表示
我们可以将其转换为以下六个约束方程：
（1）
（2）
（3）
（4）（向量的长度必须为1）（2.10）
（5）
（6）
因此，只有前述方程成立时，坐标系的值才能用矩阵表示。否则，坐标系将不正确。式（2.10）中前三个方程可以换用如下的三个向量的叉积来代替：
（2.11）
例2.3对于下列坐标系，求解所缺元素的值，并用矩阵来表示这个坐标系。
解：
显然，表示坐标系原点位置的值5，3，2对约束方程无影响。注意在三个方向向量中只有三个值是给定的，但这也已足够了。根据式（2.10），得：
或
或
或
或
或
或
将这些方程化简得：
解这六个方程得：。应注
意，必须同号。非唯一解的原因是由于给出的参数可能得到两组在相反方向上相互垂直的向量。最终得到的矩阵如下：
或
由此可见，两个矩阵都满足约束方程的要求。但应注意三个方向向量所表述的值不是任意的，而是受这些约束方程的约束，因此不可任意给矩阵赋值。
同样，可通过叉乘并令其等于，即来求解，表示如下：
或表示为：
将值代入方程得：
同时解下面这三个方程：
以此来代替三个点乘方程。联立三个单位向量长度的约束方程，便得到六个方程，求解这六个方程，可得到相同的未知参数的解。
2.4 齐次变换矩阵
由于各种原因，变换矩阵应写成方型形式，33或44均可。首先，如后面看到的，计算方形矩阵的逆要比计算长方形矩阵的逆容易得多。其次，为使两矩阵相乘，它们的维数必须匹配，即第一矩阵的列数必须与第二矩阵的行数相同。如果两矩阵是方阵则无上述要求。由于要以不同顺序将许多矩阵乘在一起得到机器人运动方程，因此，应采用方阵进行计算。
为保证所表示的矩阵为方阵，如果在同一矩阵中既表示姿态又表示位置，那么可在矩阵中加入比例因子使之成为44矩阵。如果只表示姿态，则可去掉比例因子得到33矩阵，或加入第四列全为0的位置数据以保持矩阵为方阵。这种形式的矩阵称为齐次矩阵，它们写为：
（2.12）
2.5 变换的表示
变换定义为空间的一个运动。当空间的一个坐标系（一个向量、一个物体或一个运动坐标系）相对于固定参考坐标系运动时，这一运动可以用类似于表示坐标系的方式来表示。这是因为变换本身就是坐标系状态的变化（表示坐标系位姿的变化），因此变换可以用坐标系来表示。变换可为如下几种形式中的一种：
纯平移
绕一个轴的纯旋转
平移与旋转的结合
为了解它们的表示方法，我们将逐一进行探讨。
2.5.1 纯平移变换的表示
如果一坐标系（它也可能表示一个物体）在空间以不变的姿态运动，那么该坐标就是纯平移。在这种情况下，它的方向单位向量保持同一方向不变。所有的改变只是坐标系原点相对于参考坐标系的变化，如图2.9所示。相对于固定参考坐标系的新的坐标系的位置可以用原来坐标系的原点位置向量加上表示位移的向量求得。若用矩阵形式，新坐标系的表示可以通过坐标系左乘变换矩阵得到。由于在纯平移中方向向量不改变，变换矩阵T可以简单地表示为：
（2.13）
图2.9 空间纯平移变换的表示
其中是纯平移向量相对于参考坐标系轴的三个分量。可以看到，矩阵的前三列表示没有旋转运动（等同于单位阵），而最后一列表示平移运动。新的坐标系位置为：
（2.14）
这个方程也可用符号写为：
（2.15）首先，如前面所看到的，新坐标系的位置可通过在坐标系矩阵前面左乘变换矩阵得到，后面将看到，无论以何种形式，这种方法对于所有的变换都成立。其次可以注意到，方向向量经过纯平移后保持不变。但
是，新的坐标系的位置是和向量相加的结果。最后应该注意到，齐次变换矩阵与矩阵乘法的关系使得到的新矩阵的维数和变换前相同。
例2.4坐标系F沿参考坐标系的x轴移动9个单位，沿z轴移动5个单位。求新的坐标系位置。
解：由式（2.14）或式（2.15）得：
=和
2.5.2 绕轴纯旋转变换的表示
为简化绕轴旋转的推导，首先假设该坐标系位于参考坐标系的原点并且与之平行，之后将结果推广到其他的旋转以及旋转的组合。
假设坐标系（）位于参考坐标系（）的原点，坐标系（）绕参考坐标系的x轴旋转一个角度，再假设旋转坐标系（）上有一点P相对
于参考坐标系的坐标为，相对于运动坐标系的坐标为。当坐标系绕x轴旋转时，坐标系上的点P也随坐标系一起旋转。在旋转之前，P点在两个坐标系中的坐标是相同的（这时两个坐标系位置相同，并且相互平行）。旋转后，该
点坐标在旋转坐标系（x ,y ,z）中保持不变，但在参考坐标系中却改变了（如图2.10所示）。现在要求找到运动坐标系旋转后P相对于固定参考坐标系的新坐标。
让我们从x轴来观察在二维平面上的同一点的坐标，图2.10显示了点P在坐标系旋转前后的坐标。点P相对于参考坐标系的坐标是，而相对于旋转坐标系（点P所固连的坐标系）的坐标仍为。
由图2.11可以看出，不随坐标系统x轴的转动而改变，而和却改变了，
可以证明：（2.16）
写成矩阵形式为：
（2.17）
图2.10 在坐标系旋转前后的点的坐标
图2.11 相对于参考坐标系的点的坐标和从x轴上观察旋转坐标系
可见，为了得到在参考坐标系中的坐标，旋转坐标系中的点P（或向量P）的坐标必须左乘旋转矩阵。这个旋转矩阵只适用于绕参考坐标系的x轴做纯旋转变换的情况，它可表示为：
（2.18）
注意在式（2.17）中，旋转矩阵的第一列表示相对于x轴的位置，其值为1，0，0，它表示沿x轴的坐标没有改变。
为简化书写，习惯用符号表示以及用表示。因此，旋转矩阵也可写为：
（2.19）
可用同样的方法来分析坐标系绕参考坐标系y轴和z轴旋转的情况，可以证明其结果为：
和（2.20）
式（2.18）也可写为习惯的形式，以便于理解不同坐标系间的关系，为此，可将该变换表示为 (读作坐标系R相对于坐标系U（Universe）的变换，将表示为
（P相对于坐标系R），将表示为（P相对于坐标系U），式（2.18）可
简化为：
（2.21）
由上式可见，去掉R便得到了P相对于坐标系U的坐标。
例2.5旋转坐标系中有一点P，此坐标系绕参考坐标系x轴旋转90度。求旋转后该点相对于参考坐标系的坐标，并且用图解法检验结果。
解：
由于点P固连在旋转坐标系中，因此点P相对于旋转坐标系的坐标在旋转前后保持不变。该点相对于参考坐标系的坐标为：
如图2.12所示，根据前面的变换，得到旋转后P点相对于参考坐标系的坐标为2，-4，3.
图2.12 相对于参考坐标系的坐标系旋转
2.5.3 复合变换的表示
复合变换是由固定参考坐标系或当前运动坐标系的一系列沿轴平移和绕轴旋转变换所组成的。任何变换都可以分解为按一定顺序的一组平移和旋转变换。例如，为了完成所要求的变换，可以先绕x轴旋转，再沿轴平移，最后绕y轴旋转。在后面将会看到，这个变换顺序很重要，如果颠倒两个依次变换的顺序，结果将会完全不同。
为了探讨如何处理复合变换，假定坐标系（）相对于参考坐标系（）依次进行了下面三个变换：
（1）绕x轴旋转度；
（2）接着平移（分别相对于轴）；
（3）最后绕y轴旋转度。
比如点固定在旋转坐标系，开始时旋转坐标系的原点与参考坐标系的原点
重合。随着坐标系（）相对于参考坐标系旋转或者平移时，坐标系中的P点相对于参考坐标系也跟着改变。如前面所看到的，第一次变换后，P点相对于参考坐标系的坐标可用下列方程进行计算。
（2.22）
其中，是第一次变换后该点相对于参考坐标系的坐标。第二次变换后，该点相对于参考坐标系的坐标是：
同样，第三次变换后，该点相对于参考坐标系的坐标为：
可见，每次变换后该点相对于参考坐标系的坐标都是通过用每个变换矩阵左乘该点的坐标得到的。当然，矩阵的顺序不能改变。同时还应注意，对于相对于参考坐标系的每次变换，矩阵都是左乘的。因此，矩阵书写的顺序和进行变换的顺序正好相反。
例2.6 固连在坐标系（）上的点P经历如下变换，求出变换后该点相对于参考坐标系的坐标。
(1绕z轴旋转90度；
(2接着绕y轴旋转90度；
(3接着再平移[4，-3，7]。
解：
表示该变换的矩阵方程为：
从图2.13可以看到，（）坐标系首先绕z轴旋转90度，接着绕y轴旋
转，最后相对于参考坐标系的轴平移。坐标系中的P点相对于轴的位置如图所示，最后该点在轴上的坐标分别为4+2=6，-3+7=4，7+3=10。请确认也能从图中理解上述结果。
图2.13 三次顺序变换的结果
例2.7 根据上例，假定(坐标系上的点经历相同变换，但变换按如下不同顺序进行，求出变换后该点相对于参考坐标系的坐标。
（1）绕z轴旋转90度；
（2）接着平移[4，-3，7]；
（3）接着再绕y轴旋转90度。
解：
表示该变换的矩阵方程为：
不难发现，尽管所有的变换与例2.6完全相同，但由于变换的顺序变了，该点最终坐标与前例完全不同。用图2.14可以清楚地说明这点，这时可以看出，尽管第一次变换后坐标系的变化与前例完全相同，但第二次变换后结果就完全不同，这
是由于相对于参考坐标系轴的平移使得旋转坐标系向外移动了。经第三次
变换，该坐标系将绕参考坐标系y轴旋转，因此向下旋转了，坐标系上点P的位置也显示在图中。
请证明该点相对于参考坐标系的坐标为7+2=9，-3+7=4和-4+3=-1，它与解析的结果相同。
图2.14 变换的顺序改变将改变最终结果
2.5.4 相对于旋转坐标系的变换
到目前为止，本书所讨论的所有变换都是相对于固定参考坐标系。也就是说，所有平移、旋转和距离（除了相对于运动坐标系的点的位置）都是相对参考坐标系轴来测量的。然而事实上，也有可能做相对于运动坐标系或当前坐标系的轴的变换。例如，可以相对于运动坐标系（也就是当前坐标系）的n轴而不是参考坐标系的x轴旋转90度。为计算当前坐标系中的点的坐标相对于参考坐标系的变化，这时需要右乘变换矩阵而不是左乘。由于运动坐标系中的点或物体的位置总是相对于运动坐标系测量的，所以总是右乘描述该点或物体的位置矩阵。
例2.8假设与例2.7中相同的点现在进行相同的变换，但所有变换都是相对于当前的运动坐标系，具体变换出如下。求出变换完成后该点相对于参考坐标系的坐标。
（1）绕轴旋转90度；
（2）然后沿轴平移[4，-3，7]；
（3）接着绕轴旋转90度。
解：
在本例中，因为所作变换是相对于当前坐标系的，因此右乘每个变换矩阵，可得表示该坐标的方程为：
如所期望的，结果与其他各例完全不同，不仅因为所作变换是相对于当前坐标系的，而且也因为矩阵顺序的改变。下面的图展示了这一结果，应注意它是怎样相对于当前坐标来完成这个变换的。
同时应注意，在当前坐标系中p点的坐标7，3，2是变换后得到相对于参考坐标系的坐标0，6，0的。
图2.15 相对于当前坐标系的变换
例2.9 坐标系B绕x轴旋转90°，然后沿当前坐标系a轴做了3英寸的平移，然后在绕z轴旋转90，最后沿当前坐标系o轴做5英寸的平移。
(a写出描述该运动的方程。
(b求坐标系中的点p（1，5，4）相对于参考坐标系的最终位置。
解：
在本例中，相对于参考坐标系以及当前坐标系的运动是交替进行的。
(a相应地左乘或右乘每个运动矩阵，得到：
=Rot（z,90Rot(x,90Trans(0,0,3Trans(0,5,0
(b带入具体的矩阵并将它们相乘，得到：
2.6 变换矩阵的逆
正如前面所提到的，在机器人分通过析中有很多地方要用到矩阵的逆，在下面的例子中可以看到一种涉及变换矩阵的情况。在图2.16中，假设机器人要在零件p上钻孔而须向零件p处移动。机器人基座相对于参考坐标系u的位置用坐标系R来描述，机器人手用坐标系H来描述，末端执行器（即用来钻孔的钻头的末端）用坐标系E来描述，零件的位置用坐标系P来描述。钻孔的点的位置于参考坐标系U可以通过两个独立的路径发生联系：一个是通过该零件的路径，另一个是通过机器人的路径。因此，可以写出下面的方程：
（2.24）
这就是说，该零件中点E的位置可以通过从U变换到P，并从P变换到E来完成，或者从U变换到R，从R变换到H，再从H变换到E。
焊接机器人运动分析 摘要：针对puma250焊接机器人，分析了它的正运动学、逆运动学的问题。采用D-H坐标系对机器人puma250 建立6个关节的坐标系并获取D-H 参数，并对其运动建立数学模型用MATLAB编程，同时仿真正运动学、逆运动学求解和轨迹规划利用pro-e对puma250建模三维模型。 关键词：puma250焊接机器人；正逆解；pro-e；Matlab；仿真 一、建立机器手三维图 Puma250机器人,具有6各自由度，即6个关节，其构成示意图如图1。各连杆包括腰部、两个臀部、腕部和手抓。设腰部为1连杆，两个臀部分别为2、3连杆，腰部为4连杆，手抓为5、6连杆，基座不包含在连杆范围之内，但看作0连杆，其中关节2、3、4使机械手工作空间可达空间成为灵活空间。1关节连接1连杆与基座0,2关节连接2连杆与1连杆，3关节连接3连杆与2连按，4关节连接4连杆与3连杆，5关节连接5连杆与4连杆。各连杆坐标系如图 2 所示。
图1 puma250 机器人二、建立连杆直角坐标系。
三、根据坐标系确定D-H表。 四、利用MATLAB 编程求机械手仿真图。>>L1=Link([pi/2 0 0 0 0],'standard'); L2=Link([0 0 0 -pi/2 0],'standard'); L3=Link([0 -4 8 0 0],'standard'); L4=Link([-pi/2 0 8 0 0],'standard'); L5=Link([-pi/2 0 0 -pi/2 0],'standard'); L6=Link([0 2 0 -pi/2 0],'standard'); bot=SerialLink([L1 L2 L3 L4 L5 L6],'name','ROBOT'); ([0 0 0 0 0 0])
一、平面二连杆机器人手臂运动学 平面二连杆机械手臂如图1所示，连杆1长度1l ，连杆2长度2l 。建立如图1所示的坐标系，其中，),(00y x 为基础坐标系，固定在基座上，),(11y x 、),(22y x 为连体坐标系，分别固结在连杆1和连杆2上并随它们一起运动。关节角顺时针为负逆时针为正。 图1平面双连杆机器人示意图 1、用简单的平面几何关系建立运动学方程 连杆2末段与中线交点处一点P 在基础坐标系中的位置坐标： ) sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p （1） 2、用D-H 方法建立运动学方程 假定0z 、1z 、2z 垂直于纸面向里。从),,(000z y x 到),,(111z y x 的齐次旋转变换矩阵为： ?? ??? ???????-=100 010000cos sin 00sin cos 1 111 01θθ θθT （2） 从),,(111z y x 到),,(222z y x 的齐次旋转变换矩阵为： ?? ??? ???????-=100 010000cos sin 0sin cos 2 212212 θθ θθl T （3） 从),,(000z y x 到),,(222z y x 的齐次旋转变换矩阵为：
? ???? ???????+++-+=?? ??? ? ? ?? ???-?????????????-=?=10000100sin 0)cos()sin(cos 0)sin()cos( 1000010 000cos sin 0sin cos 1000 010000cos sin 00sin cos 1121211121212212 2111 1120102θθθθθθθθθθθθθθθθ θθl l l T T T （4） 那么，连杆2末段与中线交点处一点P 在基础坐标系中的位置矢量为： ? ?? ? ? ???????=????????????++++=? ? ? ?? ? ?????????????? ?? ???+++-+=?=110)sin(sin )cos( cos 10010000100sin 0)cos()sin(cos 0)sin()cos( 212112121121121211121212 020p p p z y x l l l l l l l P T P θθθθθθθθθθθθθθθθ （5） 即， ) sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p （6） 与用简单的平面几何关系建立运动学方程（1）相同。 建立以上运动学方程后，若已知个连杆的关节角21θθ、，就可以用运动学方程求出机械手臂末端位置坐标，这可以用于运动学仿真。 3、平面二连杆机器人手臂逆运动学 建立以上运动学方程后，若已知个机械臂的末端位置，可以用运动学方程求出机械手臂二连杆的关节角21θθ、，这叫机械臂的逆运动学。逆运动学可以用于对机械臂关节角和末端位置的控制。对于本例中平面二连杆机械臂，其逆运动学方程的建立就是已知末端位置 ),(p p y x 求相应关节角21θθ、的过程。推倒如下。 （1）问题 ) sin(sin )cos(cos 2121121211θθθθθθ++=++=l l y l l x p p 已知末端位置坐标),(p p y x ，求关节角21θθ、。 （2）求1θ
1.1连杆的坐标系 应用D-H 法来建立机器人杆件的坐标系。在这种坐标系中，可以把机械手的任一连杆i （i=1，2，3···，n ）看作是一个刚体，与它相邻的两个关节i 、i-1的轴线i 和i-1 之间的关系也由它确定，如图1，可以用以下四个参数描 式中，cθi =cosθi ，sθi =sinθi ，i=1，2，3，···，n 图1连杆坐标系{i}到{i-1}的变换 i αi-1/（rad ）a i-1/（cm ）d i /（cm 12340 90°090°042.5410014.520011.895.3表1机器人连杆参数表
定义了连杆坐标系和相应得连杆参数，就能建立运动学方程，焊接机器人末端关节的坐标系{n}相对于基础坐标系{0}中的齐次变换公式为： 对于6自由度的焊接机器人公式可以写为 （2 变换矩阵0 n T是关于n个关节变量的函数，这些变量 可以通过放置在关节上的传感器测得，则机器人末端连杆再基坐标系中的位置和姿态就能描述出来。 E n表示焊接机器人末端关节的姿态， 器人在世界坐标系中的位置。[3] 2机器人的逆运动学分析 逆运动学求解是已知机器人末端的位置和姿态即 求解机器人对应于该位置和姿态的关节角 只要0 n T表示的末端连杆坐标系的位置和姿态位于机 械手的可达空间内，则运动学方程至少有一个解， 达空间内，机械手具有任意姿态，导致运动学方程可能出现重解。 机器人的运动学方程是一组非线性方程式， 求解过程中，我们逐次在公式（4）的两端同时左乘一 即为 在上式两边的矩阵中寻找简单的表达式或常数， 对应相等，计算过程如下： （ （ （ （ （ （3求取各关节的解集 依靠D-H法求解关节角的过程是和焊接机器人本身的结构相关的，换句话说，也就是特定配置的机器人需要特定的解决方案。通过公式（6）-（16）可以看出每个关节角的结果是不唯一的，如果采用已有的求解方法，显而易见该过程是缓慢的，复杂的。本文提出了一种计算最终执行器位置的所有精确值的算法。该算法是在MATLAB 程实现的。通过该算法得到各节点的解是更快速、有效的。 用变换矩阵 6T定义一条具有两个端点A和B 轨迹，如公式（17）和（19）。从而θ能够被求出，如公式20）
精心整理 焊接机器人离线编程应用技术 一、引述 随着国内外机械装备制造事业飞速发展，对各种机械设备的生产周期、产品质量、制造成本，提出了更高的要求。为了适应这种形势，设法提高及保证焊接接头质量的稳定性，机器人的柔性优势正是解决这一问题的的良好方案。 二、机器人系统简介 通用工业机器人，按其功能划分，一般由3个相互关连的部分组成：机械手总成、控制器、 教者的经验目测决定，对于复杂路径难以保证示教点的精确结果。而离线编程是将机器人所有编程的工作内容在计算机软件在完成，过程一般包括：机器人及设备的作业任务描述、建立变换方程、求解未知矩阵及编制任务程序等。在进行图形仿真以后，根据动态仿真的结果，对程序做适当的修正，以达到满意效果，最后在线控制机器人运动以完成作业。节省了在机器人上编程的时间、离线编程的程序易于修改、通过仿真模拟后，防止昂贵的设备发生碰撞而损坏、结合CAD 软件系统和其它人工智能技术与机器人系统一体化，来提高工作效率和焊接质量。由此看来当焊缝是直线或者简单曲线，焊缝上方没有干涉物且焊缝的精度要求不太高的情况下，采用在线示教的编程方式是非常理想的，但在许多复杂的作业应用中不是那么令人满意了。
因此，机器人离线编程及仿真是提高机器人焊接系统柔性化的一项关键技术，是现代机器人焊接制造业的一个重要方法。一般工业机器人焊接时，机器人对焊接过程动态变化、焊件变形和随机因素干扰等不具有自适应能力。随着焊接产品的高质量、多品种、小批量等要求增加，又对机器人焊接技术提出了更高要求。这就需要对本体机器人焊接系统进行二次开发，包括给焊接机器人配置适当的传感器，柔性周边设备以及相应软件功能，如焊缝跟踪传感、焊接过程传感与实时控制、焊接变位机构。这些功能大大扩展了基本的焊接机器人的功能，这样的焊接机器人系统智能程度的高低由所配置的传感器、控制系统以及软硬件所决定。根据目前的整体技术还不太容易满足机器人焊接的所有智能要求，但这是个重要的发展趋势。 其它 发那科公司的Roboguide以及日本OTC公司使用的离线模拟仿真软件就叫OTC。国内机器人厂家暂时还没有完全自主知识产权的模拟仿真软件。因为这些机器人公司业务主体是机器人与控制系统，而并非专业的软件公司，这些机器人厂家为了使自己的机器人更加适应市场需求，同时出于对机器人系统技术保护的考虑，而开发了只可用于自己公司机器人系统的离线模拟示教软件。这些软件虽然没有三维建模功能，但可以导入其它CAD软件设计的模型文件，通过虚拟示教方式离线编程，对于简单焊缝的作业倒也实用。
国防科学技术大学 硕士学位论文 仿人机器人运动学和动力学分析 姓名：王建文 申请学位级别：硕士 专业：模式识别与智能系统 指导教师：马宏绪 20031101
能力；目前，ＡＳＩＭＯ代表着仿人机器人研究的最高水平，见图卜２。２０００年，索尼公司也推出了自己研制的仿人机器人ＳＤＲ一３Ｘ，２００２年又研制出了ＳＤＲ一４Ｘ，见图卜３。日本东京大学也一直在进行仿人机器人的研究，与Ｋａｗａｄａ工学院合作相继研制成功了Ｈ５、Ｈ６和Ｈ７仿人机器人，其中Ｈ６机器人高１．３７米，体重５５公斤，具有３５个自由度，目前正在开发名为Ｉｓａｍｕ的新一代仿人机器人，其身高１．５米，体重５５公斤，具有３２个自由度。日本科学技术振兴机构也在从事ＰＩＮＯ机器人的研究，ＰＩＮＯ高０．７５米，采用２９个电机驱动，见图卜４。日本Ｗａｓｅｄａ大学一直在从事仿人机器人研究计划，研制的ｗＬ系列仿人机器人和ＷＥＮＤＹ机器人在机器人界有很大的影响，至今已投入１００多万美元，仍在研究之中。Ｔｏｈｏｋｕ大学研制的Ｓａｉｋａ３机器人高１．２７米，重４７公斤，具有３０个自由度。美国的ＭＩＴ和剑桥马萨诸塞技术学院等单位也一直在从事仿人机器人研究。德国、英国和韩国等也有很多单位在进行类似的研究。 图卜１Ｐ２机器人图卜２ＡＳＩＭＯ机器人图１．３ＳＤＲ－４Ｘ机器人图１－４ＰＩＮＯ机器人 图卜５第一代机器人图ｌ－６第二代机器人图１．７第三代机器人图１—８第四代机器人 在国家“８６３”高技术计划和自然科学基金的资助下，国内也开展了仿人机器人的研究工作。目前，国内主要有国防科技大学、哈尔滨工业大学和北京理工大学等单位从事仿人机器人的研究。国防科技大学机器人实验室研制机器人已有１０余年的历史，该实验室在这期间分四阶段推出了四代机器人，其中，２０００年底推出的仿人机器入一“先行者”一是国内第一台仿人机器人。２００３年６月，又成功研制了一台具有新型机械结构和运动特性的仿人机器人，这台机器人身高１．５５米，体重６３．５公斤，共有３６个自由度，脚踝有力 第２页
精心整理 一、平面二连杆机器人手臂运动学 平面二连杆机械手臂如图1所示，连杆1长度1l ，连杆2长度2l ，连杆3长度为3l 。建立如图1所示的坐标系，其中，),(00y x 为基础坐标系，固定在基座上，),(11y x 、),(22y x 、33(,)x y 为连体坐标系，分别固结在连杆1、连杆2、连杆3上并随它们一起运动。关节角顺时针为负逆时针为正。 1 θ 图11112123123p p x y 2、用D-H 方法建立运动学方程 假定0z 、1z 、2z 垂直于纸面向外。从),,(000z y x 到),,(111z y x 的齐次旋转变换矩阵为： ?? ??? ???????-=100 010000cos sin 00sin cos 1 11101 θθ θθT （2）
从),,(111z y x 到),,(222z y x 的齐次旋转变换矩阵为： ?? ??? ???????-=100 010000cos sin 0sin cos 2 212212θθ θθl T （3） 从222(,,)x y z 到333(,,)x y z 的齐次旋转变换矩阵为： 33212cos sin 0l T θθ-????=从(003T =003P =结论：（6）与用简单的平面几何关系建立运动学方程（1）相同。 补充：正解用于仿真，逆解用于控制 建立以上运动学方程后，若已知个连杆的关节角123θθθ、、，就可以用运动学方程求出机械手臂末端位置坐标，这可以用于运动学仿真。 3、平面二连杆机器人手臂逆运动学 二、平面二连杆机器人手臂的速度雅可比矩阵 速度雅可比矩阵的定义：从关节速度向末端操作速度的线性变换。现已二连杆平面机器人为例推导速度雅可比矩阵。 上面的运动学方程两边对时间求导，得到下面的速度表达式：
焊接机器人的运动控制系统 作为焊接机器人的用户，为正确选择、合理使用并做到能常规维护焊接机器人，必须对焊接机器人的运动控制系统有一定层次的了解。 焊接机器人是装上了焊钳或各种焊枪的工业机器人。工业机器人的运动控制系统涉及数学、自动控制理论等，内容很多。要在较短的篇幅中，全面而系统地介绍工业机器人的运动控制系统，实在是非工业机器人控制专业人员所能及的事情，因此，本章内容是从焊接机器人的用户角度出发，尽量以图代解、简明地阐述有关机器人运动控制系统的一般性问题。 焊接机器人运动轴的定义 点焊与弧焊两种机器人都是由典型6关节型（也称6轴）工业机器人装上焊钳或焊枪而构成，因此，讨论焊接机器人运动系统构成，亦即讨论典型6关节工业机器人的运动系统构成。顾名思义，典型6关节工业机器人有6个可活动的关节，每个关节的运动名称都有定义，在图2中，给出了典型6关节工业机器人各关节的编号与动作状态（编号后面的英文大写字母就是规定动作英文名称的第一个字母），每个关节的运动都由一个伺服电（动）机驱动，每个电机都有各自的伺服控制系统。机器人最后“手”关节上所安装的工具中心点（TCP）（对点焊钳与电焊枪的TCP点，在相应的机器人结构中都作了规定）的运动轨迹是多个关节伺服系统协同动作的结果。而机器人运动控制系统（器）的作用就是如何根据编程指令来指挥控制6个伺服电（动）机协同动作，以完成工具中心点所要求实现的运动轨迹。 焊接机器人的运动轴参数 焊接机器人的运动轴参数主要包括：各轴最大运动范围、最大速度、相关轴的容许转距、相关轴的容许惯性力矩等 焊接机器人运动控制系统的组成 对机器人运动控制系统的一般要求 机器人控制系统是机器人的重要组成部分，主要用于对机器人运动的控制，以完成特定的工作任务，其基本功能如下： 记忆功能：存储作业顺序、运动路径、运动方式、运动速度和与生产工艺有
电子科技大学 实验报告 学生姓名： 一、实验室名称：机电一体化实验室 二、实验项目名称：实验三SCARA 学号： 机器人的运动学分析 三、实验原理： 机器人正运动学所研究的内容是：给定机器人各关节的角度，计算机器人末端执行器相对于参考坐标系的位置和姿态问题。 各连杆变换矩阵相乘，可得到机器人末端执行器的位姿方程（正运动学方程） 为： n x o x a x p x 0T40T1 11T2 22T3 d3 n y o y a y p y （ 1-5）3T4 4= o z a z p z n z 0001 式 1-5 表示了 SCARA 手臂变换矩阵0 T4，它描述了末端连杆坐标系{4} 相对基坐标系 {0} 的位姿，是机械手运动分析和综合的基础。 式中： n x c1c2c4s1 s2 c4 c1 s2s4s1 c2 s4，n y s1c2 c4c1 s2 c4s1 s2 s4c1c2 s4 n z0 ， o x c1c2 s4s1 s2 s4 c1 s2 c4s1c2c4 o y s1c2 s4c1 s2 s4s1 s2 c4c1c2c4 o z0 ， a x0 ， a y0 ， a z1 p x c1 c2 l2s1s2l 2c1l 1， p y s1c2 l 2 c1 s2 l 2 s1l1， p z d3 机器人逆运动学研究的内容是：已知机器人末端的位置和姿态，求机器人对应于这个位置和姿态的全部关节角，以驱动关节上的电机，从而使手部的位姿符合要求。与机器人正运动学分析不同，逆问题的解是复杂的，而且具有多解性。
1）求关节 1： 1 A arctg 1 A 2 l 12 l 22 p x 2 p y 2 arctg p x 式中：A p x 2 ； p y 2l 1 p y 2 2）求关节 2： 2 r cos( 1 ) arctg ) l 1 r sin( 1 式中 ： r p x 2 p y 2 ；arctg p x p y 3). 求 关节变 量 d 3 令左右矩阵中的第三行第四个元素（3.4）相等，可得： d 3 p z 4). 求 关节变 量 θ 4 令左右矩阵中的第二行第一个元素（1.1,2.1 ）相等，即： sin 1 n x cos 1n y sin 2 cos 4 cos 2 sin 4 由上式可求得： 4 arctg ( sin 1 n x cos 1 n y )2 cos 1 n x sin 1 n y 四、实验目的： 1. 理解 SCARA 机器人运动学的 D-H 坐标系的建立方法； 2. 掌握 SCARA 机器人的运动学方程的建立； 3. 会运用方程求解运动学的正解和反解； （ 1-8） （ 1-9） （ 1-10 ）
本 科 毕 业 论 文（设 计） 题目（中文 学学 完 成 日 期 2017 年 3 月
摘要 当今世界，工业化日趋成熟，机器人被广泛的应用于各行各业，最常用到的有四自由度，六自由度机器人。其中，自动化水平较高的汽车制造业和电子装配业经常常常要使用到六自由度机器人。因此对其实施运动学分析，是进行科学设计的基础，也是降低机器人生产成本，优化机器人运动轨迹的前提。此外，运动分析过程有效的模拟了机器人运动的真实情况，有助于提供有效可行的优化方案。本文主要探讨六自由度机器人的运动分析，基于经典运动学以及动力学的研究方法概念，首先通过solidworks做出机械臂各部分零件的三维图，然后通过SolidWorks装配出六自由度机器人机械臂的三维模型。通过该模型，选取其中一个关节和底座，并用SolidWorks进行运动学分析，对六自由度机器人的运动学和动力学计算方法进行了仿真验证。最后得到六自由度机器人的其中一个自由度的运动仿真实例。通过对该运动仿真实例的分析，得出最佳优化方案，优化机器人的运动轨迹提高机器人的工作效率，降低机器人生产成本。 关键词：六自由度机器人；运动分析；运动学；动力学；
目录 摘要 ...................................................................................................................... I Abstract ............................................................................... 错误！未定义书签。 1 绪论 (1) 1.1课题背景及研究的目的和意义 (1) 1.2机器人国内外发展现状及前景展望--------------------------1 2 六自由度机器人运动学分析 (3) 2.1六自由度机器人的结构-------------------------------------1 2.2运动学分析----------------------------------------------1 3 六自由度机器人动力学分析 (5) 3.1综述----------------------------------------------------3 3.2机器人动力学研究方法------------------------------------3 3.2.1几项假设-------------------------------------------3 3.2.2目标-----------------------------------------------4 3.2.3数学工具-------------------------------------------5 3.3动力学原理----------------------------------------------3 3.3.1动量矩定理---------------------------------------------------------------6 3.3.2能量守恒定理--------------------------------------6 3.3.3牛顿—欧拉方程------------------------------------7 3.3.4达朗贝尔原理--------------------------------------8 3.3.5拉格朗日方程--------------------------------------9 4 六自由度机器人运动分析 (8) 4.1运动分析的软件背景---------------------------------------3 4.2运用solidworks建立六度机器人机械臂三维模型--------------9 4.3运用Solidworks对进行运动学分析-------------------------4 5 结论 (14)
平面二自由度机械臂动力学分析 [摘要] 机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。本文采用拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过研究得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。 [关键字] 平面二自由度 一、介绍 机器人是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，简化解的过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。 机器人动力学问题有两类： (1) 给出已知的轨迹点上的，即机器人关节位置、速度和加速度，求相应的关节力矩向量Q r。这对实现机器人动态控制是相当有用的。 (2) 已知关节驱动力矩，求机器人系统相应的各瞬时的运动。也就是说，给出关节力矩向量τ，求机器人所产生的运动。这对模拟机器人的运动是非常有用的。 二、二自由度机器臂动力学方程的推导过程 机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下： (1) 选取坐标系，选定完全而且独立的广义关节变量θr ，r=1, 2,…, n。 (2) 选定相应关节上的广义力F r：当θr是位移变量时，F r为力；当θr是角度变量时， F r为力矩。 (3) 求出机器人各构件的动能和势能，构造拉格朗日函数。 (4) 代入拉格朗日方程求得机器人系统的动力学方程。 下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。
作者简介：王求（１９７８－），男，在读硕士研究生；研究方向为焊接机器人运动学，材料焊接及其数值模拟。 合肥工业大学材料科学与工程学院 王求 胡小建 李雷阵 摘 要：关键词：针对在狭小空间或密闭容器内以及危险作业环境中焊接的特殊要求，以ＵＧ软件为基础设计了一种仿人焊接 机械手。采用Ｄ－Ｈ方法建立了焊接机械手的运动学方程，并讨论了该机械手的运动学问题。然后运用ＭＡＴＬＡＢ软件对机械手的运动学进行了仿真，通过仿真观察到机械手各个关节的运动，并得到所需的数据，说明了所设计参数的合理性和运动算法的正确性，为焊接机械手的动力学、控制及轨迹规划的研究提供了可靠的依据。焊接机械手；运动学；仿真；Ｍａｔｌａｂ 基于ＭＡＴＬＡＢ的仿人焊接机械手运动学分析和仿真 机器人技术作为信息技术和先进制造技术的典型代表和主要技术手段，已成为世界各发达国家竞相发展的高技术，其发展水平已经成为衡量一个国家技术发展水平的重要标志之一。焊接是制造业中最重要的工艺技术之一，它在机械制造、核工业、航空航天、能源交通、石油化工及建筑和电子等行业中的应用越来越广泛。从２１世纪先进制造技术的发展要求来看，焊接自动化生产已是必然趋势，而焊接机器人是焊接自动化的革命性进步 。但是现阶段的焊接机器人都是具 有固定底座的机械手（臂），只能在固定位置完成一定范围内的操作，适应性较低。进行复杂苛刻条件（如小直径的容器内径中焊接）和危险环境（如有辐射等作业环境）中焊接作业时，要求可以代替人类从事焊接作业的机器人，而焊接机械手是实现焊接机器人的关键技术，因此设计出一种小型焊接机械手，可以作为仿人焊接机器人的执行末端，也可以直接作为 ［１］ ［２］ 焊接的执行末端，能代替焊工实现在狭小空间或者密闭容器内以及危险作业环境中的焊接。本文根据预定要求对焊接机械手进行机械结构设计，以ＵＧ软件进行造型，然后运用Ｄ－Ｈ坐标系理论为基础建模，讨论了机械手的运动学问题，并运用Ｍａｔｌａｂ中的Ｒｏ－ｂｏｔｉｃｓＴｏｏｌｂｏｘ完成了机械手的运动学仿真和轨迹规划。 机械手主要用于点焊或弧焊，其 末端载荷要求不高，能够承受焊枪质量即可，以抓持力１ｋｇ为依据进行设计。考虑机械手的工作条件，机械手本体质量小于１０ｋｇ。机械手本体由基座、肩部、大臂、小臂、手腕、末端执行器所组成，共６个自由度，其中前３个自由度用于控制焊枪端部的空间位置，后３个自由度用于控制焊枪的空间姿态。机械手共６个关节，６个关节全部为转动关节，每个关节实现１个自由度，６个关节实现的运动分别是：１－肩部回转；２－大臂俯仰；３－小臂俯仰；４－小臂回转；５－手腕俯仰；６－手腕 ［３］ ［４］ １焊接机械手结构设计 回转，如图１所示。根据机械手的设计要求，对机械手进行整体设计，使用ＵＧ软件进行机械手的三维建模，三维造型如图２所示。 机械手的运动学主要研究机械手 相对于固定参考系的运动，特别是研究机械手末端执行器位置和姿态与关节空间变量的关系。机械手运动学要 ２运动学分析 ［５］Analysis and simulation of kinesiology of simulated welding mechanical hand based on MATLAB
第六章 机器人运动学及动力学 6.1 引论 到现在为止我们对操作机的研究集中在仅考虑动力学上。我们研究了静力位置、静力和速度，但我们从未考虑过产生运动所需的力。本章中我们考虑操作机的运动方程式——由于促动器所施加的扭矩或作用在机械手上的外力所产生的操作机的运动之情况。 机构动力学是一个已经写出很多专著的领域。的确，人们可以花费以年计的时间来研究这个领域。显然，我们不可能包括它所应有的完整的内容。但是，某种动力学问题的方程式似乎特别适合于操作机的应用。特别是，那种能利用操作机的串联链性质的方法是我们研究的天然候选者。 有两个与操作机动力学有关的问题我们打算去解决。向前的动力学问题是计算在施加一 组关节扭矩时机构将怎样运动。也就是，已知扭矩矢量τ，计算产生的操作机的运动Θ、Θ 和Θ 。这个对操作机仿真有用，在逆运动学问题中，我们已知轨迹点Θ、Θ 和Θ ，我们欲求出所需要的关节扭矩矢量τ。这种形式的动力学对操作机的控制问题有用。 6.2 刚体的加速度 现在我们把对刚体运动的分析推广到加速度的情况。在任一瞬时，线速度矢量和角速度矢量的导数分别称为线加速度和角加速度。即 B B Q Q B B Q Q 0V ()V ()d V V lim dt t t t t t ?→+?-==? （6-1） 和 A A Q Q A A Q Q 0()()d lim dt t t t t t ?→Ω+?-ΩΩ=Ω=? （6-2） 正如速度的情况一样，当求导的参坐标架被理解为某个宇宙标架{}U 时我们将用下面的记号 U A AORG V V = （6-3） 和 U A A ω=Ω （6-4）
6.2.1 线加速度 我们从描述当原点重合时从坐标架{}A 看到的矢量B Q 的速度 A A B A A Q B Q B B V V B R R Q =+Ω? （6-5） 这个方程的左手边描述A Q 如何随时间而变化。所以，因为原点是重合的，我们可以重写（6-5）为 A A B A A B B Q B B d ()V dt B B R Q R R Q =+Ω? （6-6） 这种形式的方程式当推导对应的加速度方程时特别有用。 通过对（6-5）求导，我们可以推出当{}A 与{}B 的原点重合时从{}A 中看到的B Q 的 加速度表达式 A A B A A A A Q B Q B B B B d d V (V )()dt dt B B R R Q R Q =+Ω?+Ω? （6-7） 现在用（6-6）两次── 一次对第一项，一次对最后一项。（6-7）式的右侧成为： A B A A A A B Q B B Q B B A A A A B B Q B B V () +Ω?+Ω?+Ω?+Ω? B B B B R R V R Q R V R Q （6-8） 把相同两项合起来 A B A A A A B Q B B Q B B A A A B B B V 2 () +Ω?+Ω?+Ω?Ω? B B B R R V R Q R Q （6-9） 最后，为了推广到原点不重合的情况，我们加上一项给出{}B 的原点的线加速度的项，得到下面的最后的一般公式 A B A A A A BORG B Q B B Q B B A A A B B B V 2 () ++Ω?+Ω?+Ω?Ω? A B B B V R R V R Q R Q （6-10） 对于我们将在本章上考虑的情况，我们总是有B Q 为不变，或 B Q Q V 0== B V （6-11） 所以，（6-10）简化为 A A A A A A Q BORG B B B B B V ()=+Ω?Ω?+Ω? A B B V R Q R Q （6-12） 我们将用这一结果来计算操作机杆件的线加速度。 6.2.2 角加速度 考虑{}B 以A B Ω相对于{}A 转动的情况，而{}C 以B C Ω相对于{}B 转动。为了计算 A C Ω我们把矢量在坐标架{}A 中相加
六轴联动机械臂运动学及动力学求解分析 V0.9版 随着版本的不断更新，旧版本文档中的一些笔误得到了修正，同时文档内容更丰富，仿真程序更完善。 作者朱森光 Email zsgsoft@https://www.doczj.com/doc/2818240062.html, 完成时间 2016-02-28
1引言 笔者研究六轴联动机械臂源于当前的机器人产业热，平时比较关注当前热门产业的发展方向。笔者从事的工作是软件开发，工作内容跟机器人无关，但不妨碍研究机器人运动学及动力学，因为机器人运动学及动力学用到的纯粹是数学和计算机编程知识，学过线性代数和计算机编程技术的人都能研究它。利用业余时间翻阅了机器人运动学相关资料后撰写此文，希望能够起到抛砖引玉的作用引发更多的人发表有关机器人技术的原创性技术文章。本文内容的正确性经过笔者编程仿真验证可以信赖。 2机器建模 既然要研究机器人，那么首先要建立一个机械模型，本文将以典型的六轴联动机器臂为例进行介绍，图2-1为笔者使用3D技术建立的一个简单模型。首先建立一个大地坐标系，一般教科书上都是以大地为XY平面，垂直于大地向上方向为Z轴，本文为了跟教科书上有所区别同时不失一般性，将以水平向右方向为X轴，垂直于大地向上方向为Y轴，背离机器人面向人眼的方向为Z轴，移到电脑屏幕上那就是屏幕水平向右方向为X轴，屏幕竖直向上方向为Y轴，垂直于屏幕向外为Z轴，之所以建立这样不合常规的坐标系是希望能够突破常规的思维定势训练在任意空间建立任意坐标系的能力。 图2-1 图2-1中的机械臂，底部灰色立方体示意机械臂底座，定义为关节1，它能绕图中Y轴旋转；青色长方体示意关节2，它能绕图中的Z1轴旋转；蓝色长方体示意关节3，它能绕图中的Z2轴旋转；绿色长方体示意关节4，它能绕图中的X3轴旋转；深灰色长方体示意关节5，它能绕图中的Z4轴旋转；末端浅灰色机构示意关节6即最终要控制的机械手，机器人代替人的工作就是通过这只手完成的，它能绕图中的X5轴旋转。这儿采用关节这个词可能有点不够精确，先这么意会着理解吧。 3运动学分析 3.1齐次变换矩阵 齐次变换矩阵是机器人技术里最重要的数学分析工具之一，关于齐次变换矩阵的原理很多教科书中已经描述在此不再详述，这里仅针对图2-1的机械臂写出齐次变换矩阵的生成过程。首先定义一些变量符号，关节1绕图中Y轴旋转的角度定义为θ0，当θ0=0时，O1点在OXYZ坐标系内的坐标是(x0,y0,0)；关节2绕图中的Z1轴旋转的角度定义为θ1，图中的θ1当前位置值为+90度；定义O1O2两点距离为x1,关节3绕图中的Z2轴旋转的角度定义为θ2，图中的θ2当前位置值为-90度；O2O3两点距离为x2，关节4绕图中的X3轴旋转的角度定义为θ3, 图中的θ3当前位置值为0度；O3O4两点距离为x3，关节5绕图中的Z4轴旋转的角度定义为θ4, 图中的θ4当前位置值为-60度；O4O5两点距离为x4，关节6绕图中的X5轴旋转的角度定义为θ5, 图中的θ5当前位置值为0度。以上定义中角度正负值定义符合右手法则,所有角度定义值均为本关节坐标系相对前一关节坐标系的相对旋转角度值（一些资料上将O4O5两点重合在一起即O4O5两点的距离x4退化为零，本文定义x4大于零使得讨论时更加不失一般性）。符号定义好了，接下来描述齐次变换矩阵。 定义R0为关节1绕Y轴的旋转矩阵 =cosθ0 s0 = sinθ0 //c0 R0 =[c0 0 s0 0 0 1 0 0 0 c0 0 -s0 0 0 0 1] 定义T0为坐标系O1X1Y1Z1相对坐标系OXYZ的平移矩阵 T0=[1 0 0 x0 0 1 0 y0 00 1 0 0 0 0 1] 定义R1为关节2绕Z1轴的旋转矩阵 R1=[c1 –s1 0 0 s1 c1 0 0
机器人运动学知识介绍 收藏 21:53|发布者: dynamics|查看数: 1125|评论数: 2| 来自: 东方早报 摘要: 现在你可能正拿着一本书，边看边翻页，并时不时回头，越过肩膀察看后面是否有红眼的恶意机器人。随着书页的翻动，你也许会在无意识里考虑这个问题。作为人类，在物理世界移动是如此自然，只需要一丁点的意识即可。而 ... 丹尼尔·威尔逊 现在你可能正拿着一本书，边看边翻页，并时不时回头，越过肩膀察看后面是否有红眼的恶意机器人。随着书页的翻动，你也许会在无意识里考虑这个问题。作为人类，在物理世界移动是如此自然，只需要一丁点的意识即可。而另一方面，机器人———就像最后一个选择踢球的孩子———为了避免伤到自己和别人，每一个动作都必须经过仔细考虑。机器 人专家管这个过程叫做“操作研究”。 前进和逆转 如果你醒来发现自己处在一具新的躯体中，拥有金属手臂，每只手只有三根手指，你会怎么样呢？如果不知道手臂的长度，拿东西会很困难；如果只有三根手指，那么你必须找到一个全新的抓取和握东西的方法；由于弯曲的金属手臂，你可能再也没有约会的机会。这些就是身处各地的孤独的机器人们所面临的重大问题。 运动学研究旨在解决机器人的手臂转向何方(动力学则为了解决移动的速度和劲道)。机器人运动学可分两类：前进和逆转。前进运动学的问题是机器人运用它对自身的了解(关节角度和手臂长度)来判断自己在三维空间中到底身处何方。这算是简单的部分，逆转运动学正好相反，它解决机器人如何移动才能达到合适的姿势(改变关节位置)这一问题。机器人在握你手之前，需要知道你手的大概方位，以及从这里移向那里的最优顺序。有时候，可能没有最好的解决方案(试试用你的右手碰你的右肘)。 对逆转运动学来说，大多数方案运用传感器(通常是视觉和力)来估计机器人身体的当前位置。只要有了这个，机器人就能够计划下一步行动(握手、问好或绞断你的脖子)。机器人的反应很敏捷，日本ATR实验室的类人机器人能够更新视觉，估计世界形势，并且在一秒钟里能够做60个动作。这些类人机器人已经能够跳舞，耍弄彩球，玩篮球和曲棍球。 扫描环境和选择动作的过程叫做反馈环路。新的信息被经常性地用于更新当前的决定。如果缺乏经常性更新，机器人的操作技能会变得糟糕。传感器的损伤(或非常不可信赖的传感器)会干扰这一重要的环路。比如以视觉为基础的跟踪遇到混乱的场景会大受干扰，或者浪费资源去跟踪一些无意义的目标(比如落叶等)。震动可以扰乱力传感器，即使它们位于机器人手臂的内部。虽然机器人能够反应得更快更精确，但它们总是依赖于不断更新的信息和持续改进的计划。