[发明专利]一种基于粒子滤波航迹推算和无线局域网组合定位的方法

说明书

技术领域

本发明提供一种基于粒子滤波航迹推算和无线局域网组合定位的方法，属于行人自主导航定位技术领域。

背景技术

目前，行人自主导航定位逐渐成为人民日常生活中不可或缺的一部分内容。传统的行人导航定位多依赖于GPS定位技术。然而在建筑物内部，GPS信号衰减现象严重，导致行人室内导航定位的精度严重降低。为了实现行人在室内的精确导航定位，航迹推算技术和基于无线局域网的RSSI定位技术逐渐兴起。然而，受限于MEMS惯性器件的精度，航迹推算误差往往较大；基于无线局域网的RSSI定位技术需要预先布置定位场景，技术成本较高；因此本发明采用粒子滤波算法实现航迹推算和无线局域网RSSI技术组合定位方案，有效降低了航迹推算技术误差和无线局域网RSSI定位技术技术成本，具有重要的学术意义和工程应用价值。

发明内容

1、目的：本发明的目的是提供一种基于粒子滤波航迹推算和无线局域网组合定位的方法，该方法具有可行性高，精度高等优点，其技术方案如下：

2、技术方案：本发明一种基于粒子滤波航迹推算和无线局域网组合定位的方法，该方法具体步骤如下：

步骤一、采用航迹推算技术实现室内循迹。

设行人在初始时刻t₀的位置为(E₀,N₀)，行走的距离是S₀，初始航向角是θ₀，可推算出在下一时刻t₁行人所处的位置(E₁,N₁)，如下式所示：

行人在t_k时刻位置的航位推算公式如下式所示：

行人导航系统中主要采用步数与步长的乘积获得相对位移量：

S_k＝N_k*L(3)

因此要想实现实时行人航迹推算算法，每个解算周期内需要已知如下三个物理量：行走的步数N，步长L和初始航向角θ。

相关研究表明，运动过程中垂向加速度计的变化情况可以表征行走步数的变化，因此可以利用内置加速度计完成步数解算；航向角的变化量可以由内置陀螺仪的输出角速度积分得到；步长可以由已知数学模型描述，在稳定行走过程中近似认为步长不变，在完成适当的标定实验后，可以得到步长的估计值。

步骤二、采用无线局域网RSSI技术实现空间定位

根据IEEE802.11协议，WLAN信号源名称SSID和自身的信号强度标示RSSI都是信号接入点的发送参数的一部分内容，而各种便携式设备作为信号接收方，其内置的API协议架构能够保证方便地根据信号源名称SSID解析出对应的WLAN信号强度数值。因此，可以利用不同信号源对应的信号强度数值建立特定空间内信号强度的指纹数据库，并在指纹数据库中利用模式识别算法完成空间定位。目前常用的模式识别算法包括k最近邻法，核函数估计法和人工神经网络估计法。

步骤三、建立系统状态模型和观测模型。

本方法利用粒子滤波进行行人导航定位研究，选择状态向量为X_k＝(x_k,y_k)^T。

在两次滤波算法解算周期内行人移动的距离为：

d_k＝N_k×L(4)

对应k时刻的状态向量的变化可以表示为：

假定行人在k时刻位置为X_k＝(x_k,y_k)^T，考虑航向角误差，步长误差和步数检测误差，系统状态模型可以由下式描述：

其中，Δθ_k为航向角误差，M_k为步数检测误差。

本文提出基于航迹推算和无线局域网WLAN搭建组合导航定位系统，可以利用无线局域网WLAN的接收信号强度标示RSSI，借助模式识别算法，解算出定位坐标因此，可以将作为观测值，建立系统观测模型。

系统观测方程如下式所示：

其中，为系统k时刻的观测噪声，假定系统观测噪声为均值为0的高斯噪声，方差为因此，后向概率密度函数可以简化为式(8)：

步骤四、采用粒子滤波算法实现组合定位。

假定t-1时刻更新完毕的粒子集为基于基本粒子滤波算法的室内定位算法实现步骤如下：