方世鵬 胡昌華 扈曉翔 武志輝

摘 要：針對飛行器擺動噴管電動伺服系統(tǒng)在低氣壓高溫升條件下的控制問題，提出一種復(fù)合控制方法?；贚uGre模型對伺服系統(tǒng)的復(fù)雜負(fù)載力矩進(jìn)行建模，利用狀態(tài)觀測器和兩個dual觀測器推導(dǎo)出負(fù)載力矩參數(shù)自適應(yīng)律，以期實現(xiàn)對負(fù)載力矩隨外界條件變化時的擬合。采用自適應(yīng)反步終端滑模算法，負(fù)載力矩估計值進(jìn)行虛擬力矩補償，同時解決控制電壓與力矩干擾之間不匹配、電機電壓擾動及參數(shù)變化的問題，理論分析證明所提控制算法對于匹配及非匹配不確定性都具備魯棒性，能夠保證跟蹤誤差最終一致有界。最后通過仿真及實驗，驗證了所提方法的有效性。

關(guān)鍵詞：擺動噴管；永磁同步電機；負(fù)載建模；自適應(yīng)滑模；反步法

中圖分類號：TP 29

文獻(xiàn)標(biāo)志碼：A

文章編號：1007-449X（2018）04-0113-08

Abstract：A composite control method is proposed for the high precision position control of motor servo systems of aircraft gimbaled nozzle. The complicate load was modeled based on the LuGre model. By using a state observer and two dual observers， the adaptive law of load model parameters was derived in order to approximate the real load which was changed with the change of working condition. The estimation of load torque was to compensate the virtual torque. The control input voltages were obtained through the adaptive backstepping terminal sliding mode control method with the virtual torque. The mismatch between the control voltages and torque disturbance， the voltage disturbance and the parameter variation of the motor were disposed by the proposed control method. The theoretical analysis proves that the proposed control algorithm is robust to the matched and unmatched uncertainties. The uniformly ultimately bounded convergence of tracking error can be guaranteed. Finally， simulations and experiments verify the effectiveness of the proposed method.

Keywords：gimbaled nozzle； permanent magnet synchronous motor； load modeling； adaptive sliding mode control； backstepping

0 引 言

推力矢量控制是一種通過控制主推力相對飛行器軸的偏轉(zhuǎn)產(chǎn)生改變飛行器姿態(tài)所需力矩的控制技術(shù)，它不依賴于氣動力，從而在低速高空時仍能產(chǎn)生較大的控制力矩，同時推力損失小，燃?xì)鈩恿ζ焚|(zhì)優(yōu)良[1]，因此在飛行器中得以大量應(yīng)用。推力矢量控制有很多種方法，擺動噴管推力矢量控制方法因其具有較好的方向性和簡單的結(jié)構(gòu)形式而被廣泛采用。

推動噴管改變主推力方向需要一套伺服系統(tǒng)作為執(zhí)行機構(gòu)，伺服系統(tǒng)推動噴管時還需克服復(fù)雜的大負(fù)載力矩[2]，為了滿足大推力要求，以往通常采用液壓伺服系統(tǒng)。由于PID算法結(jié)構(gòu)簡單，利于實現(xiàn)，因此工程應(yīng)用中大多采用PID 控制算法控制液壓伺服系統(tǒng)以獲得滿意的噴管控制性能[3]，但是PID算法魯棒性較差、參數(shù)整定困難、對系統(tǒng)參數(shù)變化和干擾敏感等缺點限制了控制性能的提升。文獻(xiàn)[4]研究了擺動噴管電液伺服系統(tǒng)的終端滑?？刂品椒ǎ捎酶蓴_觀測器（disturbance observer，DOB）觀測外部力矩變化并進(jìn)行前饋補償，取得了較好的控制效果。液壓系統(tǒng)維護成本高，液壓油泄露容易造成污染等問題隨著飛行器長時間儲存和工作顯得非常突出，與此同時，以高性能永磁體材料誕生為基礎(chǔ)，迎來了電動機的飛速發(fā)展時期，永磁同步電機等體積小、力矩大、效率高的電動機[5]，被越來越多的使用在高性能的驅(qū)動機構(gòu)中，電動伺服系統(tǒng)克服了液壓系統(tǒng)需要設(shè)計和維護復(fù)雜油路的不足，加之現(xiàn)代數(shù)字控制技術(shù)和電力技術(shù)的飛速發(fā)展也能允許更為復(fù)雜的控制算法，使得電動伺服系統(tǒng)逐步向大推力領(lǐng)域不斷滲透。一些學(xué)者利用魯棒PID控制器結(jié)合bang-bang控制算法對電動伺服系統(tǒng)進(jìn)行控制[6]，開啟了擺動噴管高精度電動伺服系統(tǒng)先進(jìn)控制算法的研究先例，但是文中做了較多的線性近似，且無法避免PID算法的不足。

本文以永磁同步電機（permanent magnet synchronous motor， PMSM）電動伺服系統(tǒng)作為擺動噴管的執(zhí)行機構(gòu)，研究低氣壓、高溫升條件下如何提高擺動噴管的控制性能。以LuGre（Lund-Grenoble）模型為基礎(chǔ)對伺服系統(tǒng)的負(fù)載力矩進(jìn)行建模，同時考慮溫度升高導(dǎo)致的負(fù)載力矩模型參數(shù)變化，利用狀態(tài)觀測器和dual觀測器推導(dǎo)參數(shù)自適應(yīng)律，并將負(fù)載力矩估計值用于虛擬力矩補償，針對控制電壓與擾動力矩的不匹配，及電動伺服系統(tǒng)本身的不確定性等問題，結(jié)合反步法和自適應(yīng)控制方法，利用終端滑?？刂扑惴óa(chǎn)生控制電壓，理論分析證明了所得控制電壓對于匹配及非匹配不確定性均具有強魯棒性。最后的仿真及實驗結(jié)果表明，所提算法對于擺動噴管電動伺服系統(tǒng)具有良好的控制性能。

1 系統(tǒng)建模

如圖1所示的飛行器擺動噴管伺服系統(tǒng)，噴管在伺服作動器的作用下實現(xiàn)偏擺，從而控制飛行器的偏航和俯仰姿態(tài)，整個伺服作動器按照上位機的指令動作，實際上是一類位置跟蹤系統(tǒng)。

1.1 負(fù)載力矩建模

系統(tǒng)負(fù)載力矩[2]是以摩擦力矩為主，位置力矩、慣性力矩、阻尼力矩和偏心力矩共同組合而成的復(fù)雜負(fù)載形式。摩擦的強非線性特征及其復(fù)雜的產(chǎn)生機理至今尚未被完全描述清楚，但是可以對其隨速度和位置的變化情況進(jìn)行經(jīng)驗建模， LuGre摩擦模型[7]因其能描述摩擦的大部分動態(tài)特征而被廣泛應(yīng)用，LuGre利用一個內(nèi)部摩擦狀態(tài)（鬃毛的平均變形z（t））來描述摩擦力

1.2 永磁同步電機伺服系統(tǒng)模型

作動器為永磁同步電機驅(qū)動的伺服系統(tǒng)，若PMSM為隱極式，磁路不飽和，氣隙磁場為正弦分布，忽略磁滯和渦流損耗影響，定子為三相對稱繞組，可以建立d-q坐標(biāo)系下的動力學(xué)方程如下式所示[8]

4 數(shù)值仿真與實驗

對文中提出的負(fù)載力矩模型自適應(yīng)特性以及控制規(guī)律進(jìn)行數(shù)值仿真和實驗，首先檢驗狀態(tài)觀測器、兩個摩擦觀測器以及由此導(dǎo)出的負(fù)載力矩模型參數(shù)自適應(yīng)律的性能。

4.1 負(fù)載力矩模型的自適應(yīng)特性

基于誤差系統(tǒng)（5）設(shè)計數(shù)字仿真實驗，來檢驗基于觀測器提出的負(fù)載力矩模型的自適應(yīng)特性。仿真實驗框圖如圖2所示。

參考輸入信號δr=1sint，取J=1 kg·m2，利用PID控制器建立閉環(huán)系統(tǒng)，PID參數(shù)為KP=10、KI=5、KD=6。模擬真實負(fù)載力矩采用式（2），假設(shè)負(fù)載力矩的參數(shù)隨著環(huán)境因素在逐漸變化，在3個時間區(qū)間里，各個參數(shù)的取值如表1所示，表中各個參數(shù)σ0、σ1、σ2、kδ、Tp、Fs、Fc的單位分別為N·m/rad、N·ms/rad、N·ms/rad、N·m/rad、N·m、N·m、N·m，ωs取為0.001 rad/s，并設(shè)置擾動力矩為Ta=0.01sint。

負(fù)載力矩的估計值都沒有進(jìn)行前饋補償，兩種方法的負(fù)載力矩估計值如圖3所示，從圖中可以看出，兩種方法都能跟蹤負(fù)載力矩的變化情況，就快速性而言，擾動觀測器在20 s和40 s時應(yīng)對負(fù)載力矩突變時要更迅速一些，這是與兩者的機理相吻合的，擾動觀測器的響應(yīng)速度取決于其帶寬，而自適應(yīng)只能處理慢時變問題。同時從圖4負(fù)載力矩擬合誤差可知，本文的方法的誤差要稍大一些，這是因為擾動力矩并沒有包含在模型中，且靜摩擦力和庫侖摩擦力的變化是通過調(diào)整其他參數(shù)來適應(yīng)的。然而擾動觀測器有一個非常突出的不足，當(dāng)它觀測含摩擦力矩的負(fù)載力矩時，由于速度過零時的負(fù)載力矩變化非常快，受限于其帶寬，導(dǎo)致擾動觀測器無法觀測到這種快速的變化，因此會出現(xiàn)圖4中類似沖擊一樣的負(fù)載力矩誤差，這種突變的力矩沖擊對于控制系統(tǒng)補償是非常不利的。本文所提的方法由于采用了動態(tài)摩擦模型，因此可以對速度過零時的負(fù)載力矩進(jìn)行比較好的擬合，克服了擾動觀測器帶來的不足。未來將兩種方法相結(jié)合，達(dá)到較為快速的辨識出負(fù)載力矩同時保持一定的辨識精度，是可以考慮的一個方向。

通過仿真還可以發(fā)現(xiàn)，投影算式（12）、式（14）是非常關(guān)鍵的，它相當(dāng)于一種自適應(yīng)關(guān)閉機制，保證負(fù)載模型參數(shù)收斂到一定范圍內(nèi)。由于所有的負(fù)載模型參數(shù)都是依靠狀態(tài)觀測誤差ζ來驅(qū)動的，因此若是自適應(yīng)參數(shù)γ0、γ1、γ2、γ3、γ4、γ5、γ6選擇不當(dāng)，則θ中各個參數(shù)收斂速度不同，極有可能出現(xiàn)參數(shù)失控，引發(fā)振蕩等問題，從而導(dǎo)致模型不收斂。圖5為沒有采用投影算式，γ0、γ1、γ2、γ3、γ4、γ5、γ6取值為1，1，100，100，100，100，100時的負(fù)載力矩圖，可以看出模型負(fù)載力矩已經(jīng)不能擬合模擬真實負(fù)載力矩了。

4.2 實驗結(jié)果

搭建了以PMSM為動力裝置的擺動噴管伺服系統(tǒng)實驗平臺。制作的仿真噴管，其慣量和尺寸與真實噴管的大小相同，為了模擬復(fù)雜的負(fù)載力矩特性，采用負(fù)載模擬器來獲取接近于真實情況的負(fù)載力矩?？刂破?、放大器等電子控制器件與滾珠絲杠等機械傳動部件一起集成在作動器中。

為驗證本文所提的負(fù)載力矩模型和伺服控制策略的有效性，同時減小伺服控制器的計算量和保證算法實時性，此處采用上位機和伺服控制器相結(jié)合的控制策略，基于觀測器的負(fù)載力矩估計依靠上位機來完成，控制電壓生成、坐標(biāo)系轉(zhuǎn)換、和SVPWM等依靠下位機來完成，上位機和下位機通過通信模塊完成信息通信。本文中計算控制律時利用差分計算式（25）中的i·*q，因此式（24）中雙曲函數(shù)可以用飽和函數(shù)代替，同時也降低了計算量。負(fù)載力矩模型各參數(shù)的初值利用穩(wěn)態(tài)辨識技術(shù)[14]進(jìn)行粗略辨識。為了分析對比，采用矢量控制方法和三閉環(huán)PID結(jié)合的控制策略對伺服系統(tǒng)進(jìn)行控制。圖6為兩種控制方法在跟蹤斜坡響應(yīng)信號時的跟蹤曲線，可以看出，低速時PID控制會出現(xiàn)較為明顯的低速爬坡現(xiàn)象，本文所提方法較好地克服了這一問題。

圖7為跟蹤信號δr=40sin4t時的跟蹤誤差曲線，從圖中以看出本文方法顯著降低了跟蹤誤差，提高了控制精度。為了檢驗PMSM在參數(shù)Rs、Ls變化時本文方法的有效性，控制律（25）中參數(shù)Rs，Ls初值設(shè)置為不同于電機標(biāo)稱值的數(shù)值，圖8顯示了跟蹤信號δr=40sin4t時的誤差曲線，可以看到參數(shù)Rs、Ls快速突變時的影響可以通過本文的魯棒自適應(yīng)方法進(jìn)行補償，經(jīng)過3s左右的時間跟蹤誤差便能減小到合理區(qū)間。

5 結(jié) 論

對飛行器擺動噴管電動伺服系統(tǒng)高性能控制算法進(jìn)行研究。針對復(fù)雜的負(fù)載力矩形式，以及低氣壓、高溫升環(huán)境下系統(tǒng)參數(shù)變化帶來的不確定等問題，提出了一種復(fù)合控制策略，并進(jìn)行了仿真和實驗。結(jié)果表明，所提控制方法能較好的補償摩擦為主的負(fù)載力矩變化，克服傳統(tǒng)三閉環(huán)PID控制導(dǎo)致的低速爬坡現(xiàn)象，且在匹配和非匹配不確定性條件下能取得良好的控制效果。本文的負(fù)載力矩估計是在上位機完成的，實際飛行器飛行中，所有的計算都必須由伺服控制器完成，這對于控制器的計算壓力非常大，如何提高算法的實時性將是下步研究的重點。

參 考 文 獻(xiàn)：

[1] 朱學(xué)平，祁鵬，張曉峰，等.擺動噴管控制導(dǎo)彈魯棒飛行控制系統(tǒng)設(shè)計[J].固體火箭技術(shù)，2013，36（4）：427.

ZHU Xueping， QI Peng， ZHANG Xiaofeng，et al. Design of robust autopilot control system for missile with movable nozzle thrust vector controlling [J]. Journal of Solid Rocket Technology， 2013， 36（4）： 427.

[2] 劉宏博，周軍，周鳳岐.推力矢量控制伺服系統(tǒng)的負(fù)載及負(fù)載匹配[J].彈箭與制導(dǎo)學(xué)報，2006，26（2）：740.

LIU Hongbo， ZHOU Jun， ZHOU Fengqi. The load and load matching of servo system for thrust vector control [J]. Journal of Projectiles， Rockets， Missiles and Guidance， 2006， 26（2）： 740.

[3] Dragan V.Lazic'， Milan R. Ristanovic'. Electrohydraulic thrust vector control of twin rocket engines with position feedback via angular transducers[J]. Control Engineering Practice， 2007， 15（5）：583.

[4] 王衛(wèi)紅，孫良樺，張武龍. 擺動噴管的Terminal滑模魯棒控制[J]. 電機與控制學(xué)報，2014，18（5）：7.

WANG Weihong， SUN Lianghua， ZHANG Wulong. Terminal sliding mode robust control for swing nozzle [J]. Electric Machines and Control， 2014， 18（5）：7.

[5] Jesús Linares-Flores， Carlos García-Rodríguez，Hebertt Sira-Ramírez，et al. Robust backstepping tracking controller for low-speed PMSM positioning system： design， analysis， and implementation[J]. IEEE Transactions on Industrial Informatics， 2015， 11（5）：1130.

[6] LI Y， LU H， TIAN S， et al. Posture control of electromechanical-actuator-based thrust vector system for aircraft engine[J]. IEEE Transactions on Industrial Electronics， 2012， 59（9）：3561.

[7] C.Canudas de Wit， H. Olsson， K. J. Astrom，et al. A new model for control of systems with friction[J]. IEEE Trans. Autom. Control， 1995， 40（3）： 419.

[8] YU Jinpeng， SHI Peng， DONG Wenjie， et al. Neural network-based adaptive dynamic surface control for permanent magnet synchronous motors[J]. IEEE Transactions on Neural Networks and Learning Systems， 2015， 26（3）：640.

[9] W J CHEN， K KONG， M TOMIZUKA. Dual-stage adaptive friction compensation for precise load side position tracking of indirect drive mechanisms[J]. IEEE Trans. on Contr. Systems Technology， 2015， 23（1）：164.

[10] YAO B， BU F， REEDY J， et al. Adaptive robust motion control of single-rod hydraulic actuators： Theory and experiments[J]. IEEE/ASME Transactions on Mechatronics.，2000， 5（1）：79.

[11] L XU， B YAO. Adaptive robust control of mechanical systems with nonlinear dynamic friction compensation[J]. International Journal of Control， 2007， 81（2）：167.

[12] 李升波，李克強，王建強，等.非奇異快速的終端滑模控制方法及其跟車控制應(yīng)用[J].控制理論與應(yīng)用，2010，27（5）：543.

LI Shengbo， LI Keqiang， WANG Jianqiang，et al. Nonsingular fast terminal-sliding-mode control method and its application on vehicular following system [J]. Control Theory & Applications， 2010， 27（5）：543.

[13] 王毅，何朕.伺服系統(tǒng)的摩擦補償[J].電機與控制學(xué)報，2013，17（8）：107.

WANG Yi， HE Zhen. Friction compensation for servo systems [J]. Electric Machines and Control，2013， 17（8）：107.

[14] LEE T H，TAN K K，HUANG S. Adaptive friction compensation with a dynamical friction model[J]. IEEE/ASME Transactions on Mechatronics， 2011，16（1）：133.

（編輯：劉素菊）