工业机器人技术基础第2章-工业机器人的数学基础课件

目录第一章工业机器人概论第二章工业机器人的数学基础第三章工业机器人的机械系统第四章工业机器人的动力系统第五章工业机器人的感知系统第六章工业机器人的控制系统第七章工业机器人编程与调试工业机器人技术基础工业机器人技术基础主要内容2.1矩阵及运算2.2坐标系及其关系描述2.3坐标变换2.4机器人运动学2.5机器人动力学工业机器人技术基础第2章工业机器人的数学基础主要内容工业机器人技术基础第2章工业机器人的数学基础第二章工业机器人的数学基础工业机器人技术基础2.1矩阵及运算1.矩阵的定义定义1由mn个数aij（i=1，2，，m；j=1,2，，n），排成m行n列的数表：称为m行n列矩阵，简称为mn矩阵。这mn个数称为矩阵A的元素，aij叫做矩阵A的第i行第j列元素。元素是实数的矩阵叫做实矩阵，元素是复数的矩阵叫做复矩阵。本教程中的矩阵除特别说明外，都指实矩阵。通常用大写的拉丁字母A、B、C等表示矩阵。有时为了指明矩阵的第i行第j列元素为aij，可将A记作A=(aij)mn或A=(aij)，也可将mn矩阵A记为Amn。当A的行数与列数相等时，称A为n阶方阵或n阶矩阵。显然，一阶矩阵就是一个数。第二章工业机器人的数学基础工业机器人技术基础2.1第二章工业机器人的数学基础工业机器人技术基础2.1矩阵及运算只有一行的矩阵A=（a1，a2，，an）叫做行矩阵；只有一列的矩阵叫做列矩阵。两个矩阵的行数相等、列数也相等时，就称它们为同型矩阵。如果A=(aij)与B=(bij)是同型矩阵，并且它们的对应元素相等，即

aij=bij

（i=1，2，，m；j=1，2，，n），那末就称矩阵A与矩阵B相等，记作A=B。元素都是零的矩阵，记作0。注意不同型的零矩阵是不同的。II几种特殊矩阵a)对角矩阵(diagonalmatrix)，如下的矩阵称为对角矩阵，记为diag（a11

,a22,a33……

ann）第二章工业机器人的数学基础工业机器人技术基础2.1矩第二章工业机器人的数学基础工业机器人技术基础b)数量矩阵(scalarmatrix)c)三角矩阵(triangularmatrix)上三角矩阵(uppertriangularmatrix)第二章工业机器人的数学基础工业机器人技术基础b)数量矩第二章工业机器人的数学基础工业机器人技术基础d)

对称阵(symmetricmatrix）和反对称阵(anti-symmetricmatrix)如果n阶矩阵A=（aij）的元素满足aij=aji（i，j=1，2，，n），则称A为n阶对称矩阵，如如果n阶矩阵A=（aij）的元素满足aij=aji（i，j=1，2，，n），则称A为n阶反对称矩阵。显然，故aii=0（i=1，2，，n）如：第二章工业机器人的数学基础工业机器人技术基础d)

第二章工业机器人的数学基础工业机器人技术基础

▲矩阵的加法设有两个mn的矩阵A=（aij），B＝（bij），则矩阵A和B的和记作A+B。即：III矩阵的运算易证，矩阵加法满足下列运算规律（设A、B、C都是mn矩阵）：a)A+B=B+A；b)（A+B）+C=A+（B+C）。设矩阵A=（aij），记A=（aij），A称为A的负矩阵，显然有A+（A）=0。由此定义矩阵的减法运算为

AB=A+(-B)第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础

▲矩阵相等条件：①矩阵要同阶②对应元素相等满足上述条件，矩阵就相等。如下述矩阵：III矩阵的运算第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础▲数与矩阵相乘数与矩阵A的乘积记作A或A，规定为易证，数乘矩阵满足下列运算规律（设A、B为mn矩阵，、为数）：(i).

（）A=（A）；(ii).

（+）A=A+A；(iii).

（A+B）=A+B。第二章工业机器人的数学基础工业机器人技术基础▲数与矩阵相第二章工业机器人的数学基础工业机器人技术基础▲矩阵与矩阵相乘设矩阵A=(aij)ms，B=(bij)sn，则矩阵A和矩阵B的乘积矩阵C=（cij）mn，其中

Cij=ai1b1j+ai2b2j++aisbsj

（i=1，2，，m；j=1，2，，n）记作C=AB。对于矩阵的乘法需注意以下三点：第一，只有矩阵A的列数等于B的行数时，AB才有意义。第二，乘积C=（cij）mn的第i行第j列的元素等于矩阵A的第i行的每一个元素与矩阵B的第j列的对应元素的乘积之和。第三，乘积C的行数等于矩阵A的行数，列数等于矩阵B的列数。第二章工业机器人的数学基础工业机器人技术基础▲矩阵与矩阵第二章工业机器人的数学基础工业机器人技术基础例1求AB和BA。其中解：第二章工业机器人的数学基础工业机器人技术基础例1求第二章工业机器人的数学基础工业机器人技术基础例2求AB和BA。其中解：第二章工业机器人的数学基础工业机器人技术基础例2求第二章工业机器人的数学基础工业机器人技术基础

在上述两个例子中都有ABBA，即矩阵乘法不满足乘法交换律，为此将AB称为用A左乘B，而将BA称为A右乘以B。还应注意到在例5中：A，B均为非零矩阵，但AB却为零矩阵。由定义可以验证矩阵的乘法满足以下运算规律：（假设运算都是可行的）(i).

结合律：（AB）C=A（BC）；(ii).

左分配律：A（B+C）=AB+AC；(iii).

右分配律：（B+C）A=BA+CA；(iv).

（AB）=（A）B=A（B）。（为常数）对于单位矩阵E,容易验证EmAmn=Amn

，AmnEn=Amn。有了矩阵的乘法，就可以定义n阶方阵的幂。设A是n阶方阵，定义A1=A，A2=A1A1，，Ak+1=AkA1

，其中k为正整数。这就是说，Ak就是k个A相乘。显然，只有方阵的幂才有意义。由于矩阵乘法适合结合律，所以方阵的幂满足以下运算规律：

AA=A+

，(A)=A

不过，一般(AB)kAkBk。第二章工业机器人的数学基础工业机器人技术基础在上述第二章工业机器人的数学基础工业机器人技术基础

▲矩阵的转置把矩阵A=(aij)m×n的行换成同序数的列所得到的新矩阵，叫做A的转置矩阵(transpose)，记作A

或AT。显然，A=(aji)n×m矩阵的转置也是一种运算，易证它满足下述运算规律（假设运算都是可行的）：

(i)

(A)=A；

(ii)

(A+B)=A+B

；

(iii)(A)=A

；

(iv)(AB)=BA

。第二章工业机器人的数学基础工业机器人技术基础▲矩阵的转第二章工业机器人的数学基础工业机器人技术基础

▲方阵的行列式

由n阶方阵A的元素按原来位置不变所构成的行列式（各元素的位置不变），叫做方阵A的行列式，记作|A|或detA。设A为n阶方阵，如果|A|≠0，则称

为非奇异矩阵；如果|A|=0，则称

为奇异矩阵。

由方阵A确定行列式|A|的运算满足下述运算规律（设A，B为n阶方阵，为数）：

(i).

|A|=|A|（行列式性质1）；

(ii).

|A|=n|A|；

(iii).|AB|=|A||B|。

▲其它方阵设

A为n阶方阵，由|A|的各元素的代数余子式所构成的方阵称为方阵

的伴随阵

A*，有以下性质：AA*=A*A=|A|E如果存在一个矩阵A-1

，使得AA-1=A-1A=

E,则矩阵

A-1称为A

的可逆矩阵或逆阵。当方阵|A|≠0，有第二章工业机器人的数学基础工业机器人技术基础▲方阵的行第二章工业机器人的数学基础工业机器人技术基础

▲矩阵求导

矩阵的元素如果为时间t

的函数，记为

Aij(t)，该矩阵记为

A(t)。它对时间的导数为一同阶矩阵，其各元素为原矩阵的元素

对时间的导数，即根据此定义与微分的基本性质，可得如下关系式：上式中：

a为时间函数的标量；

A与B

均为时间函数的矩阵，它们满足矩阵运算的条件。第二章工业机器人的数学基础工业机器人技术基础▲矩阵求导第二章工业机器人的数学基础工业机器人技术基础2.2坐标系及其关系描述▲坐标系插曲：有一天，笛卡尔(1596-1650，法国哲学家、数学家、物理学家)生病卧床，但他头脑一直没有休息，在反复思考一个问题:几何图形是直观的，而代数方程则比较抽象，能不能用几何图形来表示方程呢?这里，关键是如何把组成几何的图形的点和满足方程的每一组"数"挂上钩。他就拼命琢磨。通过什么样的办法、才能把"点"和"数"联系起来。突然，他看见屋顶角上的一只蜘蛛，拉着丝垂了下来，一会儿，蜘蛛又顺着丝爬上去，在上边左右拉丝。蜘蛛的"表演"，使笛卡尔思路豁然开朗。他想，可以把蜘蛛看做一个点，它在屋子里可以上、下、左、右运动，能不能把蜘蛛的每个位置用一组数确定下来呢?他又想，屋子里相邻的两面墙与地面交出了三条线，如果把地面上的墙角作为起点，把交出来的三条线作为三根数轴，那么空间中任意一点的位置，不是都可以用这三根数轴上找到的有顺序的三个数来表示吗?反过来，任意给一组三个有顺序的数，例如3.2.1，也可以用空间中的一个点P来表示它们(如图1)。同样，用一组数(a，b)可以表示平面上的一个点，平面上的一个点也可以用一组二个有顺序的数来表示(如图2)。于是在蜘蛛的启示下，笛卡尔创建了直角坐标系。第二章工业机器人的数学基础工业机器人技术基础2.2坐标第二章工业机器人的数学基础工业机器人技术基础■直角坐标系

在平面上建立直角坐标系以后，可用点到两条互相垂直的坐标轴的距离来确定点的位置，即平面内的点P与二位有序数组（a，b）一一对应。在空间建立三维直角坐标系后，可用点到三个互相垂直的坐标平面的距离来确定点的位置，即空间的点P与三维有序数组（a，b，c）一一对应。建立坐标系，如左图所示，取三条相互垂直的具有一定方向和度量单位的直线，叫做三维直角坐标系

或空间直角坐标系o-xyz。利用三维直角坐标系可以把空间的点P与三维有序数组（a，b，c）建立起一一对应的关系。右图所示就是典型的直角坐标系型机器人。第二章工业机器人的数学基础工业机器人技术基础■直角坐标系第二章工业机器人的数学基础工业机器人技术基础■圆柱坐标系如左图所示设M(r,ψ,z)为空间内一点，并设点M在xoy面上的投影P的极坐标为r,θ，则这样的三个数r,θ,z就叫点M的圆柱坐标，其典型圆柱坐标系型机器人见右图。第二章工业机器人的数学基础工业机器人技术基础■圆柱坐标系第二章工业机器人的数学基础工业机器人技术基础■球坐标系如左图所示假设P（x，y，z）为空间内一点，则点P也可用这样三个有次序的数(r，θ，φ)来确定，其中r为原点O与点P间的距离；θ为有向线段OP与z轴正向的夹角；φ为从正z轴来看自x轴按逆时针方向转到OM所转过的角，这里M为点P在xOy面上的投影。这样的三个数r，θ，φ叫做点P的球面坐标，其典型球坐标系型机器人见右图第二章工业机器人的数学基础工业机器人技术基础■球坐标系第二章工业机器人的数学基础工业机器人技术基础■机器人常用坐标系

在机器人学科里经常用参考坐标系和关节坐标系来描述空间机器人的位姿。▲参考坐标系

通常采用三维空间中的固定坐标系o-xyz来描述▲关节坐标系

关节坐标系用来描述机器人每一个独立关节的运动。XYZO参考坐标系关节坐标系XYOX’Y’O’第二章工业机器人的数学基础工业机器人技术基础■机器人常用第二章工业机器人的数学基础工业机器人技术基础■向量向量：既有大小又有方向的量.向量表示：模长为1的向量.零向量：模长为0的向量.||向量的模：向量的大小.单位向量：或或或第二章工业机器人的数学基础工业机器人技术基础■向量向量：第二章工业机器人的数学基础工业机器人技术基础自由向量：不考虑起点位置的向量.相等向量：大小相等且方向相同的向量.负向量：大小相等但方向相反的向量.向径：空间直角坐标系中任一点

与原点构成的向量.第二章工业机器人的数学基础工业机器人技术基础自由向量：不第二章工业机器人的数学基础工业机器人技术基础[1]加法：（平行四边形法则）特殊地：若‖分为同向和反向（平行四边形法则有时也称为三角形法则）二、向量的加减法第二章工业机器人的数学基础工业机器人技术基础[1]加法第二章工业机器人的数学基础工业机器人技术基础向量的加法符合下列运算规律：（1）交换律：（2）结合律：（3）[2]减法第二章工业机器人的数学基础工业机器人技术基础向量的加法符第二章工业机器人的数学基础工业机器人技术基础三、向量与数的乘法第二章工业机器人的数学基础工业机器人技术基础三、向量与数第二章工业机器人的数学基础工业机器人技术基础数与向量的乘积符合下列运算规律：（1）结合律：（2）分配律：两个向量的平行关系第二章工业机器人的数学基础工业机器人技术基础数与向量的乘第二章工业机器人的数学基础工业机器人技术基础例1

化简解第二章工业机器人的数学基础工业机器人技术基础例1第二章工业机器人的数学基础工业机器人技术基础四、向量在坐标轴上的分向量与向量的坐标这六个平面与x,y,z轴分别相交于第二章工业机器人的数学基础工业机器人技术基础四、向量在坐第二章工业机器人的数学基础工业机器人技术基础zxoy第二章工业机器人的数学基础工业机器人技术基础zxoy第二章工业机器人的数学基础工业机器人技术基础称有向线段的值为向量在x轴上的投影有向线段的值为向量在

y轴上的投影有向线段的值为向量在

z轴上的投影依次记作即xoy第二章工业机器人的数学基础工业机器人技术基础称有向线段的第二章工业机器人的数学基础工业机器人技术基础由图上可以看出而——称为基本单位向量xoy第二章工业机器人的数学基础工业机器人技术基础由图上可以看第二章工业机器人的数学基础工业机器人技术基础——向量在三个坐标轴上的分向量——向量的分解式向量在三个坐标轴上的投影——称为向量的坐标向量可用它的坐标表示为——向量的坐标表示式xoy第二章工业机器人的数学基础工业机器人技术基础——向量在三第二章工业机器人的数学基础工业机器人技术基础特殊地：——称为向径向量的加减法、向量与数的乘法运算的坐标表达式第二章工业机器人的数学基础工业机器人技术基础特殊地：——第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础非零向量的方向角：非零向量与三条坐标轴的正向的夹角称为方向角.五、向量的模与方向余弦的坐标表示式第二章工业机器人的数学基础工业机器人技术基础非零向量第二章工业机器人的数学基础工业机器人技术基础由图分析可知向量的方向余弦方向余弦通常用来表示向量的方向.向量模长的坐标表示式第二章工业机器人的数学基础工业机器人技术基础由图分析可知第二章工业机器人的数学基础工业机器人技术基础当时，向量方向余弦的坐标表示式第二章工业机器人的数学基础工业机器人技术基础当第二章工业机器人的数学基础工业机器人技术基础启示实例两向量作这样的运算,结果是一个数量.定义一、两向量的数量积第二章工业机器人的数学基础工业机器人技术基础启示实例两向第二章工业机器人的数学基础工业机器人技术基础结论两向量的数量积等于其中一个向量的模和另一个向量在这向量的方向上的投影的乘积.数量积也称为“点积”、“内积”.第二章工业机器人的数学基础工业机器人技术基础结论两向第二章工业机器人的数学基础工业机器人技术基础数量积符合下列运算规律：（1）交换律：（2）分配律：（3）若为数若、为数：第二章工业机器人的数学基础工业机器人技术基础数量积符合下第二章工业机器人的数学基础工业机器人技术基础两向量夹角余弦的坐标表示式第二章工业机器人的数学基础工业机器人技术基础两向量夹角余第二章工业机器人的数学基础工业机器人技术基础实例二、两向量的向量积第二章工业机器人的数学基础工业机器人技术基础实例二、两向第二章工业机器人的数学基础工业机器人技术基础定义关于向量积的说明：//向量积也称为“叉积”、“外积”.第二章工业机器人的数学基础工业机器人技术基础定义关于向量第二章工业机器人的数学基础工业机器人技术基础■坐标系之间关系描述空间中任意点

或向量在不同坐标系的描述是不同的，为了阐述从一个坐标系到另一个坐标系的描述关系，需要讨论两坐标系的位姿(位置和姿态)关系。坐标系通常由3个互相正交的轴来表示（例如x，y和z）。由于在任意给定空间内可能有多个坐标系，因此我们定义o-xyz(简称{o}系)来表示固定的全局参考坐标系；用o-xbybzb(简称{b}系)来表示运动的刚体坐标系。分两种情况来描述两坐标系之间位姿关系。分两种情况：▲共原点设{o}系和{b}系共原点，i，j和k是{o}系的三正交轴单位向量，ib，jb和kb是{b}系的三正交轴单位向量，那么这两个坐标系的位姿关系可以用下列第二章工业机器人的数学基础工业机器人技术基础■坐标系之间第二章工业机器人的数学基础工业机器人技术基础方向余弦阵具有以下基本性质：1)方向余弦阵为一正交阵.矩阵中每行和每列中元素的平方和为1；两个不同列或不同行中对应元素的乘积之和为0。2）A系相对B系的方向余弦阵与B系相对

系A的方向余弦阵互为转置；3)当且仅当两坐标系两两方向一致时，则它们的方向余弦阵为一三阶单位阵。第二章工业机器人的数学基础工业机器人技术基础方向余弦阵具第二章工业机器人的数学基础工业机器人技术基础■坐标系之间关系描述空间中任意点

或向量在不同坐标系的描述是不同的，为了阐述从一个坐标系到另一个坐标系的描述关系，需要讨论两坐标系的位姿(位置和姿态)关系。坐标系通常由3个互相正交的轴来表示（例如x，y和z）。由于在任意给定空间内可能有多个坐标系，因此我们定义o-xyz(简称{o}系)来表示固定的全局参考坐标系；用o-xbybzb(简称{b}系)来表示运动的刚体坐标系。分两种情况来描述两坐标系之间位姿关系。分两种情况：▲不共原点设{o}系和{b}系不共原点，i，j和k是{o}系的三正交轴单位向量，ib，jb和kb是{b}系的三正交轴单位向量，那么这两个坐标系的位姿关系可以用下列矩阵来表示：第二章工业机器人的数学基础工业机器人技术基础■坐标系之间第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础工业机器人技术基础例2.1如图所示，{o}系为一固定坐标系，{b}为一运动坐标系。初始状态：运动坐标系{b}的初始位姿与{o}系重合，但经过一定时间后，{b}系开始运动，最终{b}系相对于{o}系的y轴逆时针旋转了30°，试用方向余弦阵A分别表示出运动初始和运动终了两个状态时的两坐标系的位姿关系。解：1）运动初始状态 根据方向余弦阵的基本性质可知，两坐标系完全重合，其方向余弦阵A就是一个三阶单位阵2）运动终了状态 根据式（2-3），可写出方向余弦阵A第二章工业机器人的数学基础工业机器人技术基础例2.1如图所示，{o}系为一固定坐标系第二章工业机器人的数学基础工业机器人技术基础■空间刚体描述在运动过程中物体内任意两点的距离保持不变的物体称为刚体。在机器人学里，任一刚体的位置、姿态可由其上的任一基准点（通常选作物体的质心）和过该点的坐标系相对于参考坐标系的相对关系来确定。如下图所示，设有一运动椭圆刚体A，选其上的圆心点ob为基准点，长轴为yb轴，短轴为xb，椭圆面的法向为zb，置坐标系ob-xbybzb。再选一固定坐标系{o}，于是，该椭圆刚体A的空间位置和姿态可由下式所示矩阵来表示出式中：，第二章工业机器人的数学基础工业机器人技术基础■空间刚体描第二章工业机器人的数学基础工业机器人技术基础■坐标变换变换定义为在空间产生运动。当空间的坐标系（向量、物体或运动坐标系）相对于固定的参考坐标系运动时，这一运动可以用类似于表示坐标系的方式来表示。这是因为变换本身就是坐标系状态的变化（表示坐标系位姿的变化）。变换坐标可为如下几种形式的一种：1．纯平移坐标变换；2．绕一个轴的纯旋转；3．平移与旋转的组合第二章工业机器人的数学基础工业机器人技术基础■坐标变换第二章工业机器人的数学基础工业机器人技术基础设有一固定的直角坐标系o-xyz（简称{o}系）和一运动的直角坐标系ob-xbybzb（简称{b}系）具有相同的方位，但{o}系的原点与{b}系的原点不重合，用位置向量

描述{b}系相对{o}系的位置，称

为{b}系相对{o}系的平移向量，且其中

、

和

是平移向量

相对于固定坐标系{o}的xb、yb和zb轴的3个分量。■纯平移第二章工业机器人的数学基础工业机器人技术基础设有一固定的第二章工业机器人的数学基础工业机器人技术基础如果点

P在{b}系中的位置为

bP，那么它相对于{o}系的位置向量oP

可由向量相加得出，即oP=oPoob+bP上式称为：坐标平移方程

那么如何在{O}表述{b}呢？坐标余弦阵，因为两坐标系方位相同，即两坐标系关系为：第二章工业机器人的数学基础工业机器人技术基础如果点P在第二章工业机器人的数学基础工业机器人技术基础而{b}系在{o}表示应该用两个矩阵来表述，及位置矩阵和余弦矩阵，则：那矩阵可看成是如下两个矩阵的乘积：首先可以看到，新坐标系位姿可通过在原坐标系矩阵前面左乘平移变换矩阵得到。其次可以看到，方向向量经过平移后保持不变。最后可以看到，这种坐标变换便于用矩阵乘法来进行变换计算，并使得到的新矩阵的维数与变换前相同。第二章工业机器人的数学基础工业机器人技术基础而{b}系在第二章工业机器人的数学基础工业机器人技术基础例2.2初始状态：运动坐标系{b}在固定坐标系{o}的位姿为Tboold

。经过一段时间后，运动坐标系{b}沿固定坐标系{o}的y轴正向移动5个单位，沿z轴正向移动5个单位。求运动终了时运动坐标系{b}在固定坐标系{o}的位姿Tbo-new

。第二章工业机器人的数学基础工业机器人技术基础例2.2初第二章工业机器人的数学基础工业机器人技术基础如图2-13所示，旋转前固定坐标系{o}和运动坐标系{b}重合，显然P点在{o}系和{b}系中的坐标值都相等；经过一段时间后运动坐标系{b}绕z轴逆时针旋转了θ角，旋转后P点在{o}系和{b}系中的坐标值显然不等。但存在关系■绕轴转动第二章工业机器人的数学基础工业机器人技术基础如图2-13第二章工业机器人的数学基础工业机器人技术基础写成矩阵形式为：可见，旋转后为了得到点P在固定参考坐标系{o}里的坐标矩阵，必须在点P在运动坐标系{b}的坐标矩阵的左边乘上一个矩阵，该矩阵也就是绕z轴旋转的旋转矩阵

，它可表示为：第二章工业机器人的数学基础工业机器人技术基础写成矩阵形式第二章工业机器人的数学基础工业机器人技术基础同理可推出绕Y轴旋转的旋转矩阵：可推出绕X轴旋转的旋转矩阵：第二章工业机器人的数学基础工业机器人技术基础同理可推出绕第二章工业机器人的数学基础工业机器人技术基础例2.3现运动坐标系中有一点p(1,2,3)T，它随运动坐标系一起绕固定坐标系的z轴旋转90°。求旋转后该点在固定坐标系的坐标。解：第二章工业机器人的数学基础工业机器人技术基础例2.3现运第二章工业机器人的数学基础工业机器人技术基础■复合运动对于一般的情形，运动坐标系{b}与固定坐标系{o}的原点既不重合，方位也不相同。但两者的关系可通过一定的变换实现。这种变换就是复合变换，即由固定坐标系的一系列沿轴平移变换和绕轴旋转变换所组成的。任何变换都可以分解为按一定顺序的一组平移变换和旋转变换。例如，为了完成所要求的变换，可以先绕x轴旋转，再沿x、y和z轴平移，最后再绕z轴旋转。但一般情况下这种变换顺序很重要，如果颠倒两个依次变换的顺序，结果将会有所不同。为探讨如何处理复合变换，假定运动坐标系{b}相对于固定坐标系{o}依次进行了下面3个变换：1）首先绕x轴旋转α角；2）然后分别沿x、y和z轴平移dx、dy和dz；3）最后绕y轴旋转β角。简称：转-移-转第二章工业机器人的数学基础工业机器人技术基础■复合运动对第二章工业机器人的数学基础工业机器人技术基础按转-移-转运动顺序，写出运动方程：1）转2）移3）转4）运动合成（左乘原则）第二章工业机器人的数学基础工业机器人技术基础按转-移-转第二章工业机器人的数学基础工业机器人技术基础例2.4现运动坐标系中有一点p(1,2,3)T，经历了如下变换，求出变换后该点在固定坐标系的坐标。1）首先绕x轴旋转90°角；2）然后分别沿x、y和z轴平移1、0和0；3）最后绕z轴旋转90°角解：第二章工业机器人的数学基础工业机器人技术基础例2.4第二章工业机器人的数学基础工业机器人技术基础■图形解验证：第二章工业机器人的数学基础工业机器人技术基础■图形解验证第二章工业机器人的数学基础工业机器人技术基础例2.5已知条件一样，但变换顺序发生了以下变动，求出变换后该点在固定坐标系的坐标。。1）首先绕Z轴旋转90°角；2）然后分别沿x、y和z轴平移1、0和0；3）最后绕X轴旋转90°角解：第二章工业机器人的数学基础工业机器人技术基础例2.5第二章工业机器人的数学基础工业机器人技术基础■图形解验证：第二章工业机器人的数学基础工业机器人技术基础■图形解验证第二章工业机器人的数学基础工业机器人技术基础从例题（2.4）和例题（2.5）不难发现，尽管所有的变换完全相同，但由于变换的顺序变了，该点在固定坐标系中的坐标值完全不同，可见坐标变换必须严格按照变换顺序进行，也就是说矩阵的乘法一般情况下不满足交换律。■相对运动坐标系下的变换前面所有例子是相对固定坐标系而言的，那相对运动坐标系该作如何变换？一个原则：原来的左乘矩阵现在变为右乘就可以了。第二章工业机器人的数学基础工业机器人技术基础从例题（2.第二章工业机器人的数学基础工业机器人技术基础例2.6在例2-4中，已知条件一样，但变换参照发生了以下变动，求出变换后该点在固定坐标系的坐标。1）首先绕zb轴旋转90°角；2）然后分别沿xb、yb和zb轴平移1、0和0；3）最后绕xb轴旋转90°角。解：第二章工业机器人的数学基础工业机器人技术基础例2.6第二章工业机器人的数学基础工业机器人技术基础■图形解验证：第二章工业机器人的数学基础工业机器人技术基础■图形解验证第二章工业机器人的数学基础工业机器人技术基础■坐标逆变换正如2.2.1节所提及的逆矩阵在机器人坐标变换中有着十分重要的作用。根据方向余弦阵的性质可知，方向余弦阵为一正交阵，其转置矩阵和逆矩阵是相等关系。如图2-17，假设机器人要在零件P上钻孔，则机器人末端执行器必须向P处移动。一般情况下，机器人的基座是固定的，因此可用固定坐标系{o}来描述机器人基座，机器人末端执行器用运动坐标系{b}来描述，待加工零件用另一坐标系{p}来描述（一般情况下它相对固定坐标系{o}而言，其位姿也是已知的）。第二章工业机器人的数学基础工业机器人技术基础■坐标逆变换第二章工业机器人的数学基础工业机器人技术基础■坐标逆变换待加工零件p的位置可通过两条路径来获取：一条是直接通过固定坐标系{o}到待加工零件坐标系{p}，正如刚才而言，其在固定坐标系{o}内的位姿是已知的；另一条是从固定坐标系{o}变换到末端执行器即运动坐标系{b}，然后再从运动坐标系{b}变换到待加工零件坐标系{p}。因此可写出：引入逆矩阵：第二章工业机器人的数学基础工业机器人技术基础■坐标逆变换第二章工业机器人的数学基础工业机器人技术基础2.4机器人运动学机器人运动学涉及机器人相对于固定坐标系运动几何学关系的分析和研究，而与产生该运动所需的力或力矩无关。这样，运动学就涉及机器人空间位移作为时间函数的解析说明，特别是机器人末端执行器位置和姿态与关节变量之间的关系。运动学基本问题：⒈

对于一给定的机器人，已知杆件几何参数和关节角向量，求机器人末端执行器相对参考坐标系的位置和姿态。这类问题称为运动学正问题（直接问题）。2.已知机器人杆件的几何参数，给定了机器人末端执行器相对参考坐标系的期望位置和姿态，求机器人各关节角向量，即机器人各关节要如何运动才能达到这个预期的位姿？如能达到，那么机器人有几种不同形态可满足同样的条件？这类问题称为运动学逆问题（解臂形问题）。第二章工业机器人的数学基础工业机器人技术基础2.4机第二章工业机器人的数学基础工业机器人技术基础

由于机器人手臂的独立变量是关节变量，但作业通常是用固定坐标系来描述的，所以常常碰到的是第二个问题，即机器人运动学逆问题。1955年Denavit和Hartenbe曾提出了一种采用矩阵代数方法，来描述机器人手臂杆件相对固定参考坐标系的空间几何。这种方法使用4x4齐次变换矩阵来描述两个相邻的机械刚性构件间的空间几何关系，把正向运动学问题简化为寻求等价的4x4齐次变换矩阵，此矩阵把手部坐标系的空间位移与参考坐标系联系起来，并且该矩阵还可用于推导手臂运动的动力学方程。而运动学逆向问题可采用如矩阵代数、迭代或几何方法来解。

为了使问题简单易懂，以两自由度的机器人的手爪为例来说明。图2-18所示为两自由度机器人手部的连杆机构。由于其运动主要由各连杆机构来决定，所以在进行机器人运动学分析时，一般是把驱动器及减速器的元件去除后来分析。第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础从几何学的观点来处理这个手指位置与关节变量的关系成为运动学。这里引入向量分别表示末端执行器位置r和关节变量θ：末端执行器位置的各分量，按几何学可表示为：第二章工业机器人的数学基础工业机器人技术基础从几何学的观第二章工业机器人的数学基础工业机器人技术基础用向量表示这个关系式，其一般可表示为：已知机器人的关节变量θ，求其末端执行器位置r的运动学问题称为正运动学。如果给定机器人末端执行器位置r，为了达到这个预期的位姿，求机器人的关节变量θ的运动学问题称为逆运动学。第二章工业机器人的数学基础工业机器人技术基础用向量表示这第二章工业机器人的数学基础工业机器人技术基础■位置的正逆运动学方程

要确定一个刚体在空间的位姿，需要在该刚体上固连一个坐标系（因刚体在空间需要按不同期望运动，因此该坐标系一般叫做运动坐标系），然后通过描述该坐标系的原点在固定坐标系的坐标位置（3个自由度）以及该坐标系相对固定坐标系的姿态（3个自由度），总共需要6个自由度或6个信息来完整定义或描述该刚体在固定坐标系的位姿。

同理，如果要确定机器人末端执行器在空间的位姿，也必须在末端执行器上固连一个坐标系来确定末端执行器在空间的位姿，这正是机器人正运动学方程所要完成的任务。第二章工业机器人的数学基础工业机器人技术基础■位置的正逆第二章工业机器人的数学基础工业机器人技术基础机器人实现这一过程主要由两步来完成：1）首先在固定坐标系中首先移动机器人末端执行器到达预定的位置，即先确定位置的正逆运动学方程；2）机器人末端执行器到达指定位置后，然后调整末端执行器姿态，以适应或满足期望姿态，理论上机器人末端执行器在固定坐标系的位姿与加工目标在固定坐标系的位姿完全一致，即确定姿态的正逆运动学方程。确定位置的正逆运动学方程需根据工业机器人不同的坐标构型来定，下面就探讨几种构型的情况。第二章工业机器人的数学基础工业机器人技术基础机器人实现这第二章工业机器人的数学基础工业机器人技术基础■位置的正逆运动学方程▲直角坐标系型在这种情况下，有3个沿xyz轴的线性运动，这一类型的机器人的所有驱动都是线性的（比如液压油缸或线性动力丝杠），这时机器人末端执行器通过3个线性关节分别沿3个轴的运动来完成。在直角坐标系中，表示机器人末端执行器位置的正运动学变换矩阵为例2.7要求固连在直角坐标系型机器人末端执行器上的运动坐标系{b}的原点定位在固定坐标系上的点p=[3,4,5]T，试计算运动坐标系{b}相对固定坐标系{o}所需要的移动量或各关节变量。第二章工业机器人的数学基础工业机器人技术基础■位置的正逆第二章工业机器人的数学基础工业机器人技术基础例2.7要求固连在直角坐标系型机器人末端执行器上的运动坐标系{b}的原点定位在固定坐标系上的点p=[3,4,5]T，试计算运动坐标系{b}相对固定坐标系{o}所需要的移动量或各关节变量。解：写出其正运动学变换矩阵由此矩阵可得到：dx=3、dy=4和dz=5第二章工业机器人的数学基础工业机器人技术基础例2.7要第二章工业机器人的数学基础工业机器人技术基础■位置的正逆运动学方程▲圆柱坐标系型圆柱坐标系包括3个关节变量，分别是两个线性关节平移变量和一个旋转关节变量。其坐标变换顺序为：1）首先沿固定坐标系的x轴移动dx；2）然后绕固定坐标系的z轴旋转γ角，3）最后沿固定坐标系的z轴移动dz。这三个坐标变换建立了机器人末端执行器上的运动坐标系到固定坐标系之间的联系关系。由于这三个变换都是相对固定坐标系的坐标轴的，因此由这3个变换所产生的总变换可通过依次左乘每个对应变换矩阵而求得：第二章工业机器人的数学基础工业机器人技术基础■位置的正逆第二章工业机器人的数学基础工业机器人技术基础例2.8假设要将圆柱坐标系型机器人末端执行器上的运动坐标系原点放在[3,4,7]T，试计算该机器人的三个关节变量。解：dz=7和方程组求解此方程组：第二章工业机器人的数学基础工业机器人技术基础例2.8假第二章工业机器人的数学基础工业机器人技术基础■位置的正逆运动学方程▲球坐标系型球坐标系包括3个关节变量，分别是1个线性关节平移变量和2个旋转关节变量。其坐标变换顺序为：1）首先沿固定坐标系的z轴移动dz；2）然后绕固定坐标系的y轴旋转β角；3）最后绕固定坐标系的z轴旋转γ角。这三个坐标变换建立了机器人末端执行器上的运动坐标系到固定坐标系之间的联系关系。由于这三个变换都是相对固定坐标系的坐标轴的，因此由这3个变换所产生的总变换可通过依次左乘每个对应变换矩阵而求得：第二章工业机器人的数学基础工业机器人技术基础■位置的正逆第二章工业机器人的数学基础工业机器人技术基础例2.9假设要将球坐标系型机器人末端执行器上的运动坐标系原点放在[3,4,7]T，试计算该机器人的三个关节变量。解：可得求解此方程组：第二章工业机器人的数学基础工业机器人技术基础例2.9假第二章工业机器人的数学基础工业机器人技术基础■姿态的正逆运动学方程假设固连在机器人末端执行器上的运动坐标系在直角坐标系、圆柱坐标系或球坐标系中已经运动到了我们期望的位置上，但它仍然平行于固定坐标系，或者说姿态不满足使用要求。下一步工作正如前面分析的那样，希望在不改变位置的情况下，适当地旋转运动坐标系而使其达到期望的位姿。当然这时只能相对运动坐标系各个轴旋转了，因为假设绕固定坐标系参考轴旋转，那么最先运动到位的位置有可能发生改变。常见的绕运动坐标系的旋转主要有：1）滚动角、俯仰角、偏航角2）欧拉角第二章工业机器人的数学基础工业机器人技术基础■姿态的正逆第二章工业机器人的数学基础工业机器人技术基础■姿态的正逆运动学方程▲滚动角、俯仰角、偏航角空中的战斗机要完成各种攻击任务，必须要参考飞机坐标系姿态实时进行调整改变，而不是参照大地坐标来进行姿态调整。定义：1、滚转角Φα（又称Roll，简称R）---绕图示坐标系x轴旋转；2、偏航角Φβ（又称Yaw，简称Y）---绕图示坐标y轴旋转；3、俯仰角Φγ（又称Pitch，简称P）---绕图示坐标Z轴旋转。现假设按照PRY旋转顺序进行姿态调整，需要右乘所有PRY和其它旋转所产生的与位姿改变有关的矩阵。第二章工业机器人的数学基础工业机器人技术基础■姿态的正逆第二章工业机器人的数学基础工业机器人技术基础上式仅表示机器人末端执行器相对固定坐标系的姿态变化，不能反应出位置。该坐标系相对于固定坐标系的最终位姿是由机器人末端执行器在固定坐标系的位置和机器人末端执行器相对固定坐标系的姿态组成。第二章工业机器人的数学基础工业机器人技术基础上式仅表示机第二章工业机器人的数学基础工业机器人技术基础根据机器人末端执行器采取的坐标系型式不同，其最终位姿也有所不同，具体有以下三种：1）根据直角坐标系和PRY来设计的，那么机器人末端执行器运动坐标系相对固定坐标系的最终位姿矩阵就为：2）根据圆柱坐标系和PRY来设计的，那么机器人末端执行器运动坐标系相对固定坐标系的最终位姿矩阵就为：3）根据球坐标系和PRY来设计的，那么机器人末端执行器运动坐标系相对固定坐标系的最终位姿矩阵就为：第二章工业机器人的数学基础工业机器人技术基础根据机器人末第二章工业机器人的数学基础工业机器人技术基础一般情况下，机器人末端执行器相对固定坐标系的位姿矩阵是已知的，而PRY角的值是未知的，也是需要求的关节变量。现以直角坐标系和PRY组合方式求其逆运动学解。由式（2-17）可很方便写出机器人末端执行器相对固定坐标系的位姿矩阵：第二章工业机器人的数学基础工业机器人技术基础一般情况下，第二章工业机器人的数学基础工业机器人技术基础上述矩阵为同型矩阵，且相等，那么它们对应的元素也必须相等。第二章工业机器人的数学基础工业机器人技术基础上述矩阵为同第二章工业机器人的数学基础工业机器人技术基础例2.10下面给出了一个直角坐标系+PRY型机器人手所期望的最终位姿，试求出所有关节变量。解：根据式（2-18）和式（2-19）式得第二章工业机器人的数学基础工业机器人技术基础例2.10第二章工业机器人的数学基础工业机器人技术基础■姿态的正逆运动学方程▲欧拉角空中的战斗机要完成各种攻击任务，必须要参考飞机坐标系姿态实时进行调整改变，而不是参照大地坐标来进行姿态调整。与PRY角不同，按照以下顺序变换：1）首先绕图示坐标系z轴旋转角Φ；2）然后绕图示坐标y轴旋转角θ；3）最后绕图示坐标z轴旋转ψ，这样的旋转转序称为欧拉角旋转。第二章工业机器人的数学基础工业机器人技术基础■姿态的正逆第二章工业机器人的数学基础工业机器人技术基础根据机器人末端执行器采取的坐标系型式不同，其最终位姿也有所不同，具体有以下三种：1）根据直角坐标系和欧拉角来设计的，那么机器人末端执行器运动坐标系相对固定坐标系的最终位姿矩阵就为：2）根据圆柱坐标系和欧拉角来设计的，那么机器人末端执行器运动坐标系相对固定坐标系的最终位姿矩阵就为：3）根据球坐标系和欧拉角来设计的，那么机器人末端执行器运动坐标系相对固定坐标系的最终位姿矩阵就为：其坐标位姿矩阵的逆运动学解同PRY解法一样，此处不再探讨。第二章工业机器人的数学基础工业机器人技术基础根据机器人末第二章工业机器人的数学基础工业机器人技术基础D-H法与正逆运动学方程D-H模型表示了对机器人连杆和关节进行建模的一种非常简单的方法，可用于任何机器人构型，而不管机器人的结构顺序和复杂程度如何。它也可用于表示已经讨论过的在任何坐标中的变换，例如直角坐标、圆柱坐标、球坐标、欧拉角坐标及RPY坐标等。另外，它也可以用于表示全旋转的链式机器人、SCARA机器人或任何可能的关节和连杆组合。尽管采用前面的方法对机器人直接建模会更快、更直接，但D-H表示法有其附加的好处，使用它已经开发了许多技术，例如，雅克比矩阵的计算和力分析等。假设机器人由一系列关节和连杆组成。这些关节可能是滑动（线性）的或旋转（转动）的，它们可以按任意的顺序放置并处于任意的平面。连杆也可以是任意的长度（包括零），它可能被弯曲或扭曲，也可能位于任意平面上。所以任何一组关节和连杆都可以构成一个我们想要建模和表示的机器人。第二章工业机器人的数学基础工业机器人技术基础D-H法与正第二章工业机器人的数学基础工业机器人技术基础D-H法定义：关节：第1个关节为n关节；第2个关节为关节n+1；第3个关节为关节n+2；在这些关节的前后可能还有其他关节。连杆：位于关节n与关节n+1之间的杆件为连杆n；位于关节n+1与关节n+2之间的杆件为连杆n+1；依次类推。坐标系：1）如果关节是旋转副，那么z轴位于按右手定则规定的旋转的方向；如果关节是移动副，那么z轴为沿直线运动的方向。在每种情况下，关节n处的z轴的编号为n-1；对于旋转关节，其关节变量为θ；对于移动关节，其关节变量为d。2）通常关节不一定平行或相交，因此定义前后两个z轴的公垂线为x轴，且x轴的指向为下一个z轴。3）y轴由右手定则和已定的z轴与x轴而定。第二章工业机器人的数学基础工业机器人技术基础D-H法定义第二章工业机器人的数学基础工业机器人技术基础D-H法定义：坐标变换（目标：{n}系变换到{n+1}）绕zn轴旋转θz-n+1，使得xn轴和xn+1轴互相平移；沿zn轴平移dz-n+1距离，使得xn轴和xn+1轴共线；沿xn轴平移dx-n+1距离，使得两坐标系原点重合；将zn轴绕xn+1轴旋转θx-n+1，使得zn轴和zn+1轴对准。表示前面4个运动变换的两个依次坐标系之间的变换是4个运动变换矩阵的乘积，又因为是参照运动坐标系的，因此所有的变换矩阵都是右乘。第二章工业机器人的数学基础工业机器人技术基础D-H法定义第二章工业机器人的数学基础工业机器人技术基础例2.11对于如图2-20所示的简单2轴平面机器人，根据D-H表示法，建立必要的坐标系，填写D-H参数表，导出该机器人的正运动学方程。解：根据坐标系有关对z轴和x轴的定义，在图2-20上作出各关节坐标轴。再填写D-H参数表2-2。第二章工业机器人的数学基础工业机器人技术基础例2.11第二章工业机器人的数学基础工业机器人技术基础从0-2系的运动学方程就为：如果给定θ1、θ2、d1和d2的值，根据正运动学方程就可以求出机器人末端的位姿。第二章工业机器人的数学基础工业机器人技术基础从0-2系的第二章工业机器人的数学基础工业机器人技术基础机器人微分运动与速度：再由矩阵求导公式，分别对上述方程的两个变量θ1和θ2求微分，可得出：写成矩阵形式为：显然点P的位置微小变化就是点P的运动速度，在多自由度的机器人中，可用同样的方法将关节的微分运动与手的微分运动结合起来。为了具有共性，式（2-20）还可写为：表示机器人手绕x、y、z轴的微分旋转表示雅可比矩阵。第二章工业机器人的数学基础工业机器人技术基础机器人微分运第二章工业机器人的数学基础工业机器人技术基础2.坐标系的微分运动▲微分平移▲微分转动微分旋转是坐标系的微小旋转，它通常用Rot(q,dθ)来表示，其含义是坐标系绕q轴旋转一个角度dθ。因为旋转量很小，根据微分理论有sindx=dx；cosdx=1。显然，表示绕x、y、z轴的微分旋转矩阵为第二章工业机器人的数学基础工业机器人技术基础2.坐标系第二章工业机器人的数学基础工业机器人技术基础机器人动力学：机器人的动力学研究物体的运动与受力之间的关系。机器人动力学方程是机器人机械系统的运动方程，它表示机器人各关节的关节位置、关节速度、关节加速度与各关节执行器驱动力或力矩之间的关系。机器人的动力学有两个相反的问题：一是已知机器人各关节执行器的驱动力或力矩，求解机器人各关节的位置、速度、加速度，这是动力学正问题；二是已知各关节的位置、速度、加速度，求各关节所需的驱动力或力矩，这是动力学逆问题。机器人的动力学正问题主要用于机器人的运动仿真。例如在机器人设计时，需根据连杆质量、运动学和动力学参数、传动机构特征及负载大小进行动态仿真，从而决定机器人的结构参数和传动方案，验算设计方案的合理性和可行性，以及结构优化的程度；在机器人离线编程时，为了估计机器人高速运动引起的动载荷和路径偏差，要进行路径控制仿真和动态模型仿真。第二章工业机器人的数学基础工业机器人技术基础机器人动力学第二章工业机器人的数学基础工业机器人技术基础研究机器人动力学逆问题的目的是为了对机器人的运动进行有效的实时控制，以实现预期的轨迹运动，并达到良好的动态性能和最优指标。由于机器人是个复杂的动力学系统，由多个连杆和关节组成，具有多个输入和输出，存在着错综复杂的耦合关系和严重的非线性，所以动力学的实时计算很复杂，在实际控制时需要做一些简化假设。目前研究机器人动力学的方法很多，由牛顿-欧拉方法、拉格朗日方法、阿贝尔方法和凯恩方法等，详细内容可查阅相关书籍。第二章工业机器人的数学基础工业机器人技术基础研究机器人动

目录第一章工业机器人概论第二章工业机器人的数学基础第三章工业机器人的机械系统第四章工业机器人的动力系统第五章工业机器人的感知系统第六章工业机器人的控制系统第七章工业机器人编程与调试工业机器人技术基础工业机器人技术基础主要内容2.1矩阵及运算2.2坐标系及其关系描述2.3坐标变换2.4机器人运动学2.5机器人动力学工业机器人技术基础第2章工业机器人的数学基础主要内容工业机器人技术基础第2章工业机器人的数学基础第二章工业机器人的数学基础工业机器人技术基础2.1矩阵及运算1.矩阵的定义定义1由mn个数aij（i=1，2，，m；j=1,2，，n），排成m行n列的数表：称为m行n列矩阵，简称为mn矩阵。这mn个数称为矩阵A的元素，aij叫做矩阵A的第i行第j列元素。元素是实数的矩阵叫做实矩阵，元素是复数的矩阵叫做复矩阵。本教程中的矩阵除特别说明外，都指实矩阵。通常用大写的拉丁字母A、B、C等表示矩阵。有时为了指明矩阵的第i行第j列元素为aij，可将A记作A=(aij)mn或A=(aij)，也可将mn矩阵A记为Amn。当A的行数与列数相等时，称A为n阶方阵或n阶矩阵。显然，一阶矩阵就是一个数。第二章工业机器人的数学基础工业机器人技术基础2.1第二章工业机器人的数学基础工业机器人技术基础2.1矩阵及运算只有一行的矩阵A=（a1，a2，，an）叫做行矩阵；只有一列的矩阵叫做列矩阵。两个矩阵的行数相等、列数也相等时，就称它们为同型矩阵。如果A=(aij)与B=(bij)是同型矩阵，并且它们的对应元素相等，即

aij=bij

（i=1，2，，m；j=1，2，，n），那末就称矩阵A与矩阵B相等，记作A=B。元素都是零的矩阵，记作0。注意不同型的零矩阵是不同的。II几种特殊矩阵a)对角矩阵(diagonalmatrix)，如下的矩阵称为对角矩阵，记为diag（a11

,a22,a33……

ann）第二章工业机器人的数学基础工业机器人技术基础2.1矩第二章工业机器人的数学基础工业机器人技术基础b)数量矩阵(scalarmatrix)c)三角矩阵(triangularmatrix)上三角矩阵(uppertriangularmatrix)第二章工业机器人的数学基础工业机器人技术基础b)数量矩第二章工业机器人的数学基础工业机器人技术基础d)

对称阵(symmetricmatrix）和反对称阵(anti-symmetricmatrix)如果n阶矩阵A=（aij）的元素满足aij=aji（i，j=1，2，，n），则称A为n阶对称矩阵，如如果n阶矩阵A=（aij）的元素满足aij=aji（i，j=1，2，，n），则称A为n阶反对称矩阵。显然，故aii=0（i=1，2，，n）如：第二章工业机器人的数学基础工业机器人技术基础d)

第二章工业机器人的数学基础工业机器人技术基础

▲矩阵的加法设有两个mn的矩阵A=（aij），B＝（bij），则矩阵A和B的和记作A+B。即：III矩阵的运算易证，矩阵加法满足下列运算规律（设A、B、C都是mn矩阵）：a)A+B=B+A；b)（A+B）+C=A+（B+C）。设矩阵A=（aij），记A=（aij），A称为A的负矩阵，显然有A+（A）=0。由此定义矩阵的减法运算为

AB=A+(-B)第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础

▲矩阵相等条件：①矩阵要同阶②对应元素相等满足上述条件，矩阵就相等。如下述矩阵：III矩阵的运算第二章工业机器人的数学基础工业机器人技术基础第二章工业机器人的数学基础工业机器人技术基础▲数与矩阵相乘数与矩阵A的乘积记作A或A，规定为易证，数乘矩阵满足下列运算规律（设A、B为mn矩阵，、为数）：(i).

（）A=（A）；(ii).

（+）A=A+A；(iii).

（A+B）=A+B。第二章工业机器人的数学基础工业机器人技术基础▲数与矩阵相第二章工业机器人的数学基础工业机器人技术基础▲矩阵与矩阵相乘设矩阵A=(aij)ms，B=(bij)sn，则矩阵A和矩阵B的乘积矩阵C=（cij）mn，其中

Cij=ai1b1j+ai2b2j++aisbsj

（i=1，2，，m；j=1，2，，n）记作C=AB。对于矩阵的乘法需注意以下三点：第一，只有矩阵A的列数等于B的行数时，AB才有意义。第二，乘积C=（cij）mn的第i行第j列的元素等于矩阵A的第i行的每一个元素与矩阵B的第j列的对应元素的乘积之和。第三，乘积C的行数等于矩阵A的行数，列数等于矩阵B的列数。第二章工业机器人的数学基础工业机器人技术基础▲矩阵与矩阵第二章工业机器人的数学基础工业机器人技术基础例1求AB和BA。其中解：第二章工业机器人的数学基础工业机器人技术基础例1求第二章工业机器人的数学基础工业机器人技术基础例2求AB和BA。其中解：第二章工业机器人的数学基础工业机器人技术基础例2求第二章工业机器人的数学基础工业机器人技术基础

在上述两个例子中都有ABBA，即矩阵乘法不满足乘法交换律，为此将AB称为用A左乘B，而将BA称为A右乘以B。还应注意到在例5中：A，B均为非零矩阵，但AB却为零矩阵。由定义可以验证矩阵的乘法满足以下运算规律：（假设运算都是可行的）(i).

结合律：（AB）C=A（BC）；(ii).

左分配律：A（B+C）=AB+AC；(iii).

右分配律：（B+C）A=BA+CA；(iv).

（AB）=（A）B=A（B）。（为常数）对于单位矩阵E,容易验证EmAmn=Amn

，AmnEn=Amn。有了矩阵的乘法，就可以定义n阶方阵的幂。设A是n阶方阵，定义A1=A，A2=A1A1，，Ak+1=AkA1

，其中k为正整数。这就是说，Ak就是k个A相乘。显然，只有方阵的幂才有意义。由于矩阵乘法适合结合律，所以方阵的幂满足以下运算规律：

AA=A+

，(A)=A

不过，一般(AB)kAkBk。第二章工业机器人的数学基础工业机器人技术基础在上述第二章工业机器人的数学基础工业机器人技术基础

▲矩阵的转置把矩阵A=(aij)m×n的行换成同序数的列所得到的新矩阵，叫做A的转置矩阵(transpose)，记作A

或AT。显然，A=(aji)n×m矩阵的转置也是一种运算，易证它满足下述运算规律（假设运算都是可行的）：

(i)

(A)=A；

(ii)

(A+B)=A+B

；

(iii)(A)=A

；

(iv)(AB)=BA

。第二章工业机器人的数学基础工业机器人技术基础▲矩阵的转第二章工业机器人的数学基础工业机器人技术基础

▲方阵的行列式

由n阶方阵A的元素按原来位置不变所构成的行列式（各元素的位置不变），叫做方阵A的行列式，记作|A|或detA。设A为n阶方阵，如果|A|≠0，则称

为非奇异矩阵；如果|A|=0，则称

为奇异矩阵。

由方阵A确定行列式|A|的运算满足下述运算规律（设A，B为n阶方阵，为数）：

(i).

|A|=|A|（行列式性质1）；

(ii).

|