孫 輝

（中國科學(xué)院長春光學(xué)精密機械與物理研究所中國科學(xué)院航空光學(xué)成像與測量重點實驗室，吉林長春130033）

機載光電平臺目標定位與誤差分析

孫 輝

（中國科學(xué)院長春光學(xué)精密機械與物理研究所中國科學(xué)院航空光學(xué)成像與測量重點實驗室，吉林長春130033）

根據(jù)機載光電平臺的特點，建立了6個坐標系統(tǒng)，進行了8次線性變換，構(gòu)建了從光電平臺成像系統(tǒng)像面坐標系到大地地理坐標系的目標定位數(shù)學(xué)模型。計算了目標在大地地理坐標系的經(jīng)緯度和高程坐標，分析了各種測量參數(shù)對目標定位精度的影響。通過建立誤差模型和仿真數(shù)據(jù)進行目標定位實驗，采用蒙特卡羅方法統(tǒng)計目標定位誤差。實驗結(jié)果表明，載機經(jīng)緯度誤差、載機姿態(tài)角度誤差及光電平臺指向角度誤差是影響目標定位精度的主要因素，其中載機經(jīng)緯度誤差直接傳遞到目標定位誤差，載機姿態(tài)角度誤差和光電平臺指向角度誤差大體上以10-4～10-2比例作用到目標定位誤差。本文方法有效可行，對機載光電平臺目標定位具有實用價值。

機載光電平臺；目標定位；大地坐標系；蒙特卡羅方法

1 引 言

機載光電平臺是在地面成像系統(tǒng)基礎(chǔ)上發(fā)展起來的新型光電成像設(shè)備，具有時效性強、機動靈活、作用范圍大等優(yōu)點，在軍事偵察、目標定位、設(shè)備導(dǎo)航、空間遙感、災(zāi)害預(yù)報、資源探測等各方面發(fā)揮了越來越重要的作用［1-4］。近年來，全球定位系統(tǒng)（Global Position System，GPS）、慣性導(dǎo)航系統(tǒng)（Inertial Navigation System，INS）及計算機技術(shù)的發(fā)展和進步，為研制和應(yīng)用新型機載光電平臺帶來了前所未有的機遇，新一代機載光電平臺向著多功能、智能化、集成化方向發(fā)展，為提高飛機任務(wù)系統(tǒng)的整體性能奠定了良好的基礎(chǔ)。

目標定位是機載光電平臺關(guān)鍵技術(shù)之一，如何實現(xiàn)目標精確定位，完善誤差分析和誤差分配機制，是研制高性能機載光電平臺需要解決的重要問題。近年來，有關(guān)目標定位技術(shù)在學(xué)術(shù)界和工程應(yīng)用領(lǐng)域引起廣泛關(guān)注，在光電平臺目標自主定位與測量［5-7］、飛行器飛行軌跡測量［8］、航空吊艙目標定位［9］、雷達偵察系統(tǒng)目標定位［10］、星載SAR目標定位［11］、小型無人機目標定位［12］等方面提出了許多有效方法。其中文獻［6］通過平臺測量設(shè)備，結(jié)合載機GPS和航空姿態(tài)測量系統(tǒng)進行目標定位，同時討論了機載光電平臺自主定位的技術(shù)優(yōu)勢及其特點；文獻［8］在分析光電跟蹤測量設(shè)備組成基礎(chǔ)上，全面系統(tǒng)討論了影響測量精度的各方面因素，通過坐標變換和構(gòu)建測量方程，進行測量誤差分析和誤差分配；文獻［9］在不依賴激光測距機或無線電測高儀條件下，通過飛機與地面的相對高度推算飛機與目標之間的斜距，利用空間坐標變換，在平坦地勢條件下對地面目標進行準確定位。

本文結(jié)合機載光電平臺特點，通過建立6個坐標系統(tǒng)和8次線性變換，構(gòu)建從光電平臺成像系統(tǒng)像面坐標到大地地理坐標的目標定位數(shù)學(xué)模型；根據(jù)載機位置參數(shù)、載機姿態(tài)參數(shù)和光電平臺目標指向角度和距離計算目標大地坐標；通過樣本數(shù)據(jù)定位實驗，討論載機測量參數(shù)和光電平臺測量參數(shù)對目標定位精度的影響。本文方法可應(yīng)用于機載光電平臺對地面、海面和空中目標的精確定位。

2 空間坐標系與坐標變換

2.1 地心空間直角坐標系G（O-GxGyGz）

地心空間直角坐標系G使用直角坐標（Gx，Gy，Gz）表示空間點的位置，參見圖1。

圖1 地心空間直角坐標系Fig.1 Geocentric coordinate system

2.2 地心大地坐標系E（λ，φ，h）

地心大地坐標系E使用經(jīng)度λ、緯度φ和高程h表示空間點的位置，參見圖2。

圖2 地心大地坐標系Fig.2 Geodetic coordinate system

從E系到G系變換公式為：

從G到E系變換公式為：

式（1）～（4）中，a為參考橢球長半軸長度，b為參考橢球短半軸長度，

2.3 載機地理坐標系S（O-SxSySz）

載機地理坐標系原點O定義為載機質(zhì)心，Sx軸指向正北，Sz軸指向正東，Sy軸指向天向，參見圖3。

圖3 載機地理坐標系Fig.3 Geographic coordinate system of the vehicle

從載機地理坐標系S到地心空間直角坐標系G的坐標變換可表示為：

式中，Q1表示繞Sx軸的旋轉(zhuǎn)矩陣，Q2表示繞Sz軸的旋轉(zhuǎn)矩陣。

2.4 載機機體坐標系A(chǔ)（O-AxAyAz）

載機機體坐標系A(chǔ)原點O定義為載機質(zhì)心，Ax軸指向機頭方向，Az軸指向機翼方向，Ay軸指向機體上方，參見圖4。

圖4 載機機體坐標系Fig.4 Body coordinate systems of the vehicle

從載機機體坐標系A(chǔ)系到載機地理坐標系S系的坐標變換公式可表示為：

式（6）中Q3，Q4，Q5分別表示繞Ay，Az，Ax軸的旋轉(zhuǎn)矩陣。

2.5 成像系統(tǒng)坐標系C（O-CxCyCz）

成像系統(tǒng)坐標系C是光學(xué)成像系統(tǒng)物空間坐標系統(tǒng)，Cx軸指向目標方向，Cz軸沿物鏡平面向右，Cy軸垂直于OCxCz平面［8］，參見圖5，圖中的α和β分別表示平臺方位和俯仰角度。

圖5 成像系統(tǒng)坐標系Fig.5 Coordinate systems of the camera

從成像系統(tǒng)坐標系C系到載機機體坐標系A(chǔ)系的坐標變換公式為：

式（7）中，Q6，Q7分別表示繞Cy，Cz軸的旋轉(zhuǎn)矩陣。

2.6 像面坐標系P（O-PxPyPz）

像面坐標系P是光學(xué)成像系統(tǒng)的像空間坐標系統(tǒng)，將C系沿Cx軸平移f即構(gòu)成P系，參見圖6，其中f表示物鏡焦距。

圖6 像面坐標系Fig.6 Coordinate systems of the plane

從像面坐標系P系到成像系統(tǒng)坐標系C系的變換公式為：

式（8）中Q8表示比例縮放和平移變換矩陣。

3 目標定位與誤差分析

3.1 載機測量與光電平臺測量參數(shù)

目標定位首先需要確定載機定位參數(shù)及光電平臺測量參數(shù)，其中載機定位參數(shù)包括載機大地坐標（λ，φ，h）和姿態(tài)角（ψ，θ，φ），由全球定位系統(tǒng)（GPS）和慣性導(dǎo)航系統(tǒng)（INS）給出［13］；光電平臺測量參數(shù)包括視軸指向方位角α、俯仰角β和目標距離ρ，視軸指向方位角和俯仰角由角度傳感器，如角位移編碼器或感應(yīng)同步器給出［14］，目標距離由激光測距機給出。

3.2 目標定位

機載光電平臺通過伺服系統(tǒng)控制光學(xué)成像系統(tǒng)視軸指向目標，目標景物成像在像面中心，建立影像點與景物點之間的對應(yīng)關(guān)系，推導(dǎo)從像面坐標到大地地理坐標之間的變換關(guān)系，是本文重點討論的關(guān)鍵問題。

目標成像在像面中心，在像面坐標系（P系）中的坐標為（0，0，0），結(jié)合式（5）～（8），可推導(dǎo)出目標在地心直角坐標（G系）下的空間直角坐標（xobj，yobj，zobj），計算公式如下：

將目標的空間直角坐標（xobj，yobj，zobj）代入式（2）～（4），即可得到目標的大地坐標（λobj，φobj，hobj），實現(xiàn)目標的大地坐標定位。

3.3 誤差分析

3.3.1 誤差來源

根據(jù)式（1）～（9），目標定位誤差與載機經(jīng)緯度誤差、載機姿態(tài)角度誤差和視軸指向角度誤差有關(guān)，因此可定義目標定位誤差分析模型如下：

式中，Δλobj和Δφobj分別表示目標經(jīng)度和緯度的定位誤差。

3.3.2 蒙特卡羅統(tǒng)計分析

蒙特卡羅（Monte Carlo）方法是一種基于概率統(tǒng)計的數(shù)值計算方法［15-16］，可以比較準確地描述客觀事物特點，解決一些常規(guī)數(shù)值方法難以解決的實際問題。本文使用蒙特卡羅方法分析和計算目標定位誤差。首先根據(jù)載機和平臺測量參數(shù)誤差分布特點，確定載機經(jīng)緯度、載機姿態(tài)角和平臺目標指向角度測量誤差服從表1所列的隨機分布，通過對測量參數(shù)誤差進行隨機抽樣處理，根據(jù)式（9）計算目標經(jīng)度、緯度和高程，統(tǒng)計定位誤差。

表1 隨機誤差分布表Table 1 Distributions of random errors

誤差分析基本步驟如下：

Step1：根據(jù)誤差計算模型確定變量參數(shù)與誤差分布空間；

Step2：選擇隨機序列長度，根據(jù)誤差分布空間，生成載機經(jīng)緯度（λi，φi）、載機姿態(tài)（ψi，θi，φi）、目標指向角度（αi，βi）隨機參數(shù)；

Step3：選擇上述隨機參數(shù)代入式（1）～（9），計算目標經(jīng)度λobji和緯度φobji；

Step4：分別計算目標經(jīng)度λobji的標準差φobji和緯度的標準差σobjφ及相應(yīng)的誤差敏感度μ。

其中：

誤差敏感度μ用于衡量目標定位誤差對測量參數(shù)誤差的敏感程度，μ＜1時表示敏感程度低，測量參數(shù)誤差經(jīng)過比例縮小傳遞到定位誤差；μ=1時，表示測量參數(shù)誤差等值傳遞到定位誤差；μ＞1時表示敏感程度高，測量參數(shù)誤差經(jīng)過比例放大傳遞到定位誤差。

4 實驗結(jié)果與分析

為驗證本文方法，選擇一組測量數(shù)據(jù)進行目標定位計算和誤差分析實驗，通過實驗結(jié)果進一步分析載機經(jīng)緯度、載機姿態(tài)角度及平臺指向角度對目標定位結(jié)果的影響。

實驗中選擇WGS-84世界坐標系統(tǒng)及其協(xié)議規(guī)定的地球常數(shù)，載機位置參數(shù)、載機姿態(tài)參數(shù)及光電平臺目標測量參數(shù)，見表2。將測量參數(shù)代入式（9），計算目標的經(jīng)緯度和高程坐標，計算結(jié)果見表3。

表2 載機和光電平臺測量參數(shù)Table 2 M easured parameters of aircraft and EO platform

表3 目標定位結(jié)果Table 3 Localization results of target

根據(jù)誤差分析的基本步驟，首先選擇隨機參數(shù)序列長度n=106，按照表1中的誤差分布密度函數(shù)生成7個隨機誤差序列，每個隨機誤差序列和其它測量參數(shù)進行組合代入式（9），計算目標經(jīng)度和緯度，并根據(jù)式（12）～（14）計算目標定位誤差和誤差敏感度，誤差統(tǒng)計結(jié)果見表4。

表4 目標定位誤差統(tǒng)計結(jié)果Table 4 Statistics results of target localization errors

從表4的目標經(jīng)緯度誤差對測量參數(shù)誤差的敏感度數(shù)據(jù)可以看出，載機經(jīng)緯度的敏感度等于1，表明載機經(jīng)緯度誤差直接轉(zhuǎn)化為目標定位誤差；載機姿態(tài)角度和平臺指向角度的敏感度為10-4～10-2，表明載機姿態(tài)角度誤差和平臺指向角度誤差以10-4～10-2的比例作用到目標定位誤差。因此，在同等誤差條件下，載機經(jīng)緯度誤差是決定目標定位誤差的主要來源，載機經(jīng)緯度的測量精度是影響目標定位精度的關(guān)鍵因素；在載機姿態(tài)角度誤差和平臺指向角度誤差較大條件下，對目標定位精度仍然起著決定性作用。

5 結(jié) 論

本文根據(jù)機載光電平臺組成特點，通過建立6個坐標系統(tǒng)和8次線性變換，構(gòu)建從成像系統(tǒng)像面坐標系到大地地理坐標系的目標定位數(shù)學(xué)模型。從載機位置參數(shù)、載機姿態(tài)參數(shù)、光電平臺目標參數(shù)出發(fā)，推導(dǎo)出目標的地心大地坐標計算公式；根據(jù)測量參數(shù)誤差分布，采用蒙特卡羅分析法估算目標定位誤差；通過實驗數(shù)據(jù)分析了測量參數(shù)誤差與目標定位誤差之間的關(guān)系，具有一定的理論和應(yīng)用價值。實驗結(jié)果表明，通過載機位置參數(shù)、載機姿態(tài)參數(shù)和光電平臺目標指向角度參數(shù)等測量信息可以實現(xiàn)機載光電平臺對目標的精確測量。在目標定位誤差方面，載機經(jīng)緯度的敏感度等于1，載機姿態(tài)角度和平臺指向角度的敏感度為10-4～10-2。載機經(jīng)緯度誤差對目標定位計算結(jié)果影響較大，載機姿態(tài)角誤差、光電平臺指向角度誤差產(chǎn)生的誤差影響較小，載機位置測量精度是影響目標定位精度的關(guān)鍵因素。

本文通過實驗結(jié)果定量分析了目標定位誤差與測量參數(shù)誤差的關(guān)系，在實際工程應(yīng)用中可以根據(jù)指標要求進行合理的誤差分配和測量精度控制，以期減小計算誤差，達到最佳的設(shè)計效果。本文方法適合機載光電平臺對地面、海面和空中目標的大地坐標定位。

［1］ 宋豐華.現(xiàn)代空間光電系統(tǒng)及應(yīng)用［M］.北京：國防工業(yè)出版社，2004. SONG F H.Modern Spatial Electro-optical Imaging System and Its Application［M］.Beijing：National Defence Industry Press，2004.

［2］ 孟慶季，張續(xù)嚴，周凌，等.機載激光3D探測成像系統(tǒng)的關(guān)鍵技術(shù)［J］.中國光學(xué)，2011，4（3）：327-339. MENG Q J，ZHANG X Y，ZHOU L，et al..Key technologies of airborne laser 3D detection imaging system［J］.Chinese Optics，2011，4（3）：327-339.（in Chinese）

［3］ 張健，張雷，曾飛，等.機載激光3D探測成像系統(tǒng)的發(fā)展現(xiàn)狀［J］.中國光學(xué)，2011，4（3）：213-232. ZHANG J，ZHANG L，ZENG F，et al..Development status of airborne 3D imaging lidar systems［J］.Chinese Optics，2011，4（3）：213-232.（in Chinese）

［4］ 楊權(quán)，劉晶紅，馬曉飛.基于圖像處理的機載光電平臺自動調(diào)焦方法［J］.液晶與顯示，2011，26（5）：677-682. YANG Q，LIU JH，MA X F.Auto-focusingmethod based on image processing for airborne electro-optical imaging platform［J］.Chinese J.Liquid Crystals and Displays，2011，26（5）：677-682.（in Chinese）

［5］ 艾宏山，劉攀.機載光電系統(tǒng)的目標定位研究［J］.光學(xué)與光電技術(shù)，2011，9（2）：77-80. AIH SH，LIU P.Research on target positioning of airborne electro-optical system［J］.Opt.Optoelectronic Technol.，2011，9（2）：77-80.（in Chinese）

［6］ 劉晶紅，孫輝，張葆，等.航空光電成像平臺的目標自主定位［J］.光學(xué)精密工程，2007，15（8）：1305-1310. LIU JH，SUN H，ZHANG B，et al..Target self-determination orientation based on aerial photoelectric imaging platform［J］.Opt.Precision Eng.，2007，15（7）：1305-1310.（in Chinese）

［7］ 王晶，楊立保，高利民.機載光電平臺目標定位測量技術(shù)［J］.長春理工大學(xué)學(xué)報（自然科學(xué)版），2009，32（4）：531-534. WANG J，YANG L B，GAO L M.Target orientation measuring of airborne EO platform［J］.J.Changchun Univ.Sci. Technol.（Natural Science Edition），2009，32（4）：531-534.（in Chinese）

［8］ 王家騏，金光，顏昌翔.機載光電跟蹤測量設(shè)備的目標定位誤差分析［J］.光學(xué)精密工程，2005，13（2）：105-116. WANG JQ，JIN G，YAN CH X.Orientation error analysis of airborne opto-electric tracking and measuring device［J］. Opt.Precision Eng.，2005，13（2）：105-116.（in Chinese）

［9］ 林旻序，喬彥峰，戴明，等.單載荷航空吊艙目標定位方法研究［J］.紅外技術(shù)，2011，33（10）：593-597. LIN M X，QIAO Y F，DAIM，et al..Research on single payload air pod target location method［J］.Infrared Technol.，2011，33（10）：593-597.（in Chinese）

［10］ 廖龍靈.直升機載雷達偵察系統(tǒng)目標定位精度分析［J］.電訊技術(shù)，2005，45（4）：107-110. LIAO L L.Goes straightup the airborne radar approach sensor y system localization of target precision analysis［J］.Telecommunication Technology，2005，45（4）：107-110.（in Chinese）

［11］ 袁孝康.星載合成孔徑雷達目標定位研究［J］.上海航天，2002（1）：1-7. YUAN X K.Studies of ground target location ofsSpaceborne SAR［J］.Aerospace Shanghai，2002（1）：1-7.（in Chinese）

［12］ REDDING J，MCLAIN T，BEARD R，et al..Vision-based target localization from a fixed-wing miniature air vehicle［C］//Proceedings of the 2006 American Control Conference Minneapolis，June 14-16，2006，Minnesota，USA，2006：2862-2867.

［13］ 張葆，姚俊峰，高利民.機載GPS測量定位技術(shù)研究［J］.光學(xué)精密工程，2009，17（1）：172-178. ZHANG B，YAO J F，GAO L M.Measuring orientation technology based on airborne GPS［J］.Opt.Precision Eng.，2009，17（1）：172-178.（in Chinese）

［14］ 孫瑩，萬秋華，王樹潔，等.航天級光電編碼器的信號處理系統(tǒng)設(shè)計［J］.光學(xué)精密工程，2010，18（5）：1182-1188. SUN Y，WAN Q H，WANG SH J，et al..Design of signal process system for spaceborne photo electric encode［J］.Opt. Precision Eng.，2010，18（5）：1182-1188.（in Chinese）

［15］ 徐利治，陳希孺，鄭忠國，等.現(xiàn)代數(shù)學(xué)手冊，隨機數(shù)學(xué)卷［M］.武漢：華中科技大學(xué)出版社，2000. XU L Z，CHEN X R，ZHENG ZH G，et al..Modern Mathematics Handbook，Stochastic Mathematics［M］.Wuhan：Huazhong University of Science and Technology Press，2000.（in Chinese）

［16］ 劉琳，張興德，賀誼亮.基于蒙特卡洛模擬法的紅外光學(xué)系統(tǒng)公差分析［J］.激光與紅外，2010，40（5）：496-499. LIU L，ZHANG X D，HE Y L.Monte Carlo simulation and its application in the IR optical system［J］.Laser&Infrared，2010，40（5）：496-499.（in Chinese）

Target localization and error analysis of airborne electro-optical platform

SUN Hui
（Key Laboratory of Airborne Optical Imaging and Measurement，Changchun Institute of Optics，F(xiàn)ine Mechanics and Physics，Chinese Academy of Sciences，Changchun 130033，China）
*Corresponding author，E-mail：sunh@ciomp.ac.cn

On the basis of the characteristics of an airborne electro-optical platform，six coordinate systems were established and eight linear coordinate transformationswere performed.A coordinate transformationmodel from a camera sensor plane to geodetic coordinate systemswas established by using linear coordinate transformation，and the computation formula of geodetic coordinate of the targetwas derived based on the transformation of different coordinates.The influence of target localization due to various error factorswas discussed，and the localization errorwas analyzed with Mont Carlomethod.The experimental results show that the target location is affected by aircraftposition errors，aircraftattitude errors and EO platform pose errors，amongwhich the aircraft position errors are transferred directly into the target location，and the aircraft attitude errors and EO platform pose errors are tranferred scaling with the range of 10-4～10-2to the target location.Thismethod isefficient and useful to the localization of targets for airborne EO platforms.

airborne electro-optical platform；target localization；geodetic coordinate system；Mont Carlomethod

V249

A

10.3788/CO.20130606.0912

1674-2915（2013）06-0912-07

2013-09-16；

2013-11-17

國家重點基礎(chǔ)研究發(fā)展計劃（973計劃）資助項目（No.2009CB72400607）；國家高技術(shù)研究發(fā)展計劃（863計劃）資助項目（No.2008AA121803）

孫 輝（1963—），男，吉林柳河人，研究員，1985年于吉林大學(xué)獲得學(xué)士學(xué)位，主要從事數(shù)字圖像處理及計算機仿真研究。E-mail：sunh@ciomp.ac.cn