以粒子滤波为基础的多信息融合室内定位方法设计详解.docx

《以粒子滤波为基础的多信息融合室内定位方法设计详解.docx》由会员分享，可在线阅读，更多相关《以粒子滤波为基础的多信息融合室内定位方法设计详解.docx（8页珍藏版）》请在第一文库网上搜索。

1、以粒子滤波为基础的多信息融合室内定位方法设计详解O引言目前，国内外已有不少对室内定位的研究。FOX1INE等人提出基于惯性测量单元(Inertia1MeasurementUnit,IMU)的传统导航机制，通过对加速度进行两次积分得到行走距离，对陀螺仪积分得到航向变化值,结果得到较为精确的定位结果，然而其卷避度性能的基础是价格昂贵的IMU,在行人定位中并不能普及；1EVIRW和JUDDT提出了行人航迹推算(PeC1eStrianDeadReckoning,PDR)算法来实现行人定位,该算法利用加速度信号探测用户行走时的跨步，采用有关模型估计步长，利用从陀螺仪获得的方向信息推算出行人的速度、位置和

2、距离等信息，其算法简单，比传统惯性导航机制的定位精度更高。然而，随着时间的增加，传感器的误差不断积累,使得到达一定距离后PDR的定位精度急剧下降；谢宏伟等人设计了一款基于稳定性增强粒子滤波磁场匹配算法的壬机室内定位系统，该系统实现了在未知初始方向和位置的情况下的定位，并达到12m的定位精度。但该算法实现复杂，计算速度慢。基于上述原因，本文提出一种基于粒子滤波的多信息融合室内定位方法，通过融合PDR和地磁信息，实时动态补偿PDR的定位误差，实现高精度、低成本、低复杂度的PDR/地磁融合室内定位。1融合定位算法PDR算法利用加速度计、陀螺仪和磁力计等惯性器件得到行人行走时的原始数据，原始数据经扩展

3、卡尔曼滤波融合得到行人的步频、步长以及方向信息。由于惯性器件误差的积累导致定位误差不断增大，所以本文选用地磁来辅助PDR实现室内定位，原理框图如图1所示。粒子权重粒/滤波用户位置地磁定位包含3个方面：一是导航区域地磁数据库的建立；二是载体上磁力计的实时测量；三是地磁匹配。首先把载体经过区域中某些点的地磁场特征量绘制成基准图保存下来，当载体穿越这些区域时，将地磁的相似程度作为基准进行匹配，本文选取粒子滤波算法来完成相似度的匹配。2PDR定位原理PDR技术基本思想是通过载体携带的加速度传感器及方向传感器获得单位时间内载体的位移及方向，从而可以根据上一时刻载体的位置和方向推算出载体在当前时刻的位置和

4、方向。若已知初始位置坐标为(x,y),则第k步的位置坐标为：Xk=Xo+21COS0i4y=yo+r4si1】仇其中*和4分别表示第i步的方向角和:2.1步态检测跨步探测方法有零点探测、峰值探测、自相关、步相探测、零速修正等，具体采取哪种方法与加速度安装位置有关。本文以正常持手机方式采集数据,设计一种基于加速度信号的滑动窗口+峰值探测的步频探测算法。步频探测算法的结果如图2所示，行走过程中的步态基本都被标注出来，步态判别准确率接近100%oIS111IAI1*02468101214IISJ,.：J2/COv3图2步频检测结果2.2步长估计PDR算法中步长估计方法主要有两种：一是基于惯性导航原理

5、对加速度二次积分；二是利用人员行进特性对其特定动作下的行进距离进行建模。基于步长模型的方法大多使用低成本惯性器件实现步长估计。本文PI)R算法用建模的方法来确定行人的步长。假设在行走过程中加速度的变化与步长成比例，在一个周期内，第k步的步长Ik可以通过下式得到：/产仅储IT+3.5%)(2)其中，app表示加速度峰值与谷值的差，B是比例因子，定位之前将得到的训练数据经最小二乘法拟合得到。为了检测步长估计算法的性能，进行8次实验来验证该算法。每次测试者行走的总长度是20m,表1是8组数据的解算距离及误差，表明该步长估计算法的精度在短距离内可以达到1m0表1步长估计结果测试序号参考距离An解算距离

6、An误差/m12019.85070.149322020.95110.951132019.41200.588042020.36340.363452020.67620.676262019.19110.808972020.26210262382020.00.00052.3方向估计对于行人行走时方向角测量，普遍采用低成本陀螺仪、加速度计和磁力计等实现。陀螺仪的零点存在温度漂移，加速度计会受到载体震动的影响，磁力计会被外部磁场干扰。因此，为了得到可靠、准确的方向角，必须利用滤波器融合不同传感器的数据、滤除不必要的干扰。本文选取扩展卡尔曼滤波器实现融合算法。图3是由扩展卡尔曼滤波器得到的行人方向角，由于误

7、差的存在，由扩展卡尔曼滤波得到的方向角与参考方向还是存在一定的偏差，最大误差接近30oO0OIO203040506070s0050(JO50(X)50W504332211(O)/叵/图3方向角解算3地磁定位地磁定位的关键是地磁匹配算法，地磁匹配是指利用地磁图进行导航定位的过程。首先把载体经过区域中某些点的地磁场特征量绘制成地磁匹配参考图或称基准图保存在载体计算机中，当载体穿越这些区域时，将地磁的相似程度作为基准进行匹配，认为最佳匹配点就是行人的位置。3.1地磁基准数据库的建立克里金插值法是一种最优、线性和无偏的估计方法，是应用最广泛的空间内插方法之一，能最大程度地利用所给的信息，具有很高的插值

8、精度。图4是经克里金插值后的室内地磁基准图。503.2粒子滤波粒子滤波是一种使用有限数量粒子来表示状态的后验分布的非参数化滤波算法。在粒子滤波算法中，状态的后验分布采样点被称为粒子，每个粒子都表示对当前状态的假设，通过粒子的权重来衡量该粒子所表示状态的可能性大小，如果一个区域内的粒子非常密集，表示实际状态在该区域的概率非常大。粒子滤波主要由状态方程、观测方程以及重采样等部分组成。本文的状态方程如式（3）所示：Xk+.+A)COS(仇+A0)sin(ft+0)(3)式中，（看,九）表示第A步的位置坐标，/2和仇分别表示经粒子权重加权过的步长和方向值，和表示步K和方向的随机误差，均服从高斯分布。观

9、测方程的核心在于如何计算粒子权重3,而3实际上依赖于所在位置的磁场变化率，但是这个变化率在不同的位置不尽相同，而且无法准确测量。这里认为3是服从高斯分布的“3,如式（4）所示：叫一（2TryIIIS7Uexp-4(dS*)-(cbs-obsf)pVuJJJ)eyiOy1-(Oiss1+,-obss/)W-I)(砌式中，n表示观测值Z的维度，本文用磁场向量的模值作为观测值，所以n=1;V是协方差；ObSS表示由地磁匹配得到的当前位置对应的地磁值；Z表示当前位置地磁的观测值。PDR算法可以计算行人的步长，然而，由于惯性器件的累积误差使得步长的误差较大。本文通过设定步长初始值并由粒子权重不断修正的方

10、式来得到动态步长。正常人行走的步长范围为0.5m0.7m,假设步长的初始值10=0.6m,则步长计算如式(5)所示：4+=(1)0i(5)i=1其中，N表示粒子的个数4表示第A+1步的加权步K,(4+i)表示第A步第i个粒子的步氏表示第力步第，个粒子的权重。方向角的初始值由PDR算法得到，为了避免随着行走距离的增加导致由PDR算法得到的方向角不准确，本文通过粒子滤波算法不断迭代得到方向角，方向角的计算如式(6)所示：Nft=(k+Si)k(6)i=1式中，N表示粒子的个数，仇讨表示第A1步的加权方向值，(仇+A仇)表示第1步第z个粒子的方向，&表示第k步第i个粒子的权重。若遇到转弯情况，欧用手

11、平英法得到的方向角。/少：；：一仙3.3重采样在粒子滤波中存在粒子退化的问题，粒子权值的方差随着时间增大，状态空间中的有效粒子数较少，随着无效采样粒子数目的增加，使得大量的计算浪费在对估计后验滤波概率分布几乎不起作用的粒子上，使得估计性能下降，粒子群逐渐发散。重采样方法可以有效解决粒子退化问题。当有效粒子数小于某一阈值时，便对粒子进行重采样。重采样的思想就是舍弃权重小的粒子，将权重大的粒子复制几次得到新粒子，用这些新粒子代替舍弃掉的粒子，至于每个粒子复制几次完全由粒子的权重决定。4实验结果及分析为了验证本文提出的基于粒子滤波的多信息融合室内定位算法的可行性，在室内环境进行了实验。实验场地为大学

12、图书馆四楼413实验室。为了提高磁场定位的精度，采用克里金插值算法对采集到的地磁数据进行0.5m间隔的空间插值。设定初始位置已知，实验者手持手机在实验室沿指定路径行走一周。在行走的过程中，手机以20HZ的频率采集并保存加速度计、陀螺仪以及磁力计的原始数据，最终由MAT1AB软件仿真出结果。本文对两种定位算法的结果进行对比：第一种是基于扩展卡尔曼滤波的纯PDR定位算法，第二种是基于粒子滤波的多信息融合室内定位算法。图5是由两种算法得到的MAT1AB仿真图，由图5看出基于粒子滤波的融合室内定位算法的性能明显优于PDR算法。由于惯性器件的精度不高，随着时间的增加由扩展卡尔曼滤波器得到的方向角误差不断

13、增大，导致由PDR得到的行人轨迹严重偏离实际轨迹。由于粒子滤波算法能够不断地修正步长和方向角，这就解决了PDR中误差不断积累的问题。所以，随着行走距离的增加，基于粒子滤波的融合室内定位算法的精度能够保持稳定。O268IO12;ONEast/m定位结果仿真图/本文比较两条仿真轨迹与参考轨迹的坐标数据，得到两种算法的误差，如表2所示。表2估计路径与实际路径误差最大误差/m最小误差/m平均误差/m均方误差/mPDR5.010.31.46,2.Q9raMC2(rK粒子滤波1.430.150.43O6！由表2可知，本文提出的算法与PDR算法相比，平均误差减少了70.5%,均方误差减少了70.8%。实验结果表明，本文提出的基于粒子滤波的多信息融合室内定位算法可以解决定位误差累积的问题，有效地提高了定位精度。5结论在室内定位技术中，针对传统PDR短距离精度高、长距离累积误差严重和地磁匹配容易受外界干扰磁场的影响等问题，本文提出一种基于粒子滤波的多信息融合室内定位算法，该算法通过动态补偿步长和方向角误差有效地抑制了定位结果的发散。实验结果表明，该算法的精度能达到12m,验证了该算法的有效性和可行性。