一种基于可视图建模的航迹规划方法与流程

本发明涉及智能船舶控制技术领域,尤其涉及一种基于可视图建模的航迹规划方法。

背景技术：

船舶航迹规划是指船舶能够根据航行环境在保证安全的前提下(避开各种动态或静态的碍航物)自主规划出一条路径最短的最优路径。航迹规划是基于环境建模的数据基础而来的，传统的航迹规划和环境建模是各自独立的，必须依靠数据完备的环境模型数据才能进行精准的航迹规划，这样不仅延长了算法执行时间且会生成许多冗余的环境模型数据。可视图建模是一种常用的环境建模方法，但在复杂的环境中，大量的可视边(可航线路段)的构建不仅增加了建模的难度且降低了航迹规划的精度，因此，仍有深度优化的必要。

技术实现要素：

(一)要解决的技术问题

为了解决现有技术的上述问题，本发明提供一种基于可视图建模的航迹规划方法。

(二)技术方案

为了达到上述目的，本发明实施例中提供一种基于可视图建模的航迹规划方法，包括：

步骤s1、获取航行环境信息，生成用于航迹规划的可视图，所述航行环境信息包括船舶的起点信息、目标点信息、障碍物信息、不可行航行区域信息，所述可视图包括起点、目标点，以及与障碍物和不可行航行区域对应的障碍图形；

步骤s2、连接起点和目标点，形成贯穿线；

步骤s3、获取与贯穿线相交的多个障碍图形，并获取所述多个障碍图形与贯穿线的距离最远的顶点，在贯穿线的一侧，依次连接起点、所有与贯穿线相交的障碍图形的顶点和目标点，形成一折线，位于贯穿线两侧的两条的折线围成一多边形区域；

步骤s4、去除可视图中所有与多边形区域不相交的障碍图形；

步骤s5、可视图中所有障碍图形的顶点构成可选的航路节点，基于所有可选的航路节点获取从起点到目标点的航时最短的最优航线。

可选的，步骤s5中基于所有可选的航路节点获取从起点到目标点的航时最短的最优航线的步骤包括：

步骤s50、创建第一列表和第二列表，所述第一列表用于存储起点、目标点和所有航路节点，所述第二列表用于存储最优航线的航路节点；

步骤s51、根据公式f(x)＝gn+hn计算第一列表中的所有航路节点对应的路径的总代价，以获取路径的总代价最小的航路节点，并将该航路节点设定为当前节点，其中，gn值表示从起点到航路节点的路径总耗时，hn值表示从航路节点到终点的路径总耗时；

步骤s52、判断步骤s51中获得的当前节点是否为目标点，如果是，执行步骤s57，如果否，执行步骤s53；

步骤s53、判断当前节点是否被访问过，如果是，执行步骤s55，如果否，执行步骤s54；

步骤s54、连接当前节点与上一航路节点，形成穿越线，所述上一航路节点与当前节点相邻，且在折线上位于靠近起点的一侧，如果该穿越线不在可视图中，将其作为可视边添加到可视图中，如果该穿越线在可视图中且不与障碍图形相交，更新当前节点的状态为被访问过，执行步骤s51；

步骤s55、连接当前节点与目标节点形成穿越线，如果该穿越线在可视图中或不与障碍图形相交，执行步骤s57，如果该穿越线不在可视图中，执行步骤s56；

步骤s56、将步骤s51中的当前节点添加到第二列表中，同时从第一列表中删除该当前节点，然后将与步骤s55中的穿越线相交的障碍图形中距离该穿越线两侧最远的顶点放入第一列表中，执行步骤s51；

步骤s57、将第二列表中的所有节点与可视边组成的连线输出，该连线即为最优航线。

可选的，在步骤s4之后，步骤s5之前，所述航迹规划方法还包括：

检测是否有相邻的两个障碍图形可融合，从起点到目标点的一侧，若可视图中相邻的两个障碍图形的中心的连线与贯穿线不相交，则对该相邻的两个障碍图形进行融合处理，形成新的障碍图形。

可选的，对相邻的两个障碍图形进行融合处理的步骤为：

在所述相邻的两个障碍图形的中心的连线的两侧做两个障碍图形的公切线，公切线与两个障碍图形的轮廓线围成的图形即为新的障碍图形，所述相邻的两个障碍图形位于所述新的障碍图形内。

(三)有益效果

本发明的有益效果是：

本发明在构建基础的环境模型的时候，通过采取删减无效障碍物、融合可定向融合障碍物等方法对模型进行深度优化，大幅度降低了模型的复杂度，减少了可视边的数量，避免了冗余的环境模型数据的产生，从而提高了后续路径规划算法的执行效率。

本发明将路径搜索与环境模型的构造的过程融合在一起，基于删减融合的可视图的骨架构造方法以及路径规划算法，在搜索最优路径的过程中同步生成可视图，不仅降低了模型架构的时间也提高了全局路径规划的效率。

本发明所构建的环境模型不会影响原路径规划算法的精度，保证了在提升算法执行效率的同时确保结果的安全性与经济性。

本发明的应用范围广，在广阔海域复杂海况的环境中具有常规路径规划算法无法比拟的优越性。

本发明灵活性较高，只要是通过节点探索策略进行路径规划的算法均适用于本发明的技术方案。

附图说明

图1为本发明实施例中基于可视图建模的航迹规划方法的流程图；

图2为根据航行环境信息，生成的用于航迹规划的可视图；

图3为去除不与贯穿线相交的障碍图形之后的可视图；

图4为对相邻的两个障碍图形进行融合处理之后的可视图；

图5为利用本发明的航迹规划算法获取最优航线后的可视图。

具体实施方式

为了更好的解释本发明，以便于理解，下面结合附图，通过具体实施方式，对本发明作详细描述。

在具体介绍本发明的技术方案之前，对本发明涉及的专业术语进行说明。

可视图建模是指在起始点以及航行环境中各障碍物的顶点之间，每两点进行可视化判断，若两点间无障碍物，则说明两点可视，则该两点间的连线称为可视边。

如图1所示，本发明实施例中提供一种基于动态可视图建模的航迹规划方法，包括：

步骤s1、获取航行环境信息，生成用于航迹规划的可视图，所述航行环境信息包括船舶的起点信息、目标点信息、障碍物信息、不可行航行区域信息，所述可视图包括起点、目标点，以及与障碍物和不可行航行区域对应的障碍图形；

步骤s2、连接起点和目标点，形成贯穿线；

步骤s3、获取与贯穿线相交的多个障碍图形，并获取所述多个障碍图形与贯穿线的距离最远的顶点，在贯穿线的一侧，依次连接起点、所有与贯穿线相交的障碍图形的顶点和目标点，形成一折线，位于贯穿线两侧的两条的折线围成一多边形区域；

步骤s4、去除可视图中所有与多边形区域不相交的障碍图形；

步骤s5、可视图中所有障碍图形的顶点构成可选的航路节点，基于所有可选的航路节点获取从起点到目标点的航时最短的最优航线。

上述技术方案通过简化用于航迹规划的可视图模型，通过航迹规划算法实时寻找效果最优的可视边，达到环境建模与路径规划同步进行的效果，大幅度提升了算法的执行效率，降低了建模用时以及路径规划用时，同时避免了冗余的环境模型的数据的生成。

其中，所述贯穿线具体可以为大圆航线，为从起点到目标点的最短连线，有利于实现航时最短的最优航线。

相邻两个航路节点之间的连线形成可视边，可视边与障碍图形不相交，所有可视边和障碍图形的侧边构成从起点到目标点的可航行路段。

为了进一步简化可视图，在步骤s4之后，步骤s5之前还包括：

检测是否有相邻的两个障碍图形可融合，从起点到目标点的一侧，若可视图中相邻的两个障碍图形的中心的连线与贯穿线不相交，则对该相邻的两个障碍图形进行融合处理，形成新的障碍图形。

上述步骤通过对中心连线位于贯穿线一侧的相邻两个障碍图形进行融合处理，进一步简化可视图，提升航迹规划算法的执行效率。

其中，对相邻的两个障碍图形进行融合处理的步骤具体可以为：

在所述相邻的两个障碍图形的中心的连线的两侧做两个障碍图形的公切线，公切线与两个障碍图形的轮廓线围成的图形即为新的障碍图形，所述相邻的两个障碍图形位于所述新的障碍图形内。

上述融合处理方法将相邻的两个障碍图形连通成一个障碍图形，进一步简化了可视图，而且通过做公切线能够使得新的障碍图形的面积最小，减小对航迹规划的影响。

需要说明的是，对相邻的两个障碍图形进行融合处理的方法并不局限于上述一种。

本实施例中，通过以下航迹规划算法来获取从起点到目标点的航时最短的最优航线，具体为：步骤s5中基于所有可视边、以及障碍图形的侧边获取从起点到目标点的航时最短的最优航线的步骤包括：

步骤s50、创建第一列表和第二列表，所述第一列表用于存储起点、目标点和所有航路节点，所述第二列表用于存储最优航线的航路节点；

步骤s51、根据公式f(x)＝gn+hn计算第一列表中的所有航路节点对应的路径的总代价，以获取路径的总代价最小的航路节点，并将该航路节点设定为当前节点，其中，gn值表示从起点到航路节点的路径总耗时，hn值表示从航路节点到终点的路径总耗时；

步骤s52、判断步骤s51中获得的当前节点是否为目标点，如果是，执行步骤s57，如果否，执行步骤s53；

步骤s53、判断当前节点是否被访问过，如果是，执行步骤s55，如果否，执行步骤s54；

步骤s54、连接当前节点与上一航路节点，形成穿越线，所述上一航路节点与当前节点相邻，且在折线(步骤s2中的折线)上位于靠近起点的一侧，如果该穿越线不在可视图中，将其作为可视边添加到可视图中，如果该穿越线在可视图中且不与障碍图形相交，更新当前节点的状态为被访问过；

步骤s55、连接当前节点与目标节点形成穿越线，如果该穿越线在可视图中或不与障碍图形相交，执行步骤s57，如果该穿越线不在可视图中，执行步骤s56；

步骤s56、将步骤s51中的当前节点添加到第二列表中，同时从第一列表中删除该当前节点，然后将与步骤s55中的穿越线相交的障碍图形中距离该穿越线两侧最远的顶点放入第一列表中，执行步骤s51；

步骤s57、将第二列表中的所有节点与可视边组成的连线输出，该连线即为最优航线。

通过上述航迹规划算法可以从构建的可视图的所有航路节点中获取航时最短的最优航线。

上述技术方案中，gn值是从起点到当前节点之间，所有相邻两个的航路节点的路径耗时之和，即起点到第一个航路节点、第一个航路节点到第二个航路节点、第二个航路节点到第三个航路节点……直到与该当前节点相邻的前一个航路节点到该当前节点的所有路径的耗时之和。同理，hn值是从当前节点到终点之间，所有相邻两个的航路节点的路径耗时之和，即当前节点到第n个航路节点(与该当前节点相邻的下一个航路节点)、第n个航路节点到第n+1航路节点、第n+1个航路节点到第n+12个航路节点……直到该当前节点到终点的所有路径的耗时之和，其中，n为正整数。

需要说明的是，本发明的技术方案不仅可以利用上述航迹规划算法获取最优航线，还可以利用dijkstra算法、跳点搜索算法等路径规划算法获取最优航线，只要是通过航路节点探索策略进行路径规划的算法均适用于本发明的技术方案。

在实际航行中，可以将航程分为多段，采用本发明的技术方案进行每段航程的航迹规划，以减少建模的数据的生成，降低建模用时，提升算法的执行效率。

结合图2-图5所示，下面以一具体的实施方式来描述本发明的技术方案。

如图2所示，s为起点，g为目标点，连接起点s和目标点g，形成贯穿线10，构建多边形区域100；

如图3所示，去除与多边形区域100不相交的障碍图形1，对多边形区域100内的障碍图形进行融合处理，形成用于航迹规划的可视图；

如图4所示，检测从起点到目标点的一侧具有相邻的两个障碍图形可融合，对该相邻的两个障碍图形进行融合处理，形成新的障碍图形；

如图5所示，利用本发明的路径规划算法获取最优航线的航路节点1、2、3，然后依次连接起点s、1、2、3、g，形成可视边a、b、c、d，将可视边a、b、c、d输出得到最优航线，具体如下图：

经由公式f(x)的确定，将航路节点1确认为当前节点，然后构建由起点s到航路节点1的穿越线a，经判定a为起点s和航路节点1之间的可视边，便将其加入到可视图中，即将穿越线a描绘出来；

然后根据公式f(x)将航路节点2确认为当前节点，同时构建上一航路节点1到当前节点2的穿越线b，经判定穿越线b为航路节点1和2间的可视边，将其加入到可视图中，即将穿越线b描绘出来；然后寻找到航路节点3，构建航路节点2和3之间的可视边c，最后找到目标点g，构建航路节点3和目标点g之间的可视边d，确定到达目标点寻路结束，最后输出由起点s、航路节点1、航路节点2、航路节点3、目标点g和可视边a、b、c、d组成的最优航线。

以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明技术原理的前提下，还可以做出若干改进和替换，这些改进和替换也应视为本发明的保护范围。