CN106767826A - 一种室内跨楼层路径导航的方法 - Google Patents
一种室内跨楼层路径导航的方法 Download PDFInfo
- Publication number
- CN106767826A CN106767826A CN201611205673.6A CN201611205673A CN106767826A CN 106767826 A CN106767826 A CN 106767826A CN 201611205673 A CN201611205673 A CN 201611205673A CN 106767826 A CN106767826 A CN 106767826A
- Authority
- CN
- China
- Prior art keywords
- floor
- path
- end points
- point
- path navigation
- 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/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Indicating And Signalling Devices For Elevators (AREA)
Abstract
本发明公开了一种室内跨楼层路径导航的方法,包括:1)根据楼层地图数据,将每层的端点建立一个端点集合,以端点绘制出所有可行进路径,可行进路径以线段形式保存下来,建立每层的线段集合;2)接收到出发点、目标点路径导航需求后,将楼层的所有线段将其转换成图算法的邻接矩阵,根据时间复杂度递归计算出同楼层的路径,求出每对顶点间的最短路径;3)将不同楼层的端点进行矩阵连接,将多楼层的贯通配置信息抽象出来,然后将同一个垂直方向上的相关联的点合并到一个集合中,将跨楼层数据输入后,初始化时按照类型赋予不同的权重,同楼层间点的距离可以通过查询对应楼层的邻接矩阵获得,根据这些初始数据使用图算法求出跨楼层的邻接矩阵。
Description
技术领域
本发明涉及一种路径导航方法,尤其涉及一种室内跨楼层路径导航的方法。
背景技术
对于室内地图的路径规划,基本都是在一张地图上进行最短路径计算,其基本原理就是通过调用复杂的路径拓扑数据库,在同一张地图的平面出发点和目标点之间通过路径寻优方法搜索出总代价最低的路径。
随着室内地图服务***的出现,开始出现对多楼层地图之间进行路径导航的需求。室内地图通常是具有多个楼层地图,并在不同的楼层地图之间存在连接关系,这需要在不同楼层地图的出发点和目标点之间进行跨地图的路径计算,而传统地图的路径规划已无法适应这种室内地图服务***。
现有技术中室内路径的搜索算法有Dijkstra、A*等,所需时间较慢,这对于需要频繁查询路径的场合,将造成较大的延时,大大影响使用的效果,因此市场亟需一种可支持室内跨楼层地图路径导航的方法来满足用户使用需求,达到较好的用户体验。
发明内容
为了解决现有技术中存在的问题及不足,本发明提供了一种室内跨楼层路径导航的方法,利用改进的Floyd-Warshall算法将端点集合和路线集合转换为关系矩阵,同楼层1ms、跨楼层5ms左右,速度具有较大优势。
一种室内跨楼层路径导航的方法,步骤包括:
1)根据楼层地图数据,将每层的端点建立一个端点集合,以端点绘制出所有路径,路径以线段形式保存下来,建立每层的线段集合;
将每层楼的跨楼层建筑作为端点放进端点集合中,跨楼层建筑包括电梯、楼梯、扶梯;
2)接收到出发点、目标点路径导航需求后,将楼层的所有线段将其转换成图算法的邻接矩阵,根据时间复杂度递归计算出同楼层的最短路径;
在图算法过程中由于需要求完整路径,所以存储的不止是路径长度,还有前驱端点在端点集合中的下标;
3)将不同楼层的端点进行矩阵连接,将多楼层的贯通配置信息抽象出来,然后将同一个垂直方向上的相关联的点合并到一个集合中,将跨楼层数据输入后,初始化时按照类型赋予不同的权重,同楼层间点的距离可以通过查询对应楼层的邻接矩阵获得,最后根据这些初始数据使用图算法求出跨楼层的邻接矩阵。
所述步骤2)中如果出发点和目标点不在线段上,则将出发点和目标点投影到线段上,再进行计算。
所述步骤2)中的时间复杂度按O(1)计算。
在收到出发点和目标点路径导航需求后,需要先判断出发点和目标点是否在同一层,如果在同一层,则采用时间复杂度O(1)进行路径的计算;如果出发点和目标点在不同楼层,则将不同楼层的端点进行贯通连接,计算每层的时间复杂度,得出每层的路径规划,再将每层路径进行合并,完成总的时间复杂度的计算,完成整个路径的规划。
本发明采用改进的Floyd-Warshall算法将端点集合和路线集合转换为关系矩阵,使用n^2的空间来换取时间效率,n为端点个数,一个楼层一般不超过100,在需要频繁查询路径距离的时候具有巨大优势;利用本方法查询周围最近的公共建筑或对周围店铺距离进行排序,而且查询的是精确的路线距离而非简单的欧式距离,比起一般的室内路径搜索算法快50ms左右,采用本发明消耗时间在同楼层1ms、跨楼层5ms左右,速度具有较大优势,将各楼层分别求矩阵是为了减少空间浪费,而且各楼层可以通过楼层间矩阵连接到一起,跨楼层路径查询速度也较为理想。
附图说明
下面结合附图及实施例对本发明进一步进行描述
图1为本发明的流程图;
图2为本发明同一楼层最短路径一实施例示意图。
具体实施方式
如图1所示,实施例1:本发明一种室内跨楼层路径导航的方法的跨层路径导航步骤包括:
1)根据楼层地图数据,将每层的端点建立一个端点集合,以端点绘制出所有路径,路径以线段形式保存下来,建立每层的线段集合;
将每层楼的跨楼层建筑作为端点放进端点集合中,跨楼层建筑包括电梯、楼梯、扶梯;
2)接收到出发点、目标点路径导航需求后,将楼层的所有线段将其转换成图算法的邻接矩阵,根据时间复杂度递归计算出同楼层的最短路径;
在图算法过程中由于需要求完整路径,所以存储的不止是路径长度,还有前驱端点在端点集合中的下标;
3)将不同楼层的端点进行矩阵连接,将多楼层的贯通配置信息抽象出来,然后将同一个垂直方向上的相关联的点合并到一个集合中,将跨楼层数据输入后,初始化时按照类型赋予不同的权重,同楼层间点的距离可以通过查询对应楼层的邻接矩阵获得,最后根据这些初始数据使用图算法求出跨楼层的邻接矩阵。
所述步骤2)中如果出发点和目标点不在线段上,则将出发点和目标点投影到线段上,再进行计算。
所述步骤2)中的时间复杂度按O(1)计算。
在收到出发点和目标点路径导航需求后,需要先判断出发点和目标点是否在同一层,如果在同一层,则采用时间复杂度O(1)进行路径的计算;如果出发点和目标点在不同楼层,则将不同楼层的端点进行矩阵连接,计算每层的时间复杂度,得出每层的路径规划,再将每层路径进行合并,完成总的时间复杂度的计算,完成整个路径的规划。
如图2所示,对于同楼层的路径导航,采用以下实施例进行说明,对于同一楼层的两个端点s和e进行路径导航,具体流程分解如下:对于普遍性的起点s到终点e的最短路径查询,首先求出s/e离最短路线的投影s’/e’,然后得出s’/e’所在路线的两个端点a、b(c、d),然后比较以下4段路线得出最短距离:s’a+ac+ce’、s’a+ad+de’、s’b+bc+ce’、s’b+bd+de’。
其中求距离时s’a、s’b、ce’、de’直接使用欧式距离时间复杂度O(1),ac、ad、bc、bd直接查询矩阵数组即可时间复杂度也是O(1),总共只有4种组合总时间复杂度O(1),详细路径可以根据最短距离的路线利用矩阵递归求出中间路径,前后再分别加上ss’、s'a/s'b和ce'/de’、e'e。
本发明采用改进的Floyd-Warshall算法将端点集合和路线集合转换为关系矩阵,使用n^2的空间来换取时间效率,n为端点个数,一个楼层一般不超过100,在需要频繁查询路径距离的时候具有巨大优势;利用本方法查询周围最近的公共建筑或对周围店铺距离进行排序,而且查询的是精确的路线距离而非简单的欧式距离,比起一般的室内路径搜索算法快50ms左右,采用本发明消耗时间在同楼层1ms、跨楼层5ms左右,速度具有较大优势,将各楼层分别求矩阵是为了减少空间浪费,而且各楼层可以通过楼层间矩阵连接到一起,跨楼层路径查询速度也较为理想。
以上实施例仅用以说明本发明而并非限制本发明的技术方案,任何对本发明的等同修改或替换均涵盖在本发明的权利要求之内。
Claims (5)
1.一种室内跨楼层路径导航的方法,其特征在于,其步骤包括:
1)根据楼层地图数据,将每层的端点建立一个端点集合,以端点绘制出所有路径,路径以线段形式保存下来,建立每层的线段集合;
2)接收到出发点、目标点路径导航需求后,将楼层的所有线段将其转换成图算法的邻接矩阵,根据时间复杂度递归计算出同楼层的最短路径;
3)将不同楼层的端点进行矩阵连接,将多楼层的贯通配置信息抽象出来,然后将同一个垂直方向上的相关联的点合并到一个集合中,将跨楼层数据输入后,初始化时按照类型赋予不同的权重,同楼层间点的距离可以通过查询对应楼层的邻接矩阵获得,最后根据这些初始数据使用图算法求出跨楼层的邻接矩阵。
2.根据权利要求1所述的一种室内跨楼层路径导航的方法,其特征在于,如果出发点和目标点不在线段上,则将出发点和目标点投影到线段上,再进行计算。
3.根据权利要求1所述的一种室内跨楼层路径导航的方法,其特征在于,步骤1)中将每层楼的跨楼层建筑作为端点放进端点集合中,跨楼层建筑包括电梯、楼梯、扶梯。
4.根据权利要求1所述的一种室内跨楼层路径导航的方法,其特征在于,在图算法过程中由于需要求完整路径,所以存储的不止是路径长度,还有前驱端点在端点集合中的下标。
5.根据权利要求1所述的一种室内跨楼层路径导航的方法,其特征在于,所述步骤2)中的时间复杂度按O(1)计算。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611205673.6A CN106767826A (zh) | 2016-12-23 | 2016-12-23 | 一种室内跨楼层路径导航的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611205673.6A CN106767826A (zh) | 2016-12-23 | 2016-12-23 | 一种室内跨楼层路径导航的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106767826A true CN106767826A (zh) | 2017-05-31 |
Family
ID=58919810
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611205673.6A Pending CN106767826A (zh) | 2016-12-23 | 2016-12-23 | 一种室内跨楼层路径导航的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106767826A (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107203214A (zh) * | 2017-07-31 | 2017-09-26 | 中南大学 | 一种运载机器人复杂混合路径协同自适应智能规划方法 |
CN109205413A (zh) * | 2018-08-07 | 2019-01-15 | 北京云迹科技有限公司 | 跨楼层路径规划方法及*** |
CN109764877A (zh) * | 2019-02-26 | 2019-05-17 | 深圳优地科技有限公司 | 一种机器人跨楼层导航方法、装置及机器人 |
CN111091250A (zh) * | 2020-03-23 | 2020-05-01 | 广东博智林机器人有限公司 | 路网数据的生成方法、装置、电子设备以及可读存储介质 |
CN111678517A (zh) * | 2020-05-26 | 2020-09-18 | 天津市微卡科技有限公司 | 智能机器人跨楼层自主导航方法 |
CN112902965A (zh) * | 2021-01-28 | 2021-06-04 | 盈合(深圳)机器人与自动化科技有限公司 | 机器人跨楼层轨迹的显示方法与*** |
CN112948919A (zh) * | 2021-02-02 | 2021-06-11 | 盈嘉互联(北京)科技有限公司 | 一种基于图像细化的bim模型跨楼层路网提取方法 |
CN112967175A (zh) * | 2021-02-02 | 2021-06-15 | 盈嘉互联(北京)科技有限公司 | 一种基于bim的跨楼层路网提取方法 |
CN113033907A (zh) * | 2021-04-07 | 2021-06-25 | 上海钛米机器人股份有限公司 | 路径规划方法及装置、电子设备、存储介质 |
CN113326344A (zh) * | 2021-06-21 | 2021-08-31 | 广州小鹏汽车科技有限公司 | 地图显示方法及装置、交通工具及存储介质 |
CN113465604A (zh) * | 2021-05-31 | 2021-10-01 | 杭州易现先进科技有限公司 | 跨楼层导航的方法和*** |
CN113465601A (zh) * | 2021-05-13 | 2021-10-01 | 上海师范大学 | 一种基于可视路径的室内导航 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102176283A (zh) * | 2011-01-07 | 2011-09-07 | 重庆大学 | 一种简化交通路网模型及基于此模型的导航方法 |
CN103267526A (zh) * | 2013-05-24 | 2013-08-28 | 北京邮电大学 | 一种室内导航方法及*** |
CN103900600A (zh) * | 2012-12-25 | 2014-07-02 | 中国电信股份有限公司 | 室内跨楼层地图路径导航方法及*** |
CN104457775A (zh) * | 2014-12-12 | 2015-03-25 | 北京航天宏图信息技术有限责任公司 | 路径确定方法、装置和导航仪 |
US9212920B1 (en) * | 2010-01-13 | 2015-12-15 | Lockheed Martin Corporation | System and method for real time optimization of driving directions |
CN105571594A (zh) * | 2015-12-02 | 2016-05-11 | 上海携程商务有限公司 | 室内导航方法 |
CN105628043A (zh) * | 2015-12-28 | 2016-06-01 | 北京握奇智能科技有限公司 | 一种浮动车车载终端的最优路径搜索方法及*** |
CN106123898A (zh) * | 2016-06-15 | 2016-11-16 | 成都新橙北斗智联有限公司 | 基于图片解析的室内路径规划方法 |
-
2016
- 2016-12-23 CN CN201611205673.6A patent/CN106767826A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9212920B1 (en) * | 2010-01-13 | 2015-12-15 | Lockheed Martin Corporation | System and method for real time optimization of driving directions |
CN102176283A (zh) * | 2011-01-07 | 2011-09-07 | 重庆大学 | 一种简化交通路网模型及基于此模型的导航方法 |
CN103900600A (zh) * | 2012-12-25 | 2014-07-02 | 中国电信股份有限公司 | 室内跨楼层地图路径导航方法及*** |
CN103267526A (zh) * | 2013-05-24 | 2013-08-28 | 北京邮电大学 | 一种室内导航方法及*** |
CN104457775A (zh) * | 2014-12-12 | 2015-03-25 | 北京航天宏图信息技术有限责任公司 | 路径确定方法、装置和导航仪 |
CN105571594A (zh) * | 2015-12-02 | 2016-05-11 | 上海携程商务有限公司 | 室内导航方法 |
CN105628043A (zh) * | 2015-12-28 | 2016-06-01 | 北京握奇智能科技有限公司 | 一种浮动车车载终端的最优路径搜索方法及*** |
CN106123898A (zh) * | 2016-06-15 | 2016-11-16 | 成都新橙北斗智联有限公司 | 基于图片解析的室内路径规划方法 |
Non-Patent Citations (2)
Title |
---|
张乃孝等: "《数据结构:C++与面向对象的途径》", 31 January 2001, 高等教育出版社 * |
杨德君: "室内精确定位导航***的设计与实现", 《中国优秀硕士学位论文全文数据库基础科学辑》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107203214A (zh) * | 2017-07-31 | 2017-09-26 | 中南大学 | 一种运载机器人复杂混合路径协同自适应智能规划方法 |
CN109205413A (zh) * | 2018-08-07 | 2019-01-15 | 北京云迹科技有限公司 | 跨楼层路径规划方法及*** |
CN109764877A (zh) * | 2019-02-26 | 2019-05-17 | 深圳优地科技有限公司 | 一种机器人跨楼层导航方法、装置及机器人 |
CN109764877B (zh) * | 2019-02-26 | 2020-10-27 | 深圳优地科技有限公司 | 一种机器人跨楼层导航方法、装置及机器人 |
CN111091250A (zh) * | 2020-03-23 | 2020-05-01 | 广东博智林机器人有限公司 | 路网数据的生成方法、装置、电子设备以及可读存储介质 |
CN111678517A (zh) * | 2020-05-26 | 2020-09-18 | 天津市微卡科技有限公司 | 智能机器人跨楼层自主导航方法 |
CN112902965A (zh) * | 2021-01-28 | 2021-06-04 | 盈合(深圳)机器人与自动化科技有限公司 | 机器人跨楼层轨迹的显示方法与*** |
CN112948919A (zh) * | 2021-02-02 | 2021-06-11 | 盈嘉互联(北京)科技有限公司 | 一种基于图像细化的bim模型跨楼层路网提取方法 |
CN112967175A (zh) * | 2021-02-02 | 2021-06-15 | 盈嘉互联(北京)科技有限公司 | 一种基于bim的跨楼层路网提取方法 |
CN112967175B (zh) * | 2021-02-02 | 2021-09-07 | 盈嘉互联(北京)科技有限公司 | 一种基于bim的跨楼层路网提取方法 |
CN113033907A (zh) * | 2021-04-07 | 2021-06-25 | 上海钛米机器人股份有限公司 | 路径规划方法及装置、电子设备、存储介质 |
CN113465601A (zh) * | 2021-05-13 | 2021-10-01 | 上海师范大学 | 一种基于可视路径的室内导航 |
CN113465604A (zh) * | 2021-05-31 | 2021-10-01 | 杭州易现先进科技有限公司 | 跨楼层导航的方法和*** |
CN113465604B (zh) * | 2021-05-31 | 2024-01-26 | 杭州易现先进科技有限公司 | 跨楼层导航的方法和*** |
CN113326344A (zh) * | 2021-06-21 | 2021-08-31 | 广州小鹏汽车科技有限公司 | 地图显示方法及装置、交通工具及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106767826A (zh) | 一种室内跨楼层路径导航的方法 | |
CN106371445B (zh) | 一种基于拓扑地图的无人车规划控制方法 | |
CN1969170B (zh) | 导航***、路径搜索服务器及路径搜索方法 | |
WO2020108207A1 (zh) | 一种高精度地图的构建方法及装置 | |
CN104931063B (zh) | 路径规划方法 | |
CN108021686B (zh) | 一种快速匹配电子地图中公交线路与道路网络的方法 | |
CN102506851B (zh) | 导航装置及导航方法 | |
CN110515380B (zh) | 基于转弯权重约束的最短路径规划方法 | |
CN105674995A (zh) | 一种基于用户出行轨迹获取通勤路线的方法及装置 | |
CN108827335B (zh) | 一种基于单向搜索模型的最短路径规划方法 | |
CN110471418B (zh) | 智能停车场中的agv调度方法 | |
CN103900600A (zh) | 室内跨楼层地图路径导航方法及*** | |
JP6090226B2 (ja) | 経路生成装置および経路生成方法 | |
CN101216913A (zh) | 合乘动态匹配多级筛选方法 | |
KR20180021883A (ko) | 항법 기준점 확정 및 네비 방법 및 장치, 및 저장 매체 | |
CN108764765A (zh) | 一种派送路径确定方法、装置、终端和存储介质 | |
CN113189988B (zh) | 一种基于Harris算法与RRT算法复合的自主路径规划方法 | |
CN109556622A (zh) | 一种兴趣点查找方法和装置 | |
CN111123198A (zh) | 一种楼宇内的用户定位导航方法及*** | |
CN109459052B (zh) | 一种扫地机全覆盖路径规划方法 | |
CN103164529B (zh) | 一种基于Voronoi图的反k最近邻查询方法 | |
CN105571594A (zh) | 室内导航方法 | |
CN105466447A (zh) | 导航***及导航方法 | |
CN110910501A (zh) | 基于全景地图的网络分析模型构建及路径分析方法 | |
CN114495552A (zh) | 一种快速停车找车导航方法及其*** |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170531 |
|
WD01 | Invention patent application deemed withdrawn after publication |