机器人技术第三章数学基础

机器人技术第三章数学基础第一页，共五十二页，编辑于2023年，星期六讲授预备知识目的：运动学动力学研究对象：工业机器人第二页，共五十二页，编辑于2023年，星期六第2.5章

机器人学关键技术

1.机器人学机器人学——机械电子工程的典型案例机械电子的由来？MechatronicsMechanics+ElectronicsTetsuroMori（森哲郎）日本安川电气公司工程师1969年提出、1971年注册第三页，共五十二页，编辑于2023年，星期六第2.5章

机器人学关键技术

2.机器人学特点机械电子工程交叉学科特性Dr.KevinCraigMarquetteUniversity第四页，共五十二页，编辑于2023年，星期六第2.5章

机器人学关键技术

3.机器人学研究内容IEEEInternationalConferenceonRoboticsandAutomation(ICRA)2013Karlsruhe(德国) 文章： 873/2265(38.5%)

分会场： 84

国家： 63IEEE/RSJInternationalConferenceonIntelligentRobotsandSystems(IROS)2013Tokyo(日本) 文章： 904/2094(43.2%)

分会场： 153

国家： -第五页，共五十二页，编辑于2023年，星期六I.机器人学内容第六页，共五十二页，编辑于2023年，星期六第2.5章

机器人学关键技术

3.机器人学研究内容TechnicalSession的主要内容HumanrobotinteractionMedicalroboticsSensorfusionLeggedrobotsUnderwaterrobotsManipulatormotionplanningCameracalibrationIntelligenttransportationsystemsSLAM:FeaturesandlandmarksHumanoidrobotbodymotionMicrorobotsBiologically-inspiredroboticdevicesRehabilitationroboticsFieldroboticsGraspingNanoroboticmanipulationFish-likerobot…………第七页，共五十二页，编辑于2023年，星期六第三章机器人运动学的数学基础第八页，共五十二页，编辑于2023年，星期六参考教材

[美]付京逊《机器人学》[中南大学]蔡自兴《机器人学》[美]理查德·鲍尔《机器人操作手·数学·编程与控制》第九页，共五十二页，编辑于2023年，星期六参考教材

[美]付京逊《机器人学》美籍华人普渡大学（PurdueUniversity）电机工程专业著名教授4部著作、400多篇论文第一任国际模式识别学会会长，被誉为自动模式识别之父1985年去世第十页，共五十二页，编辑于2023年，星期六参考教材

[中南大学]蔡自兴中南大学教授，我国人工智能和机器人领域著名专家中国人工智能学会智能机器人专委会理事长曾在普渡大学工作过第十一页，共五十二页，编辑于2023年，星期六第一节

引言第十二页，共五十二页，编辑于2023年，星期六串联机器人可以用一个开环关节链来建模由数个驱动器驱动的转动或移动关节串联而成一端固定在基座上，另一端是自由的，安装工具（末端执行器），用以操纵物体，或完成各种任务关节的相对运动导致杆件的运动，使末端执行器定位于所需要的方位上在一般机器人应用问题中，人们感兴趣的是：末端执行器相对于固定参考坐标数的空间几何描述，也就是机器人的运动学问题机器人的运动学即是研究机器人手臂末端执行器位置和姿态与关节变量空间之间的关系第十三页，共五十二页，编辑于2023年，星期六运动学研究的问题Whereismyhand?DirectKinematicsHERE!HowdoIputmyhandhere?InverseKinematics:Choosetheseangles!运动学正问题运动学逆问题第十四页，共五十二页，编辑于2023年，星期六

哈佛大学RogerBrockett建立的指数积公式运动学滚动接触非完整控制数学基础-刚体运动参考文献：机器人操作的数学导论作者：理查德·摩雷李泽湘夏卡恩·萨斯特里翻译：徐卫良钱瑞明（东南大学）研究运动学的方法第十五页，共五十二页，编辑于2023年，星期六1955年丹纳维特（Denavit）和哈顿伯格（Hartenberg）提出了一种采用矩阵代数方法解决机器人的运动学问题—D-H方法，其数学基础即是齐次变换具有直观的几何意义能表达动力学、计算机视觉和比例变换问题为以后的比例变换、透视变换等打下基础第十六页，共五十二页，编辑于2023年，星期六第二节数学基础—齐次坐标和齐次变换第十七页，共五十二页，编辑于2023年，星期六2.1点和面的齐次坐标

2.1.1点的齐次坐标

一般来说，n维空间的齐次坐标表示是一个（n+1）维空间实体。有一个特定的投影附加于n维空间，也可以把它看作一个附加于每个矢量的特定坐标—比例系数。引入齐次坐标的目的是为了表示几何变换的旋转、平移和缩放式中i,j,k为x,y,z轴上的单位矢量，a=,b=,c=，w为比例系数

显然，齐次坐标表达并不是唯一的，随w值的不同而不同。在计算机图学中，w作为通用比例因子，它可取任意正值，但在机器人的运动分析中，总是取w=1

。列矩阵一个点矢：第十八页，共五十二页，编辑于2023年，星期六[例1]：可以表示为：

V=[3451]T

或V=[68102]T

或V=[-12-16-20-4]T

第十九页，共五十二页，编辑于2023年，星期六

齐次坐标与三维直角坐标的区别V点在ΣOXYZ坐标系中表示是唯一的（a、b、c）而在齐次坐标中表示可以是多值的。不同的表示方法代表的V点在空间位置上不变。

第二十页，共五十二页，编辑于2023年，星期六

几个特定意义的齐次坐标：[000n]T—坐标原点矢量的齐次坐标，n为任意非零比例系数[1000]T—指向无穷远处的OX轴[0100]T—指向无穷远处的OY轴[0010]T—指向无穷远处的OZ轴[0000]T—没有意义2个常用的公式：点乘:叉乘:第二十一页，共五十二页，编辑于2023年，星期六2.1.2平面的齐次坐标平面齐次坐标由行矩阵P=[abcd]来表示当点v=[xyzw]T处于平面P内时，矩阵乘积PV=0，或记为

与点矢相仿，平面也没有意义第二十二页，共五十二页，编辑于2023年，星期六

点和平面间的位置关系设一个平行于x、y轴，且在z轴上的坐标为单位距离的平面P可以表示为：或

有：PV=例如：点V=[102011]T

必定处于此平面内，而点V=[0021]T处于平P的上方，点V=[0001]T处于P平面下方，因为：第二十三页，共五十二页，编辑于2023年，星期六2.2旋转矩阵及旋转齐次变换

2.2.1旋转矩阵

设固定参考坐标系直角坐标为ΣOxyz，动坐标系为ΣO´uvw，研究旋转变换情况。①

初始位置时，动静坐标系重合，O、O´重合，如图。各轴对应重合，设P点是动坐标系ΣO´uvw中的一点，且固定不变。则P点在ΣO´uvw中可表示为：

、、为坐标系ΣO´uvw的单位矢量，则P点在Σoxyz中可表示为：第二十四页，共五十二页，编辑于2023年，星期六当动坐标系ΣO´uvw绕O点回转时，求P点在固定坐标系Σoxyz中的位置已知：P点在ΣO´uvw中是不变的仍然成立，由于ΣO´uvw回转，则：用矩阵表示为:（2-7）第二十五页，共五十二页，编辑于2023年，星期六反过来：2.2.2旋转齐次变换用齐次坐标变换来表示式（2-7）第二十六页，共五十二页，编辑于2023年，星期六2.2.3三个基本旋转矩阵和合成旋转矩阵

三个基本旋转矩阵

即动坐标系求的旋转矩阵，也就是求出坐标系中各轴单位矢量在固定坐标系中各轴的投影分量，很容易得到在两个坐标系重合时，有：第二十七页，共五十二页，编辑于2023年，星期六方向余弦阵第二十八页，共五十二页，编辑于2023年，星期六同理：

三个基本旋转矩阵:

第二十九页，共五十二页，编辑于2023年，星期六

合成旋转矩阵:例1：在动坐标中有一固定点，相对固定参考坐标系做如下运动：①R（x,90°）；②R(z,90°)；③R(y,90°)。求运动后点在固定参考坐标系下的位置。解1：用画图的简单方法第三十页，共五十二页，编辑于2023年，星期六解2：用分步计算的方法①R（x,90°）②R（z,90°）③R（y,90°）（2-14）（2-15）（2-16）第三十一页，共五十二页，编辑于2023年，星期六

上述计算方法非常繁琐，可以通过一系列计算得到上述结果。将式（2-14）（2-15）（2-16）联写为如下形式：R3x3为二者之间的关系矩阵，我们令：定义1：当动坐标系绕固定坐标系各坐标轴顺序有限次转动时，其合成旋转矩阵为各基本旋转矩阵依旋转顺序左乘。注意：旋转矩阵间不可以交换

第三十二页，共五十二页，编辑于2023年，星期六

平移齐次变换矩阵注意：平移矩阵间可以交换，平移和旋转矩阵间不可以交换第三十三页，共五十二页，编辑于2023年，星期六2.2.4相对变换

举例说明：例1：动坐标系∑0′起始位置与固定参考坐标系∑0重合,动坐标系∑0′做如下运动：①R(Z,90º)②R（y,90º）③Trans(4，-3,7)，求合成矩阵解1：用画图的方法：第三十四页，共五十二页，编辑于2023年，星期六解2：用计算的方法根据定义1，我们有：

以上均以固定坐标系多轴为变换基准，因此矩阵左乘。如果我们做如下变换，也可以得到相同的结果：例2：①先平移Trans(4,-3,7)；②绕当前轴转动90º；③绕当前轴转动90º；求合成旋转矩阵。（2-20）第三十五页，共五十二页，编辑于2023年，星期六解1：用画图的方法解2：用计算的方法（2-21）第三十六页，共五十二页，编辑于2023年，星期六式（2-20）和式（2-21）无论在形式上，还是在结果上都是一致的。因此我们有如下的结论：动坐标系在固定坐标系中的齐次变换有2种情况：定义1：如果所有的变换都是相对于固定坐标系中各坐标轴旋转或平移，则依次左乘，称为绝对变换。定义2：如果动坐标系相对于自身坐标系的当前坐标轴旋转或平移，则齐次变换为依次右乘，称为相对变换。结果均为动坐标系在固定坐标中的位姿（位置+姿态）。相对于固定坐标系，

也就是说，动坐标系绕自身坐标轴做齐次变换，要达到绕固定坐标系相等的结果，就应该用相反的顺序。

第三十七页，共五十二页，编辑于2023年，星期六右乘的意义：机器人用到相对变换的时候比较多例如机械手抓一个杯子，如右图所示，手爪需要转动一个角度才抓的牢，相对于固定坐标系表达太麻烦，可以直接根据手爪的坐标系表示但也要知道在∑O中的位姿，就用右乘的概念。

oH第三十八页，共五十二页，编辑于2023年，星期六2.2.5绕通过原点的任意轴旋转的齐次变换有时动坐标系∑O´可能绕过原点O的分量分别为rx、ry、rz的任意单位矢量r转动φ角。研究这种转动的好处是可用∑O´绕某轴r的一次转动代替绕∑O各坐标轴的数次转动为推导此旋转矩阵，可作下述5步变换：绕X轴转α角，使r轴处于XZ平面内绕Y轴转-β角，使r

轴与OZ轴重合绕OZ轴转动φ角绕Y轴转β角绕X轴转-α角第三十九页，共五十二页，编辑于2023年，星期六由上图容易求出：由定义1和定义2，上述5次旋转的合成旋转矩阵为：（2-25）第四十页，共五十二页，编辑于2023年，星期六带入式（2-25），得由该式可以推出3个基本旋转矩阵第四十一页，共五十二页，编辑于2023年，星期六2.2.6齐次变换矩阵的几何意义

设，有一个手爪，即动坐标系∑O´，已知，初始位置重合，那么∑O´在∑O中的齐次坐标变换为：，如果手爪转了一个角度，

则：第四十二页，共五十二页，编辑于2023年，星期六T反映了∑O´在∑O中的位置和姿态，即表示了该坐标系原点和各坐标轴单位矢量在固定坐标系中的位置和姿态。该矩阵可以由4个子矩阵组成，写成如下形式：为姿态矩阵（旋转矩阵），表示动坐标系∑O´在固定参考坐标系∑O中的姿态，即表示∑O´各坐标轴单位矢量在∑O各轴上的投影为位置矢量矩阵，代表动坐标系∑O´坐标原点在固定参考坐标系∑O中的位置为透视变换矩阵，在视觉中进行图像计算，一般置为0为比例系数

第四十三页，共五十二页，编辑于2023年，星期六如果需要求解∑O在∑O´中的位置和姿态，此时的齐次变换矩阵为，即求逆矩阵：

其中：这些式子以后经常遇到，在机器人计算中，所要求的就是齐次变换矩阵第四十四页，共五十二页，编辑于2023年，星期六2.2.7透镜成像的齐次变换

第四十五页，共五十二页，编辑于2023年，星期六因此，进行机器人运动学计算时，不能省略透视矩阵，有摄像头时，透视矩阵为

[0-