CN118062207A - 一种海洋机器人基于进排水的浮力调节控制系统及方法 - Google Patents

Abstract

本发明涉及一种海洋机器人领域，具体说是一种海洋机器人基于进排水的浮力调节控制系统，包括：上层控制计算机、进排水控制器以及进排水管路系统；上层控制计算机，通过CAN总线与进排水控制器连接，用于接收进排水控制器反馈的实时信号，并对进排水控制器发出进水控制命令或排水控制命令；进排水控制器，通过I/O接口与进排水管路系统连接，与进排水管路系统实时通信，接收进排水管路系统反馈的信号值，根据进排水管路系统反馈的信号值进行判断，以对进排水管路系统实现实时控制；本发明的进排水控制器采用控制与功率驱动一体化设计，降低了控制系统在海洋机器人所需的空间。

Description

一种海洋机器人基于进排水的浮力调节控制系统及方法

技术领域

本发明涉及一种海洋机器人领域，具体说是一种海洋机器人基于进排水的浮力调节控制系统及方法。

背景技术

海洋机器人可在水下自主航行，其具有航行稳定、携带传感器种类多、水下续航时间长、能够自主完成多种使命等优势，已经成为深海探测活动的重要技术手段之一。为降低功耗海洋机器人通常采用调整浮力大小来完成下潜及上浮动作，但目前的海洋机器人陆用进排水控制系统实现该系列动作，而对于上述陆用进排水控制系统，用于海洋机器人进排水控制系统存在特殊要求：

(1)自动控制问题。对于海洋机器人来说，在无人操控时需要自动控制进排水；

(2)控制系统集成。对于海洋机器人来说，需要控制系统小型化集成。

发明内容

针对现有技术的不足，本发明提供一种海洋机器人基于进排水的浮力调节控制方法及应用系统，该控制系统通过自身的控制单元完成海洋机器人在航行时根据需要进行进排水控制，以克服上述陆用进排水控制系统的缺陷。

本发明为实现上述目的所采用的技术方案是：一种海洋机器人基于进排水的浮力调节控制系统，包括：上层控制计算机、进排水控制器以及进排水管路系统；

上层控制计算机，通过CAN总线与进排水控制器连接，用于接收进排水控制器反馈的实时信号，并对进排水控制器发出进水控制命令或排水控制命令；

进排水控制器，通过I/O接口与进排水管路系统连接，与进排水管路系统实时通信，接收进排水管路系统反馈的信号值，根据进排水管路系统反馈的信号值进行判断，以对进排水管路系统实现实时控制；

进排水管路系统，用于反馈压力、流量以及液位信息的信号值至进排水控制器，并通过进排水控制器的控制，实现进水、排水的通断。

所述进排水控制器，包括：电源板、模拟资源板、模拟隔离板、数字资源板和数字驱动板；

所述电源板连接模拟资源板，用于分别对模拟资源板提供5VDC、12VDC和24VDC；

所述模拟资源板一端与模拟隔离板连接，用于向模拟隔离板提供所需的24VDC，并接收通过模拟隔离板隔离后的模拟信号；另一端连接数字资源板，用于向数字资源板提供所需的5VDC和12VDC，且与数字资源板进行SPI同步串行通信；

所述模拟隔离板与模拟量信号的传感器连接，用于接收传感器的4-20mA电流信号，并电流信号隔离后传入模拟资源板；

所述数字资源板与数字驱动板连接，所述数字驱动板，用于输出24VDC电压信号，驱动进排水管路系统的执行元件，以及接收进排水管路系统反馈的电压信号。

所述进排水管路系统，包括：进水箱、排水箱、外部进水箱、外部排水箱、排水控制管路以及进排水管路；

所述进排水管路包括：第一排水支路、第二排水支路以及进水支路；

在所述第一排水支路上，海水从进水箱流出，通过第一排水支路依次经进水箱进出水接口、进水箱排水阀、进排水控制管路、排水阀、海水连通口、通海阀流出至海水进出口；

在所述第二排水支路上，海水从排水箱流出，通过第二排水支路依次经排水箱进出水接口、排水箱排水阀、进排水控制管路、排水阀、海水连通口、通海阀流出至海水进出口；

在所述进水支路上，海洋机器人外的海水依次经海水进出口、通海阀海水连通口、进水阀、进排水控制管路分别进入至进水箱进水阀和排水箱进水阀；

所述进水箱进水阀和排水箱进水阀分别通过进水箱进出水接口和排水箱进出水接口与进水箱和排水箱连接。

所述进排水控制管路，包括：顺次设置在进排水管路上的排水泵、排水泵止回阀、压力计和流量计；

所述进排水管路的输入端分别与进水箱排水阀、排水箱排水阀以及进水阀连接，进排水管路的输出端分别与进水箱进水阀、排水阀进水箱以及排水阀连接；

所述流量计通过AD接口与进排水控制器连接，用于采集进、排水回路的流量信息，监控进排水管路中各支路的流量状态；

所述压力计通过AD接口与进排水控制器连接，用于采集进、排水回路的压力信息，监控进排水管路中各支路的压力状态；

所述排水泵还通过I/O接口与进排水控制器连接，用于控制排水泵的启停。

所述进水箱和排水箱均设于海洋机器人内；

所述进水箱和排水箱内均设有液位传感器，所述液位传感器通过AD接口与进排水控制器连接，以采集进水箱、排水箱的液位位置信息，监控液位状态。

所述进水箱排水阀、排水箱排水阀、排水阀、通海阀、进水箱进水阀、排水箱进水阀均为电动球阀；

所述电动球阀均通过I/O接口与进排水控制器连接，用于控制进排水管路中各支路的通断。

所述进水箱进出水接口与进水箱之间的管路上设有进水箱联通阀；排水箱进出水接口与排水箱之间的管路上设有排水箱联通阀；

所述进水箱联通阀和排水箱联通阀通过I/O接口与进排水控制器连接，用于控制排水箱和排水箱的进水和出水的通断。

一种海洋机器人基于进排水的浮力调节控制系统的控制方法，包括以下步骤：

1)海洋机器人航行前，上层控制计算机通过CAN总线向进排水控制器下达指令，开启通海阀、进水阀，进水箱进水阀、排气水箱进水阀，进水箱联通阀、排水箱联通阀，进排水控制器输出控制信号使排水泵开始工作，开始进水工作；

2)进排水控制管路上的流量计检测进水管路流量状态，当检测到管路都没有流量时，或进排水控制管路上的压力计检测进水管路压力状态，当检测到管路都没有压力时发送至进排水控制器，进排水控制器关闭排水泵、进水箱进水阀、排水箱进水阀；

3)当海洋机器人需要排水时，上层控制计算机给进排水控制器下达排水控制命令，进排水控制器接受排水控制命令，并驱动打开通海阀、排水阀，进气水箱排水阀、排水箱排水阀，进水箱联通阀、排水箱联通阀，进排水控制器开始排水控制。

所述进排水控制器输出控制信号使排水泵开始工作，开始进水工作，具体为：

上层控制计算机给进排水控制器下达进水控制命令，进排水控制器接受进水控制命令，开启通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀，打开排水泵，并获取进水箱和排水箱的液位信息；

若进水箱和排水箱的液位信息都大于设定液位，则关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀；否则继续进水设定时间后；

继续进水设定时间后，若两液位仍大于设定液位，则关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀；否则认为进水超时并上报至进排水控制器并关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀，进水工作结束。

所述进排水控制器开始排水控制，具体为：

上层控制计算机给进排水控制器下达排水控制命令，进排水控制器接受排水控制命令，开启通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀，打开排水泵，并获取进水箱和排水箱液位信息；若进水箱和排水箱的液位信息都为0，则关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀；否则继续进水设定时间后；

继续进水设定时间后，若两液位都等于0，则关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀；否则认为进水超时并上报并关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀，排水工作结束。

本发明具有以下有益效果及优点：

1、本发明的进排水控制器采用控制与功率驱动一体化设计，降低了控制系统在海洋机器人所需的空间。

2、本发明的控制系统可以根据实际应用情况调整控制参数，可靠性高。

附图说明

图1为本发明的总体系统结构框图；

图2为本发明的进排水控制器控制原理图；

图3为本发明的管路系统连接关系图；

图4为本发明的进水控制流程图；

图5为本发明的排水控制流程图。

具体实施方式

下面结合附图及实施例对本发明做进一步的详细说明。

如图1所示，为本发明的总体系统结构框图；本发明是用于海洋机器人舱内进排水系统自动控制，包括：上层控制计算机、进排水控制器以及进排水管路系统；

上层控制计算机，通过CAN总线与进排水控制器连接，用于接收进排水控制器反馈的实时信号，并对进排水控制器发出进水控制命令或排水控制命令；

进排水控制器，通过I/O接口与进排水管路系统连接，与进排水管路系统实时通信，接收进排水管路系统反馈的信号值，根据进排水管路系统反馈的信号值进行判断，以对进排水管路系统实现实时控制；

进排水管路系统，用于反馈压力、流量以及液位信息的信号值至进排水控制器，并通过进排水控制器的控制，实现进水、排水的通断。

基本原理为上层控制计算机通过CAN总线将控制命令发送给进排水控制器，进排水控制器根据控制命令，驱动进排水管路系统中各个元器件、排水泵，同时进排水控制器通过CAN总线将工作状态反馈给上层控制计算机，实现自动控制。

如图2所示，为本发明进排水控制器控制原理图，其进排水控制器是由电源板、模拟资源板、模拟隔离板、数字资源板、数字驱动板五部分组成；

其中，电源板连接模拟资源板，用于分别对模拟资源板提供5VDC、12VDC和24VDC；

模拟资源板一端与模拟隔离板连接，用于向模拟隔离板提供所需的24VDC，并接收通过模拟隔离板隔离后的模拟信号；另一端连接数字资源板，用于向数字资源板提供所需的5VDC和12VDC，且与数字资源板进行SPI同步串行通信；

模拟隔离板与模拟量信号的传感器连接，用于接收传感器的4-20mA电流信号，并电流信号隔离后传入模拟资源板；

数字资源板与数字驱动板连接，数字驱动板，用于输出24VDC电压信号，驱动进排水管路系统的执行元件，以及接收进排水管路系统反馈的电压信号。

工作原理为：外部24VDC经过电源板输出24VDC、12VDC、5VDC给模拟资源板供电，模拟资源板向模拟隔离板提供所需24VDC，并且接收通过模拟隔离板隔离后的模拟信号；另一端连接数字资源板，用于向数字资源板提供所需的5VDC和12VDC，并且与数字资源板进行串口通信，数字资源板向数字驱动板输出5VDC电压信号，并且接收数字驱动板的反馈电压信号，数字驱动板用于输出24VDC电压信号，驱动电动球阀和排水泵，以及接收电动球阀反馈5VDC电压信号。

如附图3所示，本发明是用于海洋机器人舱内进排水系统自动控制，由进水部分和排水部分组成的装置，其主要包括：进水箱、排水箱、外部进水箱、外部排水箱、排水控制管路以及进排水管路；

进排水管路包括：第一排水支路、第二排水支路以及进水支路；

在第一排水支路上，海水从进水箱流出，通过第一排水支路依次经进水箱进出水接口、进水箱排水阀、进排水控制管路、排水阀、海水连通口、通海阀流出至海水进出口；

在第二排水支路上，海水从排水箱流出，通过第二排水支路依次经排水箱进出水接口、排水箱排水阀、进排水控制管路、排水阀、海水连通口、通海阀流出至海水进出口；

在进水支路上，海洋机器人外的海水依次经海水进出口、通海阀海水连通口、进水阀、进排水控制管路分别进入至进水箱进水阀和排水箱进水阀；

进水箱进水阀和排水箱进水阀分别通过进水箱进出水接口和排水箱进出水接口与进水箱和排水箱连接。

进排水控制管路，包括：顺次设置在进排水管路上的排水泵、排水泵止回阀、压力计和流量计；

进排水管路的输入端分别与进水箱排水阀、排水箱排水阀以及进水阀连接，进排水管路的输出端分别与进水箱进水阀、排水阀进水箱以及排水阀连接；

流量计通过AD接口与进排水控制器连接，用于采集进、排水回路的流量信息，监控进排水管路中各支路的流量状态；

压力计通过AD接口与进排水控制器连接，用于采集进、排水回路的压力信息，监控进排水管路中各支路的压力状态；

排水泵还通过I/O接口与进排水控制器连接，用于控制排水泵的启停。

进水箱和排水箱均设于海洋机器人内；

进水箱和排水箱内均设有液位传感器，所述液位传感器通过AD接口与进排水控制器连接，以采集进水箱、排水箱的液位位置信息，监控液位状态。

进水箱排水阀、排水箱排水阀、排水阀、通海阀、进水箱进水阀、排水箱进水阀均为电动球阀；

电动球阀均通过I/O接口与进排水控制器连接，用于控制进排水管路中各支路的通断。

进水箱进出水接口与进水箱之间的管路上设有进水箱联通阀；排水箱进出水接口与排水箱之间的管路上设有排水箱联通阀；

进水箱联通阀和排水箱联通阀通过I/O接口与进排水控制器连接，用于控制排水箱和排水箱的进水和出水的通断。

本发明中，进水是进水箱和排水箱通过海水出入口经过通海阀、进水阀、进水箱进水阀、排水箱进水阀、进水箱联通阀、排水箱联通至进、排水箱为海洋机器人提供负浮力，排水是进水箱和排水箱通过海水出入口经过通海阀、排水阀、进水箱进水阀、排水箱进水阀、进水箱联通阀、排水箱联通至进、排水箱为海洋机器人提供正浮力。

如图1所示，根据本申请的系统结构示意框图，本发明基于进排水的浮力调节控制系统的控制方法，包括以下步骤：

1)海洋机器人航行前，上层控制计算机通过CAN总线向进排水控制器下达指令，开启通海阀、进水阀，进水箱进水阀、排气水箱进水阀，进水箱联通阀、排水箱联通阀，进排水控制器输出控制信号使排水泵开始工作，开始进水工作；

2)进排水控制管路上的流量计检测进水管路流量状态，当检测到管路都没有流量时，或进排水控制管路上的压力计检测进水管路压力状态，当检测到管路都没有压力时发送至进排水控制器，进排水控制器关闭排水泵、进水箱进水阀、排水箱进水阀；

3)当海洋机器人需要排水时，上层控制计算机给进排水控制器下达排水控制命令，进排水控制器接受排水控制命令，并驱动打开通海阀、排水阀，进气水箱排水阀、排水箱排水阀，进水箱联通阀、排水箱联通阀，进排水控制器开始排水控制。

如图4所示，本发明是用于海洋机器人舱内进排水系统进水自动控制，进排水控制器输出控制信号使排水泵开始工作，开始进水工作，具体为：

上层控制计算机给进排水控制器下达进水控制命令，进排水控制器接受进水控制命令，开启通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀，打开排水泵，并获取进水箱和排水箱的液位信息；

若进水箱和排水箱的液位信息都大于设定液位(排气水箱为550mm，进气水箱为550mm)，则关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀；否则继续进水设定时间(本实施例为5分钟)后；

继续进水5分钟后，若两液位仍大于设定液位(排气水箱为550mm，进气水箱为550mm)，则关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀；否则认为进水超时并上报至进排水控制器并关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀，进水工作结束。

如图5所示，本发明的进排水控制器开始排水控制，具体为：

上层控制计算机给进排水控制器下达排水控制命令，进排水控制器接受排水控制命令，开启通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀，打开排水泵，并获取进水箱和排水箱液位信息；若进水箱和排水箱的液位信息都为0，则关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀；否则继续进水5分钟后；

继续进水5分钟后，若两液位都等于0，则关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀；否则认为进水超时并上报并关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀，排水工作结束。

以上所述仅为本发明的实施方式，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进、扩展等，均包含在本发明的保护范围内。

Claims (10)

1.一种海洋机器人基于进排水的浮力调节控制系统，其特征在于，包括：上层控制计算机、进排水控制器以及进排水管路系统；

上层控制计算机，通过CAN总线与进排水控制器连接，用于接收进排水控制器反馈的实时信号，并对进排水控制器发出进水控制命令或排水控制命令；

进排水控制器，通过I/O接口与进排水管路系统连接，与进排水管路系统实时通信，接收进排水管路系统反馈的信号值，根据进排水管路系统反馈的信号值进行判断，以对进排水管路系统实现实时控制；

进排水管路系统，用于反馈压力、流量以及液位信息的信号值至进排水控制器，并通过进排水控制器的控制，实现进水、排水的通断。

2.根据权利要求1所述的一种海洋机器人基于进排水的浮力调节控制系统，其特征在于，所述进排水控制器，包括：电源板、模拟资源板、模拟隔离板、数字资源板和数字驱动板；

所述电源板连接模拟资源板，用于分别对模拟资源板提供5VDC、12VDC和24VDC；

所述模拟资源板一端与模拟隔离板连接，用于向模拟隔离板提供所需的24VDC，并接收通过模拟隔离板隔离后的模拟信号；另一端连接数字资源板，用于向数字资源板提供所需的5VDC和12VDC，且与数字资源板进行SPI同步串行通信；

所述模拟隔离板与模拟量信号的传感器连接，用于接收传感器的4-20mA电流信号，并电流信号隔离后传入模拟资源板；

所述数字资源板与数字驱动板连接，所述数字驱动板，用于输出24VDC电压信号，驱动进排水管路系统的执行元件，以及接收进排水管路系统反馈的电压信号。

3.根据权利要求1所述的一种海洋机器人基于进排水的浮力调节控制系统，其特征在于，所述进排水管路系统，包括：进水箱、排水箱、外部进水箱、外部排水箱、排水控制管路以及进排水管路；

所述进排水管路包括：第一排水支路、第二排水支路以及进水支路；

在所述第一排水支路上，海水从进水箱流出，通过第一排水支路依次经进水箱进出水接口、进水箱排水阀、进排水控制管路、排水阀、海水连通口、通海阀流出至海水进出口；

在所述第二排水支路上，海水从排水箱流出，通过第二排水支路依次经排水箱进出水接口、排水箱排水阀、进排水控制管路、排水阀、海水连通口、通海阀流出至海水进出口；

在所述进水支路上，海洋机器人外的海水依次经海水进出口、通海阀海水连通口、进水阀、进排水控制管路分别进入至进水箱进水阀和排水箱进水阀；

所述进水箱进水阀和排水箱进水阀分别通过进水箱进出水接口和排水箱进出水接口与进水箱和排水箱连接。

4.根据权利要求3所述的一种海洋机器人基于进排水的浮力调节控制系统，其特征在于，所述进排水控制管路，包括：顺次设置在进排水管路上的排水泵、排水泵止回阀、压力计和流量计；

所述进排水管路的输入端分别与进水箱排水阀、排水箱排水阀以及进水阀连接，进排水管路的输出端分别与进水箱进水阀、排水阀进水箱以及排水阀连接；

所述流量计通过AD接口与进排水控制器连接，用于采集进、排水回路的流量信息，监控进排水管路中各支路的流量状态；

所述压力计通过AD接口与进排水控制器连接，用于采集进、排水回路的压力信息，监控进排水管路中各支路的压力状态；

所述排水泵还通过I/O接口与进排水控制器连接，用于控制排水泵的启停。

5.根据权利要求3所述的一种海洋机器人基于进排水的浮力调节控制系统，其特征在于，所述进水箱和排水箱均设于海洋机器人内；

所述进水箱和排水箱内均设有液位传感器，所述液位传感器通过AD接口与进排水控制器连接，以采集进水箱、排水箱的液位位置信息，监控液位状态。

6.根据权利要求3所述的一种海洋机器人基于进排水的浮力调节控制系统，其特征在于，所述进水箱排水阀、排水箱排水阀、排水阀、通海阀、进水箱进水阀、排水箱进水阀均为电动球阀；

所述电动球阀均通过I/O接口与进排水控制器连接，用于控制进排水管路中各支路的通断。

7.根据权利要求3所述的一种海洋机器人基于进排水的浮力调节控制系统，其特征在于，所述进水箱进出水接口与进水箱之间的管路上设有进水箱联通阀；排水箱进出水接口与排水箱之间的管路上设有排水箱联通阀；

所述进水箱联通阀和排水箱联通阀通过I/O接口与进排水控制器连接，用于控制排水箱和排水箱的进水和出水的通断。

8.根据权利要求1所述的一种海洋机器人基于进排水的浮力调节控制系统的控制方法，其特征在于，包括以下步骤：

1)海洋机器人航行前，上层控制计算机通过CAN总线向进排水控制器下达指令，开启通海阀、进水阀，进水箱进水阀、排气水箱进水阀，进水箱联通阀、排水箱联通阀，进排水控制器输出控制信号使排水泵开始工作，开始进水工作；

2)进排水控制管路上的流量计检测进水管路流量状态，当检测到管路都没有流量时，或进排水控制管路上的压力计检测进水管路压力状态，当检测到管路都没有压力时发送至进排水控制器，进排水控制器关闭排水泵、进水箱进水阀、排水箱进水阀；

3)当海洋机器人需要排水时，上层控制计算机给进排水控制器下达排水控制命令，进排水控制器接受排水控制命令，并驱动打开通海阀、排水阀，进气水箱排水阀、排水箱排水阀，进水箱联通阀、排水箱联通阀，进排水控制器开始排水控制。

9.根据权利要求8所述的一种海洋机器人基于进排水的浮力调节控制系统的控制方法，其特征在于，所述进排水控制器输出控制信号使排水泵开始工作，开始进水工作，具体为：

上层控制计算机给进排水控制器下达进水控制命令，进排水控制器接受进水控制命令，开启通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀，打开排水泵，并获取进水箱和排水箱的液位信息；

若进水箱和排水箱的液位信息都大于设定液位，则关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀；否则继续进水设定时间后；

继续进水设定时间后，若两液位仍大于设定液位，则关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀；否则认为进水超时并上报至进排水控制器并关闭排水泵、通海阀、进水阀、进水箱联通阀、排水水箱联通阀、进水箱进水阀及排水箱进水阀，进水工作结束。

10.根据权利要求8所述的一种海洋机器人基于进排水的浮力调节控制系统的控制方法，其特征在于，所述进排水控制器开始排水控制，具体为：

上层控制计算机给进排水控制器下达排水控制命令，进排水控制器接受排水控制命令，开启通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀，打开排水泵，并获取进水箱和排水箱液位信息；若进水箱和排水箱的液位信息都为0，则关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀；否则继续进水设定时间后；

继续进水设定时间后，若两液位都等于0，则关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀；否则认为进水超时并上报并关闭排水泵、通海阀、排水阀、进水箱联通阀、排水水箱联通阀、进水箱排水阀及排气水箱排水阀，排水工作结束。