CN112799069B - 一种基于航海雷达图像的冰区航行海冰避障路径生成方法 - Google Patents
一种基于航海雷达图像的冰区航行海冰避障路径生成方法 Download PDFInfo
- Publication number
- CN112799069B CN112799069B CN202011608109.5A CN202011608109A CN112799069B CN 112799069 B CN112799069 B CN 112799069B CN 202011608109 A CN202011608109 A CN 202011608109A CN 112799069 B CN112799069 B CN 112799069B
- Authority
- CN
- China
- Prior art keywords
- ice
- navigation
- path
- area
- point
- 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
- 238000000034 method Methods 0.000 title claims abstract description 27
- 230000002457 bidirectional effect Effects 0.000 claims abstract description 9
- 238000012360 testing method Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000013459 approach Methods 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims description 3
- 230000007547 defect Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 abstract description 2
- 238000005259 measurement Methods 0.000 abstract 1
- 238000001514 detection method Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/937—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of marine craft
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Ocean & Marine Engineering (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种基于航海雷达图像的冰区航行海冰避障路径生成方法,该方法通过航海雷达图像,识别本船船位、短期目标位置及海冰碍航区域,重构冰区航行场景;结合双向快速扩展随机树B‑RRT算法与贪心算法,生成较为简捷的路径,提出一种小尺度的海冰避障路径生成方法。相较于采用海冰模型或冰图进行大尺度冰区水域航行的航路设计,冰区水域的气象与海况变化莫测,尚需小尺度的海冰避障路径进行辅助决策支持。由于小尺度冰区航行决策时间有限,本发明提出的方法具有随机性,可以在短时间内快速生成多条路径,再藉由路径风险指数评估与选择风险较低的海冰避障路径,为冰区航行辅助决策提供技术支撑。
Description
技术领域:
本发明涉及极地冰区航行海冰避障领域,具体地说,是一种基于航海雷达图像的冰区航行海冰避障路径生成方法。
背景技术:
近年来随著船舶在极地水域航行的需求不断提高,路径规划与海冰避障已成为极地航行重要的研究课题。在冰区航行过程中,除了使用探照灯、望远镜等设备进行传统瞭望避障外,航海雷达(marine radar)也是一种重要的探冰工具,可视为航行员的第二双眼睛。在《极地水域船舶航行安全规则(Polar Code)》中明确指出,应积极使用配备增强探冰能力的雷达;另外,在中国船级社出版的《极地水域操作手册编写指南》中,也提到虽然在不同海况和天气条件下,雷达探测不同特征浮冰块的能力存在一定局限性,但其仍是目前探测冰目标的最有效设备。即使从普通的航海雷达上无法得知海冰的厚度与结构,但仍可获得本船周围的实时海冰覆盖情况。因此,在海冰避障与路径优化上,航海雷达是值得善用的航海仪器。
国内外研究在冰区航行路径规划上,大多通过海冰模型或冰图作为数据来源进行航路设计,本质上属于大尺度路径规划。不同于上述大尺度的路径规划方法,本发明使用雷达图像作为海冰数据来源,提出小尺度海冰避障路径规划方法。由于空间范围小,对算法计算时间的要求更高,目前国内外航海技术中,仍缺乏一套快速进行冰区航行海冰避障路径生成的方法。
发明内容:
为了在冰区小尺度范围下,生成海冰避障路径作为航行员参考,本发明提出一种基于航海雷达图像的冰区航行海冰避障路径生成方法。本发明采取的技术方案为:通过航海雷达图像进行航行场景重构识别本船船位、短期目标位置及海冰碍航区域;结合双向快速扩展随机树B-RRT算法与贪心算法,提出一种小尺度的海冰避障路径生成方法;提出路径风险指数,评估与选择风险较低的海冰避障路径,为冰区航行辅助决策提供技术支撑。
为了实现以上目的,本发明一种基于航海雷达图像的冰区航行海冰避障路径生成方法包括以下步骤:
步骤一:冰区航行场景重构。
步骤1.1:读取航海雷达图像,根据所设定的画面每秒传输帧数(FPS),从航海雷达视频撷取特定时点的图像。
步骤1.2:获取关键信息,从图像上获取航海雷达的显示模式、显示方向、选定的距离标尺、距离刻度圈的间距、船首向、对水航速、对地航向、对地航速及计画航路。
步骤1.3:撷取圆形显示区,航海雷达图像的圆形显示区为主要表征冰区航行场景的感兴趣区域(region of interest),将感兴趣区域以掩膜区域矩阵表示,该区域内数值设置为1,区域外数值设置为0。
步骤1.4:确认自身船位与目标位置,不论航海雷达选用偏心或非偏心的显示方式,自身船位皆为统一共同基准点(consistent common reference point),都是距离刻度圈的圆心;另外,从计画航路与方位刻度的交点及船首向判别短期目标位置;据此,可以读取自身船位与目标位置在雷达图像上的坐标。
步骤1.5:提取海冰与目标,将圆形显示区内根据目标回波的像素覆盖区域设置为白色,其他冗余信息的区域设置为黑色,获得海冰与目标的二值图像。
步骤二:冰区避障路径生成。
步骤2.1:使用双向快速扩展随机树(B-RRT)算法生成路径,将本船船位视为起点,将计画航路上的短期目标位置视为终点,将海冰与不明目标区域视为碍航区域,从起点与终点同时向位形空间中新增顶点,快速生成路径。
步骤2.2:使用贪心算法去除冗余点,改善双向快速扩展随机树容易产生冗余顶点的缺点。
步骤2.3:依据船舶航速,生成适当数量的路径方案;相同航行距离下,船舶航速越快,避障路径的决策时间越有限,航行员可以自行设定生成路径方案个数的阈值。
步骤三:冰区避障路径选择。
步骤3.1:计算路径风险指数,一条路径是由数个转向点所组成,在转向点Xi与转向点Xi+1之间有一航段Sj+1,在航段Sj+1上,设定数个间隔相等的基准点,以每个基准点为中心建立一个正方形测试框,标记出在测试框内的海冰边界像素,计算各个海冰边界像素与该基准点之间的距离;比较各个基准点,找寻在该航段中,最接近点的距离DCPj+1及包含最接近点的该块海冰面积Areaj+1,通过下式将各个航段的风险数值加总后,可获得整条路径的风险数值,风险数值越大代表该条路径越危险;
其中,RRI:路径风险指数;Areaj:J航段上,最接近点的该块海冰面积;DCPj:J航段上,最接近点的距离。
步骤3.2:选择路径,比较所有生成的路径方案,挑选风险指数最小的路径作为推荐路径。
附图说明:
图1为本发明基于航海雷达图像的冰区航行海冰避障路径生成方法的流程图;
图2为本发明基于航海雷达图像的冰区航行海冰避障路径生成方法的航行场景重构示意图;
图3为本发明基于航海雷达图像的冰区航行海冰避障路径生成方法的快速扩展随机树示意图;
图4为本发明基于航海雷达图像的冰区航行海冰避障路径生成方法的贪心算法示意图;
图5为本发明基于航海雷达图像的冰区航行海冰避障路径生成方法的路径风险指数示意图。
具体实施方式:
以下结合附图,进一步说明本发明的具体实施方式。如图1所示,本发明公开一种基于航海雷达图像的冰区航行海冰避障路径生成方法,包含冰区航行场景重构、冰区避障路径生成、冰区避障路径选择三步骤,具体说明如下:
步骤一:冰区航行场景重构。
步骤1.1:读取航海雷达图像,根据所设定的画面每秒传输帧数(FPS),从航海雷达视频撷取特定时点的图像。
步骤1.2:获取关键信息,从图像上获取航海雷达的显示模式、显示方向、选定的距离标尺、距离刻度圈的间距、船首向、对水航速、对地航向、对地航速及计画航路。
步骤1.3:撷取圆形显示区,航海雷达图像的圆形显示区为主要表征冰区航行场景的感兴趣区域(region of interest),将感兴趣区域以掩膜区域矩阵表示,该区域内数值设置为1,区域外数值设置为0。将原始图像的高维矩阵乘以掩膜区域矩阵,即可撷取圆形显示区的图像,滤除其他区域的冗余信息。
步骤1.4:确认自身船位与目标位置,不论航海雷达选用偏心或非偏心的显示方式,自身船位皆为统一共同基准点(consistent common reference point),都是距离刻度圈的圆心;另外,从计画航路与方位刻度的交点及船首向判别短期目标位置;据此,可以读取自身船位与目标位置在雷达图像上的坐标。
步骤1.5:提取海冰与目标,将圆形显示区内根据目标回波的像素覆盖区域设置为白色,其他冗余信息的区域设置为黑色,获得海冰与目标的二值图像,如图2所示。
步骤二:冰区避障路径生成。
步骤2.1:使用双向快速扩展随机树(B-RRT)算法生成路径,将本船船位视为起点,将计画航路上的短期目标位置视为终点,将海冰与不明目标区域视为碍航区域,从起点与终点同时向位形空间中新增顶点,快速生成路径。快速扩展随机树(RRT)算法的基本思路如图3所示:在位形空间内随机产生一个点,即随机顶点(qrand),有一半概率使用终点(qgoal)作为随机顶点;在所有顶点内,找寻距离随机顶点最近的顶点,即最近顶点(qnear),在一开始时,起点(qinit)即为最近顶点;使用避碰检测函数判断最近顶点与随机顶点之间是否有障碍物,在没有障碍物的情况下,从最近顶点往随机顶点的方向上,使用预设的步长(Δq)增加一个顶点,即新增顶点(qnew);据此,在快速扩展随机树(RRT)上,增加顶点与边;当新增顶点与终点间的距离小于设定阈值,或最近顶点与新增顶点之间包含终点时,表示已经可以获得路径。以快速扩展随机树(RRT)为基础,双向快速扩展随机树(B-RRT)从起点与终点同时向位形空间中新增顶点,可以更快速获得路径。
步骤2.2:使用贪心算法去除冗余点,改善双向快速扩展随机树容易产生冗余顶点的缺点。采用预设步长(step size)新增顶点的做法,快速扩展随机树(RRT)及双向快速扩展随机树(B-RRT)都容易产生冗余顶点。为了改善这个缺点,本发明结合贪心算法,其基本思路如图4所示:原始路径显示为虚线,从起点(qinit)开始,依序对原路径上的各个顶点进行碰撞检测,即该顶点与终点(qgoal)的连线是否通过障碍物,将首个能够通过检测的顶点,记录为新路径的第一个顶点(q1′);将该顶点视为新终点,若起点与新终点(q1′)的连线通过障碍物,则再从起点开始,依序对起点到新终点间原路径上的各个顶点进行检测,直到起点与最后一个新路径顶点的连线未通过障碍物。据此,可获得经过贪心算法去除冗余顶点的新路径,显示为实线。
步骤2.3:依据船舶航速,生成适当数量的路径方案;相同航行距离下,船舶航速越快,避障路径的决策时间越有限,航行员可以自行设定生成路径方案个数的阈值。
步骤三:冰区避障路径选择。
步骤3.1:计算路径风险指数,一条路径是由数个转向点所组成,如图5所示,在转向点Xi与转向点Xi+1之间有一航段Sj+1,在航段Sj+1上,设定数个间隔相等的基准点,以每个基准点为中心建立一个正方形测试框,标记出在测试框内的海冰边界像素,计算各个海冰边界像素与该基准点之间的距离;比较各个基准点,找寻在该航段中,最接近点的距离DCPj+1及包含最接近点的该块海冰面积Areaj+1,通过下式将各个航段的风险数值加总后,可获得整条路径的风险数值,风险数值越大代表该条路径越危险;
其中,RRI:路径风险指数;Areaj:J航段上,最接近点的该块海冰面积;DCPj:J航段上,最接近点的距离。
步骤3.2:选择路径,比较所有生成的路径方案,挑选风险指数最小的路径作为推荐路径。
Claims (1)
1.一种基于航海雷达图像的冰区航行海冰避障路径生成方法,其特征在于包括以下步骤:
步骤一:冰区航行场景重构;
步骤1.1:读取航海雷达图像,根据所设定的画面每秒传输帧数FPS,从航海雷达视频撷取特定时点的图像;
步骤1.2:获取关键信息,从图像上获取航海雷达的显示模式、显示方向、选定的距离标尺、距离刻度圈的间距、船首向、对水航速、对地航向、对地航速及计画航路;
步骤1.3:撷取圆形显示区,航海雷达图像的圆形显示区为主要表征冰区航行场景的感兴趣区域,将感兴趣区域以掩膜区域矩阵表示,区域内数值设置为1,区域外数值设置为0;
步骤1.4:确认自身船位与目标位置,不论航海雷达选用偏心或非偏心的显示方式,自身船位皆为统一共同基准点,都是距离刻度圈的圆心;另外,从计画航路与方位刻度的交点及船首向判别短期目标位置;据此,可以读取自身船位与目标位置在雷达图像上的坐标;
步骤1.5:提取海冰与目标,将圆形显示区内根据目标回波的像素覆盖区域设置为黑色,其他冗余信息的区域设置为白色,获得海冰与目标的二值图像;
步骤二:冰区避障路径生成;
步骤2.1:使用双向快速扩展随机树B-RRT算法生成路径,将本船船位视为起点,将计画航路上的短期目标位置视为终点,将海冰与不明目标区域视为碍航区域,从起点与终点同时向位形空间中新增顶点,快速生成路径;
步骤2.2:使用贪心算法去除冗余点,改善双向快速扩展随机树容易产生冗余顶点的缺点;
步骤2.3:依据船舶航速,生成适当数量的路径方案;相同航行距离下,船舶航速越快,避障路径的决策时间越有限,航行员可以自行设定生成路径方案个数的阈值;
步骤三:冰区避障路径选择;
步骤3.1:计算路径风险指数,一条路径是由数个转向点所组成,在转向点Xi与转向点Xi+1之间有一航段Sj+1,在航段Sj+1上,设定数个间隔相等的基准点,以每个基准点为中心建立一个正方形测试框,标记出在测试框内的海冰边界像素,计算各个海冰边界像素与该基准点之间的距离;比较各个基准点,找寻在该航段中,最接近点的距离DCPj+1及包含最接近点的该块海冰面积Areaj+1,通过下式将各个航段的风险数值加总后,可获得整条路径的风险数值,风险数值越大代表该条路径越危险;
其中,RRI:路径风险指数;Areaj:J航段上,最接近点的该块海冰面积;DCPj:J航段上,最接近点的距离;
步骤3.2:选择路径,比较所有生成的路径方案,挑选风险指数最小的路径作为推荐路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011608109.5A CN112799069B (zh) | 2020-12-30 | 2020-12-30 | 一种基于航海雷达图像的冰区航行海冰避障路径生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011608109.5A CN112799069B (zh) | 2020-12-30 | 2020-12-30 | 一种基于航海雷达图像的冰区航行海冰避障路径生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112799069A CN112799069A (zh) | 2021-05-14 |
CN112799069B true CN112799069B (zh) | 2024-02-13 |
Family
ID=75804368
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011608109.5A Active CN112799069B (zh) | 2020-12-30 | 2020-12-30 | 一种基于航海雷达图像的冰区航行海冰避障路径生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112799069B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111752281A (zh) * | 2020-07-13 | 2020-10-09 | 浪潮软件股份有限公司 | 基于改进rrt算法的移动机器人路径规划方法及*** |
CN114217637B (zh) * | 2021-12-03 | 2023-05-09 | 北京理工大学 | 一种环境自适应巡航飞艇控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1364507A (en) * | 1970-11-12 | 1974-08-21 | Sperry Rand Corp | Colision avoidance apparatus |
JP2005061893A (ja) * | 2003-08-08 | 2005-03-10 | Toshima Imazu | 船舶航行支援装置 |
CN109459031A (zh) * | 2018-12-05 | 2019-03-12 | 智灵飞(北京)科技有限公司 | 一种基于贪心算法的无人机rrt路径优化方法 |
CN110220514A (zh) * | 2019-05-27 | 2019-09-10 | 中国电子科技集团公司第二十八研究所 | 一种基于海图数据的动态航线生成方法 |
CN110440804A (zh) * | 2019-08-02 | 2019-11-12 | 上海海事大学 | 适用于极地冰区航行的智能导航方法 |
CN110515094A (zh) * | 2019-07-11 | 2019-11-29 | 同济大学 | 基于改进rrt*的机器人点云地图路径规划方法及*** |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012162310A1 (en) * | 2011-05-23 | 2012-11-29 | Ion Geophysical Corporation | Marine threat monitoring and defense system |
-
2020
- 2020-12-30 CN CN202011608109.5A patent/CN112799069B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1364507A (en) * | 1970-11-12 | 1974-08-21 | Sperry Rand Corp | Colision avoidance apparatus |
JP2005061893A (ja) * | 2003-08-08 | 2005-03-10 | Toshima Imazu | 船舶航行支援装置 |
CN109459031A (zh) * | 2018-12-05 | 2019-03-12 | 智灵飞(北京)科技有限公司 | 一种基于贪心算法的无人机rrt路径优化方法 |
CN110220514A (zh) * | 2019-05-27 | 2019-09-10 | 中国电子科技集团公司第二十八研究所 | 一种基于海图数据的动态航线生成方法 |
CN110515094A (zh) * | 2019-07-11 | 2019-11-29 | 同济大学 | 基于改进rrt*的机器人点云地图路径规划方法及*** |
CN110440804A (zh) * | 2019-08-02 | 2019-11-12 | 上海海事大学 | 适用于极地冰区航行的智能导航方法 |
Non-Patent Citations (2)
Title |
---|
基于改进蚁群算法的船舶冰区航行路径规划;童帮裕;胡坚堃;;中国航海(01);全文 * |
复杂水域环境中无人艇航行规划方法研究;李跃芳;邵光明;武智强;苑茹滨;;中国造船(S1);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112799069A (zh) | 2021-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110309383B (zh) | 基于改进的dbscan算法的船舶轨迹聚类分析方法 | |
CN112799069B (zh) | 一种基于航海雷达图像的冰区航行海冰避障路径生成方法 | |
CN113601536B (zh) | 一种配网车载智能巡检机器人***及方法 | |
CN105184816A (zh) | 基于usv的视觉检测和水面目标追踪***及其检测追踪方法 | |
CN112884760A (zh) | 近水桥梁多类型病害智能检测方法与无人船设备 | |
CN107132530A (zh) | 天/空/船艇/浮标/岛礁基海域多传感器一体监测*** | |
CN109213204B (zh) | 基于数据驱动的auv海底目标搜寻航行***及方法 | |
CN104535066A (zh) | 一种船载红外视频图像中的海上目标与电子海图的叠加方法及*** | |
CN115060264A (zh) | 一种基于ais数据的prm航线规划方法 | |
CN111723632B (zh) | 一种基于孪生网络的船舶跟踪方法及*** | |
CN103398710A (zh) | 一种夜雾天况下的舰船进出港导航***及其构建方法 | |
CN105741234A (zh) | 基于三维全景环视的无人艇自动锚泊视觉辅助*** | |
CN111292360A (zh) | 一种用于船舶行驶航线推荐方法及*** | |
Naus et al. | Precision in determining ship position using the method of comparing an omnidirectional map to a visual shoreline image | |
CN104992172A (zh) | 一种基于沿岸突异区扫描的港口遥感图像靠岸船舶检测方法 | |
Hsieh et al. | Sea ice warning visualization and path planning for ice navigation based on radar image recognition | |
CN110751077A (zh) | 一种基于部件匹配与距离约束的光学遥感图片船舶检测方法 | |
CN107527331B (zh) | 基于双冒泡法的极地冰山遥感识别方法 | |
CN113805178A (zh) | 一种水面静态碍航物探测方法 | |
JP5152913B2 (ja) | 洋上監視システムおよび方法 | |
CN116453276A (zh) | 一种海上风电电子围栏监控预警方法和*** | |
CN109164412A (zh) | 一种基于信标识别的辅助定位方法 | |
Praczyk et al. | Concept and first results of optical navigational system | |
JP2018124198A (ja) | 受信機の適地判定方法、及び受信機の適地判定システム | |
CN113432594A (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 |