[发明专利]一种适用于潜航器水面回收的控制系统及其控制方法

说明书

本发明公开了一种适用于潜航器水面回收的控制系统及其控制方法，属于无人艇技术领域。潜航器水面回收的控制系统包括双体无人艇中控系统、双体无人艇运动控制系统、激光检测与视觉识别模块、潜航器回收系统、潜航器中控系统、潜航器运动控制系统。本发明在双体无人艇运动控制系统中设计有基于深度学习的无人艇位姿预测模型，实现了无人艇位姿数据的预报，提高了无人艇定位的精度和潜航器回收平台的稳定性。同时，在潜航器运动控制系统中设计有自适应滑模容错跟踪控制器，使潜航器在执行回收任务过程中具有更高的可靠性和稳定性。本发明设计的潜航器水面回收控制系统能够有效的提高潜航器回收效率和成功率，节省了回收成本，具有一定的实用价值。

技术领域

本发明涉及无人艇技术领域，具体涉及一种适用于潜航器水面回收的控制系统及其控制方法。

背景技术

潜航器凭借其卓越的水下科考能力，被广泛应用于水文地理勘察等领域。并且，伴随着潜航器控制技术的发展，潜航器的回收技术近年来也引起了大量学者的关注。然而，当前潜航器回收技术往往离不开工作人员参与，而且过度的依赖于复杂设计的回收机构，这不仅增加了系统的复杂度，其回收效率也比较低。而且，潜航器除了面对复杂海洋环境和苛刻的通信环境外，还可能遭遇驱动器故障等其它不利因素，这都将增加潜航器回收失败的概率。因此，需要设计一种容错能力较强的鲁棒性控制系统，来保障潜航器可以有效的处理驱动器故障、克服时变的外界干扰和系统不确定性，以提高潜航器的可靠性和稳定性，确保可以顺利、高效的实现预定的潜航器回收任务。

发明内容

针对现有技术中存在的问题和不足，本发明的目的在于提供一种适用于潜航器水面回收的控制系统及其控制方法。

为实现发明的目的，本发明采用如下技术方案：

第一方面，本发明提供了一种适用于潜航器水面回收的控制系统，包括双体无人艇中控系统、双体无人艇运动控制系统、激光检测与视觉识别模块、潜航器回收系统、潜航器中控系统、潜航器运动控制系统；所述双体无人艇中控系统分别与双体无人艇运动控制系统、激光检测与视觉识别模块、潜航器回收系统、潜航器中控系统连接；所述潜航器运动控制系统分别与激光检测与视觉识别模块、潜航器回收系统、潜航器中控系统连接；所述激光检测与视觉识别模块与潜航器回收系统连接；所述双体无人艇中控系统用于接收用户所发送的回收指令，生成潜航器回收指令和海面目标检测和识别指令，并将潜航器回收指令传输至潜航器中控系统，将海面目标检测和识别指令传输至激光检测与视觉识别模块；所述潜航器中控系统用于接收来自双体无人艇中控系统的潜航器回收指令，生成潜航器上浮指令，并将潜航器上浮指令传输至潜航器运动控制系统；所述潜航器运动控制系统根据接收到的潜航器上浮指令，控制潜航器上浮；所述激光检测与视觉识别模块用于检测水面目标，并将目标检测结果反馈给双体无人艇中控系统；所述双体无人艇中控系统用于接收到激光检测与视觉识别模块反馈的目标检测结果，如果反馈的结果是检测到水面目标，则所述双体无人艇中控系统向双体无人艇运动控制系统发送动力定位指令，如果反馈的结果是未检测到水面目标，则所述双体无人艇中控系统向潜航器中控系统发送的潜航器回收指令；所述双人无人艇运动控制系统根据接收到的动力定位指令，完成双体无人艇的动力定位，并将完成动力定位指令反馈给双体无人艇中控系统；所述双体无人艇中控系统根据双人无人艇运动控制系统反馈的完成动力定位指令，向潜航器回收系统发送回收装置下放指令；所述潜航器回收系统根据接收到的回收装置下放指令将回收装置下放到回收准备点位置，并将回收准备点位置、回收装置开口端中心轴线信息反馈给双体无人艇中控系统；所述双体无人艇中控系统将回收准备点位置、回收装置开口端中心轴线信息、前进指令传输给潜航器中控系统，潜航器中控系统再将回收准备点位置、回收装置开口端中心轴线信息和前进指令传输给潜航器运动控制系统；所述潜航器运动控制系统根据回收准备点位置、回收装置开口端中心轴线信息和前进指令规划潜航器与回收准备点位置间的期望路径，控制潜航器进入回收装置；所述激光检测与视觉识别模块对回收装置内部进行目标识别，并将目标识别结果反馈给双体无人艇中控系统，如果识别到目标，则潜航器回收系统按预定指令继续完成潜航器的回收工作，如果未能识别到目标，则激光检测与视觉识别模块将其结果反馈给双体无人艇中控系统，双体无人艇中控系统再次向潜航器中控系统发送回收指令，使潜航器重新回到回收准备点位置，继续执行回收任务，直至完成潜航器的回收。