A method for docking underwater bionic robots based on USBL

Through the USBL-based underwater bionic robot connection method, heading correction and docking are carried out in stages, solving the problem of time waste and connection failure caused by the return or manual recycling of underwater bionic robots, realizing direct underwater energy replenishment and data Downloads and task updates improve connection success rate.

CN115373386BActive Publication Date: 2024-11-15HUNAN GUOTIAN ELECTRONICS TECH CO LTD +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210931009.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-08-04
Publication Date
2024-11-15
Estimated Expiration
2042-08-04

AI Technical Summary

Technical Problem

Existing underwater bionic robots need to automatically return or manually recover energy replenishment, data download and task update after completing work tasks, resulting in a high risk of time waste and connection failure.

Method used

The USBL-based underwater bionic robot connection method is adopted. Through three stages: long-range, medium-range and short-range, the heading correction and docking algorithm is used to directly perform energy replenishment, data download and task update underwater. Avoid returning or manual recycling.

Benefits of technology

It saves work tasks time, improves the connection success rate, and realizes the energy replenishment, data download and task update directly underwater by underwater.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115373386B_ABST
    Figure CN115373386B_ABST
Patent Text Reader

Abstract

The present invention discloses a USBL-based underwater bionic robot docking method. After the underwater bionic robot sails to the docking starting point, if no USBL signal is searched, it will perform a roundabout navigation at 50m in the southeast, northwest and northeast directions of point A to search for USBL signals until a signal is searched in one of the directions, and the heading is corrected according to a first heading correction algorithm; three heading adjustment points are set at 100m, 200m and 300m from the docking station, and the underwater bionic robot corrects the heading according to a second heading correction algorithm after receiving the USBL signal; when the underwater bionic robot is 100m away from the docking station, it keeps the route straight, and when it is 2m away from the docking station, the underwater bionic robot turns off the power device and uses its own inertia to dock. The present invention continuously corrects the docking route of the underwater bionic robot through the three-stage search of far, middle and near, thereby improving the docking success rate.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of underwater detection equipment, and in particular relates to a USBL-based underwater bionic robot docking method. Background Art

[0002] Existing underwater bionic robots (taking bionic fish as an example) are generally small in size, carry insufficient energy, and cannot work in water for a long time. After completing a task, they need to return to the home port automatically or be manually recovered, and then replenish energy, download data, and update tasks. Since their automatic return or manual recovery takes a long time, a certain amount of work time is wasted. In addition, if the docking search process is not accurate, the underwater bionic robot will also fail to dock. Summary of the invention

[0003] In view of the current status of various docking stations, the present invention designs a USBL-based underwater bionic robot docking method for inclusive docking stations after analyzing the relevant principles of docking. This solution does not require the underwater bionic robot to achieve energy replenishment, data download, and task update through automatic return or manual recovery, and can be achieved directly underwater through the docking station. According to the coordinate position of the underwater bionic robot and the docking station, the entire docking process is divided into three stages: long-range, medium-range, and short-range, and different docking algorithms are used to correct the heading of the underwater bionic robot.

[0004] The USBL-based underwater bionic robot docking method disclosed in the present invention is applied to an underwater bionic robot and a docking station, and comprises the following steps:

[0005] After the underwater bionic robot autonomously navigates underwater to the docking starting point A, it starts to search for the pulse signal emitted by the docking station USBL. After receiving the USBL signal, the underwater bionic robot performs underwater bionic robot position correction according to the signal information. If the USBL signal is not found, it performs a roundabout navigation at 50m in the southeast, northwest and northeast directions of point A to search for the USBL signal until a signal is found in one of the directions, and then corrects the heading according to the first heading correction algorithm;

[0006] Three heading adjustment points are set on the center line of the docking station at 100m, 200m and 300m away from the docking station. After receiving the pulse signal from the USBL on the docking station, the underwater bionic robot corrects the heading according to the second heading correction algorithm;

[0007] When the underwater bionic robot is 100m away from the docking station, it keeps going straight. When it is 2m away from the docking station, the underwater bionic robot turns off the power device and uses its own inertia to dock with the docking station. The docking station drives the plug-in device to raise the pin and lock the underwater bionic robot.

[0008] Furthermore, the first heading correction algorithm is as follows:

[0009]

[0010]

[0011] Among them, α is the installation angle of the docking station, Long M and Lat M are the absolute longitude and latitude of the docking station M, Long M and Lat M are the absolute longitude and latitude of the underwater bionic robot N, β is the horizontal azimuth between the underwater bionic robot and the docking station, and L is the distance between the docking station and the underwater bionic robot.

[0012] Furthermore, the second heading correction algorithm is as follows:

[0013]

[0014]

[0015]

[0016]

[0017] Wherein, α is the installation angle of the docking station, Long M and Lat M are the absolute position latitude and longitude of the docking station M, Long M and Lat M are the absolute position latitude and longitude of the underwater bionic robot N, β is the horizontal azimuth between the underwater bionic robot and the docking station, L is the distance between the docking station and the underwater bionic robot, h is the height difference between the underwater bionic robot and the docking station, v x is the horizontal speed of the underwater bionic robot, v y is the vertical speed of the underwater bionic robot.

[0018] Furthermore, the position where the plug-in device is connected to the underwater bionic robot is calculated as follows:

[0019]

[0020] ξ is the seawater resistance coefficient, S is the cross-sectional area of ​​the underwater bionic robot tail rudder, t is the difference between the time of driving the plug-in device and the time of successful docking, L joint is the position where the plug-in device is connected to the underwater bionic robot, m0 is the mass of the underwater bionic robot, g is gravity, ρ is the density of seawater, and v water is the seawater flow rate.

[0021] Furthermore, after the docking station is connected to the underwater bionic robot, an underwater electrical connector is used to replenish energy, download data and update tasks for the underwater bionic robot.

[0022] Furthermore, the connection starting point A is 500m away from the connection station

[0023] The beneficial effects of the present invention are as follows:

[0024] Due to technical problems, existing underwater bionic robots need to return automatically or be manually recovered after completing a work task, and then they need to replenish energy, download data, and update tasks. Since their automatic return or manual recovery takes a lot of time, a certain amount of work task time is wasted. The present invention is aimed at an inclusive docking station, which does not require the underwater bionic robot to achieve energy replenishment, data download, and task update through automatic return or manual recovery. It can be achieved directly underwater through docking stations, saving work task time. At the same time, through the three-stage search of far, medium and near, the docking route of the underwater bionic robot is continuously corrected, thereby improving the docking success rate. BRIEF DESCRIPTION OF THE DRAWINGS

[0025] Figure 1 Schematic diagram of the connection method of the present invention;

[0026] Figure 2 Flow chart of the remote connection algorithm of the present invention;

[0027] Figure 3 Flowchart of the mid-range docking algorithm of the present invention. DETAILED DESCRIPTION

[0028] The present invention is further described below in conjunction with the accompanying drawings, but the present invention is not limited in any way. Any changes or substitutions made based on the teachings of the present invention belong to the protection scope of the present invention.

[0029] The USBL (Ultra-Short Baseline) system includes: a docking station (transceiver array) and a beacon (transponder). The beacon can be installed on underwater bionic robots that need to be positioned, such as towed fish, AUV, ROV, etc.

[0030] In order for the underwater bionic robot to dock accurately with the docking station, the location of the docking station must be accurately determined. Among them, the location of the docking station mainly refers to its absolute position and relative position. The absolute position of the docking station mainly refers to the latitude and longitude, depth and opening position of the docking station; the relative position of the docking station mainly refers to the relative distance, relative horizontal and vertical angle, etc. The absolute position can be stored on the underwater bionic robot by pre-storing the position on the docking station, and the relative position needs to be calculated in real time during the underwater movement of the underwater bionic robot. Due to the limited technical capabilities at present, the underwater bionic robot does not have the computing capability for the time being. The docking station needs to calculate the relative position and transmit it to the underwater bionic robot through underwater acoustic communication. After the underwater bionic robot arrives near the docking station, it transmits information with the docking station in a cycle of 2s through the USBL ultra-short baseline. The underwater bionic robot transmits a pulse signal. After receiving the signal, the docking station calculates the underwater bionic robot's relative position, horizontal and vertical azimuth angles and other data information. This information is transmitted to the underwater bionic robot in the form of a pulse signal, and then the relative distance is calculated based on the time difference between the transmitted signal and the received signal, as well as the propagation speed of the signal in the water. The underwater bionic robot initially transmits all received signals to the underwater bionic robot central management system.

[0031] The present invention divides the underwater docking of the underwater bionic robot into three stages: long-range, medium-range, and short-range. The first stage is the long-range search stage, in which the main purpose is to search for the signal of the docking station USBL, and to make a preliminary correction to the course after receiving the signal. The second stage is the medium-range search stage, in which the main purpose is to adjust the course of the underwater bionic robot according to the absolute position of the docking station, so that it sails to the opening direction of the docking station. The third stage is the short-range search, in which the main purpose is to maintain navigation and docking according to the position of the docking station. The schematic diagram of the docking in the three stages is shown in the figure. Figure 1 .

[0032] Long-range search phase search algorithm

[0033] Remote search mainly involves the underwater bionic robot autonomously navigating underwater to point A and then searching for the pulse signal emitted by the docking station USBL. Since there is a certain error between the position calculated by the underwater bionic robot's inertial navigation system and the actual position, the algorithm flow is as follows: Figure 2 As shown. When the underwater bionic robot reaches point A, it actually reaches point A1 near point A due to the error of the inertial navigation system. After receiving the USBL signal, the underwater bionic robot position correction is performed according to the signal information. If the USBL signal is not found within 5 pulse signal cycles, it is necessary to perform a roundabout navigation at 50m in the east, south, west and north directions of point A to search for the USBL signal until the signal is found in one of the directions, and then correct the error caused by the inertial navigation system according to the signal.

[0034] It is known that the installation angle of the docking station is α (0 for the true north direction and negative for the clockwise direction), the longitude and latitude of the absolute position of the docking station M is (Long M, Lat M), the horizontal azimuth between the underwater bionic robot and the docking station is β, and the distance between the two is L. When the radian system is converted to the angle system, 180 / π radians ≈ 57.3°. According to the correction algorithm of the error generated by the inertial navigation system, the longitude and latitude of the underwater bionic robot N after correction based on the received USBL signal is:

[0035]

[0036]

[0037] The aircraft searches for USBL signals by circling in four directions: southeast, northwest, and northeast. As long as a signal is found in one direction, corrections will be made in that direction.

[0038] Mid-range search phase search algorithm

[0039] Three heading adjustment points are set at 100m, 200m and 300m away from the docking station on the center line of the docking station. After receiving the pulse signal from the USBL on the docking station, the underwater bionic robot will correct its heading. After adjustment, the heading of the underwater bionic robot is on the same horizontal plane as the center line of the docking station. Figure 3 , the correction algorithm process is as follows:

[0040] It is known that the installation angle of the docking station is α (0 is the north direction and negative is clockwise), the absolute position longitude and latitude of the docking station M is (Long M, Lat M), the horizontal azimuth between the underwater bionic robot and the docking station is β, and the distance between the two is L. When the radian system is converted to the angle system, 180 / π radians ≈ 57.3°. According to the correction algorithm of the error generated by the inertial navigation system, the longitude and latitude of the underwater bionic robot N after correction based on the received USBL signal is:

[0041]

[0042]

[0043]

[0044]

[0045] Where h is the height difference between the underwater bionic robot and the docking station, v x is the horizontal speed of the underwater bionic robot, v y It is the vertical speed of the underwater bionic robot. The position of three mid-range points is corrected to improve the accuracy of the docking route, laying the foundation for subsequent short-range search. Short-range docking only requires keeping the route straight.

[0046] Proximity search phase search algorithm

[0047] When the underwater bionic robot is 100m away from the docking station, it keeps its route straight. When it is 2m away from the docking station, the underwater bionic robot turns off the power device and uses its own inertia to dock with the docking station. The docking station will drive the plug-in device to raise the latch to lock the underwater bionic robot. Due to their small size and weight, some underwater bionic robots are likely to be affected by the ocean current during the docking process, causing certain errors when docking with the docking station. The docking station central management system needs to make corrections, calculate the corrected position of the underwater bionic robot and drive the plug-in device.

[0048] The position where the plug-in device is connected to the underwater bionic robot is calculated as follows:

[0049]

[0050] ξ is the seawater resistance coefficient, S is the cross-sectional area of ​​the underwater bionic robot tail rudder, t is the difference between the time of driving the plug-in device and the time of successful docking, L joint is the position where the plug-in device is connected to the underwater bionic robot, m0 is the mass of the underwater bionic robot, g is gravity, ρ is the density of seawater, and v water is the seawater flow rate.

[0051] After the docking station is connected to the underwater bionic robot, the underwater electrical connector is used to replenish energy, download data, and update tasks for the underwater bionic robot. The underwater electrical connector can be a wired charging method or a wireless charging method. The docking station downloads the collected data from the underwater bionic robot through short-range communication, and performs data configuration or software upgrades, task updates, and other tasks on the underwater bionic robot.

[0052] The beneficial effects of the present invention are as follows:

[0053] Due to technical problems, existing underwater bionic robots need to return automatically or be manually recovered after completing a work task, and then they need to replenish energy, download data, and update tasks. Since their automatic return or manual recovery takes a lot of time, a certain amount of work task time is wasted. The present invention is aimed at an inclusive docking station, which does not require the underwater bionic robot to achieve energy replenishment, data download, and task update through automatic return or manual recovery. It can be achieved directly underwater through docking stations, saving work task time. At the same time, through the three-stage search of far, medium and near, the docking route of the underwater bionic robot is continuously corrected, thereby improving the docking success rate.

[0054] As used herein, the word "preferred" is intended to be used as an example, instance, or illustration. Any aspect or design described herein as "preferred" is not necessarily to be construed as being more advantageous than other aspects or designs. On the contrary, the use of the word "preferred" is intended to present concepts in a specific way. The term "or" as used in this application is intended to mean an inclusive "or" rather than an exclusive "or". That is, unless otherwise specified or clear from the context, "X uses A or B" means any one of the naturally included permutations. That is, if X uses A; X uses B; or X uses both A and B, then "X uses A or B" is satisfied in any of the foregoing examples.

[0055] Moreover, although the present disclosure has been shown and described with respect to one or implementations, those skilled in the art will think of equivalent variations and modifications based on the reading and understanding of this specification and the accompanying drawings. The present disclosure includes all such modifications and variations, and is limited only by the scope of the appended claims. In particular, with respect to the various functions performed by the above-mentioned components (such as elements, etc.), the terms used to describe such components are intended to correspond to any component (unless otherwise indicated) that performs the specified function of the component (such as it is functionally equivalent), even if the structure is not equivalent to the disclosed structure of the function in the exemplary implementation of the present disclosure shown herein. In addition, although the specific features of the present disclosure have been disclosed with respect to only one of several implementations, such features can be combined with one or other features of other implementations that may be desired and advantageous for a given or specific application. Moreover, insofar as the terms "including", "having", "containing" or their variations are used in specific embodiments or claims, such terms are intended to be included in a manner similar to the term "comprising".

[0056] The functional units in the embodiments of the present invention may be integrated into a processing module, or each unit may exist physically separately, or multiple or more units may be integrated into one module. The above-mentioned integrated module may be implemented in the form of hardware or in the form of a software functional module. If the integrated module is implemented in the form of a software functional module and sold or used as an independent product, it may also be stored in a computer-readable storage medium. The above-mentioned storage medium may be a read-only memory, a disk or an optical disk, etc. The above-mentioned devices or systems may execute the storage method in the corresponding method embodiment.

[0057] To sum up, the above embodiment is an implementation mode of the present invention, but the implementation mode of the present invention is not limited by the embodiment. Any other changes, modifications, substitutions, combinations, and simplifications that deviate from the spirit and principles of the present invention should be equivalent replacement methods and are included in the protection scope of the present invention.

Claims

1. A USBL-based underwater bionic robot docking method, applied to underwater bionic robots and docking stations, It is characterized in that The following steps are involved: After the underwater bionic robot autonomously navigates underwater to the docking starting point A, it starts to search for the pulse signal emitted by the docking station USBL. After receiving the USBL signal, the underwater bionic robot performs underwater bionic robot position correction according to the signal information. If the USBL signal is not found, it performs a roundabout navigation at 50m in the southeast, northwest and northeast directions of point A to search for the USBL signal until a signal is found in one of the directions, and then corrects the heading according to the first heading correction algorithm; Three heading adjustment points are set on the center line of the docking station at 100m, 200m and 300m away from the docking station. After receiving the pulse signal from the USBL on the docking station, the underwater bionic robot corrects the heading according to the second heading correction algorithm; The second heading correction algorithm is as follows: Wherein, t is the difference between the time of driving the plug-in device and the time of successful docking, α is the installation angle of the docking station, Long M and Lat M are the absolute position latitude and longitude of the docking station M, Long N and LatN are the absolute position latitude and longitude of the underwater bionic robot N, β is the horizontal azimuth between the underwater bionic robot and the docking station, L is the distance between the docking station and the underwater bionic robot, h is the height difference between the underwater bionic robot and the docking station, v x is the horizontal speed of the underwater bionic robot, v y is the vertical speed of the underwater bionic robot; When the underwater bionic robot is 100m away from the docking station, it keeps going straight. When it is 2m away from the docking station, the underwater bionic robot turns off the power device and uses its own inertia to dock with the docking station. The docking station drives the plug-in device to raise the pin and lock the underwater bionic robot.

2. The USBL-based underwater bionic robot docking method according to claim 1, It is characterized in that The first heading correction algorithm is as follows: Among them, α is the installation angle of the docking station, Long M and Lat M are the absolute longitude and latitude of the docking station M, LongN and LatN are the absolute longitude and latitude of the underwater bionic robot N, β is the horizontal azimuth between the underwater bionic robot and the docking station, and L is the distance between the docking station and the underwater bionic robot.

3. The USBL-based underwater bionic robot docking method according to claim 1, It is characterized in that The position where the plug-in device is connected to the underwater bionic robot is calculated as follows: ξ is the seawater resistance coefficient, S is the cross-sectional area of ​​the underwater bionic robot tail rudder, t is the difference between the time of driving the plug-in device and the time of successful docking, L joint is the position where the plug-in device is connected to the underwater bionic robot, m 0 is the mass of the underwater bionic robot, g is gravity, ρ is the density of seawater, v water is the seawater flow rate.

4. The USBL-based underwater bionic robot docking method according to claim 1, It is characterized in that After the docking station is connected to the underwater bionic robot, an underwater electrical connector is used to replenish energy, download data and update tasks for the underwater bionic robot.

5. The USBL-based underwater bionic robot docking method according to claim 1, It is characterized in that The connection starting point A is 500m away from the connection station.