基于改进粒子滤波算法的GPS非高斯伪距误差修正精

1、第23卷第6期,24,电子测量与仪器学报JOURNALOFELECTRONICMEASUREMENTANDINSTRUMENTVol.23No.62009年6月基于改进粒子滤波算法的GPS非高斯伪距误差修正涂刚毅金世俊祝雪芬宋爱国(东南大学仪器科学与工程学院，南京210096)摘要：针对城市环境中由于受到多径效应影响，GPS伪距误差呈非高斯分布的问题，本文通过对实测数据进行分析，在建立正确的伪距误差分布模型的基础上，提出了一种改进粒子滤波修正算法，用于优化PVT解算结果，提高了GPS在城市环境中定位的精度。并通过与卡尔曼滤波定位优化算法结果进行比较，验证了此算法的有效性。关键词：GPS;粒子滤

2、波器；伪距；定位精度中图分类号：TP228文献标识码：A国家标准学科分类代码：510.40CompensationofGPSnon-GaussianpseudorangeerrorbasedonimprovedparticlefilteralgorithmTuGangyiJinShijunZhuXuefenSongAiguo(SchoolofInstrumentScienceandEngineering,SoutheastUniversity,Nanjing210096,China)Abstract:Duetothemulti-patheffectinurbanenvironment,GPSp

3、seudorangeerrorappearsnon-Gaussianerrordistribution.Inthispaper,thecorrectpseudorangeerrordistributionmodelhasbeenestablishedaccordingtotheanalysisofthemeasureddata.Basedonthisnon-Gaussianmodel,animprovedparticlefilteralgorithmisimplementedtocompensatethenon-Gaussianpseudorangeerrorandoptimizetheest

4、imationsofPVT.TheaccuracyofGPSurbanpositioningisimprovedandthevalidityofthisalgorithmhasbeenverifiedbycomparingwithKalmanfilterexperiments.Keywords:GPS;particlefilter;pseudorange;positioningaccuracy本文于2009年2月收到。*基金项目：教育部重大培育(编号：708045)资助项目；江苏省六大高峰人才”资助项目；东南大学优秀青年教师基金(编号:4022001004)资助项目。1引言目前，全球定位系统(

5、globalpositioningsystem,GPS)在军事和民用方面均得到了越来越广泛的运用。GPS定位技术要求接收机和卫星之间无遮挡，但在城市环境中，由于伪距测量会受到多径效应的影响，造成信号延迟，从而引入较大误差，影响定位精度。统计实验结果显示，受到多径效应影响的伪距误差，其误差分布为非高斯分布川。常规卡尔曼滤波方法不能用来对非高斯的误差进行修正。粒子滤波作为一种非线性滤波方法，随着采样粒子数的不断增大，逐渐趋向状态的后验概率密度，在解决非高斯分布误差问题时具有明显的优势2。基于以上理论，本文提出了一种利用粒子滤波器对非高斯的伪距误差进行修正的方法，用于提高GPS在城市环境中位置、速度

6、、时间(position、velocity>time,PVT)解算的精度。该算法具体实现分为三步：PVT位置解算；建立伪距误差分布模型；在此模型基础上利用粒子滤波器对伪距误差进行修正，从而提高GPS定位精度。限于篇幅，本文仅对后两基于改进粒子滤波算法的GPS非高斯伪距误差修正-25步研究结果进行介绍，并且将本文提出的粒子滤波算法与卡尔曼滤波(Kalmanfilter,KF)定位优化算法结果进行了比较。2伪距误差分布特性由于粒子滤波器应用是建立在误差分布已知的前提下，所以实验的第一步就是建立精确的伪距误差分布模型1。首先需要获知接收机在测试点的精确坐标。该坐标可以通过在房顶使用高精度接收机

7、测得同一位置坐标，减去两点间高程差获得。实验显示伪距误差分布因信噪比(signal-to-noiseratio,SNR)不同而变化。故在利用粒子滤波器对伪距误差进行修正时，应根据信噪比选用不同的误差模型。本文研究对象为城市环境中的GPS信号，特点是由于受建筑物或树木遮挡的影响，可视卫星数量少，且GPS信号的信噪比普遍较低。伪距误差分布特性统计结果如图1(a),(b)所示。如图1(a),(b)所示，在城市低信噪比环境下，伪距误差方差较大，误差均值也发生较大偏移，其分布呈非高斯分布。因而利用粒子滤波器对此非高斯分布的伪距误差进行修正，方法可行。需要指出的是伪距误差的均值和方差因接收机型号的不同而有

8、所不同。(a)统计分布图(a)Chartdistribution(b)方差及均值曲线(信噪比：1545dB)(b)Varianceandmeancurve图1伪距误差曲线Fig.1Pseudorangeerrorcurve3系统状态方程及观测方程离散系统的非线性，非高斯随机状态空间模型可表示为下式2:Xk=f(Xk，Wk)(1)yk=h(Xk,vj式中：Xk为系统在k时刻的状态向量，yk为观测向量,Wk与vk分别为系统噪声和量测噪声，二者相互独立。f,h分别为有界非线性映射。为避免粒子滤波器当状态向量的维数增加，粒子总数迅速增加，运算效率迅速降低的问题，应尽量减少状态向量的维数。在本文中，k时

9、刻粒子滤波器的状态向量设为四维，即xk=Lank,Lonk,Hk,bkT0其中Lonk为经度值，Lank为纬度值，Hk为高度坐标，bk为时钟误差。测量值yk=URdP2,|,APNktT。式中：Nsat为在k时刻可视卫星的数量。为接收机与卫星i之间的伪距误差，可以通过下式计算得到1:"i=R狂一&bj&tro-4&门(2)式中：i为卫星编号，R是从卫星i到接收机的距离，当接收机估计坐标已知时，该参数可通过计算得到。E为接收机计算得到的卫星i到接收机的距离，瓯为卫星时钟偏差，可通过PVT解算获得；&；ro和%ion分别为对流层和电离层的传输延时，该两项误

10、差可以通过导航电文中的参数计算得到。-26电子测量与仪器学报2009年4粒子滤波器算法及实现粒子滤波器是通过递归蒙特卡罗采样实现跟踪的一种统计计算方法，其算法包括4个主要步骤：初始化粒子集、预测、更新和重采样。粒子滤波器在计算过程中随着时间的增长，一部分粒子的权值会变得非常大，而其余粒子的权值很小，从而丧失粒子的多样性，导致精度下降，这一现象被称为粒子退化。为了解决这一问题，本文中采用了顺序重要重采样(sequentialimportanceresampling,SIR)算法2-4。根据处理对象，具体实现步骤如下：1)初始状态，k=0,根据PVT解算估算的结果X0,将其作为状态空间中心，生成N

11、个样本父；3。每个样本被认为是一个粒子。2)给每一个粒子分配相同的权值：,j1wk=；,j=1,2,W,N；(3)N3)对粒子的权值进行更新。a.计算粒子j与卫星i之间的伪距误差ARj,并将其作为k时刻的测量值yk=»"以此出2年3'(4)式中：NSat为在k时刻被接收机捕获的卫星数量。b.根据式(5),逐个更新粒子j的权值2jjp(yklx/)p(xk|xL)j.j.Wk=Wk3j-j=Wkp(yk|Xk)(5)q(Xk|Xk4)式中：j=1,2,|,N,q(Xj|xki为重要性密度函数，即粒子的取样分布函数，p(xk|x)为后验密度函数。不同卫星间伪距误差可认为

12、相互独立，由式(4),可认为Nsatp(yk|xk)=口p(AP|xk)(6)i1将其代入式(5),得到Nsatwk=wLnpSRj|xk)i1其中，后验密度函数p(ARj|xk)可以根据图1(a)伪距误差分布模型得到。c.对粒子权系数进行规一化wr(8)“.wk图2粒子滤波器算法结构框图Fig.2Blockdiagramofparticlefiltersalgorithms4)计算有效粒子数Neff和门限粒子数Nth冏：12NNeff-N2,Nth-(9)平wk)3jT5)如果Neff>Nth,记录所有粒子x二xk及其权彳tw/，j=1,2,W,N。否则根据重采样算法对粒子进行重采样，

13、并重复步骤2)至5)。6)计算优化后的状态参量xk：Nxk=£wk*xk*(10)jT7)重复步骤3至6,直到轨迹结束。具体流程如图2所示。此外，在步骤1生成粒子时，可根据PVT解算基于改进粒子滤波算法的GPS非高斯伪距误差修正-27结果中的水平精度因子(horizontaldilutionofprecision,HDOP)、高程精度因子(verticaldilutionofprecision,VDOP)和时间精度因子(timedilutionofprecision,TDOP)值决定粒子状态空间的大小和粒子的数量。在用户距离误差的标准差不变的情况下，DOP与同方向上的位置误差成比例关

14、系。当HDOP,VDOP和TDOP值较大时，表明当前卫星分布不合理，通常定位结果误差较大，则需扩大粒子滤波器粒子分布的状态空间，并增加粒子的数量。5实验结果本实验选用的GPS接收机为一款商用蓝牙接收机GlobalsatBT338。较一般商用接收机，该接收机支持伪距等原始数据输出，且小巧，便于携带和安装在如移动机器人等小型设备上。为便于比较定位误差，实验时，接收机不移动，位置固定。实验环境如图3所示，部分信号被高层建筑遮蔽，同时接收机受到前方屋顶反射造成的多径效应误差的影响，是典型的城市环境。图3实验环境Fig.3Experimentenvironment为对算法的有效性进行验证，本文将粒子滤波

15、器算法结果与卡尔曼滤波算法结果进行了比较。GPS卡尔曼滤波方法及模型在多本专著中都有论述，针对GPS定位精度优化问题，本文采用文献5的模型及方法。由于篇幅有限，在此不做介绍。实验时，卡尔曼滤波算法中接收机在经度、纬度、高度方向上速度分量误差的均方差均取为0.5m/s,时钟漂移造误差的均方差均取为10m。通过对约8分钟的连续GPS信号进彳T处理，得到以下结果。在图4精度因子曲线图中，HDOP、VDOP、TDOP值均在正常范围内，据此可知PVT解算结果正确，未出现定位异常。图4精度因子曲线图Fig.4DOPcurves通过将PVT、卡尔曼滤波和粒子滤波定位结果与真实坐标进行比较，得到图5定位误差曲

16、线和表1。实验证明，利用卡尔曼滤波算法和粒子滤波算法又PVT定位结果进行优化，均取得了较好的效果其中粒子滤波算法定位误差被减少了37.10%。同时，为了对PVT和粒子滤波算法定位结果的离散情况进行比较，可对两种算法的定位误差的方差值进行比较。实验结果显示，通过应用本文提出的粒子滤波算法，在经度和纬度方向上，定位误差的方差均得到了优化。其中经度方向上粒子滤波算法改进明显，定位方差减少了68.15%。图6为定位结果分布图，粒子滤波算法定位结果较卡尔曼滤波算法定位结果更加集中，从而提高了GPS在城市环境中定位的准确度。-28电子测量与仪器学报2009年-PVT定W谡基曲线甘尔姑涉波定位误龙曲行一朴子

17、波波定位误差Illi建表2定位误差方差/m较PVT优化经度14.7825PVT纬度21.5549经度13.054511.69%卡尔曼滤波纬度16.033325.62%粒子经度4.708268.15%滤波纬度15.08530.02%Table2Varianceofpositioningerror图5定位误差曲线Fig.5Positioningerrorcurves6结论表1定位误差均值Table1Meanerrorofpositioning定位误差/m较PVT优化PVT22.5959卡尔曼滤波18.084819.96%粒子滤波14.212837.10%短(1劭发乱啪32.OJBK32.0S86*

18、32.O5M就32,05832.057132057ft32057-1综上所述，本文提出的改进的粒子滤波器算法可以用于对城市环境下的非高斯伪距误差进行补偿减少PVT定位误差，提高其定位精度，同时使得定位结果更加集中，提高了系统的稳定性。IK7KH7IINIIK.7HK9LKIIXT削IIIS.TM1KI7894IIH.7KV5II8飞加纬度产图6定位结果分布图Fig.6Positioningdistribution参考文献:123TORREAD,GHINAMOG,DETOMAE,etal.AnalysisoftheaccuracyofindoorGNSSmeasurementsandpositi

19、oningsolutionC.Toulouse:TheEuropeanNavigationConference-GlobalNavigationSatelliteSystems,ENC-GNSS,2008:22-25.ARULAMPALAMS,MASKELLS,GORDONN,etal.Atutorialonparticlefiltersforon-linenon-linear/non-gaussianbayesiantrackingJ.IEEETransactionsonSignalProcessing,2002,50(2):174-188.AGGARWALP,SYEDZ.,ELSHEIMY

20、N.Hybridextendedparticlefilter(HEPF)forintegratedciviliannav456igationsystemC.Monterey:Position,LocationandNavigationSymposium,IEEE/ION,2008:984N92.BOLICM,DJURICPM,HONGS.Resamplingalgorithmsforparticlefilters:AcomputationalcomplexityperspectiveJ.EURASIPJournalonAppliedSignalProcessing,2004,2004(15):

21、2267-2277.BROWNRG,HWANGPYC.IntroductiontorandomsignalsandappliedkalmanfilteringM.NewYork:JohnWiley&Sons,Inc.,1997.438-457.VERMAAKJ,GODSILLSJ,PeREZP.MonteCarlofilteringformulti-targettrackinganddataassociationJ.IEEETransactionsonAerospaceandElectronicSystems,基于改进粒子滤波算法的GPS非高斯伪距误差修正-292005,41(1):309-332.7S?RKK?S,VEHTARIA,LAMPINENJ.Rao-Blackwellizedparticlefilterformultipletargettr