admin 管理员组文章数量: 1086019
2024年4月16日发(作者:免费建站优缺点)
2 0 1 8年2月
doi:10.6041/j.issn.1000—1298.2018.02.051
农业机械学报 第49卷第2期
机械臂神经网络非奇异快速终端滑模控制
吴爱国 刘海亭 董 娜
(天津大学电气自动化与信息工程学院,天津300072)
摘要:针对多自由度机械臂轨迹跟踪控制系统存在收敛速度慢、跟踪精度低的问题,提出了一种基于径向基神经网
络(RBFNN)的非奇异快速终端滑模(NFTSM)自适应轨迹跟踪控制方法。首先,该方法采用非奇异快速终端滑模
超曲面,切换控制项引入连续终端吸引子,使得系统能在有限的时间内收敛到平衡点。其次,采用RBFNN逼近系
统未知非线性动力学,并结合逼近误差的自适应补偿机制,实现无模型控制。利用Lyapunov理论证明闭环系统的
全局渐进稳定性和有限时间收敛性。最后,将该控制方法应用于Denso串联机械臂进行实验验证,并分析系统传
输延时对实验结果的影响,提出解决方法。仿真和实验结果表明,该控制方法能有效地提高系统收敛速度和跟踪
精度,增强对外部扰动的鲁棒性,削弱系统抖振。
关键词:机械臂;轨迹跟踪;终端滑模;神经网络;有限时间收敛
中图分类号:TP241;TP273 文献标识码:A 文章编号:1000—1298(2018)02—0395—10
Nonsingular Fast Terminal Sliding Mode Control of Robotic
Manipulators Based on Neural Networks
WU Aiguo LIU Haiting DONG Na
(School of Electrical and Information Engineering,Tianjin University,Tianjin 300072,China)
Abstract:A nonsingular fast terminal sliding mode adaptive controller based on RBF neural network was
proposed for trajectory tracking control of multi degree of ̄eedom manipulator with slow convergence
speed and low tracking precision.Firstly,the nonsingular fast terminal sliding mode hypersurfaee was
adopted in the control scheme and the continuous terminal attractor was introduced into the switch
control,which made the system converge to the equilibrium point in a finite time.Secondly,the adaptive
RBF neural network was used to approximate the unknown nonlinear dynamics of the system,the adaptive
compensation mechanism of approximation error and adaptive law of weights of neural networks were
designed to realize the model free contro1.The global asymptotic stability and finite time convergence of
the closed-loop system were proved by Lyapunov theory.Finally,the control method was applied to
Denso serial manipulator for experimental verification,the effect of transmission delay on the experimental
results was analyzed and the solution was proposed.The simulation and experimental results demonstrated
that the proposed control method can improve the convergence speed and the tracking accuracy of the
system effectively,and enhance the robustness of the external disturbance.At the same time,it can
weaken the chattering of the system and enhance the real—time contro1.
Key words:robotic manipulators;trajectory tracking;terminal sliding mode;neural network;finite time
convergence
0 引言
近些年来,机械臂在自动化领域发挥着重要的
作用。随着现代工业的快速发展,它们已经被广泛
存在许多不确定性和外部扰动,难以建立精确数学
模型,给机械臂的精确控制带来一定的困难,所以研
究机械臂高速度、高精度的轨迹跟踪控制具有重要
意义。
应用于众多领域,其中许多任务需要高速度和高精
度的轨迹跟踪控制。然而机械臂的动力学模型普遍
收稿日期:2017—06—13修回日期:2017—07—20
针对机械臂轨迹跟踪控制问题已经提出了许多
控制方法,比如PID控制¨ 、迭代学习控制 、鲁棒
基金项目:国家自然科学基金项目(61403274)和天津市智能制造科技重大专项(15ZXZNGX00160)
作者简介:吴爱国(1954一),男,教授,博士生导师,主要从事机器人、空调和电机研究,E-mail:wuaiguotju@163.corfl
396 农业机械学报
控制 、自适应控制 、反馈线性化控制 以及模
糊控制 等方法,其中终端滑模控制由于其有限时
控制力矩,容易引起抖振。
针对上述问题,本文提出一种基于径向基神经
网络RBFNN的非奇异快速终端滑模(NFTSM)自适
应轨迹跟踪控制方法。
间收敛特性、对参数摄动和外部扰动的强鲁棒性,已
被广泛应用于机械臂轨迹跟踪控制中。MAN等
首次提出终端滑模面的概念,相比线性滑模面,提高
了系统在接近平衡点时的收敛速度,但该方法存在
奇异性问题。为解决该问题,FENG等 提出非奇
异终端滑模(NTSM)控制方法,并应用于机械臂轨
迹跟踪控制,证明其有效性。李升波等 在此基础
上提出了NFTSM控制方法,相比NTSM,提高了系
1 模型描述
基于拉格朗日方程的Ⅳ关节机械臂的动力学
模型表示为
(q) +C(q, ) +G(g)+ = (1)
式中 q、 、 ——关节角位移矢量、角速度矢量和
统在远离平衡点时的收敛速度,实现全局有限时间
快速收敛。最近,XIAO等 提出了一种基于观测
器的串联机械臂轨迹跟踪控制方法,采用2个滑模
角加速度矢量,q、q、 ∈R
M(口)——对称正定有界惯性矩阵, (q)∈
R “
观测器分别估计不确定运动学和未知动力学,但其
动力学观测器是基于估计误差的,导致该方法在实
c(q,宣)——离心力和哥式力矩阵,c(q, )∈
R
际工程中难以实现。文献[11—12]采用RBFNN在
G(q)——重力项矢量,G(g)∈R
线学习动力学建模误差,结合自适应边界技术估计
学习误差和外部扰动的边界值,提高了控制精度。
但以上这两种方法都需要依赖于机械臂的模型,限
外部扰动信号, ∈R
控制力矩矢量, ∈R
制了其实际应用价值。文献[13—14]研究了一种
基于模型局部逼近的自适应终端滑模控制方法,采
用RBFNN逼近被控对象模型矩阵的各个元素,实
现无模型控制。但随着机械臂自由度的增加,控制
器计算量将会急剧增加,不利于系统的实时控制,并
且控制律存在不连续项,容易引起抖振。GUO
等 提出自由漂浮空间机械臂约束自适应RBF—
假设1:假设期望轨迹q ∈R 是一个二次连续
可微的函数。
控制目标:设计合适的控制器,使关节输出口在
有限的时间内跟踪期望轨迹q。。
定义系统跟踪误差及其导数为
, =垡一鼋d
?【 = 一
= —
(2)
NTSM控制方法,考虑致动器的实际物理约束,采用
RBFNN补偿有限的输入,实现空间机械臂在轨操
作。WANG等 。。提出了基于时延估计的机械臂连
2控制器设计
控制器的设计分为:①确定NFTSM滑模面,根
据Lyapunov理论设计控制律。②设计合适的
RBFNN逼近机械臂未知非线性动力学。控制系统
的结构框图如图1所示。
续分数阶非奇异终端滑模控制方法,相比边界层技
术获得更好的控制性能。但是该方法未考虑对估计
误差的补偿,而是通过鲁棒项加以抑制,这就使得所
设计的控制器具有一定的保守性,需要更大的切换
图1 控制系统结构框图
Fig.1 Block diagram of control system
2.1控制律设计
面,以确保产生理想的滑动模态,然后设计滑模控制
律驱动系统从任意初始状态到达滑模面。定义
(3)
NFTSM滑模面为
= -4- 一 +fl一 (4)
为简化表达式,定义
=
[ ; … :]
设计滑模控制系统,首先需要建立合适的滑模
第2期 吴爱国等:机械臂神经网络非奇异快速终端滑模控制 397
其中 =diag( 1, 2,…,O/ ) (OL >0)
=
diag( ̄ ,卢:,…,卢 ) (卢 >0)
式中 rl、r2、r3、r4——正奇数,1<F1/r2<2,F3/r4>
r1/r2
李升波等 对式(4)进行了定量分析,从理论
上证明其有限时间收敛性,本文在此只进行定性分
析。当跟踪误差靠近平衡点时,即误差I e I≤1时,
忽略P的高次项,式(4)近似为
= +卢 (5)
当系统处于滑模面,即s=0时,式(5)可表示
为
台=一卢 P (6)
由于式(6)中口的指数小于1,则误差导数的绝
对值大于相同参数的线性滑模面,克服后者收敛速
度慢的问题。
同理当跟踪误差远离平衡点时,即误差l e l>1
时,口的高次项起主要作用,此时式(4)近似为
=一
(触 ) 2/rle : ·’ (7)
由于式(7)中e的指数大于1,故收敛速度高于
线性滑模面。
建立了合适的滑模面,下一步是设计控制律驱
动系统到达该滑模面。式(4)对时间求导可得
= + (r3/r4)diag( 。) +
卢 (r /r )diag(匆rl/r2 ) (8)
由式(1)和式(2)可知跟踪误差的二阶导数可
被重新表示为
=q一一q。。 + 一 (q) —c(q, )奇一G(g)一r =
+(J 一M(q)) 一c(g, )垂一G(q)一f 一 =
+.厂 (9)
式中卜机械臂未知非线性函数
将式(9)代人式(8),可得
=
匆+ 一。(r3/r4)diag( )匆+
(F1/r2)diag( )( +-厂) (10)
如果机械臂未知非线性函数-厂精确已知,可设
计控制律为
=一
.
厂+ + … (11)
式中 。——等效控制项 …——切换控制项
设计等效控制为
f =一[, + 一 (r3/r4)diag(P 一。)]·
(r:/r。) (12)
滑模控制系统利用切换控制律保证滑动模态的
发生,传统切换控制采用不连续控制项 …sign( ),
但需要不确定性和外部扰动的上界先验知识。由于
滑模系统只在滑动阶段才对模型不确定性和外部扰
动具有不变性,为加快趋近阶段的速度,增强鲁棒
性,本文提出快速连续终端切换控制律即
…
=一卢(/'2/r1)(A1 +A2 +A3 ,, ) (13)
其中 r5/r6>1 0<F7/r8<1
A1=diag(All,Al2,…,Al )
A2=diag(A 21,A 22,…,A 2 )
A3=diag(A 3】,A 32,…,A 3 )
式中 A A 、A, ——正常数
2.2 RBFNN设计
神经网络具有学习和逼近任意非线性函数的能
力,是控制许多复杂动力学系统的有力工具之一。
相比多层感知器神经网络,RBFNN是一种特殊的网
络结构,具有结构简单、快速学习和更好的逼近能
力,不仅可以减少神经网络的参数调整的数目,还可
以避免局部极小问题,满足实时控制的要求。因此,
为解决控制器依赖机械臂模型的问题,利用RBFNN
逼近未知非线性函数。
定义 ∈R 为逼近机械臂未知非线性函数的
RBFNN的理想输出,厂N ∈R 为实际输出,表示为
l
’., l( 1)
81
f= =
w ( 2)
十
2
+
(14)
●
:
:
●
:
w ( )
n
,., ( 。)
,2
'I,T2 ( 2)
=
●
(15)
:
l n T ( )
其中 ’., =[Wn 2 … ]。。
L O'il O'i2 … J
式中 ——机械臂第i个神经网络的实际输出
W ——第i个神经网络最优权重wi 的估计
——
第i个神经网络的高斯基函数
——
神经网络隐含层的节点数
高斯基函数表达式为
唧
(一 )
(i=1,2,…,n;J.=I,2,…,L) (16)
其中 =[e , q 由d ]
c =[c 1 c 2…ciL]
b =[b l b 2…6 ]
式中 ——第i个神经网络的输入向量
c ——第i个神经网络的中心矩阵
西 ——第i个神经网络的基宽向量
由于神经网络存在逼近误差,传统方法是增大
切换增益加以抑制,但这种方法具有一定的保守性,
398 农业机械学报
容易引起抖振。本文设计一个神经网络逼近误差自
适应补偿项,进一步减小逼近误差对系统的影响。
因此控制量的输入可以被重新表示为
一
+∑ s s =
=一
fNN一
∑ A 一∑ A 2iS “一
[J + (r3/r )diag(e )] (F2/r1)
+A3
· z一
卢(r2/r1)(A1 +A2 )一s (17)
∑ A 3i¥ +∑tr(
∑ s s
s w )+
(22)
为使,N 自适应的逼近 ,并保证神经网络权值有
其中
[ I
界,可设计权值更新律和自适应补偿更新律为
=F 。 s (1 )(r /r:) 一F rl 111 s2 w (18)
音 =F s (1/ )(r /r2) —F rl s2 占 (19)
= 一 =
… ] +
其中 = >0
式中 , 、叩 、厂 、叼。 ——正常数
3稳定性分析
定理1:针对机械臂系统式(1),当选用式(4)
所示的NFTSM滑模面,式(17)的控制律和式(18)、
式(19)的自适应更新律,则神经网络的权重和误差
补偿有界,闭环系统全局渐进稳定。
证明:取Lyapunov函数为
÷[ + tr( , )+ , ]
(20)
其中 =W 一’., = 一8
式中 ——第i个神经网络的权重向量的最优值
与估计值之间的误差
第i个神经网络的逼近误差的最优值
与估计值之间的误差
对时间t求微分可得
T
=
一
∑tr( 厂二 )一∑ 厂 奎
(21)
将式(10)和式(17)~(19)代入到式(21)可得
V= {卢 (F1/r )diag( )[ 一
(F2/r1)(Al +A2 " +A3 )一8]}一
∑打( 厂二 )一∑ 厂二 音 =
∑s (1 )(r。/r ) +
∑s (1 )(rI/r/)1 一∑s A 一
∑s A s 一∑s A 3iS 一
∑ r( O'iSi(1 )(r /r:) )+
∑ (rlwi w )一∑ s (1佃 )(r。/r:)
[s … ]
=8 一£=[ … ]
根据F一范数的性质可以得到
≤一∑ A 一“
∑
A s 一 A, s 一
rlwi s ∑
(1 lI一W丁/max)
W/
max
一
4
77 s
(I量I一 ̄丁imax) s
 ̄'im
ax
——
4
(23)
由于,是有界的,则w 有界,取
l lll≤
… ,
I8 I≤ … 。
此时分以下3种情况考虑:
(1)当II II≥ … 且l I≥ … 时,V≤0,根
据Lyapunov理论可得闭环系统稳定,并且l lll最
终收敛至 … ,l I最终收敛至 … ,保证’., 和s
的有界性。
(2)当I s l≥1时,由于 ≥5 ,式(23)可进
一
步表示为
≤一
塞(A】f 一
(24)
若满足A +A ≥( + 2 )/4,贝0可
以保证 ≤0。
(3)当 I<1时,由于s > ,同理可得。
若满足A +A ≥(叼 叫j…+77 s )/4,贝4可
以保证 ≤0。
综上所述,要使 ≤0,需要满足以下条件
l lll≥W… 且I I≥s… (25)
或 A +A: ≥(叼 2m +叩 szm )/4
且Al +A 3 ≥(r/wi +77 2… )/4 (26)
第2期 吴爱国等:机械臂神经网络非奇异快速终端滑模控制 399
因此选择合理的A 、A: 、A 即可保证 ≤0,保
证闭环系统稳定。
≤∑s gtiK +∑s
l 1 1
=1 i=l
s 一∑s。 A ^一
i=1
当系统满足上述条件时,由式(23)和式(24)可
∑s A 2iS i 一∑s lp'iA r ≤
一
知,当且仅当S=0时,V=0。即当V 0时,s;0。
根据LaSalle不变性原理可知,当 一。。时, 一0,闭
环系统渐进稳定。
∑gs(A 一K
一
) 一∑ ̄f'iA 3iS “≤
(34) ∑s2 一 :∑sr; “
由式(20)可知,当l lll_÷∞或l lll—o。或 其中
l lII一∞时, 一。。,李雅普诺夫函数正定且径向
无界,闭环系统全局渐进稳定。
4有限时间收敛性分析
证明:取Lyapunov函数为
=
÷s s (27)
对时间t求微分可得
。
=s { (F1/r )diag( z )[ 一
卢(r2/r1)(AlS+A2 +A3 )一 ]}=
∑s (1 )(r。/r ) +
∑s (1 )(r /r ) 一
∑s A 一∑s。 A s r 一∑s A
(28)
由于高斯函数的值域为[0,1],则l 『l≤√ ,
又因为I J 01 ll≤lI l ll_,则 是有界的。
为简化计算,取 =[ 。 : … ] ,其中 =
 ̄T
i f。
假设以下不等式成立
I≤卢 (r:/r )K l s I (29)
l l≤卢 (F2/r1)K I s I (30)
式中K ;、K ——正常数
当满足以下不等式时,可保证式(29)、(30)成
立
lI≥ — 鱼 :△
。
(31)
min (/3 (r2/r1)K )
Il≥ — 一:△ (32)
mi (卢 (r2/r1)K )
由式(31)、(32)可知,取滑模函数S满足
l lS lI≥max(△ ,A 2)=△, (33)
将式(29)、(30)代入式(28)可得
A1 >K f+K
=
i [ (A —K 一K。 )]
2=rai
n(gti
.
A 3 )
由文献[17]可得
(2 )卡≤∑s ¨ (35)
将式(27)、(35)代人式(34)可得
十2 1V +2” ≤0 (36)
其中 =(r /r8+1)/2
由文献[17]可得有限收敛时间满足
≤ tn (37)
由式(37)可知,滑模函数S将在有限的时间内
收敛到邻域△ 内。由式(31)、(32)可知,增大卢
与r 的值或减小r。的值可使△ 减小,△,越小跟踪
效果越好。
5 仿真
为了验证本文所提的控制算法的有效性,选取
6-DOF Denso串联机械臂的前3个关节作为控制对
象,其余3个关节锁死,并利用拉格朗日方程¨ 建
立该机械臂前3个关节的动力学模型,由于该模型
方程比较复杂,在此没有具体列出。通过Matlab软
件进行仿真研究,仿真采用式(17)控制律,记为
NFT—T—RBF,采用式(18)、(19)自适应律,仿真参
数如表1所示。
表1 NFT—T—RBF仿真参数
Tab.1 Simulation parameters of NFT—T—RBF
参数 数值 参数 数值
1
/r2 11/9 Al diag(3,1,10)
r3/r4 5/3 A2 diag(2,1,5)
5/r6 5/3 diag(5,5,10)
7
/r8 3/5 Fw diag(1,1,1)
diag(1.1,1) 田 diag(0.1,0.1,0.1)
diag(80,50,80) l‘,0 [1,1,1]
为对比说明本文所提控制器的有效性,与以下
3种控制方法的仿真结果进行对比。
农业机械学报
控制器1:相比本文所提控制器,切换控制项采
用不连续鲁棒项,记为NFT—S—RBF,控制律为
l=一 N一
关节通道的1、2、3 S时刻施加扰动,持续时间均为
0.5 S,扰动值为对应关节控制量的限幅值的0.8倍,
如图2所示。图3表示RBFNN对未知非线性函数
的估计。图4为3个关节的轨迹跟踪曲线,期望轨
迹均为正弦信号,其中前2个关节的期望轨迹的幅
[J +
(1"3/r4)diag(e )] (r2/r1) 一
(38) 口(1"2/rI)(k1 +k2 sign(S))一s
控制器1的仿真参数如表2所示。
表2 NFT—S—RBF仿真参数
Tab.2 Simulation parameters of NFT—S—RBF
参数 数值 参数 数值
l
/r2 11/9 k2 diag(0.1,0.2,0.05)
3
/r4 5/3 Fw diag(1,1,1)
diag(1,1,1) T/ diag(0.1,0.1,0.1)
p diag(80,80,200) 0 (3,4,2)
kl diag(7,5,6)
控制器2:相比控制器1,不再引入RBF神经网
络估计系统未知非线性动力学,记为NFT—S,控制
律为
=一
[J +
(F3/r )diag(e )]卢(r:/r,) 。一
(i"2/r。)(k,S+k sign(S)) (39)
控制器2的仿真参数如表3所示。
表3 NFT—S仿真参数
Tab.3 Simulation parameters of NFT—S
参数 数值 参数 数值
1/r2 11/9 diag(80,50,50)
r3/r4 5/3 kl diag(5,4,4)
口diag(1,1,1) k2 diag(0.1,0.2,0.1)
控制器3:相比控制器2,采用线性滑模面,记为
SMC—s,该控制器的滑模面和控制律分别为
S= +fie (40)
3=一klS—k2 sign(S) (41)
控制器3的仿真参数如表4所示。
表4 SMC—S仿真参数
Tab.4 Simulation parameters of SMC—S
机械臂3个关节的期望轨迹分别为
,
qd1=(27/3)sin(2t)
{qd2:(27/3)sin(2t)+,rr/2 (42)
【qd3=(5"rr/18)sin(2t)
被控对象的初始状态为:(q ,g:,q ,臼 , ,由,)=
(2-rr/3,7竹/6,5 /l8,0,0,0)。
RBF神经网络隐含层的节点数L=7。
为验证所提控制算法的抗扰动性能,分别在3个
值为2v/3,第3个关节的幅值为5,rr/18。图5为3个
关节的轨迹跟踪误差曲线。图6为各个关节的控制
输出力矩。由图4和图5可以看出,4种控制器最
终都能实现轨迹跟踪,但每个控制器的收敛速度、鲁
棒性等又各有不同。
时间/s
图2外部扰动
Fig.2 External disturbance
:
:
器
 ̄ ̄lN/s
图3不确定项估计
Fig.3 Estimation of uncertainty
对比图4、5中的NFT—S与SMC—S,两者的主
要区别是采用的滑模面不同,NFT—S控制器采用非
奇异快速终端滑模面,SMC—S采用线性滑模面。
由图4可以看出,对于在1、2、3 S时刻施加的外部扰
动,SMC—S控制器对扰动更为敏感。由图5可看
出,对于SMC—S控制器,外部扰动使3个关节产生
的跟踪误差的峰值分别为1.8、0.4、0.2 rad,而对于
NFT—S控制器,扰动产生的误差均在0.1 rad以内,
误差峰值分别降低了94%、75%和50%。由图5
可以看出,SMC—S控制器的调整时间约为2 S,而
NFT—S控制器的调整时间为1 S,相比前者降低了
50%。以上分析表明,非奇异快速终端滑模控制
方法提高了滑模运动阶段的收敛速度,增强系统
鲁棒性。
第2期 吴爱国等:机械臂神经网络非奇异快速终端滑模控制 401
0 0 0.5 110 1.5 2.O 2.5 3.O 3.5 4.0 4.5 5.0
时间/s
时间,自 时间/s
(a)关节1 (b)关节2 (c)关节3
图4关节轨迹跟踪曲线(仿真)
Fig.4 Trajectory tracking ̄llYVe¥of joints
O
时问,目 时间/s
(a)关节1 (b)关节2
图5关节跟踪误差曲线(仿真)
Fig.5 Tracking error ̄UlWeS of joints
50
言
言
邑0
0 -5o
.1 摘亩姑
时间『日 时间/s
冒
杰
时间/s 时间/s 时间,g
一二 _一 L-f吉
(a)关节1
(b)关节2
(c)关节3
图6关节控制力矩(仿真)
Fig.6 Control torques of joints
对比控制器1与控制器2,即图4~6中的
控制器的切换控制项引入终端吸引子代替符号函
NFT—S—RBF与NFT—S,NFT—S—RBF控制器利用
数,使控制力矩输出连续。由图4和图5中可以看
RBF神经网络对系统未知非线性函数进行实时估
出,NFT—T~RBF控制器的调整时间均在0.3 S以
计和补偿。由图4和图5可以看出,NFT—s—RBF
内,降低了系统响应时间,并且进一步提高系统的抗
控制器的抗扰动性能和系统收敛速度均略优于 扰动性能。因此切换控制项引人终端吸引子能够提
NFT—S控制器。由图6可以看出,NFT—s控制器
高滑模趋近速度,增强鲁棒性。
的控制力矩输出产生了剧烈的抖振,这是由于切换 仿真结果表明,本文所提出的基于径向基神经
控制项中的符号函数k sign( )造成的,而NFT—S— 网络的非奇异快速终端滑模控制方法能够有效的提
RBF控制器的输出力矩则更为平滑。以上分析表
高系统控制性能,加快收敛速度,增强鲁棒性,抑制
明,引入RBF神经网络估计系统不确定项能够有效
系统抖振。
地削弱系统抖振。
对比本文所提控制器与控制器1,即图4、5中
6 实验
的NFT—T—RBF与NFT—S—RBF,NFT—T—RBF
为了验证本文所提的控制算法在实际应用中的
402 农业机械学报
控制性能,在Denso 6一DOF机械臂的前3个关节上
控制越为
(t.)=~ (t ) (45)
进行轨迹跟踪实验,其余关节锁死,该实验平台是
Quanser公司开发的Denso 6—1)OF机械臂控制系
女I1果机械臂控制系统是渐进稳定的,则满足
.
统,如图7所示。其硬件系统主要包括Denso VP一
6242G机械臂,伺服控制器,控制汁算机。软件系统
为Quanser公司开发的能完全兼容Madab的实时控
制软件Qua, 用户可以在Simulink环境下调整内部
控制;}i{也可以独 没计控制器,通过该软件自动生
(ffI)l> (t。)I (t。>t ,)
(46)
这将会导致在t.时刻作用于机械臂的控制量
的绝对值偏大,偏差量为
A =If (t。)l—I r (t,)I:卢[I (t )l—I O(t,)I]
(47)
成可执行文件。系统控制过程:编码器测量6个关
电动机的角度位置,通过专用电缆传送到伺服控
制器的数据采集模块,再通过以太网传输到汁算机,
通过J 位机控制器计算输出控制力矩,经数据采集
模块送到伺服驱动器,驱动机械臂关节电动机运动,
完成机械臂控制任务。
炎{t4 机械臂本体
偏差量△ 增大将会导致系统状态在滑模面附
近抖振,由式(47)叮知,卢与△ 。成正比,但 与提
高系统收敛速度和稳态精度也成正比,使得减小偏
差量与提高系统性能相悖,为了减小每个采样时刻
的偏差量,削弱抖振,在实验中将式(I2)修改为
:
.,
一
[, + ‘(r3/r4)diag(e。 一‘)]·
p(r2/r1) 。。” (48)
囵鞭一
其中
参数
I
=diag( , …, )( <卢 )
实验采用式(17)控制律记为NFT—T~RBF,
式(18)、(19)自适应律,实验参数如表6所示。
表6 NFT—T—RBF实验参数
Tab.6 Experimental parameters of NFT—T—RBF
数髓
t1/9
5/3
参数
A1
A2
数值
diag(5,5.5)
diag(1.I.1)
/r
/r4
表5关键运行参数
Tab.5 Critical operating parameters
7
/r^
/rs
5/3
3/5
A3 diag(5.5.5)
diag(1.1.1)
Qt"diag(50.30,50)
diag(50,30.50)
T/
.‘,【 1
diag(0.1,0.1,0.1)
(1,1,1)
为对比验证本艾所提控制方法的有效性,将实
验结果与WAN等 所提出的基于扩张状态观测器
该实验是依据本文所提的控制算法以及仿真研
究,独 设计控制器,实现机械臂轨迹跟踪控制 由
于实际系统中存在信号传输延时问题,该系统延时
的滑模控制方法(PD—ESO—SMC)进行对比。PD—
ESO—SMC控制方法采用扩张状态观测器对系统不
确定项进行实时的估计和补偿;滑模面采用线性滑
模面,系统收敛速度慢,稳态精度低;切换控制引入
sal函数,但该函数只能在滑模函数小于1时加快趋
近速度,不能实现全局快速趋近。
为6个采样时刻,fH在仿真中是不存在这种问题的,
因此需要考虑系统延时对控制性能的影响,分析控
制律式(17)可知,若滑模面的参数确定,其中等效
控制 . 则为不可控的量。定义
PD—ESO—SMC方法所采用的滑模面和控制律
分别为
S= +k e
f= :S+k3diag(1S I )sign(s)
彳...。=一 [, + ’(r3/r4)diag(e “ 一 )]·
(r,/r ) /r2=一 (43)
(49)
(50)
式中 ——关于e和 的函数
设某一次采样时刻为f 时刻,则该时刻所需要
的等效控制艟为
r...,(,。)=一卢O(t。) (44)
PD—ESO—SMC方法的实验参数如表7所示。
3个关节的期望轨迹分别为
,
ql{1=(1T/l8)sint
然而由于传输延时的影响,控制量 (t。)将在
,,时刻作用于机械臂,但,,时刻机械臂真正需要的
?qd2=(1T/I8)sint
【q【I1l=(7r/l8)sint一竹/2
(51)
第2期 吴爱国等:机械臂神经网络非奇异快速终端滑模控制
表7 PD~ESO—SMC实验参数
关节的轨迹跟踪任务。由图8可以看出,本文所提
的控制方法比PD—ESO—SMC方法具有更快的收
敛速度。由图9可以看出,PD—ESO—SMC控制方
法的误差稳态精度在0.02 tad左右,而NFT—
T—RBF控制方法的稳态精度在0.005 rad左右,显
Tab.7 Experimental parameters of PD—ESO—SMC
参数
k1
k2
数值
diag(15,15,12)
diag(10,10,7)
参数
k3
k4
数值
diag(15,22,10)
0.7
图8为关节轨迹跟踪曲线。图9为关节轨迹跟
踪误差曲线。图10为各个关节的控制输出力矩。
著地提高了系统跟踪精度。由图10可以看出,输出
控制量有轻微的抖振,但是在允许的范围之内。实
验结果表明,本文所提控制方法在实际应用中能够
图11表示机械臂启动的初始化时间为2.85 S,在初
始化完成以后采用用户独立设计的控制器完成各个 提高系统收敛速度和跟踪精度。
一
1
1
1
l
蔬, ,‘一、\
…
一
—
—
一
一
一
l
1
1
1
—
-
时间/s
(a)关节1
时问,8
(b)关节2
时间/s
(c)关节3
图8关节轨迹跟踪曲线(实验)
Fig.8 Trajectory tracking curves of joints
n n m m气;
时间/s
时间,B
(c)关节3
(b)关节2
图9关节跟踪误差曲线(实验)
Fig.9 Tracking error curves of joints
时间,粤
(a)关节1
时间/s
(b)关节2
时间/s
(c)关节3
图l0关节控制力矩(实验)
Fig.10 Control torques of joints
为衡量整个控制系统的平均跟踪精度,引入均
方差的指标 比较两者的控制性能,即
则系统均方差指标如表8所示。
由表8可以看出,NFT—T—RBF控制方法在3
个关节的均方差比PD—ESO—SMC的均方差分别
:
[e]=
(52)
降低了51.2%、41.0%和70.3%,表明本文所提的
控制方法能够有效提高跟踪精度。
式中 Ⅳ,——系统初始化完成以后的总采样数
404 农业机械学报 2 0 1 8匀三
统存在收敛速度慢、跟踪精度低的问题,分析比较
NFTSM和线性滑模的收敛性能,并结合RBFNN对
碉
l O O O 0 O O 0 O O
O 9 8 7 6 5 4 3 2 l
系统未知非线性函数进行实时估计和补偿,实现无
模型控制,以及切换控制项引入快速连续终端吸引
子,提出了一种基于RBF神经网络的非奇异快速终
端滑模控制方法,并证明了系统全局渐进稳定性和
t 1 l , 1l I\
0 1 2 3 4 5 6 7 8 9 10
有限时间收敛特性。
时间,s
(2)仿真结果表明,相比线性滑模,NFTSM使滑
模运动阶段收敛速度提升约50%,3个关节的扰动
误差峰值分别降低了94%、75%和50%,增强了系
图l1 系统初始化时间
Fig.1 1 System initialization time
表8均方差
Tab.8 Mean square deviation rad
统鲁棒性。RBFNN补偿控制器在增强系统控制性
能的同时有效地降低了系统抖振,使控制量输出更
平滑。快速连续终端吸引子缩短了滑模趋近阶段的
时间,进一步提高系统的抗扰动性能。
(3)实验结果表明,相比PD—ESO—SMC控制
7 结论
(1)针对具有不确定性和外部扰动的机械臂系
方法,本文控制方法的均方差分别降低了51.2%、
41.0%和70.3%,有效地提高了系统跟踪精度。
参 考 文 献
1 ZHAO J B,WANG X Y,ZHANG G X,et a1.Design and implementation of membrane controllers for trajectory tracking of
nonholonomic wheeled mobile robots[J].Integrated Computer Aided Engineering,2015,23(1):15—30.
2 BOUAKRIF F,ZASADZINSKI M.Trajectory tracking control for perturbed robot manipulators using iterative learning method[J].
International Journal ofAdvanced Manufacturing Technology,2016,87:2013—2022.
3 HUANG D W,ZHAI J Y,AI W Q,et a1.Disturbance observer—based robust control for trajectory tracking of wheeled mobile
robots[J].Neuroc0 puting,2016,198:74—79.
4 CUONG P V,WANG Y N.Adaptive trajectory tracking neural network control with robust compensator for robot manipulators[J].
Neural Computing and Applications,2016,27(2):525—536.
5 CAMBERA J C.FELIU—BATLLE V.Input—state feedback linearization control of a single—link flexible robot arm moving under
gravity and joint friction[J].Robotics&Autonomous Systems,2017,88:24—36.
6 FATEH M M,AZARGOSHASB S.Discrete adaptive fuzzy control for asymptotic tracking of robotic manipulators[J].Nonlinear
Dynamics,2014,78(3):2195—2204.
7 MAN Z H,PAPLINSKI A P,WU H R.A robust MIMO terminal sliding mode control scheme for rigid robotic manipulators『J].
IEEE Transactions on Automatic Control,1994,39(12):2464—2469.
8 FENG Y,Yu X H,MAN Z H.Non—singular terminal sliding mode control of rigid manipulators[J].Automatica,2002,
38(12):2159—2167.
9李升波,李克强,王建强,等.非奇异快速的终端滑模控制方法[J].信息与控制,2009,38(1):1—8.
LI S B,LI K Q,WANG J Q,et a1.Nonsingular and fast terminal sliding mode control method[J].Information and Control,
2009,38(1):1—8.(in Chinese)
1 0 XIAO B,YIN S,KAYNAK O.Tracking control of robotic manipulators with uncertain kinematics and dynamics r¨.IEEE
Transactions on Industrial Electronics,20 1 6,63(1 0):6439—6449.
1 1 KUMAR N,PANWAR V,BORM J H,et a1.Enhancing precision performance of trajectory tracking controller for robot
manipulators using RBFNN and adaptive bound[J].Applied Mathematics&Computation,2014,231:320—328.
1 2 Yu L,FEI S,HUANG J,et a1.Trajectory switching control of robotic manipulators based on RBF neural networks[J].Circuits,
Systems,and Signal Processing,2014,33(4):1119—1133.
13 TRAN M D,KANG H J.Adaptive terminal sliding mode control of uncertain robotic manipulators based on local approximation of
a dynamic systeml J J.Neurocomputing,2O17,228:231—240.
14 PHAM C V,WANG Y N.Robust adaptive trajectory tracking sliding mode control based on neural networks for cleaning and
detecting robot manipulators[J].Journal of Intelligent&Robotic Systems,2015,79(1):101—114.
15 GUO S P,LI D X,MENG Y H,et a1.Task space control of free—floating space robots using constrained adaptive RBF—NTSM
[J].Science China Technological Sciences,2014,57(4):828—837.
(下转第240页)
24O
2012,43(6):717—725.
农业机械学报 2 0 1 8焦
PAN Deng,REN Li,LIU Yu.Application of distributed hydrological model for optimizing irrigation regime in Heilong—gang and
Yundong plain I.model calibration and validation[J].Journal of Hydraulic Engineering,20 1 2,43(6):7 1 7—725.(in
Chinese)
1O王斌,王贵作,黄金柏,等.栅格分布式水文模型在高寒区日流量模拟中的应用[J].水力发电学报,2013,32(6):36—42.
WANG Bin,WANG Guizuo,HUANG Jinbai,et a1.Distributed hydrological model based on grid and its application to daily
runoff simulation for high—cold region[J].Journal of Hydroelectric Engineering,2013,32(6):36—42.(in Chinese)
11戚颖.三江平原典型流域土地覆被变化对水资源的影响研究[D].哈尔滨:东北林业大学,2015.
QI Ying.Research on the effects of land cover change of typical basin in Sanjiang plain[D].Harbin:Northeast Forestry
University,2015.(in Chinese)
12 白雪峰,王斌,戚颖.土地覆被变化对径流量影响的GSAC模型分析[J/OL].农业机械学报,2017,48(7):257—264.
http://www.j—csam.org/jcsam/ch/reader/view—abstract.aspx?flag 1&file—no=20170732&joum —id=jcsam.DOI:10.6041/
j.issn.1000—1298.2017.07.032.
BAI Xuefeng,WANG Bin,QI Ying.Impacts of land cover change on runoff based on grid—based Sacramento model[J/OL].
Transactions of the Chinese Society for Agricultural Machinery,2017,48(7):257—264.(in Chinese)
13 HARGREAVES G H,SAMANI Z A.Reference crop evap0transpiration from temperature[J].Applied Engineering in
Agriculture,1985,1(2):96—99.
14 ZHOU M,ISHIDAIRA H,HAPUARACHCHI H P,et a1.Estimating potential evap0transpirati0n using Shuttleworth—Wallace
model and NOAA—AVHRR NDVI data to feed a distributed hydrological model over the Mekong River basin[J].Journal of
Hydrology,2006,327:151—173.
1 5 RODELL M,HOUSER P R,JAMBOR U E A,et a1.The global land data assimilation system[J].Bulletin of the American
Meteorological Society,2004,85(3):38l一394.
16王斌,丁星臣,黄金柏,等.基于HWSD的GSAC模型网格化产流参数估计与校正[J/OL].农业机械学报,2017,
48(9):250—256,249.http://www.j—csam.org/jcsam/eh/reader/view—abstract.aspx?flag=1&file—no=20170931&journal—
id=jcsam.DOI:10.6041/j.issn.1000-1298.2017.09.031.
WANG Bin,DING Xingchen,HUANG Jinbai,et a1.Grid runoff parameters estimation and adjustment of GSAC model based on
HWSD[J/OL].Transactions ofthe Chinese Society orf Agricultural Machinery,2017,48(9):250—256,249.(in Chinese)
1 7 MO Xingguo,LIU Suxia,LIN Zhonghui,et a1.Simulating temporal and spatial variation of evapotranspiration over the Lushi
basin[J].Journal of Hydrology,2004,285:125—142.
1 8 BORMANN K J.EVANS J P,MCCABE M F.Constraining snowmeh in a temperature-index model using simulated snow densities
『J].Journal of Hydrology,2014,517:652—667.
19 PENEV K.LITTLEFAIR G.Free search—a comparative analysis『J].Information Sciences,2005,172(1—2):173—193.
20 王斌,黄金柏,宫兴龙,等.Free Search算法率定的Sacramento模型在东北寒旱区的应用[J/OL].农业机械学报,2016,
47(6):171—177.http://www.j-csam.0rg/jcsam/ch/reader/view—abstract.aspx?flag=1&file—no=20160622&journal—id=
jcsam.DOI:10.6041/j.issn.1000—1298.2016.06.022.
WANG Bin,HUANG Jinbai,GONG Xinglong,et a1.Application of Sacramento model calibrated by Free Search algorithm in cold
and arid region ofNortheast China[J/OL].Transactions ofthe Chinese Society for Agrieuhural Machinery,2016,47(6):171—
177.f in Chinese)
(上接第404页)
1 6 WANG Y Y.GU L Y,XU Y H.et a1.Practical tracking control of robot manipulators with continuous fractional—order
nonsingular terminal sliding mode[J].IEEE Transactions on Industrial Electronics,2016,63(10):6194—6204.
17 YU S H,YU X H,SHIRINZADEH B,et a1.Continuous infinite time control for’robotic manipulators with terminal sliding mode
lJ.Automatiea,2005,41(11):1957—1964.
18霍伟.机器人动力学与控制[M].北京:高等教育出版社,2005.
19 WAN K G,wu A G,LIU H T,et a1.Trajectory tracking of 3-DOF spatial robot manipulator[C]∥2016 12th World Congress on
Intelligent Control and Automation.IEEE,20 1 6:3259—3264.
20 丁力,马瑞,单文桃,等.小型无人直升机航向线性自抗扰控制[J/OL].农业机械学报,2【)l7,48(5):22—27.http://
www.j—csam.org/jcsam/ch/reader/view—abstract.aspx?file—no=20170502&t]ag:1.DOI:10.6041/j.issn.1000-1298.2017.
05.002
DING L,MA R.SHAN W T,et a1.Linear active disturbance rejection control f() yaw channel of small—scale unmanned
helicopter[J/OL].Transactions ofthe Chinese Society for Agricultural Machinery,2017,48(5):22—27.(in Chinese)
版权声明:本文标题:机械臂神经网络非奇异快速终端滑模控制 内容由网友自发贡献,该文观点仅代表作者本人, 转载请联系作者并注明出处:http://www.roclinux.cn/p/1713237061a625346.html, 本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如发现本站有涉嫌抄袭侵权/违法违规的内容,一经查实,本站将立刻删除。
发表评论