CN113810846B - 一种基于WiFi和IMU融合的室内定位方法 - Google Patents
一种基于WiFi和IMU融合的室内定位方法 Download PDFInfo
- Publication number
- CN113810846B CN113810846B CN202111201727.2A CN202111201727A CN113810846B CN 113810846 B CN113810846 B CN 113810846B CN 202111201727 A CN202111201727 A CN 202111201727A CN 113810846 B CN113810846 B CN 113810846B
- Authority
- CN
- China
- Prior art keywords
- positioning
- wifi
- rss
- estimation
- imu
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/025—Services making use of location information using location based information parameters
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/029—Location-based management or tracking services
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/80—Services using short range communication, e.g. near-field communication [NFC], radio-frequency identification [RFID] or low energy communication
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于WiFi与IMU融合的室内定位方法,涉及室内定位技术领域,具体包括如下步骤:离线采集WiFi信号强度构建无线地图;高斯过程回归精化无线地图;使用自适应K近邻算法获取定位初值;融合WiFi和IMU的粒子滤波进行定位估计。本发明与现有技术相比,具有如下有益效果:使用高斯过程回归精细化原始无线地图,将离散的指纹数据库替换为WiFi节点的RSS信号强度分布模型,更好地拟合了真实的信号强度分布;利用粒子滤波融合WiFi和IMU数据进行定位估计,并引入重定位机制抑制较大定位误差,提高了定位精度和频率。
Description
技术领域
本发明属于室内定位技术领域,具体地说涉及一种基于WiFi和IMU融合的室内定位方法。
背景技术
大型室内场景由于室内空间复杂多样,用户身处室内,如何做到实时定位,并了解周围场景是一个值得关注的问题。通常情况下,室内场景中会布置一些室内平面图来为行人提供位置指引。但是对于一些大型公共场景,由于其空间复杂,设施多样,即使提供平面图用户依然无法有效地定位自身位置。由于GPS无法在室内工作,因此许多基于其他信号源的室内定位技术被提出,如UWB定位、蓝牙定位、惯导定位、WiFi定位等。其中,WiFi的部署成本低廉、覆盖范围广、能提供绝对位置,但定位频率较低、定位精度较低,而IMU则能够提供高频率、高精度的相对位置估计,但是存在累积误差。
发明内容
本发明所要解决的技术问题是提供一种基于WiFi和IMU融合的室内定位方法,其利用WiFi和IMU两者互补,将两者进行融合,能够实现高精度高频率的绝对位置估计。
为解决上述问题,本发明的技术方案是:
一种基于WiFi和IMU融合的室内定位方法,包括如下步骤:
步骤一、离线采集WiFi信号强度构建原始无线地图;
步骤二、使用高斯过程回归对构建的原始无线地图进行拟合,训练得到符合真实信号分布的真实无线地图;
步骤三、实时获取周围WiFi节点的RSS数据,然后根据真实无线地图中的训练数据使用自适应K近邻算法获取WiFi节点的定位初值坐标;
步骤四、采用融合WiFi和IMU的粒子滤波对获取的定位初值坐标进行定位估计;
步骤五、计算步骤四采用融合定位得到的定位估计与使用自适应K近邻算法计算k时刻的WiFi节点的定位估计之间的定位误差,并判断该定位误差是否超过设定的误差阈值,若超过,则进行重定位,并选择融合定位得到的定位估计代替k时刻的WiFi节点的定位估计,以此为下一轮粒子滤波的定位初值。
作为本发明的一种优选改进,步骤一具体包括:离线阶段,在室内定位区域中预先布置M个WiFi节点,并对室内地图进行栅格化,将定位区域划分为N个栅格,每个栅格的坐标表示为zi=(xi,yi),i∈[1,N],通过采集这N个栅格内的WiFi信号强度RSS,得到每个栅格的WiFi信号强度向量ri=[ri1,ri2,...,riM]T,从而构建出室内场景的原始无线地图D={(z1,r1),(z2,r2),...,(zN,rN)}。
作为本发明的一种优选改进,步骤二具体包括:
以RSS分布的对数衰减模型为先验,则先验分布可以表示为f(x)~N(μf,Kff),其中x表示位置坐标,μf表示RSS分布的均值,Kff表示RSS分布的协方差;
给定步骤一所建立的RSS观测数据(x*,y*),其中x*,y*分别表示栅格坐标和对应的RSS向量值;
通过假设y*与f(x)服从联合高斯分布,可以计算得到RSS的后验分布f*(x),从而得到更准确的RSS信号分布的无线地图。
作为本发明的一种优选改进,步骤三具体包括:
定位阶段,在线实时获取周围WiFI节点的RSS数据rq=[rq1,rq2,...,rqM]T,将其与真实无线地图中的训练数据rti=[rt1,rt2,...,rtM]T,i∈[1,N]一一匹配,计算两者间的差异度di;
对差异度从小到大排序,设定差异度阈值dth,选择小于阈值的差异度对应的训练点作为定位候选点{(xk,yk)}k∈[1,K];
根据计算得到的候选点坐标{(xk,yk)}及其差异度dk,加权计算出定位初值坐标(x0,y0)。
作为本发明的一种优选改进,步骤四具体包括:
粒子初始化,由定位初值坐标(x0,y0)生成随机采样粒子{(xi,yi)}i∈[1,P],P为粒子个数;
重要性采样,考虑连续两帧WiFi信号帧k-1时刻到k时刻,对于所有粒子,根据两帧间采集到的IMU数据进行状态递推:
yik=fy(yik-1,sk,θk)
xik=fx(xik-1,sk,θk)
其中,位移sk由步长公式根据加速度计值计算得到,航向角θk由角速度计和磁力计融合计算得到;
通过高斯过程回归模型,计算出粒子所在位置的RSS预测值,根据k时刻实时采集到的RSS真实值,计算粒子的权重wik;
计算粒子的权重和sum(wik),并对每个粒子进行权重归一化:
通过对粒子坐标按权重进行加权,更新k时刻的定位估计:
作为本发明的一种优选改进,步骤五具体包括:使用自适应K近邻算法计算k时刻的WiFi节点的定位估计对于步骤四采用融合定位得到的位置估计(xk,yk),计算两者之间的定位误差然后设定误差阈值τ,如果定位误差超过该误差阈值τ,则需要进行重定位,并选择融合定位得到的定位估计代替k时刻的WiFi节点的定位估计,以此为下一轮粒子滤波的定位初值。
本发明与现有技术相比,具有如下有益效果:
1、使用高斯过程回归精细化原始无线地图,将离散的指纹数据库替换为WiFi节点的RSS信号强度分布模型,更好地拟合了真实的信号强度分布;
2、利用粒子滤波融合WiFi和IMU数据进行定位估计,并引入重定位机制抑制较大定位误差,提高了定位精度和频率。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图,其中:
图1为本发明一种基于WiFi和IMU融合的室内定位方法的流程图。
具体实施方式:
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
请参阅图1所示,本发明提供了一种基于WiFi和IMU融合的室内定位方法,包括如下步骤:
步骤一、离线采集WiFi信号强度构建原始无线地图;
具体包括:离线阶段,在室内定位区域中预先布置M个WiFi节点,并对室内地图进行栅格化,将定位区域划分为N个栅格,每个栅格的坐标表示为zi=(xi,yi),i∈[1,N],通过采集这N个栅格内的WiFi信号强度RSS,得到每个栅格的WiFi信号强度向量ri=[ri1,ri2,...,riM]T,从而构建出室内场景的原始无线地图D={(z1,r1),(z2,r2),...,(zN,rN)}。
步骤二、使用高斯过程回归对构建的原始无线地图进行拟合,训练得到符合真实信号分布的真实无线地图,这样获得的真实无线地图的分辨率更高,特征更精确;
具体包括:以RSS分布的对数衰减模型为先验,则先验分布可以表示为f(x)~N(μf,Kff),其中x表示位置坐标,μf表示RSS分布的均值,Kff表示RSS分布的协方差;
给定步骤一所建立的RSS观测数据(x*,y*),其中x*,y*分别表示栅格坐标和对应的RSS向量值;
通过假设y*与f(x)服从联合高斯分布,可以计算得到RSS的后验分布f*(x),从而得到更准确的RSS信号分布的无线地图。
步骤三、实时获取周围WiFi节点的RSS数据,然后根据真实无线地图中的训练数据使用自适应K近邻算法获取WiFi节点的定位初值坐标;
具体包括:定位阶段,在线实时获取周围WiFI节点的RSS数据rq=[rq1,rq2,...,rqM]T,将其与真实无线地图中的训练数据rti=[rt1,rt2,...,rtM]T,i∈[1,N]一一匹配,计算两者间的差异度di;
对差异度从小到大排序,设定差异度阈值dth,选择小于阈值的差异度对应的训练点作为定位候选点{(xk,yk)}k∈[1,K];
根据计算得到的候选点坐标{(xk,yk)}及其差异度dk,加权计算出定位初值坐标(x0,y0)。
步骤四、采用融合WiFi和IMU的粒子滤波对获取的定位初值坐标进行定位估计;
具体包括:粒子初始化,由定位初值坐标(x0,y0)生成随机采样粒子{(xi,yi)}i∈[1,P],P为粒子个数;
重要性采样,考虑连续两帧WiFi信号帧k-1时刻到k时刻,对于所有粒子,根据两帧间采集到的IMU数据进行状态递推:
yik=fy(yik-1,sk,θk)
xik=fx(xik-1,sk,θk)
其中,位移sk由步长公式根据加速度计值计算得到,航向角θk由角速度计和磁力计融合计算得到;
通过高斯过程回归模型,计算出粒子所在位置的RSS预测值,根据k时刻实时采集到的RSS真实值,计算粒子的权重wik;
计算粒子的权重和sum(wik),并对每个粒子进行权重归一化:
通过对粒子坐标按权重进行加权,更新k时刻的定位估计:
步骤五、计算步骤四采用融合定位得到的定位估计与使用自适应K近邻算法计算k时刻的WiFi节点的定位估计之间的定位误差,并判断该定位误差是否超过设定的误差阈值,若超过,则进行重定位,并选择融合定位得到的定位估计代替k时刻的WiFi节点的定位估计,以此为下一轮粒子滤波的定位初值。
具体包括:使用自适应K近邻算法计算k时刻的WiFi节点的定位估计对于步骤四采用融合定位得到的位置估计(xk,yk),计算两者之间的定位误差然后设定误差阈值τ,如果定位误差超过该误差阈值τ,则需要进行重定位,并选择融合定位得到的定位估计代替k时刻的WiFi节点的定位估计,以此为下一轮粒子滤波的定位初值。
本发明与现有技术相比,具有如下有益效果:
1、使用高斯过程回归精细化原始无线地图,将离散的指纹数据库替换为WiFi节点的RSS信号强度分布模型,更好地拟合了真实的信号强度分布;
2、利用粒子滤波融合WiFi和IMU数据进行定位估计,并引入重定位机制抑制较大定位误差,提高了定位精度和频率。
本说明书中所描述的以上内容仅仅是对本发明所作的举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种修改或补充或采用类似的方式替代,只要不偏离本发明说明书的内容或者超越本权利要求书所定义的范围,均应属于本发明的保护范围。
Claims (3)
1.一种基于WiFi和IMU融合的室内定位方法,其特征在于,包括如下步骤:
步骤一、离线采集WiFi信号强度构建原始无线地图;
步骤二、使用高斯过程回归对构建的原始无线地图进行拟合,训练得到符合真实信号分布的真实无线地图,具体包括:
以RSS分布的对数衰减模型为先验,则先验分布可以表示为f(x)~N(μf,Kff),其中x表示位置坐标,μf表示RSS分布的均值,Kff表示RSS分布的协方差;
给定步骤一所建立的RSS观测数据(x*,y*),其中x*,y*分别表示栅格坐标和对应的RSS向量值;
通过假设y*与f(x)服从联合高斯分布,可以计算得到RSS的后验分布f*(x),从而得到更准确的RSS信号分布的无线地图;
步骤三、实时获取周围WiFi节点的RSS数据,然后根据真实无线地图中的训练数据使用自适应K近邻算法获取WiFi节点的定位初值坐标,具体包括:
定位阶段,在线实时获取周围WiFI节点的RSS数据rq=[rq1,rq2,...,rqM]T,将其与真实无线地图中的训练数据rti=[rt1,rt2,...,rtM]T,i∈[1,N]一一匹配,计算两者间的差异度di;
对差异度从小到大排序,设定差异度阈值dth,选择小于阈值的差异度对应的训练点作为定位候选点{(xk,yk)}k∈[1,K];
根据计算得到的候选点坐标{(xk,yk)}及其差异度dk,加权计算出定位初值坐标(x0,y0);
步骤四、采用融合WiFi和IMU的粒子滤波对获取的定位初值坐标进行定位估计,具体包括:
粒子初始化,由定位初值坐标(x0,y0)生成随机采样粒子{(xi,yi)}i∈[1,P],P为粒子个数;
重要性采样,考虑连续两帧WiFi信号帧k-1时刻到k时刻,对于所有粒子,根据两帧间采集到的IMU数据进行状态递推:
yik=fy(yik-1,sk,θk)
xik=fx(xik-1,sk,θk)
其中,位移sk由步长公式根据加速度计值计算得到,航向角θk由角速度计和磁力计融合计算得到;
通过高斯过程回归模型,计算出粒子所在位置的RSS预测值,根据k时刻实时采集到的RSS真实值,计算粒子的权重wik;
计算粒子的权重和sum(wik),并对每个粒子进行权重归一化:
通过对粒子坐标按权重进行加权,更新k时刻的定位估计:
步骤五、计算步骤四采用融合定位得到的定位估计与使用自适应K近邻算法计算k时刻的WiFi节点的定位估计之间的定位误差,并判断该定位误差是否超过设定的误差阈值,若超过,则进行重定位,并选择融合定位得到的定位估计代替k时刻的WiFi节点的定位估计,以此为下一轮粒子滤波的定位初值。
2.根据权利要求1所述的一种基于WiFi和IMU融合的室内定位方法,其特征在于,步骤一具体包括:离线阶段,在室内定位区域中预先布置M个WiFi节点,并对室内地图进行栅格化,将定位区域划分为N个栅格,每个栅格的坐标表示为zi=(xi,yi),i∈[1,N],通过采集这N个栅格内的WiFi信号强度RSS,得到每个栅格的WiFi信号强度向量ri=[ri1,ri2,...,riM]T,从而构建出室内场景的原始无线地图D={(z1,r1),(z2,r2),...,(zN,rN)}。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111201727.2A CN113810846B (zh) | 2021-10-15 | 2021-10-15 | 一种基于WiFi和IMU融合的室内定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111201727.2A CN113810846B (zh) | 2021-10-15 | 2021-10-15 | 一种基于WiFi和IMU融合的室内定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113810846A CN113810846A (zh) | 2021-12-17 |
CN113810846B true CN113810846B (zh) | 2022-05-03 |
Family
ID=78937665
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111201727.2A Active CN113810846B (zh) | 2021-10-15 | 2021-10-15 | 一种基于WiFi和IMU融合的室内定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113810846B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117077238B (zh) * | 2023-08-18 | 2024-02-02 | 南京六域知物科技有限公司 | 一种用于消防点位精准跟踪的方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017011902A1 (en) * | 2015-07-20 | 2017-01-26 | Blackberry Limited | Indoor positioning systems and meeting room occupancy |
CN109883428A (zh) * | 2019-03-27 | 2019-06-14 | 成都电科慧安科技有限公司 | 一种融合惯导、地磁和WiFi信息的高精度定位方法 |
CN110345939A (zh) * | 2019-07-02 | 2019-10-18 | 山东科技大学 | 一种融合模糊逻辑判断及地图信息的室内定位方法 |
CN110933599A (zh) * | 2019-12-17 | 2020-03-27 | 北京理工大学 | 一种融合uwb与wifi指纹的自适应定位方法 |
CN112562077A (zh) * | 2020-11-25 | 2021-03-26 | 西北工业大学 | 一种融合pdr和先验地图的行人室内定位方法 |
CN113382357A (zh) * | 2021-06-29 | 2021-09-10 | 上海电力大学 | 一种改进pdr与rssi融合的蓝牙室内定位方法 |
CN113566820A (zh) * | 2021-06-17 | 2021-10-29 | 电子科技大学 | 一种基于位置指纹和pdr算法的融合人行定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB201804079D0 (en) * | 2018-01-10 | 2018-04-25 | Univ Oxford Innovation Ltd | Determining the location of a mobile device |
-
2021
- 2021-10-15 CN CN202111201727.2A patent/CN113810846B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017011902A1 (en) * | 2015-07-20 | 2017-01-26 | Blackberry Limited | Indoor positioning systems and meeting room occupancy |
CN109883428A (zh) * | 2019-03-27 | 2019-06-14 | 成都电科慧安科技有限公司 | 一种融合惯导、地磁和WiFi信息的高精度定位方法 |
CN110345939A (zh) * | 2019-07-02 | 2019-10-18 | 山东科技大学 | 一种融合模糊逻辑判断及地图信息的室内定位方法 |
CN110933599A (zh) * | 2019-12-17 | 2020-03-27 | 北京理工大学 | 一种融合uwb与wifi指纹的自适应定位方法 |
CN112562077A (zh) * | 2020-11-25 | 2021-03-26 | 西北工业大学 | 一种融合pdr和先验地图的行人室内定位方法 |
CN113566820A (zh) * | 2021-06-17 | 2021-10-29 | 电子科技大学 | 一种基于位置指纹和pdr算法的融合人行定位方法 |
CN113382357A (zh) * | 2021-06-29 | 2021-09-10 | 上海电力大学 | 一种改进pdr与rssi融合的蓝牙室内定位方法 |
Non-Patent Citations (4)
Title |
---|
《Demo: Measuring Distance Traveled by an Object using WiFi-CSI and IMU Fusion》;Raghav Hampapur Venkatanarayan;《2019 IEEE 27th International Conference on Network Protocols (ICNP)》;20191031;全文 * |
《基于WiFi指纹的层级学习室内定位模型》;薛敏;《电子测量与仪器学报》;20210430;全文 * |
基于粒子滤波和地图匹配的融合室内定位;周瑞等;《电子科技大学学报》;20180530(第03期);全文 * |
多源信息融合的室内定位方法;韩冷等;《传感器与微系统》;20200702(第07期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113810846A (zh) | 2021-12-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Liu et al. | Mercury: An infrastructure-free system for network localization and navigation | |
US9244152B1 (en) | Determining device locations using movement, signal strength | |
CN109597864B (zh) | 椭球边界卡尔曼滤波的即时定位与地图构建方法及系统 | |
CN105704652B (zh) | 一种wlan/蓝牙定位中的指纹库采集和优化方法 | |
CN109413578B (zh) | 一种基于wifi与pdr融合的室内定位方法 | |
CN106714110A (zh) | 一种Wi‑Fi位置指纹地图自动构建方法及系统 | |
CN107941211B (zh) | 基于二阶级联的多元素融合定位方法、装置及电子设备 | |
CN105263113A (zh) | 一种基于众包的WiFi位置指纹地图构建方法及其系统 | |
CN105424030A (zh) | 基于无线指纹和mems传感器的融合导航装置和方法 | |
CN107635204A (zh) | 一种运动行为辅助的室内融合定位方法及装置、存储介质 | |
US8213956B2 (en) | Method of tracking a state of a mobile electronic device | |
CN111970633A (zh) | 基于WiFi、蓝牙和步行者行航位推算融合的室内定位方法 | |
Koo et al. | PDR/fingerprinting fusion indoor location tracking using RSS recovery and clustering | |
CN108426582B (zh) | 行人室内三维地图匹配方法 | |
CN113810846B (zh) | 一种基于WiFi和IMU融合的室内定位方法 | |
CN109341682B (zh) | 一种提高地磁场定位精度的方法 | |
CN106028450B (zh) | 室内定位方法及设备 | |
Wang et al. | Error-ellipse-resampling-based particle filtering algorithm for target tracking | |
CN110366109B (zh) | 一种用于室内目标的定位方法及系统 | |
Ma et al. | A fast path matching algorithm for indoor positioning systems using magnetic field measurements | |
CN109931940B (zh) | 一种基于单目视觉的机器人定位置信度评估方法 | |
CN109961129A (zh) | 一种基于改进粒子群的海上静止目标搜寻方案生成方法 | |
Wendlandt et al. | Continuous location and direction estimation with multiple sensors using particle filtering | |
Chu et al. | A particle filter based reference fingerprinting map recalibration method | |
Zhao et al. | Factor graph based multi-source data fusion for wireless localization |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |