第四章微分运动和雅可比矩阵课件

▲雅可比矩阵的定义▲微分运动与广义速度▲雅可比矩阵的构造法▲PUMA560机器人的雅可比矩阵▲逆雅可比矩阵▲力雅可比矩阵第四讲：微分运动和雅可比矩阵▲雅可比矩阵的定义第四讲：微分运动和雅可比矩阵1

上一章我们讨论了刚体的位姿描述、齐次变换，机器人各连杆间的位移关系，建立了机器人的运动学方程，研究了运动学逆解，建立了操作空间与关节空间的映射关系。本章将在位移分析的基础上，进行速度分析，研究操作空间速度与关节空间速度之间的线性映射关系——雅可比矩阵(简称雅可比)。雅可比矩阵不仅用来表示操作空间与关节空间之间的速度线性映射关系，同时也用来表示两空间之间力的传递关系。上一章我们讨论了刚体的位姿描述、齐次变换24.1雅可比矩阵的定义

把机器人关节速度向量定义为：

式中，为连杆i相对i-1的角速度或线速度。4.1雅可比矩阵的定义3手抓在基坐标系中的广义速度向量为：

式中，v为线速度，ω为角速度分量。手抓在基坐标系中的广义速度向量为：4从关节空间速度向操作空间速度映射的线性关系称为雅可比矩阵，记为J，即：

4-3从关节空间速度向操作空间速度映射的线性5在数学上，机器人终端手抓的广义位置（位姿）矢量P可写成：

上式对时间求导，有：4-5在数学上，机器人终端手抓的广义位置（位6对照式4-3和式4-5，可知：

对照式4-3和式4-5，可知：7

在机器人学中，J是一个把关节速度向量变换为手爪相对基坐标的广义速度向量的变换矩阵。在三维空间运行的机器人，其J阵的行数恒为6(沿/绕基坐标系的变量共6个)；列数则为机械手含有的关节数目。对于平面运动的机器人来说，手的广义位置向量均容易确定，可采用直接微分法求J，比较方便。在机器人学中，J是一个把关节速度向量8对于三维空间运行的机器人则不完全适用。从三维空间运行的机器人运动学方程，可以获得直角坐标位置向量的显式方程，因此，J的前三行可以直接微分求得，但不可能找到方位向量的一般表达式。找不出互相独立的、无顺序的三个转角来描述方位．绕直角坐标轴的连续角运动变换是不可交换的，而对角位移的微分与对角位移的形成顺序无关，故一般不能运用直接微分法来获得J的后三行。因此，常用构造性方法求雅可比J。对于三维空间运行的机器人则不完全适用。从三维94.2微分运动与广义速度刚体或坐标系的微分运动包括微分移动矢量d和微分转动矢量δ。前者由沿三个坐标轴的微分移动组成，后者由绕三个坐标轴的微分转动组成，即或

或4.2微分运动与广义速度10刚体或坐标系的微分运动矢量刚体或坐标系的广义速度刚体或坐标系的微分运动矢量刚体或坐标系的广义速度11简写为：简写为：12其中，R是旋转矩阵S(P)为矢量P的反对称矩阵S(P)矩阵具有以下性质：其中，R是旋转矩阵S(P)为矢量P的反对称矩阵S(P)矩阵具13相应的，广义速度V的坐标变换为：任意两坐标系A和B之间广义速度的坐标变换为：相应的，广义速度V的坐标变换为：任意两坐标系A和B之间广义速144.3雅可比矩阵的构造法构造雅可比矩阵的方法有矢量积法和微分变换法，雅可比矩阵J(q)既可当成是从关节空间向操作空间的速度传递的线性关系，也可看成是微分运动转换的线性关系，即：

4.3雅可比矩阵的构造法15对于有n个关节的机器人，其雅可比矩阵J(q)是6×n阶矩阵，其前三行称为位置雅可比矩阵，代表对手爪线速度v的传递比，后三行称为方位矩阵，代表相应的关节速度对手爪的角速度ω的传递比。因此，可将雅可比矩阵J(q)分块，即：式中，Jli和Jai分别表示关节i的单位关节速度引起手爪的线速度和角速度。

对于有n个关节的机器人，其雅可比矩阵J(q)是16雅可比矩阵的求解（矢量积法）：Jli的求法：(1)第i关节为移动关节时仅平移关节产生的线速度雅可比矩阵的求解（矢量积法）：仅平移关节产生的线速度17设某时刻仅此关节运动、其余的关节静止不动，则：设bi-1为zi-1轴上的单位矢量，利用它可将局部坐标下的平移速度di转换成基础坐标下的速度：由于所以设某时刻仅此关节运动、其余的关节静止不动，则：设bi18

(2)第i个关节为转动关节时，设某时刻仅此关节运动，其余的关节静止不动，仍然利用bi-1将zi-1轴上的角速度转化到基础坐标中去仅旋转关节产生的线速度(2)第i个关节为转动关节时，设19矢量起于Oi-1，止于On，所以由ωi产生的线速度为:矢量起于Oi-1，止于On，所以由ωi产生的线速20由于所以由于所以21雅可比矩阵的求解：Jai的求法：第i关节为移动关节时由于关节移动的平移不对手部产生角速度，所以此时(2)第i关节为转动关节时，所以雅可比矩阵的求解：(2)第i关节为转动关节时，所以22当第i关节为移动关节时当第i关节为转动关节时当第i关节为移动关节时当第i关节为转动关节时23确定1、用b表示zi-1轴上的单位向量把它转换到基础坐标系中，即为确定1、用b表示zi-1轴上的单位向量把它转换到基础坐标系中24

如右图所示。用O、Oi-1、On分别表示基础坐标系、i-1号坐标及手部坐标系的原点。用矢量x表示在各自坐标系中的原点。把用齐次坐标表示如右图所示。用O、Oi-1、On分别表示基础坐25有上式可以确定有上式可以确定26例2-6：建立右图的雅可比矩阵例2-6：建立右图的雅可比矩阵27第四章微分运动和雅可比矩阵课件28机械臂末端的速度为机械臂末端的速度为29微分变换法

对于转动关节

微分变换法对于转动关节30对于移动关节

对于移动关节31对于移动关节

对于转动关节

对于移动关节对于转动关节32例：PUMA560的6个关节都是转动关节，其雅可比有6列。此处用矢量积法计算J(q)例：PUMA560的6个关节都是转动关节，其雅可比有6列。此33第四章微分运动和雅可比矩阵课件34第四章微分运动和雅可比矩阵课件35第四章微分运动和雅可比矩阵课件36例：斯坦福六自由度机器人除第三关节为移动关节外，其余5个关节为转动关节。此处用微分法计算TJ(q)例：斯坦福六自由度机器人除第三关节为移动关节外，其余5个关节37第四章微分运动和雅可比矩阵课件38第四章微分运动和雅可比矩阵课件39若给定机器人终端手抓的广义速度向量V，则可由下式解出相应的关节速度：逆雅可比矩阵

上式中，称为逆雅可比矩阵，为加给对应关节伺服系统的速度输入变量。若给定机器人终端手抓的广义速度向量V，则可由40雅可比矩阵的应用1、分离速度控制

由上式可见，当已知手端速度向量V，可通过左乘雅可比逆矩阵计算出机器人的关节速度向量，所以上式为运动学逆问题的速度关系式，是对机器人进行速度控制的基本关系式。雅可比矩阵的应用由上式可见，当已知手端速度41

采用计算机控制时，把速度表示位置增量的形式，故将上式写为：式中,Δv为手部在基础坐标下一个采样周期的位移(线位移、角位移)；Δq为在同一周期内关节变量的增量。采用计算机控制时，把速度表示位置增量的形式，42

当要求机器人沿某轨迹运动时，Δv为已知，将它代入上式中求得关节变量增量Δq

，于是可确定各关节变量值，由伺服系统实现位置控制，这就是分离速度控制原理，如下图所示。Δv要求Δv实际分离速度控制原理当要求机器人沿某轨迹运动时，Δv为已知，将43雅可比矩阵的应用2、在静力分析中的应用

有些机器人的工作需要与环境接触，并保持一定的接触力，如右图所示。接触力F可表示为一个六维力向量：设一个驱动器只驱动一个关节，则n个关节需求n个驱动力，可组成一个n维关节力向量:雅可比矩阵的应用有些机器人的工作需要与环境接44T与F的关系可以表示为：2-56T与F的关系可以表示为：2-5645

式中，称为机器人力雅可比，它表示在静止平衡状态下，末端广义力向关节力映射的线性关系。显然，力雅可比是机器人速度雅可比的转置。因此，机器人静力学传递关系和速度传递关系紧密相关。式中，称为机器人力雅可比，它表示在46第四章微分运动和雅可比矩阵课件47由构型和例2-6可得：由构型和例2-6可得：48第四章微分运动和雅可比矩阵课件49思考题1：右图为三自由度机械手(1)用D-H方法建立各附体坐标系；(2)列出连杆的D-H参数表；