CN108959829B - 基于轴不变量的非理想关节机器人动力学建模方法 - Google Patents
基于轴不变量的非理想关节机器人动力学建模方法 Download PDFInfo
- Publication number
- CN108959829B CN108959829B CN201810933654.8A CN201810933654A CN108959829B CN 108959829 B CN108959829 B CN 108959829B CN 201810933654 A CN201810933654 A CN 201810933654A CN 108959829 B CN108959829 B CN 108959829B
- Authority
- CN
- China
- Prior art keywords
- axis
- force
- formula
- moment
- constraint
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 54
- 239000013598 vector Substances 0.000 claims description 86
- 239000011159 matrix material Substances 0.000 claims description 63
- 238000013519 translation Methods 0.000 claims description 29
- 230000001133 acceleration Effects 0.000 claims description 17
- 230000000452 restraining effect Effects 0.000 claims description 16
- 238000004364 calculation method Methods 0.000 claims description 15
- 230000005484 gravity Effects 0.000 claims description 12
- 241000764238 Isis Species 0.000 claims description 4
- 230000000295 complement effect Effects 0.000 claims description 4
- 241000372285 Isanda Species 0.000 claims description 3
- 241000287196 Asthenes Species 0.000 claims description 2
- 230000002146 bilateral effect Effects 0.000 claims description 2
- 238000005303 weighing Methods 0.000 claims description 2
- 230000014509 gene expression Effects 0.000 description 20
- 230000008569 process Effects 0.000 description 18
- 238000009795 derivation Methods 0.000 description 10
- 239000002245 particle Substances 0.000 description 9
- 230000008901 benefit Effects 0.000 description 8
- 230000009466 transformation Effects 0.000 description 5
- 239000000654 additive Substances 0.000 description 4
- 230000000996 additive effect Effects 0.000 description 4
- 230000009977 dual effect Effects 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 238000005094 computer simulation Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 241001061260 Emmelichthys struhsakeri Species 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 238000005511 kinetic theory Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 229940037201 oris Drugs 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000005631 quantum field theories Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 208000011580 syndromic disease Diseases 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于轴不变量的非理想关节机器人动力学与解算方法,对于非理想约束系统,建立了闭链刚体非理想约束系统的Ju‑Kane动力学方程。以关节空间自然轴链为基础的Ju‑Kane闭链刚体动力学克服了笛卡尔坐标轴链空间的局限:在基于笛卡尔坐标轴链的牛顿欧拉动力学中,非树运动副约束不能表达如齿条与齿轮、蜗轮与蜗杆等约束。而本申请的非树约束副的约束代数方程式可表达任一种约束类形,并且物理内涵明晰;降低了系统方程求解的复杂度;保证了约束方程的准确性。
Description
技术领域
本发明涉及一种非理想关节机器人动力学建模与解算方法,属于机器人技术领域。
背景技术
拉格朗日在研究月球天平动问题时提出了拉格朗日方法,是以广义坐标表达动力学方程的基本方法;同时,也是描述量子场论的基本方法。应用拉格朗日法建立动力学方程已是一个烦琐的过程,尽管拉格朗日方程依据系统能量的不变性推导系统的动力学方程,具有理论分析上的优势;但是在工程应用中,随着系统自由度的增加,方程推导的复杂性剧增,难以得到普遍应用。凯恩方程建立过程与拉格朗日方程相比,通过系统的偏速度、速度及加速度直接表达动力学方程。故凯恩动力学方法与拉格朗日方法相比,由于省去了系统能量的表达及对时间的求导过程,极大地降低了系统建模的难度。然而,对于高自由度的系统,凯恩动力学建模方法也是难以适用。
拉格朗日方程及凯恩方程极大地推动了多体动力学的研究,以空间算子代数为基础的动力学由于应用了迭代式的过程,计算速度及精度都有了一定程度的提高。这些动力学方法无论是运动学过程还是动力学过程都需要在体空间、体子空间、系统空间及系统子空间中进行复杂的变换,建模过程及模型表达非常复杂,难以满足高自由度系统建模与控制的需求,因此,需要建立动力学模型的简洁表达式;既要保证建模的准确性,又要保证建模的实时性。没有简洁的动力学表达式,就难以保证高自由度系统动力学工程实现的可靠性与准确性。同时,传统非结构化运动学及动力学符号通过注释约定符号内涵,无法被计算机理解,导致计算机不能自主地建立及分析运动学及动力学模型。
发明内容
本发明所要解决的技术问题是提供一种基于轴不变量的非理想关节机器人动力学建模与解算方法。
为解决上述技术问题,本发明采用以下技术方案:
一种基于轴不变量的非理想关节机器人动力学建模方法,其特征是,
给定多轴刚体系统D={A,K,T,NT,F,B},惯性系记为F[i],除了重力外,作用于轴u的合外力及力矩在上的分量分别记为及轴k的质量及质心转动惯量分别记为mk及轴k的重力加速度为驱动轴u的双边驱动力及驱动力矩在上的分量分别记为及环境i对轴l的作用力及作用力矩分别为及iτl;轴u对轴u′的广义约束力记为
设运动轴u的广义内摩擦及粘滞的合力及合力矩分别为根据建立的闭链刚体系统的Ju-Kane动力学方程,计算关节加速度后,计算径向约束力大小及约束力矩大小及再建立如下闭链刚体非理想约束系统的Ju-Kane动力学方程:
【1】轴u及轴u′的Ju-Kane动力学规范方程分别为
【2】非树约束副uku′的约束代数方程为
闭链刚体系统的Ju-Kane动力学方程:
【1】轴u及轴u′的Ju-Kane动力学规范方程分别为
【2】非树约束副uku′的约束代数方程为
其中:
式中:及是3×3的分块矩阵,及是3D矢量;kI表示杆k质心I;轴k的质量及质心转动惯量分别记为mk及 为转动轴u的惯性矩阵;为平动轴u的惯性矩阵;hR为转动轴u的非惯性矩阵;hP为平动轴u的非惯性矩阵;为平动关节角速度;为转动关节角速度。
上式表示运动轴矢量与运动轴约束力具有自然正交补的关系;
其中:
至此,完成了轴径向约束广义力的计算。
考虑广义内摩擦力及粘滞力的基于轴不变量的约束力求解步骤为:
其中:sk[u]─运动轴u的内摩擦系数,ck[u]─运动轴u的粘滞系数;sign()表示取正或负符号;
闭链刚体系统的Ju-Kane动力学方程根据树链Ju-Kane规范型方程建立。
树链Ju-Kane规范型方程
并且,
式中,kI表示杆k质心I;轴k的质量及质心转动惯量分别记为mk及 为转动轴u的惯性矩阵;为平动轴u的惯性矩阵;hR为转动轴u的非惯性矩阵;hP为平动轴u的非惯性矩阵;作用于轴u的合外力及力矩在上的分量分别记为及 作用于轴u的合外力及力矩在上的分量分别记为及驱动轴u的双边驱动力及驱动力矩在上的分量分别记为及环境i对轴l的作用力及作用力矩分别为及itl;llk为取由轴l至轴k的运动链,uL表示获得由轴u及其子树构成的闭子树。
本发明所达到的有益效果:
对于非理想约束系统,建立了闭链刚体非理想约束系统的Ju-Kane动力学方程。
【1】在基于笛卡尔坐标轴链的牛顿欧拉动力学中,非树运动副uku′∈P约束不能表达齿条与齿轮、蜗轮与蜗杆等约束。而本申请建立的非树约束副uku′的约束代数方程可表达任一种约束类形,并且物理内涵明晰;
【2】在基于笛卡尔坐标轴链的牛顿欧拉动力学当中,非树运动副代数约束方程是6D的;而本申请建立的非树约束副的约束代数方程表示是3D非树运动副代数约束方程,从而降低了系统方程求解的复杂度;
【3】在基于笛卡尔坐标轴链的牛顿欧拉动力学当中,非树运动副代数约束方程是关于6D矢量空间绝对加速度的,是关于关节坐标、关节速度的迭代式,具有累积误差;而本申请建立的非树约束副的约束代数方程是关于关节加速度的,保证了约束方程的准确性。
附图说明
图1自然坐标系与轴链;
图2固定轴不变量;
图3、图4为运动轴的内摩擦力及粘滞力示意图。
具体实施方式
下面对本发明作进一步描述。以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
闭链刚体系统具有非常广泛的应用;比如,CE3巡视器的摇臂移动系统是具有差速器的闭链,重载机械臂通常是具有四连杆的闭链系统。同时,实际的运动轴通常包含内摩擦力及粘滞力。因此研究闭链刚体系统的Ju-Kane动力学建模非常必要。
描述运动链的基本拓扑符号及操作是构成运动链拓扑符号系统的基础,定义如下:
【1】运动链由偏序集合(]标识。
【2】A[l]为取轴序列A的成员;因轴名l具有唯一的编号对应于A[l]的序号,故A[l]计算复杂度为O(1)。
计算复杂度O()表示计算过程的操作次数,通常指浮点乘与加的次数。以浮点乘与加的次数表达计算复杂度非常烦琐,故常采用算法循环过程中的主要操作次数;比如:关节位姿、速度、加速度等操作的次数。
定义1自然坐标轴:称与运动轴或测量轴共轴的,具有固定原点的单位参考轴为自然坐标轴,亦称为自然参考轴。
定义2自然坐标系:若多轴系统D处于零位,所有笛卡尔体坐标系方向一致,且体坐标系原点位于运动轴的轴线上,则该坐标系统为自然坐标系统,简称自然坐标系。
自然坐标系优点在于:(1)坐标系统易确定;(2)零位时的关节变量为零;(3)零位时的系统姿态一致;(4)不易引入测量累积误差。
定义3不变量:称不依赖于一组坐标系进行度量的量为不变量。
对轴不变量而言,其绝对导数就是其相对导数。因轴不变量是具有不变性的自然参考轴,故其绝对导数恒为零矢量。因此,轴不变量具有对时间微分的不变性。有:
定义6自然坐标:以自然坐标轴矢量为参考方向,相对系统零位的角位置或线位置,记为ql,称为自然坐标;称与自然坐标一一映射的量为关节变量;其中:
其中:
定义9关节空间:以关节自然坐标ql表示的空间称为关节空间。
定义10位形空间:称表达位置及姿态(简称位姿)的笛卡尔空间为位形空间,是双矢量空间或6D空间。
给定多轴系统D={T,A,B,K,F,NT},在系统零位时,只要建立底座系或惯性系,以及各轴上的参考点Ol,其它杆件坐标系也自然确定。本质上,只需要确定底座系或惯性系。
给定一个由运动副连接的具有闭链的结构简图,可以选定回路中任一个运动副,将组成该运动副的定子与动子分割开来;从而,获得一个无回路的树型结构,称之为Span树。T表示带方向的span树,以描述树链运动的拓扑关系。
定义以下表达式或表达形式:
本申请中约定:在运动链符号演算系统中,具有偏序的属性变量或常量,在名称上包含表示偏序的指标;要么包含左上角及右下角指标,要么包含右上角及右下角指标;它们的方向总是由左上角指标至右下角指标,或由右上角指标至右下角指标,本申请中为叙述简便,有时省略方向的描述,即使省略,本领域技术人员通过符号表达式也可以知道,本申请中采用的各参数,对于某种属性符,它们的方向总是由偏序指标的左上角指标至右下角指标,或由右上角指标至右下角指标。例如:可简述为(表示由k至l)平动矢量;表示(由k至l的)线位置;krl表示(由k至l的)平动矢量;其中:r表示“平动”属性符,其余属性符对应为:属性符φ表示“转动”;属性符Q表示“旋转变换矩阵”;属性符l表示“运动链”;属性符u表示“单位矢量”;属性符ω表示“角速度”;属性符J表示质心转动惯量;J表示偏速度雅克比矩阵;角标为i表示惯性坐标系或大地坐标系;其他角标可以为其他字母,也可以为数字。
本申请的符号规范与约定是根据运动链的偏序性、链节是运动链的基本单位这两个原则确定的,反映了运动链的本质特征。链指标表示的是连接关系,右上指标表征参考系。采用这种符号表达简洁、准确,便于交流与书面表达。同时,它们是结构化的符号系统,包含了组成各属性量的要素及关系,便于计算机处理,为计算机自动建模奠定基础。指标的含义需要通过属性符的背景即上下文进行理解;比如:若属性符是平动类型的,则左上角指标表示坐标系的原点及方向;若属性符是转动类型的,则左上角指标表示坐标系的方向。
(1)lS-杆件l中的点S;而S表示空间中的一点S。
(7)左下角指标为0时,表示机械零位;如:
(8)0-三维零矩阵;03=[0 0 0]T;1-三维单位矩阵;
(9)约定:“\”表示续行符;“□”表示属性占位;则
(12)iQl,相对绝对空间的旋转变换阵;
(14)对于一给定有序的集合r=[1,4,3,2]T,记r[x]表示取集合r的第x行元素。常记[x]、[y]、[z]及[w]表示取第1、2、3及4列元素。
(15)ilj表示由i到j的运动链;llk为取由轴l至轴k的运动链;
1.建立多轴系统的拉格朗日方程
得
保守力与惯性力具有相反的链序。拉格朗日系统内的约束既可以是质点间的固结约束,又可以是质点系统间的运动约束;刚体自身是质点系统质点能量具有可加性;刚体动能量由质心平动动能及转动动能组成。下面,就以简单运动副R/P分别建立拉格朗日方程,为后续进一步推出新的动力学理论奠定基础。
给定刚体多轴系统D={A,K,T,NT,F,B},惯性空间记为i,轴l的能量记为其中平动动能为转动动能为引力势能为轴l受除引力外的外部合力及合力矩分别为Dfl及Dτl;轴l的质量及质心转动惯量分别为ml及轴u的单位轴不变量为环境i作用于lI的惯性加速度记为重力加速度链序由i至lI;链序由lI至i;且有
【1】系统能量
其中:
【2】多轴系统拉格朗日方程
由式(2)得多轴系统拉格朗日方程,
2.建立Ju-Kane动力学预备方程:
基于多轴系统拉格朗日方程(6)推导居―凯恩(Ju-Kane)动力学预备定理。先进行拉格朗日方程与凯恩方程的等价性证明;然后,计算能量对关节速度及坐标的偏速度,再对时间求导,最后给出Ju-Kane动力学预备定理。
【1】拉格朗日方程与凯恩方程的等价性证明
证毕。
动力学系统D的平动动能及转动动能分别表示为
考虑式(4)及式(5),即有
式(7)及式(8)是居―凯恩动力学预备定理证明的依据,即居―凯恩动力学预备定理本质上与拉格朗日法是等价的。同时,式(8)右侧包含了多轴系统凯恩方程;表明拉格朗日法与凯恩法的惯性力计算是一致的,即拉格朗日法与凯恩法也是等价的。式(8)表明:在拉格朗日方程(4)中存在重复计算的问题。
【2】能量对关节速度及坐标的偏速度
至此,已完成能量对关节速度及坐标的偏速度计算。
【3】求对时间的导数
至此,已完成对时间t的求导。
【4】Ju-Kane动力学预备定理
将式(11)、式(14)、式(15)及式(16)代入式(8),
给定多轴刚体系统D={A,K,T,NT,F,B},惯性系记为F[i],除了重力外,作用于轴u的合外力及力矩分别记为及轴k的质量及质心转动惯量分别记为mk及轴k的重力加速度为则轴u的Ju-Kane动力学预备方程为
式(17)具有了树链拓扑结构。kI表示杆k质心I。因闭子树uL中的广义力具有可加性;因此闭子树的节点有唯一一条至根的运动链,因此运动链iln可以被运动链uL替换。
下面,针对Ju-Kane动力学预备方程,解决式(17)右侧Dfk及Dτk的计算问题,从而建立树链刚体系统Ju-Kane动力学方程。
3.建立树链刚体系统Ju-Kane动力学模型
左序叉乘与转置的关系为:
根据运动学迭代式,有:
3.1外力反向迭代
即
即有
式(26)及式(27)表明环境作用于轴k的合外力或力矩等价于闭子树kL对轴k的合外力或力矩,将式(26)及式(27)合写为
至此,解决了外力反向迭代的计算问题。在式(28)中,闭子树对轴k的广义力具有可加性;力的作用具有双重效应,且是反向迭代的。所谓反向迭代是指:是需要通过链节位置矢量迭代的;的序与前向运动学计算的序相反。
3.2共轴驱动力反向迭代
【1】由式(18)、式(19)及式(29)得
即
【2】由式(19)、式(18)及式(29)得
即
至此,完成了共轴驱动力反向迭代计算问题。
3.3树链刚体系统Ju-Kane动力学显式模型的建立:
下面,先陈述树链刚体系统Ju-Kane动力学方程,简称Ju-Kane方程;然后,给出建立步骤。
给定多轴刚体系统D={A,K,T,NT,F,B},惯性系记为F[i],除了重力外,作用于轴u的合外力及力矩在上的分量分别记为及轴k的质量及质心转动惯量分别记为mk及轴k的重力加速度为驱动轴u的双边驱动力及驱动力矩在上的分量分别记为及环境i对轴l的力及力矩分别为及iτl;则轴u树链Ju-Kane动力学方程为
将偏速度计算公式式(19),式(18)及式(20)代入Ju-Kane动力学预备方程(17)得
由式(21)得
考虑式(43),则有
同样,考虑式(43),得
将式(43)至式(45)代入式(42)得式(34)至式(39)。
实施例1
给定如图3所示的通用3R机械臂,A=(i,1:3];应用本发明的方法建立树链Ju-Kane动力学方程,并得到广义惯性矩阵。
步骤1建立基于轴不变量的迭代式运动方程。
由式(46)基于轴不变量的转动变换矩阵
得
运动学迭代式:
二阶张量投影式:
由式(48)及式(47)得
由式(49),式(47)及式(55)得
由式(50)及式(55)得
由式(51)、式(55)及式(57)得
由式(52)及式(55)得
由式(53)及式(55)得
步骤2建立动力学方程。先建立第1轴的动力学方程。由式(37)得
由式(39)得
由式(61)及式(62)得第1轴的动力学方程,
建立第2轴的动力学方程。由式(37)得
由式(39)得
由式(64)及式(65)得第2轴的动力学方程,
最后,建立第3轴的动力学方程。由式(37)得
由式(39)得
由式(67)及式(68)得第3轴的动力学方程,
由式(61),式(63)及式(67)得广义质量阵。
由此可知,只要程式化地将系统的拓扑、结构参数、质惯量等参数代入式(36)至式(40)就可以完成动力学建模。通过编程,很容易实现Ju-Kane动力学方程。因后续的树链Ju-Kane规范方程是以Ju-Kane动力学方程推导的,树链Ju-Kane动力学方程的有效性可由Ju-Kane规范型实例证明。
3.4树链刚体系统Ju-Kane动力学规范型
在建立系统动力学方程后,紧接着就是方程求解的问题。在动力学系统仿真时,通常给定环境作用的广义力及驱动轴的广义驱动力,需要求解动力学系统的加速度;这是动力学方程求解的正问题。在求解前,首先需要得到式(71)所示的规范方程。
规范化动力学方程,
其中:RHS–右手侧(Right hand side)
显然,规范化过程就是将所有关节加速度项进行合并的过程;从而,得到关节加速度的系数。将该问题分解为运动链的规范型及闭子树的规范型两个子问题。
3.4.1运动链的规范型方程
将式(36)及式(37)中关节加速度项的前向迭代过程转化为反向求和过程,以便后续应用;显然,其中含有6种不同类型的加速度项,分别予以处理。
上式的推导步骤为:
3.4.2闭子树的规范型方程
因闭子树uL中的广义力具有可加性;因此闭子树的节点有唯一一条至根的运动链,式(73)至式(77)的运动链iln可以被uL替换。由式(73)得
由式(74)得
由式(75)得
由式(76)得
由式(77)得
至此,已具备建立规范型的前提条件。
3.5树链刚体系统Ju-Kane动力学规范方程
下面,建立树结构刚体系统的Ju-Kane规范化动力学方程。为表达方便,首先定义
然后,应用式(78)至式(82),将式(36)及式(37)表达为规范型。
【1】式(36)的规范型为
上式的具体建立步骤为:由式(24)及式(36)得
由式(52)及式(85)得
将式(80)代入式(85)右侧前一项得
将式(79)代入式(86)右侧后一项得
将式(87)及式(88)代入式(86)得
【2】式(37)的规范型为
上式的具体建立步骤为:由式(37)得
将式(78)代入式右侧前一项(91)得
将式(81)代入式(91)右侧后一项得
将式(82)代入式(91)右侧中间一项得
将式(92),式(93)及式(94)代入式(92)得
【3】应用式(84)及式(90),将Ju-Kane方程重新表述为如下树链Ju-Kane规范型方程:
给定多轴刚体系统D={A,K,T,NT,F,B},惯性系记为F[i],除了重力外,作用于轴u的合外力及力矩在上的分量分别记为及轴k的质量及质心转动惯量分别记为mk及轴k的重力加速度为驱动轴u的双边驱动力及驱动力矩在上的分量分别记为及环境i对轴l的作用力及力矩分别为及iτl;则轴u的Ju-Kane动力学规范方程为
式中,kI表示杆k质心I;轴k的质量及质心转动惯量分别记为mk及 为转动轴u的惯性矩阵;为平动轴u的惯性矩阵;hR为转动轴u的非惯性矩阵;hP为平动轴u的非惯性矩阵;作用于轴u的合外力及力矩在上的分量分别记为及 驱动轴u的双边驱动力及驱动力矩在上的分量分别记为及环境i对轴l的作用力及作用力矩分别为及iτl;llk为取由轴l至轴k的运动链,uL表示获得由轴u及其子树构成的闭子树。
4.闭链刚体系统的Ju-Kane动力学方程建立
下面,先陈述闭链刚体系统的居―凯恩(简称Ju-Kane)动力学方程;然后,给出具体建模过程。
给定多轴刚体系统D={A,K,T,NT,F,B},惯性系记为F[i],除了重力外,作用于轴u的合外力及力矩在上的分量分别记为及轴k的质量及质心转动惯量分别记为mk及轴k的重力加速度为驱动轴u的双边驱动力及驱动力矩在上的分量分别记为及环境i对轴l的作用力及作用力矩分别为及iτl;轴u对轴u′的广义约束力记为则有闭链刚体系统的Ju-Kane动力学方程:
【1】轴u及轴u′的Ju-Kane动力学规范方程分别为
【2】非树约束副uku′的约束代数方程为
其中:
式中:及是3×3的分块矩阵,及是3D矢量;kI表示杆k质心I;轴k的质量及质心转动惯量分别记为mk及 为转动轴u的惯性矩阵;为平动轴u的惯性矩阵;hR为转动轴u的非惯性矩阵;hP为平动轴u的非惯性矩阵;为平动关节角速度;为转动关节角速度。
具体建模过程如下:
由式(114)得
由式(115)及式(116)得
由式(115)得
δ表示增量;
由式(18)及式(118)得
故有
由式(110)及式(122)得式(105)。由式(19)及式(119)得
由式(111)及式(123)得式(106)。由式(19)及式(120)得
由式(112)及式(124)得式(107)。由式(19)及式(121)得
由式(113)及式(125)得(108)。由式(18),式(116)及式(110)得
根据轴u的Ju-Kane动力学规范方程得式(103)及式(104)。
以关节空间自然轴链为基础的Ju-Kane闭链刚体动力学克服了笛卡尔坐标轴链空间的局限:
【1】在基于笛卡尔坐标轴链的牛顿欧拉动力学中,非树运动副uku′∈P约束不能表达及或及的情形,即不能表达齿条与齿轮、蜗轮与蜗杆等约束。而本申请的非树约束副uku′的约束代数方程式(105)至式(108)可表达任一种约束类形,并且物理内涵明晰;
【2】在基于笛卡尔坐标轴链的牛顿欧拉动力学当中,非树运动副代数约束方程是6D的;而式(105)至式(108)表示是3D非树运动副代数约束方程,从而降低了系统方程求解的复杂度;
【3】在基于笛卡尔坐标轴链的牛顿欧拉动力学当中,非树运动副代数约束方程是关于6D矢量空间绝对加速度的,是关于关节坐标、关节速度的迭代式,具有累积误差;而式(105)至式(108)是关于关节加速度的,保证了约束方程的准确性。
5.基于轴不变量的约束力求解
其中:
在完成前向动力学正解后,根据已计算的关节加速度由式(130)可以得到关节约束力大小约束力矩大小当时,由式(130)得且式(130)中同一时刻具有相同的运动状态及内外力。仅在运动轴向上出现力及力矩的平衡;而在约束轴向,动力学方程不满足,即力与力矩不一定平衡。
至此,完成了轴径向约束广义力的计算。
将根据运动轴类型及自然参考轴表达的刚体运动链广义惯性矩阵称为轴链刚体广义惯性矩阵,简称轴链广义惯性矩阵。
给定多轴刚体系统D={A,K,T,NT,F,B},将系统中各轴动力学方程(96)按行排列;将重排后的轴驱动广义力及不可测的环境作用力记为fC,可测的环境广义作用力记为fi;将系统对应的关节加速度序列记为将重排后的记为h;考虑式(135);则该系统动力学方程为
由式(136)得
其中,
由式(136)得
6.广义内摩擦力及粘滞力计算
故有
其中:sk[u]─运动轴u的内摩擦系数,ck[u]─运动轴u的粘滞系数;sign()表示取正或负符号。
运动轴的广义内摩擦力及粘滞力是运动轴的内力,因为它们仅存在于运动轴向上,与轴径向约束力总是正交的。当运动轴轴向动态作用力平衡时,无论广义内摩擦力及粘滞力是否存在或大小如何,都不影响动力学系统的运动状态;故而,不影响运动轴的径向约束力。因此,由式(130)至式(134)计算运动轴u的径向约束力大小及约束力矩大小时,可以不考虑运动轴的广义内摩擦力及粘滞力。
7.建立闭链刚体非理想约束系统的Ju-Kane动力学显式模型
设运动轴u的广义内摩擦及粘滞的合力及合力矩分别为闭链刚体系统的Ju-Kane动力学方程建立后,计算关节加速度后,应用式(129)至式(134)计算径向约束力大小及约束力矩大小及再建立如下闭链刚体非理想约束系统的Ju-Kane动力学方程:
【1】轴u及轴u′的Ju-Kane动力学规范方程分别为
【2】非树约束副uku′的约束代数方程为
其它,参见式(103)至式(113)、式(97)至式(102)。
建立过程为:
Claims (7)
1.一种基于轴不变量的非理想关节机器人动力学建模方法,其特征是,
给定多轴刚体系统D={A,K,T,NT,F,B},惯性系记为F[i],A为轴序列,K为运动副类型序列,T表示带方向的span树,以描述树链运动的拓扑关系,NT为约束轴的序列即非树,F为杆件参考系序列,B为杆件体序列;除了重力外,作用于轴u的合外力及力矩在上的分量分别记为及轴k的质量及质心转动惯量分别记为mk及轴k的重力加速度为驱动轴u的双边驱动力及驱动力矩在上的分量分别记为及环境i对轴l的作用力及作用力矩分别为及iτl;轴u对轴u′的广义约束力记为
约定:在运动链符号演算系统中,具有偏序的属性变量或常量,在名称上包含表示偏序的指标;要么包含左上角及右下角指标,要么包含右上角及右下角指标;对于某种属性符,它们的方向总是由偏序指标的左上角指标至右下角指标,或由右上角指标至右下角指标;
定义不变量:称不依赖于一组坐标系进行度量的量为不变量;
设运动轴u的广义内摩擦及粘滞的合力及合力矩分别为根据建立的闭链刚体系统的Ju-Kane动力学方程,计算关节加速度后,计算径向约束力大小及约束力矩大小及再建立如下闭链刚体非理想约束系统的Ju-Kane动力学方程:
【1】轴u及轴u′的Ju-Kane动力学规范方程分别为
式中:及是3×3的分块矩阵,及是3D矢量;为转动副R下轴u的惯性矩阵;为平动副P下轴u的惯性矩阵;hR为转动副R下轴u的非惯性矩阵;hP为平动副P下轴u的非惯性矩阵;【2】非树约束副uku′的约束代数方程为
2.根据权利要求1所述的基于轴不变量的非理想关节机器人动力学建模方法,其特征是,
闭链刚体系统的Ju-Kane动力学方程:
【1】轴u及轴u′的Ju-Kane动力学规范方程分别为
其中:及是3×3的分块矩阵,及是3D矢量;kI表示杆k质心I;轴k的质量及质心转动惯量分别记为mk及 为转动副R下轴u的惯性矩阵;为平动副P下轴u的惯性矩阵;hR为转动副R下轴u的非惯性力;hP为平动副P下轴u的非惯性力;
【2】非树约束副uku′的约束代数方程为
其中:
6.根据权利要求1所述的基于轴不变量的非理想关节机器人动力学建模方法,其特征是,闭链刚体系统的Ju-Kane动力学方程根据树链Ju-Kane规范型方程建立。
7.根据权利要求6所述的基于轴不变量的非理想关节机器人动力学建模方法,其特征是,树链Ju-Kane规范型方程
并且,
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810933654.8A CN108959829B (zh) | 2018-08-16 | 2018-08-16 | 基于轴不变量的非理想关节机器人动力学建模方法 |
PCT/CN2018/112677 WO2020034404A1 (zh) | 2018-08-16 | 2018-10-30 | 基于轴不变量的非理想关节机器人动力学建模与解算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810933654.8A CN108959829B (zh) | 2018-08-16 | 2018-08-16 | 基于轴不变量的非理想关节机器人动力学建模方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108959829A CN108959829A (zh) | 2018-12-07 |
CN108959829B true CN108959829B (zh) | 2020-04-07 |
Family
ID=64469611
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810933654.8A Active CN108959829B (zh) | 2018-08-16 | 2018-08-16 | 基于轴不变量的非理想关节机器人动力学建模方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN108959829B (zh) |
WO (1) | WO2020034404A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109620410B (zh) * | 2018-12-04 | 2021-01-26 | 微创(上海)医疗机器人有限公司 | 机械臂防碰撞的方法及系统、医疗机器人 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102091967A (zh) * | 2011-02-24 | 2011-06-15 | 华中科技大学 | 一种多轴数控加工的进给速度平滑方法 |
CN103495969A (zh) * | 2013-09-28 | 2014-01-08 | 北京工业大学 | 一种基于接触式传感器的柔性铰链并联机器人控制装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102495550B (zh) * | 2011-11-21 | 2013-07-10 | 湖南湖大艾盛汽车技术开发有限公司 | 并联机器人的正、逆动力学响应分析与控制方法 |
SE537534C2 (sv) * | 2013-08-27 | 2015-06-02 | Cognibotics Ab | Metod och system för bestämning av åtminstone en egenskap hos en manipulator |
CN105956254A (zh) * | 2016-04-27 | 2016-09-21 | 西安交通大学 | 一种用于转子系统动力学建模的刚体单元法 |
CN107529630B (zh) * | 2017-06-23 | 2021-06-29 | 西北工业大学 | 一种空间机器人建立动力学模型的方法 |
CN108038286B (zh) * | 2017-11-30 | 2021-12-03 | 长安大学 | 一种二自由度冗余驱动并联机器人的动力学建模方法 |
-
2018
- 2018-08-16 CN CN201810933654.8A patent/CN108959829B/zh active Active
- 2018-10-30 WO PCT/CN2018/112677 patent/WO2020034404A1/zh active Application Filing
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102091967A (zh) * | 2011-02-24 | 2011-06-15 | 华中科技大学 | 一种多轴数控加工的进给速度平滑方法 |
CN103495969A (zh) * | 2013-09-28 | 2014-01-08 | 北京工业大学 | 一种基于接触式传感器的柔性铰链并联机器人控制装置 |
Non-Patent Citations (3)
Title |
---|
Simulation And Research on the Model of Rehabilitation Robot for Upper Limbs based on Kane Equation;Xue-feng ZHU等;《2012 Second International Conference on Instrumentation & Measurement, Computer, Communication and Control》;20121231;第1583-1586页 * |
崎岖地形环境中月球车的动力学建模与仿真;彭丽媛等;《系统科学与数学》;20110630;第31卷(第6期);第742-750页 * |
高精度解耦六自由度机械臂逆运动学解法;付荣等;《计算机测量与控制》;20101231;第18卷(第7期);第1637-1640、1644页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108959829A (zh) | 2018-12-07 |
WO2020034404A1 (zh) | 2020-02-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020034420A1 (zh) | 一种基于轴不变量的多轴机器人逆运动学建模与解算方法 | |
WO2020034419A1 (zh) | 一种基于轴不变量的多轴机器人动力学建模方法 | |
Orin et al. | Centroidal momentum matrix of a humanoid robot: Structure and properties | |
WO2020034422A1 (zh) | 一种基于轴不变量的多轴机器人系统正运动学建模与解算方法 | |
WO2020034421A1 (zh) | 一种基于轴不变量的多轴机器人系统建模与控制方法 | |
Wang et al. | A multi-objective approach for the trajectory planning of a 7-DOF serial-parallel hybrid humanoid arm | |
CN107529630A (zh) | 一种空间机器人建立动力学模型的方法 | |
CN108959829B (zh) | 基于轴不变量的非理想关节机器人动力学建模方法 | |
Jing et al. | A recursive dynamic modeling and control for dual-arm manipulator with elastic joints | |
CN109117451B (zh) | 基于轴不变量的树链机器人动力学建模与解算方法 | |
CN109086544B (zh) | 基于轴不变量的闭链机器人动力学建模与解算方法 | |
CN109015641B (zh) | 基于轴不变量的通用6r机械臂逆解建模与解算方法 | |
CN108803350B (zh) | 基于轴不变量的动基座多轴机器人动力学建模与解算方法 | |
CN108942943B (zh) | 基于轴不变量的多轴机器人正运动学计算方法 | |
CN109079850B (zh) | 基于轴不变量多轴机器人d-h系及d-h参数确定方法 | |
CN109291047B (zh) | 基于轴不变量及dh参数1r/2r/3r逆解建模方法 | |
Li et al. | Dynamic modeling and analysis for 6-DOF industrial robots | |
CN109033688B (zh) | 基于轴不变量的通用7r机械臂逆解建模与解算方法 | |
CN108959828B (zh) | 基于轴不变量的通用3r机械臂逆解建模与解算方法 | |
Zhang et al. | Analysis and Simulation of Mechanical Arm Dynamics Model Based on Simulink | |
Wei et al. | Dynamic modeling of mobile manipulator based on floating-like base | |
Li et al. | Simulation and trajectory optimization of articulated robots via spectral variational integrators | |
Olaru et al. | Modeling and simulation of the parallel robot's structure with LabVIEW™ instrumentation | |
Zhao et al. | Kinematics of a 6-DOF feeding and unloading manipulator | |
Dmitriev et al. | Representation of a robotic manipulator mechanical subsystem as a component circuit with vector links |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |