管春洋,卿 立,何 偉

(北京自動化控制設(shè)備研究所，北京 100074)

一種新型的偽衛(wèi)星輔助下的慣導初始對準方法

管春洋,卿 立,何 偉

(北京自動化控制設(shè)備研究所，北京 100074)

靜基座且已知載體位置的情況下,INS可以快速地完成初始對準,但是在野外環(huán)境下通常無法快速地給出初始位置。偽衛(wèi)星具有鋪設(shè)簡單快捷,不易受到破壞的特點,適合在未知環(huán)境下作為GNSS系統(tǒng)的補充來輔助定位。但是在GNSS拒止的情況下，如果單獨使用偽衛(wèi)星(PL)來進行定位會存在定位結(jié)果誤差較大等問題,難以輔助INS系統(tǒng)完成初始對準。為了解決GNSS拒止情況下偽衛(wèi)星輔助慣性導航系統(tǒng)進行初始對準存在的問題,提出了以高度傳感器輔助下的PL定位算法,利用該算法得到準確的位置信息進而實現(xiàn)GNSS拒止條件下INS系統(tǒng)的初始對準,滿足高精度的INS系統(tǒng)在復雜環(huán)境下的使用需求。

慣導對準；偽衛(wèi)星；氣壓高度輔助

0 引言

近年來隨著我國自主研發(fā)的北斗衛(wèi)星導航系統(tǒng)的建設(shè)逐步建成與完善,北斗衛(wèi)星導航系統(tǒng)作為全球四大衛(wèi)星導航系統(tǒng)之一得到了廣泛的關(guān)注[1],同時隨著電子技術(shù)的發(fā)展,衛(wèi)星導航系統(tǒng)的應用也越來越廣泛[2]。對于組合導航系統(tǒng)來說,在低動態(tài)高信噪比的條件下，GNSS接收機可以自主完成衛(wèi)星導航信號的捕獲,此時衛(wèi)星導航接收機可以輔助INS單元進行動基座的傳遞對準[3],系統(tǒng)無需進行地面靜基座的對準,從而縮短了INS單元的初始對準時間,提高了整個系統(tǒng)的效率。

GNSS/INS組合導航系統(tǒng)雖然可以提高整個系統(tǒng)的性能,但是在GNSS系統(tǒng)受到干擾時同樣也會影響INS系統(tǒng)的性能,甚至導致組合導航系統(tǒng)發(fā)散。為了提高組合導航系統(tǒng)的魯棒性,文獻[4]提出了基于偽距誤差重建的多星故障檢測方法,文獻[5]提出了基于子p集值檢驗的慣性/衛(wèi)星緊組合多星故障識別方法,以上這些方法都提高了組合導航系統(tǒng)在衛(wèi)星出現(xiàn)故障時的性能。但是如果GNSS系統(tǒng)出現(xiàn)嚴重故障時即GNSS拒止條件下，現(xiàn)有的方法無法保證GNSS系統(tǒng)的可用性,進而也無法完成對INS系統(tǒng)的對準,此時INS系統(tǒng)需要獨立完成初始對準。在靜基座且已知載體位置的情況下,INS系統(tǒng)可以快速地完成對初始對準,但是在野外環(huán)境下通常無法快速地給出準確的初始位置,需要借助于外部信息輔助來完成初始位置裝訂。偽衛(wèi)星具有鋪設(shè)簡單快捷,且不易受到攻擊與干擾的特點,適合在野外環(huán)境下作為GNSS系統(tǒng)的補充來輔助定位。但是在實際中如果單獨使用偽衛(wèi)星來進行定位會存定位誤差過大等問題,無法滿足INS靜基座對準的需要,因此本文提出了一種高度傳感器輔助下的偽衛(wèi)星定位方法,利用該方法得到準確的位置信息進而實現(xiàn)對慣導的初始對準。

1 INS的靜基座初始對準基本原理

1.1 粗對準原理

粗對準的計算采用直接解析法,即通過矩陣運算直接求解出載體的姿態(tài)信息,該方法的優(yōu)點是運算量較小,計算時間較短,但是對準精度較差且無法對傳感器的誤差進行估計。該方法的具體計算步驟如下。

首先構(gòu)造矢量V=g×ω,矢量V滿足式(1)

(1)

其中，Vb、Vl如下所示:

Vb=gb×ωb

Vl=gl×ωl

進而得到式(2)

(2)

由于方向余弦矩陣滿足如下所示

(3)

(4)

(5)

1.2 精對準原理

在完成粗對準之后繼續(xù)對慣導進行精對準以消除平臺失準角并對慣性器件的誤差進行校正。精對準解算利用Kalman濾波技術(shù)來得到平臺失準角信息并對慣性器件的誤差進行校正,因此應對系統(tǒng)進行建模得到相應的狀態(tài)方程與量測方程。由于載體處于靜止狀態(tài)因此相應的狀態(tài)向量X如下式所示[8]

(6)

其中，E、N、U代表東北天坐標系的東向、北向、天向。x、y、z代表載體坐標系的x軸、y軸、z軸。δv為速度誤差量,φ為平臺失準角,δa為加速度計誤差,δε為陀螺儀誤差。

精對準時狀態(tài)向量的微分形式如式(7)所示

(7)

其中，矩陣F1、F2如式(8)、式(9)所示,R為地球平均半徑,國際上一般取值為6367.56km[9-10]。

(8)

(9)

(10)

(11)

利用Kalman濾波技術(shù)并結(jié)合相應的狀態(tài)方程與量測方程即可完成對INS的精對準。

由以上的推導可以看到,INS的粗對準與精對準過程都需要已知接收機的位置信息,在GNSS失效且處于野外的條件下,單獨利用INS傳感器難以實現(xiàn)INS的靜態(tài)初始對準,需要外部提供位置信息以輔助INS的初始化。因此可以考慮利用偽衛(wèi)星系統(tǒng)快速地獲得載體的位置信息來輔助INS的靜基座初始對準,提高INS系統(tǒng)的定位精度與初始對準速度。

2 偽衛(wèi)星定位中存在的問題

定位結(jié)果的三維分布圖如圖1所示?？梢钥吹?，在常規(guī)的幾何分布下,利用偽衛(wèi)星定位的結(jié)果誤差非常大,無法應用于INS的靜基座初始對準。在不考慮測距誤差的情況下對空間位置精度因子(PDOP)進行分析,結(jié)果如圖2所示,PDOP的值約為3200左右,此時的PDOP值無法滿足定位的精度要求。為了進一步定位問題,同時對比了水平位置精度因子(HDOP)與高程精度因子(VDOP),對比結(jié)果如圖3所示?？梢钥吹剑琕DOP的值與PDOP的值接近,而HDOP的值較小。

表1 基站位置Tab.1 The position of the base station

圖1 定位結(jié)果三維分布圖Fig.1 Three -dimensional diagram of the position

圖2 定位結(jié)果的PDOP值Fig.2 PDOP of the position

圖3 PL定位結(jié)果的HDOP與VDOP對比Fig.3 The compare between HDOP and VDOP

因此得出如下的結(jié)論,常規(guī)的偽衛(wèi)星布設(shè)方案雖然具有布設(shè)簡單、易于實現(xiàn)的優(yōu)點，但是利用偽衛(wèi)星對靠近地面的載體進行定位時,由于VDOP較大,導致定位誤差較大,無法滿足精度要求,但是HDOP的值很小,是符合定位精度要求的。如果能夠由外部得到準確的高度信息,仍可以利用偽衛(wèi)星完成定位的工作。

目前高精度的氣壓高度表的精度在短時間內(nèi)可達2m,分辨率可達0.1m,完全可以滿足定位精度的要求[11]。因此本節(jié)提出了利用高度傳感器輔助偽衛(wèi)星的定位算法,利用該算法可以有效地消除偽衛(wèi)星定位中VDOP過大對定位結(jié)果的影響,得到準確的定位結(jié)果。

3 基于高度傳感器輔助的偽衛(wèi)星定位算法

由之前的分析可知,造成偽衛(wèi)星單獨定位結(jié)果較差的原因為VDOP值過大,因此如果利用高度傳感器來提供高度信息即可避免定位結(jié)果的發(fā)散。

(12)

對其進行線性化后如式(13)所示

HhsΔrPL=bPL

(13)

其中:

(14)

In=

(15)

ΔrPL=rPL-rPL_k-1

(16)

(17)

其中，Hhs為雅克比矩陣,rPL_k-1為迭代運算的上一次結(jié)果,bPL為殘差向量。

在完成了高度傳感器輔助下的定位算法的建模后,利用以上的數(shù)學模型結(jié)合牛頓迭代法以及最小二乘法即可得到載體的位置信息[12]。

4 仿真與分析

為了對設(shè)計的算法進行仿真,仿真場景與第2節(jié)一致。偽衛(wèi)星的測距誤差為2m,高度傳感器的誤差為2m,分辨率為0.1m。經(jīng)過仿真得到載體的定位結(jié)果三維分布如圖5所示,東向、北向以及天向的定位誤差如圖6所示。由仿真圖可以看到,設(shè)計的高度傳感器輔助下的偽衛(wèi)星定位方法可以有效地消除由于VDOP過大造成的定位發(fā)散問題,提高了偽衛(wèi)星系統(tǒng)的性能。由該方法得到的區(qū)域定位結(jié)果可以應用于GNSS拒止環(huán)境下的野外INS靜基座對準,提高了INS系統(tǒng)的性能與應用范圍。

圖4 定位結(jié)果分布圖Fig.4 The figure of the position

圖5 定位誤差Fig.5 The error of the position

5 結(jié)論

野外環(huán)境GNSS拒止條件下利用偽衛(wèi)星可以輔助INS系統(tǒng)完成靜基座初始對準,針對GNSS拒止條件下,單獨使用偽衛(wèi)星時存在的定位誤差較大無法滿足靜基座初始對準要求的問題,本文首先研究了單獨使用偽衛(wèi)星定位誤差較大的原因,在以上研究的基礎(chǔ)上提出了一種高度傳感器輔助下的偽衛(wèi)星定位方法并設(shè)計了相應的定位算法,該方法可以有效地消除由于VDOP過大造成的定位發(fā)散問題,提高了偽衛(wèi)星系統(tǒng)的性能。由該方法得到的區(qū)域定位結(jié)果可以應用于GNSS系統(tǒng)失效下的野外INS靜基座對準,提高了INS系統(tǒng)的性能與應用范圍。

[1]HackmanC,ByramSM,SlabinskiVJ,etal.USNOGPS/GLONASSPNTproducts:Overview,andGPS+GLONASSvsGLONASSonlyPPPaccuracy[C].Position,LocationandNavigationSymposium-PLANS2014, 2014IEEE/ION.IEEE, 2014: 793-803.

[2]LiX,DickG,LuC.Multi-GNSSmeteorology:Real-timeretrievingofatmosphericwatervaporfromBeiDou,Galileo,GLONASS,andGPSobservations[J].IEEETransactionsonGeoscienceandRemoteSensing, 2015, 53(12): 6385-6393.

[3] 曲法義,魏紀林,崔乃剛,等.機載精確制導武器快速傳遞對準[J].哈爾濱工業(yè)大學學報, 2014, 46(1): 7-11.

[4] 張鑫,崔曉偉,馮振明.基于偽距誤差重建的多星故障檢測方法[J].清華大學學報(自然科學版), 2014, 54(4): 425-431.

[5] 鐘麗娜,劉建業(yè),李榮冰,等.基于子p集值檢驗的慣性/衛(wèi)星緊組合多星故障識別方法[J].控制與決策, 2013, 28(6): 884-888.

[6] 萬德鈞,房建成.慣性導航初始對準[M].南京:東南大學出版社, 1998.

[7] 秦永元.卡爾曼濾波與組合導航原理[M].西安:西北工業(yè)大學出版社, 2012: 33-55.

[8] 董緒榮,張守信,華仲春.GPS/SINS組合導航定位及其應用[M].長沙:國防科技大學出版社， 1998: 220-224.

[9]ZhuH.Establishmentofgeodeticcoordinatesystem[M].PublishingHouseofSurveyingandMapping, 1986.

[10] 程鵬飛,成英燕,文漢江，等.2000國家大地坐標系實用寶典[M].北京:測繪出版社, 2008.

[11] 郝振海,黃圣國.高精度氣壓高度表研制[J].南京航空航天大學學報, 2009, 41(1): 134-138.

[12] 謝鋼.GPS原理與接收機設(shè)計[M].北京:電子工業(yè)出版社, 2012: 42-67.

A New Method of Initial Alignment Assisted by Pseudo-Satellites

GUAN Chun-yang， QING Li， HE Wei

( Beijing Institute of Automatic Control Equipment,Beijing 100074,China)

Under stationary base and the known location of the carrier, the INS can complete the initial alignment, but the obtainment of the initial location is difficult in the wild.Pseudo-satellites with the laying of simple and quick, less susceptible to damage, is suitable as a supplement positioning of GNSS in unknown environment.But in the case of GNSS denial,and used pseudo-satellite positioning alone it will cause large errors in positioning result, cannot assist the initial alignment of INS.In order to solve the problem in pseudo-satellite aided INS initial alignment under GNSS denial, this paper presents a pseudo-satellite positioning algorithmwith height sensor assisted.With accurate position information obtained by the algorithm, the initial alignment of INS is completed under the GNSS denial, meeting the need of high-precision INS in a complex environment.

Alignment of INS; Pseudo-satellites; Atmospheric pressure altitude aided

10.19306/j.cnki.2095-8110.2017.03.003

2016-07-16；

2016-08-16

裝備預研共用技術(shù)課題(41417040301)

管春洋(1990-)，男，碩士，主要從事慣性衛(wèi)星組合導航技術(shù)方面的研究。E-mail:gcyhit@163.com

U666.1

A

2095-8110(2017)03-0017-05