一种基于自适应无迹卡尔曼滤波的室内定位方法技术

本发明专利技术公开一种基于自适应无迹卡尔曼滤波的室内定位方法，步骤是：根据室内环境收集采样点处接收到的路由器信号并组合成为指纹存入数据库，实时采集路由器信号序列，将序列和数据库中的指纹进行匹配，估计得到近似位置；通过传感器获取加速度、角加速度和磁场强度数据，通过航迹推算算法中步长检测算法和航向推算算法分别求得行进中步长和方向；利用估计位置信息、步长和方向信息构建合适无迹卡尔曼滤波算法的系统方程和测量方程模型，并根据观测值和后验估计值的偏差设计自适应噪声缩放因子，修正当前时刻的过程噪声的方差，最后通过迭代更新估计位置。此种方法可实现在未知模型和行人状态多变情况下滤波的优良性能，保证长期稳定的定位精度。

An Indoor Location Method Based on Adaptive Untracked Kalman Filter

The invention discloses an indoor positioning method based on adaptive unscented Kalman filter. The steps are: collecting router signals received at sampling points according to indoor environment and combining them into fingerprints to store in the database, collecting router signal sequences in real time, matching the sequences with fingerprints in the database, and estimating approximate positions; acquiring acceleration and angular acceleration by sensors. According to the data of degree and magnetic field intensity, the step size and direction of trajectory estimation algorithm are obtained by step detection algorithm and heading estimation algorithm respectively; the system equation and measurement equation model of the appropriate unscented Kalman filter algorithm are constructed by using the estimated position information, step size and direction information, and the adaptive noise scaling factor is designed according to the deviation between the observed value and the posterior estimated value, and the appropriate correction is made. The variance of the process noise at the previous time is updated iteratively to estimate the location. This method can realize the excellent performance of filtering in the case of unknown model and variable pedestrian state, and ensure long-term and stable positioning accuracy.

【技术实现步骤摘要】
一种基于自适应无迹卡尔曼滤波的室内定位方法
本专利技术属于室内定位算法领域，特别涉及一种基于自适应无迹卡尔曼滤波算法的室内定位方法。
技术介绍
室内定位技术在当今生活中不可或缺，常用的室外定位导航的全球定位系统在室内复杂环境中，信号弱且不能保证信息有效性，为了满足各种室内定位的需求，研究人员已经研究开发了很多适合室内环境的定位系统，从单一数据源定位到多种方式相互辅助定位，部分技术可取得较为满意的定位效果。微机电系统的快速发展带来了惯导系统的平民化，以此为基础开发的航迹推算系统可以估计实时轨迹，但存在累积误差，长时间的轨迹导航效果不佳；另一方面，WiFi(WirelessFidelity，无线保真技术)设备的普及使得通过无线电射频信号定位成为现实，通过信号衰减模型和指纹匹配都可以完成定位，但在复杂环境中受多径效应、人身遮挡等问题影响，加上信号有跳变的情况出现，平均误差较大。在低成本和易实现的情况下，科研人员对融合定位技术中融合惯导系统和无线的技术愈发感兴趣，开发了很多两种技术结合的室内定位方法，意在结合这两者所各自具有的优势，常用的主要是各种滤波算法。上个世纪六十年代开始，卡尔曼滤波理论就被使用来对根据系统的量测值去消除系统的随机干扰。卡尔曼滤波通过实时更新均值和协方差实现滤波过程，是一种适用于线性系统的估计方法，而在现实问题上，需要我们进行估计的状态所组成的系统常常是非线性的，因此在随后的这几十年间发展了一系列基于卡尔曼滤波的非线性估计算法，如拓展卡尔曼滤波，无迹卡尔曼滤波，粒子滤波等。拓展卡尔曼滤波通过将非线性系统线性化，而后使用卡尔曼滤波的方式进行估计，应对非线性较低的系统有良好的性能，而在非线性强的场合难以给出可靠的估计；无迹卡尔曼滤波通过无迹变换而后实现滤波，能够提供更高阶的估计精度，同时计算量更小，应对较高非线性的系统也能够给出较好的估计结果；粒子滤波是一个完全的非线性估计器，对于非线性系统具有更好的性能表现，但是计算量将大幅增加，使用于特定高精度场合。卡尔曼滤波及其拓展形式都是建立在已知模型的情况下，对于稳定的系统可以实现很好的估计，但是对于模型不确定的情况就会出现滤波效果变差，估计结果偏差变大，从而导致在多种运动结合的情况下定位结果变差差的问题。
技术实现思路
本专利技术的目的，在于提供一种基于自适应无迹卡尔曼滤波的室内定位方法，采用无迹卡尔曼滤波滤波算法融合WiFi指纹定位和航迹推算的室内定位方法，并结合观测值和后验估计结果偏差设计自适应调整的过程噪声，实现在未知模型和行人状态多变情况下滤波的优良性能，保证长期稳定的定位精度。为了达成上述目的，本专利技术的解决方案是：一种基于自适应无迹卡尔曼滤波的室内定位方法，包括如下步骤：步骤1，根据室内环境收集采样点处接收到的路由器信号并组合成为指纹存入数据库，接着实时通过行人手中的手机采集路由器信号序列，将序列和数据库中的指纹进行匹配，估计得到近似位置；步骤2，通过传感器获取加速度、角加速度和磁场强度数据，通过航迹推算算法中步长检测算法和航向推算算法分别求得行进中步长和方向；步骤3，利用步骤1、2中的估计位置信息、步长和方向信息构建合适无迹卡尔曼滤波算法的系统方程和测量方程模型，并根据观测值和后验估计值的偏差设计自适应噪声缩放因子，修正当前时刻的过程噪声的方差，最后通过迭代更新估计位置。上述步骤1中，路由器信号指纹形式是一个向量，按照路由器的MAC地址排序接收到的信号强度序列，表达式如下：指纹序列＝[rssi1,rssi2,rssi3,…,rssin]其中，rssi表示信号强度，n表示定位所在地点收集到的路由器信号个数，每一个指纹序列代表一个采样点的特征。上述步骤1中，采用k近邻匹配方法进行匹配，首先计算扫描到的指纹同数据库中每一个采样点指纹的匹配度L：其中，下标i代表获得的指纹同指纹库中第i个采样点进行比较，j代表指纹中第j个信号强度，n代表指纹序列的长度；ROL代表通过手机实时采集到的指纹序列，ROFF代表指纹库中每一个采样点的指纹序列；将得到的所有匹配度进行排序，选出最小的k个，根据选出的k个采样点已知的位置，求均值得到的结果作为无线指纹的定位位置。上述步骤2中，步长检测算法的计算表达式如下：其中，F表示步行的频率，S表示步长。上述步骤2中，航向推算算法以四元数形式进行计算，通过四元数与方向余弦矩阵的对应关系，求解得到欧拉角，其中航向角为四元数[q1234]通过一阶荣格库塔求解以下微分方程得到：其中，T为每一步的时间长度，也即一个时间周期，[gxgygz]为通过加速度和磁场强度修正过的三轴角加速度值。上述步骤3中，系统方程模型建立如下：其中，xk和yk为二维坐标位置第k步后的位置，Sk为第k步行走的步长，ψk为第k步后的人体朝向角度，为航向角的变化量，Wk-1为3维的系统过程噪声；测量方程模型建立如下：其中Vk为5维的系统观测噪声；系统方程和测量方程的离散形式如下：Xk＝f(Xk-1,uk-1)+Wk-1Zk＝h(Xk)+Vk其中，f和h为非线性向量函数，Xk-1为第k-1步的状态量；uk-1为第k-1步的外部输入量，一般情况下可以不作考虑；Wk-1和Vk是方差分别为Qk和Rk的零均值白噪声序列；通过无迹变换，求得2n+1个Sigma点，通过预测得到先验估计及其协方差接着通过测量更新得到测量预测及其协方差Pz和相关协方差Pxz；最后得到迭代更新的卡尔曼增益Kk，后验估计及其协方差Pk：其中，为Pz的逆矩阵，zk为实际的测量数据向量。上述步骤3中，自适应噪声缩放因子Λk通过观测值zk和后验估计值的偏差ek进行设计，对先验估计协方差进行修正，原形式如下：其中为未加入噪声的先验估计协方差，Qk为系统过程噪声协方差矩阵；加入修正因子Λk后：ek通过观测值zk和后验估计值求得：其中I为单位矩阵，H为非线性向量函数h无迹变换后的函数，vk为观测噪声；噪声缩放因子Λk通过偏差ek求解：Λk＝Ak/BkTk＝I-HKk其中，μ为计算步长，根据时延和计算能力进行调节；因此每一时刻的过程噪声方差：Qk+1＝ΛkQk其中，tr为求矩阵的迹，上标T为矩阵的转置，R为系统观测噪声协方差矩阵。采用上述方案后，与现有技术相比，本专利技术的有益效果是：该自适应卡尔曼滤波算法可以应对室内的复杂环境和行人定位时所表现出的不同状态，通过自适应调整模型中过程噪声的参数，确保模型快速匹配当前状态，保证滤波效果持续处于高效状态。此外无迹卡尔曼滤波算法适用于融合定位的非线性模型，能充分利用定位模型中两种数据在定位上各自的优点，并且相较于拓展卡尔曼滤波等其他适合非线性模型的算法具有更高效的滤波效果。附图说明图1是本专利技术的流程图；图2是本专利技术的航迹推算具体实现示意图；图3是本专利技术的过零点步频检测示意图；图4是本专利技术的指纹定位现场示意图。具体实施方式以下将结合附图，对本专利技术的技术方案及有益效果进行详细说明。如图1所示，基于自适应无迹卡尔曼滤波算法的室内定位包括三个部分，分别是航迹推算、指纹定位和自适应无迹卡尔曼。航迹推算通过过零检测得到步频，用于步长计算；通过航向检测算法整合传感器数据得到方向角。指纹定位通过离线指纹采集和在线指纹匹配两个步骤实现。自适应无迹卡尔曼通过整合航迹推算和指纹定位的结果建本文档来自技高网...

【技术保护点】
1.一种基于自适应无迹卡尔曼滤波的室内定位方法，其特征在于包括如下步骤：步骤1，根据室内环境收集采样点处接收到的路由器信号并组合成为指纹存入数据库，接着实时通过行人手中的手机采集路由器信号序列，将序列和数据库中的指纹进行匹配，估计得到近似位置；步骤2，通过传感器获取加速度、角加速度和磁场强度数据，通过航迹推算算法中步长检测算法和航向推算算法分别求得行进中步长和方向；步骤3，利用步骤1、2中的估计位置信息、步长和方向信息构建合适无迹卡尔曼滤波算法的系统方程和测量方程模型，并根据观测值和后验估计值的偏差设计自适应噪声缩放因子，修正当前时刻的过程噪声的方差，最后通过迭代更新估计位置。

【技术特征摘要】
1.一种基于自适应无迹卡尔曼滤波的室内定位方法，其特征在于包括如下步骤：步骤1，根据室内环境收集采样点处接收到的路由器信号并组合成为指纹存入数据库，接着实时通过行人手中的手机采集路由器信号序列，将序列和数据库中的指纹进行匹配，估计得到近似位置；步骤2，通过传感器获取加速度、角加速度和磁场强度数据，通过航迹推算算法中步长检测算法和航向推算算法分别求得行进中步长和方向；步骤3，利用步骤1、2中的估计位置信息、步长和方向信息构建合适无迹卡尔曼滤波算法的系统方程和测量方程模型，并根据观测值和后验估计值的偏差设计自适应噪声缩放因子，修正当前时刻的过程噪声的方差，最后通过迭代更新估计位置。2.如权利要求1所述的一种基于自适应无迹卡尔曼滤波的室内定位方法，其特征在于：所述步骤1中，路由器信号指纹形式是一个向量，按照路由器的MAC地址排序接收到的信号强度序列，表达式如下：指纹序列＝[rssi1,rssi2,rssi3,…,rssin]其中，rssi表示信号强度，n表示定位所在地点收集到的路由器信号个数，每一个指纹序列代表一个采样点的特征。3.如权利要求1所述的一种基于自适应无迹卡尔曼滤波的室内定位方法，其特征在于：所述步骤1中，采用k近邻匹配方法进行匹配，首先计算扫描到的指纹同数据库中每一个采样点指纹的匹配度L：其中，下标i代表获得的指纹同指纹库中第i个采样点进行比较，j代表指纹中第j个信号强度，n代表指纹序列的长度；ROL代表通过手机实时采集到的指纹序列，ROFF代表指纹库中每一个采样点的指纹序列；将得到的所有匹配度进行排序，选出最小的k个，根据选出的k个采样点已知的位置，求均值得到的结果作为无线指纹的定位位置。4.如权利要求1所述的一种基于自适应无迹卡尔曼滤波的室内定位方法，其特征在于：所述步骤2中，步长检测算法的计算表达式如下：其中，F表示步行的频率，S表示步长。5.如权利要求1所述的一种基于自适应无迹卡尔曼滤波的室内定位方法，其特征在于：所述步骤2中，航...

【专利技术属性】
技术研发人员：刘昊，查丹柯，梁彪，
申请(专利权)人：东南大学—无锡集成电路技术研究所，东南大学，南京三宝科技股份有限公司，
类型：发明
国别省市：江苏,32