一种基于WiFi和IMU融合的室内定位方法与流程

一种基于wifi和imu融合的室内定位方法
技术领域
1.本发明属于室内定位技术领域，具体地说涉及一种基于wifi和imu融合的室内定位方法。


背景技术：

2.大型室内场景由于室内空间复杂多样，用户身处室内，如何做到实时定位，并了解周围场景是一个值得关注的问题。通常情况下，室内场景中会布置一些室内平面图来为行人提供位置指引。但是对于一些大型公共场景，由于其空间复杂，设施多样，即使提供平面图用户依然无法有效地定位自身位置。由于gps无法在室内工作，因此许多基于其他信号源的室内定位技术被提出，如uwb定位、蓝牙定位、惯导定位、wifi定位等。其中，wifi的部署成本低廉、覆盖范围广、能提供绝对位置，但定位频率较低、定位精度较低，而imu则能够提供高频率、高精度的相对位置估计，但是存在累积误差。


技术实现要素：

3.本发明所要解决的技术问题是提供一种基于wifi和imu融合的室内定位方法，其利用wifi和imu两者互补，将两者进行融合，能够实现高精度高频率的绝对位置估计。
4.为解决上述问题，本发明的技术方案是：
5.一种基于wifi和imu融合的室内定位方法，包括如下步骤：
6.步骤一、离线采集wifi信号强度构建原始无线地图；
7.步骤二、使用高斯过程回归对构建的原始无线地图进行拟合，训练得到符合真实信号分布的真实无线地图；
8.步骤三、实时获取周围wifi节点的rss数据，然后根据真实无线地图中的训练数据使用自适应k近邻算法获取wifi节点的定位初值坐标；
9.步骤四、采用融合wifi和imu的粒子滤波对获取的定位初值坐标进行定位估计；
10.步骤五、计算步骤四采用融合定位得到的定位估计与使用自适应k近邻算法计算k时刻的wifi节点的定位估计之间的定位误差，并判断该定位误差是否超过设定的误差阈值，若超过，则进行重定位，并选择融合定位得到的定位估计代替k时刻的wifi节点的定位估计，以此为下一轮粒子滤波的定位初值。
11.作为本发明的一种优选改进，步骤一具体包括：离线阶段，在室内定位区域中预先布置m个wifi节点，并对室内地图进行栅格化，将定位区域划分为n个栅格，每个栅格的坐标表示为z
i
＝(x
i
,y
i
),i∈[1,n]，通过采集这n个栅格内的wifi信号强度rss，得到每个栅格的wifi信号强度向量r
i
＝[r
i1
,r
i2
,...,r
im
]
t
，从而构建出室内场景的原始无线地图d＝{(z1,r1),(z2,r2),...,(z
n
,r
n
)}。
[0012]
作为本发明的一种优选改进，步骤二具体包括：
[0013]
以rss分布的对数衰减模型为先验，则先验分布可以表示为f(x)～n(μ
f
,k
ff
)，其中x表示位置坐标，μ
f
表示rss分布的均值，k
ff
表示rss分布的协方差；
[0014]
给定步骤一所建立的rss观测数据(x*,y*)，其中x*,y*分别表示栅格坐标和对应的rss向量值；
[0015]
通过假设y*与f(x)服从联合高斯分布，可以计算得到rss的后验分布f*(x)，从而得到更准确的rss信号分布的无线地图。
[0016]
作为本发明的一种优选改进，步骤三具体包括：
[0017]
定位阶段，在线实时获取周围wifi节点的rss数据r
q
＝[r
q1
,r
q2
,...,r
qm
]
t
，将其与真实无线地图中的训练数据r
ti
＝[r
t1
,r
t2
,...,r
tm
]
t
,i∈[1,n]一一匹配，计算两者间的差异度d
i
；
[0018]
对差异度从小到大排序，设定差异度阈值d
th
，选择小于阈值的差异度对应的训练点作为定位候选点{(x
k
,y
k
)}
k∈[1,k]
；
[0019]
根据计算得到的候选点坐标{(x
k
,y
k
)}及其差异度d
k
，加权计算出定位初值坐标(x0,y0)。
[0020]
作为本发明的一种优选改进，步骤四具体包括：
[0021]
粒子初始化，由定位初值坐标(x0,y0)生成随机采样粒子{(x
i
,y
i
)}
i∈[1,p]
，p为粒子个数；
[0022]
重要性采样，考虑连续两帧wifi信号帧k
‑
1时刻到k时刻，对于所有粒子，根据两帧间采集到的imu数据进行状态递推：
[0023]
y
ik
＝f
y
(y
ik
‑1,s
k
,θ
k
)
[0024]
x
ik
＝f
x
(x
ik
‑1,s
k
,θ
k
)
[0025]
其中，位移s
k
由步长公式根据加速度计值计算得到，航向角θ
k
由角速度计和磁力计融合计算得到；
[0026]
通过高斯过程回归模型，计算出粒子所在位置的rss预测值，根据k时刻实时采集到的rss真实值，计算粒子的权重w
ik
；
[0027]
计算粒子的权重和sum(w
ik
)，并对每个粒子进行权重归一化：
[0028][0029]
通过对粒子坐标按权重进行加权，更新k时刻的定位估计：
[0030][0031]
粒子重采样，对粒子集{(x
ik
,y
ik
),w
ik
}进行重采样，重采样后的粒子集为
[0032]
作为本发明的一种优选改进，步骤五具体包括：使用自适应k近邻算法计算k时刻的wifi节点的定位估计对于步骤四采用融合定位得到的位置估计(x
k
,y
k
)，计算两者之间的定位误差然后设定误差阈值τ，如果定位误差超过该误差阈值τ，则需要进行重定位，并选择融合定位得到的定位估计代替k时刻的wifi节点的定位估计，以此为下一轮粒子滤波的定位初值。
[0033]
本发明与现有技术相比，具有如下有益效果：
[0034]
1、使用高斯过程回归精细化原始无线地图，将离散的指纹数据库替换为wifi节点的rss信号强度分布模型，更好地拟合了真实的信号强度分布；
[0035]
2、利用粒子滤波融合wifi和imu数据进行定位估计，并引入重定位机制抑制较大定位误差，提高了定位精度和频率。
附图说明
[0036]
为了更清楚地说明本发明实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图，其中：
[0037]
图1为本发明一种基于wifi和imu融合的室内定位方法的流程图。
具体实施方式：
[0038]
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0039]
为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。
[0040]
请参阅图1所示，本发明提供了一种基于wifi和imu融合的室内定位方法，包括如下步骤：
[0041]
步骤一、离线采集wifi信号强度构建原始无线地图；
[0042]
具体包括：离线阶段，在室内定位区域中预先布置m个wifi节点，并对室内地图进行栅格化，将定位区域划分为n个栅格，每个栅格的坐标表示为z
i
＝(x
i
,y
i
),i∈[1,n]，通过采集这n个栅格内的wifi信号强度rss，得到每个栅格的wifi信号强度向量r
i
＝[r
i1
,r
i2
,...,r
im
]
t
，从而构建出室内场景的原始无线地图d＝{(z1,r1),(z2,r2),...,(z
n
,r
n
)}。
[0043]
步骤二、使用高斯过程回归对构建的原始无线地图进行拟合，训练得到符合真实信号分布的真实无线地图，这样获得的真实无线地图的分辨率更高，特征更精确；
[0044]
具体包括：以rss分布的对数衰减模型为先验，则先验分布可以表示为f(x)～n(μ
f
,k
ff
)，其中x表示位置坐标，μ
f
表示rss分布的均值，k
ff
表示rss分布的协方差；
[0045]
给定步骤一所建立的rss观测数据(x*,y*)，其中x*,y*分别表示栅格坐标和对应的rss向量值；
[0046]
通过假设y*与f(x)服从联合高斯分布，可以计算得到rss的后验分布f*(x)，从而得到更准确的rss信号分布的无线地图。
[0047]
步骤三、实时获取周围wifi节点的rss数据，然后根据真实无线地图中的训练数据使用自适应k近邻算法获取wifi节点的定位初值坐标；
[0048]
具体包括：定位阶段，在线实时获取周围wifi节点的rss数据r
q
＝[r
q1
,r
q2
,...,r
qm
]
t
，将其与真实无线地图中的训练数据r
ti
＝[r
t1
,r
t2
,...,r
tm
]
t
,i∈[1,n]一一匹配，计算两者间的差异度d
i
；
[0049]
对差异度从小到大排序，设定差异度阈值d
th
，选择小于阈值的差异度对应的训练点作为定位候选点{(x
k
,y
k
)}
k∈[1,k]
；
[0050]
根据计算得到的候选点坐标{(x
k
,y
k
)}及其差异度d
k
，加权计算出定位初值坐标(x0,y0)。
[0051]
步骤四、采用融合wifi和imu的粒子滤波对获取的定位初值坐标进行定位估计；
[0052]
具体包括：粒子初始化，由定位初值坐标(x0,y0)生成随机采样粒子{(x
i
,y
i
)}
i∈[1,p]
，p为粒子个数；
[0053]
重要性采样，考虑连续两帧wifi信号帧k
‑
1时刻到k时刻，对于所有粒子，根据两帧间采集到的imu数据进行状态递推：
[0054]
y
ik
＝f
y
(y
ik
‑1,s
k
,θ
k
)
[0055]
x
ik
＝f
x
(x
ik
‑1,s
k
,θ
k
)
[0056]
其中，位移s
k
由步长公式根据加速度计值计算得到，航向角θ
k
由角速度计和磁力计融合计算得到；
[0057]
通过高斯过程回归模型，计算出粒子所在位置的rss预测值，根据k时刻实时采集到的rss真实值，计算粒子的权重w
ik
；
[0058]
计算粒子的权重和sum(w
ik
)，并对每个粒子进行权重归一化：
[0059][0060]
通过对粒子坐标按权重进行加权，更新k时刻的定位估计：
[0061][0062]
粒子重采样，对粒子集{(x
ik
,y
ik
),w
ik
}进行重采样，重采样后的粒子集为
[0063]
步骤五、计算步骤四采用融合定位得到的定位估计与使用自适应k近邻算法计算k时刻的wifi节点的定位估计之间的定位误差，并判断该定位误差是否超过设定的误差阈值，若超过，则进行重定位，并选择融合定位得到的定位估计代替k时刻的wifi节点的定位估计，以此为下一轮粒子滤波的定位初值。
[0064]
具体包括：使用自适应k近邻算法计算k时刻的wifi节点的定位估计对于步骤四采用融合定位得到的位置估计(x
k
,y
k
)，计算两者之间的定位误差然后设定误差阈值τ，如果定位误差超过该误差阈值τ，则需要进行重定位，并选择融合定位得到的定位估计代替k时刻的wifi节点的定位估计，以此为下一轮粒子滤波的定位初值。
[0065]
本发明与现有技术相比，具有如下有益效果：
[0066]
1、使用高斯过程回归精细化原始无线地图，将离散的指纹数据库替换为wifi节点的rss信号强度分布模型，更好地拟合了真实的信号强度分布；
[0067]
2、利用粒子滤波融合wifi和imu数据进行定位估计，并引入重定位机制抑制较大定位误差，提高了定位精度和频率。
[0068]
本说明书中所描述的以上内容仅仅是对本发明所作的举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种修改或补充或采用类似的方式替代，只
要不偏离本发明说明书的内容或者超越本权利要求书所定义的范围，均应属于本发明的保护范围。