工作空間機(jī)器人末端軌跡的滑?？刂?/h1>
2016-02-07 06:42沈顯慶鄭俊翔王明杰劉繼紅
黑龍江科技大學(xué)學(xué)報(bào) 2016年6期
沈顯慶, 鄭俊翔, 唐 巍, 王明杰, 劉繼紅
(1.黑龍江科技大學(xué) 電氣與控制工程學(xué)院， 哈爾濱 150022； 2.黑龍江科技大學(xué) 哈爾濱煤礦機(jī)械研究所，哈爾濱 150036；3.哈爾濱工業(yè)大學(xué) 自動(dòng)化測(cè)試與控制研究所， 哈爾濱 150001)
工作空間機(jī)器人末端軌跡的滑?？刂?/p>
沈顯慶1, 鄭俊翔1, 唐 巍1, 王明杰2, 劉繼紅3
(1.黑龍江科技大學(xué) 電氣與控制工程學(xué)院， 哈爾濱 150022； 2.黑龍江科技大學(xué) 哈爾濱煤礦機(jī)械研究所，哈爾濱 150036；3.哈爾濱工業(yè)大學(xué) 自動(dòng)化測(cè)試與控制研究所， 哈爾濱 150001)
為了提高工業(yè)機(jī)器人軌跡跟蹤性能，針對(duì)傳統(tǒng)控制器存在的啟動(dòng)輸出轉(zhuǎn)矩大、誤差收斂速度慢和抖振等問題，提出了一種應(yīng)用于機(jī)器人工作空間的基于改進(jìn)型雙冪次指數(shù)趨近律的滑模控制律設(shè)計(jì)方法。在工作空間位置坐標(biāo)的動(dòng)力學(xué)方程基礎(chǔ)上，通過改進(jìn)指數(shù)趨近律的方法，將基于飽和函數(shù)的雙冪次指數(shù)趨近律運(yùn)用在終端滑?？刂破髟O(shè)計(jì)中，實(shí)現(xiàn)了對(duì)工作空間下末端軌跡的直接控制，在Simulink環(huán)境下對(duì)比分析了兩種趨近律設(shè)計(jì)滑模控制律的控制效果。結(jié)果表明：基于該方法所設(shè)計(jì)的控制器具有良好的魯棒性和控制精確度，同時(shí)有效地削弱了抖振。
機(jī)器人； 滑?？刂疲?趨近律； 軌跡跟蹤
0 引 言
當(dāng)前，工業(yè)機(jī)器人前沿技術(shù)和產(chǎn)業(yè)發(fā)展迅速，在生產(chǎn)中應(yīng)用日趨廣泛，已成為現(xiàn)代設(shè)備制造業(yè)中重要的自動(dòng)化裝備。機(jī)器人高級(jí)控制策略和智能控制成為近年來控制科學(xué)領(lǐng)域探索研究的前沿課題?；Ｗ兘Y(jié)構(gòu)控制由于快速性好、計(jì)算量小、無超調(diào)、實(shí)時(shí)性強(qiáng)，能對(duì)系統(tǒng)進(jìn)行精確地軌跡跟蹤控制，成為近年來機(jī)器人高級(jí)控制研究的熱點(diǎn)，它能有效解決傳統(tǒng)控制器存在啟動(dòng)輸出轉(zhuǎn)矩大、誤差收斂速度慢等問題，然而抖振問題仍是在實(shí)際應(yīng)用中的障礙。
國內(nèi)外許多學(xué)者從趨近律的角度提出了不同解決抖振對(duì)策，高為炳[1]提出了設(shè)計(jì)趨近律的概念，為縮短趨近時(shí)間以及削弱抖振提供了可行性的辦法。盛嚴(yán)等[2]提出了一種指數(shù)趨近律，可從較大的趨近速度逐漸減少到零，有效縮短了趨近時(shí)間。Yu等[3]通過將指數(shù)趨近律與單冪次趨近律組合，使趨近過程更加平滑，但到達(dá)切換面系統(tǒng)后仍存在抖振。Jiang等[4]將模糊控制與指數(shù)趨近律結(jié)合，利用模糊規(guī)則動(dòng)態(tài)調(diào)節(jié)趨近律中的增益，使系統(tǒng)的動(dòng)態(tài)品質(zhì)得到進(jìn)一步改善，消除了高頻抖動(dòng)。Bandyopadhyay等[5]將改進(jìn)的單冪次趨近律與積分滑模面相結(jié)合設(shè)計(jì)控制律，但趨近時(shí)間有待提高。文獻(xiàn)[6-7]提出了一種全局快速收斂的雙冪次趨近律。文獻(xiàn)[8-10]在趨近律加入了自適應(yīng)項(xiàng)，可自適應(yīng)調(diào)節(jié)增益，有效提高了趨近速度并削弱了抖振。張瑤等[11]將多冪次趨近律應(yīng)用于航天器姿態(tài)控制，并通過詳細(xì)推導(dǎo)驗(yàn)證了所設(shè)計(jì)趨近律的優(yōu)越性和可行性。筆者在對(duì)機(jī)械臂的動(dòng)力學(xué)特性和趨近律特性分析的基礎(chǔ)上，將基于飽和函數(shù)的雙冪次指數(shù)趨近律和終端滑模面應(yīng)用于機(jī)器人控制器的設(shè)計(jì)中，實(shí)現(xiàn)對(duì)工作空間下末端軌跡的直接控制。
1 機(jī)械手動(dòng)力學(xué)模型
對(duì)于被控對(duì)象為一個(gè)剛性n關(guān)節(jié)機(jī)械手，根據(jù)拉格朗日方法，其動(dòng)力學(xué)方程為[12]
(1)
式中：D(q)Rn×n——機(jī)械手的慣性矩陣；
D(q)Rn——重力向量；
qRn——表示關(guān)節(jié)角度量；
τRn——電機(jī)施加的關(guān)節(jié)扭矩；
τdRn——外加干擾。
mi——mi=P+Pl;
q1、q2——關(guān)節(jié)1和關(guān)節(jié)2的角位移；
mα、mβ——關(guān)節(jié)1和關(guān)節(jié)2的質(zhì)量；
l1、l2——關(guān)節(jié)1和關(guān)節(jié)2的長度；
g——重力加速度。
為了實(shí)現(xiàn)末端執(zhí)行器的空間位置控制，需要針對(duì)工作空間設(shè)計(jì)直接的方法，建立基于末端位置的動(dòng)力學(xué)方程。根據(jù)機(jī)械手關(guān)節(jié)力矩τ與末端執(zhí)行力Fx之間存在線性映射關(guān)系，通過靜力學(xué)中的虛功原理[13]可得
Fx=J-T(q)τ。
根據(jù)文獻(xiàn)[14]中推導(dǎo)過程，得到基于末端位置坐標(biāo)(x1,x2)的動(dòng)力學(xué)方程
(2)
式中:Dx(q)=J-TD(q)J-1;
Gx(q)=J-TG(q)；
fd=J-Tτd。
2 滑?？刂破鞯脑O(shè)計(jì)
變結(jié)構(gòu)控制系統(tǒng)的結(jié)構(gòu)動(dòng)態(tài)控制過程，根據(jù)系統(tǒng)當(dāng)前的狀態(tài)偏差及偏差導(dǎo)數(shù)的變化，通過躍變的方式按照設(shè)定的規(guī)律作動(dòng)態(tài)改變?；Ｗ兘Y(jié)構(gòu)作為一類特殊的非線性控制方式，該類系統(tǒng)將在狀態(tài)空間預(yù)先設(shè)定一個(gè)切換曲面，由不連續(xù)的控制律，不斷變換控制狀態(tài)相結(jié)構(gòu)，使其沿著這個(gè)預(yù)定的切換曲面向平衡點(diǎn)滑動(dòng)，最后系統(tǒng)漸近穩(wěn)定至平衡點(diǎn)。機(jī)械手末端軌跡跟隨的驅(qū)動(dòng)力矩可用位置、速度的變化方式以設(shè)定規(guī)律趨向滑模面加以控制。系統(tǒng)從任意的初始狀態(tài)趨向切換面，趨近運(yùn)動(dòng)s→0的過程，如圖1所示。
圖1 系統(tǒng)變結(jié)構(gòu)的相軌跡
2.1 趨近律的設(shè)計(jì)
滑模變結(jié)構(gòu)過程包括趨近運(yùn)動(dòng)和滑模運(yùn)動(dòng)兩個(gè)環(huán)節(jié)。趨近運(yùn)動(dòng)中滑?？蛇_(dá)性條件僅保證由系統(tǒng)狀態(tài)空間任意起始運(yùn)動(dòng)點(diǎn)在限定時(shí)間內(nèi)到達(dá)切換面，對(duì)于其具體運(yùn)動(dòng)軌跡未作任何限制，因此，采用趨近律的方法可以有效改善趨近運(yùn)動(dòng)的動(dòng)態(tài)品質(zhì)。
典型的指數(shù)趨近律表示為
(3)
傳統(tǒng)指數(shù)趨近律存在一些不足，雖然在等速趨近律的基礎(chǔ)上增加了指數(shù)趨近項(xiàng)，利用指數(shù)趨近能縮短趨近時(shí)間，一定程度上抑制抖振，但等速項(xiàng)存在使系統(tǒng)不能從根本上消除抖振，控制器性能仍有提升的空間。鑒于傳統(tǒng)冪次趨近律能平滑進(jìn)入滑動(dòng)模態(tài)特點(diǎn)，文中在指數(shù)趨近律與冪次趨近律相結(jié)合的基礎(chǔ)上，對(duì)變結(jié)構(gòu)過程進(jìn)行了改進(jìn)，設(shè)計(jì)了一種改進(jìn)型雙冪次指數(shù)趨近律，綜合了兩者的優(yōu)點(diǎn)，從而改進(jìn)了指數(shù)趨近律。由于典型控制器含有不連續(xù)符號(hào)函數(shù)sgn(s)，控制器的力矩輸出必然會(huì)出現(xiàn)抖振現(xiàn)象。由于雙曲正切函數(shù)是光滑的，可使輸出平滑，因此，采用雙曲正切函數(shù)來代替符號(hào)函數(shù)，提升系統(tǒng)抑制抖振的性能。最后，設(shè)計(jì)的基于飽和函數(shù)的改進(jìn)型雙冪次指數(shù)趨近律表示為：
(4)
其中，ε1>0,ε2>0,k>0,1>α>0,β>1。
文中提出的趨近律原理與傳統(tǒng)趨近律相似，以s=1為臨界值，將系統(tǒng)到達(dá)滑模面分為兩個(gè)階段。式(4)中，當(dāng)|s|<1時(shí)，α值越小，系統(tǒng)狀態(tài)的趨近速度越快，β越大，-ε2|s|βtanh(s/δ)項(xiàng)在式中所起的作用越小，可忽略后項(xiàng)對(duì)系統(tǒng)的影響；當(dāng)|s|>1時(shí)，α值越小，-ε1|s|αtanh(s/δ)項(xiàng)在式中所起的作用越小，可忽略前項(xiàng)對(duì)系統(tǒng)的影響，β越大，系統(tǒng)狀態(tài)的趨近速度越快。式(4)中前兩項(xiàng)，相當(dāng)分階段控制，需增加指數(shù)項(xiàng)ks來緩解系統(tǒng)分界過程中的不連續(xù)性，從而削弱系統(tǒng)的抖振，保證系統(tǒng)的穩(wěn)定性。
2.2 控制律的設(shè)計(jì)
機(jī)械手滑模控制系統(tǒng)的結(jié)構(gòu)設(shè)計(jì)，如圖2所示。
圖2 機(jī)械手滑?？刂平Y(jié)構(gòu)
設(shè)計(jì)的變結(jié)構(gòu)控制器如下，定義誤差:
(5)
式中：e——機(jī)械臂末端位置的跟蹤誤差；
為了提高收斂性能，采用Terminal滑?？刂撇呗訹15-17]，在切換面的設(shè)計(jì)中引入非線性函數(shù)，使得切換面上跟蹤誤差能在有限時(shí)間內(nèi)收斂到零。
定義終端滑模切換面[15]
(6)
式中：Λ——一個(gè)正定矩陣；
p、q——正奇數(shù)，q>p。
定義參考變量
(7)
于是，則有
(8)
整理得
(9)
取常用的趨近律式(3)代入式(9)可得控制律：
(10)
式中：ε>0,K>0。
(11)
式中：ε1>0,ε2>0,k>0,δ>0。
2.3 穩(wěn)定性證明
對(duì)改進(jìn)的滑?？刂破鬟M(jìn)行穩(wěn)定性分析時(shí)，將式(11)代入式(2)，得
(12)
(13)
由于Dx(q)為對(duì)稱正定，則可選取Lyapunov函數(shù)
(14)
將定義的Lyapunov函數(shù)求導(dǎo)后代入式(14)得
(15)
結(jié)合(13)可得
(16)
收斂性分析，由Barlalat引理得e是連續(xù)的，則當(dāng)t→∞時(shí)，e→→0，即s指數(shù)收斂，位置誤差e和速度誤差指數(shù)收斂。
3 仿真結(jié)果與分析
a 末端節(jié)點(diǎn)的位置跟蹤
b 末端節(jié)點(diǎn)的速度跟蹤
c 控制輸入Fx和M
d 軌跡跟蹤效果
a 末端節(jié)點(diǎn)的位置跟蹤
b 末端節(jié)點(diǎn)的速度跟蹤
c 控制輸入Fx和M
d 軌跡跟蹤效果
4 結(jié)束語
針對(duì)機(jī)器人跟蹤控制器存在的問題，以加快誤差收斂速度和降低抖振、改善趨近運(yùn)動(dòng)的動(dòng)態(tài)品質(zhì)作為優(yōu)化目標(biāo)，提出了改進(jìn)指數(shù)趨近律的設(shè)計(jì)思想和方法，給出了基于飽和函數(shù)的改進(jìn)型雙冪次趨近律滑模控制策略，解決了以往控制器啟動(dòng)輸出力矩大、跟蹤速度慢，典型趨近律滑模控制力矩輸出存在抖振等問題，使軌跡跟蹤的誤差收斂速度和抑制切換抖振達(dá)到最佳。改進(jìn)的控制律使系統(tǒng)相狀態(tài)可根據(jù)與切換面距離，自適應(yīng)地調(diào)節(jié)主導(dǎo)趨近規(guī)律，從而使系統(tǒng)具有良好的魯棒性和控制精確度，同時(shí)有效地消除了抖振。為進(jìn)一步研究滑?？刂圃诘芽柨臻g下機(jī)械手末端位置跟蹤的應(yīng)用提供了參考。
[1] 高為炳. 變結(jié)構(gòu)控制的理論及設(shè)計(jì)方法[M]. 北京: 科學(xué)出版社, 1996.
[2] 盛 嚴(yán), 王 超, 陳建斌， 等. 結(jié)構(gòu)滑模控制的一種指數(shù)趨近律方法[J]. 噪聲與振動(dòng)控制, 2002， 8(4)： 31-35.
[3] YU S H, YU X H, SHI R B, et al. Continuous finite-time control for robotic manipulators with terminal sliding mode[J]. Automatica, 2005, 41(11): 1957-1964.
[4] JIANG K, ZHANG J G, CHEN Z M. A new approach for the sliding mode control based on fuzzy reaching law[C]// Proceedings of the 4th World Congress on Intelligent Control and Automation, China: Shanghai, 2002: 656-660.
[5] BANDYOPADHYAY B, FULWANI D, PARK Y J. A robust algorithm against actuator saturation using integral sliding mode and composite non-linear feedback[C]// Processdings of the 17th IFAC World Congress. COEX, Korea, South: IFAC, 2008: 14174-14179.
[6] 梅 紅, 王 勇. 快速收斂的機(jī)器人滑模變結(jié)構(gòu)控制[J]. 信息與控制, 2009, 38(5): 552-557.
[7] 李 鵬, 馬建軍, 鄭志強(qiáng), 等. 采用冪次趨近律的滑?？刂品€(wěn)態(tài)誤差界[J]. 控制理論與應(yīng)用, 2011, 28(5): 619-624.
[8] 姜 君, 陳慶偉, 郭 健, 等. 基于新型趨近律的動(dòng)中通系統(tǒng)滑模穩(wěn)定跟蹤控制[J]. 控制與決策, 2011, 26(12): 1904-1908.
[9] 徐 杰, 柴發(fā)武. 基于改進(jìn)趨近律的機(jī)械臂非奇異終端滑?？刂芠J]. 黑龍江科技大學(xué)學(xué)報(bào), 2016, 26(2)： 192-196.
[10] 翟偉娜, 葛運(yùn)旺, 宋書中, 等. 基于改進(jìn)趨近律的機(jī)械手滑模控制[J]. 信息與控制, 2014, 43(3): 300-305.
[11] 張 瑤, 馬廣富, 郭延寧, 等. 一種多冪次滑模趨近律設(shè)計(jì)與分析[J]. 自動(dòng)化學(xué)報(bào), 2016, 42(3): 466-471.
[12] 蔡自興, 謝 斌. 機(jī)器人學(xué)[M]. 北京: 清華大學(xué)出版社, 2015.
[13] 大熊繁. 機(jī)器人控制入門[M]. 盧伯英， 譯. 北京： 科學(xué)出版社， 2002.
[14] 劉金琨. RBF神經(jīng)網(wǎng)絡(luò)自適應(yīng)控制MATLAB仿真[M]. 北京： 清華大學(xué)出版社， 2014： 175-182.
[15] FENG Y, YU X H, MAN Z H. Non-singular terminal sliding mode control of rigid manipulators[J]. Automatica, 2002, 38(12): 2159-2167.
[16] TAO C W, TAUR J S, CHAN M L. Adaptive fuzzy terminal mode controller for linear systems with mismatch time-varying uncertainties feng [J]. IEEE Transactions on Systems, 2004, 34(1): 255-262.
[17] KARAYIANNIDIS Y, ROVITHAKIS G, DOULGERI Z. Force position tranking for a robotic manipulator in comliant contact with a surface using neuro-adaptive control[J]. Automtica,2007, 43(10): 1281-1288.
(編校 李德根)
Study on trajectory of manipulators end-effector based on sliding mode algorithm in task space
ShenXianqing1，ZhengJunxiang1，TangWei1,WangMingjie2,LiuJihong3
(1.School of Electrical & Control Engineering, Heilongjiang University of Science & Technology, Harbin 150022, China；2. Harbin Coal Mine Mechanical Research Institute, Heilongjiang University of Science & Technology, Harbin 150036, China； 3. Automatic Test & Control Institute, Harbin Institute of Technology, Harbin 150022, China)
This paper presents a novel design approach for sliding mode control law based on an improved double power exponential reaching law——a method aimed at improving the trajectory tracking performance of industrial robot as a viable solution to the drawbacks inherent in traditional controllers, such as a higher starting output torque, a lower error convergence speed and chattering. The research building on the dynamics equations in task space coordinates involves improving exponential reaching law and applying the double power exponential reaching law with the saturation function for designing a terminal sliding mode controller; and thereby achieving the direct control of end-effector’s trajectory in task space. The study is validated by the simulation experiment under the environment of Simulink and subsequent comparison of the control effects of different controllers under two reaching laws. The results demonstrate that this proposed method may provide a control system with a better robustness, a greater control precision, and an effective chattering reduction.
robot; sliding mode control; reaching law; trajectory tracking
2016-10-17
黑龍江省教育廳科學(xué)技術(shù)研究項(xiàng)目(12541697)
沈顯慶(1969-)，男，吉林省通化人，教授，博士，研究方向：先進(jìn)伺服系統(tǒng)與智能控制，E-mail:shenxianqing2001@163.com。
10.3969/j.issn.2095-7262.2016.06.019
TP273
2095-7262(2016)06-0681-06
:A
猜你喜歡
軌跡讀友·少年文學(xué)(清雅版)(2020年4期)2020-08-24 軌跡讀友·少年文學(xué)(清雅版)(2020年3期)2020-07-24 基于組合滑模控制的絕對(duì)重力儀兩級(jí)主動(dòng)減振設(shè)計(jì)中國慣性技術(shù)學(xué)報(bào)(2019年6期)2019-03-04 TRIZ與情景分解法在換刀機(jī)械手設(shè)計(jì)中的應(yīng)用制造技術(shù)與機(jī)床(2018年11期)2018-11-23 軌跡現(xiàn)代裝飾(2018年5期)2018-05-26 機(jī)械手式自動(dòng)打結(jié)機(jī)河北農(nóng)機(jī)(2017年12期)2018-01-20 使用SGCMGs航天器滑模姿態(tài)容錯(cuò)控制北京航空航天大學(xué)學(xué)報(bào)(2017年4期)2017-11-23 基于粒子群迭代的一種冗余機(jī)械手逆解算法制造技術(shù)與機(jī)床(2017年4期)2017-06-22 進(jìn)化的軌跡（一）——進(jìn)化，無盡的適應(yīng)中國三峽(2017年2期)2017-06-09 北京航空航天大學(xué)學(xué)報(bào)(2016年7期)2016-11-16
沈顯慶, 鄭俊翔, 唐 巍, 王明杰, 劉繼紅
(1.黑龍江科技大學(xué) 電氣與控制工程學(xué)院， 哈爾濱 150022； 2.黑龍江科技大學(xué) 哈爾濱煤礦機(jī)械研究所，哈爾濱 150036；3.哈爾濱工業(yè)大學(xué) 自動(dòng)化測(cè)試與控制研究所， 哈爾濱 150001)
工作空間機(jī)器人末端軌跡的滑?？刂?/p>
沈顯慶1, 鄭俊翔1, 唐 巍1, 王明杰2, 劉繼紅3
(1.黑龍江科技大學(xué) 電氣與控制工程學(xué)院， 哈爾濱 150022； 2.黑龍江科技大學(xué) 哈爾濱煤礦機(jī)械研究所，哈爾濱 150036；3.哈爾濱工業(yè)大學(xué) 自動(dòng)化測(cè)試與控制研究所， 哈爾濱 150001)
為了提高工業(yè)機(jī)器人軌跡跟蹤性能，針對(duì)傳統(tǒng)控制器存在的啟動(dòng)輸出轉(zhuǎn)矩大、誤差收斂速度慢和抖振等問題，提出了一種應(yīng)用于機(jī)器人工作空間的基于改進(jìn)型雙冪次指數(shù)趨近律的滑模控制律設(shè)計(jì)方法。在工作空間位置坐標(biāo)的動(dòng)力學(xué)方程基礎(chǔ)上，通過改進(jìn)指數(shù)趨近律的方法，將基于飽和函數(shù)的雙冪次指數(shù)趨近律運(yùn)用在終端滑?？刂破髟O(shè)計(jì)中，實(shí)現(xiàn)了對(duì)工作空間下末端軌跡的直接控制，在Simulink環(huán)境下對(duì)比分析了兩種趨近律設(shè)計(jì)滑模控制律的控制效果。結(jié)果表明：基于該方法所設(shè)計(jì)的控制器具有良好的魯棒性和控制精確度，同時(shí)有效地削弱了抖振。
機(jī)器人； 滑?？刂疲?趨近律； 軌跡跟蹤
0 引 言
當(dāng)前，工業(yè)機(jī)器人前沿技術(shù)和產(chǎn)業(yè)發(fā)展迅速，在生產(chǎn)中應(yīng)用日趨廣泛，已成為現(xiàn)代設(shè)備制造業(yè)中重要的自動(dòng)化裝備。機(jī)器人高級(jí)控制策略和智能控制成為近年來控制科學(xué)領(lǐng)域探索研究的前沿課題?；Ｗ兘Y(jié)構(gòu)控制由于快速性好、計(jì)算量小、無超調(diào)、實(shí)時(shí)性強(qiáng)，能對(duì)系統(tǒng)進(jìn)行精確地軌跡跟蹤控制，成為近年來機(jī)器人高級(jí)控制研究的熱點(diǎn)，它能有效解決傳統(tǒng)控制器存在啟動(dòng)輸出轉(zhuǎn)矩大、誤差收斂速度慢等問題，然而抖振問題仍是在實(shí)際應(yīng)用中的障礙。
國內(nèi)外許多學(xué)者從趨近律的角度提出了不同解決抖振對(duì)策，高為炳[1]提出了設(shè)計(jì)趨近律的概念，為縮短趨近時(shí)間以及削弱抖振提供了可行性的辦法。盛嚴(yán)等[2]提出了一種指數(shù)趨近律，可從較大的趨近速度逐漸減少到零，有效縮短了趨近時(shí)間。Yu等[3]通過將指數(shù)趨近律與單冪次趨近律組合，使趨近過程更加平滑，但到達(dá)切換面系統(tǒng)后仍存在抖振。Jiang等[4]將模糊控制與指數(shù)趨近律結(jié)合，利用模糊規(guī)則動(dòng)態(tài)調(diào)節(jié)趨近律中的增益，使系統(tǒng)的動(dòng)態(tài)品質(zhì)得到進(jìn)一步改善，消除了高頻抖動(dòng)。Bandyopadhyay等[5]將改進(jìn)的單冪次趨近律與積分滑模面相結(jié)合設(shè)計(jì)控制律，但趨近時(shí)間有待提高。文獻(xiàn)[6-7]提出了一種全局快速收斂的雙冪次趨近律。文獻(xiàn)[8-10]在趨近律加入了自適應(yīng)項(xiàng)，可自適應(yīng)調(diào)節(jié)增益，有效提高了趨近速度并削弱了抖振。張瑤等[11]將多冪次趨近律應(yīng)用于航天器姿態(tài)控制，并通過詳細(xì)推導(dǎo)驗(yàn)證了所設(shè)計(jì)趨近律的優(yōu)越性和可行性。筆者在對(duì)機(jī)械臂的動(dòng)力學(xué)特性和趨近律特性分析的基礎(chǔ)上，將基于飽和函數(shù)的雙冪次指數(shù)趨近律和終端滑模面應(yīng)用于機(jī)器人控制器的設(shè)計(jì)中，實(shí)現(xiàn)對(duì)工作空間下末端軌跡的直接控制。
1 機(jī)械手動(dòng)力學(xué)模型
對(duì)于被控對(duì)象為一個(gè)剛性n關(guān)節(jié)機(jī)械手，根據(jù)拉格朗日方法，其動(dòng)力學(xué)方程為[12]
(1)
式中：D(q)Rn×n——機(jī)械手的慣性矩陣；
D(q)Rn——重力向量；
qRn——表示關(guān)節(jié)角度量；
τRn——電機(jī)施加的關(guān)節(jié)扭矩；
τdRn——外加干擾。
mi——mi=P+Pl;
q1、q2——關(guān)節(jié)1和關(guān)節(jié)2的角位移；
mα、mβ——關(guān)節(jié)1和關(guān)節(jié)2的質(zhì)量；
l1、l2——關(guān)節(jié)1和關(guān)節(jié)2的長度；
g——重力加速度。
為了實(shí)現(xiàn)末端執(zhí)行器的空間位置控制，需要針對(duì)工作空間設(shè)計(jì)直接的方法，建立基于末端位置的動(dòng)力學(xué)方程。根據(jù)機(jī)械手關(guān)節(jié)力矩τ與末端執(zhí)行力Fx之間存在線性映射關(guān)系，通過靜力學(xué)中的虛功原理[13]可得
Fx=J-T(q)τ。
根據(jù)文獻(xiàn)[14]中推導(dǎo)過程，得到基于末端位置坐標(biāo)(x1,x2)的動(dòng)力學(xué)方程
(2)
式中:Dx(q)=J-TD(q)J-1;
Gx(q)=J-TG(q)；
fd=J-Tτd。
2 滑?？刂破鞯脑O(shè)計(jì)
變結(jié)構(gòu)控制系統(tǒng)的結(jié)構(gòu)動(dòng)態(tài)控制過程，根據(jù)系統(tǒng)當(dāng)前的狀態(tài)偏差及偏差導(dǎo)數(shù)的變化，通過躍變的方式按照設(shè)定的規(guī)律作動(dòng)態(tài)改變?；Ｗ兘Y(jié)構(gòu)作為一類特殊的非線性控制方式，該類系統(tǒng)將在狀態(tài)空間預(yù)先設(shè)定一個(gè)切換曲面，由不連續(xù)的控制律，不斷變換控制狀態(tài)相結(jié)構(gòu)，使其沿著這個(gè)預(yù)定的切換曲面向平衡點(diǎn)滑動(dòng)，最后系統(tǒng)漸近穩(wěn)定至平衡點(diǎn)。機(jī)械手末端軌跡跟隨的驅(qū)動(dòng)力矩可用位置、速度的變化方式以設(shè)定規(guī)律趨向滑模面加以控制。系統(tǒng)從任意的初始狀態(tài)趨向切換面，趨近運(yùn)動(dòng)s→0的過程，如圖1所示。
圖1 系統(tǒng)變結(jié)構(gòu)的相軌跡
2.1 趨近律的設(shè)計(jì)
滑模變結(jié)構(gòu)過程包括趨近運(yùn)動(dòng)和滑模運(yùn)動(dòng)兩個(gè)環(huán)節(jié)。趨近運(yùn)動(dòng)中滑?？蛇_(dá)性條件僅保證由系統(tǒng)狀態(tài)空間任意起始運(yùn)動(dòng)點(diǎn)在限定時(shí)間內(nèi)到達(dá)切換面，對(duì)于其具體運(yùn)動(dòng)軌跡未作任何限制，因此，采用趨近律的方法可以有效改善趨近運(yùn)動(dòng)的動(dòng)態(tài)品質(zhì)。
典型的指數(shù)趨近律表示為
(3)
傳統(tǒng)指數(shù)趨近律存在一些不足，雖然在等速趨近律的基礎(chǔ)上增加了指數(shù)趨近項(xiàng)，利用指數(shù)趨近能縮短趨近時(shí)間，一定程度上抑制抖振，但等速項(xiàng)存在使系統(tǒng)不能從根本上消除抖振，控制器性能仍有提升的空間。鑒于傳統(tǒng)冪次趨近律能平滑進(jìn)入滑動(dòng)模態(tài)特點(diǎn)，文中在指數(shù)趨近律與冪次趨近律相結(jié)合的基礎(chǔ)上，對(duì)變結(jié)構(gòu)過程進(jìn)行了改進(jìn)，設(shè)計(jì)了一種改進(jìn)型雙冪次指數(shù)趨近律，綜合了兩者的優(yōu)點(diǎn)，從而改進(jìn)了指數(shù)趨近律。由于典型控制器含有不連續(xù)符號(hào)函數(shù)sgn(s)，控制器的力矩輸出必然會(huì)出現(xiàn)抖振現(xiàn)象。由于雙曲正切函數(shù)是光滑的，可使輸出平滑，因此，采用雙曲正切函數(shù)來代替符號(hào)函數(shù)，提升系統(tǒng)抑制抖振的性能。最后，設(shè)計(jì)的基于飽和函數(shù)的改進(jìn)型雙冪次指數(shù)趨近律表示為：
(4)
其中，ε1>0,ε2>0,k>0,1>α>0,β>1。
文中提出的趨近律原理與傳統(tǒng)趨近律相似，以s=1為臨界值，將系統(tǒng)到達(dá)滑模面分為兩個(gè)階段。式(4)中，當(dāng)|s|<1時(shí)，α值越小，系統(tǒng)狀態(tài)的趨近速度越快，β越大，-ε2|s|βtanh(s/δ)項(xiàng)在式中所起的作用越小，可忽略后項(xiàng)對(duì)系統(tǒng)的影響；當(dāng)|s|>1時(shí)，α值越小，-ε1|s|αtanh(s/δ)項(xiàng)在式中所起的作用越小，可忽略前項(xiàng)對(duì)系統(tǒng)的影響，β越大，系統(tǒng)狀態(tài)的趨近速度越快。式(4)中前兩項(xiàng)，相當(dāng)分階段控制，需增加指數(shù)項(xiàng)ks來緩解系統(tǒng)分界過程中的不連續(xù)性，從而削弱系統(tǒng)的抖振，保證系統(tǒng)的穩(wěn)定性。
2.2 控制律的設(shè)計(jì)
機(jī)械手滑模控制系統(tǒng)的結(jié)構(gòu)設(shè)計(jì)，如圖2所示。
圖2 機(jī)械手滑?？刂平Y(jié)構(gòu)
設(shè)計(jì)的變結(jié)構(gòu)控制器如下，定義誤差:
(5)
式中：e——機(jī)械臂末端位置的跟蹤誤差；
為了提高收斂性能，采用Terminal滑?？刂撇呗訹15-17]，在切換面的設(shè)計(jì)中引入非線性函數(shù)，使得切換面上跟蹤誤差能在有限時(shí)間內(nèi)收斂到零。
定義終端滑模切換面[15]
(6)
式中：Λ——一個(gè)正定矩陣；
p、q——正奇數(shù)，q>p。
定義參考變量
(7)
于是，則有
(8)
整理得
(9)
取常用的趨近律式(3)代入式(9)可得控制律：
(10)
式中：ε>0,K>0。
(11)
式中：ε1>0,ε2>0,k>0,δ>0。
2.3 穩(wěn)定性證明
對(duì)改進(jìn)的滑?？刂破鬟M(jìn)行穩(wěn)定性分析時(shí)，將式(11)代入式(2)，得
(12)
(13)
由于Dx(q)為對(duì)稱正定，則可選取Lyapunov函數(shù)
(14)
將定義的Lyapunov函數(shù)求導(dǎo)后代入式(14)得
(15)
結(jié)合(13)可得
(16)
收斂性分析，由Barlalat引理得e是連續(xù)的，則當(dāng)t→∞時(shí)，e→→0，即s指數(shù)收斂，位置誤差e和速度誤差指數(shù)收斂。
3 仿真結(jié)果與分析
a 末端節(jié)點(diǎn)的位置跟蹤
b 末端節(jié)點(diǎn)的速度跟蹤
c 控制輸入Fx和M
d 軌跡跟蹤效果
a 末端節(jié)點(diǎn)的位置跟蹤
b 末端節(jié)點(diǎn)的速度跟蹤
c 控制輸入Fx和M
d 軌跡跟蹤效果
4 結(jié)束語
針對(duì)機(jī)器人跟蹤控制器存在的問題，以加快誤差收斂速度和降低抖振、改善趨近運(yùn)動(dòng)的動(dòng)態(tài)品質(zhì)作為優(yōu)化目標(biāo)，提出了改進(jìn)指數(shù)趨近律的設(shè)計(jì)思想和方法，給出了基于飽和函數(shù)的改進(jìn)型雙冪次趨近律滑模控制策略，解決了以往控制器啟動(dòng)輸出力矩大、跟蹤速度慢，典型趨近律滑模控制力矩輸出存在抖振等問題，使軌跡跟蹤的誤差收斂速度和抑制切換抖振達(dá)到最佳。改進(jìn)的控制律使系統(tǒng)相狀態(tài)可根據(jù)與切換面距離，自適應(yīng)地調(diào)節(jié)主導(dǎo)趨近規(guī)律，從而使系統(tǒng)具有良好的魯棒性和控制精確度，同時(shí)有效地消除了抖振。為進(jìn)一步研究滑?？刂圃诘芽柨臻g下機(jī)械手末端位置跟蹤的應(yīng)用提供了參考。
[1] 高為炳. 變結(jié)構(gòu)控制的理論及設(shè)計(jì)方法[M]. 北京: 科學(xué)出版社, 1996.
[2] 盛 嚴(yán), 王 超, 陳建斌， 等. 結(jié)構(gòu)滑模控制的一種指數(shù)趨近律方法[J]. 噪聲與振動(dòng)控制, 2002， 8(4)： 31-35.
[3] YU S H, YU X H, SHI R B, et al. Continuous finite-time control for robotic manipulators with terminal sliding mode[J]. Automatica, 2005, 41(11): 1957-1964.
[4] JIANG K, ZHANG J G, CHEN Z M. A new approach for the sliding mode control based on fuzzy reaching law[C]// Proceedings of the 4th World Congress on Intelligent Control and Automation, China: Shanghai, 2002: 656-660.
[5] BANDYOPADHYAY B, FULWANI D, PARK Y J. A robust algorithm against actuator saturation using integral sliding mode and composite non-linear feedback[C]// Processdings of the 17th IFAC World Congress. COEX, Korea, South: IFAC, 2008: 14174-14179.
[6] 梅 紅, 王 勇. 快速收斂的機(jī)器人滑模變結(jié)構(gòu)控制[J]. 信息與控制, 2009, 38(5): 552-557.
[7] 李 鵬, 馬建軍, 鄭志強(qiáng), 等. 采用冪次趨近律的滑?？刂品€(wěn)態(tài)誤差界[J]. 控制理論與應(yīng)用, 2011, 28(5): 619-624.
[8] 姜 君, 陳慶偉, 郭 健, 等. 基于新型趨近律的動(dòng)中通系統(tǒng)滑模穩(wěn)定跟蹤控制[J]. 控制與決策, 2011, 26(12): 1904-1908.
[9] 徐 杰, 柴發(fā)武. 基于改進(jìn)趨近律的機(jī)械臂非奇異終端滑?？刂芠J]. 黑龍江科技大學(xué)學(xué)報(bào), 2016, 26(2)： 192-196.
[10] 翟偉娜, 葛運(yùn)旺, 宋書中, 等. 基于改進(jìn)趨近律的機(jī)械手滑模控制[J]. 信息與控制, 2014, 43(3): 300-305.
[11] 張 瑤, 馬廣富, 郭延寧, 等. 一種多冪次滑模趨近律設(shè)計(jì)與分析[J]. 自動(dòng)化學(xué)報(bào), 2016, 42(3): 466-471.
[12] 蔡自興, 謝 斌. 機(jī)器人學(xué)[M]. 北京: 清華大學(xué)出版社, 2015.
[13] 大熊繁. 機(jī)器人控制入門[M]. 盧伯英， 譯. 北京： 科學(xué)出版社， 2002.
[14] 劉金琨. RBF神經(jīng)網(wǎng)絡(luò)自適應(yīng)控制MATLAB仿真[M]. 北京： 清華大學(xué)出版社， 2014： 175-182.
[15] FENG Y, YU X H, MAN Z H. Non-singular terminal sliding mode control of rigid manipulators[J]. Automatica, 2002, 38(12): 2159-2167.
[16] TAO C W, TAUR J S, CHAN M L. Adaptive fuzzy terminal mode controller for linear systems with mismatch time-varying uncertainties feng [J]. IEEE Transactions on Systems, 2004, 34(1): 255-262.
[17] KARAYIANNIDIS Y, ROVITHAKIS G, DOULGERI Z. Force position tranking for a robotic manipulator in comliant contact with a surface using neuro-adaptive control[J]. Automtica,2007, 43(10): 1281-1288.
(編校 李德根)
Study on trajectory of manipulators end-effector based on sliding mode algorithm in task space
ShenXianqing1，ZhengJunxiang1，TangWei1,WangMingjie2,LiuJihong3
(1.School of Electrical & Control Engineering, Heilongjiang University of Science & Technology, Harbin 150022, China；2. Harbin Coal Mine Mechanical Research Institute, Heilongjiang University of Science & Technology, Harbin 150036, China； 3. Automatic Test & Control Institute, Harbin Institute of Technology, Harbin 150022, China)
This paper presents a novel design approach for sliding mode control law based on an improved double power exponential reaching law——a method aimed at improving the trajectory tracking performance of industrial robot as a viable solution to the drawbacks inherent in traditional controllers, such as a higher starting output torque, a lower error convergence speed and chattering. The research building on the dynamics equations in task space coordinates involves improving exponential reaching law and applying the double power exponential reaching law with the saturation function for designing a terminal sliding mode controller; and thereby achieving the direct control of end-effector’s trajectory in task space. The study is validated by the simulation experiment under the environment of Simulink and subsequent comparison of the control effects of different controllers under two reaching laws. The results demonstrate that this proposed method may provide a control system with a better robustness, a greater control precision, and an effective chattering reduction.
robot; sliding mode control; reaching law; trajectory tracking
2016-10-17
黑龍江省教育廳科學(xué)技術(shù)研究項(xiàng)目(12541697)
沈顯慶(1969-)，男，吉林省通化人，教授，博士，研究方向：先進(jìn)伺服系統(tǒng)與智能控制，E-mail:shenxianqing2001@163.com。
10.3969/j.issn.2095-7262.2016.06.019
TP273
2095-7262(2016)06-0681-06
:A
猜你喜歡
讀友·少年文學(xué)(清雅版)(2020年4期)2020-08-24
讀友·少年文學(xué)(清雅版)(2020年3期)2020-07-24
中國慣性技術(shù)學(xué)報(bào)(2019年6期)2019-03-04
制造技術(shù)與機(jī)床(2018年11期)2018-11-23
現(xiàn)代裝飾(2018年5期)2018-05-26
河北農(nóng)機(jī)(2017年12期)2018-01-20
北京航空航天大學(xué)學(xué)報(bào)(2017年4期)2017-11-23
制造技術(shù)與機(jī)床(2017年4期)2017-06-22
中國三峽(2017年2期)2017-06-09
