Cooperative operation method for autonomous underwater robot and docking device
By establishing a docking device on the seabed to work in concert with autonomous underwater robots, using mobile phone communication and state machine design, the problems of continuous and efficiency of autonomous underwater robots are solved, and the automation of long-term residence and multiple detection tasks is realized. Improve detection efficiency and reliability.
Patent Information
- Application Number
- CN202411479113.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-23
- Publication Date
- 2024-11-22
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
After completing the detection task, autonomous underwater robots need to surface to replenish and maintain energy, resulting in interruption of operation continuity and inability to operate under harsh sea conditions, limiting their efficiency improvement.
By establishing a docking device on the seabed and working in concert with autonomous underwater robots, data transmission, energy replenishment and long-term residency are achieved, mobile phone communication, state primitive design and finite state machine are adopted to ensure the reliable interaction between autonomous underwater robots and docking devices. and automated operations.
It has realized the long-term residence of autonomous underwater robots on the seabed and the execution of multiple operating tasks, improved detection efficiency and operation reliability, reduced manual operation requirements, and expanded the detection range.
Smart Images

Figure CN119011652A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of underwater robot control, and in particular to a method for coordinated operation of an autonomous underwater robot and a docking device. Background Art
[0002] Autonomous underwater robots (AUVs) are often used for deep-sea exploration. They can be equipped with a variety of sensors and play an important role in many fields. However, due to the limitation of the energy they can carry, after completing a detection mission, they need to surface and be recovered to the mother ship for energy replenishment, data storage and maintenance. When ready, they are deployed from the mother ship into the water again and dive to the seabed to perform the detection mission. The recovery and deployment process takes a lot of time, interrupting the continuity of the operation. In addition, they are dependent on the sea conditions and cannot operate when the sea conditions are bad. The above factors restrict the improvement of the operating efficiency of autonomous underwater robots.
[0003] In recent years, people have put forward higher and higher requirements for detection area, detection efficiency and detection frequency, and a more efficient operation method is urgently needed. In recent years, domestic and foreign research has found that by establishing a docking device on the seabed to work with autonomous underwater robots, a series of functions such as data transmission, energy replenishment and long-term residence of autonomous underwater robots can be realized, eliminating time-consuming operations such as recovery and deployment, effectively extending the operation time and detection range of autonomous underwater robots, and improving operation efficiency, which has broad application prospects.
[0004] The docking device, which can also be called a base station, garage, etc., refers to a cage-type or open device that accommodates an autonomous underwater robot. It usually has the following equipment and functions: acoustic guidance equipment and optical guidance equipment are used to guide the autonomous underwater robot back to the docking device; guiding, limiting, and locking devices are used to fix the autonomous underwater robot after it enters the docking device; acoustic and optical communication equipment are used for information exchange between the docking device and the autonomous underwater robot; wireless charging devices are used for the docking device to replenish energy for the autonomous underwater robot.
[0005] Most of the existing docking devices need to be connected to the mother ship. The status of the autonomous underwater robot or the docking device is displayed through the mother ship's control software. The docking device is controlled by the mother ship's control software. The docking device cannot work independently from the mother ship. The operation of the autonomous underwater robot out of the docking device and the various tasks after returning to the docking device are completed by the operator and cannot be automated. In addition, the autonomous underwater robot can only preset a single detection mission and cannot automatically and continuously perform multiple operation tasks after replenishing energy in the docking device. Summary of the invention
[0006] The technical problem to be solved by the present invention is to provide a method for collaborative operation of an autonomous underwater robot and a docking device in view of the deficiencies of the above-mentioned prior art, so as to realize the collaborative operation of an autonomous underwater robot and a docking device that resides on the seabed for a long time.
[0007] In order to solve the above technical problems, the technical solution adopted by the present invention is: a method for collaborative operation of an autonomous underwater robot and a docking device, comprising the following steps: Step 1: Use the handshake mechanism to establish a communication process, which serves as the basis for information exchange, command issuance, and data transmission between the autonomous underwater robot and the docking device, ensuring reliable communication between the autonomous underwater robot and the docking device; Defines a unified data packet transmitted by autonomous underwater robots and docking devices under different communication modes The structure is as follows: ,in, Indicates the packet sequence number , used to identify the order of data packets; Indicates the timestamp of the packet generation , Indicates the length of the transmitted data , Indicates the actual data transmitted. Indicates the cumulative checksum; Among them, represents the data packet sequence number, which is used to identify the order of the data packets; represents the timestamp of the data packet generation, represents the length of the transmitted data, represents the actual transmitted data, and represents the accumulated checksum; The process of handshake communication between the autonomous underwater robot and the docking device is as follows: 1) The sender initiates a connection and sends a connection request packet ; 2) After receiving the request, the receiver returns a confirmation packet ; 3) After the sender receives the confirmation packet, it starts sending and receiving data; 4) The receiver calculates the cumulative checksum of the received data packet and determines whether to receive the data packet; 4.1) The receiver calculates the cumulative checksum of the received data packet; 4.2) If the cumulative checksum of the received data packet is inconsistent with the cumulative checksum sent by the sender, the data packet is discarded: 4.3) If they are consistent, a data confirmation packet is returned to the sender; 5) If the sender does not receive the data confirmation packet within the timeout period, it resends the data packet.
[0008] Step 2: Design state primitives for the autonomous operation process of the autonomous underwater robot and the docking device. The state primitives execute each operation in the autonomous operation process of the autonomous underwater robot and the docking device, and standardize the operation execution process of the autonomous operation process of the autonomous underwater robot and the docking device; The state primitive is composed of seven sub-states: state transition configuration sub-state S1, operation execution sub-state S2, execution waiting sub-state S3, result check sub-state S4, state transition sub-state S5, timeout processing sub-state S6 and exception handling sub-state S7; the state transition configuration sub-state S1 configures the state primitives that migrate under different circumstances and constructs a state transition table; the operation execution sub-state S2 is responsible for the specific function of executing the operation; the execution waiting sub-state S3 sets the timeout time and performs execution waiting. When the waiting exceeds the timeout time, it enters the timeout processing sub-state S6; if the execution operation of the operation execution sub-state S2 is completed within the timeout time, it immediately jumps to the result check sub-state S4 to check the execution result; the result check sub-state S4 checks the execution results of the operation execution sub-state S2 and the execution waiting sub-state S3; the state transition sub-state S5 migrates according to the state transition table constructed in the state transition configuration sub-state S1 and jumps to the next state primitive; the timeout processing sub-state S6 performs the timeout processing action; the exception handling sub-state S7 performs the exception processing action; The process of the state primitives executing each operation during the autonomous operation of the autonomous underwater robot and the docking device is as follows: (1) Execute state transition configuration substate S1, configure state primitives for migration under different circumstances, and build a state transition table , the specific contents are as follows: ,in, Indicates the next state primitive to jump to when the operation performed by the state primitive ends normally; Indicates the maximum number of retries after timeout or exception processing. If the value is 0, no retries are required. If the value is greater than 0, retries are performed. If the current number of retries does not exceed , then jump to Otherwise jump to or ; Indicates the next state primitive to jump to when retrying. Indicates the next state primitive to jump to after timeout processing; Indicates the next state primitive to jump to after exception handling; (2) Execute the operation execution substate S2, which is responsible for executing the specific function of the operation. If the execution of the function of the operation in this substate takes some time to complete, or it is necessary to wait for the feedback of the autonomous underwater robot, a timeout is set and the execution waiting substate S3 is entered. If no waiting is required, the result checking substate S4 is entered. (3) Execute the execution waiting substate S3. The execution waiting substate S3 will set a timeout period. If the operation of the operation execution substate S2 is completed within the timeout period, the state immediately jumps to the result checking substate S4 to check the execution result; if the operation is not completed within the timeout period, the state enters the timeout processing substate S6; (4) Execution result check substate S4, check the execution results of the operation execution substate S2 and the execution waiting substate S3. If normal, enter the state migration substate S5; if abnormal, enter the exception handling substate S7; (5) Execute the state transition substate S5, according to the state transition table constructed in the state transition configuration substate S1 Make a migration and jump to the next state primitive. If the result is normal, jump to Status primitive. If a timeout or abnormal result occurs and a retry is required, jump to state, otherwise jump to or State primitives; (6) Execute the timeout processing substate S6 and perform the timeout processing action. If And the current number of retries is less than , then retry; (7) Execute the exception handling substate S7 and perform exception handling actions. If And the current number of retries is less than , then retry.
[0009] Step 3: Design autonomous operation finite state machines for the autonomous underwater robot and the docking device respectively, and combine the state primitives of each operation in the autonomous operation process; in the autonomous operation process, the autonomous underwater robot and the docking device each execute the autonomous operation finite state machine and communicate and interact to realize the autonomous operation process; The autonomous operation process is divided into three stages: the docking device exit stage, the operation monitoring and guidance stage, and the docking device return stage. In each stage, the autonomous underwater robot and the docking device execute the corresponding state machine and communicate to achieve collaboration. The autonomous operation finite state machine of the docking device is set to include an outbound docking device finite state machine D1, an operation monitoring and guidance finite state machine D2, and a backbound docking device finite state machine D3; The autonomous operation finite state machine of the autonomous underwater robot is set to include a docking device finite state machine A1, an operation monitoring and guidance finite state machine A2, and a docking device finite state machine A3; The docking device finite state machine D1 is set to realize the operation of the docking device in the docking device exit stage, including the state primitive D1-1 of checking the docking device system status, the state primitive D1-2 of replenishing energy to the autonomous underwater robot, the state primitive D1-3 of waking up the autonomous underwater robot, the state primitive D1-4 of sending environmental information, the state primitive D1-5 of waiting for the autonomous underwater robot system status check result, the state primitive D1-6 of mission task planning, the state primitive D1-7 of mission task synchronization and verification, the state primitive D1-8 of opening the locking device that fixes the autonomous underwater robot, and the state primitive D1-9 of notifying the autonomous underwater robot to exit the docking device; The operation monitoring and guidance finite state machine D2 is used to implement the operation monitoring and guidance stage docking device operation, including the state primitive D2-1 of shutting down the equipment except the communication positioning equipment, the state primitive D2-2 of monitoring the operation of the autonomous underwater robot, the state primitive D2-3 of turning on the acoustic guidance device for guidance preparation, the state primitive D2-4 of entering the acoustic guidance mode and the state primitive D2-5 of entering the optical guidance mode; The back-docking device finite state machine D3 is used to implement the operation of the docking device in the back-docking device stage, including a state primitive D3-1 for determining that the autonomous underwater robot is in place, a state primitive D3-2 for fixing the autonomous underwater robot by a locking device, a state primitive D3-3 for determining the optical communication state, a state primitive D3-4 for sending a stop command to the autonomous underwater robot, a state primitive D3-5 for waiting for the autonomous underwater robot to transmit data, a state primitive D3-6 for receiving data transmitted by the autonomous underwater robot, a state primitive D3-7 for sending a shutdown command and waiting for the autonomous underwater robot's communication to disappear, a state primitive D3-8 for replenishing energy to the autonomous underwater robot, and a state primitive D3-9 for saving all data and stopping the autonomous operation process state; The docking device exit finite state machine A1 is used to implement the operation of the autonomous underwater robot in the docking device exit stage, including a state primitive A1-1 for requesting environmental information, a state primitive A1-2 for checking the system status of the autonomous underwater robot, a state primitive A1-3 for mission task planning, a state primitive A1-4 for synchronizing and verifying the mission task, a state primitive A1-5 for starting to execute the mission task, a state primitive A1-6 for waiting for the docking device exit command, a state primitive A1-7 for retreating from the docking device, and a state primitive A1-8 for surfacing to adjust the course and perform the detection task; The operation monitoring and guidance finite state machine A2 is used to implement the operation of the autonomous underwater robot in the operation monitoring and guidance stage, including a state primitive A2-1 for navigating to the operation starting point, a state primitive A2-2 for performing detection and periodically sending state information, a state primitive A2-3 for navigating to the acoustic guidance starting point, a state primitive A2-4 for entering the acoustic guidance mode and navigating to the docking device, a state primitive A2-5 for entering the optical guidance mode and navigating to the docking device, and a state primitive A2-6 for entering the docking device and maintaining propulsion; The back-docking device finite state machine A3 is used to implement the operation of the autonomous underwater robot in the back-docking device stage, including a state primitive A3-1 for maintaining propulsion, a state primitive A3-2 for stopping propulsion and ending mission execution, a state primitive A3-3 for preparing detection and navigation data and sending transmission instructions, a state primitive A3-4 for transmitting data, a state primitive A3-5 for waiting for shutdown instructions, and a state primitive A3-6 for executing shutdown.
[0010] The beneficial effects of adopting the above technical scheme are as follows: the method for collaborative operation of an autonomous underwater robot and a docking device provided by the present invention (1) enables the autonomous underwater robot and the docking device to be independent of the support of the mother ship, without the need for manual operation, and to independently complete the operation tasks on the seabed, so that the docking device effectively supports the autonomous underwater robot in performing long-term, large-scale detection tasks, overcomes the technical difficulties of the resident scientific expedition mode, and conducts the first innovative application in the world; (2) models are built for each process of interactive collaboration, covering the entire workflow and various situation processing, and enables the docking device to replace humans in decision-making and processing on the seabed, effectively ensuring the reliability of the autonomous underwater robot operation; (3) through prefabricated tasks, the autonomous underwater robot can perform multiple operation tasks underwater and achieve detection coverage of a larger area. A large number of tests and verifications have been carried out in actual sea areas, and the results show that the present invention is reliable and effective and can improve detection efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0011] Figure 1 A schematic diagram of an autonomous underwater robot provided by an embodiment of the present invention in a docking device; Figure 2 A schematic diagram of communication of an autonomous underwater robot leaving a docking device provided by an embodiment of the present invention; Figure 3 A schematic diagram of a state primitive provided by an embodiment of the present invention; Figure 4 The overall flow chart of the autonomous operation state machine provided by the embodiment of the present invention; Figure 5 A schematic diagram of the process of the docking device exit stage provided by an embodiment of the present invention; Figure 6A schematic diagram of a docking device provided in an embodiment of the present invention waking up an autonomous underwater robot; Figure 7 A schematic diagram of the operation monitoring and guidance phase process provided by an embodiment of the present invention; Figure 8 A schematic diagram of the process of the docking device phase provided by an embodiment of the present invention.
[0012] In the figure, Y1 is the first acoustic communication positioning device; Y2 is the lighting lamp; Y3 is the locking device; Y4 is the mechanical wake-up device; Y5 is the camera; Y6 is the in-position detection switch; Y7 is the altimeter; Y8 is the depth gauge; Y9 is the inertial navigation; Y10 is the first optical communication device; Z10 is the second optical communication device; Y11 is the first wireless charging device; Z11 is the second wireless charging device; Y12 is the docking device guide light; Z1 is the second acoustic communication positioning device; Z2 is the AUV front camera. DETAILED DESCRIPTION
[0013] The specific implementation of the present invention is further described in detail below in conjunction with the accompanying drawings and examples. The following examples are used to illustrate the present invention, but are not intended to limit the scope of the present invention.
[0014] In this embodiment, based on the autonomous underwater robot and docking device collaborative operation method of the present invention, the autonomous underwater robot (AUV) and the docking device can be separated from the mother ship control, autonomously interact and cooperate underwater, complete the autonomous underwater robot preparatory work before leaving the docking device, autonomous underwater robot operation monitoring work, guide the autonomous underwater robot to return to the docking device work and the autonomous underwater robot after returning to the docking device. Processing work, to achieve multiple autonomous underwater robot detection operations. The implementation of this method can effectively extend the operation time of the autonomous underwater robot, expand the detection range of the autonomous underwater robot, so that the autonomous underwater robot has the ability to stay for a long time and regularly perform detection tasks, expand the application scenarios of the autonomous underwater robot, and has important practical significance.
[0015] In order to achieve the above functions, there are a series of challenges: First, underwater communication is complex and electromagnetic communication cannot be used. Commonly used acoustic communication has high latency and low bandwidth. Acoustic detection or ultra-short baseline positioning equipment will interfere with acoustic communication. The newly emerged underwater optical communication technology in recent years can achieve high-bandwidth communication, but there are strict restrictions on distance and relative position. The control system needs to flexibly switch the communication mode according to the position of the autonomous underwater robot and the docking device, and plan the working window of the acoustic equipment to avoid interference; secondly, in order to achieve the docking device being out of the control of the mother ship, the control software of the docking device needs to be smart enough to replace humans, handle various possible abnormal situations, execute each operation step according to the operation process, and communicate and interact when necessary to cooperate with each other to complete a single detection operation; finally, according to needs, multiple batches of tasks can be pre-compiled and downloaded to the docking device, and detection operations can be performed in sequence or according to manual instructions. The data of each operation is completely saved and uploaded to the mother ship when communication is available.
[0016] In the present embodiment, a method for collaborative operation of an autonomous underwater robot and a docking device is provided. First, a reliability communication algorithm is designed to address the problems of high latency and unreliable communication in an underwater environment, unify the communication protocols of different communication methods, and flexibly switch the optimal communication method according to the environment to ensure reliable communication between the autonomous underwater robot and the docking device. Second, each operation step in the autonomous operation process is modeled to form a "state primitive". The state primitive standardizes the state transition so that each operation step can handle normal, timeout, and abnormal results, ensuring unmanned and trouble-free operation of the docking device and the autonomous underwater robot. Third, based on the state primitive, an autonomous operation finite state machine for the autonomous underwater robot and the docking device is constructed, the various operation steps in the autonomous operation process are combined, migrated according to the state transition table, and communication interaction is performed as needed, finally forming a complete method for collaborative operation of the autonomous underwater robot and the docking device.
[0017] In order to apply the method of cooperative operation between the autonomous underwater robot and the docking device of the present invention, the hardware based on this embodiment is as follows: Figure 1 and Figure 2 As shown, Figure 1It is a schematic diagram of the autonomous underwater robot inside the docking device, which specifically includes: a first acoustic communication positioning device Y1 arranged on the docking device, used for the docking device and the autonomous underwater robot to communicate underwater, and for the docking device to obtain the relative position of the autonomous underwater robot; a lighting lamp Y2 and a camera Y5 arranged on the docking device, used to obtain the visual image of the autonomous underwater robot underwater; a locking device Y3 arranged in the docking device, used for the docking device to fix the autonomous underwater robot; a mechanical awakening device Y4 arranged on the docking device, which can be shortened and extended to touch the power switch on the autonomous underwater robot, and is used for the docking device to awaken the autonomous underwater robot in a dormant state and put it into working mode; an in-place detection switch Y6 arranged on the docking device, which is used for the docking device to detect the position of the autonomous underwater robot. The device is used to determine whether the autonomous underwater robot has reached the designated position; the altimeter Y7, depth meter Y8 and inertial navigation Y9 arranged on the docking device are used for the docking device to obtain its own position, depth, height and posture information; a first optical communication device Y10 and a second optical communication device Z10 installed in pairs on the docking device and the autonomous underwater robot are used for underwater short-range, high-speed optical communication; a first wireless charging device Y11 and a second wireless charging device Z11 installed in pairs on the docking device and the autonomous underwater robot are used for the underwater docking device to charge the autonomous underwater robot; a docking device guide light Y12 arranged on the docking device is turned on when the autonomous underwater robot returns to the docking device, and is used to indicate the position of the autonomous underwater robot underwater.
[0018] Figure 2 This is a schematic diagram of an autonomous underwater robot leaving a docking device to perform a detection mission, specifically including: a second acoustic communication positioning device Z1 arranged on the autonomous underwater robot, used for the docking device and the autonomous underwater robot to communicate underwater, and for the docking device to obtain the relative position of the autonomous underwater robot; an AUV front camera Z2 installed on the front end of the autonomous underwater robot, used for sensing the docking device guide light Y12 when the autonomous underwater robot returns to the docking device; since this method focuses on the interactive collaboration between the autonomous underwater robot and the docking device, other equipment on the autonomous underwater robot is not very relevant to this method and will not be described here.
[0019] In this embodiment, a method for cooperative operation between an autonomous underwater robot and a docking device specifically includes the following steps: Step 1: Design a reliable communication algorithm as the basis for information exchange, command issuance and data transmission between the autonomous underwater robot and the docking device. Compared with the stateless acoustic communication commonly used in the past, this algorithm uses a handshake mechanism to establish a reliable communication process to ensure that the communication channel is reliable and orderly, thus ensuring reliable communication between the autonomous underwater robot and the docking device. Defines a unified data packet transmitted by autonomous underwater robots and docking devices under different communication modes The structure is as follows: ,in, Indicates the packet sequence number , used to identify the order of data packets; Indicates the timestamp of the packet generation , Indicates the length of the transmitted data , Indicates the actual data transmitted. Indicates the cumulative checksum, and the calculation formula is: ,in, Indicates the i-th byte of the transmitted data packet, and n is the number of bytes in the transmitted data packet; The process of handshake communication between the autonomous underwater robot and the docking device is as follows: 1) The sender initiates a connection and sends a connection request packet : ; 2) After receiving the request, the receiver returns a confirmation packet : ; 3) After the sender receives the confirmation packet, it starts sending and receiving data: ; 4) The receiver calculates the cumulative checksum of the received data packet and determines whether to receive the data packet; 4.1) The receiver calculates the cumulative checksum of the received data packet: ; 4.2) If the cumulative checksum of the received data packet is inconsistent with the cumulative checksum sent by the sender, the data packet is discarded: ; 4.3) If they are consistent, a data confirmation packet is returned to the sender:
[0020] 5) If the sender does not receive the data confirmation packet within the timeout period, it resends the data packet: .
[0021] Step 2: Design state primitives for the autonomous operation process of the autonomous underwater robot and the docking device. The state primitives execute each operation in the autonomous operation process of the autonomous underwater robot and the docking device, and are used to standardize the operation execution process of the autonomous operation process of the autonomous underwater robot and the docking device; like Figure 3As shown, the state primitives are composed of seven sub-states: state transition configuration sub-state S1, operation execution sub-state S2, execution waiting sub-state S3, result check sub-state S4, state transition sub-state S5, timeout handling sub-state S6 and exception handling sub-state S7; the state transition configuration sub-state S1 configures the state primitives that migrate under different circumstances and constructs a state transition table; the operation execution sub-state S2 is responsible for the specific function of executing the operation; the execution waiting sub-state S3 sets the timeout time and performs execution waiting. When the waiting exceeds the timeout time, the execution proceeds. Enter the timeout processing substate S6; if the execution operation of the operation execution substate S2 is completed within the timeout period, immediately jump to the result checking substate S4 to check the execution result; the result checking substate S4 checks the execution results of the operation execution substate S2 and the execution waiting substate S3; the state migration substate S5 migrates according to the state migration table constructed in the state migration configuration substate S1 and jumps to the next state primitive; the timeout processing substate S6 performs the timeout processing action; the exception processing substate S7 performs the exception processing action; The state primitive corresponds to an operation in the autonomous operation process and refers to the smallest component unit for completing a task, such as turning on a device switch and checking the status, controlling the locking mechanism to lock and waiting for the locking to be completed, etc.
[0022] Each operation of the autonomous underwater robot and docking device during autonomous operation is completed in the state primitive. The execution process of the state primitive is as follows: (1) Execute state transition configuration substate S1, configure state primitives for migration under different circumstances, and build a state transition table , the specific contents are as follows: ,in, Indicates the next state primitive to jump to when the operation performed by the state primitive ends normally; Indicates the maximum number of retries after timeout or exception processing. If the value is 0, no retries are required. If the value is greater than 0, retries are performed. If the current number of retries does not exceed , then jump to Otherwise jump to or ; Indicates the next state primitive to jump to when retrying. Indicates the next state primitive to jump to after timeout processing; Indicates the next state primitive to jump to after exception handling; (2) Execute the operation execution substate S2, which is responsible for executing the specific function of the operation. If the execution of the function of the operation in this substate takes some time to complete, or it is necessary to wait for the feedback of the autonomous underwater robot, a timeout is set and the execution waiting substate S3 is entered. If no waiting is required, the result checking substate S4 is entered. (3) Execution wait substate S3. In the autonomous operation process, some operations cannot be completed immediately, such as: executing task planning takes several seconds or minutes, uploading and downloading files to the autonomous underwater robot takes several seconds or minutes, charging takes several minutes or hours, and locking and awakening the mechanism to move to the specified position takes more than ten seconds. These operations need to wait for a while after issuing instructions in the operation execution substate S2, and continuously check whether they have been executed.
[0023] Therefore, the execution waiting substate S3 sets the timeout time. If the operation of the operation execution substate S2 is completed within the timeout time, it will immediately jump to the result checking substate S4 to check the execution result; if the operation is not completed within the timeout time, such as the device switch is not turned on, the autonomous underwater robot has no communication feedback, the locking wake-up mechanism has not moved to the specified position, and the data has not been transmitted, it will enter the timeout processing substate S6; (4) Execution result check substate S4, check the execution results of the operation execution substate S2 and the execution waiting substate S3. If normal, enter the state migration substate S5; if abnormal, enter the exception handling substate S7; (5) Execute the state transition substate S5, according to the state transition table constructed in the state transition configuration substate S1 Make a migration and jump to the next state primitive. If the result is normal, jump to Status primitive. If a timeout or abnormal result occurs and a retry is required, jump to state, otherwise jump to or State primitives; (6) Execute the timeout processing substate S6 and perform the timeout processing action. If And the current number of retries is less than , then retry; (7) Execute the exception handling substate S7 and perform exception handling actions. If And the current number of retries is less than , then retry.
[0024] Each basic operation in the autonomous operation process must be designed according to the state primitives to implement the functions corresponding to the above seven sub-states to ensure that the various results of each operation step can be correctly processed, achieve state closed-loop control, ensure trouble-free operation of the system when no one is operating, and protect the equipment safety of the autonomous underwater robot and the docking device.
[0025] Step 3: Design autonomous operation finite state machines for the autonomous underwater robot and the docking device respectively, and combine the state primitives according to the state transition table; in the autonomous operation process, the autonomous underwater robot and the docking device each execute the autonomous operation finite state machine and communicate with each other to realize the autonomous operation process, such as Figure 4 As shown; The autonomous operation process is divided into three stages: the docking device exit stage, the operation monitoring and guidance stage, and the docking device return stage. In each stage, the autonomous underwater robot and the docking device execute the corresponding state machine and communicate to achieve collaboration. The autonomous operation finite state machine of the docking device is set to include an outbound docking device finite state machine D1, an operation monitoring and guidance finite state machine D2, and a backbound docking device finite state machine D3; The autonomous operation finite state machine of the autonomous underwater robot is set to include a docking device finite state machine A1, an operation monitoring and guidance finite state machine A2, and a docking device finite state machine A3; The docking device finite state machine D1 is set to realize the operation of the docking device in the docking device exit stage, including the state primitive D1-1 of checking the docking device system status, the state primitive D1-2 of replenishing energy to the autonomous underwater robot, the state primitive D1-3 of waking up the autonomous underwater robot, the state primitive D1-4 of sending environmental information, the state primitive D1-5 of waiting for the autonomous underwater robot system status check result, the state primitive D1-6 of mission task planning, the state primitive D1-7 of mission task synchronization and verification, the state primitive D1-8 of opening the locking device Y3 that fixes the autonomous underwater robot, and the state primitive D1-9 of notifying the autonomous underwater robot to exit the docking device; The operation monitoring and guidance finite state machine D2 is used to implement the operation monitoring and guidance stage docking device operation, including the state primitive D2-1 of shutting down the equipment except the communication positioning equipment, the state primitive D2-2 of monitoring the operation of the autonomous underwater robot, the state primitive D2-3 of turning on the acoustic guidance device for guidance preparation, the state primitive D2-4 of entering the acoustic guidance mode and the state primitive D2-5 of entering the optical guidance mode; The back-docking device finite state machine D3 is used to implement the operation of the docking device in the back-docking device stage, including a state primitive D3-1 for determining that the autonomous underwater robot is in place, a state primitive D3-2 for fixing the autonomous underwater robot by a locking device Y3, a state primitive D3-3 for determining the optical communication state, a state primitive D3-4 for sending a stop command to the autonomous underwater robot, a state primitive D3-5 for waiting for the autonomous underwater robot to transmit data, a state primitive D3-6 for receiving data transmitted by the autonomous underwater robot, a state primitive D3-7 for sending a shutdown command and waiting for the autonomous underwater robot's communication to disappear, a state primitive D3-8 for replenishing energy to the autonomous underwater robot, and a state primitive D3-9 for saving all data and stopping the autonomous operation process state; The docking device exit finite state machine A1 is used to implement the operation of the autonomous underwater robot in the docking device exit stage, including a state primitive A1-1 for requesting environmental information, a state primitive A1-2 for checking the system status of the autonomous underwater robot, a state primitive A1-3 for mission task planning, a state primitive A1-4 for synchronizing and verifying the mission task, a state primitive A1-5 for starting to execute the mission task, a state primitive A1-6 for waiting for the docking device exit command, a state primitive A1-7 for retreating from the docking device, and a state primitive A1-8 for surfacing to adjust the course and perform the detection task; The operation monitoring and guidance finite state machine A2 is used to implement the operation of the autonomous underwater robot in the operation monitoring and guidance stage, including a state primitive A2-1 for navigating to the operation starting point, a state primitive A2-2 for performing detection and periodically sending state information, a state primitive A2-3 for navigating to the acoustic guidance starting point, a state primitive A2-4 for entering the acoustic guidance mode and navigating to the docking device, a state primitive A2-5 for entering the optical guidance mode and navigating to the docking device, and a state primitive A2-6 for entering the docking device and maintaining propulsion; The back-docking device finite state machine A3 is used to implement the operation of the autonomous underwater robot in the back-docking device stage, including a state primitive A3-1 for maintaining propulsion, a state primitive A3-2 for stopping propulsion and ending mission execution, a state primitive A3-3 for preparing detection and navigation data and sending transmission instructions, a state primitive A3-4 for transmitting data, a state primitive A3-5 for waiting for shutdown instructions, and a state primitive A3-6 for executing shutdown.
[0026] In this embodiment, in the autonomous operation process, the specific operation contents of the docking device and the autonomous underwater robot at each stage are as follows: 1. Docking device stage Before the autonomous underwater robot performs the detection operation, the docking device and the autonomous underwater robot perform various preparations through the docking device finite state machine D1 and the docking device finite state machine A1; Figure 5As shown, the left side represents the docking device finite state machine of the docking device, and the right side represents the docking device finite state machine of the autonomous underwater robot. Each box represents a state primitive, and the specific execution process is: F11: Execute the state primitive D1-1 of system status check, detect the system status of the docking device itself, and check the status of each device included in the docking device to ensure that the operating conditions are met, including: equipment switch power supply detection, equipment communication detection, equipment action feedback detection and external environment detection; if the system detection is normal, jump to the next state primitive, otherwise shut down all devices, stop subsequent operations, and terminate the autonomous operation process; F12: Execute the state primitive D1-2 for replenishing energy to the autonomous underwater robot, control the wireless charging device Y11 in the docking device to replenish energy to the autonomous underwater robot, and detect the battery voltage of the autonomous underwater robot in real time. When it is fully charged, that is, when the battery voltage of the autonomous underwater robot reaches the set upper limit, stop charging and jump to the next state primitive, otherwise shut down all equipment, stop subsequent operations, and terminate the autonomous operation process.
[0027] The state primitive D1-3 of the autonomous underwater robot is awakened, and the mechanical awakening device Y4 in the docking device or the first wireless charging device Y11 is controlled to awaken the autonomous underwater robot, and the autonomous underwater robot is awakened from the shutdown dormant state to the power-on state; there are two ways to awaken the autonomous underwater robot, such as Figure 6 As shown, specifically: the first method is to transmit the electrical signal of the docking device to the second wireless charging device Z11 of the autonomous underwater robot in a contactless manner through the first wireless charging device Y11, and the second wireless charging device Z11 converts it into an electrical control signal for turning on the power supply, and the power switch of the autonomous underwater robot system is directly controlled by this electrical control signal to close, thereby turning on the power supply of the autonomous underwater robot system, and the control computer of the autonomous underwater robot is powered on and started; the second method is to extend the mechanical structure and touch the mechanical switch of the autonomous underwater robot through the mechanical awakening device Y4, so as to turn on the power supply of the autonomous underwater robot system, and the control computer of the autonomous underwater robot is powered on and started; the above two methods, either of which is effective, can realize the awakening and starting operation of the autonomous underwater robot.
[0028] Based on the above two methods, the process of single awakening of the autonomous underwater robot is as follows: the docking device wakes up the autonomous underwater robot through the first wireless charging device Y11. After the autonomous underwater robot is started, it sends a wake-up feedback to the docking device. If the docking device receives the feedback within the set time T1 (T1 is 5 minutes), the wake-up is successful; if the docking device does not receive the wake-up start feedback of the autonomous underwater robot after the T1 time, the docking device triggers the mechanical start switch of the autonomous underwater robot through the mechanical extension and contraction of the mechanical awakening device Y4 to realize the awakening of the autonomous underwater robot. Similarly, after the autonomous underwater robot is awakened and started, the wake-up start confirmation is completed with the docking device; if the wake-up feedback is not received again after the T1 time, the single awakening fails.
[0029] If the autonomous underwater robot is awakened successfully, it jumps to the next state primitive, otherwise it shuts down all devices and terminates the autonomous operation process; F13: Execute the state primitive A1-1 for requesting environmental information and the state primitive D1-4 for sending environmental information. The autonomous underwater robot sends a request to obtain data to the docking device, including: current time, current position (latitude and longitude), current water depth, heading angle, roll angle, pitch angle, depth and height information of the docking device. After receiving the request, the docking device sends various information in sequence. If the data is sent and received normally, the autonomous underwater robot and the docking device jump to the next state primitive, otherwise retry 3 times. If it still fails after retry, all equipment will be turned off and the autonomous operation process will be terminated.
[0030] F14: state primitives A1-2 for executing system status check and state primitives D1-5 for waiting for the results of the autonomous underwater robot system status check. The autonomous underwater robot executes the system to detect the working status of its own system, including: equipment switch power supply detection, equipment communication detection, equipment action feedback detection, external environment detection, and feeds back the detection results to the docking device. If the autonomous underwater robot system detection is normal, the autonomous underwater robot and the docking device jump to the next state, otherwise the autonomous underwater robot and the docking device terminate the operation, turn off all their own equipment, stop subsequent operations, and terminate the autonomous operation process.
[0031] F15: Execute the state primitives D1-6 and A1-3 of mission task planning. The autonomous underwater robot and the docking device respectively carry out task planning according to the same operation requirement and generate the mission task files required for mission execution. If the planning is successful, the autonomous underwater robot and the docking device jump to the next state primitive, otherwise, retry 3 times. If it still fails after retry, all equipment will be shut down and the autonomous operation process will be terminated.
[0032] F16: Execute the state primitives D1-7 and A1-4 of mission synchronization and verification. The autonomous underwater robot and the docking device exchange the mission file information generated by each other for comparison and verification. If the mission files generated by the two are consistent, the autonomous underwater robot and the docking device jump to the next state primitive, otherwise shut down all equipment and terminate the autonomous operation process.
[0033] F17: Execute the state primitive D1-8 of opening and locking and the state primitive A1-5 of starting the mission task. The docking device opens the locking device Y3 used to fix the autonomous underwater robot, so that the autonomous underwater robot is in an unrestrained state. If the locking device Y3 opens normally, it jumps to the next state primitive. Otherwise, it notifies the autonomous underwater robot to terminate the operation together, shut down all their respective equipment, and stop subsequent operations. The autonomous underwater robot starts to perform the mission task. The equipment of the autonomous underwater robot enters the detection operation state, the sonar starts to work, and the navigation control function is started. If the mission is started normally, it jumps to the next state. Otherwise, it notifies the docking device to terminate the operation together, shut down all their respective equipment, and stop subsequent operations.
[0034] F18: Execute the state primitive D1-9 that notifies the autonomous underwater robot to exit the docking device and the state primitive A1-6 that waits for the command to exit the docking device. The autonomous underwater robot waits for the docking device command. When the docking device determines that the locking device Y3 is opened normally, it will issue the autonomous underwater robot navigation command. At this time, the autonomous underwater robot enters the navigation state and jumps to the next state primitive respectively.
[0035] F19: Execute state primitive A1-7 of retreating and exiting the docking device. At this time, the autonomous underwater robot controls the propeller to rotate so that the autonomous underwater robot retreats and is pushed out of the docking device. After a period of time, it is determined whether it is successfully pushed out of the docking device. If normal, it jumps to the next state primitive, otherwise it notifies the docking device, and the docking device re-locks the autonomous underwater robot, terminates the operation together, shuts down all their respective equipment, stops subsequent operations, and terminates the autonomous operation process.
[0036] F110: Execute state primitive A1-8 of surfacing and adjusting heading to perform detection mission. At this time, the autonomous underwater robot has been pushed out of the docking device. In order to avoid collision with each other, the autonomous underwater robot needs to first float to a certain height on the original ground and sail to the detection starting point to start the detection mission.
[0037] At this point, the autonomous underwater robot and the docking device have completed their operational tasks in the docking device phase and entered the operation monitoring and guidance phase.
[0038] 2. Operation Monitoring and Guidance Phase During this phase, the autonomous underwater robot performs detection operations and periodically reports status, while the docking device performs monitoring and guidance work. Figure 7 As shown, the left side represents the operation monitoring and guidance finite state machine of the docking device, and the right side represents the operation monitoring and guidance finite state machine of the autonomous underwater robot. Each box represents a state primitive, and the specific execution process is: F21: Execute the state primitive D2-1 of shutting down all devices except the communication and positioning device and the state primitive A2-1 of sailing to the operation starting point. At this time, the docking device shuts down all devices except the communication and positioning device to save power during the autonomous underwater robot's detection mission. After completion, it automatically jumps to the next state primitive. At this time, the autonomous underwater robot sails to the starting point of the detection operation and automatically enters the next state primitive.
[0039] F22: Execute the state primitive D2-2 for monitoring the operation of the autonomous underwater robot and the state primitive A2-2 for performing detection and periodically sending status information. The docking device turns on the acoustic communication device and receives acoustic information from the autonomous underwater robot. If the return command of the autonomous underwater robot is received, it jumps to the next state primitive; if the communication is abnormal, it attempts to restart the device; if the abnormal operation command of the autonomous underwater robot is received, the operation information of the autonomous underwater robot is recorded, and the device is turned off to terminate the entire process. The autonomous underwater robot performs the detection task and periodically sends its own status data. If the task is completed, it sends a return command; if the status is abnormal, it sends a fault message, and jettisons the load to float up, ending the autonomous operation process.
[0040] F23: Execute the state primitive D2-3 of guidance preparation and the state primitive A2-3 of navigating to the starting point of acoustic guidance. The docking device turns on the acoustic guidance device. If the device is turned on abnormally, it will be turned off and restarted; if it is normal, it will jump to the next state primitive. The autonomous underwater robot uses its own navigation to return to the vicinity of the docking device. If the state is abnormal, it will send a fault message, and jettison the load to float up, ending the autonomous operation process.
[0041] F24: state primitive D2-4 for entering the acoustic guidance mode and state primitive A2-4 for entering the acoustic guidance mode and navigating to the docking device. At this time, the docking device continues to use the ultra-short baseline positioning method to obtain the relative position of the autonomous underwater robot, and sends it to the autonomous underwater robot through the acoustic communication positioning device. When it is detected that the autonomous underwater robot is less than 50 meters away from the docking device, it jumps to the next state. At this time, the autonomous underwater robot receives the guidance information, continuously corrects its own position and navigates to the docking device. If the state is abnormal, it sends a fault message, and discards the load and floats up, ending the autonomous operation process. If during the navigation process, the docking device guidance light Y12 is observed through the AUV front camera Z2, it jumps to the next state primitive.
[0042] F25: Execute the state primitive D2-5 of entering the optical guidance mode and the state primitive A2-5 of entering the optical guidance mode and sailing to the docking device. The docking device turns on the docking device guidance light Y12 to indicate the position to the autonomous underwater robot. The autonomous underwater robot uses the docking device guidance light Y12 observed by the AUV front camera Z2 to calculate the docking device position, and continuously sails close to the docking device. When it is 2 meters close to the docking device, it corrects its own position and posture, ensures that it is aligned with the center of the docking device, and then jumps to the next state primitive.
[0043] F26: Execute state primitive A2-6 of entering the docking device and maintaining propulsion. The autonomous underwater robot aligns with the center of the docking device, turns on the thrusters to propel forward, enters the docking device, and maintains the thruster output to hold the front of the docking device.
[0044] At this point, the operation monitoring and guidance phase of the autonomous underwater robot and docking device has completed its mission and entered the next phase.
[0045] 3. Back to docking stage In this stage, after the autonomous underwater robot returns to the docking device, the docking device locks the autonomous underwater robot, interacts with the autonomous underwater robot to complete data synchronization, and finally the docking device replenishes energy to the autonomous underwater robot. Figure 8 As shown, the left side represents the docking device finite state machine of the docking device, and the right side represents the docking device finite state machine of the autonomous underwater robot. Each box represents a state primitive, and the specific execution process is: F31: Execute the state primitive D3-1 of the autonomous underwater robot's arrival judgment and the state primitive A3-1 of maintaining the propulsion state. The docking device determines whether the autonomous underwater robot has accurately entered the designated position of the docking device through the arrival detection switch Y6. If the autonomous underwater robot has entered the designated docking position, the arrival detection switch Y6 will be triggered and the docking device will jump to the next state primitive. The autonomous underwater robot maintains a large thrust and continues to propel forward. It stops propulsion for 30 seconds every 2 minutes and uses the guide device of the docking device to correct the position.
[0046] F32: Execute the state primitive D3-2 of fixing the autonomous underwater robot through the locking device Y3. The docking device presses the autonomous underwater robot through the locking device Y3, so that the autonomous underwater robot is completely fixed inside the docking device. When the locking is completed, jump to the next state primitive. If the locking is abnormal, try to restart the device and re-execute the locking operation.
[0047] F33: State element D3-3 for executing optical communication state judgment. After the docking device fixes the autonomous underwater robot, the first optical communication device Y10 of the docking device and the second optical communication device Z10 of the autonomous underwater robot are in alignment. The docking device determines whether communication is established. If there is no communication within 1 minute, it means that the position of the autonomous underwater robot is inaccurate. At this time, the locking device Y3 is opened and the locking is re-executed. If the communication is normal, it jumps to the next state.
[0048] F34: Executes the state primitive D3-4 of sending a stop command and the state primitive A3-2 of stopping propulsion and ending mission execution. The docking device sends a stop propulsion command to the autonomous underwater robot. After receiving the command, the autonomous underwater robot gives feedback, stops propulsion, ends mission execution and jumps to the next state primitive.
[0049] F35: Execute the state primitive D3-5 of waiting for the autonomous underwater robot data transmission and the state primitive A3-3 of data ready and sending transmission instructions. The docking device waits for the autonomous underwater robot data transmission instruction. If the instruction is received, it will give feedback and jump to the next state primitive. The autonomous underwater robot compresses the detection data and navigation data, and sends the data transmission instruction to the docking device when it is ready, and waits for feedback.
[0050] F36: Execute the state primitive D3-6 for receiving the autonomous underwater robot data and the state primitive A3-4 for transmitting the data. The docking device obtains the autonomous underwater robot data through the network. When the data transmission is completed, it is verified by the MD5 value. If the verification passes, it jumps to the next step, otherwise it re-acquires the autonomous underwater robot data. The autonomous underwater robot waits for the data transmission to be completed and jumps to the next state primitive.
[0051] F37: Execute the state primitive D3-7 of sending the shutdown command and waiting for the autonomous underwater robot communication to disappear and the state primitive A3-5 of waiting for the shutdown command state. The docking device sends a shutdown command to the autonomous underwater robot, receives the command feedback, and determines whether the autonomous underwater robot successfully executes the shutdown through the communication status. After receiving the shutdown command, the autonomous underwater robot executes the shutdown action, shuts down the software system and the system power supply.
[0052] F38: Executes the state primitive D3-8 for replenishing energy to the autonomous underwater robot and the state primitive A3-6 for executing the shutdown state. The docking device replenishes energy to the autonomous underwater robot through the first wireless charging device Y11 of the autonomous underwater robot, and constantly detects the battery voltage of the autonomous underwater robot. When the battery voltage of the autonomous underwater robot reaches half charge, that is, when the battery voltage of the autonomous underwater robot reaches the set upper limit, the charging is stopped and the process jumps to the next state primitive.
[0053] F39: Execute the state primitive D3-9 for saving all data and stopping the autonomous operation process. The docking device saves all data generated by this autonomous operation process to the specified location, stops the autonomous operation process, and ends and returns to the docking device state machine.
[0054] At this point, the autonomous underwater robot and the docking device complete the operation task in the docking device phase, complete the single autonomous operation process, and the docking device and the autonomous underwater robot enter the standby state as a whole until the next autonomous operation. The autonomous underwater robot and the docking device use this method to autonomously handle various possible situations, plan and continuously execute multiple autonomous operation processes, stay on the seabed for a long time, perform detection tasks regularly or as needed, and realize long-term, large-scale, and multi-batch autonomous underwater robot detection operations.
[0055] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some or all of the technical features therein. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope defined by the claims of the present invention.
Claims
1. A method for collaborative operation of an autonomous underwater robot and a docking device, characterized by: The following steps are involved: Step 1: Use the handshake mechanism to establish a communication process, which serves as the basis for information exchange, command issuance, and data transmission between the autonomous underwater robot and the docking device, ensuring reliable communication between the autonomous underwater robot and the docking device; Step 2: Design state primitives for the autonomous operation process of the autonomous underwater robot and the docking device. The state primitives execute each operation in the autonomous operation process of the autonomous underwater robot and the docking device, and are used to standardize the operation execution process of the autonomous operation process of the autonomous underwater robot and the docking device; Step 3: Design autonomous operation finite state machines for the autonomous underwater robot and the docking device respectively, and combine the state primitives of each operation in the autonomous operation process; in the autonomous operation process, the autonomous underwater robot and the docking device each execute the autonomous operation finite state machine and communicate with each other to realize the autonomous operation process.
2. The method for cooperative operation of an autonomous underwater robot and a docking device according to claim 1, characterized in that: The specific method of step 1 is: Define a unified data packet transmitted by autonomous underwater vehicles and docking devices under different communication modes The structure is as follows: ,in, Indicates the packet sequence number , used to identify the order of data packets; Indicates the timestamp of the packet generation , Indicates the length of the transmitted data , Indicates the actual data transmitted, Indicates the cumulative checksum; The handshake communication process between the autonomous underwater robot and the docking device is as follows: 1) The sender initiates a connection and sends a connection request packet ; 2) After receiving the request, the receiver returns a confirmation packet ; 3) After the sender receives the confirmation packet, it starts sending and receiving data; 4) The receiver calculates the cumulative checksum of the received data packet and determines whether to receive the data packet; 4.1) The receiver calculates the cumulative checksum of the received data packet; 4.2) If the cumulative checksum of the received data packet is inconsistent with the cumulative checksum sent by the sender, the data packet is discarded: 4.3) If they are consistent, a data confirmation packet is returned to the sender; 5) If the sender does not receive the data confirmation packet within the timeout period, it resends the data packet.
3. The method for cooperative operation between an autonomous underwater robot and a docking device according to claim 2, characterized in that: The state primitives in step 2 are composed of seven sub-states: state transition configuration sub-state S1, operation execution sub-state S2, execution waiting sub-state S3, result check sub-state S4, state transition sub-state S5, timeout handling sub-state S6 and exception handling sub-state S7; the state transition configuration sub-state S1 configures the state primitives to be migrated under different circumstances and constructs a state transition table; the operation execution sub-state S2 is responsible for the specific function of executing the operation; the execution waiting sub-state S3 sets a timeout time and performs execution waiting. When the waiting time exceeds the timeout time, the timeout handling sub-state S6 is entered; if the execution operation of the operation execution sub-state S2 is completed within the timeout time, the state immediately jumps to the result check sub-state S4 to check the execution result; the result check sub-state S4 checks the execution results of the operation execution sub-state S2 and the execution waiting sub-state S3; The state migration sub-state S5 migrates according to the state migration table constructed in the state migration configuration sub-state S1 and jumps to the next state primitive; the timeout processing sub-state S6 performs a timeout processing action; the exception processing sub-state S7 performs an exception processing action.
4. The method for cooperative operation between an autonomous underwater robot and a docking device according to claim 3, characterized in that: The process of the state primitives executing each operation during the autonomous operation of the autonomous underwater robot and the docking device is as follows: (1) Execute state transition configuration sub-state S1, configure state primitives for migration under different circumstances, and build a state transition table , the specific contents are as follows: ,in, Indicates the next state primitive to jump to when the operation performed by the state primitive ends normally; Indicates the maximum number of retries after timeout or exception handling. If the value is 0, no retry is required. If the value is greater than 0, retry is performed. If the current number of retries does not exceed , then jump to Otherwise jump to or ; Indicates the next state primitive to jump to when retrying. Indicates the next state primitive to jump to after timeout processing; Indicates the next state primitive to jump to after exception handling; (2) Execute the operation execution sub-state S2, which is responsible for executing the specific function of the operation; if the function of the operation in this sub-state takes some time to complete, or it is necessary to wait for feedback from the autonomous underwater robot, a timeout is set and the execution wait sub-state S3 is entered. If no waiting is required, the result check sub-state S4 is entered; (3) Execute the execution waiting sub-state S3. The execution waiting sub-state S3 will set a timeout period. If the operation of the execution sub-state S2 is completed within the timeout period, the state immediately jumps to the result checking sub-state S4 to check the execution result. If the operation is not completed within the timeout period, the state enters the timeout processing sub-state S6. (4) Execution result check substate S4, check the execution results of the operation execution substate S2 and the execution waiting substate S3. If normal, enter the state migration substate S5; if abnormal, enter the exception handling substate S7; (5) Execute the state transition sub-state S5 and configure the state transition table constructed in the state transition sub-state S1. Make a transition, jump to the next state primitive, and if the result is normal, jump to Status primitive, if timeout or result is abnormal and retry is required, jump to state, otherwise jump to or State primitives; (6) Execute the timeout processing sub-state S6 and perform the timeout processing action. If And the current number of retries is less than , then retry; (7) Execute exception handling sub-state S7 and perform exception handling actions. If And the current number of retries is less than , then retry.
5. The method for cooperative operation between an autonomous underwater robot and a docking device according to claim 4, characterized in that: The specific method of step 3 is: The autonomous operation process is divided into three stages: the docking device exit stage, the operation monitoring and guidance stage, and the docking device return stage. In each stage, the autonomous underwater robot and the docking device execute their own state machines and communicate to achieve collaboration. The autonomous operation finite state machine of the docking device is set to include an exit docking device finite state machine D1, an operation monitoring and guidance finite state machine D2, and a return docking device finite state machine D3; the exit docking device finite state machine D1 is used to implement the operation of the docking device in the exit docking device phase; the operation monitoring and guidance finite state machine D2 is used to implement the operation of the docking device in the operation monitoring and guidance phase, and the return docking device finite state machine D3 is used to implement the operation of the docking device in the return docking device phase; The autonomous operation finite state machine of the autonomous underwater robot is set to include a docking device finite state machine A1, an operation monitoring and guidance finite state machine A2, and a docking device return finite state machine A3; the docking device finite state machine A1 is used to implement the operation of the autonomous underwater robot in the docking device exit stage, the operation monitoring and guidance finite state machine A2 is used to implement the operation of the autonomous underwater robot in the operation monitoring and guidance stage, and the docking device return finite state machine A3 is used to implement the operation of the autonomous underwater robot in the docking device return stage.
6. The method for cooperative operation between an autonomous underwater robot and a docking device according to claim 5, characterized in that: The docking device exit finite state machine D1 includes a state primitive D1-1 for checking the docking device system status, a state primitive D1-2 for replenishing energy to the autonomous underwater robot, a state primitive D1-3 for waking up the autonomous underwater robot, a state primitive D1-4 for sending environmental information, a state primitive D1-5 for waiting for the autonomous underwater robot system status check result, a state primitive D1-6 for mission task planning, a state primitive D1-7 for mission task synchronization and verification, a state primitive D1-8 for opening the locking device that fixes the autonomous underwater robot, and a state primitive D1-9 for notifying the autonomous underwater robot to exit the docking device; The operation monitoring and guidance finite state machine D2 includes a state primitive D2-1 for shutting down devices other than the communication and positioning device, a state primitive D2-2 for monitoring the operation of the autonomous underwater robot, a state primitive D2-3 for turning on the acoustic guidance device for guidance preparation, a state primitive D2-4 for entering the acoustic guidance mode, and a state primitive D2-5 for entering the optical guidance mode; The docking device finite state machine D3 includes a state primitive D3-1 for determining the position of the autonomous underwater robot, a state primitive D3-2 for fixing the autonomous underwater robot by a locking device, a state primitive D3-3 for determining the optical communication state, a state primitive D3-4 for sending a stop command to the autonomous underwater robot, a state primitive D3-5 for waiting for the autonomous underwater robot to transmit data, a state primitive D3-6 for receiving data transmitted by the autonomous underwater robot, a state primitive D3-7 for sending a shutdown command and waiting for the autonomous underwater robot to lose communication, a state primitive D3-8 for replenishing energy to the autonomous underwater robot, and a state primitive D3-9 for saving all data and stopping the autonomous operation process. The docking device finite state machine A1 includes a state primitive A1-1 for requesting environmental information, a state primitive A1-2 for checking the status of the autonomous underwater robot system, a state primitive A1-3 for mission planning, a state primitive A1-4 for synchronizing and verifying the mission, a state primitive A1-5 for starting to execute the mission, a state primitive A1-6 for waiting for the docking device command, a state primitive A1-7 for withdrawing from the docking device, and a state primitive A1-8 for surfacing, adjusting the course, and executing the detection mission; The operation monitoring and guidance finite state machine A2 includes a state primitive A2-1 for navigating to the operation starting point, a state primitive A2-2 for performing detection and periodically sending status information, a state primitive A2-3 for navigating to the acoustic guidance starting point, a state primitive A2-4 for entering the acoustic guidance mode and navigating to the docking device, a state primitive A2-5 for entering the optical guidance mode and navigating to the docking device, and a state primitive A2-6 for entering the docking device and maintaining propulsion; The back-docking device finite state machine A3 includes a state primitive A3-1 for maintaining propulsion, a state primitive A3-2 for stopping propulsion and ending mission execution, a state primitive A3-3 for preparing detection and navigation data and sending transmission instructions, a state primitive A3-4 for transmitting data, a state primitive A3-5 for waiting for shutdown instructions, and a state primitive A3-6 for executing shutdown.
Citation Information
Patent Citations
AUV long-term residence system based on marine environment energy
CN111377041A
Modularized remote multi-base-station cooperative control system and method for unmanned surface vehicle
CN115857490A
Underwater robot long-term residence control system and method based on base station
CN116062128A
Cited By
Underwater robot docking system and method, electronic equipment and storage medium
CN119902548A
