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

权利要求书

1.一种基于多传感器融合技术的室内行人航位推算方法，其特征是按如下步骤进行：

步骤1：建立定位区域的Wi-Fi指纹库：

以室内区域的外接矩形作为所述定位区域，以所述外接矩形的任意顶点为原点o，与原点相邻两条边分别为x轴和y轴，建立直角坐标系oxy；

将所述定位区域均匀划分为d个网格，以每个网格的中心点作为参考点，从而形成参考点集合，记为RP＝{RP₁,RP₂,…,RP_i,…,RP_d}，RP_i表示第i个网格内的参考点；i＝1,2,…,d；

在所述定位区域内设置n个路由器，记为AP＝{AP₁,AP₂,…,AP_j,…,AP_n}，AP_j表示第j个路由器；j＝1,2,…,n；

所述第i个参考点RP_i在一段时间内按照采样速率v连续采集第j个路由器AP_j发送的K个Wi-Fi信号强度值，从而构成第i个参考点RP_i采集第i个信号强度时间序列表示第i个参考点RP_i接收第j个路由器AP_j发送的第k个Wi-Fi信号强度值，进而得到第i个参考点RP_i采集n个路由器的信号强度时间序列集合RSS_i＝{RSS_i1,RSS_i2,…,RSS_ij,…RSS_in}；k＝1,2,…,K；

将信号强度时间序列中的所有元素求取均值作为第i个参考点RP_i处第j个路由器AP_j的信号强度值从而得到第i个参考点RP_i处n个路由器的信号强度值集合进而得到d个参考点处的信号强度值集合并构成Wi-Fi指纹库；

步骤2：根据加速度传感器进行步长检测和步长估计；

在所述定位区域内，利用行人携带的智能设备中所包含的加速度传感器获取行人行走的加速度波形，再采用峰值-谷值-零值-时间间隔的方法对所述加速度波形进行步长检测，从而利用式(1)得到第k步的步长L_k：

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步的俯仰角Pitch_k、滚动角Roll_k和方位角Azimuth_k，从而利用式(3)得到第k步的航向角h_k：

h_k＝c₁·Pitch_k+c₂·Roll_k+c₃·Azimuth_k(3)

式(3)中，c₁,c₂,c₃为对应的加权系数；

步骤3.2、利用所述Wi-Fi指纹库对行人进行KNN定位，并将定位结果记录为起始位置点(x₀,y₀)；

步骤3.3、利用式(5)得到第k步的PDR位置估计值P_k^PDR：

PkPDR=xkyk=xk-1yk-1+Lkcos(hk)sin(hk),k≥1---(5)]]>

步骤4：室内行人进行航位推算：

步骤4.1、初始化k＝1，根据起始位置点为(x₀,y₀)，得到第k-1步的PDR位置估计值第k-1步的位置指纹定位点

步骤4.2、根据第k步的PDR位置估计值P_k^PDR与第k-1步的PDR位置估计值P_k-1^PDR，得到第k步PDR位置估计的移动距离L_k^PDR；

步骤4.3、利用所述Wi-Fi指纹库对行人进行第k步的KNN定位，得到第k步的位置指纹定位点

步骤4.3、根据第k步的位置指纹定位点与第k-1步的位置指纹定位点得到第k步Wi-Fi指纹库测得的移动距离L_k^WiFi；

步骤4.4、根据第k步的PDR位置估计值P_k^PDR的移动方向与第k步的位置指纹定位点的移动方向之间的夹角θ_k，判断θ_k≥θ_thr是否成立，若成立，则以第k步的PDR位置估计值P_k^PDR作为第k步的定位结果，否则，执行步骤4.5；其中，θ_thr为所设定的阈值；

步骤4.5、对所述第k步Wi-Fi指纹库测得的移动距离L_k^WiFi进行判断，若L_k^WiFi∈[u×L_k^PDR,v×L_k^PDR]成立，则在第k步的PDR位置估计值P_k^PDR的移动方向寻找距离为L_k^WiFi的点作为定位结果，否则，以第k步的PDR位置估计值P_k^PDR作为第k步的定位结果；其中，0＜u＜1＜v＜1.5；

步骤4.6、以所述第k步的定位结果作为第k+1步的起始位置点；

步骤4.7、将k+1赋值给k，并返回步骤4.2执行。