机器人模型与控制-5动力学模型.ppt
- 文档编号:14742357
- 上传时间:2023-06-26
- 格式:PPT
- 页数:43
- 大小:243KB
机器人模型与控制-5动力学模型.ppt
《机器人模型与控制-5动力学模型.ppt》由会员分享,可在线阅读,更多相关《机器人模型与控制-5动力学模型.ppt(43页珍藏版)》请在冰点文库上搜索。
5.动力学模型动力学模型动力学是研究物体的运动和作用力之间的关系。
操作臂是一个复杂的动力学系统,由于系统由多个关节和连杆组成,且位形、速度和加速度都是耦合的,因此系统具有严重的非线性。
操作臂动力学反映的是多输入、多输出、多变量的耦合非线性系统动态特性。
动力学模型将力与位置、速度和加速度联系起来,实际上可看作是动力学方程,且是一个非线性微分方程组。
由力求位置、速度、加速度等运动学特征称为动力学原(正)问题,一般情况下根本不可能求解;已知运动学特征求驱动力称为动力学逆问题。
研究机器人动力学的目的:
研究机器人动力学的目的:
(1)为了实时控制:
在控制算法中包含动力学信息(反馈线性化、前馈),以期达到更好的动态特性;但是动力学信息的完整性与计算实时性之间存在矛盾,因此需要做适当的假设简化,随着计算机技术的飞速发展,这一矛盾可以在某种程度上得到解决;可以设计包含简化动力学信息的控制规律,甚至不包含动力学信息的控制规律,在详细动力学模型上进行控制仿真。
(2)动态设计与仿真:
设计人员可以根据连杆的质量、负载大小、传动机构特征、驱动能力进行动态仿真,以选择适当的参数,改进设计,获得动态性能更好的操作臂。
获得机器人动力学模型的方法很多:
拉格朗日算法、牛顿欧拉法、凯恩方程算法等
(1)拉格朗日方法:
一种能量方法,能以最简单的形式求得非常复杂的系统动力学方程,而且具有显示结构,可用于定性分析。
(2)牛顿欧拉法:
一种递推方法,基于运动坐标系和达朗伯原理,从操作臂末端开始,把驱动力作为位置、速度和加速度的函数精确地计算出来,没有多余信息,计算速度快,可用于控制时的实时计算。
5.1拉格朗日动力学拉格朗日动力学对于任何机械系统,拉格朗日函数定义为系统的动能和势能之差pkEEL系统的动能和势能可以用任意坐标系来表示,比如广义坐标,不限于笛卡儿坐标。
iq第二类拉格朗日方程iiiqLqLdtd式中:
为广义坐标,为广义速度,为广义力(若是直线坐标,则是力;若是角度坐标,则是力矩)。
iqiqiiqiiqi由于势能中不含显式的广义速度,因此拉格朗日方程还可写成ipikikiqEqEqEdtd例:
例:
图示RP机械手有2个关节组成,连杆质量(均为集中质量)分别为m1和m2,质心位置分别为r1和r,广义坐标为和r。
(1)求质心速度连杆1的质心速度sincos1111ryrxcossin1111ryrx221212121ryxv连杆2的质心速度sincos22ryrxcossinsincos22rryrrx222222222rryxv
(2)求系统的动能和势能连杆1的动能连杆2的动能2211121rmEk2222221rrmEk系统总动能222222211212121rmrmrmEk连杆2的势能系统总势能连杆1的势能sin111grmEpsin22grmEpsinsin211grmgrmEp
(2)求系统的动力学方程拉格朗日函数拉格朗日方程写成矩阵形式sinsin212121211222222211grmgrmrmrmrmEELpkcos2211222211grmrmrrmrmrmLLdtdsin2222gmrmrmrLrLdtdr重力项向心力项哥氏力项性力惯项sincos2002211222222211gmgrmrmrmrrmrmrmrmr5.2惯性张量和惯性矩阵惯性张量和惯性矩阵前面例中将各连杆质量集中到一点,实际上各连杆质量是连续分布的。
因此这里需要引入惯性张量和惯性矩阵的概念,用于描述连杆的质量分布。
张量张量(Tensor)是n维空间内,有nr个分量的一种量,其中每个分量都是坐标的函数,而在坐标变换时,这些分量也依照某些规则作线性变换。
r称为该张量的阶(Rank),零阶张量(r=0)为标量(Scale),一阶张量(r=1)为向量(Vector),二阶张量(r=2)则成为矩阵(Matrix)。
数学定义:
由若干坐标系改变时满足一定坐标转化关系的有序数组成的集合为张量。
刚体移动时,涉及到质量参数;刚体转动时,涉及到惯性矩。
刚体的质量分布由惯性矩和惯性积共同描述,惯性矩和惯性积共同组成惯性张量。
惯性矩惯性矩(momentofinertia):
物体相对于某坐标轴而言的,质量微元dm和此微元到某坐标轴的最短距离的平方之积,再对整个物体质量进行积分。
惯性积惯性积(productofinertia):
物体相对于一组相互正交的两平面而言的,质量微元dm和此微元到各平面的最短距离的乘积,再对整个物体质量进行积分。
mVzzmVyymVxxdmyxdVyxIdmxzdVxzIdmzydVzyI222222222222mVzxmVyzmVxyzxdmdVzxIyzdmdVyzIxydmdVxyI惯性张量惯性张量:
贯性矩与惯性积的组合zzyzzxyzyyxyzxxyxxAIIIIIIIIII惯性张量与坐标系的选取有关,如果选取的坐标系方位使得各惯性积均为零,此时惯性张量为对角型,此坐标系的各轴称为刚体的惯性主轴惯性主轴,相应的惯性矩称为主惯性矩主惯性矩。
mAdmyxyzxzyzzxxyxzxyzy222222I惯性张量的元素是刚体相对于某坐标系的质量分布的二阶矩二阶矩。
在机器人学中通常以齐次坐标来描述点的位置,因此在下面推导动力学模型过程中要用到另外一种质量分布表达,称为伪惯性矩阵伪惯性矩阵。
包含质量和一阶矩项T1zyxrmmVdmzyxzzyzxzyyzyxyxxzxyxdmdV1222TTrrrrJmVmVmVVzdmdVzzmydmdVyymxdmdVxxmdVm表示刚体的质心位置zyx,定义相对于原点的惯性矩为,则伪惯性矩阵可表示为。
zzyyxxoIIIImzmymxmzmIIIIymIIIIxmIIIIzzoyzxzyzyyoxyxzxyxxo222J伪惯性矩阵也与坐标系的选取有关,如果选取坐标系原点在质心上,同时选取坐标轴方向使各惯性积为零,则此坐标系称为刚体主坐标系主坐标系;相对于主坐标系而言,刚体的伪惯性矩阵为对角型对角型的。
如果将现有坐标系A平移到质心C处,则根据平行移轴定理,刚体相对于两坐标系的贯性矩和惯性积存在以下关系表示成矢量形式222222CCzzCzzACCyyCyyACCxxCxxAyxmIIzxmIIzymIIT3TCCCCCAmPPIPPIICCzxCzxACCyzCyzACCxyCxyAxmzIIzmyIIymxII式中:
I3为的单位矩阵;为质心相对于坐标系A的位置矢量。
TCCCCzyxP例:
例:
求图示密度为的均匀长方体的惯性张量和伪惯性矩阵。
质量lwhm质心坐标222hzlywx惯性矩220002222000222200022333lwmdzdydxyxIwhmdzdydxxzIhlmdzdydxzyIhlwzzhlwyyhlwxx惯性积hwmdzdydxzxIlhmdzdydxyzIwlmdzdydxxyIhlwzxhlwyzhlwxy444000000000惯性张量伪惯性矩阵伪惯性矩阵如果将坐标系移到长方体中心处,惯性张量和伪惯性矩阵都为对角阵:
222222344434443lwmhwmlhmhwmwhmwlmlhmwlmhlmI22232hlwmIIIIzzyyxxomhmlmwmhmhmhwmlhmlmhwmlmwlmwmlhmwlmwm222234424342443222J222222120001200012lwmwhmhlmCImhmlmwmC000012000012000012222J5.3操作臂的拉格朗日方程操作臂的拉格朗日方程利用拉格朗日方法推导操作臂的动力学模型的步骤:
计算连杆各点的速度;计算系统的动能;计算系统的势能;构造拉格朗日函数;推导动力学方程(拉格朗日方程)。
下面详细讨论上述步骤一、连杆各点的速度假定连杆i上的一点对坐标系i的齐次坐标为ir,对基坐标系0的齐次坐标为0r,则有X0Y0Z0XiYiZiir0rrTrii00该点的速度rTrriijjjiqqdtd1000速度的平方(可以用求矩阵迹来代替矢量点乘,矩阵对角元素之和称为该矩阵的迹(trace),记作tr(A),变换乘法和求和的顺序)ijikkjkiiijiiikkkiiijjjiqqqqqqqq11T0T0T1010T000T0TrTrTrTrrTrTrTrrrr二、系统的动能在连杆i的ir处,质量为dm的质点的动能为X0Y0Z0XiYiZiir0r连杆i的动能为ijikkjkiiijiijikkjkiiijikiqqqmqqqqqmmE11T0T011T0T00T0dTr21Trd21d21dTrrTTrrTrrijikkjkiijiijikkjkiiiiijiikikiqqqqqqqmqmEEi11T0011T0linkT00T0linkTr21dTr21d21dTJTTrrTrrJ性矩伪惯阵的杆连整个操作臂(n个连杆)的总动能为X0Y0Z0XiYiZiir0r除各连杆的动能之外,关节的动能(主要指传动机构动能,驱动器动能通常在控制器中考虑)也不能忽视,可表示为niijikkjkiijinikikqqqqEE111T001Tr21TJT221iaikaiqIE式中为广义等效惯量,对于移动关节是等效质量,对于转动关节是等效惯性矩。
aiI把连杆动能与关节动能相加,并交换求迹运算与求和运算的顺序得到操作臂的系统动能niiaiijikkjkiijinikikqIqqqqEE1211T001Tr21TJT三、系统的势能连杆i的势能(相对于基坐标系)为重力做功的负为X0Y0Z0XiYiZiir0r操作臂的总势能为iCiiiiCipimmErTgrg00式中:
mi为连杆i的质量,为重力行矢量,、分别为连杆i在坐标系i和0中的质心位置矢量。
0zyxggggiCiriCr0niiCiiipmE10rTg四、拉格朗日函数niiCiiiniiaiijikkjkiijipkmqIqqqqEEL101211T00Tr21rTgTJT五、操作臂的动力学方程利用拉格朗日方程可以得到关节i的广义驱动力inijjCjijjnijjkjmmkmkjjijiainijjkkkjjijiiiqmqqqqqqIqqqqLqLdtdrTgTJTTJT011T0201T00TrTr上式可写成inknmmkikmnkkikiGqqhqD111式中:
kikiIqqDikikainkijkjjijik,0,1,Tr,maxT00TJTnmkijmkjjijikmqqqh,maxT020TrTJTnijjCjijjiqmGrTg0整个操作臂的动力学方程写成矩阵形式关节驱动力矢量式中:
tttttqGtqqhqqD,Tntttt21Tntqtqtqt21q关节位置矢量关节速度矢量Tntqtqtqt21qTntqtqtqt21q为操作臂质量矩阵,nn对称,元素为qDikDTnhhh21,qqh为非线性哥氏力和离心力矢量,元素为nknmmkikmiqqhh11(km时为离心力;km时为哥氏力)TnGGG21qG为重力矢量,元素为Gi的物理意义:
、iG、ikD、ikmh5.4牛顿欧拉递推动力学公式牛顿欧拉递推动力学公式牛顿欧拉法基于达朗贝尔原理;惯性载荷由两部分组成:
(刚体运动随质心移动+绕质心转动)牛顿第二定律(力平衡方程)欧拉方程(力矩平衡方程)“对于任何物体,外加力和运动阻力(惯性力)在任何方向上的代数和为零。
”iiiCiCiCmdtmdvvfiiCiiiCiiCCdtdiIIImgmiiCiiiiiiiiffRf111gmiiCiCiCiiiiiiiiiiiiiiiifrmfRPmRm11111110111gmiiiiiiiifRfiCif01111111gmiiCiiiiiiiiiiiiiirfRPmRmiiiCiCiCifrm解得利用牛顿欧拉方法递推求操作臂的动力学模型的算法由三部分组成:
首先由连杆1到连杆n递推计算各连杆的速度和加速度;再由牛顿欧拉公式算出各连杆的惯性力和惯性力矩;最后根据达朗伯原理从连杆n到连杆1递推计算各连杆内部相互作用力和力矩,以及关节驱动力和力矩。
操作臂连杆间的运动传递:
(1)旋转关节的速度和加速度传递)旋转关节的速度和加速度传递连杆i+1的角速度角速度10010iiiiiR其中1111111100iTiiiiiiiiiRzR将角速度对时间求导1001001010010iiiiiiiiiiiiiiiiSRRRR其中11110111111111iiiiiiiiiiiiiiiiizRzRzR因此,连杆i+1的角加速度角加速度10011101010iiiiiiiiiiSRzR10010iiiiiPRPP连杆i+1坐标原点的位置位置100010010iiiiiiiiiiSPRPPRPP对上式求导,得连杆i+1坐标原点的速度速度100010iiiiiiSPRvv继续求导,得连杆i+1坐标原点的加速度加速度10001000100100010iiiiiiiiiiiiiiiiiiiiSSSSSPRPRvPRPRvv
(2)移动关节的速度和加速度传递)移动关节的速度和加速度传递连杆i+1的角速度角速度ii010其中将角速度对时间求导,得到角加速度角加速度ii01010010iiiiiPRPP连杆i+1坐标原点的位置位置1010010iiiiiiiiPRPRPP对上式求导,得连杆i+1坐标原点的速度速度继续求导,得连杆i+1坐标原点的加速度加速度1111111100iTiiiiiiiiiddRzRP整理得到连杆i+1坐标原点的速度速度11101100010iiiiiiiiiidSzRPRvv1110111101010001000102iiiiiiiiiiiiiiiiiiiiddSSSSzRzRPRPRvv(3)质心的加速度)质心的加速度连杆i的质心位置质心位置CiiiiCiPRPP000CiiiiiCiiiiCiSPRPPRPP000000对上式求导,得连杆i的质心速度质心速度CiiiiiCiSPRvv0000继续求导,得连杆i的质心加速度质心加速度CiiiiiCiiiiiCiiiiCiiiiiCiSSSSSPRPRvPRPRvv000000000000(4)递推公式)递推公式符号说明符号说明:
jui表示坐标系i相对于j的运动学量在j中的表达;表示坐标系i相对于j的运动学量在k中的表达。
)()(01111011010110移动关节旋转关节iiiiiiiiiiiiiiiRzRR进一步得到)()(0111101111011010110移动关节旋转关节iiiiiiiiiiiiiiiiiiiiiiRzRzRR)
(2)(111111110100100110010011010110移动关节旋转关节iiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiddzzPPvRPPvRvRvCiiiiiiCiiiiiiCiiiCiPPvvRv0000000kiju牛顿欧拉法递推过程具体步骤如下:
(1)向外递推计算连杆速度和加速度(i:
1n)CiiiCiimvfiiCiiiiiiCiiCiiIIm000
(2)计算关节驱动力或力矩(牛顿第二定律)(欧拉方程))()(11011101000移动关节旋转关节iiiiiiiiiiiiiiiRzRR)()(110111011101000移动关节旋转关节iiiiiiiiiiiiiiiiiiiiiiRzRzRR)
(2)(0111011011101101111011011101101000移动关节旋转关节iiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiddzzPPvRPPvRvRvCiiiiiiCiiiiiiCiiiCiPPvvRv0000000(3)向内递推计算力和力矩(i:
n1)gffRfiiCiiiiiiiim111gfrmfRPmRmiiCiiCiiCiiiiiiiiiiiiiim1111111关节驱动力或力矩)()(TT移动关节转动关节iiiiiiiiiZfZn说明:
说明:
做速度和加速度递推时,当i=1,有000000110000110000110vviiiiii做力和力矩递推时,当i=n,有RRRmmmfffnTnniiTTnniiTTnnii1111111111表示末端手抓对环境的作用力表示末端手抓对环境的作用力矩表示手抓相对于末端连杆的姿态5.5不同空间的动力学模型不同空间的动力学模型关节空间的状态方程qGqqhqqD,形位空间的动力学方程qGqqCqqqBqqD2将与速度有关的项分成两部分2,qqCqqqBqqh系数矩阵都只是形位的函数;为哥氏力系数矩阵,维;qB21nnn为离心力系数矩阵,维;qCnn为关节速度积矢量,维;T)1(3121nnqqqqqqqq21nn操作空间动力学方程利用和,得到如果可逆,则存在qPqqUXqVF,FqJTqGqqhqqD,qJqVqJqDTqqJqVqqUqJqqh,TqPqJqGTqJqJFT-qJqDqJqV1T-qqJqVqqhqJqqU,T-qGqJqPT-5.6基于雅可比矩阵的拉格朗日方基于雅可比矩阵的拉格朗日方程程对于n连杆机械臂,连杆i的速度和角速度可表示为整个机械臂的动能为整个机械臂的动能为qqJviii,展开qqJqqJviivii连杆i的质量为mi;相对于坐标系i的惯性张量为Ii,将其坐标轴方向变换到参考坐标系中为qRIqRTiiiqqDqqqJqRIqRqJqJqJqTniiTiiiTiviTviiTkmE21211定义惯性矩阵niiTiiiTiviTviim1qJqRIqRqJqJqJqD惯性矩阵D(q)与构型有关,为对称正定矩阵,元素以dij表示。
对称性显而易见;正定性可由动能总是非负,及当且仅当速度为零时动能为零得出来。
有利于控制系统定性分析各关节速度产生的连杆线线速度,3n各关节速度产生的连杆角角速度,3nviJiJ整个机械臂的势能整个机械臂的势能在刚体动力学的情况下,势能的唯一来源就是重力。
第i个连杆的势能可以通过假定其所有的质量集中在它的质量中心来计算CiTiPimErgg是在惯性坐标系下重力向量,rCi是第个连杆质量中心的坐标向量如果机器人有弹性,势能还包括弹性势能。
注意注意:
势能仅仅是广义坐标的函数,而不是广义坐标微分变量的函数。
整个机械臂的势能niCiTiniPiPmEE11rg拉格朗日函数拉格朗日函数以关节k为例qPijjiijPkEqqdEEL21jjkjkqdqLijjiikjjjkjjjkjjjkjkqqqdqdqddtdqdqLdtdkPijjikijkqEqqqdqL21代入拉格朗日方程kkkqLqLdtd运动方程运动方程kkPijjikijikjjjkjqEqqqdqdqd21通过交换和并且利用对称性,可以得到ijjijkiikjijjiikjqqqdqdqqqd21因此ijjiijkijjikijjkiikjijjikijikjqqcqqqdqdqdqqqdqd2121定义kijjkiikjijkqdqdqdc21注意:
注意:
对于给定的k,有cijkcjik定义kPkqEgkkninjjiijkjjkjgqqcqdqq11上面的方程中包括了三类项:
第一类包括了对广义坐标的二次导数;第二类包括了q的一阶导数的平方,其系数取决于q,可进一步分成包括的项(离心力)和包括的项(科氏力);第三类只包括但是没有它的导数的项。
的第(k,j)个元素定义为写成矩阵形式写成矩阵形式qqC,因此,拉格朗日运动方程2iqjiqqqGqqqCqqD,niikijjkiikjniiijkjkqqdqdqdqcC11,21q为重力矢量qGTnggqqqG15.7机器人动力学方程的性质机器人动力学方程的性质反对称性和保守性反对称性和保守性qqNqqCqD,2是反对称矩阵。
交换下标,并考虑D(q)的对称性,可得到证明:
证明:
的第(k,j)个元素qDniiikjkjqqdd1因此,矩阵N的第(k,j)个元素niijkikijniikijjkiikjikjkjkjkjqqdqdqqdqdqdqdCdn112kjjknn证毕。
证毕。
保守性:
是指存在一个常数,使得证明:
证明:
定义系统的总能量0,0TdtttTTq指的是系统在时间0,T内所产生的能量,保守性说明了系统所产生的能量有一个最低值。
0TTdttt0qqqqDqPTEH21求导qqqqDqqqDqPTTTEH21用运动方程代替,并令qqGEPqqDqqqqCqDqqTTTH0,221上式对时间积分000HHTHdtttTTq因为非负,因此保守性满足并且0HTH惯性矩阵的有界性惯性矩阵的有界性假定惯性矩阵D(q)有n个特征值nnnnnIqqDIq1qqn10由于D(q)正定,因此
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 机器人 模型 控制 动力学