《第四章微分运动和雅可比矩阵优秀PPT.ppt》由会员分享，可在线阅读，更多相关《第四章微分运动和雅可比矩阵优秀PPT.ppt（52页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、第四章微分运动和第四章微分运动和雅可比矩阵雅可比矩阵第一页，本课件共有52页雅可比矩雅可比矩阵阵的定的定义义微分运微分运动动与广与广义义速度速度雅可比矩雅可比矩阵阵的构造法的构造法PUMA560机器人的雅可比矩机器人的雅可比矩阵阵逆雅可比矩逆雅可比矩阵阵力雅可比矩力雅可比矩阵阵第二页，本课件共有52页 上一章我们讨论了刚体的位姿描述、齐次上一章我们讨论了刚体的位姿描述、齐次变换，机器人各连杆间的位移关系，建立了机变换，机器人各连杆间的位移关系，建立了机器人的运动学方程，研究了运动学逆解，建立器人的运动学方程，研究了运动学逆解，建立了了操作空间操作空间与与关节空间关节空间的映射关系。的映射关系。
2、本章将在位移分析的基础上，进行本章将在位移分析的基础上，进行速度分速度分析析，研究操作空间速度与关节空间速度之间的，研究操作空间速度与关节空间速度之间的线性映射关系线性映射关系雅可比矩阵雅可比矩阵(简称雅可比简称雅可比)。雅可比矩阵不仅用来表示操作空间与关节空间雅可比矩阵不仅用来表示操作空间与关节空间之间的速度线性映射关系，同时也用来表示两之间的速度线性映射关系，同时也用来表示两空间之间力的传递关系。空间之间力的传递关系。第三页，本课件共有52页4.1 雅可比矩雅可比矩阵阵的定的定义义 把机器人关节速度向量把机器人关节速度向量把机器人关节速度向量把机器人关节速度向量 定义为：定义为：定义为：定
3、义为：式中，式中，为连杆为连杆i相对相对i-1的角速度或的角速度或线速度。线速度。第四页，本课件共有52页手抓在基坐标系中的广义速度向量为：手抓在基坐标系中的广义速度向量为：式中，式中，式中，式中，v v为线速度，为线速度，为线速度，为线速度，为角速度分量。为角速度分量。为角速度分量。为角速度分量。第五页，本课件共有52页 从关节空间速度向操作空间速度映射的线从关节空间速度向操作空间速度映射的线性关系称为雅可比矩阵，记为性关系称为雅可比矩阵，记为J，即：，即：4-3第六页，本课件共有52页 在数学上，机器人终端手抓的广义位置（位在数学上，机器人终端手抓的广义位置（位姿）矢量姿）矢量P可写成：可
4、写成：上式对时间求导，有：上式对时间求导，有：4-5第七页，本课件共有52页 对照式对照式4-3和式和式4-5，可知：，可知：第八页，本课件共有52页 在机器人学中，在机器人学中，J J是一个把关节速度向量是一个把关节速度向量 变换变换为手爪相对基坐标的广义速度向量的变换矩阵。在三为手爪相对基坐标的广义速度向量的变换矩阵。在三维空间运行的机器人，其维空间运行的机器人，其J J阵的行数恒为阵的行数恒为6(6(沿沿/绕基坐绕基坐标系的变量共标系的变量共6 6个个)；列数则为机械手含有的关节数目。；列数则为机械手含有的关节数目。对于平面运动的机器人来说，手的广义位置向量对于平面运动的机器人来说，手的
5、广义位置向量 均容易确定，可采用直接微分法求均容易确定，可采用直接微分法求J J，比较方便。，比较方便。第九页，本课件共有52页 对于三维空间运行的机器人则不完全适用。对于三维空间运行的机器人则不完全适用。从三维从三维空间运行的机器人运动学方程，可以获得直角坐标位空间运行的机器人运动学方程，可以获得直角坐标位置向量置向量 的显式方程，因此，的显式方程，因此，J J的前三行可以直的前三行可以直接微分求得，但不可能找到方位向量接微分求得，但不可能找到方位向量 的一般表达式。找不出互相独立的、无顺的一般表达式。找不出互相独立的、无顺序的三个转角来描述方位绕直角坐标轴的连续角序的三个转角来描述方位绕直
6、角坐标轴的连续角运动变换是不可交换的，而对角位移的微分与对角运动变换是不可交换的，而对角位移的微分与对角位移的形成顺序无关，故一般不能运用直接微分法位移的形成顺序无关，故一般不能运用直接微分法来获得来获得J J的后三行。因此，常用构造性方法求雅可比的后三行。因此，常用构造性方法求雅可比J J。第十页，本课件共有52页4.2 微分运微分运动动与广与广义义速度速度 刚体或坐标系的微分运动包括微分移动矢量刚体或坐标系的微分运动包括微分移动矢量d和微分转动矢量和微分转动矢量。前者由沿三个坐标轴的微分移。前者由沿三个坐标轴的微分移动组成，后者由绕三个坐标轴的微分转动组成，即动组成，后者由绕三个坐标轴的微
7、分转动组成，即 或或 或或第十一页，本课件共有52页刚体或坐标系的微分运动矢量刚体或坐标系的微分运动矢量刚体或坐标系的微分运动矢量刚体或坐标系的微分运动矢量刚体或坐标系的广义速度刚体或坐标系的广义速度刚体或坐标系的广义速度刚体或坐标系的广义速度第十二页，本课件共有52页简写为：简写为：简写为：简写为：第十三页，本课件共有52页其中，其中，其中，其中，R R R R是旋转矩阵是旋转矩阵是旋转矩阵是旋转矩阵S(P)S(P)S(P)S(P)为矢量为矢量为矢量为矢量P P P P的反对称矩阵的反对称矩阵的反对称矩阵的反对称矩阵S(P)S(P)S(P)S(P)矩阵具有以下性质：矩阵具有以下性质：矩阵具有
8、以下性质：矩阵具有以下性质：第十四页，本课件共有52页相应的，广义速度相应的，广义速度V V的坐标变换为：的坐标变换为：任意两坐标系任意两坐标系A A和和B B之间广义速度的坐标变换为：之间广义速度的坐标变换为：第十五页，本课件共有52页4.3 雅可比矩雅可比矩阵阵的构造法的构造法 构造雅可比矩阵的方法有矢量积法和微分变换法，构造雅可比矩阵的方法有矢量积法和微分变换法，构造雅可比矩阵的方法有矢量积法和微分变换法，构造雅可比矩阵的方法有矢量积法和微分变换法，雅可比矩阵雅可比矩阵雅可比矩阵雅可比矩阵J(q)J(q)既可当成是从关节空间向操作空间的速既可当成是从关节空间向操作空间的速既可当成是从关节
9、空间向操作空间的速既可当成是从关节空间向操作空间的速度传递的线性关系，也可看成是微分运动转换的线性度传递的线性关系，也可看成是微分运动转换的线性度传递的线性关系，也可看成是微分运动转换的线性度传递的线性关系，也可看成是微分运动转换的线性关系，即：关系，即：关系，即：关系，即：第十六页，本课件共有52页 对于有对于有n n个关节的机器人，其雅可比矩阵个关节的机器人，其雅可比矩阵J(q)是是是是6n6n6n6n阶矩阵，其前三行称为位置雅可比矩阵，代表对手阶矩阵，其前三行称为位置雅可比矩阵，代表对手阶矩阵，其前三行称为位置雅可比矩阵，代表对手阶矩阵，其前三行称为位置雅可比矩阵，代表对手爪线速度爪线速
10、度爪线速度爪线速度v v v v的传递比，后三行称为方位矩阵，代表相应的的传递比，后三行称为方位矩阵，代表相应的的传递比，后三行称为方位矩阵，代表相应的的传递比，后三行称为方位矩阵，代表相应的关节速度关节速度关节速度关节速度 对手爪的角速度对手爪的角速度对手爪的角速度对手爪的角速度的传递比。因此，可的传递比。因此，可将雅可比矩阵将雅可比矩阵J(q)分块，即：分块，即：式中，式中，式中，式中，J Jli li和和和和J Jaiai分别表示关节分别表示关节分别表示关节分别表示关节i i的单位关节速度引起手爪的线速的单位关节速度引起手爪的线速的单位关节速度引起手爪的线速的单位关节速度引起手爪的线速度
11、和角速度。度和角速度。度和角速度。度和角速度。第十七页，本课件共有52页雅可比矩阵的求解（矢量积法）：雅可比矩阵的求解（矢量积法）：J Jli li的求法：的求法：的求法：的求法：(1)(1)第第第第i i关节为移动关节时关节为移动关节时关节为移动关节时关节为移动关节时仅平移关节产生的线速度仅平移关节产生的线速度仅平移关节产生的线速度仅平移关节产生的线速度第十八页，本课件共有52页设某时刻仅此关节运动、其余的关节静止不动，则：设某时刻仅此关节运动、其余的关节静止不动，则：设设b bi-1i-1为为z zi-1i-1轴上的单位矢量，利用它可将局部坐标下的平移轴上的单位矢量，利用它可将局部坐标下的
12、平移速度速度didi转换成基础坐标下的速度：转换成基础坐标下的速度：由于由于所以所以第十九页，本课件共有52页(2)(2)第第i i个关节为转动关个关节为转动关节时，节时，设设某时刻仅此关节运动，某时刻仅此关节运动，其余的关节静止不动，其余的关节静止不动，仍然利用仍然利用b bi-1i-1将将z zi-1i-1轴上轴上的角速度转化到基础的角速度转化到基础坐标中去坐标中去仅旋转关节产生的线速度仅旋转关节产生的线速度仅旋转关节产生的线速度仅旋转关节产生的线速度第二十页，本课件共有52页矢量矢量 起于起于O Oi-1i-1，止于，止于O On n，所以由，所以由i i产生的线速度为产生的线速度为:第
13、二十一页，本课件共有52页由于由于所以所以第二十二页，本课件共有52页雅可比矩阵的求解：雅可比矩阵的求解：J Jaiai的求法：的求法：的求法：的求法：(1)(1)第第第第i i关节为移动关节时关节为移动关节时关节为移动关节时关节为移动关节时由于关节移动的平移不对手部产生角速度，所以此时由于关节移动的平移不对手部产生角速度，所以此时由于关节移动的平移不对手部产生角速度，所以此时由于关节移动的平移不对手部产生角速度，所以此时(2)(2)第第第第i i关节为转动关节时，关节为转动关节时，关节为转动关节时，关节为转动关节时，所以所以所以所以第二十三页，本课件共有52页当第当第当第当第i i关节为移动
14、关节时关节为移动关节时关节为移动关节时关节为移动关节时当第当第当第当第i i关节为转动关节时关节为转动关节时关节为转动关节时关节为转动关节时第二十四页，本课件共有52页确定确定确定确定1 1、用、用b b表示表示z zi-1i-1轴上的单位向量轴上的单位向量把它转换到基础坐标系中，即为把它转换到基础坐标系中，即为第二十五页，本课件共有52页 如右图所示。用如右图所示。用O O、O Oi-1i-1、O On n分分别表示基础坐标系、别表示基础坐标系、i-1i-1号坐号坐标及手部坐标系的原点。用矢标及手部坐标系的原点。用矢量量x x表示在各自坐标系中的原表示在各自坐标系中的原点。点。把把用齐次坐标
15、表示用齐次坐标表示第二十六页，本课件共有52页有上式可以确定有上式可以确定第二十七页，本课件共有52页例例2-6：建立：建立右图的雅可右图的雅可比矩阵比矩阵第二十八页，本课件共有52页第二十九页，本课件共有52页机械臂末端的速度为机械臂末端的速度为第三十页，本课件共有52页微分变换法微分变换法 对于转动关节对于转动关节 第三十一页，本课件共有52页对于移动关节对于移动关节 第三十二页，本课件共有52页对于移动关节对于移动关节 对于转动关节对于转动关节 第三十三页，本课件共有52页例：例：PUMA560PUMA560的的6 6个关节都是转动关节，其雅可比有个关节都是转动关节，其雅可比有6 6列。
16、列。此处用矢量积法计算此处用矢量积法计算J(q)J(q)第三十四页，本课件共有52页第三十五页，本课件共有52页第三十六页，本课件共有52页第三十七页，本课件共有52页例：斯坦福六自由度机器人除第三关节为移动关节例：斯坦福六自由度机器人除第三关节为移动关节外，其余外，其余5 5个关节为转动关节。此处用微分法计算个关节为转动关节。此处用微分法计算T TJ(q)J(q)第三十八页，本课件共有52页第三十九页，本课件共有52页第四十页，本课件共有52页 若给定机器人终端手抓的广义速度向量若给定机器人终端手抓的广义速度向量V，则可，则可由下式解出相应的关节速度：由下式解出相应的关节速度：逆雅可比矩阵逆
17、雅可比矩阵 上式中，上式中，称为逆雅可比矩阵，称为逆雅可比矩阵，为加给对为加给对应关节伺服系统的速度输入变量。应关节伺服系统的速度输入变量。第四十一页，本课件共有52页雅可比矩阵的应用雅可比矩阵的应用1 1、分离速度控制、分离速度控制 由上式可见，当已知手端速度向量由上式可见，当已知手端速度向量V V，可通过左乘雅，可通过左乘雅可比逆矩阵计算出机器人的关节速度向量，所以上式为运可比逆矩阵计算出机器人的关节速度向量，所以上式为运动学逆问题的速度关系式，是对机器人进行速度控制的基动学逆问题的速度关系式，是对机器人进行速度控制的基本关系式。本关系式。第四十二页，本课件共有52页 采用计算机控制时，把
18、速度表示位置增量的形采用计算机控制时，把速度表示位置增量的形式，故将上式写为：式，故将上式写为：式中式中,v v为手部为手部在基础坐标下一在基础坐标下一个采样周期的位个采样周期的位移移(线位移、角位线位移、角位移移)；q q为在同为在同一周期内关节变一周期内关节变量的增量。量的增量。第四十三页，本课件共有52页 当要求机器人沿某轨迹运动时，当要求机器人沿某轨迹运动时，v为已知，将它为已知，将它代入上式中求得关节变量增量代入上式中求得关节变量增量q，于是可确定各关节变，于是可确定各关节变量值，由伺服系统实现位置控制，这就是分离速度控制原量值，由伺服系统实现位置控制，这就是分离速度控制原理，如下图
19、所示。理，如下图所示。v要求要求v实际实际分离速度控制原理分离速度控制原理第四十四页，本课件共有52页雅可比矩阵的应用雅可比矩阵的应用2 2、在静力分析中的应用、在静力分析中的应用 有些机器人的工作需要与环境接有些机器人的工作需要与环境接触，并保持一定的接触力，如右图所触，并保持一定的接触力，如右图所示。接触力示。接触力F F可表示为一个六维力向可表示为一个六维力向量：量：设一个驱动器只驱动一个关节，则设一个驱动器只驱动一个关节，则n n个关节需求个关节需求n n个驱个驱动力，可组成一个动力，可组成一个n n维关节力向量维关节力向量:第四十五页，本课件共有52页T T与与F F的关系可以表示为
20、：的关系可以表示为：2-56第四十六页，本课件共有52页 式中，式中，称为机器人称为机器人力雅可比力雅可比，它表示在静止，它表示在静止平衡状态下，末端广义力向关节力映射的线性关平衡状态下，末端广义力向关节力映射的线性关系。显然，力雅可比是机器人速度雅可比的转置。系。显然，力雅可比是机器人速度雅可比的转置。因此，机器人静力学传递关系和速度传递关系紧因此，机器人静力学传递关系和速度传递关系紧密相关。密相关。第四十七页，本课件共有52页第四十八页，本课件共有52页由构型和例由构型和例2-62-6可得：可得：第四十九页，本课件共有52页第五十页，本课件共有52页思考题思考题1 1：右图为三自由度机械手
21、右图为三自由度机械手(1)(1)用用D-HD-H方法建立各附体坐标系；方法建立各附体坐标系；(2)(2)列出连杆的列出连杆的D-HD-H参数表；参数表；(3)(3)建立运动学方程；建立运动学方程；(4)(4)建立雅可比矩阵。建立雅可比矩阵。图图1第五十一页，本课件共有52页思考题思考题2 2：对图对图1 1的三自由度机械手，取的三自由度机械手，取1 10,0,2 29090，3 39090的姿的姿态态(如图如图2)2)，试分别求出生成手爪力，试分别求出生成手爪力F FA Affx x,0,0,0,0T T，F FB B0,fy,00,fy,0T T,F FC C0,0,N0,0,NT T的驱动力矩的驱动力矩A A,B,C。图图1图图2第五十二页，本课件共有52页