李世秋,鄭成軍,陶德桂

摘 要:針對小型超低空掠海無人靶機飛控系統(tǒng)的研制,基于無線電高度表/加速度計組合控制的基本原理,在縱向姿態(tài)控制內(nèi)回路的基礎(chǔ)上設(shè)計了高度控制外回路,采用了一種Kalman互補濾波算法濾除高度信號噪聲,并獲得高質(zhì)量的垂向速度信號。基于ARM7微處理器和μC/OS-Ⅱ嵌入式實時操作系統(tǒng),完成了控制器軟硬件實現(xiàn)。半實物仿真實驗結(jié)果表明,系統(tǒng)響應(yīng)快,控制精度高,能夠準(zhǔn)確控制飛機按預(yù)設(shè)高度進行超低空掠海飛行,達到了設(shè)計要求。

關(guān)鍵詞:無人靶機;超低空掠海;高度控制;Kalman濾波;ARM

中圖分類號:TP23文獻標(biāo)識碼:A

文章編號:1004-373X(2009)19-062-04

Realization of Flight Control System of Low Level Sea-Skimming

Small Scale Unmanned Target Drone

LI Shiqiu,ZHENG Chengjun,TAO Degui

(PLA Troop No.92419,Xingcheng,125106,China)

Abstract:In the design of flight control system of the low level sea-skimming small scale unmanned drone,based upon the principle of combined control of radar altimeter and accelerometer,the outer height control loop is achieved with the inner attitude control loop.A Kalman complementary filter algorithm is used to erase the height noise and get the velocity signal with good quality at the same time.The realization of hardware and software of the system is based on ARM7 microprocessor and the μC/OS-Ⅱ embedded operation system.The results of hardware in loop test show that the system has a high precision with a quick response,and it can control the target drone fight at low level with the preset sea skimming height and meet the design requirements.

Keywords:target drone;low level sea-skimming;height keeping flight;Kalman filter;ARM

0 引 言

靶機是無人機家族中的一個重要分支,主要用于模擬作戰(zhàn)飛機、導(dǎo)彈等威脅目標(biāo),為防空武器系統(tǒng)試驗和訓(xùn)練提供逼真的空中靶標(biāo)。隨著技術(shù)的進步,現(xiàn)代反艦導(dǎo)彈多采取“超低空掠?！憋w行的突防方式,與之相應(yīng)的用于模擬反艦導(dǎo)彈類目標(biāo)的無人靶機也需要具有超低空掠海飛行能力[1]。20世紀(jì)60年代,以美國為代表的西方發(fā)達國家推出了第一代具有超低空掠海定高飛行能力的靶機,之后迅速形成了系列化,并隨著新技術(shù)的應(yīng)用不斷升級換代,某些經(jīng)典型號至今仍在廣泛使用,如石雞、火蜂、米拉奇等系列靶機,其掠海飛行的相對高度均達到了5 m以下。國內(nèi)在這一領(lǐng)域則起步較晚。

飛行控制系統(tǒng)是無人機的“大腦”,無人機的超低空掠海飛行主要是在飛控系統(tǒng)高度控制器的控制下實現(xiàn)的[2]。因此,本文針對小型靶機飛控系統(tǒng)的研制,基于無線電高度表/加速度計組合控制的基本原理,采用Kalman濾波信號處理方法和基于ARM7微處理器的嵌入式系統(tǒng),設(shè)計了一種簡單實用的高度控制器,能夠?qū)Π袡C飛行高度進行精確控制,從而實現(xiàn)超低空掠海定高飛行的目的。

1 飛控系統(tǒng)配置與高度控制原理

靶機飛控系統(tǒng)由傳感器、飛控計算機和執(zhí)行機構(gòu)3個部分組成。傳感器主要包括垂直陀螺、兩軸角速率陀螺、三軸捷聯(lián)式磁航向傳感器、無線電高度表、垂向加速度計、空速管、GPS接收機、發(fā)動機溫度和轉(zhuǎn)速傳感器等;飛控計算機是飛控系統(tǒng)的核心部件,是一臺基于ARM7的嵌入式計算機,接收來自各傳感器的測量信息,并根據(jù)控制律進行解算,給出控制信號驅(qū)動執(zhí)行機構(gòu)動作;執(zhí)行機構(gòu)主要包括升降舵機、副翼舵機、舵回路控制器、發(fā)動機油門電機和ECU控制器。飛控系統(tǒng)組成如圖1所示。

高度控制器主要由內(nèi)、外兩個反饋控制回路構(gòu)成。首先是以垂直陀螺和角速率陀螺測量信號作為反饋控制信號構(gòu)成靶機姿態(tài)控制內(nèi)回路(角運動控制系統(tǒng)),包括橫向、縱向兩個控制通道,是系統(tǒng)的核心控制回路。由于姿態(tài)控制系統(tǒng)在常值干擾力矩(如垂風(fēng))的干擾下存在姿態(tài)角靜差,會導(dǎo)致高度漂移,不能直接應(yīng)用于高度軌跡的穩(wěn)定與控制,因此在高度控制系統(tǒng)中需要直接測量飛機高度和垂向運動速度等線運動信息,使用高度表和線加速度計等傳感器,在姿態(tài)控制系統(tǒng)基礎(chǔ)上建立高度控制外回路,兩者共同構(gòu)成完整的高度控制系統(tǒng)[3](圖1中陰影部分)。在超低空飛行時要使用高精度的高度傳感器,通常采用無線電高度表[4]。在該系統(tǒng)的實際設(shè)計中,采取了無線電高度表和線加速度計組合控制,即對無線電高度表和垂向線加速度計測量信息進行特定算法綜合處理后,得到靶機高度和垂向速度的兩路反饋控制信號,送到縱向姿態(tài)控制通道,形成高度控制外回路,與姿態(tài)控制內(nèi)回路共同完成高度控制功能。

圖1 飛控系統(tǒng)組成

2 高度控制律設(shè)計

2.1 基本控制律設(shè)計

為了減少設(shè)計風(fēng)險,高度控制律采用經(jīng)典的比例-微分(PD)控制[5]。

其時域表示為:

δz=KθΔθ+K+KH?ΔH+K?

其控制原理如圖2所示。

圖2 控制原理框圖

控制量由四部分組成,包括姿態(tài)控制內(nèi)回路和高度控制外回路的各兩個控制量。

姿態(tài)控制內(nèi)回路:與俯仰角偏差Δθ成正比的比例控制器作為主控制對俯仰角進行修正,與俯仰角速率成正比的微分控制器主要用于改善姿態(tài)內(nèi)回路的阻尼特性。

高度控制外回路:與高度差ΔH成正比的比例控制器作為主控制對高度進行修正,與垂向速度成正比的微分控制器則主要用于改善高度外回路的阻尼特性。

2.2 信號處理方法及效果分析

在基本控制律確定后,一個必須解決好的主要問題就是如何獲取高質(zhì)量的反饋控制信號[6]。俯仰角偏差Δθ與俯仰角速率,按常規(guī)做法可分別由垂直陀螺和角速率陀螺提供滿足精度要求的信號。

這里主要問題在于高度信號H和垂向速度信號的獲取和處理。無線電高度表信號由于海浪起伏等因素的影響本身含有大量的噪聲,并且如果直接采用高度表信號微分獲取垂向速度信號,會引起系統(tǒng)不穩(wěn)定,不能單獨使用;如果采用加速度計信號積分獲取垂向速度信號和高度信號,又存在誤差累積的問題,也不能單獨使用。然而如果將兩者組合使用,則可以產(chǎn)生很好的優(yōu)勢互補效果。所以,本文采用了一種Kalman互補濾波算法,既可濾除高度信號噪聲,又可獲得高質(zhì)量的垂向速度信號。其設(shè)計思想是通過對垂向加速度信號進行積分得到垂向速度,再對垂向速度積分得到高度,將此高度與高度表的實際測量高度進行比較,得到一個偏差量。把該偏差量作為當(dāng)前時刻的誤差估計值重新加入到垂直加速度和垂直速度上繼續(xù)進行濾波運算[7]。

高度信號與垂向加速度信號互補濾波的原理如圖3所示。

圖3 Kalman互補濾波算法

下面根據(jù)梅遜公式和線性系統(tǒng)的疊加原理求出其傳遞函數(shù)如下:

V(s)=s+k1s2+k1s+k2a(s)+k2ss2+k1s+k2H(s)

Y(s)=1s2+k1s+k2a(s)+k1s+k2s2+k1s+k2H(s)

再對該濾波算法的效果進行分析。設(shè)拖靶的實際高度為Hr,記a=r+Na,其中Na表示加速度的誤差,則有:

a(s)=s2Hr(s)+Na(s)

記H=Hr+Nh,Nh表示高度的誤差,則有:

H(s)=Hr(s)+Nh(s)

這樣,可以得到:

V(s)=sHr(s)+s+k1s2+k1s+k2aN(s)+

k2ss2+k1s+k2HN(s)

Y(s)=Hr(s)+1s2+k1s+k2aN(s)+

k1s+k2s2+k1s+k2HN(s)

從上面可以看出,解算后的速度V由三個部分組成:

真實高度的微分:sHr(s)

加速度誤差的濾波:s+k1s2+k1s+k2aN(s)

高度誤差的濾波:k2ss2+k1s+k2HN(s)

解算后的高度Y也由三個部分組成:

真實高度:Hr(s)

加速度誤差的濾波:s+k1s2+k1s+k2aN(s)

高度誤差的濾波:k2ss2+k1s+k2HN(s)

這樣得到的垂向速度和高度信號中,加速度誤差和高度誤差的信號能夠被有效地濾波,特別是能夠有效地去除海雜波的影響。

3 控制器軟硬件設(shè)計與實現(xiàn)

高度控制器是靶機飛控系統(tǒng)的一部分,它以飛控計算機為核心,并與各路傳感器及執(zhí)行結(jié)構(gòu)共同構(gòu)成閉環(huán)控制系統(tǒng)[8]。主要由飛控計算機、垂直陀螺、角速率陀螺、無線電高度表、加速度計、舵回路控制器、舵機等設(shè)備組成。

(1) 飛控計算機

飛控計算機包括主機板、A/D轉(zhuǎn)換板、串行數(shù)據(jù)通訊接口板、開關(guān)量接口板、D/A 轉(zhuǎn)換板、模擬輸入前置處理板、離散輸入/輸出及光電隔離/驅(qū)動板、DC/DC電源變換板等。采用基于ARM的嵌入式系統(tǒng)設(shè)計,具有體積小,功耗低,硬件資源豐富,易于開發(fā),實時性和可靠性好等優(yōu)勢[9]。主機板處理器選用ARM7TDMS-S體系結(jié)構(gòu)的32位LPC2124芯片,其16 KB的內(nèi)部RAM以及128 KB的內(nèi)部FLASH存儲器,可很好地滿足嵌入式實時操作系統(tǒng)RTOS(μC/OS-Ⅱ)的運行要求,保證系統(tǒng)每20 ms能進行一次高度控制律解算。

(2) 垂直陀螺

選用TC-3E型垂直陀螺儀,在高度控制回路中主要用于測量飛機俯仰角姿態(tài),工作范圍俯仰角為±30°,輸出模擬電壓信號。

(3) 角速率陀螺

選用2軸角速率陀螺,在高度控制回路中主要用于測量飛機俯仰姿態(tài)角速度,俯仰角速度輸出范圍為±60°/s,輸出模擬電壓信號。

(4) 無線電高度表

采用調(diào)頻/連續(xù)波(FM/CW)體制,工作頻率為4 200～4 400 MHz,測高范圍為0～300 m,高度輸出形式為RS 232串口輸出,波特率為38 400 b/s,更新率為50 Hz。

(5) 加速度計

加速度計安裝在靶機的重心位置,用于測量拖靶的垂直方向加速度,選用ADXL105AQC加速度計芯片,精度為±1～±5 g,單通道模擬輸出,分辨率2 mg。

(6) 舵回路控制器

基于PWM直流電機驅(qū)動器專用集成電路L292設(shè)計。包括位置調(diào)節(jié)器、電流調(diào)節(jié)器、PWM功放、位置反饋和電流反饋傳感器。位置反饋為主反饋回路,采用WDL-25直滑式精密導(dǎo)電塑料電位器;電流反饋采用標(biāo)準(zhǔn)電阻。

(7) 升降舵機

采用齒輪減速永磁直流力矩電機,額定轉(zhuǎn)矩15 Nm,額定轉(zhuǎn)速(減速后)4±1 r/min。

(8) 軟件設(shè)計

基于嵌入式實時多任務(wù)操作系統(tǒng)μC/OS-Ⅱ下編寫應(yīng)用程序,具有可移植、裁剪、多任務(wù)和基于優(yōu)先級的搶占式任務(wù)調(diào)度等特點,實時性好,可靠性高[10]。使用實時操作系統(tǒng)(RTOS)是因為可將應(yīng)用分解成多任務(wù),簡化了應(yīng)用軟件的設(shè)計,同時RTOS使控制系統(tǒng)的實時性得到保證;良好的多任務(wù)設(shè)計,又有助于提高系統(tǒng)的穩(wěn)定性和可靠性。

4 半實物仿真實驗與結(jié)果

在自行搭建的無人機半實物仿真平臺上,對所開發(fā)的小型無人靶機高度控制系統(tǒng)進行了仿真驗證。飛機模型采用六自由度非線性全量運動方程,基本仿真步長為5 ms,仿真計算精度為64 b(雙精度浮點)。仿真系統(tǒng)包括在三軸轉(zhuǎn)臺上的垂直陀螺、角速率陀螺,與動靜壓模擬器連接的空速傳感器, 而無線電高度表信號、加速度計信號則通過計算機模擬,再接入高度控制計算機、舵機等構(gòu)成仿真回路。仿真結(jié)果如圖4和圖5所示,本文給出了兩種主要干擾條件下的結(jié)果。

圖4 四級海情與加速度計恒定誤差0.1 m/s2

情況下進入14 m定高飛行狀態(tài)

圖5 5 m/s垂風(fēng)(向下)干擾下的高度穩(wěn)定過程

仿真結(jié)果表明,在4級海情產(chǎn)生高度表噪聲影響和加速度計測量誤差影響的情況下,系統(tǒng)能夠控制靶機平穩(wěn)進入14 m定高飛行狀態(tài),并按精度要求保持在預(yù)定高度飛行。在5 m/s垂風(fēng)干擾下,靶機能夠很快回到預(yù)定的14 m基準(zhǔn)高度?？梢娤到y(tǒng)靜動態(tài)響應(yīng)指標(biāo)能滿足設(shè)計要求。

5 結(jié) 語

本文基于無線電高度表/加速度計組合控制模式,采用成熟的比例-微分(PD)控制原理,Kalman互補濾波的信號處理方法,以及基于ARM的硬件實現(xiàn)和μC/OS-Ⅱ嵌入式實時操作系統(tǒng)的軟件開發(fā),設(shè)計了小型靶機超低空掠海飛行高度控制器,其結(jié)構(gòu)簡單緊湊,原理可行。半實物仿真實驗結(jié)果表明,系統(tǒng)具有良好的靜、動態(tài)響應(yīng)特性,完全能夠?qū)崿F(xiàn)對靶機超低空高精度掠海定高飛行的控制,系統(tǒng)設(shè)計和軟硬件實現(xiàn)都是成功的。

參考文獻

[1]馮密榮,毛澤孝,劉志紅.世界無人機大全[M].北京:航空工業(yè)出版社,2004.

[2]劉波,何清華,鄒湘伏.無人機飛行控制技術(shù)初探[J].飛行力學(xué),2007(2):64-65.

[3]吳森堂,費玉華.飛行控制系統(tǒng)[M].北京:北京航空航天大學(xué)出版社,2005.

[4]高建堯,盧京潮,閻建國.某型無人機導(dǎo)航飛控系統(tǒng)設(shè)計與仿真[J].計算機測量與控制,2006,14(6):759-760.

[5]汪洋亮,王國勝,李中良.基于PID的高速無人機高度控制系統(tǒng)設(shè)計[J].艦船電子工程,2009(2):16-18.

[6]孫興宏,閻建國,秦瑋.某型無人機的飛控系統(tǒng)設(shè)計[J].計算機測量與控制,2007,15(9):1 192-1 193.

[7]梅勁松,屈薔.基于互補濾波的全數(shù)字拖靶高度控制系統(tǒng)[J].南京航空航天大學(xué)學(xué)報,2008,32(1):65-68.

[8]金岳,宋金來,王維軍.跟蹤微分器在某無人機定高控制律設(shè)計中的應(yīng)用[J].飛行力學(xué),2008(3):37-38.

[9]胡延霖,蘇永振,陳暉.基于ARM的無人機飛行控制系統(tǒng)的硬件實現(xiàn)[J].戰(zhàn)術(shù)導(dǎo)彈技術(shù),2006(1):79-83.

[10]于秀萍,王超.基于ARM的嵌入式飛行控制計算機系統(tǒng)設(shè)計[J].微計算機信息,2009,24(5):34-35.