吳 真，曹東海，熊官送

(北京自動化控制設(shè)備研究所，北京 100074)

0 引言

舵機是飛行器控制系統(tǒng)的重要組成部分，是控制系統(tǒng)中特性復(fù)雜、能耗高、配套數(shù)量多、工作環(huán)境惡劣的子系統(tǒng)，其性能和可靠性對姿態(tài)控制具有決定性的影響，直接決定了飛行器飛行結(jié)果的成敗和精度。在實際飛行過程中，舵偏角的變化和環(huán)境中風(fēng)阻等因素的影響導(dǎo)致舵機承受的鉸鏈力矩變化。文獻(xiàn)[1]采用了自抗擾控制技術(shù)應(yīng)用到電動舵系統(tǒng)中，基本思想是采用PD控制與擴張狀態(tài)觀測器相結(jié)合，取得了理想的控制效果。

在解決復(fù)雜的非線性系統(tǒng)問題時，滑模變結(jié)構(gòu)作為一種綜合方法得到了重視，具有很強的魯棒性，其對系統(tǒng)參數(shù)攝動的不敏感是以控制量的高頻抖動來換取的。系統(tǒng)要求電動舵機能在有限時間內(nèi)跟蹤指令，對于理想的被控對象，通?；？刂芠2]是通過選取合理的滑模面參數(shù)來保證狀態(tài)空間任意位置運動點在有限時間內(nèi)到達(dá)滑模面。針對高精度的伺服系統(tǒng)，實際存在很多的不確定項，且無法準(zhǔn)確得知不確定項的上界。許多學(xué)者們提出了不同的方法對不確定干擾進(jìn)行估計和辨識[3-5]，算法涉及較多參數(shù)，調(diào)參復(fù)雜，實用性不強。文獻(xiàn)[6]提出了使用擴張觀測器估計電機負(fù)載轉(zhuǎn)矩，使電機具有了更好的性能；文獻(xiàn)[7]采用邊界層與低通濾波器技術(shù)的滑?？刂扑惴?，同時對摩擦進(jìn)行建模，在小角度時獲得良好的跟蹤效果，但對系統(tǒng)中的擾動只是假定上界，未能實時估計擾動。

本文針對電動舵機高精度伺服的特點，采用了擴張狀態(tài)觀測器對電動舵機運行中的負(fù)載擾動進(jìn)行實時觀測，提出了將線性擴張狀態(tài)觀測器與滑模變結(jié)構(gòu)控制相結(jié)合，并給出了設(shè)計過程，最后通過仿真和實驗對算法的合理性加以驗證。

1 電動舵機的數(shù)學(xué)模型

電動舵機是控制飛行器舵面偏轉(zhuǎn)的伺服系統(tǒng)，其主要由舵機控制器、功率驅(qū)動、伺服電機、傳動結(jié)構(gòu)和反饋傳感器五部分組成，輸入為舵控指令信號，結(jié)構(gòu)組成如圖1所示。

圖1 電動舵系統(tǒng)結(jié)構(gòu)框圖Fig.1 Structure diagram of electromechanical actuator system

電動舵機控制器接收制導(dǎo)機給定的控制指令和傳感器的反饋信號，計算出脈沖寬度調(diào)制(Pulse Width Modulation，PWM)控制信號。由驅(qū)動器驅(qū)動伺服電機，通過電機驅(qū)動減速傳動機構(gòu)帶動舵面的偏轉(zhuǎn)，舵面偏轉(zhuǎn)角度經(jīng)反饋電位計反饋至控制器形成閉環(huán)控制。

本文所涉及電動舵機經(jīng)簡化所得數(shù)學(xué)模型如圖2所示。

圖2 電動舵系統(tǒng)數(shù)學(xué)模型Fig.2 Mathematical model of electromechanical actuator system

其中：L為電機繞組電感；R為電機繞組電阻；Kt為電機力矩系數(shù)；J為舵機折算到電機軸的總轉(zhuǎn)動慣量；Ki為電機到輸出軸的傳動比；Ke為電機反電動勢系數(shù)；B為電機阻尼系數(shù)；TL為外加負(fù)載。

首先考慮被控對象，在開環(huán)條件下，由結(jié)構(gòu)框圖可以得到控制器輸出到舵偏角的傳遞函數(shù)為：

(1)

電機模型中電氣時間常數(shù)τe=L/R，機電時間常數(shù)τm=JR/(KtKe)，由于其電氣時間常數(shù)和電機阻尼較小，為方便研究，可以忽略，被控對象可以簡化為：

(2)

將簡化后的傳遞函數(shù)轉(zhuǎn)化為微分方程形式，即為：

(3)

此微分方程表示了舵偏角與控制電壓之間的關(guān)系，通過調(diào)節(jié)電壓實現(xiàn)對舵機的控制。

2 滑模變結(jié)構(gòu)控制器

滑模變結(jié)構(gòu)控制[8]是一種非線性控制策略，它的控制特性迫使系統(tǒng)在進(jìn)入滑動模態(tài)時沿著規(guī)定的狀態(tài)軌跡作小幅度、高頻率的運動，與系統(tǒng)的參數(shù)及擾動無關(guān)，滑模面是可設(shè)計的。針對如下被控對象：

(4)

滑模面設(shè)計為：

(5)

其中，c>0且滿足Hurwitz條件,e(t)=θd-θ,θd為期望指令信號。

由于滑模變結(jié)構(gòu)控制存在高頻抖動，為了抑制抖動，本文采用指數(shù)趨近律的方法。

指數(shù)趨近律表達(dá)式為：

(6)

(7)

由式(3)～式(6)可得，舵機的滑模控制律為：

(8)

由于舵機實際運行中存在鉸鏈力矩、伺服電機本身及傳動機構(gòu)間隙等非線性因素，且滑模函數(shù)的未知干擾d無法準(zhǔn)確獲得上界。為了對未知干擾實時估計并進(jìn)行補償，本文提出了采用擴張觀測器的方法對不確定項進(jìn)行補償，把摩擦、負(fù)載等不確定因素等效為干擾進(jìn)行補償。

3 擴張狀態(tài)觀測器

擴張狀態(tài)觀測器(Extended State Observer，ESO)[9]是自抗擾控制器(Active Disturbance Reje-ction Control，ADRC)的核心部分，能對動態(tài)和不確定性的擾動進(jìn)行綜合估計。由于非線性擴展觀測器參數(shù)較多，調(diào)節(jié)復(fù)雜，在實際應(yīng)用中不能通過參數(shù)調(diào)節(jié)快速控制目標(biāo)，所以本文采用線性擴張狀態(tài)觀測器對舵機不確定項進(jìn)行估計[10]。

針對二階被控對象式(3),考慮未知干擾d，轉(zhuǎn)換為狀態(tài)方程形式如下：

(9)

(10)

4 擴張狀態(tài)觀測器與滑模變結(jié)構(gòu)復(fù)合的舵系統(tǒng)控制設(shè)計

本文涉及的電動舵機僅有電位計的反饋信號，采用位置閉環(huán)，其控制結(jié)果框圖如圖3所示。

圖3 基于擴張狀態(tài)觀測器的滑?？刂平Y(jié)構(gòu)圖Fig.3 Structure diagram of the sliding model control based on ESO

其中，ESO為三階擴張狀態(tài)觀測器，輸出的z2速度觀測值作用到滑模變結(jié)構(gòu)控制器，z3是由擴張狀態(tài)觀測器估計的總擾動量，補償?shù)娇刂破鬏敵觥?/p>

在實際舵系統(tǒng)的跟蹤系統(tǒng)中，指令信號的頻率比較低，采樣頻率達(dá)到了2kHz,所以指令信號的速度和加速度可以簡化為零，由此可以得到電動舵機的實際控制器輸出為：

(11)

5 仿真驗證

實驗樣機的電動舵機參數(shù)如表1所示,滑模變結(jié)構(gòu)控制器與擴張狀態(tài)觀測器各參數(shù)如表2所示。

表1 電動舵機參數(shù)

表2 控制器各參數(shù)表

為了比較本文所提出的擴張狀態(tài)觀測器進(jìn)行補償?shù)幕Ｗ兘Y(jié)構(gòu)控制器與常規(guī)滑模變結(jié)構(gòu)控制器的性能，對其進(jìn)行仿真驗證。

在Matlab/Simulink環(huán)境下，建立舵系統(tǒng)仿真模型。給定5V(10°)階躍指令，施加4(N·m)/(°)的彈性負(fù)載，得到的仿真結(jié)果如圖4所示。

仿真結(jié)果表明，給定大角度階躍信號時，常規(guī)滑模變結(jié)構(gòu)控制存在一定的靜差，由于擴張觀測器的存在，對負(fù)載進(jìn)行觀測，補償?shù)娇刂破髦?，可以有效減小靜差，提高控制精度。

6 實驗結(jié)果

為了驗證仿真結(jié)果，在滑?？刂破鞯膮?shù)保持不變的前提下進(jìn)行樣機實驗。在4(N·m)/(°)彈性負(fù)載條件下，通過施加不同舵控指令來研究其控制算法的效果。圖5所示為給定輸入信號1V階躍，得到兩種算法的位置跟蹤曲線。圖6所示為給定輸入5V階躍的響應(yīng)曲線。

圖5 1V帶載階躍響應(yīng)曲線Fig.5 1V step response with load

圖6 5V帶載階躍響應(yīng)曲線Fig.6 5V step response with load

從表3實驗結(jié)果對比可知，系統(tǒng)到達(dá)目標(biāo)位置后未出現(xiàn)超調(diào)現(xiàn)象，帶擴張觀測器的控制算法在小角度帶載情況下與常規(guī)滑?？刂扑惴ㄗ饔眯Ч畈欢?。常規(guī)滑?？刂扑惴ㄗ陨淼目垢蓴_能力足以克服小角度時的負(fù)載擾動量，在大角度時，實驗效果和仿真實驗同樣出現(xiàn)了一定的靜差，而擴張觀測器的作用則是縮小靜差。

表3 實驗結(jié)果對比

圖7所示為小角度時1V，1Hz條件下施加4(N·m)/(°)彈性負(fù)載所得實際電動舵機正弦跟蹤曲線。從圖7中可以看出，本文提出的控制器能在速度過零時，跟蹤誤差明顯減小。圖8所示為實時觀測器的補償控制量，在過零點處補償量最大，折算到控制信號占空比為5.5%。表明了本文提出的方法有效可行，使得電動舵機伺服控制得到進(jìn)一步提高。

為驗證大角度正弦位置跟蹤效果，在彈性負(fù)載4(N·m)/(°)條件下，給定5V3Hz的舵控指令，實驗跟蹤效果曲線如圖9所示，大角度時，在速度過零點處依然能夠準(zhǔn)確跟蹤指令信號。觀測器估計的干擾補償量如圖10所示。過零處補償量折算到控制信號占空比達(dá)到17.5%。

圖7 1V 1Hz位置跟蹤曲線Fig.7 1V 1Hz position tracking

圖8 1V 1Hz干擾補償曲線Fig.8 1V 1Hz compensation cure of disturbance

圖9 5V 3Hz位置跟蹤曲線Fig.9 5V 3Hz position tracking

7 結(jié)論

本文設(shè)計了滑模變結(jié)構(gòu)與擴張觀測器相結(jié)合的控制策略，通過擴張觀測器觀測電動舵機不確定模型因素和外加干擾，用于補償其對系統(tǒng)的影響，在Simulink中驗證算法的有效性。最終，通過某型電動舵機實物驗證了算法的正確性和有效性。特別是針對在大負(fù)載情況下，補償效果尤其明顯，取得了很好的控制效果，具有很好的工程應(yīng)用價值。