Underwater robot docking capture control system and method and computer equipment

Abstract

The invention discloses an underwater robot docking capture control system and method and computer equipment, and the system comprises at least two docking robots which are used for docking and capturing a target device at the same time; when the target equipment is captured in a butt joint mode, the parent body is located underwater and located below the target equipment; the at least two cables are in one-to-one correspondence with the at least two butt joint robots, and each butt joint robot is connected with the parent body through one cable; the cable collecting device is located on the parent body and used for driving the cable to be collected and driving the target equipment captured by the docking robot to be collected; the positioning device comprises a long-distance positioning device and a short-distance positioning device, the long-distance positioning device is used for positioning the target equipment in the initial stage that the docking robot leaves the parent body, and the short-distance positioning device is used for accurately positioning the target equipment in a short distance when the docking robot approaches the target equipment.

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, more and more deep-sea underwater operations are taking place, and the existing grasping of underwater objects is mostly done by manipulators or flexible arms. However, for smaller target devices, it is difficult for manipulators to achieve reliable grasping, and manipulators are generally rigid contacts that can cause collisions and easily damage the target device, while the flexible arm’s grasping force is not enough. Moreover, the underwater environment is complex and subject to large external disturbances. The target device is in an uncontrollable state, and the posture and position of the target device cannot be guaranteed during docking, which can easily cause collisions or fail to complete docking and locking.

[0003] Therefore, it is necessary to improve the existing technology and provide an underwater robot docking 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 view of the above 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 a complex underwater environment 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, and the underwater robot docking and capture control system includes:

[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, 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 correspond to the at least two docking robots one by one, and each of the docking robots is connected to the mother body through one of the cables;

[0009] A collecting device, the collecting device is located on the mother body and is used to drive the cable to be retracted, so as to drive the target device captured by the docking robot to be recovered;

[0010] A positioning device, 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, 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, and 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 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.

[0021] In some embodiments, an underwater robot docking and capturing control method is also provided, wherein the underwater robot docking and capturing control method utilizes any of the above-mentioned underwater robot docking and capturing control systems to complete the docking of the docking robot with the target device.

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

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

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

[0025] Acquire 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, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements any of the control methods described above 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, and the active capture is completed by docking the docking robot with the target device underwater. In view of the complex underwater environment, a long-distance positioning device and a short-distance positioning device are used. 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, so as to ensure 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 shooting the fifth image of the first docking robot including the image calibration device and the sixth image of the second docking robot, so that 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. 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 an embodiment of the present invention.

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

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

[0034] Figure 4 The figure is a schematic structural diagram 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 a docking pin completely enters a docking port to complete docking.

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

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

[0039] Fig. 9 FIG. 1 is a schematic diagram of the cross-sectional structure of a zero-gravity cable according to an embodiment of the present invention.

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

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

[0042] Fig.12 A schematic diagram of a zero-gravity cable having three air-filled cavities according to an embodiment of the present invention.

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

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

[0045] Fig.15 FIG. 1 is a schematic diagram of an inflatable support structure of a zero-gravity cable according to an embodiment of the present invention.

[0046] Fig.16 The present invention is a schematic diagram of the force state of an underwater robot docking capture control system during the target device recovery process according to an embodiment of the present invention; wherein (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] Fig.17 A schematic diagram of an electronic device according to an embodiment of the present invention. DETAILED DESCRIPTION

[0048] The embodiments of the present invention will be described below with reference to the accompanying drawings. It will be appreciated by those skilled in the art 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 descriptions are illustrative in nature and are not intended to limit the scope of the claims. In addition, in this specification, the drawings are not drawn to scale and the same reference numerals represent the same parts.

[0049] Figure 1 This is a structural block diagram of an underwater robot docking and capture control system according to an embodiment of the present invention. Figure 2 FIG. 1 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 capturing control system includes:

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

[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, 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;

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

[0054] A positioning device, 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, and the target device 2000 may be an underwater device. In some embodiments, the target device may be an underwater robot. In some embodiments, the target device is an underwater device that has lost power. 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 collecting device 5000 and a buffer locking mechanism 6000, the collecting device 5000 is used to drive the cable 1000 to be retracted, thereby driving the captured target device 2000 to be recovered, and 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 understandable that the target device 2000 is an underwater device, and the underwater device can be located on the water surface or in the water. Being located in the water means that the underwater device is completely located below the water surface. Being located on the water surface means that at least part of the underwater device is located 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 can be an underwater robot.

[0058] In some embodiments, the underwater device may have a driving source, and the driving source may drive the underwater device to move. In some embodiments, the underwater device has no driving source or the driving source loses its function. The target device 2000 may be a device that performs a target task. When the target task is completed or it needs to be recovered, it needs to be recovered to the mother body.

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

[0060] In some embodiments, the cable 1000 includes an electric cable. The electric cable is used to supply power to the docking robot 3000. In some embodiments, the cable 1000 also includes a signal line for transmitting control signals, etc. Specifically, when the underwater equipment is recovered, the docking robot is released from the mother body, the driving device of the docking robot serves as a power device, the cable can supply power to the power device, the power device includes a motor and a driving paddle, and the docking robot approaches the underwater equipment under the drive of the power device. Generally, the mother body is located below the underwater equipment. The bottom surface of the underwater equipment has a docking device, and the top of the docking robot has a docking structure matching the docking device. After the docking robot approaches the underwater equipment, the docking structure matches the docking device to complete the docking, and the mother body retracts the cable, thereby driving the underwater equipment and recovering the underwater equipment 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 in water. In some embodiments, the mother body is a fixed base station and can be located at the bottom of the water. It can be understood that the water can be in seawater or fresh water.

[0061] In some embodiments, there are two cables 1000, and the two cables 1000 are connected to the same mother body. There are two docking robots 3000, each of which is connected to the mother body 4000 through one cable 1000, and the two docking robots 3000 are docked with the underwater equipment 2000 at the same time. In some embodiments, the cable 1000 is released and collected by the collection device 5000. When collecting the cable, the cable 1000 can be wound on the collection device 5000. When the underwater equipment is retracted to the mother body, the underwater equipment contacts and locks with the buffer locking mechanism to prevent collision damage.

[0062] Figure 3 The figure is a schematic diagram of the docking state 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 an 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, and the docking robot has a docking pin that matches the docking port, and the docking port has a locking function after matching with the docking pin.

[0063] Figure 5 FIG. 1 is a schematic diagram of a structure of a docking device for underwater equipment according to an embodiment of the present invention. Figure 5 The docking device 2100 includes a docking port 2101, which has a conical structure portion and a conical cavity. The docking port 2101 has a locking groove 2102 at the lower end close to the opening, and the locking groove 2102 can be a groove surrounding the docking port 2101. The top of the docking port 2101 away from the opening has a positioning protrusion 2103, which is located at the center of the docking port 2101, protruding downward from the top of the docking port 2101 and facing the inside of the docking port. In some embodiments, the positioning protrusion 2103 is a triangular cone with the tip facing downward.

[0064] Specifically, refer to Figure 4 The docking structure 3100 includes a docking pin 3101, and the docking pin 3101 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 at the lower end opening of the tapered cavity. Through the docking port and the docking pin of the tapered structure, the docking match is smoother and less prone to violent collision.

[0065] In some embodiments, the docking pin 3101 is a movable pin. Specifically, the center of the docking pin 3101 has a threaded hole 3108, the docking robot has a frame 3102 and a docking motor 3103, and the frame has a stud 3104, one end of the stud 3104 is connected to the output shaft of the docking motor 3103, and the other end extends into the threaded hole of the docking pin 3101, and is threadedly connected with the docking pin 3101. The docking motor 3103 is fixed to the frame 3102. When the output shaft of the docking motor rotates, the docking pin 3101 can be threadedly driven to rise or fall by forward and reverse rotation. Before docking, the upper end of the docking pin 3101, that is, the top, is located in the frame. When docking is required, the docking pin 3101 is driven to rise by the docking motor, extend out of the frame, and extend into the docking port 2101 to complete the docking. Through the provision of the movable pin, it is possible to avoid being disturbed by debris in the water during the movement of the docking robot, and to avoid the docking pin directly colliding with the underwater equipment in the extended state when it is not aligned. Only when the docking robot is aligned with the underwater equipment, that is, when the position of the docking pin is aligned with the docking port, the docking motor drives the docking pin 3101 to rise, so that the docking pin extends into the docking port 2101. In addition, by setting the docking pin to extend into the docking port, the upper end of the docking robot does not need to fit the underwater equipment, so that the driving paddle of the docking robot has sufficient driving space, and the control is more convenient. In some embodiments, the plane where the driving paddle is located is on the same plane as the top plane of the docking robot. The top plane of the docking robot is the top surface of the frame at the docking pin when the docking pin does not extend out of the frame.

[0066] In some embodiments, the threaded hole 3108 is a through hole that penetrates 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 schematic diagram of the docking pin fully entering the docking port to complete the docking. Figure 6 The top cross-sectional diameter of the tapered pin structure is D1, and the cross-sectional diameter of the top of the tapered cavity 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 the taper angle of the tapered cavity, that is, the tapered pin structure and the tapered cavity have the same inclination angle, and the two can fit completely tightly.

[0068] In some embodiments, D1≥D2, d2≥d1. The cone angle of the conical pin structure is θ, the cone angle of the conical 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, complete center positioning is achieved through the top end of the threaded hole and the positioning protrusion.

[0073] Figure 7 It is a partial cross-sectional schematic diagram when the docking pin completely enters the docking interface to complete the docking. Figure 8 for Figure 7 A partial enlarged schematic diagram of the A in the middle. Figure 7 and Figure 8 In some embodiments, the lower part of the docking pin 3101 has a transverse hole 3105, and there are multiple transverse holes 3105. A latch 3106 is disposed in the transverse hole 3105, and the latch is disposed transversely and can move transversely. When extending 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 position of the latch 3106 is in the same plane as the locking groove 2102, the latch 3106 is sucked out by the magnetic force under the action of the magnet and inserted into the locking groove 2102 to complete the locking in the vertical direction. Specifically, a plurality of latches are arranged on the docking pin 3101 in an umbrella shape. The latches are all located in the same plane.

[0075] Specifically, refer to Figure 8 The lower end surface of the locking groove 2102 has a rounded corner 2105. The lower end surface of the latch 3106 has a chamfer 3107. The height of the locking groove 2102 is greater than the height of the latch 3106. In the fully locked state, the lower end surface of the locking groove 2102 and the lower end surface of the latch 3106 are in the same plane. By setting the rounded corner 2105 and the chamfer 3107, the latch 3106 can be smoothly inserted into the locking groove 2102.

[0076] In some embodiments, reference Figure 4 The docking robot has a power device, which includes a motor and a driving paddle 3109. There can be multiple driving paddles 3109, for example, four. The docking robot also has a positioning device, which is used to obtain the position of the target device, and the driving 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 position of the target device through a long-distance positioning device, and moves toward the target device under the action of a driving paddle. When the docking robot approaches the target device, the position of the target device is accurately located through a short-distance positioning device, and docking with the target device is achieved. Specifically, image recognition can be performed through a camera and an image processing module to complete precise positioning, so that the position of the docking pin is aligned with the docking interface, and then the docking and locking of the docking pin and the docking interface are started.

[0080] In some embodiments, the camera includes a first camera. The first camera is used to perform panoramic shooting 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 a rough position of the docking port on the target device, and obtain a position difference between the first image and the second image, and obtain a rough position change speed and direction of the target device based on the shooting time and position difference of the first image and the second image.

[0081] In some embodiments, 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, 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 between the third image and the fourth image.

[0082] In some embodiments, the camera includes a third camera, 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, and 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.

[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, the target device is accurately positioned at a close distance 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 short-range positioning device, including:

[0088] The first step is to obtain the rough position of the docking port. Specifically, the target device is continuously photographed in a panoramic manner by a first camera to obtain at least a first image and a second image including a panoramic image of the target device, and the first image and the second image are subjected to image recognition and / or segmentation by an image processing module 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, and obtaining the rough position change speed and direction of the target device according to the shooting time and position difference between the first image and the second image.

[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 according to the shooting time and position difference of the third image and the fourth image.

[0090] The third step is to achieve real-time and accurate tracking of the position of the target device. Specifically, after obtaining the precise position of the docking interface and its changing speed and direction, the docking robot is driven to move so that the docking pin 3101 of the docking structure 3100 is accurately aligned with the docking interface. The docking interface is continuously photographed at close range and with a micro-focus by a second camera, and the photographed images are processed in real time by an image processing module. The docking robot is driven to track the movement in real time according to the image processing results, so as to achieve real-time and accurate tracking of the position of the target device.

[0091] In some embodiments, an underwater robot docking and capturing control method is also provided, wherein the underwater robot docking and capturing control method utilizes any of the above-mentioned underwater robot docking and capturing control systems 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] Acquire the position of the target device located by a remote positioning device;

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

[0095] Acquire 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 connecting direction of the docking pins of the first docking robot and the second docking robot and the connecting direction of the two docking ports of the target device. The orientation of the first docking robot and the second docking robot matches the posture of the target device, which means that the connecting direction of the docking pins of the first docking robot and the second docking robot is parallel to the connecting direction 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 respectively 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 respectively 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 rigid body mass and 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 according to the precise position change speed and direction of the target device, and then the relative distance and orientation of the first docking robot and the second docking robot can be locked by controlling the driving force and torque vector of the docking robot, 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 keep the position following. Among them, the relative distance between the first docking robot and the second docking robot remains unchanged, which can be achieved by controlling the movement speed and direction of the first docking robot and the second docking robot.

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

[0111] In some embodiments, the image processing module detects the target device and the docking robot based on the YOLOv5s neural network algorithm, which can achieve fast and efficient target detection. In view of the distortion problem of underwater cameras when taking pictures, camera calibration is introduced to complete spatial positioning.

[0112] In some embodiments, the EPnP algorithm is used to estimate the spatial pose between the docking interface of the target device and the underwater docking robot in real time based on the 2D-3D matching point pair information. At the same time, the target device and the docking interface are detected in real time based on the YOLOv5s neural network algorithm to obtain the precise position of the docking interface.

[0113] In some embodiments, the real-time and accurate tracking of the position of the target device is implemented based on a 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. The 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 with 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 to 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 slidably 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. The locking is completed.

[0115] In some embodiments, the present application also provides an active underwater robot flexible docking and capture control method, 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 be retracted, 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 by docking the docking robots, flexible docking and controllable recovery are achieved to avoid 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 two docking robots capture a target device at the same time, achieving stable control of the posture of the target device, avoiding cable entanglement, and achieving reliable recovery. Through the collection device and the buffer locking mechanism, the contact between the target device and the mother body is buffered 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 posture lock, thereby ensuring the posture balance of the target device.

[0124] In some embodiments, the balance control device includes: a PID controller, and the PID controller outputs control parameters of the force of 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 posture balance of the docking robot. 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 collection device to control the pulling force of the collection 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 collection 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, Fig. 9 FIG. 1 is a schematic diagram of a cross-sectional structure of a cable according to an embodiment of the present invention. The cable 1000 may 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 gravity effect of the zero-gravity cables, so that the force balance at both ends of the underwater equipment is easier to control, ensuring the stable recovery of the underwater equipment. Fig. 9The cable 1000 is used for underwater equipment recovery, including 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, and 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 fresh water. In addition, by providing an inflatable cavity, the cable can be in an expanded state when inflated, and is 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 the motion control is easier.

[0128] In some embodiments, the cable comprises at least two air-filled cavities, the cable is arranged at the center of the cable, and at least two of the air-filled cavities extend along the cable. In some embodiments, the cable has two air-filled cavities, the cable is arranged at the center of the cable, the two air-filled cavities extend along the cable, and are symmetrically arranged on both sides of the cable.

[0129] Fig.10 It is a schematic diagram of the cross-sectional structure of a control valve of a cable according to an embodiment of the present invention. Fig.11 for Fig.10 AA section diagram. Fig.10 and Fig.11 In some embodiments, a control valve 300 is provided at one end of the cable used to connect 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. Fig. 9 and Fig.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 end of the cable used to connect to the mother body has an inflatable device 400, and the inflatable device can be installed on the mother body. In some embodiments, the mother body is provided with an inflatable device, and each cable is provided with at least two independent inflatable devices, and each inflatable device can inflate at least one inflatable cavity. In some embodiments, the cable has two inflatable cavities, and each inflatable 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 of inflation due to failure of a certain inflatable cavity or a certain inflatable device, especially failure of inflation 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 a certain inflatable device fails, the control valve can be opened, so that another inflatable device can be used to directly inflate the two inflatable cavities. When a certain 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 of an underwater robot docking and capture control system is also provided. The underwater robot docking and capture control system is the underwater robot docking and capture control system as 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 cavity can be conveniently controlled and adjusted, thereby adjusting the buoyancy of the entire cable to adapt to the movement state of the cable, prevent entanglement, and improve 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 to make the buoyancy of the cable greater than the gravity of the cable, so that the cable itself has an upward driving force under the action of buoyancy, reducing the driving force required for the docking robot, and the docking robot is easier and faster to approach the underwater equipment that needs to be docked. Of course, the buoyancy of the cable cannot be too greater than the gravity 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 embodiment of the present application, the docking process between the docking robot and the target device refers to the process of accurately positioning the target device at a close distance when the docking robot approaches the target device and completing the docking and locking process, that is, the docking pin and the docking port complete the docking and locking. In this process, the buoyancy of the cable is equal to the gravity of the cable, which can effectively prevent entanglement and facilitate the motion control of the docking robot, so that the docking pin and the docking port can accurately complete the docking and locking and reduce docking impact 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 collecting device on the cable and / or the inflation device adjusts the buoyancy of the cable to balance the posture of the target device.

[0138] During the cable descent or recovery process, the docking robot also descends with the underwater equipment. The air pressure in the inflated cavity can be appropriately reduced to make the buoyancy of the cable less than or equal to the weight of the cable. As a result, the cable itself has a downward driving force or 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 buoyancy of the cable cannot be too small. The cable should not move downward too fast under the action of gravity, pulling the docking robot and preventing the docking robot from losing control. It is also necessary to prevent the cable from moving downward at a speed greater than the cable collection speed of the collection device, so that the cables will be stacked and entangled, hindering recovery.

[0139] Fig.16 Schematic diagram of the force state of the underwater robot docking 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, 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, the second cable is connected to the second docking robot, the first docking robot and the second docking robot are docked with the front and rear ends of the target device respectively, and the balance control method includes:

[0141] When the tension of any one of the first cable and the second cable is 0, and the tension of the other cable is not 0, 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 collection device on the first cable and the second cable to increase the pulling force on the first cable and the second cable.

[0143] Specifically, Fig.16 As shown in FIG. 1 , 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驱动 The driving force F of the second docking robot on the target device is downward. 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 of the first cable F 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 、Buoyancy of the second cable F 2f The relationship is:

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

[0148] In the balanced 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 to which the target device itself is subjected, thereby controlling its horizontal posture.

[0150] In some embodiments, the cable has a plurality of inflatable cavities, and the plurality of inflatable cavities are more than three, for example, three, four, or five inflatable cavities. In some embodiments, the number of inflatable cavities is not more than 5. By providing two or more inflatable cavities, the reliability of inflation can be ensured, and the failure to inflate due to damage or blockage of a certain inflatable cavity can be avoided. In addition, the number of inflatable cavities is not more than 5, which can simplify the structure, reduce the difficulty of processing and manufacturing, and also avoid the easy blockage caused by the small cross-sectional size of a single inflatable cavity. In some embodiments, the number of inflatable cavities is 2-5, and an independent inflatable device is provided for each inflatable cavity, and the number of independent inflatable devices is 2-5. Providing multiple independent inflatable devices can ensure the inflation pressure and improve the inflation efficiency. In some embodiments, two or more inflatable cavities share an independent inflatable device. Of course, each cable has at least two independent inflatable devices. The inflatable cavities corresponding to the two independent inflatable devices are connected by a control valve. Under the action of the control valve, the two inflatable cavities are connected or disconnected. 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 embodiment of the present application, by providing multiple inflatable cavities and multiple independent inflatable devices, the reliability and efficiency of inflation are further guaranteed, and the anti-entanglement effect is better. In addition, the air pressure in the multiple inflatable cavities can be controlled so that the air pressure in different inflatable cavities is different, so as to adapt to the influence of the water flow direction.

[0152] refer to Fig.12 The cable has three inflatable cavities, namely, the first inflatable cavity 2011, the second inflatable cavity 2012 and the third inflatable cavity 2013. An independent inflatable device is provided for each inflatable cavity, and three independent inflatable devices are provided. Every two adjacent inflatable cavities are connected by a control valve 300, that is, 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] Fig.13FIG. 1 is a schematic diagram of the composite material layer structure of a cable according to an embodiment of the present invention. Fig. 9 and Fig.13 , the outer side of the cable is wrapped with a composite material layer 500, and the composite material layer is made of a high-strength material. The composite material layer is made of a flexible material that is resistant to bending. The setting of the composite material layer can ensure that the cable can be wound, but will not bend, thereby avoiding damage to the inflatable cavity and the cable, but it is convenient for recycling. In some embodiments, the composite material layer includes a tensile layer 501, a bending layer 502 and a protective layer 503, and the protective layer is arranged on the periphery of the tensile layer, and the tensile layer is arranged on the periphery of the bending layer. The tensile layer 501 has a large strength and is used to prevent the cable from being broken due to excessive tension. The tensile layer 501 can be composed of metal wires, and the metal wires form a mesh structure. The metal wires can be stainless steel. The bending layer 502 has a large rigidity and is used to prevent the cable from bending due to excessive bending moment. The bending layer 502 can be a flexible plastic. The protective layer 503 has good wear resistance and corrosion resistance, which is used to prevent the cable from being worn and corroded in the seawater environment and during the recovery process. The protective layer 503 can be made of rubber material. By arranging the anti-bending layer, the anti-tensile layer and the protective layer in sequence, with the anti-bending layer at the innermost side and the protective layer at the outermost side, wear, tear and bending can be effectively prevented.

[0154] refer to Fig. 9 In some embodiments, the outer periphery of the cable has an insulating layer 600, and the insulating layer is arranged between the cable and the air-filled cavity. The insulating layer 600 is arranged 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 elastic material. The cavity skin has good flexibility and elasticity and can adapt to different inflation pressures. The cavity skin 202 also has good air tightness. 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. Fig. 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] Fig.14 FIG. 1 is a schematic cross-sectional view of a cable according to an embodiment of the present invention. Fig.14 As shown, the inflatable cavity 201 has an inflatable support structure. Fig.15 FIG. 1 is a schematic diagram of an inflatable support structure of a cable according to an embodiment of the present invention. Fig.14and Fig.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. There are multiple inflatable holes 204 on the inflatable column 203. Multiple inflatable holes 204 can be arranged at intervals on the inflatable column 203. Multiple inflatable holes 204 can be staggered to prevent blockage. The inflatable device is connected to the inflatable column 203. When inflating, 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 hole 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 to 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, the inflatable cavity 201 is two symmetrically arranged, and after the inflatable cavity is flattened, the cable is flat as a whole. Specifically, the connecting rod 205 is tangentially connected to the outside 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, no filling material may be provided or a softer filling material may be provided. The inflatable support structure as a whole can be used as a supporting structure, and the cavity skin 202 is wrapped outside the inflatable support structure, and will not be displaced. The shape and position of the inflated and flattened states are controllable.

[0157] In some embodiments of the present application, after the docking and locking of the docking pin and the docking port are completed, the posture lock of the docking robot is controlled, and the pulling force of the two cables is precisely controlled to ensure the posture balance of the target device (mainly to keep it horizontal in the embodiments of the present application). The posture balance control method of the present application takes into account the pulling force of the cable, the force of the docking robot, the movement change of the target device, the influence of water flow, etc., and also combines the coordinated balance of the two docking robots and the cable to keep the horizontal position of the target device. The entire control process is realized through PID algorithm control, and the cable entanglement can be avoided.

[0158] Fig.17 FIG. 1 is a schematic diagram of an electronic device according to an embodiment of the present invention. Fig.17 In some embodiments, an electronic 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 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, a memory, and a non-volatile memory, and may also include other hardware required for the business. The processor reads the corresponding computer program from the non-volatile memory into the memory and then runs it to implement the above method.

[0160] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. An underwater robot docking and capture control system, characterized in that: The underwater robot docking and capturing control system comprises: At least two docking robots, wherein the at least two docking robots are used to simultaneously dock and capture a target device; a mother body, 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 correspond to the at least two docking robots one by one, and each of the docking robots is connected to the mother body through one of the cables; A collecting device, the collecting device is located on the mother body and is used to drive the cable to be retracted, so as to drive the target device captured by the docking robot to be recovered; A positioning device, 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.

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 comprises 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, 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 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. The underwater robot docking and capture control system according to claim 5, characterized in that: 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.

7. 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 described in any one of claims 1 to 6 to complete the docking of the docking robot with the target device.

8. The underwater robot docking capture control method according to claim 7, characterized in that: The control method comprises: Acquire the position of the target device located by a remote positioning device; driving the docking robot to move toward the target device; Acquire 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.

9. The underwater robot docking capture control method according to claim 8, characterized in that: The step of locking the position of the docking robot and the target device comprises: 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.

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

Images