《電子技術(shù)應(yīng)用》
您所在的位置:首頁(yè) > 嵌入式技術(shù) > 設(shè)計(jì)應(yīng)用 > 航空相機(jī)穩(wěn)定平臺(tái)控制算法設(shè)計(jì)及其像移補(bǔ)償
航空相機(jī)穩(wěn)定平臺(tái)控制算法設(shè)計(jì)及其像移補(bǔ)償
來源:電子技術(shù)應(yīng)用2012年第9期
張振東1,2,徐 濤1,李 博1,劉廷霞1
1.中國(guó)科學(xué)院長(zhǎng)春光學(xué)精密機(jī)械與物理研究所,吉林 長(zhǎng)春130033; 2.中國(guó)科學(xué)院研究生院,北京100039
摘要: 飛行過程中飛機(jī)姿態(tài)角速度變化會(huì)對(duì)擺掃式航空相機(jī)產(chǎn)生干擾,另外相機(jī)在拍攝時(shí)飛行方向上的景物與感光介質(zhì)之間存在相對(duì)運(yùn)動(dòng)。為消除姿態(tài)角速度的干擾和前向像移,設(shè)計(jì)了一種基于F28335的機(jī)載相機(jī)兩軸穩(wěn)定平臺(tái)系統(tǒng)。探討了伺服控制系統(tǒng)的算法選擇,介紹了硬件結(jié)構(gòu)和軟件流程。通過搖擺臺(tái)試驗(yàn)證明,該兩軸穩(wěn)定平臺(tái)動(dòng)態(tài)精度高、運(yùn)行可靠,滿足相機(jī)拍攝時(shí)序和精度的要求。
中圖分類號(hào): TP273
文獻(xiàn)標(biāo)識(shí)碼: A
文章編號(hào): 0258-7998(2012)09-0024-04
Design of the aerial camera stable platform and image motion compensation
Zhang Zhendong1,2,Xu Tao1,Li Bo1,Liu Tingxia1
1.Changchun Institute of Optics,Fine Mechanics and Physics,Chinese Academy of Sciences,Changchun 130033,China; 2.Graduate School of Chinese Academy of Sciences,Beijing 100039,China
Abstract: Changs in the attitude angular velocity will interfere with aerial camera in the flight , and there will be relative motion between scene and the photosensitive medium in the direction of flight while shooting, so that the image motion is generated. In order to eliminate the interference of the angular velocity and image motion,the paper designs a airborne two-axis stabilized platform system based on F28335, and probes the selection of the servo control system algorithm, hardware architect ure ,software process deeply. The swing platform test shows that this two-axis stabilized platform meets the requirements of camera timing and accuracy with high dynamic precision , reliable operation.
Key words : aerial camera;stable platform;F28335

    航空相機(jī)在高空?qǐng)?zhí)行拍攝任務(wù)時(shí),像移、曝光量、離焦、圖像傳感器噪聲等因素都會(huì)影響到成像質(zhì)量,其中對(duì)圖像質(zhì)量影響較大的是像移。產(chǎn)生像移的原因有多種,如姿態(tài)角速度變化、載機(jī)的運(yùn)動(dòng)及振動(dòng)等。而載機(jī)的前向運(yùn)動(dòng)及姿態(tài)角速度是前向像移產(chǎn)生的主要原因。兩軸穩(wěn)定平臺(tái)中,橫滾軸的位置閉環(huán)保持相機(jī)橫滾方向垂直地面,克服載機(jī)橫滾角速度對(duì)相機(jī)的干擾。俯仰軸的速度閉環(huán)既要克服載機(jī)俯仰方向的角速度干擾,又要根據(jù)飛行高度和地速進(jìn)行速度回掃補(bǔ)償飛行過程中的前向像移。


    該航空相機(jī)有拍攝和等待兩個(gè)工作狀態(tài)。當(dāng)處于拍攝狀態(tài)時(shí),相機(jī)回掃(俯仰軸),補(bǔ)償前向像移;當(dāng)處于等待狀態(tài)時(shí),相機(jī)保持與水平面垂直。為保證速度回掃和定位時(shí)相機(jī)平臺(tái)的穩(wěn)定,采用速度位置雙閉環(huán)控制方法。在俯仰軸和橫滾軸上分別安裝陀螺和光柵編碼器,陀螺測(cè)量平臺(tái)相對(duì)慣性空間的角速度,把陀螺值反饋到速度閉環(huán)(內(nèi)環(huán))就可以克服載機(jī)姿態(tài)角速度的干擾。位置環(huán)(外環(huán))則根據(jù)編碼器值和上位機(jī)發(fā)來的載機(jī)姿態(tài)角信息來控制相機(jī)與水平面的垂直。
1 穩(wěn)定平臺(tái)工作原理
1.1 穩(wěn)定平臺(tái)功能概述

    航空相機(jī)穩(wěn)定平臺(tái)的任務(wù)是隔離載機(jī)的擾動(dòng),保持穩(wěn)定平臺(tái)的穩(wěn)定,并同時(shí)接收上位機(jī)的指令和飛行參數(shù),實(shí)現(xiàn)相機(jī)的像移補(bǔ)償功能。利用陀螺的“空間測(cè)速機(jī)”功能實(shí)現(xiàn)速度閉環(huán)、隔離載機(jī)擾動(dòng),使相機(jī)在慣性空間內(nèi)保持穩(wěn)定。穩(wěn)定平臺(tái)控制系統(tǒng)工作原理圖如圖1所示,兩軸的工作原理相同。

    根據(jù)相機(jī)的工作狀態(tài)來改變穩(wěn)定平臺(tái)的控制狀態(tài),即當(dāng)相機(jī)處于拍攝狀態(tài)時(shí),控制系統(tǒng)根據(jù)上位機(jī)給定的速高比算出補(bǔ)償速度,并將其作為速度閉環(huán)控制的給定,而陀螺敏感兩軸慣性空間的角速度作為速度閉環(huán)控制的反饋,兩者的差值經(jīng)速度控制器輸出PWM(脈寬調(diào)制)波,經(jīng)功率級(jí)放大后驅(qū)動(dòng)伺服電機(jī),實(shí)現(xiàn)平臺(tái)在慣性空間內(nèi)的穩(wěn)定;當(dāng)相機(jī)處于等待狀態(tài)時(shí),上位機(jī)發(fā)來的載機(jī)姿態(tài)角值(載機(jī)橫滾角和俯仰角)經(jīng)過換算后作為位置閉環(huán)的給定,而兩軸編碼器值作為位置閉環(huán)的反饋,兩者的位置差經(jīng)位置控制器后作為速度環(huán)的給定[3-4]。
    相機(jī)拍照的時(shí)序圖如圖2所示。穩(wěn)定平臺(tái)進(jìn)行像移補(bǔ)償?shù)木唧w過程為:該相機(jī)拍照電平周期為1 s,對(duì)應(yīng)相機(jī)的曝光周期。相機(jī)曝光發(fā)生在200 ms時(shí)刻,持續(xù)時(shí)間為20 ms,到220 ms處曝光結(jié)束。

    穩(wěn)定平臺(tái)需要在相機(jī)曝光瞬間以像移補(bǔ)償速度控制相機(jī)鏡頭向后擺掃,以實(shí)現(xiàn)像移補(bǔ)償。為此,穩(wěn)定平臺(tái)在每個(gè)拍照周期開始時(shí)轉(zhuǎn)入速度環(huán)控制,并在200 ms內(nèi)使速度穩(wěn)定到像移補(bǔ)償速度,其階躍響應(yīng)速度如圖7所示,在200 ms內(nèi)可達(dá)到速度穩(wěn)定。曝光結(jié)束后,穩(wěn)定平臺(tái)檢測(cè)到拍照電平為低,此時(shí)轉(zhuǎn)入位置環(huán)控制將相機(jī)鏡頭返回到垂直向下的位置。
    此后每一個(gè)拍照周期,穩(wěn)定平臺(tái)執(zhí)行相同的動(dòng)作。當(dāng)穩(wěn)定平臺(tái)收到拍照停止指令后,返回至穩(wěn)定工作模式,相機(jī)鏡頭穩(wěn)定到垂直向下位置。
1.2 陀螺采樣的數(shù)字濾波
    陀螺采樣值的精度直接影響速度閉環(huán)的精度,而由于數(shù)據(jù)傳輸過程、電磁干擾和A/D轉(zhuǎn)換精度等原因,其測(cè)量數(shù)據(jù)中不可避免地混入噪聲。為保證平臺(tái)的速度穩(wěn)定精度,需要對(duì)陀螺采樣值進(jìn)行濾波,以減少隨機(jī)噪聲的影響。在高速DSP控制系統(tǒng)中,數(shù)字濾波器相對(duì)模擬濾波器容易實(shí)現(xiàn),而且數(shù)字濾波器具有靈活性、精度高、可靠性高等優(yōu)點(diǎn)。數(shù)字濾波雖然種類繁多,但有些濾波效果很好而算法復(fù)雜,不適合用于實(shí)時(shí)性要求很高的伺服系統(tǒng)中。所以,本系統(tǒng)采用應(yīng)用比較廣泛、效果良好且易于工程實(shí)現(xiàn)的巴特沃斯濾波器。巴特沃斯低通濾波器的幅值響應(yīng)在通帶內(nèi)具有最平坦的特性,且在通帶和阻帶內(nèi)的幅頻特性是單調(diào)變化的。圖3為二階巴特沃斯低通濾波器的幅頻特性,經(jīng)雙線性變化后的Z函數(shù)為:
 
    位置閉環(huán)特性如圖4(b)所示。由圖可知位置回路的閉環(huán)帶寬為84 rad/s(即13.4 Hz)[5]。
2 系統(tǒng)硬件實(shí)現(xiàn)
    兩軸穩(wěn)定平臺(tái)的硬件組成框圖如5所示,包括數(shù)字信號(hào)處理器、可編程邏輯器件、串口接口芯片、陀螺、A/D轉(zhuǎn)換芯片、光柵編碼器、制動(dòng)器和功率級(jí)等。

2.1 信號(hào)處理模塊
    本系統(tǒng)采用TMS320F28335為主控制器,該DSP由TI公司最新推出,具有浮點(diǎn)運(yùn)算能力,其工作主頻為150 MHz,具有34 KB的內(nèi)部RAM、256 KB的內(nèi)部Flash、2個(gè)32 bit的光柵采集計(jì)數(shù)器,可以滿足兩軸穩(wěn)定平臺(tái)的數(shù)據(jù)采集和算法實(shí)現(xiàn)。
2.2 數(shù)據(jù)采集模塊
    兩軸穩(wěn)定平臺(tái)控制系統(tǒng)需要完成兩路光柵編碼器值和兩路陀螺值的采集,并實(shí)現(xiàn)與上位機(jī)的通信。編碼器值的采集是由TMS320F28335(DSP)自帶的外設(shè)QEP來完成,該模塊具有32 bit計(jì)數(shù)器和濾波功能,編碼正交信號(hào)和零位信號(hào)通過RS-422接口芯片與DSP相連;陀螺值的采集是通過外擴(kuò)A/D采樣芯片AD7864來實(shí)現(xiàn)。AD7864轉(zhuǎn)換精度為12 bit,輸入電壓為-5 V~+5 V,四通道同時(shí)工作時(shí)最大速率為130 KS/s,AD7864與DSP外部接口(XINTF)如圖6(a)所示。

 

 


4 實(shí)驗(yàn)結(jié)果
    把穩(wěn)定平臺(tái)安裝在搖擺臺(tái)上,模擬飛機(jī)飛行姿態(tài)變化對(duì)平臺(tái)造成的擾動(dòng),以驗(yàn)證穩(wěn)定平臺(tái)的穩(wěn)定精度,實(shí)驗(yàn)結(jié)果如下。
4.1 模擬在拍攝狀態(tài)下的前向像移補(bǔ)償
    模擬上位機(jī)發(fā)送的飛行參數(shù)是:地速為1 000/(km/h),飛行高度為12 km。由陀螺碼值計(jì)算公式ref_speed=AC_SPEED×1.0/AC_ALTITUDE×0.325 97和參考角速度計(jì)算公式(1)可得:參考角速度為1.318°/s,陀螺參考碼值為27,陀螺分辨率為0.048 8°。得到上位機(jī)的拍攝命令后,記錄俯仰軸陀螺碼值如圖7所示,速度穩(wěn)定度≤0.3°/s,滿足系統(tǒng)要求。
4.2 模擬等待狀態(tài)下穩(wěn)定平臺(tái)的穩(wěn)定性
    在上位機(jī)發(fā)送拍攝命令之前,穩(wěn)定平臺(tái)處在等待狀態(tài),穩(wěn)定系統(tǒng)把上位機(jī)發(fā)送的飛行參數(shù)(載機(jī)俯仰角和橫滾角)進(jìn)行換算后作為位置環(huán)的參考輸入,編碼器值作為位置閉環(huán)的反饋輸入,保持相機(jī)垂直地面。模擬結(jié)果:最大角速度為4.5°/s、位置范圍為±3°的位置正弦跟蹤如圖8所示,每個(gè)編碼器碼值為0.011°,誤差計(jì)算為0.22°,小于指向精度指標(biāo)(≤0.55°),滿足系統(tǒng)要求。

    本文詳細(xì)介紹了以TMS320F28335為主控制器的航空相機(jī)穩(wěn)定平臺(tái)系統(tǒng)的硬件設(shè)計(jì)及其算法。通過搖擺臺(tái)測(cè)試可知,前向像移補(bǔ)償精度和垂直定位精度均滿足指標(biāo)要求。
參考文獻(xiàn)
[1] 盧筑飛,胡志剛.基于P89V51的兩軸穩(wěn)定平臺(tái)控制器設(shè)計(jì)[J].計(jì)算機(jī)測(cè)量與控制,2008,16(12):1863-1864.
[2] 黃埔,葛文奇,李友一,等.航空相機(jī)前向像移補(bǔ)償?shù)木€性自抗擾控制[J].光學(xué)精密工程,2011,19(4):812-819.
[3] George Ellis.Control systems guide(third edition)[M].北京:電子工業(yè)出版社,2006.
[4] 王德江,匡海鵬,蔡希昌,等.TDI-CCD全景航空相機(jī)前向像移補(bǔ)償?shù)臄?shù)字實(shí)現(xiàn)方法[J].光學(xué)精密工程,2008,16(12):2045-2052.
[5] 黃昌霞,李奇,姬偉,等.高精度穩(wěn)定平臺(tái)伺服控制系統(tǒng)設(shè)計(jì)與實(shí)現(xiàn)[J].航空兵器,2011(1):23-27.

此內(nèi)容為AET網(wǎng)站原創(chuàng),未經(jīng)授權(quán)禁止轉(zhuǎn)載。