CN112509132B - 一种面向船舶应用的立体路径计算方法 - Google Patents
一种面向船舶应用的立体路径计算方法 Download PDFInfo
- Publication number
- CN112509132B CN112509132B CN202011388530.XA CN202011388530A CN112509132B CN 112509132 B CN112509132 B CN 112509132B CN 202011388530 A CN202011388530 A CN 202011388530A CN 112509132 B CN112509132 B CN 112509132B
- Authority
- CN
- China
- Prior art keywords
- path
- node
- dimensional
- ship
- indoor
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/05—Geographic models
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F16/00—Information retrieval; Database structures therefor; File system structures therefor
- G06F16/20—Information retrieval; Database structures therefor; File system structures therefor of structured data, e.g. relational data
- G06F16/29—Geographical information databases
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Business, Economics & Management (AREA)
- Software Systems (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Physics (AREA)
- Databases & Information Systems (AREA)
- Human Resources & Organizations (AREA)
- Remote Sensing (AREA)
- Economics (AREA)
- General Engineering & Computer Science (AREA)
- Strategic Management (AREA)
- Geometry (AREA)
- Pure & Applied Mathematics (AREA)
- Computational Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Entrepreneurship & Innovation (AREA)
- General Business, Economics & Management (AREA)
- Computing Systems (AREA)
- Tourism & Hospitality (AREA)
- Quality & Reliability (AREA)
- Operations Research (AREA)
- Marketing (AREA)
- Algebra (AREA)
- Game Theory and Decision Science (AREA)
- Development Economics (AREA)
- Computer Graphics (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
一种面向船舶应用的立体路径计算方法,包括如下步骤:通过坐标转换矩阵,将船舶室内路径的二维坐标进行转换得到船舶室内路径的三维坐标;基于步骤一中得到的船舶室内路径的三维坐标和改进的A*算法,依次分段进行船舶室内立体路径计算;将根据改进的A*算法计算后的路径,进行计算,通过路径参数设置转换为CZML数据格式;转换后的CZML数据再通过三维插件进行加载和渲染;最后在地图上可视化呈现三维路径;本方法能够实现在三维部分建模的情景下精确计算室内空间立体路径,实现船舶内部空间路径的自动快速计算,对于提高地图服务能力与性能,具有重要意义。
Description
技术领域
本发明属于船舶室内地图领域,具体涉及一种面向船舶应用的立体路 径计算方法。
背景技术
随着船舶信息化程度的逐步提高与船舶电子地图应用的逐步深入,对 船舶内部立体路径计算的需求越来越迫切,但依靠人力很难快速的计算分 析出最优的空间路径,由于船舶舱室复杂、路径多样,设备繁多、全三维 仿真建模不可行等问题,船舶立体路径计算问题难以直接获取三维立体坐 标,因此船舶立体路径计算难以直接利用现有算法实现。另一方面,由于 船舶具有多层甲板,在平面地图上显示立体路径不够直观,舰员也很难根 据实际路径进行导航;因此。需要通过三维立体渲染将计算出来的路径立 体呈现。
发明内容
本发明的目的在于解决由于船舶舱室复杂、设备繁多、全三维仿真建 模不可行等问题,船舶立体路径计算问题难以直接获取三维立体坐标,因 此船舶立体路径计算难以直接利用现有算法实现的问题。
本发明采用的技术方案是:一种面向船舶应用的立体路径计算方法,包 括如下步骤:
步骤一:通过坐标转换矩阵,将船舶室内路径的二维坐标进行转换得到 三维坐标;
步骤二:基于改进的A*算法,依次分段进行船舶室内立体路径计算;
步骤三:将根据改进的A*算法计算后的路径,通过路径参数设置转换为 CZML数据格式;
步骤四:转换后的CZML数据再通过cesium进行加载和渲染;最后在地 图上可视化呈现三维路径;
进一步的,所述步骤一将船舶室内路径的二维坐标矩阵补充路径位置所 在舱室楼层的空间高度数据h1,h2,..,hn,得到三维坐标矩阵如下:
其中D3是路径对应位置的三维坐标矩阵,通过舱室所在高度将二维坐标 矩阵转换为三维坐标矩阵;为了保证精确性,引入了高度转换公式,如下 所示:
D3'=D3T'(2)
其中,h1,h2,..,hn表示路径位置所在舱室楼层的空间高度,h表示舱室楼 层的空间高度与空间寻路地址坐标的高度转换系数。
进一步的,所述步骤三中改进的A*算法表达式为:
F(n)=G(n)+H(n)+Risk(n) (4)
其中,G(n)为耗散函数,表示从起点到节点n的实际路径代价(距离);
H(n)是有可能生成路径的启发函数,表示节点n到目标点的最佳路 径估计代价,采用欧式距离表示:
F(n)是生成的路径评价函数,表示通过节点n从起点到达目标点的 路径代价;
x表示当前节点与目标节点x轴的差值;y表示当前节点与目标节点y 轴差值;z表示当前节点与目标节点z轴差值;
假设距离节点n最近的障碍点为On,其中d0为On与节点n的距离,w0为 距离障碍小于安全距离dmax时的惩罚系数。
进一步的,所述步骤二中依次分段进行船舶室内立体路径计算的具体 步骤如下所示:
(1)初始化三维坐标,构建三维数组。三维数组为1代表实际位置有 障碍,为0代表无障碍;考虑到与障碍物安全半径,可做三维膨胀操作;
(2)创建open集(所有节点的集合)和close集(已遍历过的节点集 合)。将起点加入open集;
(3)选出open集中F最小的节点,判断其是否满足约束,满足则将 其移入到close集。否则在open集中删除该节点。然后重复操作(3);
(4)判断当前移入点是否是终点,如是终点则查找完毕,获得初步路 径Pi。否则获取当前点下一步可到达的所有点;
(5)若(4)找到的点在open集中,若G比之前计算的小,则更新该 点数据。若不在,计算这些点的F、G、C值并将这些点加入open集;
(6)跳转到步骤(3),直到当前移入的点为终点;
(7)定义初步路径的节点数为m个;改进平滑处理后的路径为Pp;
(8)判断Pi的节点是否小于等于m;是则执行下一步,否则将Pi上非N 节点赋值给Pp;
(9)获得第i个节点和第i+2个节点所在的线段li,i+2;
(10)判断线段li,i+2上是否存在障碍物若不存在,则执行下一步,否则 执行第(6)步;
(11)将Pi上第i+1个节点删除;
(12)设置当前节点为下一节点,转到(2);
(13)最终获得改进算法处理后所得的优化路径;
(14)对该路径进行B样条平滑算法处理,平滑处理时需要加入角度 约束,使其更加符合实际需要;
(15)获得处理后的优化路径。
进一步的,所述步骤三中路径参数包括时间速率、路径材质、路径宽度 及路径指示方向。
相对于现有技术,本发明的有益效果在于:能够实现在三维部分建模的 情景下精确计算室内空间立体路径;同时,该方法对常规路径规划算法A* 进行了改进,有利于不同复杂场景的路径规划,并且增加了路径的安全性; 实现船舶内部空间路径的自动快速计算,对于提高地图服务能力与性能,具 有重要意义。
附图说明
图1为本发明较佳实施例面向船舶应用的立体路径计算流程图。
图2为本发明较佳实施例改进的A*路径规划算法流程图。
图3为本发明较佳实施例面向船舶应用的立体路径具体流程图。
图4为本发明某一具体算例的渲染后的三维路径示意图(图中白线为 路径)。
具体实施方式
下面结合附图对本发明进行进一步说明:
请参考图1,本发明具体涉及一种面向船舶应用的立体路径计算方法,包 括如下步骤:
步骤一:通过坐标转换矩阵,将船舶室内路径的二维坐标进行转换得到 船舶室内路径的三维坐标;
步骤二:基于步骤一中得到的船舶室内路径的三维坐标和改进的A*算法, 依次分段进行船舶室内立体路径计算;
步骤三:将根据改进的A*算法计算后的路径,进行计算,通过路径参数 (包括时间速率、路径材质、路径宽度、路径指示方向等参数)设置转换为 CZML数据格式;
步骤四:转换后的CZML数据(CZML是用来描述动态场景的JSON架构的 语言)再通过三维插件(例如cesium)进行加载和渲染;最后在地图上可视 化呈现三维路径;
所述步骤一将船舶室内路径的二维坐标矩阵补充路径位置所在舱室楼 层的空间高度数据h1,h2,..,hn,得到三维坐标矩阵如下:
其中D3是路径对应位置的三维坐标矩阵,通过舱室所在高度将二维坐标 矩阵转换为三维坐标矩阵;考虑到一些路径对应位置高度坐标和舱室所在 高度坐标不完全相同,为了保证精确性,引入了高度转换公式,如下所示:
D3'=D3T'(2)
其中,h1,h2,..,hn表示路径位置所在舱室楼层的空间高度,h表示舱室楼 层的空间高度与空间寻路地址坐标的高度转换系数,该系数根据不同舱室 有所区别。
所述步骤二中改进的A*算法表达式为:
F(n)=G(n)+H(n)+Risk(n) (4)
其中,G(n)为耗散函数,表示从起点到节点n的实际路径代价(距离);
H(n)是有可能生成路径的启发函数,表示节点n到目标点的最佳路 径估计代价,采用欧式距离表示:
F(n)是生成的路径评价函数,表示通过节点n从起点到达目标点的 路径代价;
x表示当前节点与目标节点x轴的差值;y表示当前节点与目标节点y 轴差值;z表示当前节点与目标节点z轴差值;
假设距离节点n最近的障碍点为On,其中d0为On与节点n的距离,w0为 距离障碍小于安全距离dmax时的惩罚系数。
请参考图2,图3,图4,所述步骤二中依次分段进行船舶室内立体路 径计算的具体步骤如下所示:
(1)初始化三维坐标,构建三维数组。三维数组为1代表实际位置有 障碍,为0代表无障碍;考虑到与障碍物安全半径,可做三维膨胀操作;
(2)创建open集(所有节点的集合)和close集(已遍历过的节点集 合)。将起点加入open集;
(3)选出open集中F最小的节点,判断其是否满足约束,满足则将 其移入到close集。否则在open集中删除该节点。然后重复操作3);
(4)判断当前移入点是否是终点,如是终点则查找完毕,获得初步路 径Pi。否则获取当前点下一步可到达的所有点;
(5)若(4)找到的点在open集中,若G比之前计算的小,则更新该 点数据。若不在,计算这些点的F、G、C值(即公式(4)中F(n)、G (n)及C(n)的值)并将这些点加入open集;
(6)跳转到步骤(3),直到当前移入的点为终点;
(7)定义初步路径的节点数为m个;改进平滑处理后的路径为Pp;
(8)判断Pi的节点是否小于等于m;是则执行下一步,否则将Pi上非N 节点赋值给Pp;
(9)获得第i个节点和第i+2个节点所在的线段li,i+2;
(10)判断线段li,i+2上是否存在障碍物若不存在,则执行下一步,否则 执行第(6)步;
(11)将Pi上第i+1个节点删除;
(12)设置当前节点为下一节点,转到(2);
(13)最终获得改进算法处理后所得的优化路径;
(14)对该路径进行B样条平滑算法处理,平滑处理时需要加入角度 约束,使其更加符合实际需要;
(15)获得处理后的优化路径。
该方法与一般常见的路径计算方法相比,更适合空间有限、无法进行 全三维建模的立体路径规划。
以上显示和描述了本发明的基本原理和主要特征及本发明的优点。本 行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和 说明书中描述的只是说明本发明的结构关系及原理,在不脱离本发明精神 和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入 要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其 等效物界定。
Claims (4)
1.一种面向船舶应用的立体路径计算方法,其特征在于,包括如下步骤:
步骤一:通过坐标转换矩阵,将船舶室内路径的二维坐标进行转换得到船舶室内路径的三维坐标;
步骤二:基于步骤一中得到的船舶室内路径的三维坐标和改进的A*算法,依次分段进行船舶室内立体路径计算,所述步骤二中改进的A*算法表达式为:
F(n)=G(n)+H(n)+Risk(n) (4)
其中,G(n)为耗散函数,表示从起点到节点n的实际路径代价;
H(n)是有可能生成路径的启发函数,表示节点n到目标点的最佳路径估计代价,采用欧式距离表示:
F(n)是生成的路径评价函数,表示通过节点n从起点到达目标点的路径代价;
x表示当前节点与目标节点x轴的差值;y表示当前节点与目标节点y轴差值;z表示当前节点与目标节点z轴差值;
假设距离节点n最近的障碍点为On,其中d0为On与节点n的距离,w0为距离障碍小于安全距离dmax时的惩罚系数;
步骤三:将根据改进的A*算法计算后的路径,进行计算,通过路径参数设置转换为CZML数据格式;
步骤四:转换后的CZML数据再通过三维插件进行加载和渲染;最后在地图上可视化呈现三维路径。
3.根据权利要求1所述的面向船舶应用的立体路径计算方法,其特征在于:所述步骤二中依次分段进行船舶室内立体路径计算的具体步骤如下所示:
(1)初始化三维坐标,构建三维数组;三维数组为1代表实际位置有障碍,为0代表无障碍;考虑到与障碍物安全半径,可做三维膨胀操作;
(2)创建open集和close集;将起点加入open集;
(3)选出open集中F最小的节点,判断其是否满足约束,满足则将其移入到close集;否则在open集中删除该节点;然后重复操作(3);
(4)判断当前移入点是否是终点,如是终点则查找完毕,获得初步路径Pi;否则获取当前点下一步可到达的所有点;
(5)若(4)找到的点在open集中,若G比之前计算的小,则更新该点数据;若不在,计算这些点的F、G、H值并将这些点加入open集,F、G、H即公式(4)中F(n)、G(n)及H(n)的值;
(6)跳转到步骤(3),直到当前移入的点为终点;
(7)定义初步路径的节点数为m个;改进平滑处理后的路径为Pp;
(8)判断Pi的节点是否小于等于m;是则执行下一步,否则将Pi上非N节点赋值给Pp;
(9)获得第i个节点和第i+2个节点所在的线段li,i+2;
(10)判断线段li,i+2上是否存在障碍物若不存在,则执行下一步,否则执行第(6)步;
(11)将Pi上第i+1个节点删除;
(12)设置当前节点为下一节点,转到(2);
(13)最终获得改进算法处理后所得的优化路径;
(14)对该路径进行B样条平滑算法处理,平滑处理时需要加入角度约束,使其更加符合实际需要;
(15)获得处理后的优化路径。
4.根据权利要求1所述的面向船舶应用的立体路径计算方法,其特征在于:所述步骤三中路径参数包括时间速率、路径材质、路径宽度及路径指示方向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011388530.XA CN112509132B (zh) | 2020-12-01 | 2020-12-01 | 一种面向船舶应用的立体路径计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011388530.XA CN112509132B (zh) | 2020-12-01 | 2020-12-01 | 一种面向船舶应用的立体路径计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112509132A CN112509132A (zh) | 2021-03-16 |
CN112509132B true CN112509132B (zh) | 2022-10-11 |
Family
ID=74969436
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011388530.XA Active CN112509132B (zh) | 2020-12-01 | 2020-12-01 | 一种面向船舶应用的立体路径计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112509132B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113963089B (zh) * | 2021-12-23 | 2022-05-03 | 朗坤智慧科技股份有限公司 | 一种基于a*算法的三维空间疏散模拟方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20090068518A (ko) * | 2007-12-24 | 2009-06-29 | 삼성중공업 주식회사 | 선박 화물창 벽면주행 이동로봇의 경로 계획방법 |
CN104699899A (zh) * | 2015-03-09 | 2015-06-10 | 天津大学 | 一种船舶管路路径优化设计方法 |
CN108204814A (zh) * | 2016-12-20 | 2018-06-26 | 南京理工大学 | 无人机三维场景路径导航平台及其三维改进路径规划方法 |
CN109374005A (zh) * | 2018-12-04 | 2019-02-22 | 中国舰船研究设计中心 | 一种基于船舶vr模型的船舶内部路径规划方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20190184561A1 (en) * | 2017-12-15 | 2019-06-20 | The Regents Of The University Of California | Machine Learning based Fixed-Time Optimal Path Generation |
-
2020
- 2020-12-01 CN CN202011388530.XA patent/CN112509132B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20090068518A (ko) * | 2007-12-24 | 2009-06-29 | 삼성중공업 주식회사 | 선박 화물창 벽면주행 이동로봇의 경로 계획방법 |
CN104699899A (zh) * | 2015-03-09 | 2015-06-10 | 天津大学 | 一种船舶管路路径优化设计方法 |
CN108204814A (zh) * | 2016-12-20 | 2018-06-26 | 南京理工大学 | 无人机三维场景路径导航平台及其三维改进路径规划方法 |
CN109374005A (zh) * | 2018-12-04 | 2019-02-22 | 中国舰船研究设计中心 | 一种基于船舶vr模型的船舶内部路径规划方法 |
Non-Patent Citations (5)
Title |
---|
2.5D Navigation Graph and Improved A-star Algorithm for Path Planning in Ship Inside Virtual Environment;Wei Xie等;《2020 Prognostics and Health Management Conference》;20200712;第295-299页 * |
基于操控行为和A~*算法的船舶人员疏散仿真;郭磊等;《大连海事大学学报》;20170515(第02期);第8-12页 * |
基于改进A~*算法的水面无人船全局路径规划;高峰等;《计算机应用研究》;20200630;第120-125页 * |
基于改进A~*算法的水面无人艇路径规划;随博文等;《舰船科学技术》;20191208(第23期);第132-166页 * |
海上风电场区船舶A~*避碰寻路算法;薛双飞等;《中国航海》;20180625(第02期);第21-25页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112509132A (zh) | 2021-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111060109B (zh) | 一种基于改进a星算法的无人艇全局路径规划方法 | |
CN110487279B (zh) | 一种基于改进a*算法的路径规划方法 | |
CN112179351B (zh) | 一种基于预规划路径优化rrt算法的三维避障航迹规划方法 | |
CN110260867B (zh) | 一种机器人导航中位姿确定、纠正的方法、设备及装置 | |
CN108958282B (zh) | 基于动态球形窗口的三维空间路径规划方法 | |
KR100634537B1 (ko) | 3차원 영상의 삼각 분할 장치 및 방법과 그 장치를제어하는 컴퓨터 프로그램을 저장하는 컴퓨터로 읽을 수있는 기록 매체 | |
CN105043382B (zh) | 无人机巡航方法及装置 | |
CN104897160A (zh) | 一种制作室内地图和定位的方法及装置 | |
CN113570664B (zh) | 增强现实导航显示方法和装置、电子设备、计算机介质 | |
CN110232741A (zh) | 多层包围盒确定方法、碰撞检测及运动控制方法与设备 | |
JP6810432B2 (ja) | 物体の条件に応じてモードを切り換えることができるcnn基盤で軍事目的、スマートフォン又は仮想走行に使用される疑似3dバウンディングボックスを検出する方法及びこれを利用した装置 | |
CN114740846A (zh) | 面向拓扑-栅格-度量混合地图的分层路径规划方法 | |
CN113189988B (zh) | 一种基于Harris算法与RRT算法复合的自主路径规划方法 | |
CN113296504A (zh) | 基于rgbd深度相机的移动机器人建图与路径规划方法 | |
CN108803659B (zh) | 基于魔方模型的多窗口启发式三维空间路径规划方法 | |
CN111161413A (zh) | 一种基于gis的三维虚拟机场平台的构建方法 | |
CN109374005B (zh) | 一种基于船舶vr模型的船舶内部路径规划方法 | |
CN112509132B (zh) | 一种面向船舶应用的立体路径计算方法 | |
CN115061499A (zh) | 无人机控制方法及无人机控制装置 | |
CN106931978B (zh) | 自动构建路网的室内地图生成的方法 | |
CN113936109A (zh) | 高精地图点云数据的处理方法、装置、设备以及存储介质 | |
CN113096251B (zh) | 基于cim的模型处理方法、装置、设备及存储介质 | |
CN111815684B (zh) | 基于统一残差模型的空间多元特征配准优化方法及装置 | |
CN112987720A (zh) | 一种用于移动机器人的多尺度地图构建方法及构建装置 | |
CN112379692B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |