一种基于自适应网格的快速航路规划方法及系统与流程

摘要: 本申请涉及海洋航行、数据处理,尤其涉及一种基于自适应网格的快速航路规划方法及系统。背景技术:1、目前,在舰船航路规划领域,现有的技术方案主要依赖于传统的环境建模...
一种基于自适应网格的快速航路规划方法及系统与流程

本申请涉及海洋航行、数据处理,尤其涉及一种基于自适应网格的快速航路规划方法及系统。

背景技术:

1、目前,在舰船航路规划领域,现有的技术方案主要依赖于传统的环境建模与路径搜索算法,具体的例如基于几何图元近似与直线碰撞检测的避障方法,该方法侧重于障碍物建模与碰撞判断,常用于无人水面艇(usv)的路径规划中。xing b, yu m, liu z, etal. a review of path planning for unmanned surface vehicles[j]. journal ofmarine science and engineering, 2023, 11(8): 1556.(亦可见相关混合规划方法:xud, wang h, zhang w, et al. hybrid path planning method for usv usingbidirectional a* and dynamic window approach[j]. ocean engineering, 2024,298: 117234.)功能与实现过程:障碍物简化: 将不规则的岛屿、禁航区等障碍区域近似为圆形包围盒(bounding circle)或多边形简化处理。对于圆形障碍,记录其圆心坐标与安全半径。碰撞检测: 在路径搜索的邻域扩展环节,引入直线相交判断逻辑。对于规划路径中的每一条线段,计算其与障碍物圆心之间的几何距离。安全性判定: 若线段与圆心的距离小于安全半径,则判定为碰撞,该路径不可行。

2、该方法实现简单,计算速度较快。然而,圆形近似在处理不规则海岸线或复杂障碍区时往往引入过度保守的安全裕度,导致原本可行的狭窄通道被误判为禁区;且纯几何碰撞检测难以应对多障碍源重叠区域的内部障碍评估,限制了规划算法在复杂环境中的可靠性与适应性。

3、现有技术海洋环境通常具有“大范围空旷、局部障碍密集”的特点,均匀网格无法实现计算资源的按需分配。由于网格大小在整个规划区域内保持一致,若为了保证对狭窄通道或复杂海岸线的表达精度而采用细粒度网格,会导致空旷海域的节点数量激增,严重影响规划效率。

4、采用圆形包围盒(bounding circle)来近似岛屿、禁航区等不规则障碍。由于圆形几何特性的限制,其在覆盖不规则多边形或复杂海岸线时,必然会在障碍边缘引入额外的空白区域(即过度保守的安全裕度)。过度保守的建模方式会将原本存在的可行狭窄通道误判为禁区(虚假障碍),迫使舰船进行大幅度绕行。根据实验数据,在复杂几何与局部狭窄通道条件下,该方法导致的路径长度劣化可达20%–25%。

技术实现思路

1、本申请实施例提供一种基于自适应网格的快速航路规划方法及系统,用以克服现有技术中存在的计算效率与感知精度难以兼顾、障碍物建模过度保守导致路径次优以及规划实时性不稳定等缺陷。

2、本申请实施例提供一种基于自适应网格的快速航路规划方法,包括:

3、获取目标海洋环境所有障碍能力体的位置坐标与辐射范围数据,并构建空间外围边界;

4、在所述空间外围边界的框定区域内,通过指定的分割点将区域分割为若干个基座网格;

5、基于划分的基座网格,建立混合数据结构进行存储,其中存储采用树状层次结构与扁平数值表相结合的方式;

6、基于基座网格将网格抽象为节点,根据期望的起点和终点,初始化改进的a星路径搜索算法,初始化的内容包括节点开放列表和节点关闭列表,并定义代价函数;

7、引入基于四叉树的层级射线碰撞检测改进a星路径搜索过程,从开放列表中选择使得代价函数的值最小的节点作为当前节点的扩展节点;

8、对扩展节点进行筛选和验证后,根据a星路径搜索算法搜索到达终点,通过回溯父节点生成初始路径。

9、本申请实施例提供一种基于自适应网格的快速航路规划系统,包括处理器和存储器,所述存储器上存储有计算机程序,所述计算机程序被处理器执行时实现如前述的方法的步骤。

10、本申请实施例通过自适应空间离散化技术,实现计算资源的按需分配。构建重点区域高精度、普通区域低精度的多尺度环境模型,在保证关键障碍区域表达精度的同时,大幅降低空旷海域的节点数量与计算负载,解决大规模场景下搜索效率低的难题。

11、上述说明仅是本申请技术方案的概述,为了能够更清楚了解本申请的技术手段,而可依照说明书的内容予以实施,并且为了让本申请的上述和其它目的、特征和优点能够更明显易懂,以下特举本申请的具体实施方式。

1.一种基于自适应网格的快速航路规划方法,其特征在于,包括:

2.如权利要求1所述的基于自适应网格的快速航路规划方法,其特征在于,构建空间外围边界包括:

3.如权利要求1所述的基于自适应网格的快速航路规划方法,其特征在于,分割为若干个基座网格之后还包括对覆盖的基座网格进行网格细化:

4.如权利要求3所述的基于自适应网格的快速航路规划方法,其特征在于,建立混合数据结构进行存储其中:

5.如权利要求1所述的基于自适应网格的快速航路规划方法,其特征在于,根据期望的起点和终点,初始化改进的a星路径搜索算法包括:

6.如权利要求5所述的基于自适应网格的快速航路规划方法,其特征在于,从开放列表中选择使得代价函数的值最小的节点作为当前节点的扩展节点包括:

7.如权利要求6所述的基于自适应网格的快速航路规划方法,其特征在于,对候选边进行可通行性验证包括:

8.如权利要求7所述的基于自适应网格的快速航路规划方法,其特征在于,对每个基座网格单元调用递归检查函数进行碰撞检测包括:

9.如权利要求8所述的基于自适应网格的快速航路规划方法,其特征在于,在碰撞检测过程中,引入子网格采样与面积加权方法,按相交面积比例计算边界网格的等效障碍值,并以双精度微小容差进行如下边界修正:

10.一种基于自适应网格的快速航路规划系统,其特征在于,包括处理器和存储器,所述存储器上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至9中任一项所述的方法的步骤。