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,无线保真技术)设备的普及使得通过无线电射频信号定位成为现实,通过信号衰减模型和指纹匹配都可以完成定位,但在复杂环境中受多径效应、人身遮挡等问题影响,加上信号有跳变的情况出现,平均误差较大。在低成本和易实现的情况下,科研人员对融合定位技术中融合惯导系统和无线的技术愈发感兴趣,开发了很多两种技术结合的室内定位方法,意在结合这两者所各自具有的优势,常用的主要是各种滤波算法。上个世纪六十年代开始,卡尔曼滤波理论就被使用来对根据系统的量测值去消除系统的随机干扰。卡尔曼滤波通过实时更新均值和协方差实现滤波过程,是一种适用于线性系统的估计方法,而在现实问题上,需要我们进行估计的状态所组成的系统常常是非线性的,因此在随后的这几十年间发展了一系列基于卡尔曼滤波的非线性估计算法,如拓展卡尔曼滤波,无迹卡尔曼滤波,粒子滤波等。拓展卡尔曼滤波通过将非线性系统线性化,而后使用卡尔曼滤波的方式进行估计 ...
【技术保护点】
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
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。