一种无人船导航自主决策系统及自主航行方法技术方案

本发明专利技术公开了一种无人船导航自主决策系统及自主航行方法，系统包括智能决策模块

【技术实现步骤摘要】
一种无人船导航自主决策系统及自主航行方法


[0001]本专利技术涉及无人船自动航行技术，具体涉及一种无人船导航自主决策系统及自主航行方法，属于船舶设备

。

技术介绍

[0002]船舶航行中，由于船员判断错误导致航行设备使用不当而发生碰撞事故，其中能见度低是大多数事故发生的根源，在黑暗或弥漫有薄雾的天气更容易引起船舶互撞或碰到桥墩
、
露岩和其它漂浮物
。
人为失误造成了超过
80
％的船舶碰撞事故，是海上航行的主要危险源，开展船舶智能航行决策系统的研究，对于降低船舶总体碰撞风险以及减轻船员及岸基工作人员的工作量非常重要，研究一种无人船自主决策系统，已成为船舶功能改进的首选方向
。
[0003]同时无人船的路径规划和自主避障是执行任务的关键技术之一，定点航行的精度和自主避障的能力体现了无人船的智能化发展水平
。
无人船路径规划方法对规划出的路径的光滑性提出了更高的要求，路径不仅需要光滑，而且不能出现超过其最大转弯半径的情况
。
基于搜索的算法在约束较少
、
问题规模较小的情况下有不错的表现，但是一旦问题约束增多或问题规模变大时，搜索效率会急剧下降，不利于实际应用
。

技术实现思路

[0004]专利技术目的：本专利技术的一个目的是提供一种无人船导航自主决策系统
。
[0005]本专利技术的另一个目的是提供一种无人船导航自动航行方法
。
[0006]技术方案：本专利技术的一种无人船导航自主决策系统，包括智能决策模块
、
导航模块
、
无线网络通讯模块和运动控制模块，智能决策模块用于选择无人船航行模式，在正常情况下，选择自主航行模式，在应急情况下，开启应急越控，选择人工辅助模式；导航模块用于实现无人船路径规划；运动控制模块用于实现无人船路径跟踪和轨迹优化调节，并将航行状态信息通过无线网络通讯模块发送至指控中心；指控中心通过无线网络通讯模块下达起始位置到终点位置命令给无人船后，智能决策模块选择航行模式，导航模块在电子海图数据的基础上，融合多种传感器组成的感知系统获取到的实时数据，构建海洋环境地图，实现无人船自身定位，并利用改进的
A*
算法得到全局路径，利用改进的人工势场法得到局部路径，实现无人船路径规划；运动控制模块按照导航模块规划的路径自主航行完成对路径的跟踪功能，期间通过一阶多项式曲线的轨迹优化算法和
PID
控制算法进行轨迹优化调节；
[0007]其中改进的
A*
算法包括：基于角度定义指数加权改进估价函数，利用障碍物的安全阈值优化子节点的选择以及对路径进行二次优化来提升
A*
算法路径规划效率和安全性；改进的人工势场法包括：在人工势场法的斥力函数中加入了相对速度斥力，提升无人船在动态路径规划中的求解效率；最后融合改进的
A*
算法和改进的人工势场法，选取改进的
A*
算法得到的全局路径的拐点作为子目标点，引导人工势场法进行局部路径规划，从而确定从起点位置到终点位置的一条最佳航行路线
。
[0008]可选的，在人工辅助模式下，无人船将状态反馈信息发送回指控中心，指控中心接收到无人船发送的应急越控指令后，结合无人船的位置，计算无人船当前位置和障碍物之间的最近距离，并下达航速指令和航向指令给无人船完成避让动作
。
[0009]可选的，多种传感器组成的感知系统获取到的实时数据包括：
GPS
获取到的无人船经纬度数据，测深模块获取到的海下地理信息数据，罗盘获取到的无人船的航向和姿态，雷达获取到的海面障碍距离
、
位置等相关参数，
AIS
获取并交换来船位置，航向，航速和其他数据，计程器获取到的无人船相对于海底的速度和航程数据，风速风向仪获取到的海上风速风向数据和气象仪获取到的海上气象数据
。
[0010]基于相同的专利技术构思，本专利技术的一种无人船导航自主航行方法，包括以下步骤：
[0011]S1、
指控中心在电子海图上输入起点位置和终点位置，并通过无线网络通讯模块发送给无人船；
[0012]S2、
无人船接受指令后智能决策模块选择航行模式，然后导航模块利用电子海图数据融合多种传感器组成的感知系统获取到的实时数据，实时构建并更新海洋环境地图得到自身定位；
[0013]S3、
在已知的起点位置和终点位置两个任务点之间进行全局路径规划和局部路径规划，采用融合改进的
A*
算法与改进的人工势场法的混合算法制定最佳航行路线；包括：首先，基于角度定义指数加权改进估价函数，利用障碍物的安全阈值优化子节点的选择以及对路径进行二次优化来提升
A*
算法路径规划效率和安全性；同时，在人工势场法的斥力函数中加入了相对速度斥力，提升无人船在动态路径规划中的求解效率；最后融合改进的
A*
算法和改进的人工势场法，选取改进的
A*
算法得到的全局路径的拐点作为子目标点，引导人工势场法进行局部路径规划，从而确定从起点位置到终点位置的一条最佳航行路线；
[0014]S4、
运动控制模块获取到最佳航行路线信息后，进行数据解析，分别获取到所有的路径节点总数
、
单个路径节点数据，再获取到所有经纬度数据以及航行过程中实时经纬度数据，当运动轨迹出现偏差，还需考虑无人船在导航过程中修正方向与运动方向的关系进行轨迹优化调节，产生控制无人船的航行的指令，完成对路径的跟踪功能以实现对无人船的自主导航；
[0015]S5、
根据雷达的扫描信息与来船互换信息，如果来船和自船能够保持安全距离，自船无需改变自身的航线，继续选择自主航行模式，正常行驶即可；当来船和自船超出安全距离时，智能决策模块立即切换到应急越控，采用人工辅助模式，无人船将状态反馈信息发送回指控中心，指控中心接收无人船发送的应急越控指令后，计算无人船当前位置和障碍物之间的最近距离，并下达航速指令和航向指令给无人船完成避让动作；
[0016]S6、
无人船通过无线网络通讯模块和指控中心进行通信，以一定的频率监测外界指令，收到指令之后对其进行简单的处理后发送到相应的单元模块，指控中心实时接收无人船航行路线信息，并实现电子海图屏幕共享
。
[0017]进一步的，改进的
A*
算法中基于角度定义的估价函数
f(n)
为：
[0018][0019]其中，
g(n)
为无人船从起始节点到当前节点
n
的实际代价值，
h(n)
为启发函数，表示无人船从当前节点
n
到目标点的估计代价值；
θ
i
为各子节点与父节点及目标点的夹角，若
θ
i
...

【技术保护点】

【技术特征摘要】
1.
一种无人船导航自主决策系统，其特征在于：包括智能决策模块
、
导航模块
、
无线网络通讯模块和运动控制模块，智能决策模块用于选择无人船航行模式，在正常情况下，选择自主航行模式，在应急情况下，开启应急越控，选择人工辅助模式；导航模块用于实现无人船路径规划；运动控制模块用于实现无人船路径跟踪和轨迹优化调节，并将航行状态信息通过无线网络通讯模块发送至指控中心；指控中心通过无线网络通讯模块下达起始位置到终点位置命令给无人船后，智能决策模块选择航行模式，导航模块在电子海图数据的基础上，融合多种传感器组成的感知系统获取到的实时数据，构建海洋环境地图，实现无人船自身定位，并利用改进的
A*
算法得到全局路径，利用改进的人工势场法得到局部路径，实现无人船路径规划；运动控制模块按照导航模块规划的路径自主航行完成对路径的跟踪功能，期间通过一阶多项式曲线的轨迹优化算法和
PID
控制算法进行轨迹优化调节；其中改进的
A*
算法包括：基于角度定义指数加权改进估价函数，利用障碍物的安全阈值优化子节点的选择以及对路径进行二次优化来提升
A*
算法路径规划效率和安全性；改进的人工势场法包括：在人工势场法的斥力函数中加入了相对速度斥力，提升无人船在动态路径规划中的求解效率；最后融合改进的
A*
算法和改进的人工势场法，选取改进的
A*
算法得到的全局路径的拐点作为子目标点，引导人工势场法进行局部路径规划，从而确定从起点位置到终点位置的一条最佳航行路线
。2.
根据权利要求1所述的一种无人船导航自主决策系统，其特征在于：在人工辅助模式下，无人船将状态反馈信息发送回指控中心，指控中心接收到无人船发送的应急越控指令后，结合无人船的位置，计算无人船当前位置和障碍物之间的最近距离，并下达航速指令和航向指令给无人船完成避让动作
。3.
根据权利要求1所述的一种无人船导航自主决策系统，其特征在于：多种传感器组成的感知系统获取到的实时数据包括：
GPS
获取到的无人船经纬度数据，测深模块获取到的海下地理信息数据，罗盘获取到的无人船的航向和姿态，雷达获取到的海面障碍距离
、
位置相关参数，
AIS
获取并交换来船位置
、
航向和航速，计程器获取到的无人船相对于海底的速度和航程数据，风速风向仪获取到的海上风速风向数据和气象仪获取到的海上气象数据
。4.
一种无人船导航自主航行方法，其特征在于，包括以下步骤：
S1、
指控中心在电子海图上输入起点位置和终点位置，并通过无线网络通讯模块发送给无人船；
S2、
无人船接受指令后智能决策模块选择航行模式，然后导航模块利用电子海图数据融合多种传感器组成的感知系统获取到的实时数据，实时构建并更新海洋环境地图得到自身定位；
S3、
在已知的起点位置和终点位置两个任务点之间进行全局路径规划和局部路径规划，采用融合改进的
A*
算法与改进的人工势场法的混合算法制定最佳航行路线；包括：首先，基于角度定义指数加权改进估价函数，利用障碍物的安全阈值优化子节点的选择以及对路径进行二次优化来提升
A*
算法路径规划效率和安全性；同时，在人工势场法的斥力函数中加入了相对速度斥力，提升无人船在动态路径规划中的求解效率；最后融合改进的
A*
算法和改进的人工势场法，选取改进的
A*
算法得到的全局路径的拐点作为子目标点，引导人工势场法进行局部路径规划，从而确定从起点位置到终点位置的一条最佳航行路线；
S4、
运动控制模块获取到最佳航行路线信息后，进行数据解析，分别获取到所有的路径
节点总数
、
单个路径节点数据，再获取到所有经纬度数据以及航行过程中实时经纬度数据，当运动轨迹出现偏差，还需考虑无人船在导航过程中修正方向与运动方向的关系进行轨迹优化调节，产生控制无人船的航行的指令，完成对路径的跟踪功能以实现对无人船的自主导航；
S5、
根据雷达的扫描信息与来船互换信息，如果来船和自船能够保持安全距离，自船无需改变自身的航线，继续选择自主航行模式，正常行驶即可；当来船和自船超出安全距离时，智能决策模块立即切换到应急越控，采用人工辅助模式，无人船将状态反馈信息发送回指控中心，指控中心接收无人船发送的应急越控指令后，计算无人船当前位置和障碍物之间的最近距离，并下达航速指令和航向指令给无人船完成避让动作；
S6、
无人船通过无线网络通讯模块和指控中心进行通信，以一定的频率监测外界指令，收到指令之后对其进行简单的处理后发送到相应的单元模块，指控中心实时接收无人船航行路线信息，并实现电子海图屏幕共享
。5.
根据权利要求4所述的一种无人船导航自主航行方法，其特征在于：改进的
...

【专利技术属性】
技术研发人员：李永正，侯倩雯，侯盼盼，张贻明，高佳丁，
申请(专利权)人：江苏科技大学，
类型：发明
国别省市：