专栏首页DHUtoBUAA基于电子海图的水面无人艇全局路径规划

基于电子海图的水面无人艇全局路径规划

Research and Implementation of Global Path Planning for Unmanned Surface Vehicle Based on Electronic Chart (基于电子海图的水面无人艇全局路径规划)

  该论文已经在ICMIR2017会议上发表,附上springer的文献地址 Research and Implementation of Global Path Planning for Unmanned Surface Vehicle Based on Electronic Chart,以及arXiv上的 文献地址。本文接下来主要对论文的实现原理进行分析,在最后给出程序代码,方便后来者研究和参考。

摘要

  水面无人艇(Unmanned Surface Vehicles, USVs)是一种新型的水面智能载具,其中全局路径规划是USV研究的关键技术,它可以反映出USV的智能程度。为了解决USV的全局路径规划问题,本文基于电子海图提出航行代价寻优(sailing cost optimization)的改进A*算法。我们使用S-57电子海图实现八叉树网格的环境模型建立,并基于航行安全权重、引导量和路径曲线平滑处理,提出优化的A*算法来实现规划路径航行安全,减少规划时间,提高路径平滑度。仿真结果表明,环境建模方法和改进A*算法可以规划出安全合理的全局路径。

论文实现原理

  水面无人艇的全局路径规划,是指在存在障碍物的复杂环境下,给定起始点和目标点,根据任务要求自主规划出一条能够安全避开环境中静态障碍物的最优路径。   本文提出基于电子海图的USV全局路径规划方案,分为电子海图解析、全局环境模型建立和路径搜索算法三部分。通过解析电子海图文件,提取其中的海域地理信息及碍航物等信息,将海图信息渲染成为自主航路规划系统能够识别的信息模式,建立由可航行网格和不可航行网格组成的环境模型。在此基础上,本文综合考虑航行安全性、航行距离、路径平滑度等因素,采用基于航行代价寻优的改进A*算法来搜索环境模型中的最优路径,实现水面无人艇的全局航路自主规划,提高水面无人艇的自主决策能力和智能化水平。

  水面无人艇全局路径规划系统无法直接利用电子海图进行自主路径规划,所以需要研究矢量电子海图S-57数据结构,提取出全局路径规划需要的海洋环境信息,裁剪无关数据,将电子海图转换为全局航路规划系统能够直接使用的信息。其中,利用开源的TinyXML库保存到xml文件中,供路径规划系统的后续分析和处理。   在提取得到电子海图xml文件后,通过网格化的方法把感兴趣区域划分为若干块大小相等的矩形网格,然后利用Shapely开源地理库依次判断网格中是否存在从电子海图中解析的静态障碍物(如陆地、海岛、浅滩),从而将网格环境地图划分为可航区域和不可航区域。   在实现环境建模后,全局路径搜索算法优化的目标是在确保航行安全性的前提下,尽可能使规划的路径航行代价最小,最大程度地减小与最短路径、最小航行代价无关的计算量。其中,Hart等使用启发式函数来评估从初始点到目标点的代价,在Dijkstra算法基础上,结合启发式函数形成新的路径搜索策略--A*算法,通过减少搜索空间来提高搜索效率,所以更适合网格情形下的全局路径规划。本文对传统的A*算法进行改进,实现全局路径的初步搜索。   网格环境下,如果直接把A*算法搜索得到的节点顺序连接起来作为水面无人艇的全局规划路径,通常会出现阶梯或者锯齿状路径的情况,很明显规划的路径并不是两点间的期望路径。所以,本文提出去除多余航点的曲线平滑算法,在保证安全的前提下减少路径中不必要的航点,使多段折线化为直线,增加路径的光滑度,规划的路径会更加符合起止点之间的期望路径,符合水面无人艇的运动学特性。

实现程序

  因为程序是2017年4月份实现的,仍然不够完善,可能存在bug或者性能优化点,欢迎交流和改善。程序最新代码请参考本人github wylloong

电子海图解析

  S-57电子海图解析中,本文在之前文章中已经进行详细的分析和讲解,并给出源代码,可以参见 S57-Electronic-Chart-Reading-and-Storing基于8211lib库对s57电子海图的解析和存储

建立环境模型

  该部分代码可详见github GlobalEnviStructWithSquare,如有需要请备份,可能后期会删除掉部分程序。

改进A*算法和路径平滑处理

  该部分代码可详见github GlobalPathPlanWithSquare,如有需要请备份,可能后期会删除掉部分程序。

程序示例

  程序示例数据集可在 github下载,对应程序的全局路径规划示意图如下所示:

本文参与腾讯云自媒体分享计划,欢迎正在阅读的你也加入,一起分享。

我来说两句

0 条评论
登录 后参与评论

相关文章

  • 基于电子海图的水面无人艇全局路径规划

      该论文已经在ICMIR2017会议上发表,附上springer的文献地址 Research and Implementation of Global Pat...

    waylon
  • 基于蚁群算法的机械臂打孔路径规划

    问题描述   该问题来源于参加某知名外企的校招面试。根据面试官描述,一块木板有数百个小孔(坐标已知),现在需要通过机械臂在木板上钻孔,要求对打孔路径进行规划,力...

    waylon
  • 基于蚁群算法的机械臂打孔路径规划

      该问题来源于参加某知名外企的校招面试。根据面试官描述,一块木板有数百个小孔(坐标已知),现在需要通过机械臂在木板上钻孔,要求对打孔路径进行规划,力求使打孔总...

    waylon
  • 基于电子海图的水面无人艇全局路径规划

      该论文已经在ICMIR2017会议上发表,附上springer的文献地址 Research and Implementation of Global Pat...

    waylon
  • 安装anaconda

    JNingWei
  • 解决 GNS3保存的工程不能正常运行问题

        今天想打开以前保存好的工程复习下实验时,发觉GNS3不让俺正常的运行,真是郁闷。。

    py3study
  • 浅谈高性能数据库集群 —— 分库分表

    最近学习了阿里资深技术专家李运华的架构设计关于分库分表的教程,颇有收获,总结一下。

    芋道源码
  • 013 仓储物流自动化行业里的“品质感”

    喜欢数码产品的朋友经常谈论各个品牌的手机,电脑,pad外设等,经常会谈到什么手机外观设计等等。同样的,在汽车领域,各位车友,车迷门也经常谈论这些。每年一度的苹果...

    老King
  • linux的简单介绍以及常用简单命令

    例如:需要让张三同学帮忙去楼下小卖铺买一瓶农夫山泉水和清风餐巾纸,在这个指令中“买东西”是指令的主体,买的水和餐巾纸是操作的对象,农夫山泉、清风是操作的选项。|

    踏浪
  • 让你的Excel表动起来!!!

    本次是第二次分享广大网友向我提问的经典问题。 本周问题,利用名称管理器完成二维表的匹配返回!让你的表格动起来! 话说!本次解决方案相对复杂,能看明白并且自己会...

    用户1332619

扫码关注云+社区

领取腾讯云代金券