CN102508436B - 机械手摩擦力动力学精确分析与控制应用方法 - Google Patents
机械手摩擦力动力学精确分析与控制应用方法 Download PDFInfo
- Publication number
- CN102508436B CN102508436B CN201110371461.6A CN201110371461A CN102508436B CN 102508436 B CN102508436 B CN 102508436B CN 201110371461 A CN201110371461 A CN 201110371461A CN 102508436 B CN102508436 B CN 102508436B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- friction
- mover
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 230000014509 gene expression Effects 0.000 claims abstract description 50
- 230000003068 static effect Effects 0.000 claims description 39
- 239000011159 matrix material Substances 0.000 claims description 22
- 230000000452 restraining effect Effects 0.000 claims description 13
- 230000001133 acceleration Effects 0.000 claims description 5
- 238000013016 damping Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims 2
- 230000004044 response Effects 0.000 abstract description 2
- 230000008859 change Effects 0.000 description 10
- 230000008569 process Effects 0.000 description 9
- 230000000694 effects Effects 0.000 description 7
- 230000033001 locomotion Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 238000009795 derivation Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000005461 lubrication Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 229940113046 sorine Drugs 0.000 description 1
- ZBMZVLHSJCTVON-UHFFFAOYSA-N sotalol Chemical compound CC(C)NCC(O)C1=CC=C(NS(C)(=O)=O)C=C1 ZBMZVLHSJCTVON-UHFFFAOYSA-N 0.000 description 1
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为机械手所受的外力;
(2)、建立摩擦力处的约束方程:建立机械手轨迹或运动副间的m个约束方程,假设其中包含h个完整约束和m-h个非完整约束;
对其完整约束可以描述如下:
其中,为第i个完整约束方程的表达式。
对其余的m-h个非完整约束,可以描述为:
其中,为第i个非完整约束方程的表达式;
对完整约束求二阶导,对非完整约束求一阶导可以得到如下对广义坐标两阶导统一形式的约束方程:
其中,A(q,t)=[Ali(q,t)]m×n为约束方程矩阵,为其他非二阶导项的组合;
(3)、利用Udwadia-Kalaba方程建立该机械手约束系统的整体动力学解析方程,得到理想约束力:利用Udwadia-Kalaba方程推导出机械手约束力的两个组成部分,分别是理想约束的约束力和非理想约束的约束力,机械手整体坐标系下的动力学方程为如下形式:
其中为理想约束产生的理想约束力,为非理想约束产生的非理想约束力,B+为B的广义逆。上述动力学方程等式右的三个组成部分分别表示为:
第一部分Q是表示作用在机械手上的外力的总和;
第二部分是由所有理想约束产生的理想约束力,这一部分的约束力在虚位移下所作的虚功为0。
第三部分中的是由非理想约束产生的非理想约束力,这一部分的约束力在虚位移下所做的虚功不为零;
(4)、分解理想约束力,计算得到正压力和切向力。分析可知空间机械手的约束平面其端点的约束力可以分解为如下两个组成部分:
其中, 为正压力, 为切向力;
以下将推导得到笛卡尔坐标下正压力和切向力解析形式的表达式;
定义机械手系统端部向量在笛卡尔坐标系下可以表示为p(t),
p(t)=[x(t)y(t)z(t)]T
假设机械手的端部的向量可以用以下运动方程来表达:
x=fx(q,t)
y=fy(q,t)
z=fz(q,t)
则其与广义坐标之间的雅可比矩阵可以表示为:
定义Q∈为广义坐标系下的广义力,F∈为相应的笛卡尔坐标系下的三向力,运用上述雅可比矩阵,可以得到如下关系式:
Q∈(t)=JT(q(t),t)F∈(t)
F∈(t)=(J(q(t),t)JT(q(t),t))-1J(q(t),t)Q∈(t)
则机械手系统在笛卡尔坐标系下正压力和切向力解析形式的表达式为:
其中,为B(q,t)的广义逆,A(q(t),t)为约束方程矩阵,A+(q,t)为A(q,t)的广义逆,为A的广义逆的M逆,其关系可以表达为
(5)、获得经典摩擦力和扩展摩擦力的解析形式:推导经典摩擦力模型(如,库仑摩擦力模型、静摩擦力模型等)和扩展摩擦力模型(如,Dahl摩擦力模型、LuGre摩擦力模型等)的解析形式表达式。
在下面的描述中,||·||均表示取向量的模。
作为本发明的进一步细化描述:
所述步骤(5)中,如经典摩擦力模型采用库仑摩擦力模型,库仑摩擦力的解析形式表达式为:
其中,Fc为机械手所受的库仑摩擦力,μ为摩擦系数,||Fn(t)||为正压力的大小,表示摩擦力的方向,其表达式为:
转化为笛卡尔坐标系下的方向表达式为:
于是得到解析形式的机械库仑摩擦力广义坐标表达式为:
所述步骤(5)中,经典摩擦力模型采用静摩擦力模型,静摩擦力的解析形式表达式为:由于最大可能的静摩擦力大小直接与正压力的成比例关系并且方向与外力切线方向相反(平行于接触面);而任何小于最大可能静摩擦力的切向力都会受到一个反向作用且大小相等的静摩擦的作用。因此,最大可能摩擦力大小可以表述为:
||Fm(t)||=μs||Fn(t)||
其中,||Fn(t)||为正压力的大小,μs是静摩擦力系数,Fm和Fn都是随时间变化的函数。可以得到解析形式的摩擦力如下:
其中,为静摩擦力的方向表达式。
因此,解析形式的静摩擦力表达式为:
通过合并,得到机械手所受的静摩擦力可以表示为如下解析形式:
所述步骤(5)中,扩展摩擦力模型可以采用Dahl摩擦力模型或LuGre摩擦力模型等。机械手在实际工作过程中所受的摩擦力是多样的,由于库仑摩擦和静摩擦两者并不连续,不能概括动态特性的摩擦现象,如粘性摩擦,Stribeck效应,非对称性,位置相关性等等。Dahl摩擦力模型和LuGre摩擦力模型可以描述这些现象。但是这些扩展摩擦力模型都基于一个假设,即库仑摩擦力大小||Fc||和最大可能静摩擦力大小||Fm||已知。以往这些力的计算都是基于正压力不变的假设进行的。如扩展摩擦力模型采用Dahl摩擦力模型或LuGre摩擦力模型,则:
Dahl摩擦力的解析表达式为:
其中,Ffk为Dahl摩擦力,σ为刚性系数,α是用来确定应力应变曲线形状的系数。为库仑摩擦力的大小,这样即得到Dahl摩擦力的大小。
LuGre摩擦力的解析表达式为:
其中,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为机械手所受的外力;
(2)、建立摩擦力处的约束方程:建立机械手轨迹或运动副间的m个约束方程,假设其中包含h个完整约束和m-h个非完整约束;
对其完整约束可以描述如下:
其中,为第i个完整约束方程的表达式。
对其余的m-h个非完整约束,可以描述为:
其中,为第i个非完整约束方程的表达式;
对完整约束求二阶导,对非完整约束求一阶导可以得到如下对广义坐标两阶导统一形式的约束方程:
其中,A(q,t)=[Ali(q,t)]m×n为约束方程矩阵,为其他非二阶导项的组合;
(3)、利用Udwadia-Kalaba方程建立该机械手约束系统的整体动力学解析方程,得到理想约束力:利用Udwadia-Kalaba方程推导出机械手约束力的两个组成部分,分别是理想约束的约束力和非理想约束的约束力,机械手整体坐标系下的动力学方程为如下形式:
其中为理想约束产生的理想约束力,为非理想约束产生的非理想约束力,B+为B的广义逆。上述动力学方程等式右的三个组成部分分别表示为:
第一部分Q是表示作用在机械手上的外力的总和;
第二部分是由所有理想约束产生的理想约束力,这一部分的约束力在虚位移下所作的虚功为0;
第三部分中的是由非理想约束产生的非理想约束力,这一部分的约束力在虚位移下所做的虚功不为零。
(4)、分解理想约束力,计算得到正压力和切向力。分析可知空间机械手的约束平面其端点的约束力可以分解为如下两个组成部分:
其中, 为正压力, 为切向力;
以下将推导得到笛卡尔坐标下正压力和切向力解析形式的表达式;
定义机械手系统端部向量在笛卡尔坐标系下可以表示为p(t),
p(t)=[x(t) y(t) z(t)]T
假设机械手的端部的向量可以用以下运动方程来表达:
x=fx(q,t)
y=fy(q,t)
z=fz(q,t)
则其与广义坐标之间的雅可比矩阵可以表示为:
定义Q∈为广义坐标系下的广义力,F∈为相应的笛卡尔坐标系下的三向力,运用上述雅可比矩阵,可以得到如下关系式:
Q∈(t)=JT(q(t),t)F∈(t)
F∈(t)=(J(q(t),t)JT(q(t)t))-1J(q(t),t)Q∈(t)
则机械手系统在笛卡尔坐标系下正压力和切向力解析形式的表达式为:
其中,为B(q,t)的广义逆,A(q(t),t)为约束方程矩阵,A+(q,t)为A(q,t)的广义逆,为A的广义逆的M逆,其关系可以表达为
(5)、获得经典摩擦力和扩展摩擦力的解析形式:推导经典摩擦力模型(如,库仑摩擦力模型、静摩擦力模型等)和扩展摩擦力模型(如,Dahl摩擦力模型、LuGre摩擦力模型等)的解析形式表达式。
在下面的描述中,||·||均表示取向量的模。
作为本发明的进一步细化描述:
所述步骤(5)中,如经典摩擦力模型采用库仑摩擦力模型,库仑摩擦力的解析形式表达式为:
其中,Fc为机械手所受的库仑摩擦力,μ为摩擦系数,||Fn(t)||为正压力的大小,表示摩擦力的方向,其表达式为:
转化为笛卡尔坐标系下的方向表达式为:
于是得到解析形式的机械库仑摩擦力广义坐标表达式为:
所述步骤(5)中,如经典摩擦力模型采用静摩擦力模型,静摩擦力的解析形式表达式为:
由于最大可能的静摩擦力大小直接与正压力的成比例关系并且方向与外力切线方向相反(平行于接触面);而任何小于最大可能静摩擦力的切向力都会受到一个反向作用且大小相等的静摩擦的作用。因此,最大可能摩擦力大小可以表述为:
||Fm(t)||=μs||Fn(t)||
其中,||Fn(t)||为正压力的大小,μs是静摩擦力系数,Fm和Fn都是随时间变化的函数。可以得到解析形式的摩擦力如下:
其中,为静摩擦力的方向表达式。
因此,解析形式的静摩擦力表达式为:
合并上述动摩擦力和静摩擦力公式,得到机械手所受的静摩擦力可以表示为如下解析形式:
所述步骤(5)中,扩展摩擦力模型可以采用Dahl摩擦力模型或LuGre摩擦力模型等。机械手在实际工作过程中所受的摩擦力是多样的,由于库仑摩擦和静摩擦两者并不连续,不能概括动态特性的摩擦现象,如粘性摩擦,Stribeck效应,非对称性,位置相关性等等。Dahl摩擦力模型和LuGre摩擦力模型可以描述这些现象。但是这些扩展摩擦力模型都基于一个假设,即库仑摩擦力大小||Fc||和最大可能静摩擦力大小||Fm||已知。以往这些力的计算都是基于正压力不变的假设进行的。如扩展摩擦力模型可以采用Dahl摩擦力模型或LuGre摩擦力模型,则:
Dahl摩擦力的解析表达式为:
其中,Ffk为Dahl摩擦力,σ为刚性系数,α是用来确定应力应变曲线形状的系数。为库仑摩擦力的大小,这样即得到Dahl摩擦力的大小。
LuGre摩擦力的解析表达式为:
其中,vsk为Stribeck速度,σ0为刚性系数,σ1为阻尼系数,可以选择为f为viscous摩擦力取值为f=σ2v,||FN||为库仑摩擦力的大小。
本实施例中,以平面二连杆机械手系统为具体应用实例对本发明进行详细的说明,参见图1和图2,其具体流程为:
1、建立机械手的动力学方程。这里取θ1,θ2作为机械手系统的广义坐标系,如图2所示。机械手的控制器输入力矩为[τ1 τ2],运用拉格朗日方程,建立机械手系统的动力学方程如下:
其中,m1,m2分别为机械手系统的第一、第二根机械臂的质量,l1,l2分别为机械手系统的第一、第二根机械臂的长度,g为重力加速度。
整理动力学方程,得到机械手的动力学方程为如下形式:
其中,
2、施加约束,建立约束方程。假设机械手的末端的约束在如下抛物线的轨迹上,其轨迹方程为:
y=βx2+γ
其中β,γ分别为抛物线的系数。机械手运动时的坐标应满足如下关系:
x=l1cosθ1+l2cos(θ1+θ2)
y=l1sinθ1+l2sin(θ1+θ2)
在广义坐标系下,其约束方程为:
l1sinθ1+l2sin(θ1+θ2)-β(l1cosθ1+l2cos(θ1+θ2))2-γ=0
对上述约束方程取二阶导,可以得到如下形式的约束方程:
其中,
A=2β(l1cosθ1+l2cos(θ1+θ2))(l2sin(θ1+θ2)+l1sinθ1)+l1cosθ1+l2cos(θ1+θ2),
2β(l1cosθ1+l2cos(θ1+θ2))l2sin(θ1+θ2)+l2cos(θ1+θ2)],
结合附图描叙工作原理及过程,即前面作静态描叙,后面动态说明。非线性系统受非线性约束是目前其他任何摩擦力表述形式所不能够做到的。本算例选取该受非线性约束的非线性系统能够很好的展现本发明的优越性。
3、计算获得约束力。利用Udwadia-Kalaba方程推导出约束力的理想约束力和非理想约束力两个组成部分;
总的约束力由上述等式后两部分组成:
第一部分中的是由所有理想约束产生的约束力,这一部分的约束力在虚位移下所作的虚功为0。
第二部分中的是由非理想约束产生的约束力。
4、获得正压力和切向力。推导得到笛卡尔坐标下正压力和切向力解析形式的表达式;
定义向量p(t),
p(t)=[x(t) y(t) z(t)]T
假设有如下运动关系:
x=fx(q,t)
y=fy(q,t)
z=yz(q,t)
雅可比矩阵可以描述为:
定义Q∈为广义力,F∈为相应的笛卡尔坐标下的力,运用上述雅可比矩阵,可以得到如下关系式:
Q∈(t)=JT(q(t),t)F∈(t)
F∈(t)=(J(q(t),t)JT(q(t),t))-1J(q(t),t)Q∈(t)
笛卡尔坐标正压力和切向力解析形式的表达式:
5、获得摩擦力。这里假设摩擦力为库仑摩擦力,一般库仑摩擦力广义坐标表达式为:
针对该具体机械系统,展开上述摩擦力解析形式,库伦摩擦力的解析表达为
其中,
j1=(((l1cosθ1+l2cos(θ1+θ2))2+(l2cos(θ1+θ2))2)(-l1simθ1-l2sin(θ1+θ2))-((-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2cos(θ1+θ2))+(-l2sm(θ1+θ2))(l2cos(θ1+θ2)))(l1cosθ1+l2cos(θ1+θ2)))((-l1sinθ1-l2sin(θ1+θ2))2(l2cos(θ1+θ2))2+(-l2sin(θ1+θ2))2(l1cosθ1+l2cos(θ1+θ2))2-2(-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2cos(θ1+θ2))(-l2sin(θ1+θ2))(l2cos(θ1+θ2)))-1,
j2=(((l1cosθ1+l2cos(θ1+θ2))2+(l2cos(θ1+θ2))2)(-l2sin(θ1+θ2))-((-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2ccs(θ1+θ2))+(-l2sin(θ1+θ2))(l2cos(θ1+θ2)))(l2cos(θ1+θ2)))((-l1sinθ1-l2sin(θ1+θ2))2(l2cos(θ1+θ2))2+(-l2sin(θ1+θ2))2(l1cosθ1+l2cos(θ1+θ2))2-2(-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2cos(θ1+θ2))(-l2sin(θ1+θ2))(l2cos(θ1+θ2)))-1,
j3=(((-l1sinθ1-l2sin(θ1+θ2))2+(-l1sinθ1-l2sin(θ1+θ2))2)(l1cosθ1-l2cos(θ1+θ2))-((-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2cos(θ1+θ2))+(-l2sin(θ1+θ2))(l2cos(θ1+θ2)))(-l1sinθ1-l2sin(θ1+θ2)))((-l1sinθ1-l2sin(θ1+θ2))2(l2cos(θ1+θ2))2+(-l2sin(θ1+θ2))2(l1cosθ1+l2cos(θ1+θ2))2-2(-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2cos(θ1+θ2))(-l2sin(θ1+θ2))(l2cos(θ1+θ2)))-1,
j4=(((-l1sinθ1-l2sin(θ1+θ2))2+(-l1sinθ1-l2sin(θ1+θ2))2)(l2cos(θ1+θ2))-((-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2cos(θ1+θ2))+(-l2sin(θ1+θ2))(l2cos(θ1+θ2)))(-l2sin(θ1+θ2)))((-l1sinθ1-l2sin(θ1+θ2))2(l2cos(θ1+θ2))2+(-l2sin(θ1+θ2))2(l1cosθ1+l2cos(θ1+θ2))2-2(-l1sinθ1-l2sin(θ1+θ2))(l1cosθ1+l2cos(θ1+θ2))(-l2sin(θ1+θ2))(l2cos(θ1+θ2)))-1,
利用所求的摩擦力解析形式,对系统进行数值仿真,具体参数选取如下:
机械手的质量参数: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为机械手所受的外力;
(2)、建立摩擦力处的约束方程:建立机械手轨迹或运动副间的m个约束方程,假设其中包含h个完整约束和m-h个非完整约束,则h个完整约束描述如下:
其中,为第i个完整约束方程的表达式,m、h为整数,且m>h>0;对其余的m-h个非完整约束,可以描述为:
其中,为第i个非完整约束方程的表达式;
对完整约束求二阶导,对非完整约束求一阶导可以得到如下对广义坐标两阶导统一形式的约束方程:
其中,为约束方程矩阵,为其他非一阶导项的组合;
(3)、利用Udwadia-Kalaba方程建立该机械手约束系统的整体动力学解析方程,得到理想约束力:利用Udwadia-Kalaba方程推导出机械手约束力的两个组成部分,分别是理想约束的约束力和非理想约束的约束力,机械手整体坐标系下的动力学方程为如下形式:
其中,为理想约束产生的理想约束力,为非理想约束产生的非理想约束力,B+为B的广义逆;Q为机械手所受的外力;是由所有理想约束产生的理想约束力,这一部分的约束力在虚位移下所作的虚功为0;是由非理想约束产生的非理想约束力,这部分力在虚位移下所做的虚功不为零;
(4)、分解理想约束力,得到正压力和切向力:分析可知空间机械手的约束平面其端点的理想约束力可以分解为如下两个组成部分:
其中,为正压力,为切向力,A+(q,t)是矩阵A(q,t)的Moore-Penrose广义逆阵;
(5)、推导经典摩擦力和扩展摩擦力模型的解析形式:根据上述所得正压力方程,推导经典摩擦力模型和扩展摩擦力模型的解析形式表达式。
2.根据权利要求1所述的机械手摩擦力动力学精确分析和控制应用方法,其特征在于,所述步骤(5)中,经典摩擦力模型采用库仑摩擦力模型,库仑摩擦力的解析形式表达式为:
其中,Fc为机械手所受的库仑摩擦力,μ为摩擦系数,为正压力的大小,表示摩擦力的方向,其表达式为:
转化为笛卡尔坐标系下的方向表达式为:
于是得到解析形式的机械力库仑摩擦力广义坐标表达式为:
其中,J矩阵为表征笛卡尔坐标与广义坐标之间变换关系的雅可比矩阵,JT表示矩阵J的转置矩阵。
3.根据权利要求2所述的机械手摩擦力动力学精确分析和控制应用方法,其特征在于,所述步骤(5)中,经典摩擦力模型采用静摩擦力模型,静摩擦力的解析形式表达式为:
||Fm(t)||=μs||Fn(t)||
其中,||Fn(t)||为正压力的大小,μs是静摩擦力系数,Fm和Fn都是随时间变化的函数,得到解析形式的摩擦力如下:
其中,为静摩擦力的方向表达式,因此,解析形式的静摩擦力表达式为:
通过合并,得到机械手所受的静摩擦力可以表示为如下解析形式:
其中,Fs表示静摩擦力,Ft表示切向力,μ表示动摩擦系数。
4.根据权利要求l所述的机械手摩擦力动力学精确分析和控制应用方法,其特征在于,所述步骤(5)中,扩展摩擦力模型采用Dahl摩擦力模型或LuGre摩擦力模型,则
Dahl摩擦力的解析表达式为:
其中,为Dahl摩擦力,σ为刚性系数,α是用来确定应力应变曲线形状的系数; 为库仑摩擦力的大小,这样即得到Dahl摩擦力的大小;
LuGre摩擦力的解析表达式为:
其中,为Stribeck速度,σo为刚性系数,σ1为阻尼系数,f为viscous摩擦力,取值为f=σ2v,||FN||为库仑摩擦力的大小,μ表示动摩擦系数,J矩阵为表征笛卡尔坐标与广义坐标之间变换关系的雅可比矩阵,JT表示矩阵J的转置矩阵,x,y,z分别表示笛卡尔坐标系的三个方向,μs表示静摩擦系数,σ2表示viscous摩擦力系数。
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 CN102508436A (zh) | 2012-06-20 |
CN102508436B true 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) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104697770B (zh) * | 2015-01-06 | 2017-04-19 | 武汉华威专用汽车检测有限责任公司 | 利用工业机器人进行刚性测试的系统及方法 |
EP3355778B1 (en) * | 2015-09-30 | 2020-12-09 | 3M Innovative Properties Company | System and method for optimizing body and object interactions |
CN106426174B (zh) * | 2016-11-05 | 2019-01-11 | 上海大学 | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 |
CN107423515B (zh) * | 2017-08-01 | 2020-08-04 | 中科新松有限公司 | 机械臂摩擦辨识方法、装置、设备及存储介质 |
CN108038286B (zh) * | 2017-11-30 | 2021-12-03 | 长安大学 | 一种二自由度冗余驱动并联机器人的动力学建模方法 |
CN108466289B (zh) * | 2018-03-07 | 2021-06-04 | 长安大学 | 一种考虑关节摩擦的并联机器人的动力学建模方法 |
CN108459605B (zh) * | 2018-03-22 | 2020-11-20 | 合肥工业大学 | 基于agv系统的轨迹跟踪控制方法 |
CN108762066B (zh) * | 2018-04-24 | 2021-03-12 | 合肥工业大学 | 一种直升机电动尾部减速器系统的控制方法 |
CN109660154B (zh) * | 2019-02-01 | 2020-11-03 | 东南大学 | 一种伺服柔性负载新型速度控制方法 |
CN113821935B (zh) * | 2021-09-30 | 2024-02-02 | 合肥工业大学 | 基于对称约束的动力学模型的建立方法及其系统 |
CN114818354B (zh) * | 2022-05-09 | 2024-02-13 | 合肥工业大学 | 一种机器人柔性关节摩擦力解析与建模方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101105821A (zh) * | 2007-08-23 | 2008-01-16 | 上海交通大学 | 虚拟装配操作过程的装配工艺生成方法 |
CN101517498A (zh) * | 2006-09-22 | 2009-08-26 | 埃克森美孚研究工程公司 | 模型预测控制器解分析过程 |
CN101526801A (zh) * | 2009-04-17 | 2009-09-09 | 天津理工大学 | 履带式移动机械手的广义系统统一动力学建模方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4743944B2 (ja) * | 2000-08-25 | 2011-08-10 | 鎮男 角田 | シミュレーションモデル作成方法及びそのシステムと記憶媒体 |
ATE389200T1 (de) * | 2004-06-07 | 2008-03-15 | Abb Research Ltd | Vefahren zur generierung von optimalen steuerungsproblemen für industrielle prozesse |
-
2011
- 2011-11-21 CN CN201110371461.6A patent/CN102508436B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101517498A (zh) * | 2006-09-22 | 2009-08-26 | 埃克森美孚研究工程公司 | 模型预测控制器解分析过程 |
CN101105821A (zh) * | 2007-08-23 | 2008-01-16 | 上海交通大学 | 虚拟装配操作过程的装配工艺生成方法 |
CN101526801A (zh) * | 2009-04-17 | 2009-09-09 | 天津理工大学 | 履带式移动机械手的广义系统统一动力学建模方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102508436A (zh) | 2012-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102508436B (zh) | 机械手摩擦力动力学精确分析与控制应用方法 | |
CN105945979B (zh) | 对欠驱动二指爪机构进行柔顺控制的方法 | |
She et al. | On the impact force of human-robot interaction: Joint compliance vs. link compliance | |
CN103728988B (zh) | 基于内模的scara机器人轨迹跟踪控制方法 | |
CN102495550A (zh) | 并联机器人的正、逆动力学响应分析与控制方法 | |
CN109940613B (zh) | 一种计算含压电材料机械臂动力学响应及控制的仿真方法 | |
CN104809276B (zh) | 一种多手指机器人动力学解析模型及其建模方法 | |
CN104281730A (zh) | 一种大转动变形的板壳结构动响应的有限元分析方法 | |
Halm et al. | A quasi-static model and simulation approach for pushing, grasping, and jamming | |
CN106154829A (zh) | 一种基于离散时延估计的机械手轨迹跟踪控制方法 | |
Giergiel et al. | Description of motion of a mobile robot by Maggie's equations | |
Hwang | Recursive Newton–Euler formulation for flexible dynamic manufacturing analysis of open-loop robotic systems | |
Ding et al. | Terminal force soft sensing of hydraulic manipulator based on the parameter identification | |
Jung et al. | A dynamic explicit/rigid‐plastic finite element formulationand its application to sheet metal forming processes | |
Jung et al. | Step-wise combined implicit–explicit finite-element simulation of autobody stamping processes | |
CN103678897B (zh) | 一种基于凯恩方程的飞轮隔振平台专用动力学建模方法 | |
Seifried et al. | Trajectory control of serial and parallel flexible manipulators using model inversion | |
CN106773782A (zh) | 一种气动伺服弹性混合建模方法 | |
Jia et al. | Observing pose and motion through contact | |
Korayem et al. | Sensitivity analysis of flexible joint nonholonomic wheeled mobile manipulator in singular configuration | |
Ueki et al. | Object manipulation based on robust and adaptive control by hemispherical soft fingertips | |
Pang et al. | A robust time-stepping scheme for quasistatic rigid multibody systems | |
Li et al. | Sensitivity analysis approach to multibody systems described by natural coordinates | |
Borras et al. | Framework comparison between a multifingered hand and a parallel manipulator | |
Zhang et al. | A finite element method for solving 2D contact problems with Coulomb friction and bilateral constraints |
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 |