本发明涉及室内地图领域,尤其涉及一种室内地图匹配增强定位方法、设备及存储设备。
背景技术:
随着普适计算领域的不断发展,室内位置信息变得越来越重要。由于建筑物的遮挡,使得室外成熟的卫星定位技术无法应用于室内。由于无线局域网(wlan)在室内的普遍存在,因此,利用wi-fi的室内定位技术已经成为科研人员和工业领域所研究的热门课题。
早期的wi-fi定位技术通常使用三角测量方法。然而,室内存在大量障碍物使无线信号严重受到多径效应的影响,难以建立准确的信号传播模型,使得此类方法难以得到准确的定位结果。wi-fi指纹定位方法无需建立信号传播模型,已经成为室内定位的主流方法之一。然而,wi-fi指纹定位方法定位结果会出现跳跃点的现象,降低该方法的定位精度。地图匹配方法能利用室内丰富的空间信息约束wi-fi指纹方法的定位结果,能消除不合理的跳跃点,提高定位精度。
现有技术的问题如下:现有最先进的室内地图匹配方法基于隐式马尔可夫模型或条件随机场,但此类地图匹配方法在构建转移矩阵时,仅依赖于相邻的参考点,这使得此类方法对参考点密度十分敏感,定位精度也受目标移动速度、wi-fi扫描频率等的严重影响。因此,现有的基于隐式马尔可夫模型或条件随机场的地图匹配方法十分敏感,难以在现实场景中使用。
技术实现要素:
为了解决上述问题,本发明提供了一种室内地图匹配增强定位方法、设备及存储设备,一种室内地图匹配增强定位方法,主要包括以下步骤:
s1:将室内地图中的可行走区域划分成网格,取每个网格的中点为参考点;根据室内连通关系,将最近的邻接参考点连线得到边;由所有参考点和所有边组成网格模型;
s2:基于所述网格模型计算出所有参考点两两之间的最短参考点路径和对应的最短路径距离;将每一对参考点间的最短参考点路径存储到路径表中,并根据最短路径距离构建该对参考点间的转移概率
其中δ是最短路径距离的阈值,
其中,
s3:根据采用其他定位技术得到的估计位置,利用所述网格模型中的参考点位置计算每个参考点的发散概率p(ot|si),每个参考点si的发散概率p(ot|si)为:
p(ot|si)=(1+||lo(t)-si||2)-1
其中,lo(t)表示在t时刻通过其他定位方法得到的估计位置;si是第i个参考点;i为正整数;p(ot|si)简化记为bt(si),即参考点si在t时刻的发散概率;
s4:通过转移概率矩阵和每个参考点的发散概率,求解最大联合概率的参考点序列;
t时刻最大联合概率参考点为:
利用下面的公式求解t-1时刻的最大联合概率参考点:
其中,bt-1(si)表示t-1时刻时参考点si的发散概率;
通过该方式最终获得最大联合概率的参考点序列x{x1,x2,...,xt};
s5:查询所述路径表,在所述最大联合概率的参考点序列中时间相邻的参考点对之间加上缺少的最短参考点得到最终的参考点序列;
s6:每接收一次所述其他定位技术得到的估计位置时,则运行一次步骤s3-s5,对所述最终的参考点序列进行更新;
s7:当不再接收所述其他定位技术所得的估计位置时,最后一个时刻得到的最终的参考点序列即为最优匹配路径。
进一步地,各个网格的大小相等,若所述边违反了空间约束则去除该边;若某一中心点不属于任一条边的端点,则去除该中心点;最终任意一个参考点都能通过边到达其余所有的参考点。
进一步地,当各个网格不相等时,若所述边违反了空间约束则去除该边;若某一中心点不属于任一条边的端点,则去除该中心点;最终任意一个参考点都能通过边到达其余所有的参考点。
进一步地,所述步骤s2中所述最短路径距离的阈值δ的取值大于零,阈值δ的取值范围为[4,6]米。
一种存储设备,所述存储设备存储指令及数据用于实现一种室内地图匹配增强定位方法。
一种室内地图匹配增强定位设备,包括:处理器及所述存储设备;所述处理器加载并执行所述存储设备中的指令及数据用于实现一种室内地图匹配增强定位方法。
本发明提供的技术方案带来的有益效果是:增强了地图匹配的鲁棒性,提高了定位精度,具有实用性。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明实施例中一种室内地图匹配增强定位方法的流程图;
图2是本发明实施例中路径表的使用示意图;
图3是本发明实施例中硬件设备工作的示意图。
具体实施方式
为了对本发明的技术特征、目的和效果有更加清楚的理解,现对照附图详细说明本发明的具体实施方式。
本发明的实施例提供了一种室内地图匹配增强定位方法、设备及存储设备。
请参考图1,图1是本发明实施例中一种室内地图匹配增强定位方法的流程图,具体包括如下步骤:
s1:将室内地图中的可行走区域划分成网格,取每个网格的中点为参考点;根据室内连通关系,将最近的邻接参考点连线得到边;所述室内连通关系是指,没有墙壁相隔的两个参考点相连成线,有墙壁相隔的两个参考点不相连,例如,两个参考点分别为a和b,若a和b之间没有墙壁相隔,则a和b之间连接成线,若a和b之间有墙壁相隔,则a和b之间不能连接成线;由所有参考点和所有边组成网格模型;将室内地图剖分成大小相等的网格,将网格中心点作为参考点,相邻的参考点连线作为边。为了使网格尽可能覆盖整个室内地图的行人可达区域,每一个网格的大小不一定完全相等。如果边违反了空间约束(如,穿墙)则去除;如果点不属于任何一条边的端点,则去除。最终任意一个参考点都能通过边到达其余所有的参考点。
s2:基于所述网格模型计算出所有参考点两两之间的最短参考点路径和对应的最短路径距离;将每一对参考点间的最短参考点路径存储到路径表中,并根据最短路径距离构建该对参考点间的转移概率
其中δ是最短路径距离的阈值,所述最短路径距离的阈值δ的取值大于零,阈值δ的取值范围为[4,6]米;dpath(si,sj)为参考点si和参考点sj之间的路径距离;为保证任一参考点到其余参考点间的转移概率之和为1,将转移概率作如下变换:
其中,
s3:根据采用其他定位技术得到的估计位置,利用所述网格模型中的参考点位置计算每个参考点在对应时刻的发散概率p(ot|si),每个参考点si的发散概率p(ot|si)为:
p(ot|si)=(1+||lo(t)-si||2)-1
其中,lo(t)是时间为t时通过其他定位方法得到的估计位置;si是第i个参考点;i为正整数;p(ot|si)简化记为bt(si),即参考点si在t时刻的发散概率;
s4:通过转移概率矩阵和每个参考点的发散概率,求解最大联合概率的参考点序列;t时刻每个参考点的概率的计算公式如下:
其中bt(si)表示t时刻时参考点si的发散概率;
在最后时刻t最大联合概率参考点为:
其中,δt-1(si)表示t-1时刻参考点si的联合概率,所述联合概率由发散概率和转移概率组成;
通过该方式最终获得最大联合概率的参考点序列x{x1,x2,...,xt};
s5:如图2所示,查询所述路径表,在所述最大联合概率的参考点序列中时间相邻的参考点对之间加上缺少的最短参考点得到最终的参考点序列;假设(s1,si,sj)为推理所得最大可能性参考点序列,先将该序列划分为时间相邻的俩俩参考点对如(s1,si)和(si,sj)。然后,在路径表使用这些参考点对进行查询。经过查表后s1,si之间和si,sj之间的最短参考点序列填充到对应位置,得到的序列为最终定位序列。
s6:每接收一次所述其他定位技术得到的估计位置时,则运行一次步骤s3-s5,对所述最终的参考点序列进行更新;所述其他定位技术包括行人航位推算(pdr)、蓝牙定位、地磁定位和声源定位等;
s7:当不再接收所述其他定位技术所得的估计位置时,最后一个时刻得到的最终的参考点序列即为最优匹配路径。
请参见图3,图3是本发明实施例的硬件设备工作示意图,所述硬件设备具体包括:一种室内地图匹配增强定位设备401、处理器402及存储设备403。
一种室内地图匹配增强定位设备401:所述一种室内地图匹配增强定位设备401实现所述一种室内地图匹配增强定位方法。
处理器402:所述处理器402加载并执行所述存储设备403中的指令及数据用于实现所述一种室内地图匹配增强定位方法。
存储设备403:所述存储设备403存储指令及数据;所述存储设备403用于实现所述一种室内地图匹配增强定位方法。
本发明的有益效果是:增强了地图匹配的鲁棒性,提高了定位精度,具有实用性。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。