亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        自適應(yīng)抗差Kalman濾波在多天線原始觀測值瞬時姿態(tài)確定中的應(yīng)用

        2015-01-14 03:04:00隋立芬劉長建
        測繪學(xué)報 2015年9期
        關(guān)鍵詞:抗差歷元基線

        甘 雨,隋立芬,劉長建,董 明

        信息工程大學(xué)地理空間信息學(xué)院,河南 鄭州450000

        1 引 言

        GNSS測姿具有成本低、初始化快、誤差相對穩(wěn)定等特點(diǎn),已成為GNSS應(yīng)用研究的熱點(diǎn)。目前在雙天線單瞬時定向方面的研究較為深入,一般通過約束條件輔助單基線求解,再基于基線結(jié)果計算姿態(tài),這一領(lǐng)域已有豐富成果[1-4]。在多基線方面,有學(xué)者研究了整體解算方法[5-6],但是需先解基線再解姿態(tài),無法直接利用原始觀測值測姿。文獻(xiàn)[7]提出在多基線解算過程中固定模糊度,再將模糊度回代求解四元數(shù)參數(shù),以充分利用觀測信息,但本質(zhì)上仍屬基線解算模型。文獻(xiàn)[8]以方向余弦陣為姿態(tài)參數(shù),利用原始觀測值計算方向余弦和模糊度浮點(diǎn)解,將方向余弦的正交約束引入到模糊度搜索中,利用MCLAMBDA方法(multivariate constrained LAMBDA)進(jìn)行搜索。由于約束信息的引入,使得模糊度的搜索空間不再為橢球體,整周模糊度的搜索負(fù)擔(dān)遠(yuǎn)高于一般的LAMBDA方法[9],且方向余弦陣含9個參數(shù),解算效率偏低,影響實(shí)時應(yīng)用。目前未形成可靠的由載波相位觀測解算歐拉角或四元數(shù)固定解的理論。

        現(xiàn)有測姿方法使用最小二乘進(jìn)行單歷元解算以避免周跳探測問題,歷史信息沒有得到充分利用。使用自適應(yīng)選權(quán)濾波[10]、自適應(yīng)抗差濾波[11-12]等方法均能高效地平衡歷史信息和當(dāng)前觀測,其中自適應(yīng)抗差濾波具有抵御粗差干擾的能力,在城區(qū)及海上姿態(tài)測量等應(yīng)用中能發(fā)揮優(yōu)勢。實(shí)際上,只要不使用模糊度歷史信息,使用濾波的方式也無須探測周跳,可實(shí)現(xiàn)瞬時定姿。

        本文推導(dǎo)了基于失準(zhǔn)角及乘性誤差四元數(shù)的載波相位觀測模型,分別建立有外部角速度傳感器和無外部傳感器輔助下姿態(tài)參數(shù)估計的狀態(tài)模型;使用自適應(yīng)抗差濾波估計姿態(tài),借鑒分類自適應(yīng)因子的思想,對模糊度參數(shù)和姿態(tài)誤差參數(shù)分別自適應(yīng),通過模糊度自適應(yīng)因子控制模糊度先驗(yàn)值的信任度,若選擇極小的自適應(yīng)因子,可在濾波框架內(nèi)免去探測周跳過程;根據(jù)Ratio值確定姿態(tài)參數(shù)的自適應(yīng)因子。自適應(yīng)抗差濾波能夠充分利用約束信息和歷史信息,將其融合在浮點(diǎn)解計算過程中,極大提高模糊度浮點(diǎn)解精度及其協(xié)方差的結(jié)構(gòu),在此基礎(chǔ)上使用LAMBDA方法即能快速搜索出固定解。采用實(shí)測艦載GNSS 3天線測姿算例證明了本文方法的有效性。

        2 基于姿態(tài)誤差和模糊度參數(shù)的載波相位觀測模型

        設(shè)在主天線i和天線j同步觀測到衛(wèi)星p、q,可組站星雙差觀測方程

        將式(1)在基線初值展開并忽略大氣折射延遲項(xiàng),有

        式中,bij為基線參數(shù)和為方向余弦矢量;

        整理可得基線觀測模型為

        由于GNSS觀測方程為非線性,姿態(tài)參數(shù)之間的關(guān)系也為非線性,因此,姿態(tài)估計中一般計算名義姿態(tài)中包含的姿態(tài)誤差,再對名義姿態(tài)進(jìn)行誤差修正。這里分別從失準(zhǔn)角和乘性四元數(shù)這兩種姿態(tài)誤差參數(shù)的角度推導(dǎo)相應(yīng)的載波相位觀測方程。

        設(shè)載體坐標(biāo)系為b系,當(dāng)?shù)厮阶鴺?biāo)系為n系,載體姿態(tài)可用姿態(tài)矩陣表示。設(shè)名義當(dāng)?shù)厮阶鴺?biāo)系為n′系,定義n系到n′系的失準(zhǔn)角為φ,它表示實(shí)際當(dāng)?shù)厮较祅和名義當(dāng)?shù)厮较祅′之間的旋轉(zhuǎn)矢量,可理解為名義系n′的誤差。若失準(zhǔn)角較小,其近似等于俯仰、橫滾和航向的歐拉角誤差,這里為了保證嚴(yán)密性,依舊稱之失準(zhǔn)角而非歐拉角誤差。n和n′之間的關(guān)系可用式(6)的姿態(tài)矩陣的形式表示[13]

        式中,(φ×)為φ的叉乘矩陣,為一反對稱陣。

        失準(zhǔn)角、名義姿態(tài)陣、姿態(tài)陣之間的關(guān)系如式(7)所示

        式(3)中的bij為地固系e系中的基線,加上上標(biāo)為,由坐標(biāo)旋轉(zhuǎn)關(guān)系,有

        將式(8)代入式(3),得

        整理可得基于失準(zhǔn)角參數(shù)的載波相位觀測方程

        對于天線j1和主天線i,按照式(11)可由所有觀測衛(wèi)星得到矩陣形式的觀測方程為

        若有天線(j1,j2,…,jm),則基于失準(zhǔn)角和模糊度參數(shù)(略去雙差算子)的載波相位觀測模型為

        前面推導(dǎo)了基于失準(zhǔn)角表示姿態(tài)誤差的觀測方程,也可采用乘性誤差四元數(shù)的形式。在誤差角為小量下,有[13]

        僅需將式(12)稍作改動即可得到基于乘性誤差四元數(shù)的載波相位觀測方程

        若GNSS姿態(tài)測量系統(tǒng)含m條基線,使用基線解算模型需解算3m個基線參數(shù),而使用基于失準(zhǔn)角或誤差四元數(shù)的觀測值模型僅解算3個姿態(tài)參數(shù),效率更高。

        3 姿態(tài)估計的狀態(tài)模型

        四元數(shù)微分方程為[7]

        由姿態(tài)矩陣與姿態(tài)四元數(shù)之間的關(guān)系可得乘性誤差四元數(shù)δQ滿足

        將式(18)、式(19)代入式(21)

        根據(jù)四元數(shù)乘法準(zhǔn)則,得

        由式(16),得

        式(25)、式(26)的右端第2項(xiàng)即為狀態(tài)噪聲。

        若有外部角速度傳感器如陀螺儀的輔助,則可直接使用式(25)或式(26)建立狀態(tài)方程,否則,無法獲得角速度,此時將式(26)改化為

        將ω擴(kuò)展為狀態(tài)參數(shù)并用隨機(jī)游走模型表示,納入式(27)并離散化

        即為無外部角速度傳感器輔助下的姿態(tài)估計狀態(tài)模型。

        4 自適應(yīng)抗差濾波的應(yīng)用及自適應(yīng)因子的確定

        綜合式(13)、式(28)可得基于載波相位觀測值估計姿態(tài)的濾波模型為

        式(30)中的A與式(13)略有不同,為

        使用姿態(tài)誤差而非姿態(tài)本身作為濾波中的姿態(tài)參數(shù),可以減小觀測方程線性化引起的模型誤差。設(shè)計算的名義姿態(tài)陣,濾波估計得到的失準(zhǔn)角,代入式(6)、式(7),即可對名義姿態(tài)進(jìn)行修正,修正后的即為濾波解。在k時刻,以k-1時刻的濾波解作為名義解。若k時刻成功固定模糊度即得到失準(zhǔn)角固定解時,應(yīng)在完成姿態(tài)修正后將失準(zhǔn)角置零后傳遞至下一歷元。

        若前一時刻姿態(tài)估計精度高,則本時刻名義解較為可靠,應(yīng)信任狀態(tài)預(yù)測信息,若名義解精度不高,則使用自適應(yīng)因子減小狀態(tài)信息的貢獻(xiàn)。

        姿態(tài)誤差、角速度、模糊度屬不同類型的參數(shù),很難采用統(tǒng)一的自適應(yīng)因子進(jìn)行調(diào)節(jié),分類因子自適應(yīng)濾波可對不同的分量選取不同的自適應(yīng)因子。分類因子自適應(yīng)抗差濾波解為[14-15]

        式中,為抗差等價權(quán)矩陣,可由Huber函數(shù)確定[15]

        式中,為標(biāo)準(zhǔn)化殘差;c為常量,可取1.0~1.5。

        為狀態(tài)預(yù)測的自適應(yīng)權(quán)矩陣,有

        式中,αk為自適應(yīng)因子矩陣,即

        由于ω為間接觀測量,這里不作自適應(yīng),有

        αN可調(diào)整模糊度先驗(yàn)信息的權(quán)重,若進(jìn)行周跳探測得到各衛(wèi)星中最大周跳估值為dN,顧及周跳探測量自身的噪聲,可選取自適應(yīng)因子為

        式中,σˉN為模糊度預(yù)測標(biāo)準(zhǔn)差,主要由設(shè)定的模糊度狀態(tài)噪聲決定;σDT為周跳探測量的中誤差,周跳估值越大,模糊度自適應(yīng)因子越小,一般αN<1。

        若要免去周跳探測步驟以便瞬時解算,則可取αN為一極小值,如αN=1.0e-8,此時,模糊度先驗(yàn)信息的權(quán)重降至極小,不受周跳干擾。

        自適應(yīng)濾波常用的誤差判別統(tǒng)計量包括狀態(tài)不符值或預(yù)測殘差等,GNSS定姿中,在模糊度固定前,無法獲得足夠精度的上述統(tǒng)計量??紤]姿態(tài)誤差的預(yù)測性能本質(zhì)上由名義解即前一歷元姿態(tài)濾波解的精度決定,其對應(yīng)的Ratio值能夠在一定程度上反映其可靠程度,αφ由三段函數(shù)表示

        式中,Rat為Ratio值,一般取c0=2、c1=3。

        5 計算與比較

        本文算例使用實(shí)測艦載GPS 3個天線姿態(tài)測量雙頻數(shù)據(jù)進(jìn)行計算和比較分析,3個天線構(gòu)成兩條獨(dú)立基線,基線的載體系坐標(biāo)分別為[0.0 15.0 0.0]T、[14.5 25.1 0.0]T。由于海面環(huán)境復(fù)雜,加之天線間距離較遠(yuǎn),雙差后部分觀測值仍受到較為嚴(yán)重的多路徑效應(yīng)影響,以單個歷元而言它們表現(xiàn)出粗差性質(zhì)。姿態(tài)解算中模糊度固定解的搜索均采用LAMBDA方法,若Ratio值超過3,則視相應(yīng)歷元成功固定。設(shè)計以下4種方案計算浮點(diǎn)解進(jìn)行對比。

        方案1:單歷元最小二乘;

        方案2:單歷元抗差估計;

        方案3:自適應(yīng)濾波;

        方案4:自適應(yīng)抗差濾波。

        方案3和方案4中,取模糊度自適應(yīng)因子αN=1.0e-8,即完全不使用模糊度先驗(yàn)信息,以和方案1、方案2形成對照,因此4個方案均無須主探測周跳。方案3中僅使用了自適應(yīng)因子,未使用抗差等價權(quán)控制粗差干擾。共有1800個觀測歷元,表1所示為各方案的模糊度固定結(jié)果比較,圖1為觀測衛(wèi)星數(shù)及PDOP值,圖2—圖5分別為各方案的航向角估計結(jié)果,其中固定解用直線繪制,浮點(diǎn)解用“*”表示。圖6—圖9分別為各方案的模糊度精度衰減因子ADOP值結(jié)果。ADOP能有效表征模型幾何強(qiáng)度,可對模糊度固定成功率進(jìn)行近似[16]。雖沒有外部姿態(tài)結(jié)果作為參考真值,但只要模糊度固定正確,4種方案的姿態(tài)結(jié)果基本一致,而姿態(tài)浮點(diǎn)解相對固定解會有較大突變,這點(diǎn)可由圖1—圖4看出,因此,主要從模糊度固定成功率的角度評價4種方案。采用“逐歷元L+MCLABMDA”的方法也進(jìn)行了解算,但MCLAMBDA算法無法使用Ratio檢驗(yàn)等方法評價固定效果,對比他們的模糊度固定解,MCLAMBDA算法中1783個歷元的解與本文自適應(yīng)抗差濾波法完全相同,說明兩種方法的正確率相當(dāng),這里主要比較它與本文方法的效率差異,結(jié)果如表2所示(計算平臺:HP dv4-3124tx)。

        表1 模糊度固定結(jié)果Tab.1 Results of Ambiguity Fixing

        圖1 觀測衛(wèi)星數(shù)及PDOP值Fig.1 Observed satellite number and PDOP

        圖2 方案1航向角Fig.2 Yaw of scheme 1

        圖3 方案2航向角Fig.3 Yaw of scheme 2

        圖4 方案3航向角Fig.4 Yaw of scheme 3

        表2 所有歷元姿態(tài)解算總耗時Tab.2 Total time cost of attitude determination of all epochs s

        圖5 方案4航向角Fig.5 Yaw of scheme 4

        圖6 方案1的ADOP值Fig.6 ADOP of scheme 1

        圖7 方案2的ADOP值Fig.7 ADOP of scheme 2

        從以上結(jié)果可以看出:

        (1)相對于最小二乘,抗差估計能夠較好地抵制粗差干擾,提高測姿的可靠性,但是由于未充分利用歷史信息,僅由當(dāng)前觀測值定姿的成功率不高。抗差估計結(jié)果的ADOP結(jié)果較最小二乘略差,因?yàn)榭共罟烙媽Υ植钣^測值進(jìn)行降權(quán),觀測值整體利用率更低。

        圖8 方案3的ADOP值Fig.8 ADOP of scheme 3

        圖9 方案4的ADOP值Fig.9 ADOP of scheme 4

        (2)自適應(yīng)濾波通過自適應(yīng)因子合理利用歷史約束信息,改善觀測結(jié)構(gòu),提高固定率,并具備一定的抗粗差能力,但整體上仍受到粗差觀測值影響。

        (3)自適應(yīng)抗差濾波能夠合理利用姿態(tài)歷史信息,改善整體的結(jié)構(gòu),顯著減小ADOP值,且很好地抵御了粗差干擾,大大提高模糊度固定成功率。實(shí)際上9個未成功固定的歷元中,有4個歷元固定解正確而未通過Ratio檢驗(yàn),而在另外5個歷元處存在較多粗差,同時自適應(yīng)因子為0,觀測結(jié)構(gòu)較差,無法得到可靠的浮點(diǎn)解。

        (4)由于在搜索過程中引入約束條件,MCLAMBDA的計算效率較低,耗時遠(yuǎn)高于自適應(yīng)抗差濾波方法。通常自適應(yīng)抗差濾波比最小二乘更為耗時(如浮點(diǎn)解計算階段),但由于自適應(yīng)抗差濾波得到的浮點(diǎn)解精度高于最小二乘,因此在模糊度搜索過程中更快,整體上效率稍高。

        6 結(jié) 論

        目前沒有可靠的由GNSS載波相位觀測值直接解算歐拉角或四元數(shù)的理論。基于原始觀測值直接定姿的難點(diǎn)在于如何合理利用約束信息,自適應(yīng)抗差Kalman濾波能將姿態(tài)約束信息通過狀態(tài)模型與當(dāng)前的觀測模型融合起來,本文通過建立合適的狀態(tài)模型和調(diào)節(jié)自適應(yīng)因子,最大限度地發(fā)揮歷史信息的作用,同時通過抗差等價權(quán)抵制粗差觀測值的影響,實(shí)現(xiàn)可靠、高效的姿態(tài)確定。除自適應(yīng)因子減小同時又出現(xiàn)粗差這類情況,本文方法均能實(shí)現(xiàn)瞬時姿態(tài)解算。通過模糊度參數(shù)的自適應(yīng),可以結(jié)合周跳探測結(jié)果調(diào)整模糊度歷史信息的權(quán)重,并可轉(zhuǎn)換為無須周跳探測的模式,增加了數(shù)據(jù)處理的靈活性。

        本文建立姿態(tài)估計狀態(tài)模型可以用于陀螺等外部傳感器和GNSS進(jìn)行組合測姿的情況,因此自適應(yīng)抗差Kalman濾波實(shí)現(xiàn)瞬時姿態(tài)確定的方法能用于任何含多天線GNSS的姿態(tài)測量系統(tǒng)中,具有廣闊的應(yīng)用前景。

        [1]LIU Zhijian,LIU Yi.Algorithm of a Real-time Attitude System Using Non-dedicated GPS Receivers[J].Acta Geodaetica et Cartographica Sinica,2005,34(3):213-217.(劉志儉,劉毅.一種基于非專用接收機(jī)的GPS實(shí)時定姿算法[J].測繪學(xué)報,2005,34(3):213-217.)

        [2]LIU Genyou,OU Jikun.Determining Attitude with Single Epoch GPS Algorithm and Its Precision Analysis[J].Geomatics and Information Science of Wuhan University,2003,28(6):732-735.(劉根友,歐吉坤.GPS單歷元定向和測姿算法及其精度分析[J].武漢大學(xué)學(xué)報:信息科學(xué)版,2003,28(6):732-735.)

        [3]LI Zhenghang,LIU Wanke,LOU Yidong,et al.Heading Determination Algorithm with Single Epoch Dual-frequency GPS Data[J].Geomatics and Information Science of Wuhan University,2007,32(9):753-756.(李征航,劉萬科,樓益棟,等.基于雙頻GPS數(shù)據(jù)的單歷元定向算法研究[J].武漢大學(xué)學(xué)報:信息科學(xué)版,2007,32(9):753-756.)

        [4]TANG Weiming,LI Di,CHI Fengming.Research on Single Epoch Orientation Algorithm of BeiDou Navigation Satellite System[J].Geomatics and Information Science of Wuhan University,2013,38(9):1014-1017.(唐衛(wèi)明,李笛,遲鳳明.北斗衛(wèi)星導(dǎo)航系統(tǒng)單歷元定向算法研究[J].武漢大學(xué)學(xué)報:信息科學(xué)版,2013,38(9):1014-1017.)

        [5]LU Gang,CANNON M E.Attitude Determination Using a Multi-antenna GPS System for Hydrographic Applications[J].Marine Geodesy,1994,17(4):237-250.

        [6]WANG C,LACHAPELLE G.GPS Attitude Determina-tion Reliability Performance Improvement Using Low Cost Receivers[C]∥Proceedings of the 15th International Technical Meeting of the Satellite Division of the Institute of Navigation.Portland,OR:[s.n.],2002:1064-1074.

        [7]SCHLEPPE J.Development of a Real-time Attitude System Using a Quaternion Parameterization and Non-dedicated GPS Receivers[D].Alberta,Canada:The University of Calgary,1996.

        [8]TEUNISSEN P J G.A General Multivariate Formulation of the Multi-antenna GNSS Attitude Determination Problem[J].Artificial Satellites,2007,42(2):97-111.

        [9]W ANG Bing,SUI Lifen,ZHANG Qinghua,et al.Research on Attitude Determination Algorithms Using GPS[J].Geomatics and Information Science of Wuhan University,2013,38(12):1392-1395.(王冰,隋立芬,張清華,等.利用GPS解算載體測姿的算法研究[J].武漢大學(xué)學(xué)報:信息科學(xué)版,38(12):1392-1395.)

        [10]CHAI Yanju.Theory and Method for Improving the Navigation Accuracy of GPS/INS Integration by Digging the Hidden Information[D].Wuhan:Institute of Geodesy and Geophysics,Chinese Academy of Sciences,2008.(柴艷菊.挖掘信息提高GPS/INS導(dǎo)航精度的理論與方法研究[D].武漢:中國科學(xué)院測量與地球物理研究所,2008.)

        [11]YANG Yuanxi,HE Haibo,XU Guochang.A New Adaptively Robust Filtering for Kinematic Geodetic Positioning[J].Journal of Geodesy,2001,75(2-3):109-116.

        [12]YANG Yuanxi,HE Haibo,XU Tianhe.Adaptive Robust Filtering for Kinematic GPS Positioning[J].Acta Geodaetica et Cartographica Sinica,2001,30(4):293-298.(楊元喜,何海波,徐天河.論動態(tài)自適應(yīng)濾波[J].測繪學(xué)報,2001,30(4):293-298.)

        [13]MARKLEY F L.Attitude Error Representations for Kalman Filtering[J].Journal of Guidance,Control,and Dynamics,2003,26(2):311-317.

        [14]CUI Xianqiang,YANG Yuanxi.Adaptively Robust Filterring with Classified Adaptive Factors[J].Progress in Natural Science,2006,16(4):490-494.(崔先強(qiáng),楊元喜.分類因子自適應(yīng)抗差濾波[J].自然科學(xué)進(jìn)展,2006,16(4):490-494.)

        [15]YANG Yuanxi,CUI Xianqiang.Adaptively Robust Filter with Multi Adaptive Factors[J].Survey Review,2008,40(309):260-270.

        [16]ODIJK D,TEUNISSEN PJG.ADOP in Closed Form for a Hierarchy of Multi-frequency Single-baseline GNSS Models[J].Journal of Geodesy,2008,82(8):473-492.

        猜你喜歡
        抗差歷元基線
        適用于MAUV的變基線定位系統(tǒng)
        航天技術(shù)與甚長基線陣的結(jié)合探索
        科學(xué)(2020年5期)2020-11-26 08:19:14
        歷元間載波相位差分的GPS/BDS精密單點(diǎn)測速算法
        改善單頻PPP參數(shù)收斂速度的抗差估計方法
        Recent advances of TCM treatment of childhood atopic dermatitis
        一種改進(jìn)的干涉儀測向基線設(shè)計方法
        Clinical observation of Huatan Huoxue Formula in treating coronary heart disease with hyperlipidemia
        Mechanism of sex hormone level in biological clock disorder induced acne and analysis of TCM Pathogenesis
        地形簡化對DEM不確定性的抗差性研究
        基于抗差最小均方估計的輸電線路參數(shù)辨識
        久草青青91在线播放| 国产精品涩涩涩一区二区三区免费| 中文字幕一区二区三区喷水| 国产乱精品女同自线免费| 婷婷五月婷婷五月| 亚洲精品成人网久久久久久| www.尤物视频.com| 成人免费av高清在线| 国产精品videossex久久发布| 天天摸日日摸狠狠添| 亚洲AV秘 无码一区二区三| 蜜桃成熟时日本一区二区| 成品人视频ww入口| 午夜福利电影| 国产人妖xxxx做受视频| 一区二区三区日韩精品视频| 中文字幕日本人妻久久久免费| 日本高清一区二区三区水蜜桃| 丰满人妻中文字幕乱码| 日本一二三四高清在线| 欧美大成色www永久网站婷| 免费毛片视频网站| 国产高清不卡在线视频| 国产三级a三级三级| 欧美亚洲日韩国产人成在线播放| 青草青草久热精品视频国产4| 美腿丝袜日韩在线观看| 亚洲av综合a色av中文| 五月激情婷婷丁香| 久久亚洲春色中文字幕久久久综合| 无码熟妇人妻av在线网站| 依依成人精品视频在线观看| 一区在线播放| 日本刺激视频一区二区| 亚洲国产精品久久人人爱| 在线观看视频亚洲| 日本高清成人一区二区三区 | 久久久久av综合网成人| 久久精品人人做人人爽电影蜜月| AV在线中出| 黄色国产一区二区99|