陀螺/加速度計穩(wěn)定環(huán)對“動中通”系統(tǒng)的擾動校正

方陽麗，唐 猛

(西南交通大學(xué)機械工程學(xué)院，四川 成都 610031)

陀螺/加速度計穩(wěn)定環(huán)對“動中通”系統(tǒng)的擾動校正

方陽麗，唐 猛

(西南交通大學(xué)機械工程學(xué)院，四川 成都 610031)

針對“動中通”系統(tǒng)兩次上位機指令間隔中載體姿態(tài)變化的擾動，提出了基于三軸陀螺和加速度計的穩(wěn)定回路跟蹤控制方法。該方法在傳統(tǒng)伺服系統(tǒng)電流環(huán)、速度環(huán)和位置環(huán)的反饋回路中增加了負載速度前饋補償和穩(wěn)定回路位置校正環(huán)節(jié)。利用陀螺和加速度計的測量數(shù)據(jù)融合、穩(wěn)定跟蹤修正的原理隔離載體姿態(tài)變化，對測量噪聲信號用卡爾曼濾波技術(shù)進行估計和誤差補償，有效地提高了系統(tǒng)對姿態(tài)擾動的隔離度。仿真驗證結(jié)果表明，伺服穩(wěn)定系統(tǒng)的響應(yīng)時間小于200 ms，動態(tài)跟蹤誤差小于0.1°，隔離度高于97%，具有較高的跟蹤精度，能夠滿足工業(yè)應(yīng)用穩(wěn)定跟蹤控制。

動中通；姿態(tài)擾動；陀螺穩(wěn)定回路；加速度計；卡爾曼濾波

0 引言

機載“動中通”系統(tǒng)是在飛機姿態(tài)不斷變化過程中天線陣面接收衛(wèi)星通信信號的系統(tǒng)。系統(tǒng)采用自動跟蹤技術(shù)，能在載體移動的情況下實時隔離振蕩、進行高精度捕獲目標(biāo)衛(wèi)星，從而獲得連續(xù)穩(wěn)定的衛(wèi)星通信信號?！皠又型ā毕到y(tǒng)靈活、機動、保密性強，其通信覆蓋范圍廣、適應(yīng)性強，在軍、民移動通信行業(yè)有著廣泛的應(yīng)用[1-4]。

自動跟蹤技術(shù)是通過慣性導(dǎo)航系統(tǒng)定時(20～100 ms)向上位機發(fā)送指令，利用伺服控制單元進行一次姿態(tài)校正。隨著慣導(dǎo)技術(shù)的不斷發(fā)展，導(dǎo)航精度也隨之提高，但是隨著航天技術(shù)不斷發(fā)展，飛機運動姿態(tài)變化的速率越來越快，在上位機接收兩次指令間隔中飛機姿態(tài)的變化使得跟蹤誤差增加，影響了通信質(zhì)量。研究隔離載體姿態(tài)變化擾動的伺服系統(tǒng)穩(wěn)定環(huán)控制策略是提高位置跟蹤精度的關(guān)鍵技術(shù)。

國內(nèi)外學(xué)者對控制系統(tǒng)隔離度穩(wěn)定回路作了大量研究，它的核心問題是對移動載體姿態(tài)變化進行測量和補償控制。文獻[5]把載體的運動作為干擾引入伺服系統(tǒng)，利用陀螺速度值構(gòu)成穩(wěn)定環(huán)反饋回路；文獻[6]利用載體運動中天線平臺方位和俯仰角度的變化，通過“陀螺閉環(huán)穩(wěn)定+電平跟蹤”控制方式進行穩(wěn)定補償；文獻[7]利用陀螺儀感知機構(gòu)方位、俯仰方向速度變化，積分后得位置變化量進行反饋控制。以上方法雖然能在一定程度上提高穩(wěn)定跟蹤誤差，但存在明顯缺點：穩(wěn)定跟蹤的目的是提高位置跟蹤精度，文獻[5]中的陀螺穩(wěn)定環(huán)是速度補償，沒有達到更好的位置環(huán)補償效果；陀螺儀反應(yīng)靈敏，在測量中的隨機噪聲信號經(jīng)過積分，會產(chǎn)生隨時間迅速增大的累積誤差(漂移)，影響了跟蹤精度，不適合長時間進行載體姿態(tài)變化的測量。

本文針對上述問題，提出了基于三軸陀螺和加速度計的組合穩(wěn)定回路跟蹤控制方法，并采用卡爾曼濾波算法對測量噪聲進行估計和誤差補償。能夠解決上述位置控制和跟蹤累積誤差問題，實現(xiàn)長時間衛(wèi)星精確跟蹤。

1 機載“動中通”控制系統(tǒng)

機載衛(wèi)星天線對中伺服系統(tǒng)要求在飛機飛行過程中，通過控制天線伺服機構(gòu)，完成方位、俯仰2個方向的運動，保證天線陣面實時以最大面積對準衛(wèi)星。根據(jù)功耗少、重量輕、體積小的設(shè)計原則，伺服轉(zhuǎn)臺的方位和俯仰運動均采用電機通過減速器和齒輪傳動機構(gòu)帶動負載運動的方式來實現(xiàn)，結(jié)構(gòu)設(shè)計中盡量減小負載轉(zhuǎn)動慣量和附加力矩。

伺服控制系統(tǒng)大多采用傳統(tǒng)PID算法完成電流環(huán)、速度環(huán)和位置環(huán)的反饋控制調(diào)節(jié)器的設(shè)計。一般地，通過上位機發(fā)送控制指令，三環(huán)調(diào)節(jié)器可以實現(xiàn)閉環(huán)系統(tǒng)的精度控制要求。但是，由于機載衛(wèi)星通信系統(tǒng)中載體姿態(tài)變化速率非?？?，在上位機兩次位置指令發(fā)送時間間隔內(nèi)載體姿態(tài)有可能發(fā)生較大的變化，產(chǎn)生較大的位置跟蹤誤差。為了對載體姿態(tài)變化進行檢測與隔離，實現(xiàn)更加精確的位置跟蹤，在此模型基礎(chǔ)上搭建穩(wěn)定回路控制模型，控制系統(tǒng)隔離度穩(wěn)定回路設(shè)計中，最常見的是陀螺儀穩(wěn)定回路。同時為了提高速度響應(yīng)的速度和精度，反饋回路增加了速度前饋補償環(huán)節(jié)。整個伺服系統(tǒng)的控制原理框圖如圖1所示。

圖1中的電機調(diào)速系統(tǒng)采用電流環(huán)和速度環(huán)雙閉環(huán)調(diào)速系統(tǒng)調(diào)節(jié)器。通過三環(huán)調(diào)節(jié)器和陀螺穩(wěn)定回路的作用，使系統(tǒng)隔離載體姿態(tài)變化對穩(wěn)定跟蹤的影響，保證伺服系統(tǒng)的動態(tài)跟蹤精度高、穩(wěn)態(tài)誤差小。

2 陀螺/加速度計組合穩(wěn)定回路

2.1 穩(wěn)定回路原理

針對圖1中的陀螺穩(wěn)定回路，陀螺儀作為高靈敏度測量元件，測量過程出現(xiàn)了陀螺噪聲信號以及隨機漂移誤差對跟蹤性能造成影響。隨著組合慣性測量系統(tǒng)的發(fā)展，對穩(wěn)定回路跟蹤精度最直接的一種提高方式是利用組合慣導(dǎo)元件的測量數(shù)據(jù)融合，陀螺和加速度計是常用的姿態(tài)測量元件。本文在現(xiàn)有技術(shù)的基礎(chǔ)上設(shè)計了陀螺/加速度計組合穩(wěn)定回路，在實際應(yīng)用中，陀螺儀反應(yīng)靈敏、動態(tài)性能好，但在測量過程中的隨機噪聲信號經(jīng)過積分產(chǎn)生隨時間迅速增大的累積誤差(漂移)；加速度計測量噪聲小，但動態(tài)性能差。單獨使用陀螺儀或加速度計不能得到最優(yōu)姿態(tài)隔離控制的問題。組合穩(wěn)定回路采用三軸陀螺和加速度計測量數(shù)據(jù)融合、穩(wěn)定跟蹤修正的原理可形成優(yōu)勢互補，采用標(biāo)定方法補償多個測量元件的數(shù)據(jù)誤差，用陀螺儀進行加速度計的誤差校正[8-10]；用加速度儀的數(shù)據(jù)對陀螺進行加權(quán)糾正，同時用卡爾曼技術(shù)對陀螺噪聲信號進行濾波處理。在系統(tǒng)接收上位機新的位置指令時對陀螺儀的位置積分數(shù)據(jù)清零。

在伺服機構(gòu)方位運動支座上安裝了三軸陀螺和加速度計，來感知兩次上位機指令間隔中飛機運動姿態(tài)變化引起轉(zhuǎn)臺空間三維方向上的速度/加速度變化，控制單元將采集到的值經(jīng)過坐標(biāo)變換運算得到方位和俯仰方向的導(dǎo)航速度/加速度變化，經(jīng)過積分后得到轉(zhuǎn)臺在方位和俯仰上的位置變化，通過程序中的位置補償算法得到機構(gòu)需要改變的位置量，作為控制指令和其他環(huán)路共同控制電機帶動天線陣面進行姿態(tài)調(diào)整。

根據(jù)以上數(shù)據(jù)檢測與處理技術(shù)得到載體姿態(tài)變化隔離穩(wěn)定控制的硬件結(jié)構(gòu)如圖2所示。

圖2 穩(wěn)定回路控制結(jié)構(gòu)Fig.2 Control structure of stable loop

2.2 卡爾曼濾波

穩(wěn)定回路中慣性元件測量輸出值中的隨機噪聲信號影響了系統(tǒng)輸出精度，使系統(tǒng)的動態(tài)跟蹤誤差隨時間急劇增大。為此，除了采用標(biāo)定方法補償陀螺和加速度計的數(shù)據(jù)誤差外，還必須對測量信號進行濾波處理?？柭鼮V波技術(shù)通過遞推算法從觀測量中估計出所需信號，由于使用靈活，適合處理隨機噪聲信號估計問題在工程領(lǐng)域測量技術(shù)中得到廣泛的應(yīng)用[11-12]。

通過對陀螺儀和加速度計模型原理的理解[13-14]，陀螺和加速度計的數(shù)學(xué)模型可以簡化為二階系統(tǒng)，假設(shè)離散化后的系統(tǒng)狀態(tài)空間方程系數(shù)矩陣為A,B，用卡爾曼濾波算法估計系統(tǒng)的各種誤差狀態(tài)值和補償校正，從而提高擾動控制系統(tǒng)的隔離度性能，保證穩(wěn)定跟蹤回路的精度。系統(tǒng)的卡爾曼濾波器為：

其中，u(k)為現(xiàn)在狀態(tài)控制量，P是估計誤差協(xié)方差，Q是過程噪聲協(xié)方差，X是狀態(tài)估算值，I為單位矩陣，K為卡爾曼增益。

實際應(yīng)用中，選擇了慣性測量單元QH-IMU200A用于姿態(tài)測量，它采用高可靠性和穩(wěn)定性的MEMS陀螺儀和和加速度計。在實驗臺上，將測量單元通過串口與上位機連接，手動晃動該測量單元，檢測到的數(shù)據(jù)經(jīng)過Kalman濾波器去除噪聲信號的結(jié)果如圖3所示。

圖3 Kalman濾波曲線Fig.3 Curve of Kalman filter

圖3中曲線1是載體姿態(tài)變化過程中的測量速度信號，曲線2是濾波之后的速度信號，曲線3是積分之后的位置信號。可以看出曲線2與曲線1相比存在一定時間延遲，實際控制中不采用曲線2的數(shù)據(jù)，直接采用積分之后的位置信號作為載體姿態(tài)變化數(shù)據(jù)與控制指令進行數(shù)據(jù)融合?？柭鼮V波器通過誤差估計、補償可以進一步提高擾動控制系統(tǒng)的隔離度性能，所設(shè)計的濾波器不但能夠穩(wěn)定地工作，而且系統(tǒng)的隔離度性能都有明顯的提高。

3 驗證與結(jié)果分析

3.1 仿真驗證

根據(jù)設(shè)計的伺服控制策略和各單元模型的參數(shù)，在Simulink中搭建系統(tǒng)仿真模型，由于方位運動和俯仰運動存在相似性，這里只對方位仿真模型進行分析。

為了驗證穩(wěn)定回路對姿態(tài)擾動隔離的效果，首先在不加穩(wěn)定回路的情況下對系統(tǒng)隔離度進行測試，此時的隔離度與上位機給定時間的間隔有很大的關(guān)系。在給定頻率0.125 Hz，振幅為8°的正弦信號，通信時間間隔分別依次設(shè)置為20 ms、50 ms和100 ms，仿真得到的系統(tǒng)跟蹤誤差曲線分別如圖4-圖6所示。

圖4 通信時間20 ms跟蹤誤差Fig.4 Tracking error of 20 ms

圖5 通信時間50 ms跟蹤誤差Fig.5 Trackingerror of 50 ms

圖6 通信時間100 ms跟蹤誤差Fig.6 Trackingerror of 100 ms

由圖分析可知，通信時間間隔為20 ms時，穩(wěn)定回路的隔離度約為96%；通信時間間隔為50 ms時，穩(wěn)定回路的隔離度約為94.5%；通信時間間隔為100 ms時，穩(wěn)定回路的隔離度約為92%，隨著時間間隔的增加，系統(tǒng)的隔離度降低。

采用穩(wěn)定回路后，不同通信時間間隔下的系統(tǒng)隔離度基本相同，以頻率0.125 Hz，振幅為8°的正弦信號為例，系統(tǒng)的跟蹤誤差約為0.22°，隔離度大于97%，如圖7所示。

圖7 加穩(wěn)定回路跟蹤誤差Fig.7 Tracking error with stable loop

3.2 實驗驗證

仿真結(jié)果表明，穩(wěn)定回路提高了系統(tǒng)對姿態(tài)變化擾動的隔離效果，仿真結(jié)果對實際應(yīng)用有一定參考意義，但是與真實效果還是有些差別。為此根據(jù)伺服系統(tǒng)的控制策略和陀螺/加速度計穩(wěn)定回路的研究，設(shè)計了控制系統(tǒng)硬件電路和軟件編程進行穩(wěn)定跟蹤調(diào)試驗證，硬件控制原理框圖如圖8所示。

圖8 硬件電路原理Fig.8 Theory of hardware circuit

圖中主控板的CPU采用32位高可靠高性能軍品級Soc系列芯片，內(nèi)嵌單/雙精度浮點處理單元(FPU)，適應(yīng)環(huán)境溫度范圍寬，能夠保證惡劣環(huán)境的精度要求。穩(wěn)定回路中控制電路已經(jīng)將慣性元件測量的模擬信號轉(zhuǎn)換為數(shù)字信號，通過RS232傳輸?shù)街骺刂茊卧榱朔奖阏{(diào)試過程，基于串口通信設(shè)計了上位機調(diào)試系統(tǒng)，通過上位機界面能夠?qū)崟r修改目標(biāo)指令、調(diào)節(jié)參數(shù)和監(jiān)測伺服系統(tǒng)速度和位置等運行狀態(tài)參數(shù)。伺服系統(tǒng)與上位機之間的通信采用RS485和PECL的方式，運動控制單元可提供兩路的運動控制，可實現(xiàn)速度控制、位置控制和穩(wěn)定跟蹤控制。硬件電路板裝機后和調(diào)試平臺如圖9所示。

圖9 硬件電路板與調(diào)試平臺Fig.9 Hardware circuit board and debugging platform

根據(jù)技術(shù)要求對平臺分別作階躍響應(yīng)、跟蹤響應(yīng)等指標(biāo)進行驗證，在上位機界面選擇不同的控制模式，其結(jié)果如圖10和圖11所示，圖中縱坐標(biāo)為角度值，單位(°)；橫坐標(biāo)為時間軸，時間值為顯示值×20 ms。

以方位運動為例，圖10是伺服系統(tǒng)3°階躍響應(yīng)曲線，顯示響應(yīng)無超調(diào)，上升時間為(112-102)×20 ms=200 ms。滿足控制時間≤200 ms，靜態(tài)誤差≤0.1°的要求。圖11是給定幅值為5°，頻率為0.2 Hz的正弦曲線輸入指令，在上位機界面上其反饋的負載位置動態(tài)響應(yīng)曲線和輸入指令基本重合，無法看出位置誤差，因此這里只給出了位置跟蹤誤差曲線，可以看出最大位置誤差為0.09°，滿足指標(biāo)要求。

圖10 階躍響應(yīng)曲線Fig.10 Curve of step response

圖11 位置誤差曲線Fig.11 Curve of position error

將平臺放在可以移動的載體上，先通過角度預(yù)置模式調(diào)整方位和俯仰角度，使天線陣面對準某個方位，然后進入跟蹤模式，并隨意移動載體，控制系統(tǒng)能夠通過陀螺穩(wěn)定回路的位置補償原理實時調(diào)整方位(如圖12所示)和俯仰角度，載體姿態(tài)變化的隔離度大于97%，保證天線陣面實時正對目標(biāo)位置，實現(xiàn)穩(wěn)定跟蹤性能。

圖12 方位穩(wěn)定跟蹤曲線Fig.12 Curve of stabilizing tracking of azimuth axis

4 結(jié)論

本文提出了基于陀螺和加速度計的組合穩(wěn)定回路控制方法。該方法利用陀螺和加速度計的測量數(shù)據(jù)融合、穩(wěn)定跟蹤修正原理可形成優(yōu)勢互補，可以提高機載“動中通”系統(tǒng)的隔離度；卡爾曼數(shù)據(jù)處理技術(shù)改善了系統(tǒng)的動態(tài)性能和跟蹤精度。仿真驗證和實物驗證結(jié)果表明：該伺服穩(wěn)定系統(tǒng)的系統(tǒng)的響應(yīng)時間小于200 ms，動態(tài)跟蹤誤差小于0.1°，隔離度達到97%，具有較高的跟蹤精度，能夠滿足工業(yè)應(yīng)用穩(wěn)定跟蹤控制。

[1]章百寶，陳濤. 某衛(wèi)星通信天線伺服系統(tǒng)的設(shè)計與實現(xiàn)[J]. 現(xiàn)代電子技術(shù),2015,38(1):59-61,65.

[2]錢偉行. 捷聯(lián)慣導(dǎo)與組合導(dǎo)航系統(tǒng)高精度初始對準技術(shù)研究[D]. 南京: 南京航空航天大學(xué), 2010.

[3]劉海波. 組合導(dǎo)航中全球定位系統(tǒng)輸出延遲補償方法[J]. 探測與控制學(xué)報, 2014, 36(3): 64-68.

[4]雷楊,李軍,李紹軍. 高精度穩(wěn)定平臺伺服控制系統(tǒng)仿真實現(xiàn)[J]. 電光與控制,2015, 22(5):72-76.

[5]徐貴民，黃建國. 穩(wěn)定環(huán)在 “動中通 ”伺服系統(tǒng)中應(yīng)用的仿真研究[J]. 電光與控制，2009(2)：94-96.

[6]劉曉軍，龔利紅，劉鵬，等. 衛(wèi)星天線穩(wěn)定跟蹤平臺的總體模塊化設(shè)計[J]. 寧波職業(yè)技術(shù)學(xué)院學(xué)報， 2010,14(5):35-37.

[7]宋斌，齊永龍. 一種衛(wèi)星通信天線伺服機構(gòu)設(shè)計[J]. 國外電子測量技術(shù), 2014, 33(2): 49-52.

[8]路永樂,潘英俊,黎蕾蕾,等. 采用雙軸加速度計的旋轉(zhuǎn)彈運動姿態(tài)角速率測量方法[J]. 中國慣性技術(shù)學(xué)報，2015, 23(2): 160:164.

[9]賈景瑞. 基于衛(wèi)星定位技術(shù)的軸向加速度標(biāo)定方法[J]. 探測與控制學(xué)報,2014, 36(2):46-49.

[10]馮智勇, 曾瀚, 張力,等. 基于陀螺儀及加速度計信號融合的姿態(tài)角度測量[J]. 西南師范大學(xué)學(xué)報，2011,36(4)：137-140.

[11]Wei X Y, Cong S, Deng K, et al. Isolation control of carrier turbulence for speed system of airborne electroptical gyro-stabilized platform[C]// Proceedings of the 14th Chinese Control Conference on system simulation Technology & Application, 2012,14:751-757.

[12]David H. Titterton,John L. Weston. 捷聯(lián)慣性導(dǎo)航技術(shù)(第二版)[M]. 張?zhí)旃?等譯. 北京：國防工業(yè)出版社,2007.

[13]宋康寧，叢爽，鄧科，等. 自適應(yīng)強跟蹤卡爾曼濾波在陀螺穩(wěn)定平臺中的應(yīng)用[J]. 中國科學(xué)技術(shù)大學(xué)學(xué)報, 2045, 45(1): 17-22.

[14]楊小會，董鵬飛，王超. 基于卡爾曼濾波的GPS彈道測量誤差消除方法[J]. 探測與控制學(xué)報, 2012, 34(4): 30-33.

Disturbance Correction for “Communications in Moving” System Based on Gyro/Accelerometer Stable Loop

FANG Yangli，TANG Meng

(School of Mechanical Engineering, Southwest Jiaotong University, Chengdu 610031, China)

In view of the disturbance caused by carrier attitude changing during PC instructions for ‘communications in moving’ system, a stability loop algorithm based on gyroscope and accelerometer was proposed. Based on traditional servo system of current, velocity and position feedback loop, a speed feed forward compensation and stabilization loop.were designed. The control system integrated the measurement data of gyroscope and accelerometer and used the principle of stabilizing tracking correction to isolate carrier attitude’ change. To eliminate the random noise signal, a Kalman filter was proposed, which could effectively improve the disturbance isolation ratio. The debugging results showed that the response time was less than 200 ms,the dynamic tracking error was less than 0.1°, and the isolation ratio was more than 97%, which meant the system had higher tracking precision and satisfy the stable tracking control in industrial application.

communications in moving; attitude disturbance; gyro stable loop; accelerometer; Kalman filter

2016-05-13

中央高?；究蒲袠I(yè)務(wù)費專項資金創(chuàng)新項目資助(SWJTU11CX024)

方陽麗(1989—)，女，湖北襄陽人， 碩士研究生，研究方向：機電一體化系統(tǒng)。E-mail: fangyangli@163.com。

U666

A

1008-1194(2016)06-0104-05