Underwater robot docking and capture control system, method and computer equipment

Abstract

The present invention discloses an underwater robot docking and capturing control system, method and computer equipment. The underwater robot docking and capturing control system comprises: at least two docking robots, which are used to dock and capture a target device at the same time; a mother body, which is located underwater and below the target device when docking and capturing the target device; at least two cables, which correspond one to one with the at least two docking robots, and each docking robot is connected to the mother body via a cable; a retracting device, which is located on the mother body and is used to drive the cables to retract, thereby driving the target device captured by the docking robot to be recovered; a positioning device, which comprises a long-distance positioning device and a short-distance positioning device. The long-distance positioning device is used to position the target device in the initial stage when the docking robot leaves the mother body, and the short-distance positioning device is used to accurately position the target device at close range when the docking robot approaches the target device.

Description

Technical Field

[0001] The present invention belongs to the field of underwater robots and control technologies, and in particular relates to an underwater robot docking and capturing control system, method and computer equipment. Background Art

[0002] With the rise of marine engineering, deep-sea underwater operations are becoming increasingly common. Existing underwater object grasping tasks are mostly performed by manipulators or flexible arms. However, for smaller target devices, manipulators struggle to reliably grasp them. Manipulators typically have rigid contact, which can cause collisions and damage to the target device, while flexible arms lack sufficient gripping force. Furthermore, the underwater environment is complex and subject to significant external disturbances, rendering the target device uncontrollable. This makes it impossible to guarantee the target device's posture and position during docking, easily causing collisions or preventing docking locks.

[0003] Therefore, it is necessary to improve the existing technology and provide an underwater robot docking and capture control system and method for the complex underwater environment to ensure accurate docking with the target equipment and achieve smooth and reliable recovery. Summary of the Invention

[0004] In response to the above-mentioned defects or improvement needs of the prior art, the present invention proposes an underwater robot docking and capture control system, method and computer equipment, which can ensure accurate docking and locking of the target device in complex underwater environments and achieve smooth and reliable recovery.

[0005] To achieve the above objectives, in some embodiments, an underwater robot docking and capture control system is proposed, wherein the underwater robot docking and capture control system comprises:

[0006] At least two docking robots, wherein the at least two docking robots are used to simultaneously dock and capture a target device;

[0007] a mother body, wherein when docking and capturing the target device, the mother body is located underwater and below the target device;

[0008] At least two cables, the at least two cables corresponding to the at least two docking robots one by one, each of the docking robots being connected to the mother body via one of the cables;

[0009] a retrieving device, the retrieving device being located on the mother body and configured to drive the cable to retract, thereby driving the target device captured by the docking robot to be recovered;

[0010] The positioning device includes a long-distance positioning device and a short-distance positioning device. The long-distance positioning device is used to position the target device in the initial stage when the docking robot leaves the mother body, and the short-distance positioning device is used to accurately position the target device at a close distance when the docking robot approaches the target device.

[0011] In some embodiments, the long-distance positioning device includes a sonar positioning device, and the short-distance positioning device includes a camera and an image processing module.

[0012] In some embodiments, the camera includes a first camera;

[0013] The first camera is used to perform panoramic photography of the target device to obtain at least a first image and a second image including a panoramic image of the target device;

[0014] The image processing module is used to perform image recognition and / or segmentation on the first image and the second image, perform rough positioning, obtain the rough position of the docking port on the target device, and obtain the position difference between the first image and the second image, and obtain the rough position change speed and direction of the target device based on the shooting time and position difference between the first image and the second image.

[0015] In some embodiments, the camera includes a second camera;

[0016] The second camera is used to perform close-range micro-focus photography of the docking interface to obtain at least a third image and a fourth image including macro images of the docking interface and the positioning protrusion in the docking interface;

[0017] The image processing module is used to perform image recognition and / or segmentation on the third image and the fourth image, and perform precise positioning to obtain the precise position of the docking interface and the positioning protrusion on the target device; at the same time, obtain the position difference between the third image and the fourth image, and obtain the precise position change speed and direction of the target device based on the shooting time and position difference between the third image and the fourth image.

[0018] In some embodiments, the camera includes a third camera, and there are two docking robots, including a first docking robot and a second docking robot. Each docking robot has the third camera and an image calibration device. The third camera is used to capture a fifth image of the first docking robot including the image calibration device and a sixth image of the second docking robot.

[0019] The image processing module is used to process the fifth image and the sixth image, and determine the relative distance and orientation of the first docking robot and the second docking robot according to the image calibration device.

[0020] In some embodiments, the underwater robot docking and capture control system also includes a motion control device, which is used to control the movement of the first docking robot and the second docking robot according to the relative distance and orientation of the first docking robot and the second docking robot, so that the relative distance between the first docking robot and the second docking robot matches the distance between the two docking ports of the target device and remains unchanged, and the orientation of the first docking robot and the second docking robot matches the posture of the target device.

[0021] In some embodiments, an underwater robot docking and capture control method is also provided, which uses any of the underwater robot docking and capture control systems described above to complete the docking of the docking robot with the target device.

[0022] In some embodiments, the control method includes:

[0023] Obtaining the position of the target device located by a remote positioning device;

[0024] driving the docking robot to move toward the target device;

[0025] Obtaining the position of the target device accurately located by a short-range positioning device;

[0026] The docking robot is locked in position with the target device to complete the docking.

[0027] In some embodiments, the step of locking the position of the docking robot and the target device includes:

[0028] According to the precise position change speed and direction of the target device, and the relative distance and orientation between the first docking robot and the second docking robot, the positions of the first docking robot and the second docking robot are respectively locked with the positions of the two docking ports of the target device.

[0029] In some embodiments, a computer device is also provided, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements any of the above control methods when executing the program.

[0030] Compared with the prior art, the above embodiments of the present invention have at least the following beneficial effects: when docking and capturing the target device, the mother body is located underwater, and the mother body is located below the target device. Active capture is completed by docking the docking robot with the target device underwater. In addition, a long-distance positioning device and a short-distance positioning device are used to target the complex underwater environment. The long-distance positioning device is used to locate the target device in the initial stage when the docking robot leaves the mother body, and the short-distance positioning device is used to accurately locate the target device at close range when the docking robot approaches the target device, thereby ensuring accurate docking and locking of the target device. Furthermore, a third camera is used to determine the relative distance and orientation of the first docking robot and the second docking robot by capturing the fifth image of the first docking robot and the sixth image of the second docking robot, including the image calibration device, so that the positions of the first docking robot and the second docking robot are respectively locked to the positions of the two docking ports of the target device. BRIEF DESCRIPTION OF THE DRAWINGS

[0031] Figure 1 This is a structural block diagram of an underwater robot docking and capture control system according to one embodiment of the present invention.

[0032] Figure 2 The figure is a schematic structural diagram of an underwater robot docking and capture control system according to an embodiment of the present invention.

[0033] Figure 3 This is a schematic diagram of the docking status of an underwater device and a docking robot according to an embodiment of the present invention.

[0034] Figure 4 Schematic diagram of the structure of a docking robot according to an embodiment of the present invention.

[0035] Figure 5 The figure is a schematic structural diagram of a docking device for underwater equipment according to an embodiment of the present invention.

[0036] Figure 6 This is a schematic diagram of an embodiment of the present invention when the docking pin is fully inserted into the docking port to complete docking.

[0037] Figure 7 This is a partial cross-sectional schematic diagram of an embodiment of the present invention when the docking pin fully enters the docking port to complete docking.

[0038] Figure 8 for Figure 7 A local enlarged schematic diagram of point A in the middle.

[0039] Figure 9 Schematic diagram of the cross-sectional structure of a zero-gravity cable according to an embodiment of the present invention.

[0040] Figure 10 FIG. 1 is a schematic cross-sectional structural diagram of a control valve of a zero-gravity cable according to an embodiment of the present invention.

[0041] Figure 11 for Figure 4 Schematic diagram of the AA section.

[0042] Figure 12 Schematic diagram of a zero-gravity cable having three air-filled cavities according to one embodiment of the present invention.

[0043] Figure 13 Schematic diagram of the composite material layer structure of a zero-gravity cable according to one embodiment of the present invention.

[0044] Figure 14 FIG. 1 is a schematic cross-sectional view of a zero-gravity cable according to an embodiment of the present invention.

[0045] Figure 15 Schematic diagram of the inflatable support structure of a zero-gravity cable according to one embodiment of the present invention.

[0046] Figure 16 Schematic diagram of the force state of the underwater robot docking and capture control system during the target device recovery process of an embodiment of the present invention; (a) is a schematic diagram of the target device in a balanced state, and (b) is a schematic diagram of the target device in a tilted state.

[0047] Figure 17 FIG. 1 is a schematic diagram of an electronic device according to an embodiment of the present invention. DETAILED DESCRIPTION

[0048] The following describes embodiments of the present invention with reference to the accompanying drawings. Those skilled in the art will recognize that the described embodiments may be modified in various ways or combinations thereof without departing from the spirit and scope of the present invention. Therefore, the drawings and description are illustrative in nature and are not intended to limit the scope of the claims. Furthermore, throughout this specification, the drawings are not drawn to scale, and like reference numerals represent like parts.

[0049] Figure 1 This is a structural block diagram of an underwater robot docking and capture control system according to one embodiment of the present invention. Figure 2 FIG1 is a schematic diagram of an underwater robot docking and capture control system according to an embodiment of the present invention. Figure 1 and Figure 2 As shown, the underwater robot docking and capture control system includes:

[0050] At least two docking robots 3000, wherein the at least two docking robots are used to simultaneously dock and capture a target device 2000;

[0051] a mother body 4000, which is located underwater and below the target device when docking and capturing the target device;

[0052] At least two cables 1000, each of the at least two cables corresponding to the at least two docking robots, each of the docking robots being connected to the mother body via one of the cables;

[0053] A retrieving device 5000 is located on the mother body and is used to drive the cable to retract, thereby driving the target device captured by the docking robot to be recovered;

[0054] The positioning device includes a long-distance positioning device and a short-distance positioning device. The long-distance positioning device is used to position the target device in the initial stage when the docking robot leaves the mother body, and the short-distance positioning device is used to accurately position the target device at a close distance when the docking robot approaches the target device.

[0055] In an embodiment of the present application, the docking robot 3000 is used to dock and capture the target device 2000. The target device 2000 may be a submerged device, and in some embodiments, may be an underwater robot. In some embodiments, the target device is a powered underwater device. When capturing the target device 2000, the mother body 4000 is located underwater, the target device 2000 is located on the water surface or in the water, and the mother body 4000 is located below the target device 2000.

[0056] In some embodiments, the mother body 4000 has a collection device 5000 and a buffer locking mechanism 6000. The collection device 5000 is used to drive the cable 1000 to retract, thereby driving the captured target device 2000 to be recovered. The buffer locking mechanism 6000 is used to buffer the collision when the target device 2000 approaches the mother body 4000 and lock the target device 2000 to the mother body 4000.

[0057] It is understood that target device 2000 is an underwater device, which can be located on the water surface or in the water. Being underwater means that the entire underwater device is completely below the water surface. Being on the water surface means that at least a portion of the underwater device is above the water surface, but the bottom surface of the underwater device is at least in contact with the water surface or is located below the water surface. At least the bottom surface of the underwater device is located below the water surface, and the underwater device may be an underwater robot.

[0058] In some embodiments, the underwater device may have a drive source that can drive the underwater device. In some embodiments, the underwater device may not have a drive source or the drive source may be malfunctioning. The target device 2000 may be a device that performs a target task. Upon completion of the target task or when it needs to be recovered, it needs to be returned to the mother body.

[0059] In some embodiments, the docking robot 3000 is a simple underwater robot having a driving device that can drive the docking robot 3000 to move in water.

[0060] In some embodiments, the cable 1000 comprises an electrical cable. The cable is used to supply power to the docking robot 3000. In some embodiments, the cable 1000 also comprises a signal line for transmitting control signals, etc. Specifically, when recovering the underwater device, the docking robot is released from the mother body. The docking robot's drive unit serves as a power unit, and the cable can supply power to the power unit, which includes a motor and drive paddles. Driven by the power unit, the docking robot approaches the underwater device. Generally, the mother body is located below the underwater device. The underwater device has a docking device on its bottom surface, and the docking robot has a docking structure on its top that mates with the docking device. Once the docking robot approaches the underwater device, the docking structure mates with the docking device to complete docking. The mother body then retracts the cable, driving the underwater device and recovering it back to the mother body. In some embodiments, the mother body is an underwater base station. In some embodiments, the mother body has a power source and can move underwater. In some embodiments, the mother body is a fixed base station and can be located underwater. It is understood that the underwater area can be either seawater or freshwater.

[0061] In some embodiments, there are two cables 1000, both connected to the same mother body. There are two docking robots 3000, each connected to the mother body 4000 via a cable 1000. Both docking robots 3000 can simultaneously dock with the underwater device 2000. In some embodiments, the cables 1000 are released and retracted via a retraction device 5000. During retraction, the cables 1000 can be wound around the retraction device 5000. When the underwater device is retracted to the mother body, it engages and locks with a buffer locking mechanism to prevent collision damage.

[0062] Figure 3 This is a schematic diagram of the docking status of an underwater device and a docking robot according to an embodiment of the present invention. Figure 4This is a schematic diagram of the structure of a docking robot according to one embodiment of the present invention. In some embodiments, the bottom surface of the underwater device has a docking device 2100, and the top of the docking robot has a docking structure 3100 that matches the docking device. In some embodiments, the docking device includes a docking port, and the docking structure includes a docking pin. The target device has a docking port below it, and the docking robot has a docking pin that matches the docking port. The docking port and the docking pin function as a locking mechanism when mated.

[0063] Figure 5 Schematic diagram of the structure of the docking device of the underwater equipment according to one embodiment of the present invention. Figure 5 The docking device 2100 includes a docking port 2101 having a tapered structure and a tapered cavity. The lower end of the docking port 2101, near the opening, has a locking groove 2102. The locking groove 2102 may be a groove that surrounds the docking port 2101. The top end of the docking port 2101, away from the opening, has a positioning protrusion 2103. The positioning protrusion 2103 is located at the center of the docking port 2101, protruding downward from the top end of the docking port 2101 and facing into the docking port. In some embodiments, the positioning protrusion 2103 is tapered, with the tip facing downward.

[0064] Specifically, refer to Figure 4 The docking structure 3100 includes a docking pin 3101, which has a tapered structure portion. The docking pin 3101 has a tapered pin structure. The tapered pin structure matches the tapered cavity of the docking port 2101. Specifically, when the docking is completed, the cross-sectional diameter of the tapered pin structure is less than or equal to the cross-sectional diameter of the tapered cavity. The cross-sectional diameter of the top of the tapered pin structure is less than the cross-sectional diameter of the lower end opening of the tapered cavity. The tapered docking port and the docking pin make the docking match smoother and less prone to violent collisions.

[0065] In some embodiments, the docking pin 3101 is a movable pin. Specifically, the docking pin 3101 has a threaded hole 3108 at its center. The docking robot comprises a frame 3102 and a docking motor 3103. The frame includes a stud 3104. One end of the stud 3104 is connected to the output shaft of the docking motor 3103, while the other end extends into the threaded hole of the docking pin 3101, threadedly connected to the docking pin 3101. The docking motor 3103 is fixed to the frame 3102. When the docking motor output shaft rotates, the forward and reverse rotations can thread the docking pin 3101 upward or downward. Before docking, the upper end, or top, of the docking pin 3101 is located within the frame. When docking is required, the docking motor drives the docking pin 3101 upward, extending from the frame and into the docking port 2101 to complete the docking. The provision of a movable pin prevents interference with underwater debris during the docking robot's movement and prevents the extended docking pin from colliding with underwater equipment in the event of misalignment. Only when the docking robot is aligned with the underwater device, that is, when the docking pin is aligned with the docking port, does the docking motor drive the docking pin 3101 upward, allowing it to extend into the docking port 2101. Furthermore, by allowing the docking pin to extend into the docking port, the top of the docking robot does not need to be in contact with the underwater device, allowing the docking robot's drive paddle to have sufficient space for driving, making control more convenient. In some embodiments, the plane of the drive paddle is coplanar with the top plane of the docking robot. The top plane of the docking robot is the top surface of the frame where the docking pin is located when the docking pin is not extended from the frame.

[0066] In some embodiments, the threaded hole 3108 is a through hole that passes through the docking pin 3101. The top of the threaded hole can dock with the positioning protrusion 2103. The inner diameter of the threaded hole is equal to or slightly smaller than the diameter of the uppermost end of the positioning protrusion.

[0067] Figure 6 This is a diagram showing the docking pin fully entering the docking port to complete docking. Figure 6 The cross-sectional diameter of the tapered pin structure's top is D1, and the cross-sectional diameter of the tapered cavity's top is D2. The inner diameter of the threaded hole is d1, and the diameter of the top end of the positioning protrusion is d2. The taper angle of the tapered pin structure is equal to that of the tapered cavity, meaning the tapered pin structure and the tapered cavity have the same inclination angle, allowing them to fit snugly.

[0068] In some embodiments, D1≥D2, d2≥d1. The cone angle of the tapered pin structure is θ, the cone angle of the tapered positioning protrusion 2103 is β, and the following conditions are satisfied:

[0069]

[0070] In some embodiments,

[0071]

[0072] When the docking pin is completely inserted into the docking port, the center is completely positioned through the top end of the threaded hole and the positioning protrusion.

[0073] Figure 7 This is a partial cross-sectional diagram of the docking pin fully entering the docking interface to complete the docking. Figure 8 for Figure 7 A partial enlarged schematic diagram of point A in the middle. Figure 7 and Figure 8 In some embodiments, the docking pin 3101 has a plurality of transverse holes 3105 at its lower portion. A latch 3106 is disposed in the transverse hole 3105 and is laterally movable. When the latch is extended outward, it can be inserted into the locking groove 2102 at the lower end of the docking port 2101 near the opening.

[0074] The locking groove 2102 is embedded with a magnet 2104, and the latch 3106 is made of a magnetic material. When the docking pin 3101 rises to a preset position and the latch 3106 is flush with the locking groove 2102, the latch 3106 is magnetically drawn out by the magnet and inserted into the locking groove 2102, completing the vertical locking. Specifically, multiple latches are arranged in an umbrella shape on the docking pin 3101. The latches are all located in the same plane.

[0075] Specifically, refer to Figure 8 The lower end surface of locking groove 2102 has a rounded corner 2105. The lower end surface of latch pin 3106 has a chamfered corner 3107. The height of locking groove 2102 is greater than the height of latch pin 3106. In the fully locked state, the lower end surface of locking groove 2102 and the lower end surface of latch pin 3106 are flush with each other. The provision of rounded corners 2105 and chamfered corners 3107 ensures smooth insertion of latch pin 3106 into locking groove 2102.

[0076] In some embodiments, reference Figure 4 The docking robot has a power unit including a motor and a drive paddle 3109. There may be multiple drive paddles 3109, for example, four. The docking robot also has a positioning device for obtaining the location of the target device, and the drive paddle is used to drive the docking robot to perform active movement.

[0077] In some embodiments, the positioning device includes a long-distance positioning device and a short-distance positioning device. The long-distance positioning device is used to position the target device in the initial stage when the docking robot leaves the mother body, and the short-distance positioning device is used to accurately position the target device at close range when the docking robot approaches the target device.

[0078] In some embodiments, the long-distance positioning device includes a sonar positioning device, and the short-distance positioning device includes a camera and an image processing module.

[0079] In an embodiment of the present application, the docking robot locates the target device using a long-range positioning device and, under the action of a driving paddle, moves toward the target device. When the docking robot approaches the target device, the short-range positioning device precisely locates the target device and docks with the target device. Specifically, image recognition can be performed using a camera and an image processing module to achieve precise positioning, aligning the docking pin with the docking port, and then initiating docking and locking of the docking pin and the docking port.

[0080] In some embodiments, the camera includes a first camera. The first camera is configured to capture a panoramic view of the target device, obtaining at least a first image and a second image comprising a panoramic image of the target device. The image processing module is configured to perform image recognition and / or segmentation on the first and second images, perform rough positioning, obtain a rough position of the docking port on the target device, obtain a position difference between the first and second images, and obtain a rough position change speed and direction of the target device based on the capture time and position difference between the first and second images.

[0081] In some embodiments, the camera includes a second camera. The second camera is configured to capture the docking interface at close range with a micro-focus lens, obtaining at least a third image and a fourth image comprising macro images of the docking interface and the positioning protrusion within the docking interface. The image processing module is configured to perform image recognition and / or segmentation on the third and fourth images, and to perform precise positioning to obtain the precise location of the docking interface and the positioning protrusion on the target device; simultaneously obtain the position difference between the third and fourth images, and, based on the difference in shooting time and position between the third and fourth images, obtain the precise position change speed and direction of the target device.

[0082] In some embodiments, the camera includes a third camera, and there are two docking robots, including a first docking robot and a second docking robot. Each docking robot has the third camera and an image calibration device. The third camera is used to capture a fifth image of the first docking robot, including the image calibration device, and a sixth image of the second docking robot. The image processing module is used to process the fifth and sixth images and determine the relative distance and orientation between the first and second docking robots based on the image calibration device.

[0083] In some embodiments, the image calibration device includes multiple markers, the positions of the multiple markers are known and fixed, and by taking a fifth image of the first docking robot including the image calibration device and a sixth image of the second docking robot, the relative distance and orientation of the first docking robot and the second docking robot can be determined.

[0084] In some embodiments, the underwater robot docking and capture control system also includes a motion control device, which is used to control the movement of the first docking robot and the second docking robot according to the relative distance and orientation of the first docking robot and the second docking robot, so that the relative distance between the first docking robot and the second docking robot matches the distance between the two docking ports of the target device and the relative distance between the first docking robot and the second docking robot remains unchanged, and the orientation of the first docking robot and the second docking robot matches the posture of the target device.

[0085] In some embodiments, when the docking robot approaches the target device, precise positioning of the target device at close range is achieved using the following method.

[0086] Specifically, the position of the target device is accurately located by a short-range positioning device; at the same time, the position of the target device is monitored and locked in real time.

[0087] The camera includes a first camera and a second camera, and accurately locates the position of the target device through a close-range positioning device, including:

[0088] The first step is to obtain the rough position of the docking port. Specifically, the first camera continuously captures a panoramic view of the target device to obtain at least a first image and a second image comprising a panoramic image of the target device. The image processing module performs image recognition and / or segmentation on the first image and the second image to perform rough positioning, thereby obtaining the rough position of the docking port 2101 of the docking device 2100 on the target device, and obtaining the position difference between the first image and the second image. Based on the shooting time and position difference between the first image and the second image, the rough position change speed and direction of the target device are obtained.

[0089] The second step is to obtain the precise position of the docking interface. Specifically, after obtaining the rough position of the docking interface and its changes, the docking robot is driven to move to the docking interface so that the docking pin 3101 of the docking structure 3100 is basically / roughly aligned with the docking interface. The docking interface is continuously photographed at close range and micro-focus by a second camera to obtain at least a third image and a fourth image including macro images of the docking interface and the positioning protrusion in the docking interface. The third image and the fourth image are subjected to image recognition and / or segmentation by an image processing module, and are precisely positioned to obtain the precise position of the docking interface 2101 and the positioning protrusion 2103 on the target device; at the same time, the position difference between the third image and the fourth image is obtained, and the precise position change speed and direction of the target device are obtained based on the shooting time and position difference of the third image and the fourth image.

[0090] The third step is to accurately track the position of the target device in real time. Specifically, after obtaining the precise position of the docking port, its speed of change, and its direction, the docking robot is driven to precisely align the docking pin 3101 of the docking structure 3100 with the docking port. A second camera continuously captures the docking port at close range with a micro-focus lens. The captured images are processed in real time by an image processing module. Based on the image processing results, the docking robot is driven to track the target device in real time, accurately tracking its position in real time.

[0091] In some embodiments, an underwater robot docking and capture control method is also provided, which uses any of the underwater robot docking and capture control systems described above to complete the docking of the docking robot with the target device.

[0092] In some embodiments, the underwater robot docking and capture control method includes:

[0093] Obtaining the position of the target device located by a remote positioning device;

[0094] driving the docking robot to move toward the target device;

[0095] Obtaining the position of the target device accurately located by a short-range positioning device;

[0096] The docking robot is locked in position with the target device to complete the docking.

[0097] In some embodiments, the step of locking the position of the docking robot and the target device includes:

[0098] According to the precise position change speed and direction of the target device, and the relative distance and orientation between the first docking robot and the second docking robot, the positions of the first docking robot and the second docking robot are respectively locked with the positions of the two docking ports of the target device.

[0099] Specifically, the orientation of the first docking robot and the second docking robot is the angle between the direction of the connecting line of the docking pins of the first docking robot and the second docking robot relative to the direction of the connecting line of the two docking ports of the target device. Matching the orientation of the first docking robot and the second docking robot with the posture of the target device means that the direction of the connecting line of the docking pins of the first docking robot and the second docking robot is parallel to the direction of the connecting line of the two docking ports of the target device.

[0100] The method of locking the positions of the first docking robot and the second docking robot with the positions of the two docking ports of the target device comprises aligning the docking pins of the first docking robot and the second docking robot with the two docking ports of the target device and keeping the positions following.

[0101] In some embodiments, the underwater forces and moments to which the docking robot is subjected when moving in water can be represented by the following dynamic equations.

[0102]

[0103] M∈R 6×6 is the mass matrix, including the rigid body mass and the additional mass;

[0104] C(v)∈R 6×6 is the Coriolis force and centripetal force matrix;

[0105] D(v)∈R 6×6 is the damping term matrix;

[0106] g(η)∈R 6×6 is the restoring force matrix. In some embodiments, the gravity can be made equal to the buoyancy, g(η)=0;

[0107] τ is the driving force and torque vector of the docking robot;

[0108] τ d are the external disturbance force and torque vectors.

[0109] In some embodiments, the target device is a device that has lost its power source. The external disturbance force and torque vector can be determined based on the precise position change speed and direction of the target device. Then, by controlling the driving force and torque vector of the docking robot, the relative distance and orientation of the first docking robot and the second docking robot are locked, so that the relative distance between the first docking robot and the second docking robot remains unchanged, and the docking pins of the first docking robot and the second docking robot are respectively aligned with the two docking ports of the target device and maintain position tracking. The relative distance between the first docking robot and the second docking robot remains unchanged, which can be achieved by controlling the movement speed, magnitude and direction of the first docking robot and the second docking robot.

[0110] In an embodiment of the present application, after obtaining the precise position of the docking interface and its speed, magnitude, and direction of change, the docking robot is driven to move so that the docking pin is precisely aligned with the docking interface. A camera continuously captures the docking interface at close range and with a micro-focus. The captured images are processed in real time by an image processing module. Based on the image processing results, the docking robot is driven to track the target device in real time, achieving real-time and accurate tracking of the target device's position.

[0111] In some embodiments, the image processing module detects target devices and docking robots based on the YOLOv5s neural network algorithm, enabling fast and efficient target detection. To address the distortion issues associated with underwater cameras when taking photos, camera calibration is introduced to achieve spatial positioning.

[0112] In some embodiments, the EPnP algorithm uses 2D-3D matching point pair information to achieve real-time estimation of the spatial pose between the target device's docking port and the underwater docking robot. Simultaneously, the YOLOv5s neural network algorithm is used to perform real-time detection of the target device and the docking port to obtain the precise location of the docking port.

[0113] In some embodiments, the real-time and precise tracking of the position of the target device is implemented based on the single target tracking KCF (Kernelized Correlation Filters) algorithm. The KCF algorithm uses the idea of ​​kernel correlation filters to model the spatial relationship between the target and the search area to achieve robust tracking of the target. Its core idea is to represent the characteristics of the target as a linear combination of kernel functions, thereby achieving rapid matching of target features in the frequency domain. The KCF algorithm has excellent performance when processing real-time video streams. The docking robot in the embodiment of the present application follows the locked target device and selects the KCF algorithm for higher efficiency.

[0114] In some embodiments, the buffer locking mechanism includes a buffer mechanism and a locking mechanism, the buffer mechanism includes an elastic device, and the locking mechanism includes a V-shaped structure and a fixing plate. When the underwater device is retracted into the mother body, the underwater device contacts and locks with the buffer locking mechanism to prevent collision damage. Specifically, the V-shaped structure matches the size of the underwater device, the underwater device can be embedded in the V-shaped structure, the fixing plate is rotationally connected or slidingly connected to the V-shaped structure, and after the underwater device is embedded in the V-shaped structure, the fixing plate flips or slides and presses on the upper part of the underwater device, completing the locking.

[0115] In some embodiments, the present application also provides a method for controlling flexible docking and capture of an active underwater robot, wherein the control method utilizes the underwater robot docking and capture control system described in any of the above embodiments to enable the docking robot to flexibly dock and capture the target device.

[0116] In some embodiments, the control method includes:

[0117] The docking robot leaves the mother body;

[0118] The docking robot locates the position of the target device through a remote positioning device and moves toward the target device under the action of a driving paddle;

[0119] When the docking robot approaches the target device, the position of the target device is accurately located by a short-range positioning device, and docking with the target device is achieved;

[0120] The collecting device in the mother body drives the cable to retract, thereby driving the target device captured by the docking robot to be recovered;

[0121] When the target device approaches the mother body, the target device buffers the collision through the buffer locking mechanism, and the buffer locking mechanism locks the target device to the mother body.

[0122] The underwater robot docking and capture control system of the present application completes active capture by docking the docking robot with the target device, and the docking is accurate and reliable. The docking robot and the mother body are connected by cables, and then the docking of the docking robots is used to achieve flexible docking and controllable recovery, thereby avoiding damage to the target device. Two docking robots are connected by two cables, each docking robot is connected to the mother body by a cable, and the two docking robots capture a target device at the same time, thereby achieving stable control of the posture of the target device, avoiding cable entanglement, and achieving reliable recovery. The collection device and the buffer locking mechanism are used to achieve buffering of the contact between the target device and the mother body to avoid collision, and the collection device and the locking mechanism cooperate to achieve fixed locking of the target device and complete underwater recovery.

[0123] In some embodiments, the underwater robot docking and capture control system also includes a balance control device, which is connected to each of the cables and is used to control the force applied to each of the cables so that the at least two docking robots maintain a locked posture, thereby ensuring the posture balance of the target device.

[0124] In some embodiments, the balance control device includes: a PID controller, which outputs control parameters of the force on the cable through a PID control algorithm according to changes in the posture angle parameters of the docking robot.

[0125] In some embodiments, each of the docking robots includes an inertial measurement unit, and each of the inertial measurement units is arranged parallel to a reference direction of the docking robot's posture balance. The inertial measurement unit is used to measure the posture angle of the docking robot, and the posture angle includes a pitch angle, a roll angle, and a heading angle.

[0126] In some embodiments, ensuring the posture balance of the target device includes ensuring that the posture of the target device is in a horizontal state. The balance control device is also connected to the collecting device to control the pulling force of the collecting device on the cable. When the absolute value of the pitch angle of the docking robot increases in a positive or negative direction, the corresponding collecting device is controlled to exert a pulling force on the cable and / or the inflation device is controlled to adjust the buoyancy of the cable to restore the pitch angle to a balanced value.

[0127] In some embodiments, Figure 9 1 is a schematic diagram of a cross-sectional structure of a cable according to an embodiment of the present invention. The cable 1000 can be constructed as a zero-gravity cable. Figure 1 and Figure 2 The zero-gravity cable is used in the docking and capture control system of underwater robots. Each underwater robot docking and capture control system has two zero-gravity cables. During the recovery process, the buoyancy of the two zero-gravity cables can be controlled to reduce or even avoid the influence of gravity on the zero-gravity cables, making it easier to control the force balance at both ends of the underwater equipment and ensuring stable recovery of the underwater equipment. Figure 9The cable 1000 is used for underwater equipment recovery, and includes a cable 100. One end of the cable is used to connect to a docking robot, and the other end is used to connect to a mother body. The docking robot is used to capture underwater equipment, thereby recovering the underwater equipment; the cable is used to supply power to the docking robot. In some embodiments, the cable 1000 also includes a buoyancy structure 200. The buoyancy structure includes an inflatable cavity 201. The buoyancy structure is used to make the buoyancy of the cable equal to the gravity when it is in the water, so that it is in a zero-gravity state. It can be understood that the water can be seawater or freshwater. In addition, by providing an inflatable cavity, the cable can be in an expanded state when inflated and subjected to radial outward tension. The overall rigidity of the cable is large and it is not easy to bend, so that the cable is not easy to get entangled during the pulling and recovery process, and motion control is easier.

[0128] In some embodiments, the cable comprises at least two air-filled cavities, the cable being disposed at the center of the cable, and the at least two air-filled cavities extending along the cable. In some embodiments, the cable has two air-filled cavities, the cable being disposed at the center of the cable, the two air-filled cavities extending along the cable, and being symmetrically disposed on either side of the cable.

[0129] Figure 10 This is a schematic diagram of the cross-sectional structure of a cable at a control valve according to an embodiment of the present invention. Figure 11 for Figure 10 AA cross-section diagram. Figure 10 and Figure 11 In some embodiments, a control valve 300 is provided at one end of the cable for connecting to the docking robot. The control valve 300 is connected to the inflatable cavity and is used to control the connection or disconnection of the inflatable cavity. Figure 9 and Figure 10 In the illustrated embodiment, the cable has two air-filled cavities, and the control valve 300 connects the two air-filled cavities to control the connection or disconnection of the two air-filled cavities.

[0130] In some embodiments, the cable has an inflation device 400 at one end for connection to the mother body, which can be mounted on the mother body. In some embodiments, the mother body is provided with an inflation device, and each cable is provided with at least two independent inflation devices, each of which can inflate at least one inflatable cavity. In some embodiments, the cable has two inflatable cavities, and each inflation device inflates one inflatable cavity.

[0131] In an embodiment of the present application, two inflatable cavities and two independent inflatable devices are provided, each independent inflatable device corresponds to an inflatable cavity, and the two inflatable cavities are connected by a control valve to ensure the reliability of inflation and avoid failure to inflate due to failure of a certain inflatable cavity or a certain inflatable device, especially failure to inflate due to damage or blockage of the inflatable cavity. When the inflatable devices are working normally, the control valve is closed, and the two inflatable cavities are independently inflated and the air pressure is controlled to ensure inflation efficiency and stability. When an inflatable device fails, the control valve can be opened, so that the other inflatable device can be used to directly inflate the two inflatable cavities. When an inflatable cavity is damaged and leaks, the control valve can be closed and the air pressure of the other inflatable cavity can be increased to ensure buoyancy.

[0132] In some embodiments of the present application, a balance control method for an underwater robot docking and capture control system is further provided. The underwater robot docking and capture control system is the underwater robot docking and capture control system described above. The balance control method includes:

[0133] Before the docking robot completes docking with the target device, the balance control device controls the inflation device to inflate the inflation cavity of the cable and adjusts the buoyancy of the cable so that the buoyancy of the cable is not less than the weight of the cable.

[0134] In the embodiments of the present application, by independently inflating and controlling the air pressure of the two inflatable cavities, the air pressure of the inflatable cavities can be easily controlled and adjusted, thereby adjusting the buoyancy of the entire cable to adapt to the movement state of the cable, preventing entanglement, and improving efficiency. For example, during the cable release process, that is, during the cable rising process, the docking robot is in an ascending state, and the air pressure of the inflatable cavity can be appropriately increased so that the buoyancy of the cable is greater than the weight of the cable. As a result, the cable itself has an upward driving force under the action of buoyancy, reducing the driving force required for the docking robot, making it easier and faster for the docking robot to approach the underwater equipment that needs to be docked. Of course, the buoyancy of the cable cannot be too greater than the weight of the cable to prevent the cable from moving upward faster than the docking robot, pulling the docking robot, and preventing the docking robot from losing control.

[0135] In some embodiments, the balance control method includes: during the docking process between the docking robot and the target device, the balance control device controls the inflation device to adjust the air pressure of the inflation cavity of the cable so that the buoyancy of the cable is equal to the gravity of the cable.

[0136] In the embodiments of the present application, the docking process between the docking robot and the target device involves the precise positioning of the target device at close range when the docking robot approaches the target device, and the completion of the docking and locking process, i.e., the docking pin and the docking port are docked and locked. During this process, the buoyancy of the cable is equal to the weight of the cable, which effectively prevents entanglement and facilitates the motion control of the docking robot, thereby enabling the docking pin and the docking port to accurately complete the docking and locking process and reduce docking shock and collision.

[0137] In some embodiments, the balance control method includes: after the docking robot completes docking with the target device, the balance control device controls the pulling force of the cable by the collecting device and / or the inflation device adjusts the buoyancy of the cable to balance the posture of the target device.

[0138] During the cable descent and recovery process, the docking robot also descends with the underwater equipment. The air pressure in the inflatable cavity can be appropriately reduced to make the cable's buoyancy less than or equal to the cable's weight. As a result, the cable itself has a downward driving force or a floating state under the action of gravity. Under the action of the collection device on the mother body, the cable can easily recover the underwater equipment. Of course, the cable's buoyancy cannot be too less than the cable's weight to prevent the cable from moving downward too quickly under the action of gravity, pulling on the docking robot and preventing the docking robot from losing control. It is also necessary to prevent the cable's downward movement speed from being greater than the collection speed of the collection device, which will cause the cable to pile up and tangle, hindering recovery.

[0139] Figure 16 Schematic diagram of the force state of the underwater robot docking and capture control system during the target device recovery process. (a) is a schematic diagram of the target device in a balanced state, and (b) is a schematic diagram of the target device in a tilted state.

[0140] In some embodiments, there are two cables, including a first cable and a second cable, and there are two docking robots, including a first docking robot and a second docking robot. The first cable is connected to the first docking robot, and the second cable is connected to the second docking robot. The first docking robot and the second docking robot respectively dock with the front and rear ends of the target device. The balance control method includes:

[0141] When the tension of any one of the first cable and the second cable is zero, and the tension of the other cable is not zero, the balance control device controls the inflation device to adjust the buoyancy of the other cable so that the buoyancy of the other cable is less than the gravity;

[0142] When the tensions of the first cable and the second cable are both 0, the balance control device controls the pulling force of the first cable and the second cable by the collection device to increase the pulling force on the first cable and the second cable.

[0143] Specifically, such as Figure 16 As shown, after the docking robot completes docking with the target device, the docking robot stops self-driving, and the driving force of the docking robot on the target device comes from the tension of the cable. The force on the target device includes its own buoyancy F 浮 , gravity G and the driving force F of the first docking robot on the target device 1驱动 , the driving force F of the second docking robot on the target device 2驱动 The driving force F of the first docking robot on the target device 1驱动 Direction downward. The driving force F of the second docking robot on the target device 2驱动 Direction downward.

[0144] Among them, the driving force F of the first docking robot on the target device 1驱动 , the pulling force F of the collecting device on the first cable 1拉力 , the gravity F of the first cable 1g , the buoyancy of the first cable F 1f The relationship is:

[0145] F 1驱动 =F 1拉力 +F 1g -F 1f

[0146] The driving force F of the second docking robot on the target device 2驱动 , the pulling force F of the collecting device on the second cable 2拉力 , the gravity of the second cable F 2g , the buoyancy of the second cable F 2f The relationship is:

[0147] F 2驱动 =F 2拉力 +F 2g -F 2f

[0148] In the equilibrium state, the target device is horizontal and the pitch angle is 0 degrees. When disturbed by the underwater environment or other unbalanced forces, the target device is in a tilted state and the pitch angle changes. It is necessary to control the buoyancy and tension of the cable and adjust the driving force of the first docking robot on the target device to F 1驱动’ The driving force of the second docking robot on the target device is F 2驱动’ , providing a restoring torque M for the target device 恢复 , so that the pitch angle returns to a balanced value.

[0149] In an embodiment of the present application, by jointly controlling the tension and buoyancy of the two cables, the target device can be set to always be kept in a tensioned state as much as possible during the recovery process, regardless of the gravity and buoyancy of the target device itself, thereby controlling its horizontal posture.

[0150] In some embodiments, the cable has multiple inflatable cavities, with the number of cavities being three or more, for example, three, four, or five. In some embodiments, the number of inflatable cavities is no greater than five. Providing two or more inflatable cavities ensures inflation reliability and avoids failure to inflate due to damage or blockage of a cavity. Furthermore, a number of no more than five inflatable cavities simplifies the structure, reduces manufacturing difficulties, and avoids blockage caused by the small cross-sectional dimensions of a single inflatable cavity. In some embodiments, the number of inflatable cavities is 2-5, with each cavity corresponding to an independent inflatable device. Providing multiple independent inflatable devices ensures inflation pressure and improves inflation efficiency. In some embodiments, two or more inflatable cavities share a single independent inflatable device. Of course, each cable has at least two independent inflatable devices. The corresponding inflatable cavities of the two independent inflatable devices are connected by a control valve. The control valve connects or disconnects the two inflatable cavities. When the two inflatable cavities are connected, each independent inflatable device can inflate the two inflatable cavities, and the air pressure in the two inflatable cavities is the same. When the two inflatable cavities are disconnected, each independent inflatable device can only inflate the corresponding inflatable cavity, and the air pressure in the two inflatable cavities can be different.

[0151] In the embodiments of the present application, by providing multiple inflatable cavities and multiple independent inflating devices, the reliability and efficiency of inflation are further guaranteed, and the anti-entanglement effect is improved. In addition, the air pressure in the multiple inflatable cavities can be controlled to achieve different air pressures in different inflatable cavities, thereby adapting to the influence of water flow direction.

[0152] refer to Figure 12 The cable has three inflatable cavities: a first inflatable cavity 2011, a second inflatable cavity 2012, and a third inflatable cavity 2013. Each inflatable cavity is provided with an independent inflatable device, resulting in three independent inflatable devices. Every two adjacent inflatable cavities are connected by a control valve 300. Specifically, a first control valve 301 is provided between the first inflatable cavity 2011 and the second inflatable cavity 2012, a second control valve 302 is provided between the second inflatable cavity 2012 and the third inflatable cavity 2013, and a third control valve 303 is provided between the third inflatable cavity 2013 and the first inflatable cavity 2011.

[0153] Figure 13Schematic diagram of the composite material layer structure of a cable according to an embodiment of the present invention. Figure 9 and Figure 13 The cable is wrapped with a composite material layer 500 made of a high-strength material. The composite material layer is made of a flexible, flex-resistant material. The composite material layer ensures that the cable can be wound without bending, thereby preventing damage to the air-filled cavity and cable, while also facilitating recovery. In some embodiments, the composite material layer includes a tensile layer 501, a bending-resistant layer 502, and a protective layer 503. The protective layer is disposed around the tensile layer, and the tensile layer is disposed around the bending-resistant layer. The tensile layer 501 has high strength to prevent the cable from breaking due to excessive tension. The tensile layer 501 can be composed of metal wires forming a mesh structure. The metal wires can be stainless steel. The bending-resistant layer 502 has high rigidity to prevent the cable from bending due to excessive bending moments. The bending-resistant layer 502 can be a flexible plastic. The protective layer 503 has good wear and corrosion resistance to prevent wear and corrosion of the cable in seawater environments and during recovery. The protective layer 503 can be made of rubber. By arranging the anti-bending layer, anti-tensile layer and protective layer in sequence, with the anti-bending layer on the innermost side and the protective layer on the outermost side, wear, tear and bending can be effectively prevented.

[0154] refer to Figure 9 In some embodiments, the outer periphery of the cable has an insulating layer 600, which is disposed between the cable and the air-filled cavity. The insulating layer 600 is disposed closely to the cable to insulate and protect the cable.

[0155] In some embodiments, the inflatable cavity has a cavity skin 202. The cavity skin 202 can be made of an elastic material. The cavity skin has good flexibility and elasticity and can adapt to different inflation pressures. The cavity skin 202 also has good airtightness. In some embodiments, the cavity skin 202 can be a rubber material. In some embodiments, between the composite material layer 500 and the insulating layer 600, the space other than the inflatable cavity has a filling material 700, and the filling material 700 can be a porous flexible material, such as a foam material. The filling material 700 has shaping and protective effects, and can also increase buoyancy. Figure 9 As shown, the filling material 700 has a certain shape, with an air-filled cavity in the middle. When the air-filled cavity is inflated, the cavity skin 202 is tightly attached to the filling material 700 and fills the space containing the filling material 700 .

[0156] Figure 14 Schematic diagram of the cross section of a cable according to an embodiment of the present invention. Figure 14 As shown, the inflatable cavity 201 has an inflatable support structure. Figure 15 Schematic diagram of the inflatable support structure of a cable according to an embodiment of the present invention. Figure 14and Figure 15 In some embodiments, the inflatable support structure includes an inflatable column 203, an inflatable hole 204, and a connecting rod 205. Each inflatable cavity 201 has two inflatable columns 203, and the two inflatable columns 203 are connected by a connecting rod 205. There are multiple connecting rods 205. They are arranged at intervals between the two inflatable columns 203. The inflatable column 203 extends along the longitudinal direction of the inflatable cavity 201, that is, the length direction of the cable. The inflatable column 203 is annular, and the center of the inflatable column 203 is a hollow structure. The inflatable column 203 has multiple inflatable holes 204. The multiple inflatable holes 204 can be arranged at intervals on the inflatable column 203. The multiple inflatable holes 204 can be staggered to prevent blockage. The inflatable device is connected to the inflatable column 203. During inflation, the inflatable device transmits gas through the hollow structure in the center of the inflatable column 203 and enters the inflatable cavity through the inflatable holes 204. In some embodiments, the inflatable support structure can be wound together with the cable. In this embodiment, the composite material layer 500 can be a compressible and deformable structure. When the cable is recycled, the inflatable cavity 201 that has been recycled into the mother body can be completely flattened, and the entire cable can be flattened and then wound, thereby reducing the recycling space. In this embodiment, there are two inflatable cavities 201 arranged symmetrically. After the inflatable cavities are flattened, the cable as a whole is flat. Specifically, the connecting rod 205 is tangentially connected to the outer side of the inflatable column 203. After the inflatable cavity 201 is flattened, the cavity skin 202 can be close to the connecting rod 205 and the inflatable column 203. In this embodiment, filling material may not be provided or a softer filling material may be provided. The inflatable support structure as a whole can itself serve as a supporting structure. The cavity skin 202 is wrapped around the outside of the inflatable support structure and will not shift. The shape and position of the inflated and flattened states are controllable.

[0157] In some embodiments of the present application, after the docking pin and the docking port are docked and locked, the docking robot is controlled to lock its posture, and the tension of the two cables is precisely controlled to ensure the posture balance of the target device (mainly maintaining horizontality in the embodiments of the present application). The posture balance control method of the present application takes into account the influence of cable tension, the force applied to the docking robot, the motion changes of the target device, water flow, etc., and also combines the coordinated balance of the two docking robots and the cables to maintain the horizontal position of the target device. The entire control process is achieved through PID algorithm control, and cable entanglement can also be avoided.

[0158] Figure 17 Schematic diagram of an electronic device according to an embodiment of the present invention. Figure 17 In some embodiments, an electronic device is further provided, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements any of the above methods when executing the program. In some embodiments, the electronic device is a computer device.

[0159] At the hardware level, the electronic device includes a processor, an internal bus, a network interface, memory, and non-volatile storage, and may also include other hardware required for its operations. The processor reads the corresponding computer program from the non-volatile storage into the memory and then runs it to implement the above method.

[0160] The foregoing description is merely a preferred embodiment of the present invention and is not intended to limit the present invention. Those skilled in the art will readily appreciate that various modifications and variations of the present invention are possible. Any modifications, equivalent substitutions, or improvements made within the spirit and principles of the present invention shall be included within the scope of protection of the present invention.

Claims

1. An underwater robot docking and capture control system, characterized in that: The underwater robot docking and capture control system includes: At least two docking robots, including a first docking robot and a second docking robot, the at least two docking robots are used to simultaneously dock and capture a target device, the target device having a docking device, and the docking device including a docking port; a mother body, wherein when docking and capturing the target device, the mother body is located underwater and below the target device; At least two cables, the at least two cables corresponding to the at least two docking robots one by one, each of the docking robots being connected to the mother body via one of the cables; a retrieving device, the retrieving device being located on the mother body and configured to drive the cable to retract, thereby driving the target device captured by the docking robot to be recovered; A positioning device, comprising a long-distance positioning device and a short-distance positioning device, wherein the long-distance positioning device is used to locate the target device in the initial stage of the docking robot leaving the mother body, and the short-distance positioning device is used to accurately locate the target device at a close distance when the docking robot approaches the target device; The underwater robot docking and capture control system also includes a motion control device, which is used to control the movement of the first docking robot and the second docking robot according to the relative distance and orientation of the first docking robot and the second docking robot, so that the relative distance between the first docking robot and the second docking robot matches and remains unchanged with the distance between the two docking ports of the target device, and the orientation of the first docking robot and the second docking robot matches the posture of the target device.

2. The underwater robot docking and capture control system according to claim 1, characterized in that: The long-distance positioning device includes a sonar positioning device, and the short-distance positioning device includes a camera and an image processing module.

3. The underwater robot docking and capture control system according to claim 2, characterized in that: The camera includes a first camera; The first camera is used to perform panoramic photography of the target device to obtain at least a first image and a second image including a panoramic image of the target device; The image processing module is used to perform image recognition and / or segmentation on the first image and the second image, perform rough positioning, obtain the rough position of the docking port on the target device, and obtain the position difference between the first image and the second image, and obtain the rough position change speed and direction of the target device based on the shooting time and position difference between the first image and the second image.

4. The underwater robot docking and capture control system according to claim 3, characterized in that: The camera includes a second camera; The second camera is used to perform close-range micro-focus photography of the docking interface to obtain at least a third image and a fourth image including macro images of the docking interface and the positioning protrusion in the docking interface; The image processing module is used to perform image recognition and / or segmentation on the third image and the fourth image, and perform precise positioning to obtain the precise position of the docking interface and the positioning protrusion on the target device; at the same time, obtain the position difference between the third image and the fourth image, and obtain the precise position change speed and direction of the target device based on the shooting time and position difference between the third image and the fourth image.

5. The underwater robot docking and capture control system according to claim 4, characterized in that: The camera includes a third camera. There are two docking robots, each of which has the third camera and an image calibration device. The third camera is used to capture a fifth image of the first docking robot including the image calibration device and a sixth image of the second docking robot. The image processing module is used to process the fifth image and the sixth image, and determine the relative distance and orientation of the first docking robot and the second docking robot according to the image calibration device.

6. A method for controlling the docking and capture of an underwater robot, characterized in that: The underwater robot docking and capturing control method utilizes the underwater robot docking and capturing control system according to any one of claims 1 to 5 to complete the docking of the docking robot with the target device.

7. The underwater robot docking and capture control method according to claim 6, characterized in that: The control method includes: obtaining a position of the target device located by a remote positioning device; driving the docking robot to move toward the target device; Obtaining the position of the target device accurately located by a short-range positioning device; The docking robot is locked in position with the target device to complete the docking.

8. The underwater robot docking and capture control method according to claim 7, characterized in that: The step of locking the position of the docking robot and the target device includes: According to the precise position change speed and direction of the target device, and the relative distance and orientation between the first docking robot and the second docking robot, the positions of the first docking robot and the second docking robot are respectively locked with the positions of the two docking ports of the target device.

9. A computer device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein: When the processor executes the program, the control method described in any one of claims 6 to 8 is implemented.

Images