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