CN111993417B - 一种基于rbf神经网络的机械臂自适应阻抗控制方法 - Google Patents
一种基于rbf神经网络的机械臂自适应阻抗控制方法 Download PDFInfo
- Publication number
- CN111993417B CN111993417B CN202010771033.1A CN202010771033A CN111993417B CN 111993417 B CN111993417 B CN 111993417B CN 202010771033 A CN202010771033 A CN 202010771033A CN 111993417 B CN111993417 B CN 111993417B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- matrix
- connecting rod
- controller
- axis
- 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 35
- 238000013528 artificial neural network Methods 0.000 title claims abstract description 32
- 239000011159 matrix material Substances 0.000 claims abstract description 82
- 230000008859 change Effects 0.000 claims abstract description 17
- 230000000694 effects Effects 0.000 claims abstract description 11
- 230000003044 adaptive effect Effects 0.000 claims description 23
- 230000009466 transformation Effects 0.000 claims description 21
- 230000001133 acceleration Effects 0.000 claims description 16
- 239000013598 vector Substances 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 5
- 230000003247 decreasing effect Effects 0.000 claims description 3
- 238000000844 transformation Methods 0.000 claims description 3
- 238000013519 translation Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 description 4
- 238000009795 derivation Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000002775 capsule Substances 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于RBF神经网络的机械臂自适应阻抗控制方法,包括:建立机械臂的D‑H参数,并推导机械臂的正运动学;利用kane方法建立机械臂系统的名义动力学模型;结合二阶阻抗方程设计阻抗控制器;设计动力学模型误差补偿控制器;将阻抗控制器与动力学模型误差补偿控制器结合,并根据李雅普诺夫函数设计RBF神经网络权值矩阵的变化率,构成自适应阻抗控制器,并证明自适应阻抗控制器的稳定性;根据所设计的控制器,判断机械臂柔顺控制的效果。本方法能在线补偿机械臂动力学误差的阻抗控制的方法,对机械臂模动力学的不确定部分进行在线补偿,使补偿后的阻抗控制器能够实现对机械臂的精准柔顺控制。
Description
技术领域
本发明属于机械臂柔顺控制领域,涉及一种基于径向基函数(RBF)神经网络的机械臂自适应阻抗控制方法。
背景技术
随着航天技术的发展,航天领域的研究焦点开始向航天器的在轨应用转移。但航天器在轨运行时可能会出现航天器失控、零件失效、燃料用尽等问题,导致航天器无法正常工作甚至被迫退役。由于太空环境的复杂性以及科学技术的限制,许多空间任务尚不能通过航天员出舱进行,因此空间机械臂成为了执行空间任务中不可或缺的部分。空间机械臂主要应用于在轨维护、目标捕获、飞行器组装与回收等操作,在执行任务时会与环境发生接触,空间机械臂末端与目标会存在较大的接触力。为了确保目标或机械臂本身不被损坏以及任务的顺利执行,这就需要在空间机械臂上安装力传感器实现力感知,再设计相应的控制算法将接触力控制在一个合理的范围之内。机械臂对接触力具有响应的能力,则称机械臂具有柔顺性能,相应的控制方法称为柔顺控制方法。在柔顺控制算法中,阻抗控制凭借将力与位置纳入统一控制体系等优点,成为空间机械臂柔顺控制应用领域的一大热点。在机械臂阻抗控制的研究和应用中,通常使用计算力矩控制方法,即结合机械臂逆动力学与阻抗方程设计阻抗控制器。通常机械臂执行任务的目标刚度较大,较小的控制力拒误差就会导致较大的接触力。控制力拒的精准度由逆动力学模型的精准度决定。
因此,要实现精准的柔顺控制,让机械臂具有良好的柔顺性能,需要对机械臂进行精准的动力学建模。机械臂系统具有高度的不确定性和非线性,包括模型的不确定性和参数的不确定性以及外部干扰,这些不确定性所造成的影响会直接反映为动力学模型的不确定性,从而影响机械臂的柔顺性能。机械臂系统的名义动力学模型通常可由机械臂参数求出,但实际动力学模型与名义动力学模型的误差无法通过计算求出。
因此,期望设计一种能在线补偿机械臂动力学误差的自适应阻抗控制方法。
发明内容
针对机械臂模型存在的不确定性问题,本发明提出的一种基于RBF神经网络的机械臂自适应阻抗控制方法,本方法能在线补偿机械臂动力学误差的阻抗控制的方法,对机械臂动力学模型的不确定部分进行在线补偿,使补偿后的阻抗控制器能够实现对机械臂的精准柔顺控制。
本发明提供了一种基于RBF神经网络的机械臂自适应阻抗控制方法,包括如下步骤:
S1:建立机械臂的D-H参数,并推导机械臂的正运动学;
S2:利用kane方法建立机械臂系统的名义动力学模型;
S3:根据步骤S2中建立的机械臂系统的名义动力学模型,结合二阶阻抗方程设计阻抗控制器;
S4:设定RBF神经网络的初始参数,设计动力学模型误差补偿控制器;
S5:将步骤S3中设计的阻抗控制器与步骤S4中建立的动力学模型误差补偿控制器结合,并根据李雅普诺夫函数设计RBF神经网络权值矩阵的变化率,构成自适应阻抗控制器,并证明所构成的自适应阻抗控制器的稳定性;
S6:根据步骤S5中所设计的自适应阻抗控制器,判断机械臂柔顺控制的效果,在相同的控制器参数的条件下设置期望接触力为0,以接触力大小为指标,机械臂接触力越小则柔顺控制效果越好。
进一步,步骤S1具体过程为:
假定机械臂的自由度为n,即把机械臂看作由n个连杆,n-1个关节连接组成,关节1为第1根连杆和第2根连杆的连接关节,首先根据如下步骤建立机械臂的D-H坐标系:
1)建立基座坐标系:以基座上感兴趣的位置为原点、关节1的运动轴正方向为z0轴,按右手定则建立右手正交坐标系(x0,y0,z0),其中,x0轴和y0轴与z0轴垂直,方向任选;
2)建立连杆i坐标系的zi轴:以连杆i与连杆i-1连接关节的运动轴正向为zi轴;
3)建立连杆i坐标系的原点Oi:若zi轴和连杆i-1坐标系的zi-1轴相交,则以两轴交点为原点Oi;若zi轴和zi-1轴异面或平行,则以两轴的公垂线与 zi轴的交点为原点Oi;
4)建立连杆i坐标系的xi轴:按xi=±(zi-1×zi)/||zi-1×zi||建立xi轴,即,使xi轴与zi-1轴及zi轴同时垂直;若zi-1轴与zi轴平行,则以它们的公垂线为 xi轴;
5)建立连杆i坐标系的yi轴:根据已建立的xi轴和zi轴,按右手定则建立yi轴,即令yi=(zi×xi)/||zi×xi||;
6)建立机械臂末端坐标系(xn,yn,zn):zn轴与连杆n-1坐标系的zn-1轴平行,但指向机器人本体外方向;xn轴与zn-1轴及zn轴同时垂直;yn轴由右手定则确定,由此完成机械臂的D-H坐标系的建立;
根据建立的连杆坐标系,计算从一个关节到下一个相邻关节的变换矩阵,变换通过旋转-平移-旋转-平移四个子变换得到:绕连杆i-1的xi-1轴转角度量αi-1;沿xi-1轴移动量ai-1;绕连杆i的zi轴转动角度量θi;沿zi轴移动量di;
第i-1根连杆相对于第i根连杆的位姿变换矩阵Ai定义如下:
i-1Ti=Ai=Rot(x,αi-1)Trans(x,ai-1)Rot(z,θi)Trans(z,di) (1)
其中,i-1Ti用来描述连杆末端在基座的位姿态,表示第i-1根连杆的连杆坐标系相对于第i根连杆的连杆坐标系的变换;Rot表示旋转;Trans表示移动,
计算得到第i-1根连杆相对于第i根连杆的位姿变化矩阵Ai的通式为:
其中,C表示余弦三角函数;S表示正弦三角函数,
将各连杆相对于其前一根连杆的位姿变换矩阵相乘,得到机械臂总变换矩阵0Tn,即得到机械臂的正运动学:
0Tn=0T1 1T2…n-1Tn=A1A2…An (3)。
进一步,步骤S2中利用kane方法建立机械臂系统的名义动力学模型,得到机械臂与环境接触时的名义动力学方程:
其中,τ为机械臂收到的驱动关节的控制力矩;Mc(q)为机械臂的惯性矩阵,并且为正定对称矩阵;为离心力和哥氏力矢量;gc(q)为重力矢量;q为关节旋转角矩阵;为关节旋转角速度矩阵;为关节旋转角加速度矩阵;JT(q)为雅克比矩阵的转置矩阵;Fe为机械臂末端与环境的接触力。
进一步,步骤S3具体过程如下:
二阶阻抗方程式为
利用逆动力学求得机械臂的操作律为:
其中,τc为阻抗控制器输出的机械臂控制力矩,
进一步,步骤S4中,RBF神经网络的初始参数包括输入层节点数、输出层节点数、隐含层节点数、隐含层节点中心向量和高斯函数宽度。
进一步,步骤S4具体过程如下:
动力学模型误差为计算得到的模型与真实的模型之差,则真实的机械臂动力学模型为:
将干扰项与动力学误差项合并得到:
动力学模型误差补偿控制器输出的补偿力矩为Δτ:
进一步,步骤S5具体过程如下:
将步骤S3中设计的阻抗控制器与步骤S4中建立的动力学模型误差补偿控制器结合构成机械臂自适应阻抗控制器,该自适应阻抗控制器输出的控制力矩τout为:
τout=τc+Δτ (10)
将自适应阻抗控制器输出的控制力矩代入真实的机械臂动力学模型即可得到机械臂系统状态方程,
根据李雅普诺夫函数设计RBF神经网络权值矩阵的变化率,并证明控制器的稳定性,构造如下李雅普诺夫函数V:
其中,γ>0;矩阵P是对称正定矩阵,且满足李雅普诺夫方程:
PA+ATP=-Q (13)
其中,Q>0;
对李雅普诺夫函数V求导得到:
设计自适应律为:
则
假设逼近误差是有限的,
其中,η0为逼近误差上界;sup为上确界,即最小上界;
根据逼近误差上界得到:
其中,λmin(Q)为矩阵Q的最小特征值;λmax(P)为矩阵P的最大特征值。为保证控制系统问题,由李雅普诺夫第二法则需要李雅普诺夫的导数小于0,即满足以下条件:
由式(19)得到结论:增大Q的特征值和减小P的特征值可以提高收敛效果。
本发明的有益效果:
1)本发明将动力学模型的不确定部分与名义动力学部分分开考虑,机械臂的控制力矩分别由两个控制器提供,保证了控制器的有效性;
2)本发明使用RBF神经网络在线逼近动力学模型的不确定部分,使机械臂获得更好的柔顺控制效果;
3)本发明简单易于实施,是一种具有高鲁棒性的柔顺控制方法。
附图说明
图1为本发明提供的基于RBF神经网络的机械臂自适应阻抗控制方法流程图;
图2为本发明的D-H坐标系的建立机械臂的构型参数;
图3为本发明的自适应阻抗控制器原理示意图;
图4为本发明的2自由度机械臂结构及碰撞墙面示意图;
图5为本发明的机械臂末端位置图;
图6为本发明的机械臂末端接触力图。
具体实施方式
下面结合附图对本发明作进一步详细说明。
如图1所示,本发明的基于RBF神经网络的机械臂自适应阻抗的控制方法,包括如下步骤:
S1:建立机械臂的D-H参数并推导机械臂的正运动学。将机械臂看作多根连杆连接,连杆与连杆之间的连接点叫做关节,在每一根连杆上建立一个坐标系多次使用齐次坐标变换即可得到机械臂末端坐标系和基座坐标系之间的关系,获得机械臂的正运动学。
D-H坐标系是描述机械臂运动的惯用坐标系,其示意图如图2所示,结合图2按照以下步骤建立D-H坐标系,其中假定机械臂的自由度为n,即机械臂由n个连杆,n-1个关节连接组成,建立D-H坐标系具体过程如下:
1)建立基座坐标系:以基座上感兴趣的位置为原点、关节1(即第1根连杆和第2根连杆的连接关节)的运动轴正方向为z0轴,按右手定则建立右手正交坐标系(x0,y0,z0),其中,x0轴和y0轴与z0轴垂直,方向任选;
对每个连杆i(i=1、…,n),完成步骤2)至步骤5):
2)建立连杆i坐标系的z轴(即zi轴):以连杆i与连杆i-1连接关节的运动(转动或移动)轴正向为zi轴;
3)建立连杆i坐标系的原点Oi:若zi轴和zi-1轴相交,则以两轴交点为原点Oi;若zi轴和zi-1轴异面或平行,则以两轴的公垂线与zi轴的交点为原点Oi;
4)建立连杆i坐标系的xi轴:按xi=±(zi-1×zi)/||zi-1×zi||建立xi轴,即,使xi轴与zi-1轴及zi轴同时垂直;若zi-1轴与zi轴平行,则以它们的公垂线为 xi轴;
5)建立连杆i坐标系的yi轴:根据已建立的xi轴和zi轴,按右手定则建立yi轴,即令yi=(zi×xi)/||zi×xi||;
6)建立机械臂末端坐标系(xn,yn,zn):zn轴与zn-1轴平行,但指向机器人本体外方向;xn轴与zn-1轴及zn轴同时垂直;yn轴由右手定则确定。
通过各关节位置和连杆几何参数求解机械臂末端相对于基座的位置与姿态,即为机械臂正运动学。其基本思路为:根据建立的连杆体坐标系,计算从一个关节到下一个相邻关节的变换矩阵,最后将所有变换矩阵相乘即得到机械臂总体变换矩阵。
用i-1Ti来描述连杆末端在基座的位姿态,i-1Ti表示第i-1根连杆的连杆坐标系相对于第i根连杆的连杆坐标系的变换。其变换通过“旋转-平移-旋转 -平移”四个子变换得到:绕xi-1轴转αi-1角;沿xi-1轴移动ai-1;绕zi轴转θi角;沿zi轴移动di。连杆变换矩阵定义如下:
i-1Ti=Ai=Rot(x,αi-1)Trans(x,ai-1)Rot(z,θi)Trans(z,di) (1)
其中,Ai表示第i-1根连杆相对于第i根连杆的位姿变化矩阵;Rot表示旋转;Trans表示移动。
计算得到第i-1根连杆相对于第i根连杆的位姿变化矩阵的通式为:
其中,C表示余弦三角函数;S表示正弦三角函数。
将各连杆相对于其前一根连杆的位姿变换矩阵相乘,得到机械臂总变换矩阵0Tn,即得到机械臂的正运动学:
0Tn=0T1 1T2…n-1Tn=A1A2…An (3)。
S2:利用kane方法建立机械臂系统的名义动力学模型。kane方法是利用广义速率代替广义坐标作为独立变量来描述系统的运动,并将广义主动力和广义惯性力直接向特定的基矢量方向投影,以消除理想约束力。该方法中不出现相邻体之间的内力项,使推导过程更加系统化,适用于计算机编程。本发明为了计算的快速性和编程的简便性,基于kane方程,建立多体系统的动力学模型。且将Kane方程中偏速度和偏角速度的概念推广为偏速度矩阵和偏角速度矩阵,把各体的广义惯性力统一为相同的、简洁的数学形式,使系统动力学方程易于通过计算机符号或者数值的建立,避免了建模中繁琐的公式推导。本发明利用Kane方法建立机械臂系统的名义动力学模型,是将机械臂相邻连杆通过单自由度的转动连接,建立了该多体系统的动力学模型,该模型不包含机械臂动力学模型的不确定项,故称为机械臂系统的名义动力学模型,最后可以得到机械臂与环境接触时的名义动力学方程:
其中,τ为机械臂收到的驱动关节的控制力矩;Mc(q)为机械臂的惯性矩阵,并且为正定对称矩阵;为离心力和哥氏力矢量;gc(q)为重力矢量;q为关节旋转角矩阵;为关节旋转角速度矩阵;为关节旋转角加速度矩阵;JT(q)为雅克比矩阵的转置矩阵;Fe为机械臂末端与环境的接触力。
S3:根据步骤S2中建立的机械臂系统的名义动力学模型,结合二阶阻抗方程设计阻抗控制器。
二阶阻抗方程式为
利用逆动力学求得机械臂的操作律为
将机械臂与环境接触时的名义运动学方程左右两边同时求二阶导求得关节角加速度
将关节角加速度代入逆动力学得到阻抗控制律:
其中,τc为控制器输出的机械臂控制力矩。本发明利用逆动力学设计阻抗控制器,其稳定性非常容易证明。
S4:设定RBF神经网络的初始参数,包括输入层节点数、输出层节点数、隐含层节点数、隐含层节点中心向量和高斯函数宽度,设计动力学模型误差补偿控制器。RBF神经网络对非线性函数具有较强的逼近能力,所以可以基于RBF神经网络设计一个补偿控制器,对机械臂的动力学模型误差进行补偿。再设计李雅普诺夫函数,确定RBF神经网络权值矩阵的变化率。
动力学模型误差为计算得到的模型与真实的模型之差,则真实的机械臂动力学模型为:
将干扰项与动力学误差项合并可以得到:
RBF神经网络便是在机械臂工作时在线对该误差函数进行逼近,并通过动力学模型误差补偿控制器对控制力矩进行补偿。动力学模型误差补偿控制器输出的补偿力矩为
S5:将阻抗控制器与动力学模型误差补偿控制器结合构成机械臂自适应阻抗控制器,证明自适应阻抗控制器的稳定性,自适应阻抗控制器原理示意图如图3所示。其中将阻抗控制器与动力学模型误差补偿控制器结合,是指自适应阻抗控制器输出的控制力矩由两部分相加组成,一是由名义模型决定的阻抗控制器输出的控制力矩,二是由RBF神经网络逼近动力学不确定项后误差补偿控制器输出的补偿控制力矩。
自适应阻抗控制器输出的控制力矩为
τout=τc+Δτ (10)
将自适应阻抗控制器输出的控制力矩代入真实的机械臂动力学模型即可得到机械臂系统状态方程,
根据李雅普诺夫函数设计RBF神经网络权值矩阵的变化率,并证明控制器的稳定性。构造如下李雅普诺夫函数V:
其中,γ>0;矩阵P是对称正定矩阵,且满足李雅普诺夫方程:
PA+ATP=-Q (13)
其中,Q>0。对李雅普诺夫函数V求导可以得到:
设计自适应律为:
则
假设逼近误差是有限的,
其中,η0为逼近误差上界;sup为上确界,即最小上界。
根据逼近误差上界可得
其中,λmin(Q)为矩阵Q的最小特征值;λmax(P)为矩阵P的最大特征值。为保证控制系统问题,由李雅普诺夫第二法则需要李雅普诺夫的导数小于0,即满足以下条件:
由该条件可以得到结论:增大Q的特征值和减小P的特征值可以提高收敛效果。
S6:根据步骤S5所设计的控制器,判断机械臂柔顺控制的效果。设置自适应阻抗控制器的期望接触力为0,则机械臂末端接触力的大小即可反应机械臂的柔顺性能。接触力的值越小,则柔顺性能越好。
实施例
本实施例通过对一个动力学模型存在误差的2自由度机械臂进行柔顺控制,来验证本发明方法的有效性。
(1)2自由度机械臂结构及碰撞墙面示意图如图4所示,墙面(xe表示墙面的位置)距离坐标远点0.18m其正运动学方程为
其中,x为机械臂末端x方向的位移;y为机械臂末端y方向的位移;l1为2自由度机械臂第一根连杆长度;l1为第二根连杆长度;θ1为关节1旋转的角度,θ2为关节2旋转的角度。
将正运动学方程(20)两边求导可获得雅克比矩阵J(q):
(2)利用Kane(凯恩)方法求得2自由度机械臂动力学方程为
其中,τ1为关节1的驱动力矩,τ2为关节2的驱动力矩,m1为第一根连杆的质量,m2为第二根连杆的质量,g为重力加速度。
将式(22)写为机械臂名义动力学方程的形式:
(3)如本发明步骤S3-步骤S5设计自适应阻抗控制器,并与不含补偿控制器的阻抗控制器进行对比。
自适应阻抗控制器设置参数为 动力学误差项为名义项的0.2,RBF神经网络初始阈值和权值随机赋值。机械臂末端位移如图5所示,机械臂末端接触力如图6所示。通过相应曲线可以看出,在机械臂模型存在误差的情况下,基于 RBF神经网络自适应阻抗控制器的柔顺控制效果要好于传统阻抗控制器,且该控制器可以在控制的同时在线逼近模型误差部分。
综上,本发明针对模型存在不确定性的机械臂给出了一种基于RBF神经网络的自适应阻抗控制,通过本发明控制的机械臂能够表现良好的柔顺性能,故该方法具有良好的推广前景。
对于本领域的普通技术人员来说,在不脱离本发明创造构思的前提下,还可以对本发明的实施例做出若干变型和改进,这些都属于本发明的保护范围。
Claims (5)
1.一种基于RBF神经网络的机械臂自适应阻抗控制方法,其特征在于,包括如下步骤:
S1:建立机械臂的D-H参数,并推导机械臂的正运动学;
S2:利用kane方法建立机械臂系统的名义动力学模型,得到机械臂与环境接触时的名义动力学方程:
其中,τ为机械臂收到的驱动关节的控制力矩;Mc(q)为机械臂的惯性矩阵,并且为正定对称矩阵;为离心力和哥氏力矢量;gc(q)为重力矢量;q为关节旋转角矩阵;为关节旋转角速度矩阵;为关节旋转角加速度矩阵;JT(q)为雅克比矩阵的转置矩阵;Fe为机械臂末端与环境的接触力;
S3:根据步骤S2中建立的机械臂系统的名义动力学模型,结合二阶阻抗方程设计阻抗控制器;
二阶阻抗方程式为
利用逆动力学求得机械臂的操作律为:
其中,τc为控制器输出的机械臂控制力矩,
S4:设定RBF神经网络的初始参数,设计动力学模型误差补偿控制器;
S5:将步骤S3中设计的阻抗控制器与步骤S4中建立的动力学模型误差补偿控制器结合,并根据李雅普诺夫函数设计RBF神经网络权值矩阵的变化率,构成自适应阻抗控制器,并证明所构成的自适应阻抗控制器的稳定性;
S6:根据步骤S5中所设计的自适应阻抗控制器,判断机械臂柔顺控制的效果,在相同的控制器参数的条件下设置期望接触力为0,以接触力大小为指标,机械臂接触力越小则柔顺控制效果越好。
2.根据权利要求1所述的方法,其特征在于,步骤S1具体过程为:
假定机械臂的自由度为n,即把机械臂看作由n个连杆,n-1个关节连接组成,关节1为第1根连杆和第2根连杆的连接关节,首先根据如下步骤建立机械臂的D-H坐标系:
1)建立基座坐标系:以基座上感兴趣的位置为原点、关节1的运动轴正方向为z0轴,按右手定则建立右手正交坐标系(x0,y0,z0),其中,x0轴和y0轴与z0轴垂直,方向任选;
2)建立连杆i坐标系的zi轴:以连杆i与连杆i-1连接关节的运动轴正向为zi轴;
3)建立连杆i坐标系的原点Oi:若zi轴和连杆i-1坐标系的zi-1轴相交,则以两轴交点为原点Oi;若zi轴和zi-1轴异面或平行,则以两轴的公垂线与zi轴的交点为原点Oi;
4)建立连杆i坐标系的xi轴:按xi=±(zi-1×zi)/||zi-1×zi||建立xi轴,即,使xi轴与zi-1轴及zi轴同时垂直;若zi-1轴与zi轴平行,则以它们的公垂线为xi轴;
5)建立连杆i坐标系的yi轴:根据已建立的xi轴和zi轴,按右手定则建立yi轴,即令yi=(zi×xi)/||zi×xi||;
6)建立机械臂末端坐标系(xn,yn,zn):zn轴与连杆n-1坐标系的zn-1轴平行,但指向机器人本体外方向;xn轴与zn-1轴及zn轴同时垂直;yn轴由右手定则确定,由此完成机械臂的D-H坐标系的建立;
根据建立的连杆坐标系,计算从一个关节到下一个相邻关节的变换矩阵,变换通过旋转-平移-旋转-平移四个子变换得到:绕连杆i-1的xi-1轴转角度量αi-1;沿xi-1轴移动量ai-1;绕连杆i的zi轴转动角度量θi;沿zi轴移动量di;
第i-1根连杆相对于第i根连杆的位姿变换矩阵Ai定义如下:
i-1Ti=Ai=Rot(x,αi-1)Trans(x,ai-1)Rot(z,θi)Trans(z,di) (1)
其中,i-1Ti用来描述连杆末端在基座的位姿态,表示第i-1根连杆的连杆坐标系相对于第i根连杆的连杆坐标系的变换;Rot表示旋转;Trans表示移动,
计算得到第i-1根连杆相对于第i根连杆的位姿变化矩阵Ai的通式为:
其中,C表示余弦三角函数;S表示正弦三角函数,
将各连杆相对于其前一根连杆的位姿变换矩阵相乘,得到机械臂总变换矩阵0Tn,即得到机械臂的正运动学:
0Tn=0T1 1T2… n-1Tn=A1A2… An (3)。
3.根据权利要求1所述的方法,其特征在于,步骤S4中,RBF神经网络的初始参数包括输入层节点数、输出层节点数、隐含层节点数、隐含层节点中心向量和高斯函数宽度。
5.根据权利要求4所述的方法,其特征在于,步骤S5具体过程如下:
将步骤S3中设计的阻抗控制器与步骤S4中建立的动力学模型误差补偿控制器结合构成机械臂自适应阻抗控制器,该自适应阻抗控制器输出的控制力矩τout为:
τout=τc+Δτ (10)
将自适应阻抗控制器输出的控制力矩代入真实的机械臂动力学模型即得到机械臂系统状态方程,
根据李雅普诺夫函数设计RBF神经网络权值矩阵的变化率,并证明控制器的稳定性,构造如下李雅普诺夫函数V:
其中,γ>0;矩阵P是对称正定矩阵,且满足李雅普诺夫方程:
PA+ATP=-Q (13)
其中,Q>0;
对李雅普诺夫函数V求导得到:
设计自适应律为:
则
假设逼近误差是有限的,
其中,η0为逼近误差上界;sup为上确界,即最小上界;
根据逼近误差上界得到:
其中,λmin(Q)为矩阵Q的最小特征值;λmax(P)为矩阵P的最大特征值;为保证控制系统问题,由李雅普诺夫第二法则需要李雅普诺夫的导数小于0,即满足以下条件:
由式(19)得到结论:增大Q的特征值和减小P的特征值可以提高收敛效果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010771033.1A CN111993417B (zh) | 2020-08-04 | 2020-08-04 | 一种基于rbf神经网络的机械臂自适应阻抗控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010771033.1A CN111993417B (zh) | 2020-08-04 | 2020-08-04 | 一种基于rbf神经网络的机械臂自适应阻抗控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111993417A CN111993417A (zh) | 2020-11-27 |
CN111993417B true CN111993417B (zh) | 2021-07-20 |
Family
ID=73463110
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010771033.1A Active CN111993417B (zh) | 2020-08-04 | 2020-08-04 | 一种基于rbf神经网络的机械臂自适应阻抗控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111993417B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113276114B (zh) * | 2021-05-20 | 2022-09-16 | 北京师范大学 | 一种基于终端任务指派的可重构机械臂协同力/运动控制系统与方法 |
CN113297798B (zh) * | 2021-06-10 | 2022-10-11 | 重庆邮电大学工业互联网研究院 | 一种基于人工神经网络的机器人外界接触力估计方法 |
CN113467501B (zh) * | 2021-07-20 | 2023-03-28 | 福州大学 | 作业飞行机器人动态滑翔抓取与力位混合控制方法 |
CN114102600B (zh) * | 2021-12-02 | 2023-08-04 | 西安交通大学 | 一种多空间融合的人机技能迁移与参数补偿方法及系统 |
CN114800489B (zh) * | 2022-03-22 | 2023-06-20 | 华南理工大学 | 基于确定学习与复合学习联合的机械臂柔顺控制方法、存储介质及机器人 |
CN114779643A (zh) * | 2022-04-29 | 2022-07-22 | 哈尔滨理工大学 | 一种基于旋量模型的机械臂终端滑模控制系统 |
CN114932561B (zh) * | 2022-07-26 | 2022-10-14 | 珞石(北京)科技有限公司 | 一种机器人单关节位置控制方法 |
CN116127838B (zh) * | 2022-12-30 | 2024-01-12 | 中国科学院长春光学精密机械与物理研究所 | 基于负载不确定性的光学精密设备主动隔振方法 |
CN115755592B (zh) * | 2023-01-10 | 2023-05-12 | 常熟理工学院 | 调整三自由度外骨骼运动状态的多模态控制方法及外骨骼 |
CN117817674A (zh) * | 2024-03-05 | 2024-04-05 | 纳博特控制技术(苏州)有限公司 | 一种机器人自适应阻抗控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106249616A (zh) * | 2016-07-22 | 2016-12-21 | 上海航天控制技术研究所 | 一种在轨服务机械臂动力学建模方法和系统 |
WO2019073407A1 (en) * | 2017-10-12 | 2019-04-18 | Scuola Superiore Di Studi Universitari E Di Perfezionamento Sant'anna | ADAPTIVE CONTROL OF A PORTABLE ROBOT SUCH AS AN ORTHESIS OR PROSTHESIS |
CN110434851A (zh) * | 2019-06-24 | 2019-11-12 | 浙江工业大学 | 一种5自由度机械臂逆运动学求解方法 |
CN110967972A (zh) * | 2019-12-13 | 2020-04-07 | 中国科学院自动化研究所 | 基于径向基函数神经网络的康复机器人自适应控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109465825B (zh) * | 2018-11-09 | 2021-12-10 | 广东工业大学 | 机械臂柔性关节的rbf神经网络自适应动态面控制方法 |
-
2020
- 2020-08-04 CN CN202010771033.1A patent/CN111993417B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106249616A (zh) * | 2016-07-22 | 2016-12-21 | 上海航天控制技术研究所 | 一种在轨服务机械臂动力学建模方法和系统 |
WO2019073407A1 (en) * | 2017-10-12 | 2019-04-18 | Scuola Superiore Di Studi Universitari E Di Perfezionamento Sant'anna | ADAPTIVE CONTROL OF A PORTABLE ROBOT SUCH AS AN ORTHESIS OR PROSTHESIS |
CN110434851A (zh) * | 2019-06-24 | 2019-11-12 | 浙江工业大学 | 一种5自由度机械臂逆运动学求解方法 |
CN110967972A (zh) * | 2019-12-13 | 2020-04-07 | 中国科学院自动化研究所 | 基于径向基函数神经网络的康复机器人自适应控制方法 |
Non-Patent Citations (3)
Title |
---|
Adaptive neural network force tracking impedance control for uncertain robotic manipulator based on nonlinear velocity observer;Zeqi Yang .et;《NEUROCOMPUTING》;20190228;全文 * |
下肢康复机器人运动控制策略的研究;吕显耀;《中国优秀硕士学位论文全文数据库 信息科技辑》;20180215;摘要、第24-59、67-69页 * |
吕显耀.下肢康复机器人运动控制策略的研究.《中国优秀硕士学位论文全文数据库 信息科技辑》.2018,摘要、第24-59、67-69页. * |
Also Published As
Publication number | Publication date |
---|---|
CN111993417A (zh) | 2020-11-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111993417B (zh) | 一种基于rbf神经网络的机械臂自适应阻抗控制方法 | |
Joshi et al. | Robust attitude stabilization of spacecraft using nonlinear quaternion feedback | |
CN107263466B (zh) | 空间机器人基于二次规划问题的基座无扰控制方法 | |
CN109782601A (zh) | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 | |
CN112091976B (zh) | 一种水下机械臂任务空间控制方法 | |
CN109426147B (zh) | 捕获卫星后组合航天器的自适应增益调整控制方法 | |
CN111506095B (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN112809666B (zh) | 一种基于神经网络的5-dof机械臂力位跟踪算法 | |
CN108445768B (zh) | 空间机器人操作空间轨迹跟踪的增广自适应模糊控制方法 | |
Cao et al. | ESO-based robust and high-precision tracking control for aerial manipulation | |
CN114942593B (zh) | 一种基于干扰观测器补偿的机械臂自适应滑模控制方法 | |
CN105912007A (zh) | 空间机械臂抗干扰姿态稳定的微分几何非线性控制方法 | |
Zhao et al. | Minimum base disturbance control of free-floating space robot during visual servoing pre-capturing process | |
Liu et al. | Design and motion planning of a 7-DOF assembly robot with heavy load in spacecraft module | |
Miyano et al. | Distributed force/position optimization dynamics for cooperative unknown payload manipulation | |
CN112001087A (zh) | 一种旋转关节型工业机器人非线性动力学建模分析方法 | |
CN110480641B (zh) | 一种机械臂的递推分布式快速收敛鲁棒控制方法 | |
CN115122327A (zh) | 基于对偶神经网络的危化品运输机械臂末端精确定位方法 | |
Li et al. | Adaptive neural network backstepping control method for aerial manipulator based on variable inertia parameter modeling | |
CN116141302A (zh) | 七自由度机械臂运动的控制方法、装置及电子设备 | |
Yao et al. | Hybrid position, posture, force and moment control with impedance characteristics for robot manipulators | |
Wang et al. | Rotorcraft aerial manipulator control based on improved adrc | |
Xu et al. | Vibration suppressive control of flexible-joint space manipulators based on Legendre pseudospectral method | |
CN117697767B (zh) | 空间站弹性关节空间机械臂控制方法及装置 | |
Li et al. | Robot Manipulator Trajectory Tracking with Uncertainties Based on Adaptive Sliding Control |
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 |