劉 霞,陳 勇
?
一類具有多種不確定性機器人系統(tǒng)的自適應控制
劉 霞1,陳 勇2
(1. 西華大學電氣信息學院 成都 610039;2. 電子科技大學能源科學與工程學院 成都 611731)
機器人系統(tǒng)含有不同類型的不確定性因素,這些因素的存在可能會影響系統(tǒng)的控制精度,甚至引起系統(tǒng)不穩(wěn)定。針對具有外部干擾、內部動力學參數(shù)不確定性以及未知死區(qū)特性的一類不確定性機器人系統(tǒng),提出了一種基于干擾觀測器的自適應控制器。首先建立具有外部干擾的機器人系統(tǒng)非線性數(shù)學模型,并對模型中內部動力學參數(shù)不確定性和未知死區(qū)特性進行了分析。采用非線性干擾觀測器對系統(tǒng)所受到的外部干擾進行估計和補償,在干擾觀測器的基礎上設計自適應控制器用來處理內部動力學參數(shù)的不確定性以及未知的死區(qū)特性。最后采用李雅譜諾夫函數(shù)法從理論上證明了系統(tǒng)的穩(wěn)定性和位置跟蹤誤差的收斂性,并采用數(shù)值仿真驗證了所設計方法的有效性。
自適應控制; 動力學不確定性; 外部干擾; 機器人系統(tǒng); 未知死區(qū)
機器人系統(tǒng)含有不同類型的不確定性因素[1],如參數(shù)不確定性(如機器人連桿質量、連桿長度等物理量未知)和外部干擾(如所處的作業(yè)環(huán)境干擾、摩擦、負載擾動等)。上述不確定性的存在可能會影響系統(tǒng)的控制精度,甚至引起系統(tǒng)不穩(wěn)定,因此需要設計恰當?shù)目刂品桨敢员WC系統(tǒng)的穩(wěn)定性和位置跟蹤性能。
在各種控制策略中,自適應控制是處理不確定性機器人系統(tǒng)的一種有效方法,它對結構已知而參數(shù)未知的對象具有很好的控制效果,因此在不確定性機器人系統(tǒng)的控制中得到了廣泛的應用。這方面創(chuàng)始性的且最有影響力的是文獻[2-4]的工作。近年來,又出現(xiàn)了一些關于機器人的新型自適應控制算法[5-6]。對于機器人位置軌跡的跟蹤,文獻[5]針對機器人模型中的動力學和運動學參數(shù)不確定性,提出了一種基于近似雅可比的自適應控制方法。文獻[6]提出了一個自適應控制器以補償機器人模型中的線性化和非線性參數(shù)不確定性。但是需要指出的是,自適應控制的本質基于動力學模型,它對非參數(shù)的不確定性,如外部干擾的抑制效果不是很理想。
干擾觀測器可以彌補自適應控制的不足,對不可預測的或隨機的外部干擾具有很好的抑制效果。非線性干擾觀測器的控制方案也已經在機器人控制領域得到了廣泛地應用[7-8]。文獻[7]針對具有不確定干擾的兩連桿機器人系統(tǒng)設計了一種非線性干擾觀測器,通過選擇合適的設計參數(shù)使干擾觀測器的指數(shù)漸近穩(wěn)定性可以得到保證,該干擾觀測器可用于機器人系統(tǒng)中的摩擦補償、獨立關節(jié)控制、無傳感器轉矩控制以及故障診斷。文獻[8]對文獻[7]的工作進行了擴展,提出了一種可用于連桿機器人系統(tǒng)的非線性干擾觀測器。但上述這些已有的干擾觀測器方法中都沒有考慮機器人系統(tǒng)中可能含有的未知死區(qū)特性。
結合自適應控制器和干擾觀測器的各自優(yōu)點,本文設計了一種基于干擾觀測器的自適應控制器,處理具有外部干擾、內部動力學參數(shù)不確定性以及未知死區(qū)特性的一類不確定機器人系統(tǒng)。其中,非線性干擾觀測器對外部干擾進行估計和補償,自適應控制器則處理內部不確定的動力學參數(shù)和未知的死區(qū)特性。
當考慮外部干擾時,-自由度機器人的關節(jié)空間非線性動力學為[9]:
性質1[10]慣量矩陣是對稱正定的。
性質2[10]式(1)左邊的項關于動力學參數(shù)向量是線性的,即:
機器人系統(tǒng)式(1)除了受到外部干擾的影響,還可能受到內部動力學參數(shù)不確定性的影響。當系統(tǒng)中存在動力學參數(shù)不確定性時,利用性質2,式(1)的左邊變?yōu)椋?/p>
本文所設計的基于干擾觀測器的自適應控制方案的結構如圖1所示。
圖1 不確定機器人系統(tǒng)基于干擾觀測器的自適應控制框圖
2.1 非線性干擾觀測器的設計
本文在文獻[7]工作基礎上,對受到外部干擾的機器人系統(tǒng)式(1)設計非線性干擾觀測器為:
(4)
將動力學方程式(1)代入上面的非線性干擾觀測器式(4)中,則得到干擾觀測誤差的動力學為:
(6)
2.2 自適應控制器的設計
采用干擾觀測器對外部干擾進行估計后,可以設計自適應控制器對內部不確定的動力學參數(shù)和未知死區(qū)進行處理。死區(qū)是一種典型的非線性特性,廣泛存在于機器人系統(tǒng)中,尤其是機器人的關節(jié)處,會嚴重影響系統(tǒng)的跟蹤精度。文獻[12]針對一類具有死區(qū)的非線性系統(tǒng)提出了一種自適應控制方法以滿足系統(tǒng)全局穩(wěn)定性和期望的跟蹤精度。本文在設計自適應控制器的過程中,對文獻[12]的方法進行擴展,具體應用到機器人系統(tǒng)中,并且進一步考慮該機器人系統(tǒng)受外部干擾的情形。在式(1)的兩邊同時乘以,得:
(7)
式(7)又可以改寫為:
對于死區(qū)模型式(3),可以改寫成如下形式[12]:
式中,
(10)
其中,
(12)
再將式(10)代入式(12)得:
(13)
在引入控制律之前,還需要定義以下一些變量:
,
,
控制律為:
動力學參數(shù)自適應律為:
死區(qū)參數(shù)自適應律為:
(16)
將式(14)代入式(13),并利用干擾觀測誤差的動力學式(5),得到機器人系統(tǒng)的閉環(huán)方程為:
(17)
定理 1 考慮非線性機器人系統(tǒng)式(1)同時受外部干擾、部動力學參數(shù)不確定性、未知死區(qū)特性的影響,如果通過干擾觀測器式(4)、自適應控制器式(14)~式(16)進行控制,則信號、、有界,且當時,系統(tǒng)的位置跟蹤誤差趨向于零。
證明:考慮如下李亞普諾夫函數(shù):
(19)
再將式(15)~式(17)代入式(19) 得:
(20)
(21)
(23)
對式(23)兩邊同時積分可以得到:
把設計的基于干擾觀測器的自適應控制方法在1-DOF單連桿的機器人系統(tǒng)中進行仿真,結構如圖2所示[14]。
圖2 單連桿機器人結構
在仿真過程中,還將本文所設計的基于干擾觀測器的自適應控制器的效果與無干擾觀測器的自適應控制效果進行了比較,無干擾觀測器的自適應控制器為:
最后的仿真結果如圖3~圖5所示。
a. 位置軌跡跟蹤
b. 位置軌跡跟蹤誤差
圖3 無干擾觀測器的自適應控制效果
a. 位置軌跡跟蹤
b. 位置軌跡跟蹤誤差
圖4 基于干擾觀測器的自適應控制效果
a. 干擾觀測
b. 干擾觀測誤差
圖5 干擾觀測器效果
從圖4可以看到,采用本文所設計的基于干擾觀測器的自適應控制器,機器人的位置和期望的位置彼此之間相當接近,當時,,這恰好與定理1的結論相吻合。相比之下,從圖3可以看到,當不采用干擾觀測器進行控制時,機器人系統(tǒng)的位置軌跡跟蹤誤差明顯更大。出現(xiàn)該結果的原因在于本文不但設計了干擾觀測器可以對未知的外部干擾進行觀測補償,而且在干擾觀測器基礎上設計的自適應控制器可以處理內部不確定的動力學參數(shù)和未知的死區(qū)特性,進一步確保了系統(tǒng)良好的位置跟蹤性能和穩(wěn)定性。從圖5還可以看到,干擾估計值收斂于實際的干擾,該仿真結果恰好與觀測器漸進穩(wěn)定的結論式(6)相吻合。綜上,仿真結果與理論部分的結果相一致。
本文針對同時受到外部干擾、內部動力學參數(shù)不確定性和未知死區(qū)特性的遙操作系統(tǒng),提出了一種基于干擾觀測器的自適應控制方案。所設計方法的有效性通過數(shù)學推導和數(shù)值仿真得到證明和驗證。在此基礎上,如何考慮其他更為復雜的非線性因素如齒隙、磁滯等,從而系統(tǒng)地形成一套不確定性機器人系統(tǒng)基于干擾觀測器的自適應控制算法將作為下一步的研究內容。
[1] 劉金琨. 機器人控制系統(tǒng)的設計與MATLAB仿真[M]. 北京: 清華大學出版社, 2008.
LIU Jin-kun. Design and MATLAB simulations of robotic control systems[M]. Beijing: Tsinghua University Press, 2008.
[2] CRAIG J J, HSU P, SASTRY S S. Adaptive control of mechanical manipulators[J]. The International Journal of Robotics Research, 1987, 6(2): 16-28.
[3] SLOTINE J J E, LI W. On the adaptive control of robot manipulators[J]. The International Journal of Robotics Research, 1987, 6(3): 49-59.
[4] SPONG M W, ORTEGA R. On adaptive inverse dynamics control of rigid robots[J]. IEEE Transactions on Automatic Control, 1990, 35(1): 92-95.
[5] CHEAH C C, LIU C, SLOTINE J J E. Adaptive tracking control for robots with unknown kinematic and dynamic properties[J]. The International Journal of Robotics Research, 2006, 25(3): 283-296.
[6] HUNG N V Q, TUAN H D, NARIKIYO T, et al. Adaptive control for nonlinearly parameterized uncertainties in robot[J]. IEEE transactions on control systems technology, 2008, 16(3): 458-468.
[7] CHEN W H, BALANCE D J, GAWTHROP P J, et al. A nonlinear disturbance observer for robotic manipulators[J]. IEEE Transactions on Industrial Electronics, 2000, 47(4): 932-938.
[8] NIKOOBIN A, HAGHIGHI R. Lyapunov-based nonlinear disturbance observer for serial n-link robot manipulators[J]. IEEE Transactions on Industrial Electronics, 2009, 55(2-3): 135-153.
[9] 劉霞, 黃琦, 陳勇. 不確定遙操作系統(tǒng)帶干擾觀測器的自適應控制[J]. 控制理論與應用, 2012, 29(5): 681-687.
LIU Xia, HUANG Qi, CHEN Yong. Adaptive control of uncertain teleoperation systems with disturbance observer[J]. Control Theory & Applications 2012, 29(5): 681-687.
[10] KELLY R, SANTIBANEZ V, LORIA A. Control of robot manipulators in joint space[M]. Berlin, Germany: Springer, 2005.
[11] TAO G, KOKOTOVIC P V. Adaptive control of systems with actuator and sensor nonlinearities[M]. New York: Wiley, 1996.
[12] WANG X, SU C, HONG H. Robust adaptive control of a class of nonlinear systems with unknown dead-zone[J]. Automatica, 2004, 40(3): 407-413.
[13] SLOTINE J J E, LI W. Applied Nonlinear Control[M]. Englewood Cliffs, USA: Prentice-Hall, 1991.
[14] CRRADINI M L, ORLANDO G, PARLANGELI G. A VSC approach for the robust stabilization of nonlinear plants with uncertain nonsmooth actuator nonlinearities-a unified framework[J]. IEEE Transactions on Automatic Control, 2004, 49(5): 807-812.
編 輯 漆 蓉
Adaptive Control for a Class of Robotic Systems with Multiple Uncertainties
LIU Xia1and CHEN Yong2
(1.School of Electrical and Information Engineering, Xihua University Chengdu 610039; 2. School of Energy Science and Engineering, University of Electronic Science and Technology of China Chengdu 611731)
Robotic systems suffer from different types of uncertainties which may affect the system control accuracy and even cause the system unstable. In this paper, for a class of uncertain robotic systems with external disturbance, internal dynamic parametric uncertainty and unknown dead-zone, an adaptive controller based on disturbance observer is proposed. First, the nonlinear mathematical model of robotic systems subject to external disturbance is established and the internal dynamic parametric uncertainty and unknown dead-zone in the system are analyzed. Then nonlinear disturbance observer is employed to estimate and compensate for the external disturbance. Based on the disturbance observer, an adaptive controller is then designed to deal with the uncertain dynamic parameters and unknown dead-zone. Finally, the stability and the convergence of the position tracking error of the system are proved via Lyapunov function analysis. Digital simulations demonstrate the validity of the proposed approach.
adaptive control; dynamic uncertainty; external disturbance; robotic systems; unknown dead-zone
TP273
A
10.3969/j.issn.1001-0548.2015.01.010
2014-05-02;
2014-11-02
國家自然科學基金(61305104);四川省科技支撐計劃(2013GZX0152)
劉霞(1980-),女,博士,副教授,主要從事機器人和遙操作、非線性系統(tǒng)、自適應控制方面的研究.