二維測向系統(tǒng)中坐標變換方法及實時補償技術(shù)

田德民,楊崢崢,張學(xué)成

(中國船舶重工集團公司第七二三研究所,江蘇 揚州 225101)

0 引言

以雷達電子戰(zhàn)天線基座為準的坐標系安裝于艦艇平臺時,若艦艇平臺存在偏航、縱搖、橫搖等姿態(tài)運動,這些艦載設(shè)備的坐標系與地理坐標就不再一致,其所獲取的目標參數(shù),特別是二維到達角信息就與平臺姿態(tài)相關(guān)。要消除艦艇姿態(tài)的影響,通常有機械穩(wěn)定和電氣補償2種方法。傳統(tǒng)的機械穩(wěn)定系統(tǒng)復(fù)雜,平臺笨重,精度差,已經(jīng)逐步被電氣補償方法所取代。電氣補償?shù)姆椒ㄊ峭ㄟ^已知各坐標系關(guān)系、艦艇姿態(tài)信息、平臺安裝參數(shù)等,通過數(shù)學(xué)的方法進行解算。實時動態(tài)補償技術(shù)可以利用實時信息,通過實時解算來補償平臺姿態(tài)等信息對參數(shù)測量的影響。

文獻[2]對一維比幅測向系統(tǒng)中艦艇縱橫搖對測向精度的影響進行了分析,給出了改進的技術(shù)措施,但未涉及二維測向系統(tǒng)。文獻[3]探討了傳統(tǒng)縱橫搖坐標變換的方法和不足,給出了改進的修正因子。文獻[4]也對傳統(tǒng)的艦艇縱橫搖坐標變換進行了討論,提出了存在的不足,給出了新的大地坐標與甲板坐標之間的變換矩陣。文獻[5]對艦載雷達天線電子穩(wěn)定方程及坐標變換矩陣進行了細致的推導(dǎo)和仿真工作,同時對各個文獻中各參數(shù)的定義進行了分析和比較,給出了目前采用的不同方法雖然形式不同,但結(jié)論一致的推算結(jié)果,具有一定參照意義。文獻[6]對三坐標雷達穩(wěn)定平臺剩余誤差進行了修正,給出了修正公式;文獻[7]從理論基礎(chǔ)上介紹了不同坐標系、參照系以及雷達陣面方向余弦坐標系,對于二維干涉儀測向系統(tǒng)具有同樣參考意義。文獻[8]對艦載雷達常用穩(wěn)定方式坐標變換進行了分析,并介紹了船用平臺羅經(jīng)的基本原理,從而解釋了坐標變換旋轉(zhuǎn)順序的原因。文獻[9]給出了不同坐標系之間的轉(zhuǎn)換關(guān)系,對于艦載雷達及偵察系統(tǒng)的坐標變換具有一定的指導(dǎo)意義。文獻[10]主要從歐拉角和姿態(tài)角的關(guān)系給出了一種艦艇載體坐標系到地理坐標系旋轉(zhuǎn)矩陣實用算法。

一維測向系統(tǒng)只需給出方位角,姿態(tài)變換時只需將艦艇航向角參與到方位角解算。而二維測向系統(tǒng)給出的輻射源信息不但有方位角,還包括俯仰角信息,天線陣面安裝時還可能存在傾斜角,所以在實現(xiàn)時就需要綜合考慮天線陣面安裝傾角、艦艇姿態(tài)等信息,參與到二維輻射源角度的解算中。

本文在參照以上文獻的基礎(chǔ)上,主要關(guān)注了艦載二維干涉儀測向系統(tǒng)中艦艇姿態(tài)、系統(tǒng)安裝角度等參數(shù)動態(tài)處理方法,從坐標系轉(zhuǎn)換和實時動態(tài)補償?shù)慕嵌仍诠こ躺线M行實現(xiàn)。

1 常用坐標系

艦載雷達電子戰(zhàn)系統(tǒng)中幾種常用的坐標系包括大地直角坐標系、天線方向余弦坐標、艦艇甲板直角坐標系,如圖1所示。

1.1 大地坐標系

大地坐標系采用大地緯度、大地經(jīng)度和大地高度來表示空間的點,在艦載雷達電子戰(zhàn)系統(tǒng)中一般描述空間點采用的是方位角、俯仰角及高度幾個參數(shù),為簡化后續(xù)引出的坐標變換的描述,本文中首先引出大地直角坐標系OXYZ見(圖1(a))。

圖1 各坐標系示意圖

在該坐標系中,定義如下:Z軸指向地理正北方向;Y軸沿鉛垂線向上;X軸與YZ按右手規(guī)則確定指向。

在大地直角坐標系中,軸X與Y構(gòu)成當?shù)厮矫?軸Z與X構(gòu)成的平面為當?shù)劂U垂平面。該坐標系的原點設(shè)在艦船的質(zhì)心處,并跟隨其運動。因此,更精確地說,這種坐標系為“當?shù)亍贝蟮刈鴺讼?。大地直角坐標系是最常用的參照?通常所說的目標與我艦的航向、速度以及風向、風速等,都是相對于大地直角坐標系而言的。通常雷達電子戰(zhàn)主控臺、艦艇平臺羅經(jīng)、顯示終端等也都是以大地直角坐標系為參照系的。

1.2 甲板直角坐標系

如圖1(b)所示,甲板直角坐標系OXYZ是一種動坐標系,其原點取在艦船質(zhì)心處,各軸定義如下:OZ軸與艦體縱軸平行,指向艦艏為正;OX軸垂直于OZ軸,并與其在同一水平面上,指向左舷為正;OY軸垂直于OZ軸和OX軸,按右手規(guī)則確定,向上為正。

1.3 方向余弦坐標系

如圖1(c)所示,在二維雷達和電子戰(zhàn)系統(tǒng)中,常用方向余弦坐標系給出其測量值:

式中:為目標到原點的徑向距離;,分別為目標徑向與,軸的夾角的方向余弦。

設(shè)目標在雷達陣面直角坐標系中的坐標為,,,則方向余弦各參數(shù)表述為:

1.4 球坐標系

對于二維干涉儀測向而言,重點要測量的是俯仰角和方位角,不關(guān)心目標徑向距離,所以需要利用球坐標的概念,傳統(tǒng)球坐標系如圖1(d)所示。3個參數(shù)(,,)表示一個點的球面坐標,各參數(shù)定義如下:為原點與點之間的徑向距離;為原點到點的連線與正軸之間的天頂角,數(shù)值為90°-俯仰角;為原點到點的連線在平面的投影線與正軸之間的方位角。

球坐標系有著廣泛應(yīng)用,在天文學(xué)中,經(jīng)度類于圖1(d)中的,緯度類于(90°-)。實踐中,球坐標中的角稱為被測點(,,)的方位角,(90°-)稱為高低角(俯仰角),這與我們在二維測向系統(tǒng)中給出的方位角和俯仰角的定義基本一致。

1.5 歐拉角

在探討不同坐標系的變換之前,首先引出歐拉角的概念。歐拉角是用來描述剛體在三維歐幾里德空間的取向所定義的角度,對于任何參考系,一個剛體的取向,是依照順序,從該參考系做3個歐拉角的旋轉(zhuǎn)而設(shè)定的。

如圖2所示,設(shè)定軸為參考系的參考軸。稱平面與平面的相交為交點線,用英文字母代表。順規(guī)的歐拉角可以靜態(tài)地這樣定義:是軸與交點線的夾角;是軸與軸的夾角;是交點線與軸的夾角。

圖2 歐拉角定義

但是,對于夾角的順序和標記以及夾角的2個軸的指定,并沒有任何規(guī)定。所以每當用到歐拉角時,我們必須明確地表示出夾角的順序及其參考軸。

2 坐標變換

2.1 歐拉旋轉(zhuǎn)定理

在運動學(xué)里,歐拉旋轉(zhuǎn)定理表明,在三維空間里,假設(shè)1個剛體在做1個位移的時候,剛體內(nèi)部至少有一點固定不動,則此位移等價于1個繞著包含固定點的固定軸的旋轉(zhuǎn)。

2.2 坐標旋轉(zhuǎn)變換

有了歐拉角和歐拉旋轉(zhuǎn)定理,就可以用旋轉(zhuǎn)矩陣的方式描述各坐標系之間的變換。對于本文所描述的二維干涉儀測向系統(tǒng),當天線座安裝相對甲板平面存在一個傾角,同時還要考慮艦艇縱、橫搖和航向的影響時,需要首先進行天線坐標系到甲板坐標系的旋轉(zhuǎn)變換,然后是甲板直角坐標系下的方位角、俯仰角利用艦艇縱搖角、橫搖角及航向角經(jīng)過坐標旋轉(zhuǎn)變換,得到大地直角坐標下的方位角、俯仰角。

2.2.1 天線坐標系到甲板直角坐標系的變換

當完成天線坐標系與甲板直角坐標系之間的旋轉(zhuǎn)變換后,二維測向系統(tǒng)中測得的方位角和俯仰角就變換為甲板直角坐標系下的方位角和俯仰角。

2.2.2 甲板直角坐標系到大地直角坐標系的變換

圖3 天線直角坐標系與甲板直角坐標系關(guān)系圖

艦艇的姿態(tài)由艦艇平臺羅經(jīng)提供的返回參數(shù)——橫搖角、縱搖角和航向角所唯一確定,其定義分別規(guī)定如下:橫搖角為甲板繞艦首尾線與水平面的夾角,右舷下降為正;縱搖角為艦首尾線相對水平面的轉(zhuǎn)角,艦首抬高為正;航向角為艦首尾線與正北的夾角,自正北起.順時針為正,定義區(qū)間為0～360°。

如圖1(a)與(b)所示,開始時設(shè)定甲板直角坐標系與大地直角坐標系完全重合,甲板直角坐標系相對大地直角坐標系旋轉(zhuǎn)3次,便形成3個歐拉角、、。根據(jù)歐拉旋轉(zhuǎn)定理,同時參照文獻[8]對平臺羅經(jīng)工作原理的描述,假定艦船先轉(zhuǎn)航向,再縱搖,后橫搖時(如圖4(a)、(b)、(c)所示),則大地直角坐標系與甲板直角坐標系之間的變換關(guān)系可按下述內(nèi)容計算。

圖4 大地坐標系與甲板坐標系之間變換關(guān)系

第1次甲板坐標系繞Y軸旋轉(zhuǎn)1個角度,且順時針為正,甲板坐標系由OXYZ旋轉(zhuǎn)到位置。設(shè)空間某點在坐標系OXYZ和坐標系中的坐標分別為x,y,z和,,,則這2組坐標之間的關(guān)系可表示為:

第2次繞旋轉(zhuǎn)1個角度,甲板坐標系由旋轉(zhuǎn)到位置。同一空間點在坐標系OXYZ和坐標系中的坐標分別為,,和,,,則這2組坐標之間的關(guān)系可用以下矩陣表示:

第2次繞軸旋轉(zhuǎn)1個角度,甲板坐標由旋轉(zhuǎn)到OXYZ位置。同理可以得到:

由式(6)、(7)和(8),甲板坐標系與大地坐標系之間的變換可以表示為:

其中:

結(jié)合大地直角坐標與空間球面坐標系的變換關(guān)系式(1),并利用坐標旋轉(zhuǎn)變換,將天線坐標系下測得的參數(shù)變換為大地直角坐標系下的參數(shù)。

3 實時坐標變換的工程實現(xiàn)

下面以二維干涉儀測向為例,討論一下坐標變換實時補償技術(shù)的具體實現(xiàn)。在許多文獻中都對二維干涉儀測向俯仰角和方位角進行了定義,同時對解算步驟進行了分析,在此不再贅述。從本文的角度,最終要得到大地坐標下的方位角和俯仰角,分為以下3個步驟:

(1) 按二維干涉儀測向算法解算得到天線坐標系下的方位角和俯仰角;

(2) 引入天線傾角,按天線坐標系變換到甲板坐標系下的解算方法解算得到甲板坐標系下的方位角和俯仰角;

(3) 將甲板坐標系下的方位角和俯仰角繼續(xù)進行坐標變換,解算得到大地坐標系下的方位角和俯仰角。

在步驟(1)中,以1對互相垂直的干涉儀為例,其公式僅列如下,具體不再推導(dǎo):

式中:為方位角,定義為入射信號投影與軸的夾角;為俯仰角,定義為入射信號與水平面的夾角;

通過先解算俯仰角,然后再解算方位角的方法就可以解算得到天線坐標系下的方位角和俯仰角。

步驟(2)中,按照公式(5)進行變換,因為在干涉儀測向系統(tǒng)中只能得到目標的方位和俯仰角,所以要用到目標的球坐標的概念,將公式中的、、變換為球坐標下,,,同時在此步驟中僅用到了,的三角函數(shù),所以需要將步驟(1)的輸出轉(zhuǎn)換為三角函數(shù)。

步驟(3)中,按照公式(9)進行轉(zhuǎn)換,同樣用到球坐標的概念和三角函數(shù)。最終按照步驟(3)完成計算后得到的方位角和俯仰角需要解算反三角函數(shù),而解算反三角函數(shù)快速準確的方法采用的是坐標旋轉(zhuǎn)數(shù)字計算機(CORDIC)算法。

如圖5所示,在天線坐標系下通過方位角和俯仰角解算得到天線坐標系下的方位角和俯仰角的三角函數(shù)值后,代入天線座傾角,進行甲板坐標解算,然后再引入航向角、縱搖角和橫搖角,再次解算得到大地直角坐標系下的方位角和俯仰角的三角函數(shù),最后通過CORDIC 算法解算得到大地坐標系下的方位角和俯仰角。

圖5 二維干涉儀測向坐標轉(zhuǎn)換實時解算框圖

要實現(xiàn)實時的姿態(tài)補償,所以設(shè)計中整個解算過程的3個步驟均在現(xiàn)場可編程門陣列(FPGA)內(nèi)實現(xiàn),其中三角函數(shù)的計算均采用了最快速的查表法,表中存儲的為8位三角函數(shù)值,完全可以滿足設(shè)計精度要求,整個解算過程用時小于200 ns。

4 結(jié)束語

針對雷達電子戰(zhàn)系統(tǒng)裝載平臺的實時姿態(tài)信息對系統(tǒng)測向的影響,必須采用姿態(tài)補償?shù)姆椒▽⑵脚_姿態(tài)信息引入測向處理中。本文從坐標變換的角度討論了不同坐標系之間的轉(zhuǎn)換方法及步驟,同時比對和討論了各參考文獻中的不足和局限,最后以坐標變換理論為基礎(chǔ),以艦載二維干涉儀測向為例,提出和實現(xiàn)了一種基于FPGA 的實時動態(tài)平臺姿態(tài)補償方法,并進行了工程實現(xiàn)。