陀螺穩定平臺的滑膜變結構控制實驗研究

姚兆，劉杰，李允公，衣英剛，高飛

(1.東北大學 機械工程與自動化學院，遼寧 沈陽110004;2.裝甲兵技術學院，吉林 長春130117)

0 引言

陀螺穩定光學探測平臺作為一種高精度的視軸穩定系統，可以實現對地、對空目標的全景式大范圍探測和跟蹤。它既可作為獨立的光電觀瞄系統用于偵察任務，也可作為火控系統的組成部分完成戰場作戰任務。其主要功能是隔離載體角運動，使探測器在慣性空間內保持穩定;它也能夠響應指令信號，在一定角度范圍內對目標進行搜索，在人工識別鎖定后能夠按探測器信號自動跟蹤目標，并給出方位、俯仰等角度信息，其實質就是一種速度伺服控制系統。目前，針對視軸穩定控制提出了許多控制方法，文獻［1-2］提出了采用高斯型RBF 神經網絡對摩擦力矩進行觀測和補償的方法，同其他方法相比具有較好的自適應能力和較高的精度;對于機械諧振的克服，除了采用陷波濾波器外，文獻［3］提出了采用簡單的FIR 濾波器方法，并通過實驗驗證了其效果;文獻［4-5］分析了陀螺噪聲對穩定精度的影響，提出了采用Kalman 濾波器預測實際角速率方法，仿真結果表明該方法在低信噪比情況下有效地估計了實際的角速率輸出;文獻［6］針對穩定系統中的非線性擾動，采用LQG 和Kalman 濾波算法對擾動進行實時估計和補償，并采用自校正控制的方法以提高LQG 算法的魯棒性，實驗結果表明，這種方法同采用傳統的PI 和陷波器方法相比，精度提高了近一倍，但這些方法由于計算過于復雜或者過于依賴控制對象的精確數學模型，僅適合仿真，難于實現。在工程實踐中，由于系統存在各種非線性擾動因素，采用常用的PID 控制或PD 控制作為速度控制器，很難保證穩定平臺的擾動隔離精度，尤其是在低速運行時，常常出現速度的死區現象和非平穩現象，如文獻［7］采用的H∞控制和文獻［8］采用的模糊控制方法等，很難在實際系統中應用。本文以某型號火控系統穩定平臺為實際背景，在分析雙軸穩定平臺結構和慣性穩定原理的基礎上，根據系統非線性、不確定特性以及特殊應用環境，提出采用滑膜變結構控制策略，并進行了實驗驗證。實踐證明，該系統具有負載特性好，響應速度快、穩定精度高、抗沖擊力強等特點，有效地提高了系統的擾動隔離精度和魯棒性，同時，系統結構簡單，體積小，質量輕，具備很強的實用性。

1 穩定平臺系統結構

該穩定平臺主要由雙軸速率積分陀螺儀、方位向和高低向直流力矩電機、方位向和高低向解算器、1/2 鋼帶傳動機構、支撐框架、電磁鎖定裝置及輕質反射鏡等構成。力矩電機為有限角直流力矩電機，安裝于上反頭部機械轉動框架上，兩臺電機分別提供高低軸和方位軸輸出力矩。雙軸速率積分陀螺采用撓性陀螺，安裝于平臺框架上，它是穩定平臺的核心部件，用于敏感臺體的擾動速率和反射鏡轉動的角度。其輸出信號通過線性變化、變系數等處理，與穩定伺服校正電路、功率放大電路和力矩電機構成穩定、伺服控制系統，實現反射鏡對大地空間的穩定。圖1為穩定平臺原理框圖。

圖1 穩定平臺原理框圖Fig.1 Block diagram of stabilized platform

2 穩定平臺總體設計

采用三維結構造型分析軟件，分析穩定平臺機械構造、傳動結構特點和負載特性參數，決定關重傳感器件的性能參數。根據仿真計算出的負載特性和系統總體對穩瞄控制系統性能指標的要求，對上反組件內安裝的陀螺、電機和角度傳感器等關重件進行選型，對控制系統建模，通過仿真計算確定電路參數。同時，為了提高建模的準確性，采用先進的三維造型軟件精確仿真計算上反射鏡的負載特性，根據系統總體指標要求和所選傳感器特性參數，在系統建模時采用Matlib ＆ Simulink 系統設計與分析軟件，考慮各種參數擾動影響，進行模型分析與數字動態仿真，反復驗證模型的準確性。考慮到穩瞄控制系統是一個高精度控制系統，陀螺、旋轉變壓器等器件的輸出信息屬于微弱信號，極易受到電磁干擾，影響到系統的穩定精度或同步精度，另外系統控制電路中還存在大功率電流和高頻脈沖，會對穩瞄控制系統造成影響。為此，對系統和電路中所有弱信號和大電流、高頻脈沖信號都做了屏蔽保護，電路接地采用了分類分級接地和單點接外殼方式，濾波電路還采用了金屬屏蔽方式，以盡量減少干擾［9］。

控制模塊采用集成DC/DC 電源模塊分區統一供電，電源精度高、可靠性好、穩定性好;功率放大電路采用電流反饋保護方式，并實行一體化散熱，提高整個系統可靠性。系統的位置伺服控制采用數字控制方式實現位置傳感器信號采集處理和位置校正。

3 滑模變結構控制器設計

陀螺瞄準線穩定系統除了具有運動控制中常見的機械諧振、電機死區和極限環振蕩，摩擦力矩耦合負載變化以及電氣參數波動等問題外，撓性陀螺自身由于扭桿的彈性剛度，信號器與力矩器的穩定與溫度等有關，故撓性陀螺存在零位溫度漂移現象;陀螺內部的電子器件會產生熱噪聲，陀螺外部的模擬信號的波動、電源干擾和電磁干擾會導致隨機噪聲;信號在傳輸、測量和轉換過程中可能引入噪聲，大量量測噪聲的存在會使辨識的模型具有較高的階次而無法逼近實際的系統，將會降低控制系統的精度和分辨率，而且，此類光電跟蹤系統反應時間很短，穩定控制響應時間一般在毫秒級，因此要求控制系統具有快速動態響應［10］、高質量穩態精度以及對于模型參數變化的自適應能力和魯棒性。因而常規PID控制器很難達到理想的控制效果。

變結構控制系統是一種特殊的非線性反饋控制系統，是解決有界不可測擾動、系統變參數和模型不確定問題的有效方法。由于滑動模態可以進行設計且與對象參數及擾動無關，使得滑模變結構控制具有快速響應、對參數變化及擾動不靈敏、無需系統在線辨識、物理實現簡單等優點。將其應用到穩定平臺系統中，可很好的解決精度與快速性之間的矛盾［11］，增強系統魯棒性，抑制干擾力矩對電機的影響，而且算法較簡單，工程上易于實現［12］。引入滑模變結構控制后系統模型如圖2所示。

其中:VSC 為滑膜變結構控制器;KG為陀螺的靜態傳遞系數;τG為陀螺的時間常數;RM為電機電樞回路總電阻值;TL為力矩電機的電氣時間常數;KM為力矩系數;MT為外界干擾力矩;MF為力矩電機輸出力矩;Js為折算到電機軸上的總轉動慣量;θo(k 為搖擺引起的視軸偏差修正角);θp(k 為視軸穩定伺服系統輸出角度)。

直接針對離散系統的滑模變結構控制，可以不直接考慮采樣周期的長度，因為它是一種準滑?？刂疲砩嫌钟斜苊飧哳l抖振的可能;建立在差分方程基礎上的離散系統，其狀態可由輸出、控制等值計算出來，不需要建立觀測器，從而使直接針對離散系統的滑模變結構控制，更具有實用性。

1)離散系統滑模區的可達條件

以離散李雅普諾夫穩定性為基礎，可推導出離散系統滑模區的可達條件

當采樣周期T 很小時，其等價的兩個不等式是

(2)式是保證狀態軌跡進入滑模區s(k)=0 的必要條件，稱為滑模必要條件;而(3)式保證狀態軌跡收斂到s(k)=0，稱為滑模收斂條件。

2)基于趨近律的離散滑?？刂破髟O計

基于趨近律的控制器設計是滑模變結構控制的一種典型控制策略，這種控制方法不僅可以對系統在切換面附近或沿切換面的滑模運動段進行分析，而且可以有效的對系統趨近段的動態過程進行分析和設計，從而保證系統在整個狀態空間內具有良好的運動品質。

在連續控制系統中，常用的趨近律為指數趨近律

對于離散系統可將(4)式離散化，即得離散指數趨近律為

式中，ε ＞0，q ＞0，1-qTs＞0，Ts為采樣周期。

由上式不難證明滑模區的可達條件成立，如下

即離散指數趨近律(5)式滿足滑模區的可達條件。

針對離散系統

離散滑模面為

將s(k+1)=Cx(k+1)=CAx(k)+CBu(k)代入趨近律(5)式得

得到離散滑模控制律為

忽略電機電氣時間常數的影響，本系統的開環傳遞函數為

其離散狀態空間表達式為

取R(k)=［θ0(k);+dθ0(k);d2θ0(k)］，R(k+1)=［θ0(k+1);+dθ0(k+1);d2θ0(k+1)］

切換函數可寫為

其中Ce=［C1，C2，1］，則

控制規律為

將s(k+1)-s(k)=-qTss(k)-εTssgn (s(k))代入，得

其中c1，c2，q，ε 為可變參數。滑模參數c1和c2對系統調節時間有較大的影響。趨近速度參數q 主要影響切換函數的動態切換過程，適當調整該參數能夠改變系統向滑模面的趨近速度，可以更好的改善系統動態性能。符號函數增益參數ε 代表了系統克服攝動及外干擾的能力［13］。經過試驗，c1，c2，q，ε 分別取值為35、40、30、20，此時系統具有較小的穩態誤差和較高的抗干擾能力。

4 試驗及結果分析

對該穩瞄系統分別做了搖擺試驗、振動試驗和沖擊試驗。試驗時，在主試驗臺(搖擺臺、振動臺、沖擊臺)上面中央位置放置一個平面鏡，將穩定平臺固定于主試驗臺上，并使穩定平臺底面軸向與平面鏡的軸向重合。平行光管用來測量組件內上反射鏡的運動情況，光管的目鏡內以正中央為原點，上下左右均有一定刻度。接通平行光管電源，使其向正前方發射平行光束，將目鏡對準測量組件的上反射鏡，則上反射鏡將平行光束反射至平面鏡;而后光束將沿相同路徑返回平行光管的目鏡，形成一個十字分劃，通過調整目鏡在方位和俯仰軸向的位置，可使十字分劃與目鏡的原點重合。試驗中，觀察目鏡內十字分劃的運動軌跡，便可知穩定平臺高低向穩定誤差α 和方位向穩定誤差β 最大值，具體數據如表1～表3所示。

表1 搖擺試驗穩定誤差Tab.1 Stabilization error of swing test

通過對試驗數據進行分析可以得出以下結論:

1)在使用平行光管作靜態觀察時，瞄線基本保持不動，證明系統對噪聲的抑制比較成功，達到了比較理想的動態性能［14］，工作可靠，穩定精度高，達到了平臺穩定精度的設計要求。

2)在整個高低角工作范圍內，瞄準線沿方位向的振幅，在10～40 Hz 頻率范圍內，不超過20″，在40～120 Hz 頻率范圍內，不超過30″.但在40～70 Hz諧振頻率點上的振幅達1'，在70～120 Hz 諧振頻率點上的振幅達2'，這是由于機械諧振造成的。系統的頻帶寬度越寬機械諧振對系統動態特性的影響就越顯著。所以在機械加工中，應盡量提高系統的機械諧振頻率，以使其遠離系統的中頻帶。為抑制機械諧振頻率，在對采集到的陀螺數據作放大校正預處理時使用了陷波器，在120 Hz 以下，垂直向和水平向都沒有出現嚴重的超差點，在40 Hz 以內，系統誤差均不超過20″，證明系統的低頻精度較高。

表2 振動試驗穩定誤差Tab.2 Stabilization error of vibration test

表3 沖擊試驗穩定誤差Tab.3 Stabilization error of impact test

3)火炮后座對系統精度的影響最為嚴峻，沖擊試驗充分證明了這點。沖擊過程中，陀螺的輸出信號很大，在50 g 峰值加速度下，系統最大動態誤差可達5'，但是在沖擊過后，瞄準線可基本回歸原位，系統達到設計要求。

5 結論

陀螺穩定平臺系統中的非線性因素，直接影響到系統的速度閉環控制精度，進而影響到整機的目標跟蹤精度和跟蹤速度。尤其是對低速性能要求很高的高精度光電跟蹤設備，必須采用有效的控制方法消除非線性擾動因素。另外，由于火控系統對穩定平臺的精度、抗振動、抗沖擊等性能要求較為苛刻，如果采用經典的PID 控制器，只能靠提高力矩剛度來加強對力矩干擾的抑制程度，但同時也將帶來穩定性問題。本文利用滑模變結構控制方法對模型參數變化、非線性和外擾噪聲的不敏感性，設計的穩定平臺系統無超調，響應速度快而且抗干擾能力強，具有很好的魯棒性。實驗表明，該方法可以有效地消除系統中的非線性擾動，改善陀螺速度閉環的低速性能，視軸穩定精度因此提高了50%以上，同時在控制中有效地避免了滑模抖振現象，可靠性高。

References)

［1］ Du H L，Satish S.N.Modeling and compensation of low-velocity friction with bounds ［J］.IEEE Transation on Control Systems Technology，1999，7(1):110-121.

［2］ Jayesh A.Implementation of a friction estimation and compensation technique［J］.IEEE Control Systems，1997，8:71-76.

［3］ Slobodan N.Vukosavic.Suppression of torsional oscillations in a high-performance speed servo drive［J］.IEEE Transation on Industry Electronics，1998，45(1):108-117.

［4］ Marcelo C A，Douglas E E.Novel kalman filtering method for the suppression of gyroscope noise effects in pointing and tracking systems［J］.Optical engineering，1995，34(10):3016-3030.

［5］ Marcelo C A.Kalman Filtering Approach for Reducing Gyroscope Noise Effects in Stabilized Platforms［C］∥SPIE Conference on Acquisition，Tracking，and Pointing VI，Albuquerque:1992，1697:399-413.

［6］ Li B ，Hullender D ，DeRenzo M .Nonlinear induced disturbance rejection in inertial stabilization systems［J］.IEEE Transation on Control System Technology，1998，6(3):421-427.

［7］ Shen J C.H∞control and sliding mode control of magnetic levitation system［J］.Asian J Control，2002，4(3):333-340.

［8］ Chen B，Liu X P.Fuzzy approximate disturbance decoupling ofMIMO nonlinear systems by backstepping and application to chemical processes ［J］.IEEE Transactions on Fuzzy Systems，2005，13(6):832-847.

［9］ 帳德寧.上反穩瞄系統數字化控制研究［D］.天津:天津大學，2006.ZHANG De-ning.Research on digital control of upper reflector aim-stabilization system［D］.Tianjin:Tianjin University，2006.(in Chinese)

［10］ Rtega J J.Gunfire performance of stabilized electro-optical sights［C］∥SPIE Conf，Orlando:1999，3692:74-83.

［11］ 李漢舟，劉修彥.撓性捷聯慣性導航系統誤差補償技術［J］.中國慣性技術學報，2007，15(4):403-411.LI Han-zhou，LIU Xiu-yan.Error compensation technique for SINS with dynamically tuned gyroscope［J］.Journal of Chinese Ineatial Technology，2007，15(4):403-411.(in Chinese)

［12］ 郭貴蓮，盛光忠，崔志強.基于DSP 的全數字滑模變結構直流伺服系統［J］.三峽大學學報:自然科學版，25(5):437-439.GUO Gui-lian，SHENG Guang-zhong，CUI Zhi-qiang.Full-digital SM VSC DC servo system based on DSP［J］.Journal of China Three Gorges University:Natural Science Edition，25(5):437-439.(in Chinese)

［13］ 姚瓊薈，黃繼起，吳漢松.變結構控制系統［M］.重慶:重慶大學出版社，1997:1-12.YAO Qiong-hui，HUANG Ji-qi，WU Han-song.VSC control system［M］.Chongqing:Press of Chongqing University，1997:1-12.(in Chinese)

［14］ 韓永根.角度無靜差陀螺穩定光電探測平臺設計與實現［J］.光電工程，2008，35(8):1-4.HAN Yong-gen.Design and implementation of a Gyro stabilized platform with zero steady-state angle error［J］.Opto-Electronic Engineering，2008，35(8):1-4.(in Chinese)