一种基于物理场的室内定位方法技术

本发明专利技术公开了一种基于物理场的室内定位方法，所述方法是一种改进的行人航迹推算与地磁指纹匹配方法融合的室内定位方法。其中，基于有限状态机的步频检测算法误判率低且计算量更小；步长自适应模型能够根据行人运动状态更换步长模型参数，实现步长自适应估计，估算出的行人每步步长更加准确；经过倾斜补偿和磁偏角补偿后解算出的航向更为精确；根据有效粒子规模判断是否重采样可以在权值退化及多样性匮乏之间取得平衡，重采样之后进行粒子粗化能增加粒子的多样性，进而提升了算法的鲁棒性。本发明专利技术算法复杂度低，准确性高，且不依赖任何节点信息，定位所需信息完全由物理场提供，具有重要的实用价值。

【技术实现步骤摘要】
一种基于物理场的室内定位方法
本专利技术涉及定位
，具体涉及一种基于PDR和地磁指纹融合的室内定位方法。
技术介绍
定位技术分为室外定位技术和室内定位技术两种，常用的室内定位方法有很多种，其中最常用的有以下几种：(1)行人航迹推算(PDR)：PDR是一种相对定位方法，它通过实时测量行人的步频、步长和航向信息，不依靠外部信息自主定位，在短期内精度高，稳定性好。但是PDR会受到传感器特性的影响，误差会随时间累积。(2)WIFI定位：WIFI定位是通过采集目标点的信号强度与事先建立好的指纹数据库做比对来得到目标点的位置信息。WIFI的误匹配率低但定位结果波动显著，并且需要部署足够多的节点才能保证定位的准确性。(3)超宽带(UWB)：超宽带技术是通过发送纳秒级或纳秒级以下的超窄脉冲来传输数据，可以获得Ghz级的数据带宽，实现室内定位。但是UWB难以实现大范围室内覆盖，而且系统建设成本极高。(4)地磁匹配(MM)：地磁匹配是将实时的地磁信息与地磁数据库中贮存的基准图进行匹配，根据一定的准则判断两者的拟合程度找出最相似点就可以实现定位。然而当地图过大时，地磁匹配会存在模糊解的问题。目前，使用单一技术的室内定位方法都有一定的局限性，且部分室内定位方法需要布置大量节点才能完成定位，还没有一种普适化技术能满足当前所有的室内定位服务需求，急需一种将多种方法特点优势互补的室内定位方法。
技术实现思路
本专利技术针对地磁场在室内定位中存在模糊解及行人航迹推算(PDR)存在累积误差的问题，提供一种改进的行人航迹推算与地磁指纹匹配方法融合的室内定位方法，不依赖任何节点，以PDR定位结果为中心，缩小地磁匹配区域，采用改进的粒子滤波算法解决地磁指纹的模糊解问题，达到实时修正PDR累积误差，有效的提升室内定位精度的目的。本专利技术的技术方案中主要包括改进的对行人步频检测步骤、步长检测步骤和航向解算步骤。在所述步频检测步骤中，当a(代表行人的三轴合加速度)经过了下述的全部状态后计为行人迈出了一步：(1)初始状态为S0，当a大于Thr时，状态由S0转入S1，否则在S0状态循环。(2)在S1状态时，当a大于Peak_Thr时，状态由S1转入S2，当a小于Thr时，由S1跳回S0，否则在S1状态循环。(3)在S2状态时，当a大于Neg_Thr且小于Peak_Thr时，状态由S2转入S3，否则在S2状态循环。(4)在S3状态时，当a小于Neg_Thr时，状态由S3转入S4，当a大于Peak_Thr时，状态由S3跳回S2，否则在状态S3循环。(5)在S4状态时，当a大于Neg_Thr且小于Thr时，状态由S4转入S5，否则在状态S4循环。(6)在S5状态时，当a大于Thr时，状态由S5转入S0，当a小于Neg_Thr时，状态由S5跳回S4，否则在状态S5循环。上述步骤中：Thr代表a的检测阈值；Peak_Thr代表a的峰值阈值；Neg_Thr代表a的谷值阈值；S0代表行人静止状态；S1代表a上升；S2代表a上升进入波峰状态；S3代表a下降离开波峰进入波谷状态；S4代表a在波谷状态循环；S5代表a离开波谷回归静止状态。在所述步长检测步骤中的步长测量采用加速度方差判别行人处于普通步行状态或是高速步行状态，当行人处于普通步行状态时，步长计算公式为：li＝0.35fi+0.48vi+0.22。当行人处于高速步行状态时，步长计算公式为：li＝0.30fi+0.05vi+0.72。其中：li是行人的步长；fi是行人的步频；vi是行人的三轴合加速度方差。在所述航向解算步骤中的航向角计算公式为：θi＝atan(Hy/Hx)+Mag_dec；式中：θi是行人的航向角，Hx、Hy分别是X、Y轴方向地磁强度；Mag_dec是当地的磁偏角。本专利技术的技术方案中，还提供了一种经过改进的根据行人的步频、步长、航向信息及地磁基准图进行的粒子滤波算法，其主要步骤包括如下：(1)初始化粒子群。(2)更新粒子群状态。(3)检测粒子是否穿墙并去除穿墙粒子。(4)计算各个粒子的权重。(5)根据有效粒子规模Ness判断是否需要对粒子群进行重采样，其计算公式为：设定阈值当Ness＜Ness_Thr时，则进行重采样；若Ness≥Ness_Thr时，则不进行重采样；其中：n代表第n个粒子，N表示粒子群的粒子数目；ωn表示归一化之后第n个粒子所占的权重。(6)如果对粒子群进行了重采样，则对粒子群进行粗化，粗化过程包括：第一，重采样之后对每个粒子增加一个噪声，使其在状态空间中散开；第二，下一步更新粒子群状态时，加大步长和航向的随机误差。附图说明图1是基于PDR和地磁指纹融合的室内定位方法流程图。图2是步频检测的有限状态机流程图。图3是粒子滤波算法流程图。图2中：Input代表三轴合加速度值，Thr代表的是检测阈值，Peak_Thr代表的是峰值阈值，Valley_Thr代表的是谷值阈值。具体实施方式下面以实施例详细阐述本专利技术的设计方案。基于物理场的室内定位系统依托于包含三轴加速度计、三轴陀螺仪、三轴磁力计的智能手机。通过智能手机中的传感器获取地球重力场、地磁场这些自带的物理场信息，对行人进行航迹推算，利用地磁场信息构建地磁基准图，在每个行人航迹推算的每个步态周期内进行地磁匹配时使用粒子滤波来得到行人的准确位置。具体主要包括如下内容：(1)步频检测：根据智能手机中三轴加速度计采集得到的行人加速度数据，使用有限状态机法完成行人的有效步频检测，并记录下每一有效步的起始时间戳。(2)自适应步长估计：根据自适应步长模型估算出行人每一有效步的步长。(3)航向解算：根据陀螺仪采集得到的角速度数据对磁力计数据进行倾斜补偿，根据倾斜补偿后的磁力计数据解算出绝对航向后再加上当地的磁偏角解算出当前步态的运动方向。(4)粒子滤波：根据得到的步频、步长、航向信息及地磁基准图进行粒子滤波，估计出行人准确的位置。一.所述步频检测包括以下步骤：S11：智能手机中三轴加速度计采集得到的加速度数据记为A＝{ax、ay、az}。S12：对手持式设备采集得到的三轴加速度数据A，进行平滑滤波，并计算三轴合加速度a：平滑滤波的目的是平滑数据，滤除噪声。使用三轴合加速度的原因是能够避免设备安装带来的额外误差，不用考虑加速度计的具体方向，合加速度的波形能够稳定在[-g,g]内变化。S13：使用有限状态机对行人的步频进行检测，得到有效的行人步数。有限状态机中各状态分别代表：S0：用户静止状态；S1：加速度上升，行人可能进入运动状态；S2：加速度上升进入波峰状态；S3：加速度下降离开波峰进入波谷状态；S4：a在波谷状态循环；S5：加速度离开波谷回归静止状态。如图2所示，基于有限状态机的步频检测算法的初始状态为S0，当a大于Thr时，状态由S0转入S1，否则在S0状态循环。在S1状态时，当a大于Peak_Thr时，状态由S1转入S2，当a小于Thr时，由S1跳回S0，否则在S1状态循环。在S2状态时，当a大于Valley_Thr且小于Peak_Thr时，状态由S2转入S3，否则在S2状态循环。在S3状态时，当a小于Valley_Thr时，状态由S3转入S4，当a大于Peak_Thr时，状态由S3跳回S2，否则在状态S3循环。在S4状态时，当a大于Va本文档来自技高网...

【技术保护点】
1.一种基于物理场的室内定位方法，所述方法包括对行人的步频检测步骤、自适应步长估计步骤和航向解算步骤，其特征在于：所述步频检测步骤中，当a经过了下述的全部状态后计为行人迈出了一步：(1)初始状态为S0，当a大于Thr时，状态由S0转入S1，否则在S0状态循环；(2)在S1状态时，当a大于Peak_Thr时，状态由S1转入S2，当a小于Thr时，由S1跳回S0，否则在S1状态循环；(3)在S2状态时，当a大于Neg_Thr且小于Peak_Thr时，状态由S2转入S3，否则在S2状态循环；(4)在S3状态时，当a小于Neg_Thr时，状态由S3转入S4，当a大于Peak_Thr时，状态由S3跳回S2，否则在状态S3循环；(5)在S4状态时，当a大于Neg_Thr且小于Thr时，状态由S4转入S5，否则在状态S4循环；(6)在S5状态时，当a大于Thr时，状态由S5转入S0，当a小于Neg_Thr时，状态由S5跳回S4，否则在状态S5循环；其中：a代表行人的三轴合加速度；Thr代表a的检测阈值；Peak_Thr代表a的峰值阈值；Neg_Thr代表a的谷值阈值；S0代表行人静止状态；S1代表a上升；S2代表a上升进入波峰状态；S3代表a下降离开波峰进入波谷状态；S4代表a在波谷状态循环；S5代表a离开波谷回归静止状态。...

【技术特征摘要】
1.一种基于物理场的室内定位方法，所述方法包括对行人的步频检测步骤、自适应步长估计步骤和航向解算步骤，其特征在于：所述步频检测步骤中，当a经过了下述的全部状态后计为行人迈出了一步：(1)初始状态为S0，当a大于Thr时，状态由S0转入S1，否则在S0状态循环；(2)在S1状态时，当a大于Peak_Thr时，状态由S1转入S2，当a小于Thr时，由S1跳回S0，否则在S1状态循环；(3)在S2状态时，当a大于Neg_Thr且小于Peak_Thr时，状态由S2转入S3，否则在S2状态循环；(4)在S3状态时，当a小于Neg_Thr时，状态由S3转入S4，当a大于Peak_Thr时，状态由S3跳回S2，否则在状态S3循环；(5)在S4状态时，当a大于Neg_Thr且小于Thr时，状态由S4转入S5，否则在状态S4循环；(6)在S5状态时，当a大于Thr时，状态由S5转入S0，当a小于Neg_Thr时，状态由S5跳回S4，否则在状态S5循环；其中：a代表行人的三轴合加速度；Thr代表a的检测阈值；Peak_Thr代表a的峰值阈值；Neg_Thr代表a的谷值阈值；S0代表行人静止状态；S1代表a上升；S2代表a上升进入波峰状态；S3代表a下降离开波峰进入波谷状态；S4代表a在波谷状态循环；S5代表a离开波谷回归静止状态。2.根据权利要求1所述的方法，其特征在于所述自适应步长估计步骤中，当行人处于普通步行状态时，步长计算公式为：li＝0.35fi+0.48vi+0.22；当行人...

【专利技术属性】
技术研发人员：蔡成林，徐德昌，彭军，蔡劲，汪发，胡佳，李响，
申请(专利权)人：桂林电子科技大学，
类型：发明
国别省市：广西,45