[发明专利]一种基于多传感器融合技术的室内行人航位推算方法

摘要

本发明公开了一种基于多传感器融合技术的室内行人航位推算方法，包括1、在行人所在的室内区域建立Wi‑Fi指纹库；2、手持智能设备利用设备自身硬件获取无线模块,加速度传感器,陀螺仪传感器检测到的原始数据；3、根据智能设备在Wi‑Fi指纹库中的匹配结果获取位置信息和利用加速度传感器和陀螺仪获取行人的航位信息；4、通过融合位置信息和航位信息，即完成了室内行人航位推算方法。本发明能消除PDR定位的累计误差，提高定位精度。

主权项

一种基于多传感器融合技术的室内行人航位推算方法，其特征是按如下步骤进行：步骤1：建立定位区域的Wi‑Fi指纹库：以室内区域的外接矩形作为所述定位区域，以所述外接矩形的任意顶点为原点o，与原点相邻两条边分别为x轴和y轴，建立直角坐标系oxy；将所述定位区域均匀划分为d个网格，以每个网格的中心点作为参考点，从而形成参考点集合，记为RP＝{RP1,RP2,…,RPi,…,RPd}，RPi表示第i个网格内的参考点；i＝1,2,…,d；在所述定位区域内设置n个路由器，记为AP＝{AP1,AP2,…,APj,…,APn}，APj表示第j个路由器；j＝1,2,…,n；所述第i个参考点RPi在一段时间内按照采样速率v连续采集第j个路由器APj发送的K个Wi‑Fi信号强度值，从而构成第i个参考点RPi采集第i个信号强度时间序列表示第i个参考点RPi接收第j个路由器APj发送的第k个Wi‑Fi信号强度值，进而得到第i个参考点RPi采集n个路由器的信号强度时间序列集合RSSi＝{RSSi1,RSSi2,…,RSSij,…RSSin}；k＝1,2,…,K；将信号强度时间序列中的所有元素求取均值作为第i个参考点RPi处第j个路由器APj的信号强度值从而得到第i个参考点RPi处n个路由器的信号强度值集合进而得到d个参考点处的信号强度值集合并构成Wi‑Fi指纹库；步骤2：根据加速度传感器进行步长检测和步长估计；在所述定位区域内，利用行人携带的智能设备中所包含的加速度传感器获取行人行走的加速度波形，再采用峰值‑谷值‑零值‑时间间隔的方法对所述加速度波形进行步长检测，从而利用式(1)得到第k步的步长Lk：Lk=1.07×ACCk‾3---(1)]]>式(1)中，表示第k步的平均加速度值，并由式(2)获得：ACCk‾=Σα=1N|ACCkα|N---(2)]]>式(2)中，表示第k步采集的第α次的加速度，N表示每一步所采集到的加速度总数，α＝1,2,…,N；步骤3：通过行人航位推算PDR方法得到PDR位置估计值：步骤3.1、利用行人携带的智能设备中所包含的陀螺仪获得第k步的俯仰角Pitchk、滚动角Rollk和方位角Azimuthk，从而利用式(3)得到第k步的航向角hk：hk＝c1·Pitchk+c2·Rollk+c3·Azimuthk  (3)式(3)中，c1,c2,c3为对应的加权系数；步骤3.2、利用所述Wi‑Fi指纹库对行人进行KNN定位，并将定位结果记录为起始位置点(x0,y0)；步骤3.3、利用式(5)得到第k步的PDR位置估计值PkPDR：PkPDR=xkyk=xk-1yk-1+Lkcos(hk)sin(hk),k≥1---(5)]]>步骤4：室内行人进行航位推算：步骤4.1、初始化k＝1，根据起始位置点为(x0,y0)，得到第k‑1步的PDR位置估计值第k‑1步的位置指纹定位点步骤4.2、根据第k步的PDR位置估计值PkPDR与第k‑1步的PDR位置估计值Pk‑1PDR，得到第k步PDR位置估计的移动距离LkPDR；步骤4.3、利用所述Wi‑Fi指纹库对行人进行第k步的KNN定位，得到第k步的位置指纹定位点步骤4.3、根据第k步的位置指纹定位点与第k‑1步的位置指纹定位点得到第k步Wi‑Fi指纹库测得的移动距离LkWiFi；步骤4.4、根据第k步的PDR位置估计值PkPDR的移动方向与第k步的位置指纹定位点的移动方向之间的夹角θk，判断θk≥θthr是否成立，若成立，则以第k步的PDR位置估计值PkPDR作为第k步的定位结果，否则，执行步骤4.5；其中，θthr为所设定的阈值；步骤4.5、对所述第k步Wi‑Fi指纹库测得的移动距离LkWiFi进行判断，若LkWiFi∈[u×LkPDR,v×LkPDR]成立，则在第k步的PDR位置估计值PkPDR的移动方向寻找距离为LkWiFi的点作为定位结果，否则，以第k步的PDR位置估计值PkPDR作为第k步的定位结果；其中，0＜u＜1＜v＜1.5；步骤4.6、以所述第k步的定位结果作为第k+1步的起始位置点；步骤4.7、将k+1赋值给k，并返回步骤4.2执行。