1.一种沿海航道水域船舶路径规划方法,其特征在于,包括以下步骤:
电子海图预处理:解析电子海图数据提取地理要素,将所述地理要素转换为矢量化地理要素文件;
邻接图生成:根据所述矢量化地理要素文件基于四叉树多策略建模方法构建环境模型,基于所述环境模型生成可用于路径搜索的邻接图;
航道划分:根据所述矢量化地理要素文件生成航道的中心线,将航道沿所述中心线划分为上行航道和下行航道,上行航道和下行航道的航道航向均平行于所述中心线;
初始路径生成:根据所述邻接图基于A星算法进行路径搜索,并在A星算法的代价函数中引入航道偏好因子,生成初始路径;所述航道偏好因子具体为:判断当前探索的路径点是否位于航道区域:若路径点在非航道区域内,则不改变代价;若路径点在航道区域内,则根据航向判定函数结合路径点所在的航道分带类型调整代价;所述航向判定函数根据船舶当前航向与当前所处航道规定的航道航向进行判定;
最终优化路径生成:减少所述初始路径的冗余节点和不必要转向,生成最终优化路径。
2.根据权利要求1所述的沿海航道水域船舶路径规划方法,其特征在于,在所述航道划分中,根据所述矢量化地理要素文件在航道的转折点处设置分段线,将航道进行分段规整处理,得到航道分段,将相邻两个分段线的中点相连,得到航道的所述中心线;并在所述上行航道和所述下行航道内均划分主通行带和两个过渡带,所述主通行带位于两个所述过渡带之间,划分主通行带和两个过渡带的划分线均与航道的所述中心线平行设置。
3.根据权利要求2所述的沿海航道水域船舶路径规划方法,其特征在于,所述代价函数具体为:其中,表示当前叶子节点;表示节点的代价;表示当前叶子节点的邻居叶子节点;表示节点的代价;表示航道偏好因子;表示当前叶子节点到邻居叶子节点的欧式距离;表示节点到规划路径终点的欧式距离。
4.根据权利要求3所述的沿海航道水域船舶路径规划方法,其特征在于,所述航向判定函数具体为:其中,表示路径生成中船舶当前航向与当前所处航道规定的航道航向的角度差;表示最小值;表示路径生成中当前船舶的航向;表示船舶当前所处航道规定的航道航向;表示船舶当前位置的坐标;表示船舶在前一个位置的坐标;表示反正切函数。
5.根据权利要求4所述的沿海航道水域船舶路径规划方法,其特征在于,所述航道偏好因子具体为:其中,表示航道偏好因子;表示基本代价;表示权重;表示航道分带类型为主通行带时的权重;表示航道分带类型为过渡带时的权重。
6.根据权利要求2所述的沿海航道水域船舶路径规划方法,其特征在于,所述根据所述矢量化地理要素文件在航道的转折点处设置分段线,将航道进行分段规整处理,得到航道分段,具体包括以下步骤:从所述矢量化地理要素文件中提取航道边界,航道边界为多个航道线段边界组成;
沿所述航道边界计算相邻航道线段边界的夹角,当夹角大于阈值时,将相邻航道线段边界的交点判定为航道的转折点;
在所述转折点处,根据航道线段边界的方位角设置分段线方向:当方位角落在0°±45°或180°±45°范围内时,分段线方向设为水平方向;当方位角不落在0°±45°且180°±45°范围内时,分段线方向设为竖直方向;所述分段线向两侧延伸直至交于航道线段边界,得到多个航道初始分段;
当航道初始分段路径的长度不大于预设长度时,将该航道初始分段设为航道最终分段;当航道初始分段的长度大于预设长度时,按等间距对航道初始分段补充设置分段线,使航道初始分段的长度不大于预设长度,得到航道最终分段;
将多个航道最终分段汇总得到航道分段。
7.根据权利要求2所述的沿海航道水域船舶路径规划方法,其特征在于,所述最终优化路径生成具体包括以下步骤:将所述初始路径位于所述航道内的分别划分为航道初始路径,将所述初始路径不位于所述航道内的分别划分为自由空间分段路径;
对每个所述航道初始路径根据航道分段进行分段,得到航道分段路径;
对航道分段路径和自由空间分段路径分别采用RDP算法进行简化,减少所述初始路径的冗余节点和不必要转向,生成最终优化路径。
8.根据权利要求1至7任一项所述的沿海航道水域船舶路径规划方法,其特征在于,在所述电子海图预处理中,所述电子海图数据包括S-57或S-101标准数据,提取的地理要素包括航道、陆地和水深区。
9.根据权利要求8所述的沿海航道水域船舶路径规划方法,其特征在于,在所述邻接图生成中,将水深区中水深小于船舶安全水深的区域划分为浅水区,将水深区中水深不小于船舶安全水深的区域划分为深水区,将浅水区和陆地划分为不可通航区域,将深水区划分为可通航区域;基于四叉树多策略建模方法对航道、不可通航区域和可通航区域进行差异化细分与标记,构建环境模型。
10.根据权利要求9所述的沿海航道水域船舶路径规划方法,其特征在于,所述构建环境模型具体包括以下策略:生成叶子节点:
生成初始四叉树节点;
对所述航道采用统一细分策略,将位于所述航道内的初始四叉树节点细分至预设深度,生成等尺寸的叶子节点;
对所述不可通航区域采用边界触发细分策略,仅在不可通航区域的边界与初始四叉树节点相交时触发细分,细分至指定深度后,生成叶子节点;
对所述可通航区域采用分层标记策略,将位于所述深水区内的初始四叉树节点细分至指定深度,生成叶子节点;
标记叶子节点:
在位于所述航道内的叶子节点上添加航道标记;在位于所述不可通航区域内的叶子节点上添加不可通航标记;在位于所述可通航区域内的叶子节点上添加可通航标记。