一种全航区高精度无人船自主控制方法及系统与流程

摘要: 本发明涉及无人船自主控制,尤其涉及一种全航区高精度无人船自主控制方法及系统。背景技术:1、在无人船自主航行领域,复杂海况下的环境扰动是制约其实现全航区高精度航迹...
一种全航区高精度无人船自主控制方法及系统与流程

本发明涉及无人船自主控制,尤其涉及一种全航区高精度无人船自主控制方法及系统。

背景技术:

1、在无人船自主航行领域,复杂海况下的环境扰动是制约其实现全航区高精度航迹跟踪的核心难题。现有技术中,无人船的环境感知手段往往较为单一,多依赖单一传感器获取局部海况信息,难以全面捕捉波浪方向、洋流速度及近岸障碍物分布等多维度动态干扰,导致对复杂海况的适应性不足。

2、同时,传统航迹控制方法多采用固定参数的控制策略,无法根据实时海况动态生成抗扰修正量,对波浪横向冲击、洋流侧向漂移等干扰的抵消效果有限。此外,推进系统与船体姿态调整机构的协同性不足,推力分配指令解算与执行环节存在延迟或偏差,进一步降低了航迹跟踪精度,尤其在近岸礁石区、强洋流区及波浪密集区等复杂航段,常出现航迹偏移过大、避障响应滞后等问题,难以满足全航区高精度自主航行的需求。

技术实现思路

1、本发明提供一种全航区高精度无人船自主控制方法及系统,其主要目的在于解决上述背景技术中所提出的问题。

2、为实现上述目的,本发明提供的一种全航区高精度无人船自主控制方法,包括:

3、步骤s1:通过多源环境感知传感器实时采集无人船航行区域的海况动态数据,所述海况动态数据包括波浪方向参数、洋流速度矢量及近岸障碍物分布拓扑;

4、步骤s2:基于所述海况动态数据生成抗扰航迹修正量,包括:将所述波浪方向参数与预设船体姿态稳定性阈值进行空间矢量比对,输出波浪补偿偏航角,同时根据洋流速度矢量在航迹坐标系下的投影分量计算洋流抵消散差;

5、步骤s3:融合所述波浪补偿偏航角与洋流抵消散差生成抗扰航迹修正量,并将所述抗扰航迹修正量输入至航迹跟踪控制器;

6、步骤s4:所述航迹跟踪控制器根据预设全局路径点序列与所述抗扰航迹修正量,动态解算推进系统的推力分配指令,所述推力分配指令包含主推进器转速调整量及舵角补偿值;

7、步骤s5:执行所述推力分配指令,驱动无人船船体姿态调整机构与推进器执行机构,实现全航区高精度航迹跟踪。

8、为了解决上述问题,本发明还提供一种全航区高精度无人船自主控制系统,所述系统包括:

9、海况动态数据采集模块:用于通过多源环境感知传感器实时采集无人船航行区域的海况动态数据,所述海况动态数据包括波浪方向参数、洋流速度矢量及近岸障碍物分布拓扑。

10、抗扰航迹修正基础参数生成模块:用于基于所述海况动态数据生成抗扰航迹修正量,包括:将所述波浪方向参数与预设船体姿态稳定性阈值进行空间矢量比对,输出波浪补偿偏航角,同时根据洋流速度矢量在航迹坐标系下的投影分量计算洋流抵消散差。

11、抗扰航迹修正量融合与传输模块:用于融合所述波浪补偿偏航角与洋流抵消散差生成抗扰航迹修正量,并将所述抗扰航迹修正量输入至航迹跟踪控制器。

12、推力分配指令解算模块:用于所述航迹跟踪控制器根据预设全局路径点序列与所述抗扰航迹修正量,动态解算推进系统的推力分配指令,所述推力分配指令包含主推进器转速调整量及舵角补偿值。

13、航迹跟踪执行模块:用于执行所述推力分配指令,驱动无人船船体姿态调整机构与推进器执行机构,实现全航区高精度航迹跟踪。

14、与现有技术相比,本发明具有以下有益效果:

15、本发明通过多源环境感知传感器实时采集海况动态数据,实现了对波浪、洋流及近岸障碍物等环境干扰的全面感知,为后续抗扰控制提供了精准输入。基于海况数据生成的波浪补偿偏航角与洋流抵消散差,通过融合处理形成抗扰航迹修正量,有效抵消了复杂海况对航迹的干扰。航迹跟踪控制器结合预设路径与修正量动态解算推力分配指令,确保推进系统与姿态调整机构协同动作,解决了单一干扰修正精度不足、执行机构响应不一致的问题,显著提升了无人船在各类航区的航迹跟踪稳定性。

16、进一步地,通过卡尔曼滤波抑制噪声、动态分配推力及优先执行舵角补偿等设计,实现了干扰抑制与航迹修正的闭环控制。该方法在近岸、强洋流区及波浪密集区等复杂环境下均能保持高精度航迹跟踪,突破了传统控制方法对特定海况的适应性局限,为无人船全航区自主航行提供了可靠的技术支撑,提升了自主控制的鲁棒性与泛用性。

1.一种全航区高精度无人船自主控制方法,其特征在于,所述方法包括:

2.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述通过多源环境感知传感器实时采集无人船航行区域的海况动态数据,包括:

3.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述将所述波浪方向参数与预设船体姿态稳定性阈值进行空间矢量比对,输出波浪补偿偏航角,包括:

4.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述根据洋流速度矢量在航迹坐标系下的投影分量计算洋流抵消散差,包括:

5.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述融合所述波浪补偿偏航角与洋流抵消散差生成抗扰航迹修正量,包括:

6.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述将所述抗扰航迹修正量输入至航迹跟踪控制器,包括:

7.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述航迹跟踪控制器根据预设全局路径点序列与所述抗扰航迹修正量,动态解算推进系统的推力分配指令,包括:

8.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述执行所述推力分配指令,包括:

9.如权利要求1所述的全航区高精度无人船自主控制方法,其特征在于,所述驱动无人船船体姿态调整机构与推进器执行机构,实现全航区高精度航迹跟踪,包括:

10.一种全航区高精度无人船自主控制系统,其特征在于,所述系统包括: