大俯仰角度的兩軸兩框架平臺穩(wěn)定技術(shù)

李紅光，紀(jì) 明，吳玉敬，郭新勝，彭 俠

(西安應(yīng)用光學(xué)研究所, 陜西 西安 710065)

?

大俯仰角度的兩軸兩框架平臺穩(wěn)定技術(shù)

李紅光，紀(jì) 明，吳玉敬，郭新勝，彭 俠

(西安應(yīng)用光學(xué)研究所, 陜西 西安 710065)

為了解決大俯仰角度方位平臺穩(wěn)定性能降低的問題，利用兩軸兩框架穩(wěn)定平臺穩(wěn)定原理，分析在傳統(tǒng)方位陀螺安裝方式下，大俯仰角度時方位平臺穩(wěn)定性能降低的原因以及正割補(bǔ)償帶來的噪聲等問題，提出在方位平臺上安裝2個正交的方位、橫滾陀螺，解算出瞄準(zhǔn)線方位慣性角速度，從而實(shí)現(xiàn)大俯仰角度下的方位穩(wěn)定控制方法。仿真實(shí)驗驗證了該方法可以提升大俯仰角度下兩軸兩框架平臺的方位穩(wěn)定控制性能，減小陀螺噪聲對控制性能的影響，在同等條件下，方位穩(wěn)定誤差峰峰值由450 urad減小為250 urad。

光電穩(wěn)定平臺；兩軸平臺；大俯仰角度；瞄準(zhǔn)線角速度

引言

目前，光電系統(tǒng)普遍采用的穩(wěn)定平臺是兩軸結(jié)構(gòu)，包括兩軸兩框架和兩軸四框架，其中兩軸兩框架以其機(jī)構(gòu)簡單、成本低、體積小等特點(diǎn)，應(yīng)用十分廣泛。兩軸兩框架穩(wěn)定平臺通常采用兩只陀螺作為慣性速率傳感器，均安裝在俯仰平臺上，且2個敏感軸和光軸均正交，陀螺數(shù)據(jù)分別通過方位、俯仰控制電路驅(qū)動方位、俯仰電機(jī)，形成速率閉環(huán)，從而實(shí)現(xiàn)光電系統(tǒng)的穩(wěn)定。從某些光電系統(tǒng)的戰(zhàn)術(shù)指標(biāo)來看，在穩(wěn)定平臺俯仰角度很大時仍需要正常瞄準(zhǔn)跟蹤目標(biāo)，而此時兩軸兩框架穩(wěn)定平臺的方位軸的穩(wěn)定性能降低，穩(wěn)定指標(biāo)已經(jīng)無法滿足系統(tǒng)要求[1-2]。本文在分析兩軸兩框架穩(wěn)定平臺穩(wěn)定原理的基礎(chǔ)上，針對該問題，提出了利用兩只陀螺分別測量方位轉(zhuǎn)臺的方位軸與橫滾軸的擾動速率，通過解算代替原來方位陀螺，實(shí)現(xiàn)方位平臺的速率閉環(huán)控制，實(shí)現(xiàn)在俯仰角度很大時方位平臺穩(wěn)定性能基本保持不變。

本文通過簡述兩軸兩框架穩(wěn)定平臺穩(wěn)定原理，分析大俯仰角度時方位平臺穩(wěn)定性能降低的原因以及正割補(bǔ)償帶來的問題，通過理論分析，提出了在方位平臺上安裝方位陀螺、橫滾陀螺實(shí)現(xiàn)瞄準(zhǔn)線慣性速度測量，然后在方位控制回路加入正割補(bǔ)償，從而實(shí)現(xiàn)光電系統(tǒng)瞄準(zhǔn)線的穩(wěn)定，最后通過仿真實(shí)驗驗證了該方法的能夠提升大俯仰角度下兩軸兩框架平臺的方位穩(wěn)定控制性能，減小陀螺噪聲對控制性能的影響。

1 兩軸兩框架穩(wěn)定平臺穩(wěn)定原理簡述

1.1 建立坐標(biāo)系

在進(jìn)行討論之前，先建立兩軸兩框架穩(wěn)定平臺的坐標(biāo)體系。

系統(tǒng)的結(jié)構(gòu)與坐標(biāo)的定義如圖1所示。圖中

圖1 反射鏡穩(wěn)定的坐標(biāo)系示意圖Fig.1 Schematic diagram of coordinates for mirror stabilization

1.2 穩(wěn)定原理簡述

系統(tǒng)的結(jié)構(gòu)與坐標(biāo)系定義如圖1所示，通常陀螺直接安裝于俯仰平臺上，其2個敏感軸與光軸正交。各個坐標(biāo)系相對運(yùn)動關(guān)系如圖2所示。

圖2 坐標(biāo)系相對關(guān)系示意圖Fig.2 Schematic diagram of coordinates relation

設(shè)方位平臺相對載體轉(zhuǎn)動角度為θA，載體干擾角速度耦合到方位平臺坐標(biāo)系的方程為

(1)

設(shè)俯仰平臺相對方位平臺轉(zhuǎn)動角度為θE，方位平臺對俯仰平臺的耦合關(guān)系為

(2)

由于光軸坐標(biāo)系和俯仰平臺坐標(biāo)系時刻保持一致，因此方位平臺對光軸坐標(biāo)系的耦合關(guān)系為

(3)

將(3)式展開，將(1)式代入，可以得到視軸的方位和俯仰速度表達(dá)式:

(4)

陀螺敏感安裝在俯仰平臺上，用來測量瞄準(zhǔn)線方位角速度和俯仰角速度，設(shè)陀螺敏感量分別為ωgY和ωgZ，則有：

(5)

由于光學(xué)傳感器固定安裝在俯仰平臺上，方位、俯仰陀螺測量得到的結(jié)果就是光軸的慣性方位和俯仰角速度，用陀螺信號進(jìn)行反饋，通過控制器控制方位、俯仰電機(jī)轉(zhuǎn)動，使得光軸的方位角速度ωLY、俯仰角速度ωLZ等于零，實(shí)現(xiàn)光軸慣性空間方位、俯仰的穩(wěn)定控制[3-5]。

2 大俯仰角時方位性能降低的原因

就方位閉環(huán)控制系統(tǒng)來看，方位陀螺隨俯仰軸轉(zhuǎn)動，敏感光軸方位軸的擾動信號，通過方位控制電路控制方位電機(jī)，形成速率閉環(huán)，實(shí)現(xiàn)方位軸穩(wěn)定，此時的方位控制框圖[6]如圖3所示。當(dāng)俯仰角度為零時，方位電機(jī)軸和方位陀螺敏感軸平行，方位陀螺的數(shù)據(jù)即是方位電機(jī)的轉(zhuǎn)動速度；當(dāng)俯仰轉(zhuǎn)動θE時，由于方位陀螺隨俯仰平臺轉(zhuǎn)動，此時方位陀螺測得的數(shù)據(jù)是方位電機(jī)轉(zhuǎn)速的一個分量，即方位電機(jī)轉(zhuǎn)速的cosθE倍，從控制理論來講，方位速率閉環(huán)控制回路的總增益系數(shù)降低，方位控制性能下降。

圖3 方位控制框圖Fig.3 Block diagram of azimuth control

在兩種情況下，方位控制回路開環(huán)波特圖如圖4所示，圖中無標(biāo)識曲線為俯仰角度為0°時方位控制系統(tǒng)開環(huán)波特圖，在10Hz處幅頻特性值9.76dB；圖中標(biāo)×曲線為俯仰角度為30°時，方位控制系統(tǒng)開環(huán)波特圖，在10Hz處幅頻特性8.5dB，前者總增益是后者總增益的1.154 78倍，如果俯仰角度增大，兩者相差更大，但兩者的相頻特性相同。

圖4 俯仰在不同位置時方位回路開環(huán)波特圖Fig.4 Bode plot of azimuth open loop at different pitching positions

因此，俯仰角度較大時，兩軸兩框架穩(wěn)定平臺需要對方位速率閉環(huán)回路進(jìn)行正割補(bǔ)償，此時的方位控制框圖如圖5所示，在任意俯仰角度下，方位控制回路的開環(huán)特性曲線如圖6所示，與沒有正割補(bǔ)償時俯仰處于零位的方位控制回路的開環(huán)特性曲線相同。通常，為了獲得很好的控制性能，在俯仰角度為零時，假設(shè)方位回路的增益選擇最佳值，如果對方位回路直接進(jìn)行正割補(bǔ)償，不同俯仰角度下整個閉環(huán)系統(tǒng)對陀螺數(shù)據(jù)的放大系數(shù)不同，由于陀螺噪聲的存在[7]，造成方位控制性能并沒有明顯好轉(zhuǎn)，尤其是在俯仰角度較大時，極易出現(xiàn)方位控制閉環(huán)不穩(wěn)定現(xiàn)象。

圖5 正割補(bǔ)償方位控制框圖Fig.5 Block diagram of azimuth control with secant compensation

圖6 正割補(bǔ)償?shù)姆轿豢刂苹芈烽_環(huán)特性曲線 Fig.6 Open loop characteristic curve of azimuth control with secant compensation

因此，需要尋找一種光軸慣性速率的測量方法及方位閉環(huán)控制方法，既能測量出光軸的方位速率數(shù)據(jù)，又保證在控制回路中加入正割補(bǔ)償后不會造成陀螺噪聲被放大。

3 大俯仰角穩(wěn)定平臺方位控制回路設(shè)計方法

3.1 瞄準(zhǔn)線慣性速率測量方法

根據(jù)上述兩軸兩框架穩(wěn)定原理的分析，依據(jù)公式(1)、公式(2)和公式(3)，可以得到瞄準(zhǔn)線的慣性空間下的速度表達(dá)式為

ωLZ=ωAX·sinθE+ωAZ·cosθE

(6)

因此，考慮在方位平臺上安裝兩只陀螺，在俯仰平臺上安裝一只陀螺，代替?zhèn)鹘y(tǒng)穩(wěn)定平臺中俯仰平臺的兩只陀螺。方位平臺上的兩只陀螺正交，測量方位平臺的ωAX和ωAZ，即方位平臺的方位速率和橫滾速率，然后由(6)式求解出瞄準(zhǔn)線方位速率ωLZ，代替原來的方位陀螺ωgZ。俯仰平臺上的陀螺測量瞄準(zhǔn)線俯仰速率ωLY的方法與傳統(tǒng)的測量方法相同，俯仰控制回路也不變。因此，本文只研究方位控制回路設(shè)計方法。

3.2 方位控制回路設(shè)計方法

方位控制回路框圖如圖7所示，控制回路由控制器、電機(jī)、方位平臺及負(fù)載、方位陀螺、橫滾陀螺、瞄準(zhǔn)線速度解算模塊、正割補(bǔ)償構(gòu)成。

圖7 方位控制回路框圖Fig.7 Block diagram of azimuth control loop

依據(jù)公式(6)求出瞄準(zhǔn)線方位速率，在控制回路中對其進(jìn)行正割補(bǔ)償，即

secθE·ωLZ=secθE·(ωAX·sinθE+

ωAZ·cosθE)=tgθE·ωAX+ωAZ

(7)

式中ωAX和ωAZ分別為方位平臺上兩只陀螺的輸出。從公式(7)可以看出，在正割補(bǔ)償后，方位平臺上的方位陀螺ωAZ的噪聲的放大倍率并沒有變化，而方位平臺上的橫滾陀螺ωAX的噪聲放大了tanθE倍，而在俯仰角度θE小于45°時，tanθE<1，相當(dāng)于橫滾陀螺ωAX的噪聲并沒有放大反而減小。利用兩種測速方法得到瞄準(zhǔn)線方位角速率經(jīng)過整個補(bǔ)償后的波形如圖8和圖9所示，此時俯仰角度為30°，測試時瞄準(zhǔn)線方位軸與速率轉(zhuǎn)臺的旋轉(zhuǎn)軸平行，速率轉(zhuǎn)臺轉(zhuǎn)動速率為5°/s，傳統(tǒng)方法測量的瞄準(zhǔn)線角速度均值為5.044 4°/s，利用兩只正交陀螺測量的瞄準(zhǔn)線角速度為5.043 2°/s，比較圖8和圖9比較可以看出，正割補(bǔ)償后傳統(tǒng)方法測量的瞄準(zhǔn)線速率信號白噪聲較大。

圖8 傳統(tǒng)測速量的瞄準(zhǔn)線方位速度Fig.8 Azimuth velocity of LOS measured by tradition method

圖9 兩只陀螺測量的瞄準(zhǔn)線方位速度Fig.9 Azimuth velocity of LOS measured by two gyros

因此，上述瞄準(zhǔn)線慣性速率測量方式，在對方位控制系統(tǒng)進(jìn)行正割補(bǔ)償時，避免了方位控制系統(tǒng)中陀螺噪聲對控制性能的影響；此時俯仰控制系統(tǒng)沒有變化，保證了整個系統(tǒng)的穩(wěn)定性能。

4 方位控制回路仿真

圖10 方位控制回路仿真模型圖Fig.10 Simulation diagram of azimuth control loop

圖11 方位控制回路開環(huán)波特圖Fig.11 Bode plot of azimuth control open loop

圖10中輸入點(diǎn)In為系統(tǒng)指令輸入點(diǎn)，輸入點(diǎn)In1為方位平臺的橫滾擾動，仿真時采用1hz正弦選信號。子系統(tǒng)Gsub為摩擦力矩生成模型，載體擾動在方位平臺方位向的分量通過此模型轉(zhuǎn)換為擾動力矩進(jìn)入模型，其輸入為平臺運(yùn)動速度和最大靜態(tài)摩擦力矩[9-10]，其輸出波形如圖12所示。Noise為陀螺信號的噪聲，如圖13所示。

圖12 摩擦力矩波形Fig.12 Waveform of friction moment

圖13 陀螺噪聲波形Fig.13 Waveform of gyro noise

仿真時俯仰角度為1rad，其穩(wěn)定誤差曲線如圖14所示，圖中LOS2曲線為利用傳統(tǒng)安裝方式

圖14 穩(wěn)定誤差比較Fig.14 Comparison of stabilized error

的方位陀螺作為瞄準(zhǔn)線慣性速度傳感器時，方位軸的穩(wěn)定誤差曲線，其峰峰值為450μrad。LOS1曲線為同等條件下，在方位平臺上安裝方位和橫滾陀螺作為瞄準(zhǔn)線的慣性速度傳感器時，方位向的穩(wěn)定誤差曲線，LOS1誤差曲線明顯小于LOS2誤差曲線，其穩(wěn)定誤差峰峰值在250μrad以內(nèi)。

5 結(jié)束語

本文從兩軸兩框架穩(wěn)定平臺穩(wěn)定原理出發(fā)，分析在傳統(tǒng)方位陀螺安裝方式下，大俯仰角度時方位平臺穩(wěn)定性能降低的原因以及方位控制回路對方位陀螺信號正割補(bǔ)償帶來的問題，提出通過在方位平臺上安裝兩只正交的方位、橫滾陀螺，解算出瞄準(zhǔn)線方位慣性角速度的方法，通過正割補(bǔ)償，實(shí)現(xiàn)大俯仰角度下的穩(wěn)定控制。理論分析及仿真結(jié)果表明，本文提出的方法滿足在慣性空間下兩軸兩框架光電系統(tǒng)瞄準(zhǔn)線速度測量需求，在大俯仰角度下，方位控制回路的性能幾乎沒有變化，而且避免了正割補(bǔ)償帶來的控制回路噪聲問題，較傳統(tǒng)陀螺安裝方式下的方位穩(wěn)定性能有所提升，從而實(shí)現(xiàn)了大俯仰角度下光電系統(tǒng)瞄準(zhǔn)線的穩(wěn)定。該方法瞄準(zhǔn)線的慣性速度是依據(jù)俯仰角度對方位陀螺、橫滾陀螺解算得到，因此，系統(tǒng)對俯仰角度測量精度提出了一定的要求。

[1]WangHui,BianShuancheng.Studyonstabilizationtechnologyforgyroscpe-stabilizedplatformunderlargepintchingangle[J].MicrocomputerInformation, 2012,28(6):32-33. 王輝,邊栓成.兩軸穩(wěn)定平臺大俯仰角狀態(tài)控制技術(shù)研究[J].微計算機(jī)信息, 2012,28(6):32-33.

[2]DongXiaomeng,ZhangPing.Zenithblindzoneoftwo-axisstabilizedplatform[J].JournalofBeijingUniversityofAeronauticsandAstronautics, 2007,33(7):811-815. 董小萌,張平.兩軸穩(wěn)定平臺的過頂盲區(qū)問題[J].北京航空航天大學(xué)學(xué)報, 2007,33(7):811-815.

[3]FanDapeng,ZhangZhiyong,FanShixun,etal.ResearchofbasicprinciplesofE-Ostabilizationandtrackingdevices[J].OpticsandPrecisionEngineering, 2006,14(4):673-679. 范大鵬,張智永,范世珣,等.光電穩(wěn)定跟蹤裝置的穩(wěn)定機(jī)理分析研究[J].光學(xué)精密工程, 2006,14(4):673-679.

[4]HilkertJM.InertiallyStabilizedplatformtechnology[J].IEEE, 2008,28(1):26-46.

[5]JiMing.Isolationandcompensationofmovementforstabiliztionoptics-electricalsystemwithhighaccuracy[J].ActaArmamentarii, 1996, 17(4):320-324. 紀(jì)明. 高精度光電二級穩(wěn)定系統(tǒng)的運(yùn)動隔離與補(bǔ)償分析[J].兵工學(xué)報,1996,17(4):320-324.

[6]ZhangZhiyong,FanDapeng,FanShixun.ServosystemdesignforE-Ostabilizationandtrackingdevices[J].OpticsandPrecisionEngineering, 2006,14(4):681-690. 張智永，范大鵬，范世詢.光電穩(wěn)定跟蹤裝置的控制系統(tǒng)設(shè)計[J].光學(xué)精密工程,2006,14(4):681-690.

[7]JiMing.Simulationanderroranalysisofmirrorstabilizedsystem[J].JournalofAppliedOptics, 2000,21(5):19-22. 紀(jì)明.反射鏡穩(wěn)定系統(tǒng)的仿真與誤差分析[J].應(yīng)用光學(xué),2000,21(5):19-22.

[8]WuYujing,JiMing.Compensationtechnologyforhighvelocitytrackingofelectro-opticalpod[J].JournalofAppliedOptics,2006,27 (4):293-297. 吳玉敬,紀(jì)明.光電吊艙大速率平穩(wěn)跟蹤補(bǔ)償技術(shù)研究[J].應(yīng)用光學(xué),2006,27 (4):293-297.

[9]WangShijing,YangMing,DongHao.Variablestructurecontrolbasedonstabilizedplatformconsideringfrictioncharacteristic[J].ComputerSimulation, 2009,26(5):332-336. 王石靜,楊明,董浩.考慮摩擦特性的穩(wěn)定平臺變結(jié)構(gòu)控制研究[J]. 計算機(jī)仿真,2009,26(5):332-336.

[10]XunQingqing,WuYujing,ZhangJingyue,etal.ResearchonmodelingofstabilizedaimcontrolsystembasedondSPACE[J].ActaArmamentarii,2011,11:1423-1427. 胥青青，吳玉敬，張璟玥，姜世洲.基于dSPACE平臺的穩(wěn)瞄控制系統(tǒng)建模方法研究[J].兵工學(xué)報,2011,11:1423-1427.

Stabilization technology for two-axis two-framework platformwith big pitching angle

Li Hongguang,Ji Ming,Wu Yujing,Guo Xinsheng,Peng Xia

(Xi’an Institue of Applied Optics, Xi’an 710065, China)

In order to resolve the issue of azimuth platform stability depressing, by using the stabilization principle of two-axis two-framework platform, the reason for the stability depressing and the noise caused by secant compensation of azimuth platform were analyzed,which worked in big pitching angle with azimuth gyro of tradition fixing mode. We proposed to install an azimuth gyro and a roll gyro,which were orthogonal, on the azimuth platform to calculate the inertial azimuth angle velocity of line of sight,and realized the controlling method of azimuth stability with big pitching angle. Simulation experiment validates that, the azimuth stability controlling performance of the two-axis two-framework platform with big pitching angle can be advanced and the influence of gyro noise on the controlling performance can be depressed by using the method. Under the same conditions, the peak-to-peak error of azimuth stabilization can reduce form 450 urad to 250 urad.

EO stabilization platform ; two axes platform; big pitching angle; angle velocity of line of sight

1002-2082(2015)06-0823-06

2015-07-20；

2015-09-23

李紅光(1983-)，男，山東巨野人，博士研究生，主要從事光電系統(tǒng)及穩(wěn)定跟蹤技術(shù)研究。

E-mail：redlight007@163.com

TN29

A

10.5768/JAO201536.0601001