郝萬亮，孫付平

(信息工程大學(xué)導(dǎo)航與空天目標(biāo)工程學(xué)院,河南 鄭州 450000)

Research on POS Algorithms with High Precision Based on Two Kalman Filters

HAO Wanliang,SUN Fuping

?

基于雙卡爾曼濾波器的高精度POS算法研究

郝萬亮，孫付平

(信息工程大學(xué)導(dǎo)航與空天目標(biāo)工程學(xué)院,河南 鄭州 450000)

Research on POS Algorithms with High Precision Based on Two Kalman Filters

HAO Wanliang,SUN Fuping

摘要：高精度的位置姿態(tài)系統(tǒng)(POS)在測(cè)繪領(lǐng)域發(fā)揮著重要的作用，數(shù)據(jù)處理算法是其核心技術(shù)之一。本文首先介紹了數(shù)據(jù)處理流程，提出了一種基于雙卡爾曼濾波器的緊組合模式，并詳細(xì)推導(dǎo)了其狀態(tài)方程和量測(cè)方程，然后利用實(shí)測(cè)跑車數(shù)據(jù)對(duì)該算法進(jìn)行了驗(yàn)證，并與IE(Inertial Explore)8.4的處理結(jié)果進(jìn)行了對(duì)比分析。結(jié)果表明該方法能夠達(dá)到較高的位置速度和姿態(tài)精度，是一種有效的數(shù)據(jù)處理算法。

關(guān)鍵詞：POS;GNSS/INS;緊組合;雙卡爾曼濾波器

一、引言

全球衛(wèi)星導(dǎo)航系統(tǒng)(global navigation satellite system,GNSS)和慣性導(dǎo)航系統(tǒng)(inertial navigation system,INS)具有良好的互補(bǔ)特性，因此GNSS/INS組合成為組合導(dǎo)航領(lǐng)域主要的組合方法。目前應(yīng)用最廣泛的是基于偽距的組合，但是其定位精度只能達(dá)到米級(jí)，尚不能滿足對(duì)于厘米級(jí)甚至更高精度的位置姿態(tài)系統(tǒng)(positioning and orientation system，POS)的要求。POS系統(tǒng)廣泛應(yīng)用于遙感[1]、車載移動(dòng)測(cè)圖[2]、國(guó)家基礎(chǔ)測(cè)繪、城市規(guī)劃、國(guó)土資源管理[3-4]等方面，它充分利用了載波相位信息與慣導(dǎo)組合來獲取載體的位置和姿態(tài)信息，高精度的數(shù)據(jù)處理算法是POS系統(tǒng)的核心技術(shù)之一[5]。

本文首先介紹了POS系統(tǒng)數(shù)據(jù)處理的流程，利用雙卡爾曼濾波器進(jìn)行整周模糊度的估計(jì)與誤差修正量的計(jì)算；其次對(duì)基于載波相位觀測(cè)量的緊組合卡爾曼濾波模型進(jìn)行了分析，列出了其狀態(tài)方程和量測(cè)方程；最后通過實(shí)測(cè)數(shù)據(jù)驗(yàn)證了該算法的精度，并與高精度GNSS/INS數(shù)據(jù)處理軟件IE(Inertial Explore)的后處理結(jié)果進(jìn)行了比較。

二、數(shù)據(jù)處理流程

整個(gè)系統(tǒng)數(shù)據(jù)的采集主要通過慣性測(cè)量單元(inertial measurement unit，IMU)、基站GNSS接收機(jī)及移動(dòng)站GNSS接收機(jī)3部分獲得，如圖1所示。IMU可實(shí)時(shí)測(cè)量載體的角速度及加速度信息，通過解算獲得載體的位置速度和姿態(tài)等全部運(yùn)動(dòng)參數(shù)，但是其誤差隨時(shí)間積累，GPS利用載波相位信息可以得到高精度的位置和速度，但是信號(hào)容易受到遮擋和干擾，因此POS系統(tǒng)中常常將二者組合起來實(shí)現(xiàn)優(yōu)勢(shì)互補(bǔ)[6]。在數(shù)據(jù)處理方面，為了減小矩陣的維數(shù)便于計(jì)算，不采用附加模糊度參數(shù)的集中卡爾曼濾波器，而是利用兩個(gè)分散的濾波器共同完成[7]。其中主卡爾曼濾波器用于狀態(tài)參數(shù)的估計(jì)，對(duì)慣導(dǎo)計(jì)算出來的導(dǎo)航結(jié)果及慣性器件誤差進(jìn)行閉環(huán)修正，次卡爾曼濾波用來對(duì)模糊度的浮點(diǎn)解及其協(xié)方差陣進(jìn)行估計(jì)；同時(shí)利用慣導(dǎo)輸出的位置信息，提高模糊度浮點(diǎn)解的精度和縮小搜索范圍，LAMBDA用來完成模糊度的搜索，將固定之后的整數(shù)模糊度代入主卡爾曼濾波器中，完成參數(shù)的估計(jì)過程。

圖1　數(shù)據(jù)處理流程

三、濾波模型

由于主卡爾曼濾波需要用到次卡爾曼濾波的整周模糊度信息，因此首先介紹次卡爾曼濾波的狀態(tài)方程和量測(cè)方程。

1. 次卡爾曼濾波器

濾波器的狀態(tài)方程為

Xk=Φk,k-1Xk-1+Γk-1Wk-1

(1)

式中

Wk-1為系統(tǒng)噪聲協(xié)方差矩陣。

濾波器的量測(cè)方程為

(2)

(3)

或記為

(4)

式中

整個(gè)濾波器的遞推方程為

Xk,k-1=Φk,k-1Xk-1,k-1

(5)

(6)

(7)

(8)

(9)

首先設(shè)定初值，通過遞推求出每個(gè)歷元整周模糊度浮點(diǎn)解及其協(xié)方差矩陣，然后經(jīng)過LAMBDA算法固定整周模糊度，同時(shí)也可以求出移動(dòng)站位置。

2. 主卡爾曼濾波器

(10)

參考文獻(xiàn)式(10)中各參數(shù)矩陣的設(shè)計(jì)[9]。

利用次卡爾曼濾波器求出整周模糊度后，就可將其代入雙差載波相位觀測(cè)方程，形成主卡爾曼濾波器的量測(cè)方程

Z(t)=H(t)X(t)+V(t)

(11)

式中

其中

Drr為ECEF坐標(biāo)系轉(zhuǎn)換為當(dāng)?shù)厮阶鴺?biāo)系的誤差轉(zhuǎn)換矩陣，因?yàn)闋顟B(tài)方程的狀態(tài)變量為當(dāng)?shù)厮阶鴺?biāo)系下的，而雙差載波相位觀測(cè)方程的誤差是ECEF坐標(biāo)系下的，因此需要乘以一個(gè)轉(zhuǎn)換矩陣Drr，其具體計(jì)算公式可參考文獻(xiàn)[9]；V(t)為量測(cè)誤差。

經(jīng)過卡爾曼濾波的遞推計(jì)算，即可估計(jì)出移動(dòng)站的位置、速度和姿態(tài)信息。

四、算例分析

為驗(yàn)證本文所提算法的精度，采用一組實(shí)測(cè)的跑車試驗(yàn)數(shù)據(jù)，其中陀螺儀的零偏為0.75 deg/h，加速度計(jì)的零偏為1 mg，整個(gè)系統(tǒng)采用基準(zhǔn)站加流動(dòng)站的工作模式，圖2為跑車運(yùn)行軌跡路線，圖3為整個(gè)運(yùn)動(dòng)過程中基準(zhǔn)站和流動(dòng)站的共視衛(wèi)星數(shù)。

圖2　跑車運(yùn)行軌跡

由于跑車路線位于市區(qū)，高樓林立，遮擋情況比較嚴(yán)重，可視衛(wèi)星數(shù)變化劇烈，個(gè)別時(shí)刻只有2～3顆可見星，給模糊度的固定帶來一定的困難，直接影響導(dǎo)航解算的精度。為驗(yàn)證本文所提算法的效果，以Inertial Explore 8.4軟件的解算結(jié)果作為參考值，利用本文所述算法解算出來的位置、速度及姿態(tài)誤差如圖4—圖6所示，誤差的統(tǒng)計(jì)結(jié)果見表1。

圖3　共視衛(wèi)星數(shù)

圖4　位置誤差

圖5　速度誤差

圖6　姿態(tài)誤差

平均值標(biāo)準(zhǔn)差RMS最大值位置/m東向-0.00530.01510.01600.0502北向-0.00630.02200.02290.1133天向0.01480.02850.03210.0990速度/(m/s)東向-0.00040.00450.00450.0150北向-0.00010.00520.00520.0250天向0.00220.00310.00380.0120姿態(tài)/(°)俯仰角 0.00540.00580.00800.0420橫滾角-0.00050.00560.00560.0340航向角0.01860.03550.04010.2200

從圖4—圖6誤差曲線及表1的誤差統(tǒng)計(jì)結(jié)果可以看出，在觀測(cè)條件好、可視衛(wèi)星數(shù)較多的情況下，利用本文所述的雙卡爾曼濾波算法，可以取得較好的位置、速度及姿態(tài)精度，其中位置誤差的RMS值優(yōu)于4 cm，速度誤差RMS值不大于5 mm/s,俯仰和橫滾角RMS值小于0.008°，航向角誤差的RMS值為0.04°，這主要是因?yàn)楹较蚪堑目捎^測(cè)性較差。雖然個(gè)別時(shí)刻觀測(cè)衛(wèi)星數(shù)較少，但是由于在解算時(shí)采取了緊組合的模式，對(duì)解算結(jié)果的精度影響不大，充分說明了緊組合模式的優(yōu)越性。

五、結(jié)束語(yǔ)

充分利用載波相位信息并正確解算模糊度是獲得高精度POS系統(tǒng)的關(guān)鍵，本文通過雙卡爾曼濾波器實(shí)現(xiàn)了模糊度的解算和導(dǎo)航參數(shù)誤差的估計(jì)，解決了單卡爾曼濾波解算由于參數(shù)多帶來的穩(wěn)定性問題，詳細(xì)論述了每個(gè)濾波器狀態(tài)方程與量測(cè)方程的建立過程，利用實(shí)測(cè)數(shù)據(jù)將該算法與高精度數(shù)據(jù)后處理軟件IE的處理結(jié)果進(jìn)行了比較。結(jié)果表明，該方法能夠達(dá)到較高的定位、定姿及測(cè)速精度，充分證明本文提出的算法是一種高精度的數(shù)據(jù)處理方法。

[1]李斐, 束蟬方, 陳武. 遙感技術(shù)中GPS/INS組合系統(tǒng)的應(yīng)用[J]. 測(cè)繪通報(bào), 2004(12): 1-4.

[2]陳允芳, 葉澤田. 基于多傳感器融合的車載移動(dòng)測(cè)圖系統(tǒng)研究[J]. 測(cè)繪通報(bào), 2007(1): 5-7, 19.

[3]DE AGOSTINO M, PORPORATO C. Development of an Italian Low Cost GNSS/INS System Universally Suitable for Mobile Mapping[C]∥2008 IEEE/ION Position, Location and Navigation Symposium. Monterey, CA: IEEE, 2008: 53-59.

[4]EI-SHEIMY N. The Development of VISAT-A Mobile Survey System for GIS Applications[D]. Calgary: University of Calgary, 1996: 13-18.

[5]邱宏波, 周東靈, 李文耀, 等. 基于閉環(huán)誤差控制器的高精度POS后處理算法[J]. 中國(guó)慣性技術(shù)學(xué)報(bào), 2010, 18(6): 691-695.

[6]房建成, 楊勝, 劉百奇. 高性能POS及其在移動(dòng)測(cè)圖系統(tǒng)中的應(yīng)用[J]. 紅外與激光工程, 2007, 36(S0): 478-482.

[7]孫紅星. 差分GPS/INS組合定位定姿及其在MMS中的應(yīng)用[D]. 武漢: 武漢大學(xué), 2004: 95-98.

[8]劉基余. GPS衛(wèi)星導(dǎo)航定位原理與方法[M]. 北京: 科學(xué)出版社, 2003: 289-292.

[9]苗岳旺. SINS/GPS組合導(dǎo)航數(shù)據(jù)處理方法研究[D]. 鄭州: 信息工程大學(xué), 2013.

引文格式： 郝萬亮，孫付平. 基于雙卡爾曼濾波器的高精度POS算法研究[J].測(cè)繪通報(bào)，2015(6)：12-15.DOI:10.13474/j.cnki.11-2246.2015.0167

作者簡(jiǎn)介：郝萬亮(1982—)，男，博士生，主要研究方向?yàn)閼T性導(dǎo)航與組合導(dǎo)航技術(shù)。E-mail:1520502694@qq.com

基金項(xiàng)目：國(guó)家自然科學(xué)基金(41070411)

收稿日期：2014-05-07

中圖分類號(hào)：P228.4

文獻(xiàn)標(biāo)識(shí)碼：B

文章編號(hào)：0494-0911(2015)06-0012-04