基于機載光電成像系統(tǒng)光學鉸鏈離軸的伺服抗擾算法設計

白志剛，戴凌冉，吳 曄，鐘 寧，楊光海

(1.空裝駐成都地區(qū)第五軍事代表室，成都 610041; 2.西南技術物理研究所，成都 610041)

0 引言

機載光電成像系統(tǒng)(以下簡稱系統(tǒng))安裝于飛機上，用于對地面或空中目標進行搜索、識別、跟蹤和指示、偵查、評估、取證等，具有廣泛的應用領域，從機載光電成像系統(tǒng)的使用上看，一方面要求系統(tǒng)具有穩(wěn)定的控制，另一方面也要求具有高精度的跟蹤性能。小型化是其未來發(fā)展的方向之一，本文所涉及的系統(tǒng)即為一款小型化系統(tǒng)，該系統(tǒng)主要包含光學系統(tǒng)、光電探測器、二軸伺服控制系統(tǒng)等。為減小系統(tǒng)的外形尺寸，采用了光學鉸鏈與伺服框架軸非正交的離軸設計，部分光路既不與框架軸平行，也不與框架軸垂直，給光軸指向控制及卸載飛機擾動的穩(wěn)定控制帶來了一定的困難，本文著重從穩(wěn)定控制的角度給出抗飛機角運動擾動的算法推導及實驗室驗證情況。

1 系統(tǒng)概述

1.1 光電成像系統(tǒng)分類

光電成像系統(tǒng)是通過相應光學器件把景物成像于光電接收器上，是一個對整個機載探測系統(tǒng)性能有著極其重要影響的系統(tǒng)。系統(tǒng)按照對應接收光的波長范圍可以分為可見光系統(tǒng)、紫外光系統(tǒng)、紅外光系統(tǒng)和X光系統(tǒng)；按照光學物鏡系統(tǒng)可以分為折射式系統(tǒng)、反射式系統(tǒng)和折反式系統(tǒng)。本文所討論的光電成像系統(tǒng)采用的是反射式光學系統(tǒng)。

1.2 系統(tǒng)光學鉸鏈離軸特點

在本系統(tǒng)中，入射的近似平行光經(jīng)二維掃描反射鏡(以下簡稱一反)反射進入固定反射鏡(以下簡稱二反)，光線經(jīng)二反反射進入光學鏡頭及光電探測器，再通過伺服控制系統(tǒng)驅(qū)動一反運動。該伺服控制系統(tǒng)為航向、俯仰兩軸正交結(jié)構(gòu)，航向框架為外框架，俯仰框架為內(nèi)框架。當伺服框架運動時，帶動一反圍繞一反鏡面中心進行航向、俯仰二自由度轉(zhuǎn)動，從而將外部不同空間角度上的景物經(jīng)由固定反射鏡(二反)反射到光電探測器[1]。本系統(tǒng)安裝到載機上后，伺服航向軸與載機航向軸平行，伺服俯仰軸平行于一反鏡面且位于鏡面內(nèi)，伺服航向軸處于零位時伺服俯仰軸與載機俯仰軸平行。

通常基于反射式光學系統(tǒng)的伺服平臺設計都是一反入射光與內(nèi)框軸垂直，同時一反出射光與外框軸平行。由于本系統(tǒng)后端長度尺寸受載機結(jié)構(gòu)空間限制，光電成像系統(tǒng)在結(jié)構(gòu)設計上進行了特殊處理，將一反中心與二反中心連線相對伺服航向軸前傾30°，在一反相對載機位置不變的情況下將光學鏡頭和光電探測器向前布局，適當利用了載機前端富余空間，減小了系統(tǒng)后端長度方向的尺寸，但由此帶來伺服航向軸與一反出射光不平行的問題，即所謂的“光學鉸鏈離軸”問題，此時航向、俯仰框架軸的運動形成耦合，不能形成單通道獨立控制，相應地，在系統(tǒng)伺服控制上需要進行匹配設計和額外的算法處理。

系統(tǒng)光路及伺服框架軸的關系如圖1所示，結(jié)構(gòu)三維模型剖視圖如圖2所示。

圖1 光電成像系統(tǒng)光路與框架軸關系示意圖

圖2 結(jié)構(gòu)三維模型剖視圖

1.3 系統(tǒng)控制回路特點

由于系統(tǒng)的外形尺寸的限制，在光學鉸鏈離軸的條件下，系統(tǒng)控制回路只能采取半捷聯(lián)設計方案[2-4]，取消了速率陀螺元件，通過對慣導姿態(tài)信息進行數(shù)學解算達到控制目的，但保留了與陀螺穩(wěn)定平臺相同的伺服框架，其穩(wěn)定控制回路(單通道)構(gòu)成如圖3所示。與通常陀螺信號反饋的直接穩(wěn)定回路相比，該回路有兩點不同，一是反饋信號使用的是經(jīng)微分處理后的伺服框架角信號，即框架角速度；二是指令信號中疊加了經(jīng)抗擾算法處理的飛機載體三軸角速度信號?？蚣芙撬俣鹊墨@取可以采用數(shù)字差分方法，也可采用TD跟蹤微分算法等其它方法，但需要注意所需信號帶寬的截取，同時，由于采用微分處理方式，得到的框架角速度信號在某些固定頻率點存在一定的放大，需要數(shù)字陷波器對其進行抑制；抗擾算法處理則將當前載體三軸角速度結(jié)合伺服框架角解算出卸載載體擾動所需要的框架角速度，并與外回路給定的慣性空間“角速度指令”疊加，共同作為穩(wěn)定回路的期望值，為了達到良好的穩(wěn)定精度，需要對微分算法模塊輸出的框架角速度信號與抗擾算法輸出的期望框架角速度信號進行匹配濾波，使兩者在幅頻、相頻特性盡可能逼近。

圖3 光電成像系統(tǒng)穩(wěn)定控制回路圖

本文以下介紹的重點內(nèi)容為圖3中“抗擾算法”部分。

2 抗擾算法設計

2.1 坐標系及符號定義

為方便進行運動學分析和抗擾算法推導，對本機載光電成像系統(tǒng)定義如下坐標系：

載體坐標系o1x1y1z1——與載體固聯(lián)的坐標系，原點o1位于載體質(zhì)心，o1x1軸與載體縱對稱軸一致且指向頭部，o1y1軸垂直于o1x1軸且在載體縱對稱面內(nèi)指向上方，o1x1y1z1構(gòu)成右手正交坐標系；

一反坐標系oTxTyTzT——與一反固聯(lián)的坐標系，原點oT為一反中心點，oTxT軸與一反法線重合且垂直鏡面向外，oTzT軸與俯仰框架軸平行指向右方，oTyT軸平行于鏡面向上，oTxTyTzT構(gòu)成右手正交坐標系。

視線坐標系OXLYLZL——與一反入射光固聯(lián)的坐標系，由載體坐標系o1x1y1z1依次旋轉(zhuǎn)航向視線角αL和俯仰視線角φL得到，原點O為一反中心點，OXL軸與一反入射光重合且指向外，OZL軸在所在平面內(nèi)指向右方，OYL軸指向上方，OXLYLZL構(gòu)成右手正交坐標系。

定義如下符號及矩陣：

(1)

Tα為載體坐標系到視線坐標系的方位旋轉(zhuǎn)矩陣；

(2)

(3)

(4)

2.2 算法設計原理及推導思路

1)將光路中所有光線矢量統(tǒng)一到視線坐標系OXLYLZL下，該坐標系由載體坐標系繞OYL軸旋轉(zhuǎn)航向視線角αL后再繞OZL軸旋轉(zhuǎn)俯仰視線角φL得到，其OXL軸與一反入射光平行，指向前方；

2)分別考慮一反法線繞航向框架軸轉(zhuǎn)動微量角度△α和繞俯仰框架軸轉(zhuǎn)動微量角度△φ，將方位、俯仰框架軸的2次轉(zhuǎn)動進行合成(由于是微量轉(zhuǎn)動，所以不考慮轉(zhuǎn)序的影響，進而直接將2次轉(zhuǎn)動進行線性疊加)，合成的結(jié)果除以△t并取極限，得到光軸角度變化速度[5]；

3)伺服系統(tǒng)控制光軸穩(wěn)定的目標是將視線坐標系OXLYLZL下的載體角速度OYL軸分量和OZL軸分量分別與一反出射光角速度沿OYL軸和OZL軸的分量大小相等，方向相反，即令兩者矢量和為零，因此，在構(gòu)成控制回路時，以前者為期望值，以后者為反饋值，形成負反饋控制回路，回路采用合適的校正環(huán)節(jié)將兩者之間的誤差控制到最??；

4)所有矢量按照單位矢量考慮，且因為矢量是有方向性的，所以，后續(xù)推導得到的光軸角度變化速度必須用初始矢量叉乘才是最終的光軸轉(zhuǎn)動角速度。

5)推導過程中應用的主要公式為矢量繞定軸微量轉(zhuǎn)動公式和反射定律矢量表達式：

矢量繞定軸微量轉(zhuǎn)動公式如下:

(5)

反射定律矢量表達式如下:

(6)

2.3 抗擾算法推導

2.3.1 將矢量統(tǒng)一到視線坐標系下

(7)

(8)

(9)

(10)

(11)

2.3.2 推導過程

(12)

(13)

(14)

再次應用反射定律矢量表達式，求得一反法線經(jīng)微量轉(zhuǎn)動后形成的一反入射光新的矢量分別為:

(15)

(16)

(17)

略去二階小量，得到:

(18)

同理可得，一反法線繞軸旋轉(zhuǎn)角形成的新一反出射光矢量相對于初始矢量變化為:

(19)

兩次轉(zhuǎn)動(微量轉(zhuǎn)動可忽略轉(zhuǎn)序)形成的矢量增量為:

(20)

已知條件中均為單位矢量，則可以用如下叉乘運算來求取入射光角速度矢量:

(21)

展開如下:

(22)

(23)

定義如下變量，以簡化角速度表達式:

(24)

(25)

(26)

(27)

(28)

簡化角速度表達式如下:

(29)

進一步定義變量:

(30)

(31)

角速度表達式進一步簡化為:

(32)

(33)

從而，解得:

(34)

進一步簡化，令:

C=VφyVαz-VφzVαy

(35)

得到伺服抗載體角運動擾動的框架角速度期望值:

(36)

2.3.3 推導結(jié)果小節(jié)

經(jīng)過以上推導，給出了實現(xiàn)本系統(tǒng)半捷聯(lián)穩(wěn)定所需要的角速度(ωφ、ωα)與載體角速度(ωdx,ωdy,ωdz)、伺服框架角(α、φ)和框架角速度(ωα、ωφ)的關系式(36)，在略去了高階分量后，表達式形式上為一線性表達式，式中各項系數(shù)均可以通過簡單的乘加運算得出，所需步驟也不多，移植到DSP上進行處理后運行速度和效率均較高，能夠滿足工程應用。

3 驗證與評估

將上述算法實現(xiàn)到實際的機載光電成像系統(tǒng)樣機上后，將系統(tǒng)裝夾到五軸轉(zhuǎn)臺進行穩(wěn)定精度測試，系統(tǒng)工作于半捷聯(lián)穩(wěn)定回路閉環(huán)狀態(tài)，令轉(zhuǎn)臺航向、俯仰軸同時施加1°、2 Hz正弦復合擾動，系統(tǒng)航向、俯仰通道輸出的空間角誤差如圖4～圖5所示，光電成像系統(tǒng)航向、俯仰兩通道的穩(wěn)定精度均在0.02°以內(nèi)，對比相似結(jié)構(gòu)采用陀螺信號反饋的直接穩(wěn)定控制回路方案，具有相當?shù)木取?/p>

圖5 光電成像系統(tǒng)俯仰穩(wěn)定精度測試曲線

該測試結(jié)果表明，系統(tǒng)穩(wěn)定控制回路設計、抗擾算法設計和實現(xiàn)正確，系統(tǒng)達到了良好的穩(wěn)定精度。

將系統(tǒng)裝夾到振動臺進行振動環(huán)境適應性測試，施加圖6所示隨機振動譜，系統(tǒng)通電工作正常。進一步提高振動量級，系統(tǒng)出現(xiàn)功耗增大現(xiàn)象，大小與振動量級呈正相關。經(jīng)分析，由于系統(tǒng)與振動臺之間通過減振器非剛性連接，振動臺的線運動受系統(tǒng)質(zhì)心偏離支點影響對系統(tǒng)產(chǎn)生附加的高頻、微量角擾動，被載體三軸陀螺所敏感，并通過抗擾算法轉(zhuǎn)換為穩(wěn)定回路的期望角速度，穩(wěn)定回路以其為指令控制伺服框架抑制振動臺施加的附加角擾動，但由于光學鉸鏈離軸設計，控制過程中光軸旋轉(zhuǎn)的角度與伺服框架旋轉(zhuǎn)的角度不等，在振動過程中電機必須輸出力矩以維持光軸的空間指向，而穩(wěn)定回路帶寬和諧振峰較高(-3 dB帶寬達到約60 Hz，諧振峰7 dB)，由此產(chǎn)生一定的諧振[6-10]，造成系統(tǒng)功耗增大。經(jīng)調(diào)整穩(wěn)定回路校正參數(shù)降低回路諧振峰后，再次進行振動試驗，同量級下功耗增加明顯減小。

圖6 光電成像系統(tǒng)隨機振動譜

因此，對于光學鉸鏈離軸設計的機載伺服系統(tǒng)，需要與系統(tǒng)結(jié)構(gòu)重心、支點位置、減振器減振特性、載機振動環(huán)境條件[11]等匹配設計，才能更好地適應實際應用環(huán)境，但就抗擾算法本身而言，不存在環(huán)境適應性的問題。

4 結(jié)論

1)機載光電成像系統(tǒng)光學鉸鏈離軸情況下存在伺服系統(tǒng)航向、俯仰通道運動耦合而不能獨立控制，伺服穩(wěn)定控制回路設計本質(zhì)上需要使用半捷聯(lián)設計方案；

2)抗擾算法基于矢量繞定軸微量轉(zhuǎn)動公式和反射定律矢量表達式推導得出，經(jīng)過轉(zhuǎn)臺動態(tài)測試表明，算法設計和實現(xiàn)正確；

3)使用本抗擾算法的機載光電成像系統(tǒng)經(jīng)過轉(zhuǎn)臺動態(tài)測試，穩(wěn)定精度與傳統(tǒng)方案相當；

4)光學鉸鏈離軸情況下的伺服平臺系統(tǒng)，對于振動環(huán)境的適應性需要額外的設計考慮，以減小系統(tǒng)諧振和功耗的增加。