CN106289282A - 一种室内地图行人航迹匹配方法 - Google Patents
一种室内地图行人航迹匹配方法 Download PDFInfo
- Publication number
- CN106289282A CN106289282A CN201610566818.9A CN201610566818A CN106289282A CN 106289282 A CN106289282 A CN 106289282A CN 201610566818 A CN201610566818 A CN 201610566818A CN 106289282 A CN106289282 A CN 106289282A
- Authority
- CN
- China
- Prior art keywords
- pedestrian
- path
- map
- indoor
- indoor map
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明是一种室内地图行人航迹匹配方法,包括步骤S1:采集室内地图信息,绘制室内地图,绘制室内各通道的路径线,在室内地图上标示路标;步骤S2:将行人航迹与地图中的路径线匹配、路标匹配。本发明在地图匹配过程中,在将行人位置匹配到地图的几何特征点之后,以新的位置点为定位的新的初始位置,为减小累积误差,在新的初始位置重新初始化手机中的传感器,这种彻底重新初始化对于行人航迹推算算法的作用非常大,不但消除了位置估计层上的累积误差,也消除了航向角、步长估计层的累积误差。经过路径匹配,可避免狭窄走廊内出现穿墙行为。本发明在行人航迹推算的基础之上加上地图匹配,可以提高室内定位的精度。
Description
技术领域
本发明属于地图导航技术领域,涉及一种室内地图行人航迹匹配方法。
背景技术
当前,科研人员已经提出了很多种室内地图匹配方法。
例如:终端获取用户当前位置对应的位置点,确定该位置点是否在该建筑物内事先规划的道路线段上;如果在道路线段上,直接将该位置点映射到终端的地图上;如果不在道路线段上,获取离该位置点最近的道路线段;获取该位置点到达该最近的道路线段的垂点,将该垂点映射到终端的地图上。
现有的地图匹配方法,基于实时位置进行位置匹配。
发明内容
针对现有的地图匹配方法需要设计复杂的室内地图,且匹配方法复杂,本发明的目的是提供在有行人航迹推算的基础之上,根据传感器在行进过程中输出的信号实时进行检测,检测的特征量简单,路径线的匹配方法简单,且实用性高的一种室内地图行人航迹匹配方法。
为了达成所述目的,本发明提供一种室内地图行人航迹匹配方法,包括步骤:
步骤S1:采集室内地图信息,绘制室内地图,绘制室内各通道的路径线,在室内地图上标示路标;
步骤S2:将行人航迹与地图中的路径线匹配、路标匹配。
本发明的有益效果:
本发明在室内地图匹配过程中,在将行人位置匹配到地图的路标之后,以新的位置点为定位的新的初始位置,为减小累积误差,在新的初始位置重新初始化手机中的传感器,这种彻底重新初始化对于行人航迹推算(PDR-SH)算法的作用非常大,不但消除了位置估计层上的累积误差,也消除了航向角、步长估计层的累积误差。经过路径匹配,可避免狭窄走廊内出现穿墙行为。本发明在行人航迹推算的基础之上加上地图匹配,可以提高室内定位的精度。
附图说明
图1为本发明一种室内地图行人航迹匹配方法流程图;
图2为本发明识别所述路标的流程图;
图3为本发明所述行人航迹推算的流程图;
图4为本发明行人航迹与所述室内路径匹配流程图。
具体实施方式
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍。在所有附图中,类似的元件或部分一般由类似的附图标记标识。附图中,各元件或部分并不一定按照实际的比例绘制。
请参阅图1示出本发明提供一种室内地图行人航迹匹配方法,所述方法包括步骤:
步骤S1:采集地图信息采集,绘制室内地图,绘制狭窄走廊的路径线,在地图上标明几何特征点;
步骤S2:将行人航迹与地图中的路径线匹配、路标匹配。
其中,所述路标是室内地图中的几何特征点、无线局域网(Wireless Fidelity)、地磁。
其中,利用传感器检测到行人行进的角速度、加速度。
其中,根据行人行进的角速度和加速度提取路标识别特征量,所述路标识别特征量是加速度峰值、角速度、角速度/加速度峰值、角速度积分后的角度、角速度积分后的角度/加速度峰值。
转弯检测或称路标识别,通过传感器检测到的角速度/加速度峰值等等信息,判断检测量是否达到设定阈值,若达到,进行路径匹配;
在直角拐弯处,对应的传感器输出的加速度和角速度信号有突变,这是拐弯处的运动特征。
获得路标识别特征量优选方案1的计算公式:
路标识别特征量=角速度/加速度峰值,
获得路标识别特征量可以选择如下的任意一个优选方案2的计算公式:
路标识别特征量=角速度,
路标识别特征量=加速度峰值,
路标识别特征量=角速度积分后的角度,
路标识别特征量=角速度积分后的角度/加速度峰值。
请参阅图2为本发明识别所述路标的流程图,其中,
识别步骤S2所述路标的步骤包括:
步骤S211:对路标识别特征量设定一个阈值;
步骤S212:在行人行进过程,通过传感器检测路标识别特征量有突变而且超过阈值,则识别出突变的路标识别特征量是一直角拐弯点的路标。
其中,识别所述路标的步骤包括:根据行人航迹推算的轨迹线推算行人位置,如果行人拐弯发生在通道尽头,则将行人位置直接纠正到拐弯点处,则识别出拐弯点的路标。
其中,根据路径线进行匹配对所述路标识别的步骤包括:将行人航迹拐弯点匹配到路径线,根据拐弯点在路径线上的匹配点在路径线上的行人位置,将行人位置纠正到路径线最近的拐弯处,则识别出具有拐弯点的路标。
请参阅图3示出本发明所述行人航迹推算的流程图,其中:
所述行人航迹推算包括步骤:
步骤S221:在室内的通道内,根据行人行进过程中行人航迹推算产生的行人位置点到路径线的距离;
步骤S222:如果所述距离超过了设定的路径宽度,则将行人位置纠正到路径线上,如果所述距离没有超过设定的路径宽度,执行步骤S221行人航迹推算继续。
请参阅图4示出本发明行人航迹与所述室内路径匹配流程图,其中:
所述行人航迹与地图中的路标匹配步骤包括步骤:
步骤S231:将行人位置匹配到地图的几何特征点之后,以新的位置点为定位的新的初始位置;
步骤S232:将新的初始位置重新初始化手机中的传感器。
本发明地图匹配具体过程如下:
一)、地图信息采集,绘制室内地图,绘制狭窄走廊的路径线,在地图上标明几何特征点。
二)、地图匹配过程
1)、路标识别:
下式为路标识别特征量的计算公式:
路标识别特征量=角速度/加速度峰值
本发明的其他替代方案为路标识别特征量可以选择角速度、角速度积分后角度、加速度峰值、角速度积分后的角度/加速度峰值四个量。
本发明创新为路标(拐弯点)识别,角速度/加速度峰值是否达到阈值。
对路标识别特征量设定一个阈值,在行进过程中对路标识别特征量进行检测,超过阈值,则认为发生了一次直角拐弯。所述阈值设定包括:角速度的阈值可设定在0.6-1.3之间,加速度峰值的阈值设定在0.9-1.2之间,角速度/加速度峰值阈值设定在0.8-1.1之间,速度积分后的角度是通过其改变量来检测,改变量的阈值设定为0.2-0.8之间,角速度积分后的角度/加速度峰值通过该路标识别特征量的改变量来检测,改变量阈值设定在1-1.3。
根据行人航迹推算的轨迹线推算位置,如果拐弯发生在走廊尽头,则可以将行人位置直接纠正到拐弯点处,否则根据路径线进行匹配,将拐弯点匹配到路径线,根据拐弯点在路径线上的匹配点在路径线上的位置,将位置纠正到路径线最近的拐弯处(几何特征点)。
本发明在将行人位置匹配到地图的几何特征点之后,以新的位置点为定位的新的初始位置,为减小累积误差,在新的初始位置重新初始化手机中的传感器,这种彻底重新初始化对于行人航迹推算(PDR-SH)算法的作用非常大,不但消除了位置估计层上的累积误差,也消除了航向角、步长估计层的累积误差。
2)、路径匹配
在狭窄走廊内,根据行进过程中行人航迹推算产生的位置点到路径线的距离,判断是否穿墙,如果距离超过了设定的路径宽度,则将位置纠正到路径线上,否则,行人航迹推算继续,不做处理。
本发明经过路径匹配,可避免狭窄走廊内出现穿墙行为。总之,在行人航迹推算的基础之上加上地图匹配,可以提高室内定位的精度。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围,其均应涵盖在本发明的权利要求和说明书的范围当中。
Claims (9)
1.一种室内地图行人航迹匹配方法,其特征在于,包括步骤:
步骤S1:采集室内地图信息,绘制室内地图,绘制室内各通道的路径线,在室内地图上标示路标;
步骤S2:将行人航迹与地图中的路径线匹配、路标匹配。
2.根据权利要求1所述的室内地图行人航迹匹配方法,其特征在于,所述路标是室内地图中的几何特征点、无线局域网、地磁。
3.根据权利要求1所述的室内地图行人航迹匹配方法,其特征在于,利用传感器检测到行人行进的角速度和加速度。
4.根据权利要求3所述的室内地图行人航迹匹配方法,其特征在于,根据行人行进的角速度和加速度提取路标识别特征量,所述路标识别特征量是加速度峰值、角速度、角速度/加速度峰值、角速度积分后的角度、角速度积分后的角度/加速度峰值。
5.根据权利要求4所述的室内地图行人航迹匹配方法,其特征在于,识别所述路标的步骤包括:
步骤S211:对路标识别特征量设定一个阈值;
步骤S212:在行人行进过程,通过传感器检测路标识别特征量有突变而且超过阈值,则识别出突变的路标识别特征量是一直角拐弯点的路标。
6.根据权利要求4所述的室内地图行人航迹匹配方法,其特征在于,识别所述路标的步骤包括:根据行人航迹推算的轨迹线推算行人位置,如果行人拐弯发生在通道尽头,则将行人位置直接纠正到拐弯点处,则识别出拐弯点的路标。
7.根据权利要求4所述的室内地图行人航迹匹配方法,其特征在于,根据路径线进行匹配对所述路标识别的步骤包括:将行人航迹拐弯点匹配到路径线,根据拐弯点在路径线上的匹配点以及在路径线上的行人位置,将行人位置纠正到路径线最近的拐弯处,则识别出具有拐弯点的路标。
8.根据权利要求6-7任一项所述的室内地图行人航迹匹配方法,其特征在于,所述行人航迹推算包括步骤:
步骤S221:在室内的通道内,根据行人行进过程中行人航迹推算产生的行人位置点到路径线的距离;
步骤S222:如果所述距离是超过了设定的路径宽度,则将行人位置纠正到路径线上,如果所述距离没有超过设定的路径宽度,执行步骤S221继续行人航迹推算。
9.根据权利要求1所述的室内地图行人航迹匹配方法,其特征在于,所述行人航迹与地图中的路标匹配步骤包括步骤:
步骤S231:将行人航迹中的位置匹配到地图的路标,以新的位置点为定位的新的初始位置;
步骤S232:将新的初始位置重新初始化手机中的传感器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610566818.9A CN106289282A (zh) | 2016-07-18 | 2016-07-18 | 一种室内地图行人航迹匹配方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610566818.9A CN106289282A (zh) | 2016-07-18 | 2016-07-18 | 一种室内地图行人航迹匹配方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106289282A true CN106289282A (zh) | 2017-01-04 |
Family
ID=57651450
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610566818.9A Pending CN106289282A (zh) | 2016-07-18 | 2016-07-18 | 一种室内地图行人航迹匹配方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106289282A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107144863A (zh) * | 2017-04-28 | 2017-09-08 | 上海美迪索科电子科技有限公司 | 一种基于地图信息的gps/bd定位轨迹优化方法 |
CN109099909A (zh) * | 2018-06-27 | 2018-12-28 | 电子科技大学 | 一种基于行人惯性导航路径还原和多路径相关匹配的室内定位方法 |
CN109459030A (zh) * | 2018-11-27 | 2019-03-12 | 北京方位捷讯科技有限公司 | 一种基于地标的行人定位修正方法及*** |
CN109708647A (zh) * | 2019-03-08 | 2019-05-03 | 哈尔滨工程大学 | 一种基于融合特征元素的室内拓扑地图行人定位方法 |
CN110287803A (zh) * | 2019-05-29 | 2019-09-27 | 广州小鹏汽车科技有限公司 | 一种轨迹路标的识别方法及*** |
CN110631578A (zh) * | 2019-09-29 | 2019-12-31 | 电子科技大学 | 一种无地图下室内行人定位与追踪方法 |
CN110631591A (zh) * | 2019-10-23 | 2019-12-31 | 北京航空航天大学 | 一种基于室内地图与虚拟路标辅助的行人室内导航方法 |
WO2022183936A1 (zh) * | 2021-03-04 | 2022-09-09 | 华为技术有限公司 | 一种智能家居设备选择方法及终端 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101819042A (zh) * | 2009-02-26 | 2010-09-01 | 爱信艾达株式会社 | 导航装置及导航用程序 |
CN102905368A (zh) * | 2012-10-18 | 2013-01-30 | 无锡儒安科技有限公司 | 基于智能手机平台的移动辅助室内定位方法和*** |
CN103453913A (zh) * | 2013-08-29 | 2013-12-18 | 镇江青思网络科技有限公司 | 停车场中车辆的组合定位方法 |
TW201425874A (zh) * | 2012-12-28 | 2014-07-01 | Univ Nat Cheng Kung | 使用地圖之室內定位方法 |
CN104061934A (zh) * | 2014-06-10 | 2014-09-24 | 哈尔滨工业大学 | 基于惯性传感器的行人室内位置跟踪方法 |
CN104180805A (zh) * | 2014-08-29 | 2014-12-03 | 中国海洋大学 | 基于智能手机的室内行人定位与跟踪方法 |
US20140365119A1 (en) * | 2013-06-11 | 2014-12-11 | Indooratlas Oy | Detecting information about motion of mobile device |
CN104596526A (zh) * | 2014-04-17 | 2015-05-06 | 腾讯科技(深圳)有限公司 | 一种定位点匹配方法及装置 |
CN104655137A (zh) * | 2015-03-05 | 2015-05-27 | 中国人民解放军国防科学技术大学 | 行人航迹推测辅助的Wi-Fi信号指纹定位算法 |
CN105102928A (zh) * | 2013-02-01 | 2015-11-25 | 株式会社理光 | 惯性装置、方法和程序 |
CN105180933A (zh) * | 2015-09-14 | 2015-12-23 | 中国科学院合肥物质科学研究院 | 基于直行路口检测的移动机器人航迹推算修正***及方法 |
CN105241445A (zh) * | 2015-10-20 | 2016-01-13 | 深圳大学 | 一种基于智能移动终端的室内导航数据获取方法及*** |
-
2016
- 2016-07-18 CN CN201610566818.9A patent/CN106289282A/zh active Pending
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101819042A (zh) * | 2009-02-26 | 2010-09-01 | 爱信艾达株式会社 | 导航装置及导航用程序 |
CN102905368A (zh) * | 2012-10-18 | 2013-01-30 | 无锡儒安科技有限公司 | 基于智能手机平台的移动辅助室内定位方法和*** |
TW201425874A (zh) * | 2012-12-28 | 2014-07-01 | Univ Nat Cheng Kung | 使用地圖之室內定位方法 |
CN105102928A (zh) * | 2013-02-01 | 2015-11-25 | 株式会社理光 | 惯性装置、方法和程序 |
US20140365119A1 (en) * | 2013-06-11 | 2014-12-11 | Indooratlas Oy | Detecting information about motion of mobile device |
CN103453913A (zh) * | 2013-08-29 | 2013-12-18 | 镇江青思网络科技有限公司 | 停车场中车辆的组合定位方法 |
CN104596526A (zh) * | 2014-04-17 | 2015-05-06 | 腾讯科技(深圳)有限公司 | 一种定位点匹配方法及装置 |
CN104061934A (zh) * | 2014-06-10 | 2014-09-24 | 哈尔滨工业大学 | 基于惯性传感器的行人室内位置跟踪方法 |
CN104180805A (zh) * | 2014-08-29 | 2014-12-03 | 中国海洋大学 | 基于智能手机的室内行人定位与跟踪方法 |
CN104655137A (zh) * | 2015-03-05 | 2015-05-27 | 中国人民解放军国防科学技术大学 | 行人航迹推测辅助的Wi-Fi信号指纹定位算法 |
CN105180933A (zh) * | 2015-09-14 | 2015-12-23 | 中国科学院合肥物质科学研究院 | 基于直行路口检测的移动机器人航迹推算修正***及方法 |
CN105241445A (zh) * | 2015-10-20 | 2016-01-13 | 深圳大学 | 一种基于智能移动终端的室内导航数据获取方法及*** |
Non-Patent Citations (1)
Title |
---|
邓仲哲: ""基于惯性传感器和地图匹配的行人室内定位算法"", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107144863A (zh) * | 2017-04-28 | 2017-09-08 | 上海美迪索科电子科技有限公司 | 一种基于地图信息的gps/bd定位轨迹优化方法 |
CN109099909A (zh) * | 2018-06-27 | 2018-12-28 | 电子科技大学 | 一种基于行人惯性导航路径还原和多路径相关匹配的室内定位方法 |
CN109099909B (zh) * | 2018-06-27 | 2021-09-24 | 电子科技大学 | 一种基于行人惯性导航路径还原和多路径相关匹配的室内定位方法 |
CN109459030A (zh) * | 2018-11-27 | 2019-03-12 | 北京方位捷讯科技有限公司 | 一种基于地标的行人定位修正方法及*** |
CN109708647A (zh) * | 2019-03-08 | 2019-05-03 | 哈尔滨工程大学 | 一种基于融合特征元素的室内拓扑地图行人定位方法 |
CN110287803A (zh) * | 2019-05-29 | 2019-09-27 | 广州小鹏汽车科技有限公司 | 一种轨迹路标的识别方法及*** |
CN110287803B (zh) * | 2019-05-29 | 2021-07-13 | 广州小鹏自动驾驶科技有限公司 | 一种轨迹路标的识别方法及*** |
CN110631578A (zh) * | 2019-09-29 | 2019-12-31 | 电子科技大学 | 一种无地图下室内行人定位与追踪方法 |
CN110631578B (zh) * | 2019-09-29 | 2021-06-08 | 电子科技大学 | 一种无地图下室内行人定位与追踪方法 |
CN110631591A (zh) * | 2019-10-23 | 2019-12-31 | 北京航空航天大学 | 一种基于室内地图与虚拟路标辅助的行人室内导航方法 |
WO2022183936A1 (zh) * | 2021-03-04 | 2022-09-09 | 华为技术有限公司 | 一种智能家居设备选择方法及终端 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106289282A (zh) | 一种室内地图行人航迹匹配方法 | |
CN105241445B (zh) | 一种基于智能移动终端的室内导航数据获取方法及*** | |
Bo et al. | Smartloc: Push the limit of the inertial sensor based metropolitan localization using smartphone | |
CN101750090B (zh) | 利用轨迹点导航的导航装置 | |
JP6260114B2 (ja) | 走行路情報生成装置 | |
CN103674015B (zh) | 一种无轨化定位导航方法及装置 | |
CN102682590B (zh) | 实时交通信息处理方法和装置 | |
WO2020224305A1 (zh) | 用于设备定位的方法、装置及设备 | |
Song et al. | Enhancing GPS with lane-level navigation to facilitate highway driving | |
CN101922939B (zh) | 一种导航过程中的地图匹配方法和装置 | |
US20140309841A1 (en) | Autonomous Mobile System | |
CN102879003A (zh) | 基于gps终端的面向车辆位置跟踪的地图匹配方法 | |
Wang et al. | Vehicle localization at an intersection using a traffic light map | |
CN105761242A (zh) | 一种基于计算机双目视觉与惯性测量的盲人行走定位方法 | |
CN105136160A (zh) | 一种基于移动终端和增强现实技术的近距离最优公交站点导航方法 | |
US9658074B2 (en) | Diverging and converging road geometry generation from sparse data | |
US10538250B2 (en) | Road geometry generation from sparse data | |
KR101553898B1 (ko) | 지형지물의 위치정보를 이용한 자율이동차량의 위치추정시스템 및 방법 | |
CN109459028A (zh) | 一种基于梯度下降的自适应步长估计方法 | |
CN105628035A (zh) | 步行导航方法和装置 | |
CN109141408A (zh) | 一种长输地下管道定位***的误差补偿方法及实施*** | |
CN103162687B (zh) | 基于信息可信度的图像/惯导组合导航方法 | |
CN107504968A (zh) | 一种基于pdr及移动目标进出点的轨迹追踪方法 | |
CN102721416B (zh) | 一种定位的方法和移动终端 | |
CN104215243A (zh) | 基于安卓***面向医疗应用的无源自主式室内定位*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170104 |
|
RJ01 | Rejection of invention patent application after publication |