何佳洲,羅志勇,潘江懷
(江蘇自動化研究所,江蘇 連云港 222061)
人類對客觀事物的質(zhì)、量及其相互關(guān)系的認(rèn)識都離不開測量。著名化學(xué)家門捷列夫說:“科學(xué)始于測量”;數(shù)學(xué)家雅科比認(rèn)為:“沒有測量就沒有任何精密科學(xué),就沒有任何應(yīng)用數(shù)學(xué),就沒有任何實(shí)驗。新的測量方法標(biāo)志著真正的進(jìn)步”。
與固定基座傳感器不同,艦載傳感器的基座相對于水平面是不穩(wěn)定的,因為艦艇在運(yùn)動過程中會發(fā)生縱搖、橫搖、升沉以及艏向改變,尤其是縱搖、橫搖和艏向改變對傳感器的探測結(jié)果具有非常大的影響,因此,動平臺傳感器需要一個穩(wěn)定平臺來補(bǔ)償載體姿態(tài)對傳感器測量的影響[1-3]。傳統(tǒng)方式是將傳感器架設(shè)在機(jī)械穩(wěn)定轉(zhuǎn)臺上[4-5],穩(wěn)定轉(zhuǎn)臺在縱搖軸和橫搖軸上各有一套伺服驅(qū)動裝置,當(dāng)平臺發(fā)生縱橫搖時,伺服系統(tǒng)根據(jù)接收到的控制信號,由驅(qū)動系統(tǒng)使穩(wěn)定轉(zhuǎn)臺的縱橫搖作出相對應(yīng)的轉(zhuǎn)動,從而保持傳感器天線座的始終水平。隨著計算機(jī)技術(shù)和電子掃描雷達(dá)技術(shù)的發(fā)展,出現(xiàn)了電子穩(wěn)定平臺[6-10],電子穩(wěn)定平臺并不通過機(jī)械手段去保持傳感器測量坐標(biāo)系的物理水平,而是依據(jù)載體縱橫搖信息控制傳感器波束指向,采用數(shù)學(xué)手段即時修正載體搖擺的影響,將傳感器原始測量轉(zhuǎn)換到當(dāng)?shù)厮矫妗?/p>
兩種穩(wěn)定方式誤差鏈的分析大同小異,本文后續(xù)以電子穩(wěn)定方式為例進(jìn)行說明,針對艦艇平臺傳感器探測過程,分析其各環(huán)節(jié)測量誤差鏈的傳遞和演化。具體涉及:傳感器的探測、傳感器的姿態(tài)、平臺的位置、平臺的姿態(tài)、平臺的時間同步等測量誤差,討論其對目標(biāo)定位精度的影響。
下面介紹艦載傳感器數(shù)據(jù)處理涉及的坐標(biāo)系。
圖1 艦載傳感器數(shù)據(jù)處理涉及坐標(biāo)系的示意圖
如圖1 所示,多平臺傳感器信息融合時,艦載傳感器數(shù)據(jù)處理涉及的主要坐標(biāo)系包括:
1)傳感器球坐標(biāo)系
以傳感器為中心建立的球面坐標(biāo)系,空間點(diǎn)的位置用該點(diǎn)相對于傳感器的距離r、方位角β 和俯仰角ε 描述。后續(xù)用“DBE”代指傳感器球坐標(biāo)系,該坐標(biāo)系中的點(diǎn)用(r,β,ε)表示。
2)傳感器笛卡爾坐標(biāo)系
傳感器笛卡爾坐標(biāo)系是一個空間直角坐標(biāo)系,其原點(diǎn)位于傳感器中心,Y 軸平行于艏艉線,指向艦艏為正,X 軸垂直Y 軸且平行于甲板,指向右舷為正,Z 軸垂直甲板向上。后續(xù)用“S-XYZ”代指傳感器笛卡爾坐標(biāo)系,該坐標(biāo)系中的點(diǎn)用(xs,ys,zs)表示。
3)艦艇甲板坐標(biāo)系
艦艇甲板坐標(biāo)系是一個空間直角坐標(biāo)系,其原點(diǎn)位于艦艇搖擺中心,Y 軸平行于艏艉線,指向艦艏為正,X 軸垂直Y 軸且平行于甲板,指向右舷為正,Z 軸垂直甲板向上。后續(xù)用“B-SFU”代指艦艇甲板坐標(biāo)系,該坐標(biāo)系中點(diǎn)的坐標(biāo)用(xb,yb,zb)表示。
4)艦艇地理坐標(biāo)系
艦艇地理坐標(biāo)系是一個空間直角坐標(biāo)系,其原點(diǎn)位于艦艇搖擺中心,X 軸平行于水平面指向正東,Y 軸平行水平面指向正北,Z 軸垂直于水平面向上。后續(xù)用“L-ENU”代指艦艇地理坐標(biāo)系,該坐標(biāo)系中點(diǎn)的坐標(biāo)用(xl,yl,zl)表示。
5)地心地固坐標(biāo)系
地心地固坐標(biāo)系是一個空間直角坐標(biāo)系,其原點(diǎn)位于地球中心,Z 軸與地球自轉(zhuǎn)軸相同,指向北極,X-Y 平面位于赤道面,X 軸穿過格林威治子午線,Y 軸與X,Z 構(gòu)成右手系。后續(xù)用“ECEF”代指地心地固坐標(biāo)系,而該坐標(biāo)系中點(diǎn)的坐標(biāo)用(xe,ye,ze)表示。
6)大地坐標(biāo)系
大地坐標(biāo)系是大地測量中以參考橢球為基準(zhǔn)面建立起來的坐標(biāo)系,空間點(diǎn)的位置用大地經(jīng)度L、大地緯度B 和大地高H 表示。后續(xù)用“LBH”代指大地坐標(biāo)系,該坐標(biāo)系中點(diǎn)的坐標(biāo)用(L,B,H)表示。
從傳感器測量到形成最終航跡點(diǎn),產(chǎn)生影響的主要誤差包括:
1)傳感器測量誤差(δr,δβ,δε)
傳感器測量目標(biāo)的球坐標(biāo)系誤差,可以用(δr,δβ,δε)描述。
2)傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差(δφ1,δφ2,δφ3)
該誤差指實(shí)際傳感器笛卡爾坐標(biāo)系與理論傳感器笛卡爾坐標(biāo)系(理論傳感器笛卡爾坐標(biāo)系應(yīng)對準(zhǔn)艦艇甲板坐標(biāo)系)的對準(zhǔn)誤差,可以用實(shí)際傳感器笛卡爾坐標(biāo)系相對于艦艇甲板坐標(biāo)系的3 個誤差角(δφ1,δφ2,δφ3)來描述。
3)傳感器基線誤差(δxb,δyb,δzb)
基線指傳感器相對艦艇中心的位移,事先測量以供傳感器數(shù)據(jù)處理時使用,但由于測量儀器誤差以及測量后艦艇形變等原因,數(shù)據(jù)處理中使用的基線包含一定誤差,該誤差可以用基線在艦艇甲板坐標(biāo)系中的誤差(δxb,δyb,δzb)來描述。
艦艇甲板坐標(biāo)系是一個非穩(wěn)定坐標(biāo)系,不僅隨著艦艇平移和轉(zhuǎn)向,還隨著艦艇進(jìn)行搖擺運(yùn)動,其參考軸的空間方向在不斷地變化。這個變化由艦艇上的慣性設(shè)備所觀測并提供給平臺使用,而慣性設(shè)備的觀測含有誤差。該誤差可以用艦艇縱搖角、橫搖角、航向角誤差(δ1,δ2,δ3)來描述。
5)艦艇位置誤差(δL,δB,δH)
艦艇位置信息由導(dǎo)航系統(tǒng)提供,該誤差可以用導(dǎo)航系統(tǒng)給出的艦艇大地坐標(biāo)誤差(δL,δB,δH)來描述。
1)傳感器球坐標(biāo)系到傳感器笛卡爾坐標(biāo)系(DBE→S-XYZ)
傳感器球坐標(biāo)系到傳感器笛卡爾坐標(biāo)系轉(zhuǎn)換公式為
該坐標(biāo)轉(zhuǎn)換的誤差傳播公式為
其中,
2)傳感器笛卡爾坐標(biāo)系到艦艇甲板坐標(biāo)系(S-XYZ→B-SFU)
傳感器笛卡爾坐標(biāo)系到艦艇甲板坐標(biāo)系坐標(biāo)轉(zhuǎn)換公式為
在實(shí)際中,(φ1,φ2,φ3)一般未測量(即默認(rèn)兩個坐標(biāo)系是對準(zhǔn)的),因此,這里?。é?,φ2,φ3)測量值為0。得到誤差傳播公式為
誤差傳播公式為
3)艦艇甲板坐標(biāo)系到艦艇地理坐標(biāo)系(B-SFU→L-ENU)
艦艇甲板坐標(biāo)系到艦艇地理坐標(biāo)系坐標(biāo)轉(zhuǎn)換公式為
4)艦艇地理坐標(biāo)系到地心地固坐標(biāo)系(L-ENU→ECEF)
艦艇地理坐標(biāo)系到地心地固坐標(biāo)系坐標(biāo)轉(zhuǎn)換公式為
大地坐標(biāo)系到地心地固坐標(biāo)系坐標(biāo)轉(zhuǎn)換公式為
該坐標(biāo)轉(zhuǎn)換的誤差傳播公式為:
傳感器對目標(biāo)的測量數(shù)據(jù)處理要考慮1.2 中五類誤差的綜合作用效果,其處理流程圖及其涉及的誤差如圖2 所示,詳細(xì)的轉(zhuǎn)換步驟及其誤差累積分為如下6 步:
1)第1 步
圖2 傳感器量測到ECEF 坐標(biāo)系轉(zhuǎn)換過程誤差累積
2)第2 步
同樣,由于傳感器的測量以及傳感器笛卡爾坐標(biāo)系的對準(zhǔn)都是有誤差的,因此
其中
其中,(δφ1,δφ2,δφ3)是傳感器笛卡爾坐標(biāo)系的對準(zhǔn)誤差。
3)第3 步
類似地,由于誤差的存在
4)第4 步
5)第5 步
6)第6 步
根據(jù)上節(jié)綜合可得各誤差源對目標(biāo)位置估計的影響為
其中,各符號的意義如前節(jié)所示。
上述誤差的影響都是線性模型,可以很方便地將各誤差的影響拆分,如下所示:
平臺位置的東向誤差δxE對目標(biāo)位置估計的影響為
平臺位置的北向誤差δxN對目標(biāo)位置估計的影響為
平臺位置的垂直誤差δxD對目標(biāo)位置估計的影響為
傳感器距離測量誤差δr 對目標(biāo)位置估計的影響Sδr為
傳感器方位角測量誤差δβ 對目標(biāo)位置估計的影響Sδβ為
傳感器俯仰角測量誤差δε 對目標(biāo)位置估計的影響Sδε為
傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差δφ1對目標(biāo)位置估計的影響為
傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差δφ2對目標(biāo)位置估計的影響為
傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差δφ3對目標(biāo)位置估計的影響為
如果僅僅關(guān)注于各誤差傳播的靈敏度在3 個方向的分量,而不從整體的角度對其進(jìn)行分析,則很可能丟失關(guān)于誤差傳播的一些重要規(guī)律,因為許多誤差傳播規(guī)律往往單獨(dú)從其分量的傳播規(guī)律中很難體現(xiàn)出來,只有將各分量綜合在一起考慮時才能比較清晰地展現(xiàn)。
定義誤差傳播的歸一靈敏度為:誤差傳播靈敏度在3 個方向分量的平方和的開方,即
顯然,歸一靈敏度從整體上描述了一個誤差對目標(biāo)三維空間位置估計的影響。
下面在一些典型的場景下進(jìn)行仿真。
首先考慮下頁表1 所示的場景,仿真結(jié)果如表2 所示。再考慮表3 所示的場景,仿真結(jié)果如表4 所示。從表2 和表4 可以看出:
1)導(dǎo)航位置/ 傳感器基線誤差傳播的歸一靈敏度為1,也就是說,一個單位的平臺位置/基線誤差只會產(chǎn)生一個單位的目標(biāo)位置誤差;另外還可以發(fā)現(xiàn),平臺導(dǎo)航位置/傳感器基線誤差的歸一靈敏度與目標(biāo)和平臺的相對位置無關(guān),是一個常量。
表1 仿真場景1
2)平臺姿態(tài)、航向誤差傳播的歸一靈敏度和傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差傳播的歸一靈敏度一一對應(yīng)相等,都是依賴于目標(biāo)與平臺相對位置關(guān)系的變化量。
3)傳感器距離測量誤差傳播的歸一靈敏度和目標(biāo)與平臺的相對位置無關(guān),等于1;但傳感器方位測量誤差和俯仰角測量誤差的歸一靈敏度則和目標(biāo)到平臺的相對位置有關(guān)。
表2 各誤差傳播的靈敏度(仿真場景1)
4)時間誤差傳播的歸一靈敏度和目標(biāo)與平臺的相對位置無關(guān),只與目標(biāo)的速度、加速度以及測量測量使用的延遲時間(即需要外推的時間)有關(guān);目標(biāo)的速度/加速度/測量使用的延遲時間越大,時間誤差對目標(biāo)位置估計的影響越大。
平臺導(dǎo)航位置誤差、傳感器基線誤差、傳感器距離測量誤差以及時間誤差傳播的歸一靈敏度均是一個定值(等于1),和目標(biāo)與平臺的相對位置關(guān)系無關(guān);但是,平臺姿態(tài)航向誤差、傳感器方位俯仰測量誤差和傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差的傳播的歸一靈敏度,則是一個和目標(biāo)與平臺相對位置關(guān)系有關(guān)的變化量。為了解這幾個誤差的傳播規(guī)律,需要考察不同目標(biāo)-平臺相對位置關(guān)系下,這些誤差傳播歸一靈敏度的變化情況。
鑒于此,繪制了這些誤差傳播的歸一靈敏度的幾何分布圖(等值線圖),如下頁圖3(仿真場景1)和圖4(仿真場景2)所示,其中紅色星號表示的是平臺的位置(由于平臺姿態(tài)航向誤差傳播的歸一靈敏度和傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差傳播的歸一靈敏度是一一對應(yīng)相等的,所以只繪制了前者的分布圖,后者只需參照前者即可)。
表3 仿真場景2
根據(jù)圖3 和圖4,再結(jié)合各誤差傳播靈敏度的理論表達(dá)式不難看出:
1)平臺縱搖角誤差(傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差δφ1)傳播的歸一靈敏度與目標(biāo)在艦艇甲板坐標(biāo)系中Y 方向的距離成正比。
2)平臺橫搖角誤差(傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差δφ2)傳播的歸一靈敏度與目標(biāo)在艦艇甲板坐標(biāo)系中X 方向的距離成正比。
表4 各誤差傳播的靈敏度(仿真場景2)
圖3 仿真場景1
3)平臺航向角誤差(傳感器笛卡爾坐標(biāo)系對準(zhǔn)誤差δφ3)和傳感器方位測量誤差傳播的歸一靈敏度和目標(biāo)到平臺的水平距離成正比。
4)傳感器俯仰角測量誤差傳播的歸一靈敏度和目標(biāo)到平臺的距離成正比。
圖4 仿真場景2
上兩節(jié)對各誤差對目標(biāo)位置估計的影響作了較為詳細(xì)的定性分析;本小節(jié)從定量的角度對各誤差對目標(biāo)位置估計的影響作詳細(xì)分析。
首先定義各測量的標(biāo)準(zhǔn)誤差水平如表5 所示,并假設(shè)各誤差是相互獨(dú)立的。
表5 各測量的標(biāo)準(zhǔn)誤差水平表
結(jié)合表3 和表4,可以得到標(biāo)準(zhǔn)誤差水平條件下各誤差對目標(biāo)位置的影響結(jié)果,如圖5(仿真場景1)和圖6(仿真場景2)所示,其中紅色條形的長度代表該誤差造成的目標(biāo)位置誤差的標(biāo)準(zhǔn)差的大小。
從圖5 和圖6 可以看出,在仿真設(shè)置的標(biāo)準(zhǔn)誤差水平下,目標(biāo)位置誤差主要有3 個誤差源:平臺導(dǎo)航位置誤差,傳感器測量誤差,時間誤差。
在多平臺多傳感器信息融合中,傳感器的測量精度是影響統(tǒng)一態(tài)勢正確形成的一個關(guān)鍵因素。本文采用理論建模并輔之以數(shù)字仿真的方法,對分布式系統(tǒng)中,各誤差源對傳感器測量精度的影響進(jìn)行了詳細(xì)的討論。
首先根據(jù)實(shí)際情況分析了影響艦載傳感器目標(biāo)測量精度的各項誤差。這些誤差可以歸為三大類:一類是傳感器誤差,主要包括傳感器測量誤差和傳感器平臺的誤差;一類是平臺導(dǎo)航誤差,主要包括平臺位置誤差和平臺姿態(tài)航向誤差;最后一類是時間誤差,包括時戳誤差、時間同步誤差等等。
圖6 仿真場景誤差影響2
然后,以誤差傳播理論為工具,在嚴(yán)格遵從艦載傳感器數(shù)據(jù)處理流程的基礎(chǔ)上,推導(dǎo)了各誤差到目標(biāo)航跡點(diǎn)(地心地固坐標(biāo)系下)的傳播模型,并以模型為依托,分析了誤差的傳播規(guī)律,這些傳播規(guī)律從定性的角度深刻反映了誤差的性質(zhì)。
最后,根據(jù)標(biāo)準(zhǔn)誤差水平表在一些典型的場景下進(jìn)行了仿真。仿真顯示:平臺位置誤差、傳感器測量誤差和時間誤差是目標(biāo)位置誤差的3 個主要來源,在文中給定的誤差水平下,這3 個誤差導(dǎo)致的目標(biāo)位置誤差占整個目標(biāo)位置誤差的80%以上。因此,改善艦載傳感器目標(biāo)航跡質(zhì)量應(yīng)主要從這3 個誤差著手。
另外,需要指出的是,雖然本文具體給出的是艦載傳感器目標(biāo)測量精度的分析,但從文中分析流程不難看出,本文的分析方法具有一般性,可以用于其他平臺傳感器目標(biāo)測量精度的評估。