汽渡船舶自主导航与靠离泊控制方法及系统与流程

摘要: 本发明属于船舶智能控制,尤其涉及汽渡船舶自主导航与靠离泊控制方法及系统。背景技术:1、汽渡船舶广泛运营于内河水系及沿海近岸航线,承担车辆和乘客的日常渡运任务。与...
汽渡船舶自主导航与靠离泊控制方法及系统与流程

本发明属于船舶智能控制,尤其涉及汽渡船舶自主导航与靠离泊控制方法及系统。

背景技术:

1、汽渡船舶广泛运营于内河水系及沿海近岸航线,承担车辆和乘客的日常渡运任务。与远洋船舶不同,汽渡船舶具有艏艉对称且两端均配备推进器的结构特点,航行无需掉头,且通常采用高频次、短航线的运营模式,单船每日靠离泊操作可达数十次。近年来,船舶自主航行技术快速发展,将其应用于汽渡船舶已成为提升渡运安全性和运营效率的重要方向。

2、现有汽渡船舶自主靠离泊控制方案中,较为典型的技术路线是:通过激光雷达、摄像头及差分gps等传感器实时采集船舶周边环境数据和船舶自身位姿数据,利用感知算法识别泊位边界、码头前沿线及跳板接驳点等泊位特征信息;随后,基于船舶运动学模型和预设的船舶固定质量参数(包括空船质量、设计重心位置及标称转动惯量),结合实时采集的环境扰动数据,由轨迹规划模块生成一条从当前位置驶向目标泊位的靠泊轨迹,并通过推进器控制系统跟踪该靠泊轨迹完成停靠。

3、上述现有方案在实际应用于汽渡船舶时,由于汽渡船舶在每一次航行中搭载的车辆数量、型号及停放位置均存在显著差异,导致船舶的实际总质量、重心位置和转动惯量在不同航次之间发生剧烈且无规律的变化,而现有方案均将船舶的质量参数视为固定不变的标称值,使得轨迹规划所依据的船舶动力学模型与船舶的实际物理状态严重失配,规划出的靠泊轨迹无法真实反映船舶在当前装载条件下的实际响应特性,导致轨迹跟踪控制精度和靠泊安全性不足,也增加了推进系统的能耗和机械磨损。

技术实现思路

1、本发明的目的在于提供汽渡船舶自主导航与靠离泊控制方法及系统,旨在解决背景技术中确定的现有技术存在的技术问题。

2、本发明是这样实现的,汽渡船舶自主导航与靠离泊控制方法,所述方法包括:

3、获取甲板上每辆车的重量和车辆停放位置,并生成甲板载荷分布数字地图;

4、根据所述甲板载荷分布数字地图,计算船舶当前总质量、船舶当前三维重心坐标和船舶当前转动惯量,得到船舶动态质量属性数据;

5、根据所述船舶动态质量属性数据,结合实时船位数据和实时艏向数据,分别生成以船舶艏端作为靠泊前端的第一靠泊轨迹和以船舶艉端作为靠泊前端的第二靠泊轨迹;

6、通过目标泊位的位置坐标和几何参数,分别规划出第一靠泊轨迹的终端位置和终端艏向角作为第一终端期望姿态,以及第二靠泊轨迹的终端位置和终端艏向角作为第二终端期望姿态;

7、分别评估第一靠泊轨迹、第二靠泊轨迹在预设综合效能指标下的第一综合效能值和第二综合效能值,并将数值更小者所对应的靠泊轨迹作为目标靠泊轨迹,并将所述目标靠泊轨迹所对应的靠泊端作为目标靠泊端;

8、根据所述目标靠泊轨迹的终端期望姿态和所述船舶动态质量属性数据,控制艏端推进器和艉端推进器的差动推力输出,完成靠泊。

9、作为本发明更进一步的方案,所述获取甲板上每辆车的重量和车辆停放位置,并生成甲板载荷分布数字地图,具体包括:

10、采集每辆车驶过对应甲板称重区域时的称重读数,将称重读数作为每辆车的重量;

11、采集甲板全局图像,对所述甲板全局图像进行车辆目标检测和位置识别,获取每辆车在甲板平面坐标系下的中心点坐标作为车辆停放位置;

12、将每一辆车的重量与对应的车辆停放位置关联存储,生成甲板载荷分布数字地图。

13、作为本发明更进一步的方案,所述得到船舶动态质量属性数据,具体包括:

14、将所述甲板载荷分布数字地图中每一辆车的重量进行累加,得到船舶当前总质量;

15、以甲板预设参考原点为基准,结合每一辆车的重量与车辆停放位置中对应的横坐标值、纵坐标值和高度坐标值,获取船舶当前三维重心坐标中的横向重心坐标值、纵向重心坐标值和垂向重心坐标值;

16、根据船舶当前总质量、船舶当前三维重心坐标以及甲板上每一辆车相对于所述船舶当前三维重心坐标的分布距离,计算绕船舶垂直轴线方向的船舶当前转动惯量;

17、将所述船舶当前总质量、所述船舶当前三维重心坐标和所述船舶当前转动惯量共同作为船舶动态质量属性数据输出。

18、作为本发明更进一步的方案,所述生成以船舶艏端作为靠泊前端的第一靠泊轨迹和以船舶艉端作为靠泊前端的第二靠泊轨迹,具体包括:

19、依据所述船舶当前总质量和所述船舶当前三维重心坐标,分别计算以船舶艏端作为靠泊前端时、以船舶艉端作为靠泊前端时的动力学响应参数;

20、获取实时船位数据和实时艏向数据,并结合目标泊位的位置坐标和动力学响应参数进行轨迹规划,生成以船舶艏端作为靠泊前端的第一路径点序列以及以船舶艉端作为靠泊前端的第二路径点序列;

21、分别获取与所述第一路径点序列中每个路径点对应的第一期望航速和第一期望艏向角,以及以船舶艉端作为靠泊前端的第二路径点序列以及与所述第二路径点序列中每个路径点对应的第二期望航速和第二期望艏向角;

22、由所述第一路径点序列、所述第一期望航速和所述第一期望艏向角共同构成所述第一靠泊轨迹,由所述第二路径点序列、所述第二期望航速和所述第二期望艏向角共同构成所述第二靠泊轨迹。

23、作为本发明更进一步的方案,所述分别规划出第一靠泊轨迹的终端位置和终端艏向角作为第一终端期望姿态,以及第二靠泊轨迹的终端位置和终端艏向角作为第二终端期望姿态,具体包括:

24、获取目标泊位的几何参数,所述目标泊位的几何参数包括目标泊位的跳板接驳点位置坐标和目标泊位的靠泊艏向角;

25、依据所述目标泊位的跳板接驳点位置坐标和目标泊位的靠泊艏向角,确定以船舶艏端靠泊时的第一终端期望姿态,所述第一终端期望姿态包括第一终端期望位置和第一终端期望艏向角;

26、依据所述目标泊位的跳板接驳点位置坐标确定以船舶艏端靠泊时的第一终端期望位置,依据所述目标泊位的靠泊艏向角确定以船舶艏端靠泊时的第一终端期望艏向角,由所述第一终端期望位置和所述第一终端期望艏向角共同构成所述第一终端期望姿态,并将所述第一终端期望姿态与所述第一靠泊轨迹关联存储;

27、依据所述目标泊位的跳板接驳点位置坐标和目标泊位的靠泊艏向角,结合船体总长度确定以船舶艉端靠泊时的第二终端期望姿态,所述第二终端期望姿态包括第二终端期望位置和第二终端期望艏向角。

28、作为本发明更进一步的方案,所述分别评估第一靠泊轨迹、第二靠泊轨迹在预设综合效能指标下的第一综合效能值和第二综合效能值,具体包括:

29、分别依据所述第一路径点序列和第二路径点序列中各路径点与航道边界线之间的位置关系,计算第一靠泊轨迹和第二靠泊轨迹的安全风险值;

30、分别依据所述第一期望航速和所述第二期望航速计算第一靠泊轨迹的第一经济性消耗值和第二靠泊轨迹的第二经济性消耗值;

31、分别依据所述第一期望艏向角和第二期望艏向角中最后一个路径点的艏向角计算第一靠泊轨迹的第一运营效率耗时值和第二靠泊轨迹的第二运营效率耗时值;

32、依据第一安全风险值、第一经济性消耗值和第一运营效率耗时值计算第一综合效能值;依据第二安全风险值、第二经济性消耗值和第二运营效率耗时值计算第二综合效能值;

33、取所述第一综合效能值和所述第二综合效能值之间数值更小者所对应的靠泊轨迹作为所述目标靠泊轨迹,并将所述目标靠泊轨迹所对应的靠泊端作为目标靠泊端。

34、作为本发明更进一步的方案,所述控制艏端推进器和艉端推进器的差动推力输出,完成靠泊,具体包括:

35、从目标靠泊轨迹中提取对应的终端期望位置和终端期望艏向角,作为目标终端期望姿态;

36、将所述目标终端期望姿态中的终端期望位置与所述实时船位数据之间的偏差作为位置偏差,将所述目标终端期望姿态中的终端期望艏向角与所述实时艏向数据之间的偏差作为 艏向角偏差;

37、依据位置偏差、艏向角偏差以及船舶当前转动惯量,计算用于消除位置偏差和艏向角偏差所需的旋转力矩补偿值;

38、依据所述旋转力矩补偿值分别确定艏端推进器和艉端推进器各自输出的差动推力,并输出对应控制信号。

39、本发明的另一目的在于提供汽渡船舶自主导航与靠离泊控制系统,所述系统包括:

40、载荷分布采集模块,用于获取甲板上每辆车的重量和车辆停放位置,并生成甲板载荷分布数字地图;

41、动态质量属性计算模块,用于根据所述甲板载荷分布数字地图,计算船舶当前总质量、船舶当前三维重心坐标和船舶当前转动惯量,得到船舶动态质量属性数据;

42、靠泊轨迹生成模块,用于根据所述船舶动态质量属性数据,结合实时船位数据和实时艏向数据,分别生成以船舶艏端作为靠泊前端的第一靠泊轨迹和以船舶艉端作为靠泊前端的第二靠泊轨迹;

43、目标位置规划模块,用于通过目标泊位的位置坐标和几何参数,分别规划出第一靠泊轨迹的终端位置和终端艏向角作为第一终端期望姿态,以及第二靠泊轨迹的终端位置和终端艏向角作为第二终端期望姿态;

44、综合效能评估模块,用于分别评估第一靠泊轨迹、第二靠泊轨迹在预设综合效能指标下的第一综合效能值和第二综合效能值,并将数值更小者所对应的靠泊轨迹作为目标靠泊轨迹,并将所述目标靠泊轨迹所对应的靠泊端作为目标靠泊端;

45、差动推力控制模块,用于根据所述目标靠泊轨迹的终端期望姿态和所述船舶动态质量属性数据,控制艏端推进器和艉端推进器的差动推力输出,完成靠泊。

46、本发明的有益效果是:

47、本发明通过建立基于实时车辆载荷感知的船舶动态质量属性获取机制,使系统能够精确掌握每一次靠泊操作前船舶的真实总质量、三维重心坐标及绕垂直轴线的转动惯量,并将这些动态质量参数作为靠泊轨迹规划的核心输入依据,从而解决了现有方案中因采用固定质量参数而导致轨迹规划与船舶实际响应特性严重偏离的技术难题;

48、本发明充分利用汽渡船舶艏艉两端均具备推进能力的结构特征,同步生成以艏端靠泊和以艉端靠泊的两条镜像轨迹,并通过综合考量安全风险、能耗消耗及装卸效率的综合效能评估机制自适应选取最优靠泊方案,使得靠泊轨迹始终与船舶当前的实际装载状态和操纵特性保持匹配,显著提高了汽渡船舶在高频次、变载荷运营条件下的靠泊安全性、轨迹跟踪精度及运营效率,同时降低了推进系统的非必要能耗。