CN102508436A - 机械手摩擦力动力学精确分析与控制应用方法 - Google Patents

机械手摩擦力动力学精确分析与控制应用方法 Download PDF

Info

Publication number
CN102508436A
CN102508436A CN2011103714616A CN201110371461A CN102508436A CN 102508436 A CN102508436 A CN 102508436A CN 2011103714616 A CN2011103714616 A CN 2011103714616A CN 201110371461 A CN201110371461 A CN 201110371461A CN 102508436 A CN102508436 A CN 102508436A
Authority
CN
China
Prior art keywords
centerdot
friction
constraint
force
friction force
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.)
Granted
Application number
CN2011103714616A
Other languages
English (en)
Other versions
CN102508436B (zh
Inventor
黄晋
黄清敏
成艾国
胡洁
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hunan University
Original Assignee
Hunan University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hunan University filed Critical Hunan University
Priority to CN201110371461.6A priority Critical patent/CN102508436B/zh
Publication of CN102508436A publication Critical patent/CN102508436A/zh
Application granted granted Critical
Publication of CN102508436B publication Critical patent/CN102508436B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)
  • Feedback Control In General (AREA)

Abstract

一种机械手摩擦力动力学精确分析和控制应用方法,其步骤为:(1)建立机械手的动力学方程;(2)建立摩擦力处的约束方程;(3)利用Udwadia-Kalaba方程建立该机械手约束系统的整体动力学解析方程,得到理想约束力;(4)分解理想约束力,计算得到约束处的正压力和切向力的解析形式;(5)推导获得经典摩擦力和扩展摩擦力等模型的解析形式表达式。本发明是一种能对机械手的摩擦力进行实时计算,对其动力学响应进行精确分析,并得到解析形式的摩擦力表达形式,解决了以往机械系统中摩擦力只能用于用数值形式表达或正压力假定为恒定值的问题,可以方便运用于含有摩擦力的机械手控制器设计。

Description

机械手摩擦力动力学精确分析与控制应用方法
技术领域
本发明主要涉及到机械手摩擦力的控制领域,特指一种机械手摩擦力动力学精确分析与控制方法,特别是针对含复杂约束机械手系统的摩擦力动力学精确分析,包括获得机械手的经典摩擦力(库仑摩擦、静摩擦)和扩展摩擦力(Dahl摩擦力、LuGre摩擦力)的解析形式。
背景技术
摩擦力是两个表面接触的物体相互运动时互相施加的一种物理力。它在机械系统当中广泛存在,如轴承,传动系统,液动和气动缸,阀门,制动和车轮等等。关于摩擦的研究在日益受到重视,特别是在控制工程领域,如机械手系统,驱动系统,高精度伺服系统,机器人的设计等。然而,摩擦力由于其高度的非线性,可能导致稳态误差,极限环和较差的控制性能。因此,对机械系统中摩擦力进行精确分析,获得解析形式摩擦力,对消除机械系统中由摩擦力导致的控制误差就显得格外重要。
摩擦力可以是随接触中的正压力,表面材料性质,物体间的位置和相对速度,湿度和润滑条件等变化的函数。常见的摩擦现象有:静摩擦,库仑摩擦,粘滞摩擦,Stribeck效应,不对称性和位置相关等等。由于摩擦力在物理接触条件下可能包含上述提到的一些或者所有现象,因此在分析摩擦力时还应考虑其参数随时间的变化。
传统的摩擦力模型包含库仑摩擦,干摩擦,粘性摩擦或是这些摩擦的组合,不能描述其它的摩擦特征像Stribeck效应,不对称性和位置相关的其它摩擦特征。为了建立一种用于控制工程,精确和有效表达机械系统摩擦力的模型,许多研究者展开了改进既有分析摩擦模型的研究,并在一定条件下的控制工程中进行了大量尝试。1968年由Dahl提出的Dahl模型用于带摩擦的控制系统仿真,将普通库仑摩擦一般化,没有考虑Stribeck效应和静摩擦。1995年Bliman和Sorine用他们的一阶和二阶模型得到库仑摩擦和干摩擦的模型强调速度独立性。1995年,Canudas de Wit等给出了包含库仑摩擦,静摩擦,粘性摩擦和Stribeck效应的LuGre模型。1998年,Olsson给出了关于其它摩擦模型的一般形式,并在它们的应用在1997年后得到了发展。此后,在2000年Swevers等人给出的LuGre模型的改进形式Leuven模型,并且在2002年Lampaert等人的研究提供了Leuven模型的改进形式,通过用更有效的Maxwell滑移模型替代之前的执行滞后的堆叠机制。在Lampaert于2004年和Fassios于2005年发表的论文中对这种模型进行了应用。2004年,Ferretti等发展了单状态和多状态积分摩擦模型通过对Dahl模型的积分求解。2005年,一种连续微分摩擦力模型由Makkar等人提出,他们强调获得了一系列不用包含不连续或分段连续函数摩擦力重要方面。2010年,Bittencourt等人研究了扩展摩擦模型来获得载荷和温度对机器人铰链摩擦的影响。摩擦力的模型研究工作仍在继续,并取得了可喜的成果。
现有的摩擦力在进行动力学分析时都是基于一个假设,即产生在接触面间的正压力是恒定的。在实际机械手的运动过程中,由于其本身状态的变化,且受到约束条件,外界环境变化的影响,正压力随时间会强烈变化。因此,传统的摩擦力分析手段已不适于分析复杂的机械手动力学工作过程,迫切需要一种解析形式的摩擦力表达方法,对其运动过程进行精确分析,并利于实现其过程的实时控制。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种能对机械手的摩擦力进行实时计算、对其动力学响应进行精确分析、并得到解析形式的摩擦力表达形式的机械手摩擦力动力学精确分析与控制方法,进而用以解决以往机械系统中摩擦力只能用于用数值形式表达或正压力假定为恒定值的问题,可以方便运用于含不可忽略摩擦力的机械手控制器设计的方法。
为解决上述技术问题,本发明提出的解决方案为:
一种机械手摩擦力动力学精确分析和控制方法,其步骤如下:
(1)、建立机械手的动力学方程,其形式为
M q · · = Q
其中,M为机械手的质量矩阵,q为系统广义坐标,为系统广义速度,
Figure BDA0000110631720000023
为系统广义加速度,Q为机械手所受的外力;
(2)、建立摩擦力处的约束方程:建立机械手轨迹或运动副间的m个约束方程,假设其中包含h个完整约束和m-h个非完整约束;
对其完整约束可以描述如下:
Figure BDA0000110631720000024
其中,
Figure BDA0000110631720000025
为第i个完整约束方程的表达式。
对其余的m-h个非完整约束,可以描述为:
Figure BDA0000110631720000026
其中,为第i个非完整约束方程的表达式;
对完整约束求二阶导,对非完整约束求一阶导可以得到如下对广义坐标两阶导统一形式的约束方程:
A ( q , t ) q · · = b ( q · , q , t )
其中,A(q,t)=[Ali(q,t)]m×n为约束方程矩阵,
Figure BDA0000110631720000031
为其他非二阶导项的组合;
(3)、利用Udwadia-Kalaba方程建立该机械手约束系统的整体动力学解析方程,得到理想约束力:利用Udwadia-Kalaba方程推导出机械手约束力的两个组成部分,分别是理想约束的约束力和非理想约束的约束力,机械手整体坐标系下的动力学方程为如下形式:
M q · · = Q + Q i c + Q ni c = Q + M 1 2 B + ( b - AM - 1 Q ) + M 1 2 ( I - B + B ) M - 1 2 C
其中
Figure BDA0000110631720000033
为理想约束产生的理想约束力,
Figure BDA0000110631720000034
为非理想约束产生的非理想约束力,
Figure BDA0000110631720000035
B+为B的广义逆。上述动力学方程等式右的三个组成部分分别表示为:
第一部分Q是表示作用在机械手上的外力的总和;
第二部分
Figure BDA0000110631720000036
是由所有理想约束产生的理想约束力,这一部分的约束力在虚位移下所作的虚功为0。
第三部分中的
Figure BDA0000110631720000037
是由非理想约束产生的非理想约束力,这一部分的约束力在虚位移下所做的虚功不为零;
(4)、分解理想约束力,计算得到正压力和切向力。分析可知空间机械手的约束平面其端点的约束力可以分解为如下两个组成部分:
Q ( q · , q , t ) = Q p ( q · , q , t ) + Q t ( q · , q , t )
其中, Q p ( q · , q , t ) = A + ( q , t ) A ( q , t ) Q ( q · , q , t ) 为正压力, Q t ( q · , q , t ) = ( 1 - A + ( q , t ) A ( q , t ) ) Q ( q · , q , t ) 为切向力;
以下将推导得到笛卡尔坐标下正压力和切向力解析形式的表达式;
定义机械手系统端部向量在笛卡尔坐标系下可以表示为p(t),
p(t)=[x(t)y(t)z(t)]T
假设机械手的端部的向量可以用以下运动方程来表达:
x=fx(q,t)
y=fy(q,t)
z=fz(q,t)
则其与广义坐标之间的雅可比矩阵可以表示为:
J ( q ( t ) = ∂ f x ( q , t ) ∂ q 1 ∂ f x ( q , t ) ∂ q 2 · · · ∂ f x ( q , t ) ∂ q n ∂ f y ( q , t ) ∂ q 1 ∂ f y ( q , t ) ∂ q 2 · · · ∂ f y ( q , t ) ∂ q n ∂ f z ( q , t ) ∂ q 1 ∂ f z ( q , t ) ∂ q 2 . . . ∂ f z ( q , t ) ∂ q n
定义Q为广义坐标系下的广义力,F为相应的笛卡尔坐标系下的三向力,运用上述雅可比矩阵,可以得到如下关系式:
p · ( t ) = J ( q ( t ) , t ) q · ( t )
Q(t)=JT(q(t),t)F(t)
F(t)=(J(q(t),t)JT(q(t),t))-1J(q(t),t)Q(t)
则机械手系统在笛卡尔坐标系下正压力和切向力解析形式的表达式为:
F n ( t ) = ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) Q id c ( q · ( t ) , q ( t ) , t )
= ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) × M - 1 2 ( q ( t ) , t ) B + ( q ( t ) , t ) ( b ( ( q · ( t ) , q ( t ) , t ) ) )
- A ( q ( t ) , t ) M - 1 ( q ( t ) , t ) Q ( q · ( t ) , q ( t ) , t )
F t ( t ) = ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) Q t c ( q · ( t ) , q ( t ) , t )
= ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) × ( I - A M + ( q ( t ) , t ) A ( q ( t ) , t ) ) Q ( q · ( t ) , q ( t ) , t )
其中,为B(q,t)的广义逆,A(q(t),t)为约束方程矩阵,A+(q,t)为A(q,t)的广义逆,
Figure BDA0000110631720000049
为A的广义逆的M逆,其关系可以表达为
(5)、获得经典摩擦力和扩展摩擦力的解析形式:推导经典摩擦力模型(如,库仑摩擦力模型、静摩擦力模型等)和扩展摩擦力模型(如,Dahl摩擦力模型、LuGre摩擦力模型等)的解析形式表达式。
在下面的描述中,||·||均表示取向量的模。
作为本发明的进一步细化描述:
所述步骤(5)中,如经典摩擦力模型采用库仑摩擦力模型,库仑摩擦力的解析形式表达式为:
F c = - μ | | F n ( t ) | | p ^ ( t ) , p ^ ≠ 0
其中,Fc为机械手所受的库仑摩擦力,μ为摩擦系数,||Fn(t)||为正压力的大小,
Figure BDA00001106317200000412
表示摩擦力的方向,其表达式为:
p ^ ( t ) = p · ( t ) | | p · ( t ) | | p · ≠ 0
转化为笛卡尔坐标系下的方向表达式为:
p ^ ( t ) = J ( q ( t ) , t ) q · ( t ) | | J ( q ( t ) , t ) q · ( t ) | | q · ≠ 0
于是得到解析形式的机械库仑摩擦力广义坐标表达式为:
Q c ( q · , q , t ) = - μ J T ( q , t ) | | F n ( t ) | | J ( q , t ) q · | | J ( q , t ) q · | | , q · ≠ 0
所述步骤(5)中,经典摩擦力模型采用静摩擦力模型,静摩擦力的解析形式表达式为:由于最大可能的静摩擦力大小直接与正压力的成比例关系并且方向与外力切线方向相反(平行于接触面);而任何小于最大可能静摩擦力的切向力都会受到一个反向作用且大小相等的静摩擦的作用。因此,最大可能摩擦力大小可以表述为:
||Fm(t)||=μs||Fn(t)||
其中,||Fn(t)||为正压力的大小,μs是静摩擦力系数,Fm和Fn都是随时间变化的函数。可以得到解析形式的摩擦力如下:
F s ( t ) = - F t ( t ) , q · = 0 and | | F t | | ≤ | | F s | | - μ s | | F n ( t ) | | f ^ ( t ) , q · = 0 and | | F t | | > | | F s | |
其中,
Figure BDA0000110631720000055
为静摩擦力的方向表达式。
因此,解析形式的静摩擦力表达式为:
Q s ( t ) = - Q t ( t ) , q · = 0 and | | F t | | ≤ | | F s | | - μ s J T ( q , t ) | | F n ( t ) | | f ^ ( t ) , q · = 0 and | | F t | | > | | F s | |
通过合并,得到机械手所受的静摩擦力可以表示为如下解析形式:
Q f = - μ J T | | F n | | p ^ , q · ≠ 0 - Q t , q · = 0 and | | F t | | ≤ | | F s | | - μ s J T | | F n | | f ^ , q · = 0 and | | F t | | > | | F s | |
所述步骤(5)中,扩展摩擦力模型可以采用Dahl摩擦力模型或LuGre摩擦力模型等。机械手在实际工作过程中所受的摩擦力是多样的,由于库仑摩擦和静摩擦两者并不连续,不能概括动态特性的摩擦现象,如粘性摩擦,Stribeck效应,非对称性,位置相关性等等。Dahl摩擦力模型和LuGre摩擦力模型可以描述这些现象。但是这些扩展摩擦力模型都基于一个假设,即库仑摩擦力大小||Fc||和最大可能静摩擦力大小||Fm||已知。以往这些力的计算都是基于正压力不变的假设进行的。如扩展摩擦力模型采用Dahl摩擦力模型或LuGre摩擦力模型,则:
Dahl摩擦力的解析表达式为:
dF fk dt = σ ( 1 - F fk { μ | | ( JJ T ) - 1 JM 1 2 B + ( b - AM - 1 Q ) | | } k ) α k · , k = x , y , z
其中,Ffk为Dahl摩擦力,σ为刚性系数,α是用来确定应力应变曲线形状的系数。
Figure BDA0000110631720000062
为库仑摩擦力的大小,这样即得到Dahl摩擦力的大小。
LuGre摩擦力的解析表达式为:
d ω k dt = k · - σ 0 | | k · | | g k ω k , g k = { μ | | F N | | } k + { ( μ s - μ ) | | F N | | } k e - ( k · / v sk ) 2 F fk = σ 0 ω k + σ 0 dω k dt + f k , k = x , y , z
其中,
Figure BDA0000110631720000064
vsk为Stribeck速度,σ0为刚性系数,σ1为阻尼系数,可以选择为f为viscous摩擦力取值为f=σ2v,||FN||为库仑摩擦力的大小。
与现有技术相比,本发明的优点在于:
(1)摩擦力计算精确。利用本方法可获得机械手摩擦力的解析形式,可以得到机械手系统动力学分析的精确解。因此,令摩擦力的计算具有很高的精度。
(2)接触面正压力可变。机械系统接触面正压力一般为变值,本发明中的摩擦力解析形式可以不管机械手工作时接触面间的正压力是否恒定,均可进行计算,并且可用于存在不可积分摩擦力的机械手系统的系统设计中。
(3)易于控制器设计。由于可获得机械手中正压力变化时摩擦力的解析表达式,非常适合用于机械手系统的控制器设计。
(4)适用于扩展摩擦力模型。本方法不仅适用于经典的摩擦力模型,而且可以用于扩展摩擦力模型,能够很好的表达机械系统中正压力为变值时的摩擦力现象。
附图说明
图1是机械手空间约束及受力分解示意图;
图2是具体实例中二自由度平面机械手结构示意图;
图3是机械手端部接触面正压力变化图;
图4是机械手端部沿X向运动的示意图;
图5是机械手端部沿X向摩擦力大小的示意图;
图6是机械手端部沿Y向运动的示意图;
图7是机械手端部沿Y向摩擦力大小的示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明做进一步详细说明。
本发明的一种机械手摩擦力动力学精确分析和控制方法,其步骤如下:
(1)、建立机械手的动力学方程,其形式为
M q · · = Q
其中,M为机械手的质量矩阵,q为系统广义坐标,
Figure BDA0000110631720000072
为系统广义速度,
Figure BDA0000110631720000073
为系统广义加速度,Q为机械手所受的外力;
(2)、建立摩擦力处的约束方程:建立机械手轨迹或运动副间的m个约束方程,假设其中包含h个完整约束和m-h个非完整约束;
对其完整约束可以描述如下:
Figure BDA0000110631720000074
其中,
Figure BDA0000110631720000075
为第i个完整约束方程的表达式。
对其余的m-h个非完整约束,可以描述为:
Figure BDA0000110631720000076
其中,
Figure BDA0000110631720000077
为第i个非完整约束方程的表达式;
对完整约束求二阶导,对非完整约束求一阶导可以得到如下对广义坐标两阶导统一形式的约束方程:
A ( q , t ) q · · = b ( q · , q , t )
其中,A(q,t)=[Ali(q,t)]m×n为约束方程矩阵,
Figure BDA0000110631720000079
为其他非二阶导项的组合;
(3)、利用Udwadia-Kalaba方程建立该机械手约束系统的整体动力学解析方程,得到理想约束力:利用Udwadia-Kalaba方程推导出机械手约束力的两个组成部分,分别是理想约束的约束力和非理想约束的约束力,机械手整体坐标系下的动力学方程为如下形式:
M q · · = Q + Q i c + Q ni c = Q + M 1 2 B + ( b - AM - 1 Q ) + M 1 2 ( I - B + B ) M - 1 2 C
其中
Figure BDA00001106317200000711
为理想约束产生的理想约束力,
Figure BDA00001106317200000712
为非理想约束产生的非理想约束力,
Figure BDA00001106317200000713
B+为B的广义逆。上述动力学方程等式右的三个组成部分分别表示为:
第一部分Q是表示作用在机械手上的外力的总和;
第二部分
Figure BDA0000110631720000081
是由所有理想约束产生的理想约束力,这一部分的约束力在虚位移下所作的虚功为0;
第三部分中的
Figure BDA0000110631720000082
是由非理想约束产生的非理想约束力,这一部分的约束力在虚位移下所做的虚功不为零。
(4)、分解理想约束力,计算得到正压力和切向力。分析可知空间机械手的约束平面其端点的约束力可以分解为如下两个组成部分:
Q ( q · , q , t ) = Q p ( q · , q , t ) + Q t ( q · , q , t )
其中, Q p ( q · , q , t ) = A + ( q , t ) A ( q , t ) Q ( q · , q , t ) 为正压力, Q t ( q · , q , t ) = ( 1 - A + ( q , t ) A ( q , t ) ) Q ( q · , q , t ) 为切向力;
以下将推导得到笛卡尔坐标下正压力和切向力解析形式的表达式;
定义机械手系统端部向量在笛卡尔坐标系下可以表示为p(t),
p(t)=[x(t) y(t) z(t)]T
假设机械手的端部的向量可以用以下运动方程来表达:
x=fx(q,t)
y=fy(q,t)
z=fz(q,t)
则其与广义坐标之间的雅可比矩阵可以表示为:
J ( q ( t ) = ∂ f x ( q , t ) ∂ q 1 ∂ f x ( q , t ) ∂ q 2 · · · ∂ f x ( q , t ) ∂ q n ∂ f y ( q , t ) ∂ q 1 ∂ f y ( q , t ) ∂ q 2 · · · ∂ f y ( q , t ) ∂ q n ∂ f z ( q , t ) ∂ q 1 ∂ f z ( q , t ) ∂ q 2 . . . ∂ f z ( q , t ) ∂ q n
定义Q为广义坐标系下的广义力,F为相应的笛卡尔坐标系下的三向力,运用上述雅可比矩阵,可以得到如下关系式:
p · ( t ) = J ( q ( t ) , t ) q · ( t )
Q(t)=JT(q(t),t)F(t)
F(t)=(J(q(t),t)JT(q(t)t))-1J(q(t),t)Q(t)
则机械手系统在笛卡尔坐标系下正压力和切向力解析形式的表达式为:
F n ( t ) = ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) Q id c ( q · ( t ) , q ( t ) , t )
= ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) × M - 1 2 ( q ( t ) , t ) B + ( q ( t ) , t ) ( b ( ( q · ( t ) , q ( t ) , t ) ) )
- A ( q ( t ) , t ) M - 1 ( q ( t ) , t ) Q ( q · ( t ) , q ( t ) , t )
F t ( t ) = ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) Q t c ( q · ( t ) , q ( t ) , t )
= ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) × ( I - A M + ( q ( t ) , t ) A ( q ( t ) , t ) ) Q ( q · ( t ) , q ( t ) , t )
其中,
Figure BDA0000110631720000096
为B(q,t)的广义逆,A(q(t),t)为约束方程矩阵,A+(q,t)为A(q,t)的广义逆,
Figure BDA0000110631720000097
为A的广义逆的M逆,其关系可以表达为
Figure BDA0000110631720000098
(5)、获得经典摩擦力和扩展摩擦力的解析形式:推导经典摩擦力模型(如,库仑摩擦力模型、静摩擦力模型等)和扩展摩擦力模型(如,Dahl摩擦力模型、LuGre摩擦力模型等)的解析形式表达式。
在下面的描述中,||·||均表示取向量的模。
作为本发明的进一步细化描述:
所述步骤(5)中,如经典摩擦力模型采用库仑摩擦力模型,库仑摩擦力的解析形式表达式为:
F c = - μ | | F n ( t ) | | p ^ ( t ) , p ^ ≠ 0
其中,Fc为机械手所受的库仑摩擦力,μ为摩擦系数,||Fn(t)||为正压力的大小,
Figure BDA00001106317200000910
表示摩擦力的方向,其表达式为:
p ^ ( t ) = p · ( t ) | | p · ( t ) | | p · ≠ 0
转化为笛卡尔坐标系下的方向表达式为:
p ^ ( t ) = J ( q ( t ) , t ) q · ( t ) | | J ( q ( t ) , t ) q · ( t ) | | q · ≠ 0
于是得到解析形式的机械库仑摩擦力广义坐标表达式为:
Q c ( q · , q , t ) = - μ J T ( q , t ) | | F n ( t ) | | J ( q , t ) q · | | J ( q , t ) q · | | , q · ≠ 0
所述步骤(5)中,如经典摩擦力模型采用静摩擦力模型,静摩擦力的解析形式表达式为:
由于最大可能的静摩擦力大小直接与正压力的成比例关系并且方向与外力切线方向相反(平行于接触面);而任何小于最大可能静摩擦力的切向力都会受到一个反向作用且大小相等的静摩擦的作用。因此,最大可能摩擦力大小可以表述为:
||Fm(t)||=μs||Fn(t)||
其中,||Fn(t)||为正压力的大小,μs是静摩擦力系数,Fm和Fn都是随时间变化的函数。可以得到解析形式的摩擦力如下:
F s ( t ) = - F t ( t ) , q · = 0 and | | F t | | ≤ | | F s | | - μ s | | F n ( t ) | | f ^ ( t ) , q · = 0 and | | F t | | > | | F s | |
其中,
Figure BDA0000110631720000102
为静摩擦力的方向表达式。
因此,解析形式的静摩擦力表达式为:
Q s ( t ) = - Q t ( t ) , q · = 0 and | | F t | | ≤ | | F s | | - μ s J T ( q , t ) | | F n ( t ) | | f ^ ( t ) , q · = 0 and | | F t | | > | | F s | |
合并上述动摩擦力和静摩擦力公式,得到机械手所受的静摩擦力可以表示为如下解析形式:
Q f = - μ J T | | F n | | p ^ , q · ≠ 0 - Q t , q · = 0 and | | F t | | ≤ | | F s | | - μ s J T | | F n | | f ^ , q · = 0 and | | F t | | > | | F s | |
所述步骤(5)中,扩展摩擦力模型可以采用Dahl摩擦力模型或LuGre摩擦力模型等。机械手在实际工作过程中所受的摩擦力是多样的,由于库仑摩擦和静摩擦两者并不连续,不能概括动态特性的摩擦现象,如粘性摩擦,Stribeck效应,非对称性,位置相关性等等。Dahl摩擦力模型和LuGre摩擦力模型可以描述这些现象。但是这些扩展摩擦力模型都基于一个假设,即库仑摩擦力大小||Fc||和最大可能静摩擦力大小||Fm||已知。以往这些力的计算都是基于正压力不变的假设进行的。如扩展摩擦力模型可以采用Dahl摩擦力模型或LuGre摩擦力模型,则:
Dahl摩擦力的解析表达式为:
dF fk dt = σ ( 1 - F fk { μ | | ( JJ T ) - 1 JM 1 2 B + ( b - AM - 1 Q ) | | } k ) α k · , k = x , y , z
其中,Ffk为Dahl摩擦力,σ为刚性系数,α是用来确定应力应变曲线形状的系数。
Figure BDA0000110631720000106
为库仑摩擦力的大小,这样即得到Dahl摩擦力的大小。
LuGre摩擦力的解析表达式为:
d ω k dt = k · - σ 0 | | k · | | g k ω k , g k = { μ | | F N | | } k + { ( μ s - μ ) | | F N | | } k e - ( k / v sk ) 2 F fk = σ 0 ω k + σ 0 dω k dt + f k , k = x , y , z
其中,vsk为Stribeck速度,σ0为刚性系数,σ1为阻尼系数,可以选择为
Figure BDA0000110631720000112
f为viscous摩擦力取值为f=σ2v,||FN||为库仑摩擦力的大小。
本实施例中,以平面二连杆机械手系统为具体应用实例对本发明进行详细的说明,参见图1和图2,其具体流程为:
1、建立机械手的动力学方程。这里取θ1,θ2作为机械手系统的广义坐标系,如图2所示。机械手的控制器输入力矩为[τ1 τ2],运用拉格朗日方程,建立机械手系统的动力学方程如下:
τ 1 = m 2 l 2 2 ( θ · · 1 + θ · · 2 ) + m 2 l 1 l 2 cos θ 2 ( 2 θ · · 1 + θ · · 2 ) + ( m 1 + m 2 ) l 1 2 θ · · 1 - m 2 l 1 l 2 sin θ 2 θ · 2 2 - 2 m 2 l 1 l 2 sin θ 2 θ · 1 θ · 2
+ m 2 l 2 g cos ( θ 1 + θ 2 ) + ( m 1 + m 2 ) l 1 g cos θ 1
τ 2 = m 2 l 1 l 2 cos θ 2 θ · · 1 + m 2 l 1 l 2 sin θ 2 θ · 1 2 + m 2 l 2 g cos ( θ 1 + θ 1 ) + m 2 l 2 2 ( θ · · 1 + θ · · 2 )
其中,m1,m2分别为机械手系统的第一、第二根机械臂的质量,l1,l2分别为机械手系统的第一、第二根机械臂的长度,g为重力加速度。
整理动力学方程,得到机械手的动力学方程为如下形式:
M ( q , t ) q · · = Q ( q · , q , t )
q = θ 1 θ 1 , M = m 11 m 12 m 12 m 22 , Q = h 1 h 2 ,
其中,
m 11 = m 2 l 2 2 + 2 m 2 l 1 l 2 cos θ 2 + ( m 1 + m 2 ) l 1 2
m 12 = m 2 l 2 2 + m 2 l 1 l 2 cos θ 2
m 22 = m 2 l 2 2
h 1 = τ 1 + m 2 l 1 l 2 sin θ 2 θ · 2 ( θ · 2 + 2 θ · 1 ) - m 2 l 2 g cos ( θ 1 + θ 1 ) - ( m 1 + m 2 ) l 1 g cos θ 1
h 2 = τ 2 - m 2 l 1 l 2 sin θ 2 θ · 1 2 - m 2 l 2 g cos ( θ 1 + θ 1 )
2、施加约束,建立约束方程。假设机械手的末端的约束在如下抛物线的轨迹上,其轨迹方程为:
y=βx2
其中β,γ分别为抛物线的系数。机械手运动时的坐标应满足如下关系:
x=l1cosθ1+l2cos(θ12)
y=l1sinθ1+l2sin(θ12)
在广义坐标系下,其约束方程为:
l1sinθ1+l2sin(θ12)-β(l1cosθ1+l2cos(θ12))2-γ=0
对上述约束方程取二阶导,可以得到如下形式的约束方程:
A ( q , t ) q · · = b ( q · , q , t ) ,
其中,
A=2β(l1cosθ1+l2cos(θ12))(l2sin(θ12)+l1sinθ1)+l1cosθ1+l2cos(θ12),
   2β(l1cosθ1+l2cos(θ12))l2sin(θ12)+l2cos(θ12)],
b = l 1 sin θ 1 θ · 1 + l 2 sin ( θ 1 + θ 2 ) ( θ · 1 + θ · 2 ) 2 - 2 β ( l 1 sin θ 1 θ · 1 + l 2 sin ( θ 1 + θ 2 ) ( θ · 1 + θ · 2 ) ) 2
- 2 β ( l 1 cos θ 1 + l 2 cos ( θ 1 + θ 2 ) ) ( l 1 cos θ 1 θ · 1 2 + l 2 cos ( θ 1 + θ 2 ) ( θ · 1 + θ · 2 ) 2 ) .
结合附图描叙工作原理及过程,即前面作静态描叙,后面动态说明。非线性系统受非线性约束是目前其他任何摩擦力表述形式所不能够做到的。本算例选取该受非线性约束的非线性系统能够很好的展现本发明的优越性。
3、计算获得约束力。利用Udwadia-Kalaba方程推导出约束力的理想约束力和非理想约束力两个组成部分;
M q · · = Q + Q i c + Q ni c = Q + M 1 2 B + ( b - AM - 1 Q ) + M 1 2 ( I - B + B ) M - 1 2 C
总的约束力由上述等式后两部分组成:
第一部分中的
Figure BDA0000110631720000125
是由所有理想约束产生的约束力,这一部分的约束力在虚位移下所作的虚功为0。
第二部分中的
Figure BDA0000110631720000126
是由非理想约束产生的约束力。
4、获得正压力和切向力。推导得到笛卡尔坐标下正压力和切向力解析形式的表达式;
定义向量p(t),
p(t)=[x(t) y(t) z(t)]T
假设有如下运动关系:
x=fx(q,t)
y=fy(q,t)
z=yz(q,t)
雅可比矩阵可以描述为:
J ( q ( t ) = ∂ f x ( q , t ) ∂ q 1 ∂ f x ( q , t ) ∂ q 2 · · · ∂ f x ( q , t ) ∂ q n ∂ f y ( q , t ) ∂ q 1 ∂ f y ( q , t ) ∂ q 2 · · · ∂ f y ( q , t ) ∂ q n ∂ f z ( q , t ) ∂ q 1 ∂ f z ( q , t ) ∂ q 2 . . . ∂ f z ( q , t ) ∂ q n
定义Q为广义力,F为相应的笛卡尔坐标下的力,运用上述雅可比矩阵,可以得到如下关系式:
p · ( t ) = J ( q ( t ) , t ) q · ( t )
Q(t)=JT(q(t),t)F(t)
F(t)=(J(q(t),t)JT(q(t),t))-1J(q(t),t)Q(t)
笛卡尔坐标正压力和切向力解析形式的表达式:
F n ( t ) = ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) Q id c ( q · ( t ) , q ( t ) , t )
= ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) × M - 1 2 ( q ( t ) , t ) B + ( q ( t ) , t ) ( b ( ( q · ( t ) , q ( t ) , t ) ) )
- A ( q ( t ) , t ) M - 1 ( q ( t ) , t ) Q ( q · ( t ) , q ( t ) , t )
F t ( t ) = ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) Q t c ( q · ( t ) , q ( t ) , t )
= ( J ( q ( t ) , t ) J T ( q ( t ) , t ) - 1 J ( q ( t ) , t ) × ( I - A M + ( q ( t ) , t ) A ( q ( t ) , t ) ) Q ( q · ( t ) , q ( t ) , t )
5、获得摩擦力。这里假设摩擦力为库仑摩擦力,一般库仑摩擦力广义坐标表达式为:
Q c ( q · , q , t ) = - μ J T ( q , t ) | | F n ( t ) | | J ( q , t ) q · | | J ( q , t ) q · | | , q · ≠ 0
针对该具体机械系统,展开上述摩擦力解析形式,库伦摩擦力的解析表达为
Q f = [ [ - μ ( ( j 1 ( n 1 b 1 + n 2 b 2 ) + j 2 ( n 2 b 1 + n 3 b 2 ) ) 2 ( b - b 3 ) 2 + ( j 3 ( n 1 b 1 + n 2 b 2 ) + j 4 ( n 2 b 1 + n 3 b 2 ) ) 2 ( b - b 3 ) 2 ) 1 2
( ( ( - l 1 sin θ 1 - l 2 sin ( θ 1 + θ 2 ) ) q · 1 + ( - l 2 sin ( θ 1 + θ 2 ) ) q · 2 ) 2 + ( ( l 1 cos θ 1 + l 2 cos ( θ 1 + θ 2 ) ) q · 1 + ( l 2 cos ( θ 1
+ θ 2 ) ) q 2 · ) 2 ) - 1 2 ( ( - l 1 sin θ 1 - l 2 sin ( θ 1 + θ 2 ) ) ( ( - l 1 sin θ 1 - l 2 sin ( θ 1 + θ 2 ) ) q · 1 + ( - l 2 sin ( θ 1 + θ 2 ) ) q · 2 )
+ ( l 1 cos θ 1 + l 2 cos ( θ 1 + θ 2 ) ) ( ( l 1 cos θ 1 + l 2 cos ( θ 1 + θ 2 ) ) q · 1 + ( l 2 cos ( θ 1 + θ 2 ) ) q · 2 ) ) ] ;
[ - μ ( ( j 1 ( n 1 b 1 + n 2 b 2 ) + j 2 ( n 2 b 1 + n 3 b 2 ) ) 2 ( b - b 3 ) 2 + ( j 3 ( n 1 b 1 + n 2 b 2 ) + j 4 ( n 2 b 1 + n 3 b 2 ) ) 2 ( b - b 3 ) 2 ) 1 2
( ( ( - l 1 sin θ 1 - l 2 sin ( θ 1 + θ 2 ) ) θ · 1 + ( - l 2 sin ( θ 1 + θ 2 ) ) θ · 2 ) 2 + ( ( l 1 cos θ 1 + l 2 cos ( θ 1 + θ 2 ) ) θ · 1 + ( l 2 cos ( θ 1
+ θ 2 ) ) θ · 2 ) 2 ) - 1 2 ( ( - l 2 sin ( θ 1 + θ 2 ) ) ( ( - l 1 sin θ 1 - l 2 sin ( θ 1 + θ 2 ) ) θ · 1 + j 2 θ · 2 ) + ( l 2 cos ( θ 1 + θ 2 ) ) ( ( l 1 cos θ 1
- l 2 cos ( θ 1 + θ 2 ) ) θ · 1 + ( l 2 cos ( θ 1 + θ 2 ) ) θ · 2 ) ) ] ] ,
其中,
j1=(((l1cosθ1+l2cos(θ12))2+(l2cos(θ12))2)(-l1simθ1-l2sin(θ12))-((-l1sinθ1-l2sin(θ12))(l1cosθ1+l2cos(θ12))+(-l2sm(θ12))(l2cos(θ12)))(l1cosθ1+l2cos(θ12)))((-l1sinθ1-l2sin(θ12))2(l2cos(θ12))2+(-l2sin(θ12))2(l1cosθ1+l2cos(θ12))2-2(-l1sinθ1-l2sin(θ12))(l1cosθ1+l2cos(θ12))(-l2sin(θ12))(l2cos(θ12)))-1
j2=(((l1cosθ1+l2cos(θ12))2+(l2cos(θ12))2)(-l2sin(θ12))-((-l1sinθ1-l2sin(θ12))(l1cosθ1+l2ccs(θ12))+(-l2sin(θ12))(l2cos(θ12)))(l2cos(θ12)))((-l1sinθ1-l2sin(θ12))2(l2cos(θ12))2+(-l2sin(θ12))2(l1cosθ1+l2cos(θ12))2-2(-l1sinθ1-l2sin(θ12))(l1cosθ1+l2cos(θ12))(-l2sin(θ12))(l2cos(θ12)))-1
j3=(((-l1sinθ1-l2sin(θ12))2+(-l1sinθ1-l2sin(θ12))2)(l1cosθ1-l2cos(θ12))-((-l1sinθ1-l2sin(θ12))(l1cosθ1+l2cos(θ12))+(-l2sin(θ12))(l2cos(θ12)))(-l1sinθ1-l2sin(θ12)))((-l1sinθ1-l2sin(θ12))2(l2cos(θ12))2+(-l2sin(θ12))2(l1cosθ1+l2cos(θ12))2-2(-l1sinθ1-l2sin(θ12))(l1cosθ1+l2cos(θ12))(-l2sin(θ12))(l2cos(θ12)))-1
j4=(((-l1sinθ1-l2sin(θ12))2+(-l1sinθ1-l2sin(θ12))2)(l2cos(θ12))-((-l1sinθ1-l2sin(θ12))(l1cosθ1+l2cos(θ12))+(-l2sin(θ12))(l2cos(θ12)))(-l2sin(θ12)))((-l1sinθ1-l2sin(θ12))2(l2cos(θ12))2+(-l2sin(θ12))2(l1cosθ1+l2cos(θ12))2-2(-l1sinθ1-l2sin(θ12))(l1cosθ1+l2cos(θ12))(-l2sin(θ12))(l2cos(θ12)))-1
n 1 = 1 4 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) - 1 2 ( 2 m 22
+ 2 m 11 - 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 ( m 22 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 + m 11 ( 2 m 22
+ 2 m 11 + 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 - m 11 ( 2 m 22 + 2 m 11 - 2 ( m 22 2 - 2 m 22 m 11 + m 11 2
+ 4 m 12 2 ) 1 2 ) 1 2 - m 22 ( 2 m 22 + 2 m 11 + 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 + m 22 ( 2 m 11 +
2 m 11 - 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 + ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ( 2 m 22 + 2 m 11
+ 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) ,
n 2 = 1 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) - 1 2 m 12 ( - ( 2
m 22 + 2 m 11 + 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + m 12 2 ) 1 2 ) + ( 2 m 22 + 2 m 11 - 2 ( m 22 2 - 2 m 22 m 11 + m 11 2
+ tm 12 2 ) 1 2 ) ) ,
n 3 = 1 4 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) - 1 2 ( 2 m 22
+ 2 m 11 - 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 + ( m 22 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 + m 22 ( 2 m 22
+ 2 m 11 + 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 - m 22 ( 2 m 22 + 2 m 11 - 2 ( m 22 2 - 2 m 22 m 11 + m 11 2
+ 4 m 12 2 ) 1 2 ) 1 2 - m 11 ( 2 m 22 + 2 m 11 + 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 + m 11 ( 2 m 22 +
2 m 11 - 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) 1 2 + ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ( 2 m 22 + 2 m 11
+ 2 ( m 22 2 - 2 m 22 m 11 + m 11 2 + 4 m 12 2 ) 1 2 ) ,
b 1 = ( a 1 n 3 - a 2 n 2 ) ( n 1 n 3 - n 2 2 ) - 1 ( ( a 1 n 3 - a 2 n 2 ) ( n 1 n 3 - n 2 2 ) - 2 + ( a 2 n 1 - a 1 n 2 ) ( n 1 n 3 - n 2 2 ) - 2 ) - 1 ,
b 2 = ( a 2 n 1 - a 1 n 2 ) ( n 1 n 3 - n 2 2 ) - 1 ( ( a 1 n 3 - a 2 n 2 ) ( n 1 n 3 - n 2 2 ) - 2 + ( a 2 n 1 - a 1 n 2 ) ( n 1 n 3 - n 2 2 ) - 2 ) - 1 ,
b 3 = ( - m 12 2 + m 22 m 11 ) - 1 ( h 1 a 1 m 22 - h 1 a 2 m 12 - h 2 a 1 m 12 + h 2 a 2 m 11 ) ,
利用所求的摩擦力解析形式,对系统进行数值仿真,具体参数选取如下:
机械手的质量参数:m1=1,m2=1,
机械手的几何参数:l1=1,l2=2,
重力加速度:g=9.8
摩擦系数:μ=0.1
选取抛物线约束方程:y=1/4x2(即β=1/4,γ=0)
控制器力矩输入:τ1=5sint,τ2=2
在此驱动力矩的作用下,机械手系统杆2末端将在抛物线约束的轨迹内作往复运动,并且正压力随时间变化而改变。以往尚无任何摩擦力表述形式能够处理以上非线性机械系统中摩擦力接触面正压力为变值的情况。
用本发明的方法建立机械手解析形式的摩擦力形式,进行动力学分析,就可以得到该过程中正压力随时间的变化而变化如图3所示,得到x向的运动位移和摩擦力如图4和图5所示,得到y方向的运动位移和摩擦力如图6和图7所示,进而克服了以往不能建立机械手随正压力变化的解析形式摩擦力的缺点。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。

Claims (4)

1.一种机械手摩擦力动力学精确分析和控制应用方法,其特征在于,步骤如下:
(1)、建立机械手的动力学方程,其形式为
M q · · = Q
其中,M为机械手的质量矩阵,q为系统广义坐标,
Figure FDA0000110631710000012
为系统广义速度,
Figure FDA0000110631710000013
为系统广义加速度,Q为机械手所受的外力;
(2)、建立摩擦力处的约束方程:建立机械手轨迹或运动副间的m个约束方程,假设其中包含h个完整约束和m-h个非完整约束,则h个完整约束描述如下:
Figure FDA0000110631710000014
其中,
Figure FDA0000110631710000015
为第i个完整约束方程的表达式;
对其余的m-h个非完整约束,可以描述为:
Figure FDA0000110631710000016
其中,
Figure FDA0000110631710000017
为第i个非完整约束方程的表达式;
对完整约束求二阶导,对非完整约束求一阶导可以得到如下对广义坐标两阶导统一形式的约束方程:
A ( q , t ) q · · = b ( q · , q , t )
其中,A(q,t)=[Ali(q,t)]m×n为约束方程矩阵,为其他非二阶导项的组合;
(3)、利用Udwadia-Kalaba方程建立该机械手约束系统的整体动力学解析方程,得到理想约束力:利用Udwadia-Kalaba方程推导出机械手约束力的两个组成部分,分别是理想约束的约束力和非理想约束的约束力,机械手整体坐标系下的动力学方程为如下形式:
M q · · = Q + Q i c + Q ni c = Q + M 1 2 B + ( b - AM - 1 Q ) + M 1 2 ( I - B + B ) M - 1 2 C
其中,
Figure FDA00001106317100000111
为理想约束产生的理想约束力,
Figure FDA00001106317100000112
为非理想约束产生的非理想约束力,
Figure FDA00001106317100000113
B+为B的广义逆;Q是表示作用在机械手上的外力的总和。
Figure FDA00001106317100000114
是由所有理想约束产生的理想约束力,这一部分的约束力在虚位移下所作的虚功为0;
Figure FDA00001106317100000115
是由非理想约束产生的非理想约束力,这部分力在虚位移下所做的虚功不为零;
(4)、分解理想约束力,得到正压力和切向力:分析可知空间机械手的约束平面其端点的约束力可以分解为如下两个组成部分:
Q ( q · , q , t ) = Q p ( q · , q , t ) + Q t ( q · , q , t )
其中, Q p ( q · , q , t ) = A + ( q , t ) A ( q , t ) Q ( q · , q , t ) 为正压力, Q t ( q · , q , t ) = ( 1 - A + ( q , t ) A ( q , t ) ) Q ( q · , q , t ) 为切向力;
(5)、推导经典摩擦力和扩展摩擦力模型的解析形式:根据上述所得正压力方程,推导经典摩擦力模型和扩展摩擦力模型的解析形式表达式。
2.根据权利要求1所述的机械手摩擦力动力学精确分析和控制应用方法,其特征在于,所述步骤(5)中,经典摩擦力模型采用库仑摩擦力模型,库仑摩擦力的解析形式表达式为:
F c = - μ | | F n ( t ) | | p ^ ( t ) , p ^ ≠ 0
其中,Fc为机械手所受的库仑摩擦力,μ为摩擦系数,||Fn(t)||为正压力的大小,
Figure FDA0000110631710000024
表示摩擦力的方向,其表达式为:
p ^ ( t ) = p · ( t ) | | p · ( t ) | | p · ≠ 0
转化为笛卡尔坐标系下的方向表达式为:
p ^ ( t ) = J ( q ( t ) , t ) q · ( t ) | | J ( q ( t ) , t ) q · ( t ) | | q · ≠ 0
于是得到解析形式的机械库仑摩擦力广义坐标表达式为:
Q c ( q · , q , t ) = - μ J T ( q , t ) | | F n ( t ) | | J ( q , t ) q · | | J ( q , t ) q · | | , q · ≠ 0 .
3.根据权利要求2所述的机械手摩擦力动力学精确分析和控制应用方法,其特征在于,所述步骤(5)中,经典摩擦力模型采用静摩擦力模型,静摩擦力的解析形式表达式为:
|Fm(t)||=μs||Fn(t)||
其中,||Fn(t)||为正压力的大小,μs是静摩擦力系数,Fm和Fn部是随时间变化的函数,得到解析形式的摩擦力如下:
F s ( t ) = - F t ( t ) , q · = 0 and | | F t | | ≤ | | F s | | - μ s | | F n ( t ) | | f ^ ( t ) , q · = 0 and | | F t | | > | | F s | |
其中,
Figure FDA0000110631710000029
为静摩擦力的方向表达式,因此,解析形式的静摩擦力表达式为:
Q s ( t ) = - Q t ( t ) , q · = 0 and | | F t | | ≤ | | F s | | - μ s J T ( q , t ) | | F n ( t ) | | f ^ ( t ) , q · = 0 and | | F t | | > | | F s | |
通过合并,得到机械手所受的静摩擦力可以表示为如下解析形式:
Q f = - μ J T | | F n | | p ^ , q · ≠ 0 - Q t , q · = 0 and | | F t | | ≤ | | F s | | - μ s J T | | F n | | f ^ , q · = 0 and | | F t | | > | | F s | | .
4.根据权利要求1所述的机械手摩擦力动力学精确分析和控制应用方法,其特征在于,所述步骤(5)中,扩展摩擦力模型采用Dahl摩擦力模型或LuGre摩擦力模型,则
Dahl摩擦力的解析表达式为:
dF fk dt = σ ( 1 - F fk { μ | | ( JJ T ) - 1 JM 1 2 B + ( b - AM - 1 Q ) | | } k ) α k · , k = x , y , z
其中,Ffk为Dahl摩擦力,σ为刚性系数,α是用来确定应力应变曲线形状的系数;为库仑摩擦力的大小,这样即得到Dahl摩擦力的大小;
LuGre摩擦力的解析表达式为:
d ω k dt = k · - σ 0 | | k · | | g k ω k , g k = { μ | | F N | | } k + { ( μ s - μ ) | | F N | | } k e - ( k · / v sk ) 2 F fk = σ 0 ω k + σ 0 dω k dt + f k , k = x , y , z
其中,
Figure FDA0000110631710000034
vsk为Stribeck速度,σ0为刚性系数,σ1为阻尼系数,f为viscous摩擦力,取值为f=σ2v,||FN||为库仑摩擦力的大小。
CN201110371461.6A 2011-11-21 2011-11-21 机械手摩擦力动力学精确分析与控制应用方法 Expired - Fee Related CN102508436B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110371461.6A CN102508436B (zh) 2011-11-21 2011-11-21 机械手摩擦力动力学精确分析与控制应用方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110371461.6A CN102508436B (zh) 2011-11-21 2011-11-21 机械手摩擦力动力学精确分析与控制应用方法

Publications (2)

Publication Number Publication Date
CN102508436A true CN102508436A (zh) 2012-06-20
CN102508436B CN102508436B (zh) 2014-07-16

Family

ID=46220537

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110371461.6A Expired - Fee Related CN102508436B (zh) 2011-11-21 2011-11-21 机械手摩擦力动力学精确分析与控制应用方法

Country Status (1)

Country Link
CN (1) CN102508436B (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104697770A (zh) * 2015-01-06 2015-06-10 武汉华威专用汽车检测有限责任公司 利用工业机器人进行刚性测试的系统及方法
CN106426174A (zh) * 2016-11-05 2017-02-22 上海大学 一种基于力矩观测和摩擦辨识的机器人接触力检测方法
CN107423515A (zh) * 2017-08-01 2017-12-01 中科新松有限公司 机械臂摩擦辨识方法、装置、设备及存储介质
CN108024756A (zh) * 2015-09-30 2018-05-11 3M创新有限公司 用于优化身体与对象相互作用的系统和方法
CN108038286A (zh) * 2017-11-30 2018-05-15 长安大学 一种二自由度冗余驱动并联机器人的动力学建模方法
CN108459605A (zh) * 2018-03-22 2018-08-28 合肥工业大学 基于agv系统的轨迹跟踪控制方法
CN108466289A (zh) * 2018-03-07 2018-08-31 长安大学 一种考虑关节摩擦的并联机器人的动力学建模方法
CN108762066A (zh) * 2018-04-24 2018-11-06 合肥工业大学 一种直升机电动尾部减速器系统的控制方法
CN109660154A (zh) * 2019-02-01 2019-04-19 东南大学 一种伺服柔性负载新型速度控制方法
CN113821935A (zh) * 2021-09-30 2021-12-21 合肥工业大学 基于对称约束的动力学模型的建立方法及其系统
CN114818354A (zh) * 2022-05-09 2022-07-29 合肥工业大学 一种机器人柔性关节摩擦力解析与建模方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030115037A1 (en) * 2000-08-25 2003-06-19 Shizuo Sumida Simulation model creation method and system, and storage medium
US20070143074A1 (en) * 2004-06-07 2007-06-21 Abb Research Ltd. Method of generating optical control problems for industrial processes
CN101105821A (zh) * 2007-08-23 2008-01-16 上海交通大学 虚拟装配操作过程的装配工艺生成方法
CN101517498A (zh) * 2006-09-22 2009-08-26 埃克森美孚研究工程公司 模型预测控制器解分析过程
CN101526801A (zh) * 2009-04-17 2009-09-09 天津理工大学 履带式移动机械手的广义系统统一动力学建模方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030115037A1 (en) * 2000-08-25 2003-06-19 Shizuo Sumida Simulation model creation method and system, and storage medium
US20070143074A1 (en) * 2004-06-07 2007-06-21 Abb Research Ltd. Method of generating optical control problems for industrial processes
CN101517498A (zh) * 2006-09-22 2009-08-26 埃克森美孚研究工程公司 模型预测控制器解分析过程
CN101105821A (zh) * 2007-08-23 2008-01-16 上海交通大学 虚拟装配操作过程的装配工艺生成方法
CN101526801A (zh) * 2009-04-17 2009-09-09 天津理工大学 履带式移动机械手的广义系统统一动力学建模方法

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104697770B (zh) * 2015-01-06 2017-04-19 武汉华威专用汽车检测有限责任公司 利用工业机器人进行刚性测试的系统及方法
CN104697770A (zh) * 2015-01-06 2015-06-10 武汉华威专用汽车检测有限责任公司 利用工业机器人进行刚性测试的系统及方法
CN108024756A (zh) * 2015-09-30 2018-05-11 3M创新有限公司 用于优化身体与对象相互作用的系统和方法
CN106426174B (zh) * 2016-11-05 2019-01-11 上海大学 一种基于力矩观测和摩擦辨识的机器人接触力检测方法
CN106426174A (zh) * 2016-11-05 2017-02-22 上海大学 一种基于力矩观测和摩擦辨识的机器人接触力检测方法
CN107423515A (zh) * 2017-08-01 2017-12-01 中科新松有限公司 机械臂摩擦辨识方法、装置、设备及存储介质
CN107423515B (zh) * 2017-08-01 2020-08-04 中科新松有限公司 机械臂摩擦辨识方法、装置、设备及存储介质
CN108038286B (zh) * 2017-11-30 2021-12-03 长安大学 一种二自由度冗余驱动并联机器人的动力学建模方法
CN108038286A (zh) * 2017-11-30 2018-05-15 长安大学 一种二自由度冗余驱动并联机器人的动力学建模方法
CN108466289A (zh) * 2018-03-07 2018-08-31 长安大学 一种考虑关节摩擦的并联机器人的动力学建模方法
CN108466289B (zh) * 2018-03-07 2021-06-04 长安大学 一种考虑关节摩擦的并联机器人的动力学建模方法
CN108459605A (zh) * 2018-03-22 2018-08-28 合肥工业大学 基于agv系统的轨迹跟踪控制方法
CN108459605B (zh) * 2018-03-22 2020-11-20 合肥工业大学 基于agv系统的轨迹跟踪控制方法
CN108762066A (zh) * 2018-04-24 2018-11-06 合肥工业大学 一种直升机电动尾部减速器系统的控制方法
CN108762066B (zh) * 2018-04-24 2021-03-12 合肥工业大学 一种直升机电动尾部减速器系统的控制方法
CN109660154A (zh) * 2019-02-01 2019-04-19 东南大学 一种伺服柔性负载新型速度控制方法
CN113821935A (zh) * 2021-09-30 2021-12-21 合肥工业大学 基于对称约束的动力学模型的建立方法及其系统
CN113821935B (zh) * 2021-09-30 2024-02-02 合肥工业大学 基于对称约束的动力学模型的建立方法及其系统
CN114818354A (zh) * 2022-05-09 2022-07-29 合肥工业大学 一种机器人柔性关节摩擦力解析与建模方法
CN114818354B (zh) * 2022-05-09 2024-02-13 合肥工业大学 一种机器人柔性关节摩擦力解析与建模方法

Also Published As

Publication number Publication date
CN102508436B (zh) 2014-07-16

Similar Documents

Publication Publication Date Title
CN102508436B (zh) 机械手摩擦力动力学精确分析与控制应用方法
Sohl et al. A recursive multibody dynamics and sensitivity algorithm for branched kinematic chains
CN102495550B (zh) 并联机器人的正、逆动力学响应分析与控制方法
CN103399986B (zh) 基于微分几何的空间机械臂建模方法
CN103331756A (zh) 一种机械臂运动控制方法
CN105631167A (zh) 一种航天器热致振动动力学响应评估方法
CN102848391A (zh) 基于真实力反馈的四通道双边遥操作控制系统
She et al. On the impact force of human-robot interaction: Joint compliance vs. link compliance
CN104281730A (zh) 一种大转动变形的板壳结构动响应的有限元分析方法
CN103862459A (zh) 一种用于机载并联平台的位姿观测器设计方法
CN101635063A (zh) 一种椭圆截面弹性柱体自由扭转/变形的模拟方法
CN103678897B (zh) 一种基于凯恩方程的飞轮隔振平台专用动力学建模方法
Jung et al. Step-wise combined implicit–explicit finite-element simulation of autobody stamping processes
CN106773782A (zh) 一种气动伺服弹性混合建模方法
CN104155909B (zh) 基于pc+fpga的带速度观测器的有限时间稳定性控制系统
CN104361145B (zh) 一种基于贴轴坐标系的转子动力学建模方法
CN103217924A (zh) 面向实时控制应用的过约束重型并联机床动力学建模方法
Ayusawa et al. Comprehensive Theory of Differential Kinematics and Dynamics for Motion Optimization.
CN105740485A (zh) 一种机械系统力学的运动仿真方法及系统
Bejczy Dynamic analysis for robot arm control
Norrlöf Modeling of industrial robots
Wang et al. Research on a Workspace Analysis Method of Cable-Driven Parallel Mechanism Considering Inertia Force
Maciąg et al. Direct sensitivity analysis of planar multibody systems in the Hamiltonian framework
Pogorelov Simulation of constraints by compliant joints
Chen Error Modeling Analysis of Parallel Robot Based on Improved Fish Swarm Algorithm

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20140716

Termination date: 20151121

EXPY Termination of patent right or utility model