High-precision relative positioning method for underwater cleaning robots

By setting up fixed acoustic position reference points and synchronous short baseline positioning system on the hull, the underwater relative coordinate system is established, and the problem of insufficient positioning accuracy of underwater cleaning robots is solved, and centimeter-level high-precision positioning and blind spot cleaning are achieved, improving the Work efficiency and cost-effectiveness.

CN115837964BActive Publication Date: 2024-11-15750 TEST SITE OF CHINA SHIPBUILDING IND CORP
View PDF 0 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

Existing underwater cleaning robots are difficult to achieve high-precision positioning under differential conditions of no GPS at sea, resulting in insufficient cleaning accuracy and the inability to clean the hull shell without dead corners, and there are areas for cleaning missing.

Method used

Using a synchronous short baseline positioning system based on the hull's own structural dimensions and fixed acoustic position reference points, establish an underwater relative coordinate space system, eliminate GPS measurement errors and coordinate conversion errors, and calculate underwater through synchronous sound source and short baseline transducer Clean the relative and absolute coordinates of the robot to achieve high-precision positioning at centimeter level.

Benefits of technology

Under complex sea conditions, high-precision positioning of underwater robots can be achieved, operating efficiency, reduce costs, and ensure that there are no blind spots in the hull shell.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115837964B_ABST
    Figure CN115837964B_ABST
Patent Text Reader

Abstract

The high-precision relative positioning method for an underwater cleaning robot of the present invention is used for positioning the underwater cleaning robot on a working mother ship. A second synchronous sound source is installed on the underwater cleaning robot, the cleaning ship is placed in the water near the working mother ship, a first synchronous sound source is fixed on the bow or stern side wall of the working mother ship, a first short base array element and a second short base array element are fixed on the cleaning ship, the first short baseline transducer and the second short baseline transducer are located at the same water depth on the same side of the cleaning ship, the vertical distance between the first short baseline transducer and the second short baseline transducer is a, the coordinates of the underwater cleaning robot and the first synchronous sound source in the relative coordinate system are calculated, and the motion trajectory of the underwater cleaning robot is drawn. The present invention can effectively reduce the influence of the base array attitude and heading caused by the shaking of the cleaning ship and the working ship caused by wind and waves at sea within the same period, and meet the actual operation measurement needs under complex sea conditions.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of marine engineering and relates to a high-precision relative positioning method for an underwater cleaning robot. Background Art

[0002] When an underwater cleaning robot is performing long-term continuous cleaning of a ship's hull at sea, operators need to know in real time the specific position of the underwater robot relative to the ship being cleaned, as well as its navigation trajectory, to provide underwater coordinate references for the underwater robot to perform high-precision manual operations and automatic intelligent operations, so as to achieve efficient cleaning and reduce operating costs.

[0003] When existing underwater cleaning robots are adsorbed below the water surface of the cleaning ship's hull and work continuously for a long time, most of them use the ship-borne ultra-short baseline positioning method to locate the underwater coordinates of the underwater cleaning robot, and combine the spatial absolute geodetic coordinates of the ship-borne ultra-short baseline array to calculate the spatial absolute geodetic coordinates of the underwater cleaning robot relative to the ultra-short baseline array. In addition to the hydroacoustic measurement error, GPS positioning error and conversion error between hydroacoustic measurement coordinates and absolute geodetic coordinates will inevitably occur. Especially under the condition of no GPS differential at sea, the final error of the real-time positioning accuracy of the underwater target will be more than 2 meters, making it difficult for the underwater cleaning robot to completely clean the hull of the ship at sea without dead ends, and there will be areas that are missed when cleaning.

[0004] In order to solve this engineering and technical problem, the present invention proposes a method based on the structural dimensions of the hull itself, setting a fixed acoustic position reference point of the hull, and combining the synchronous short baseline positioning system on the operating vessel to establish an underwater relative coordinate space system, thereby eliminating GPS measurement errors and coordinate conversion errors, thereby providing underwater high-precision positioning and navigation technical support for underwater cleaning robots when they operate continuously underwater for a long time. Summary of the invention

[0005] The invention purpose of this application is to solve the problem that it is difficult to achieve long-term continuous high-precision positioning and tracking requirements for underwater cleaning robots by combining existing inertial navigation technology, GPS and hydroacoustic measurement technology. Based on a synchronous quick shipborne segment baseline system, a new underwater high-precision relative positioning method based on setting a fixed reference point on the hull is proposed. This application can eliminate GPS measurement errors and coordinate conversion errors, and does not require the assistance of inertial navigation and GPS equipment. It can achieve centimeter-level high-precision positioning and navigation of underwater robots in complex sea conditions, thereby improving underwater operation efficiency and reducing operation costs.

[0006] In order to achieve the invention purpose of this application, this application adopts the following technical solutions:

[0007] The invention discloses a high-precision relative positioning method for an underwater cleaning robot. The method is used for positioning the underwater cleaning robot on a work mother ship. The underwater cleaning robot is attached to the side wall of the work mother ship and is used to clean the side wall of the work mother ship. A second synchronous sound source is installed on the underwater cleaning robot. The cleaning ship is placed in the water near the work mother ship. A first synchronous sound source is fixed on the bow or stern side wall of the work mother ship. A first short-base array element and a second short-base array element are fixed on the cleaning ship. The first short-base array element includes: a first array frame and a first short-baseline transducer. The first short-baseline transducer is fixed at the bottom end of the first array frame, and the first array frame is fixed to the side wall of the cleaning ship. The second short-baseline array element includes: a second array frame and a second short-baseline transducer. The second short-baseline transducer is fixed at the bottom end of the second array frame, and the second array frame is fixed to the side wall of the cleaning ship. The first short-baseline transducer and the second short-baseline transducer are located at the same water depth on the same side of the cleaning ship. The vertical distance between the first short-baseline transducer and the second short-baseline transducer is a, wherein:

[0008] High-precision relative positioning methods for underwater cleaning robots include:

[0009] (a) Calculate the coordinates of the underwater cleaning robot and the first synchronous sound source in the relative coordinate system

[0010] A relative coordinate system of the X-axis and the Y-axis is established with the line connecting the first short baseline transducer and the second short baseline transducer as the X-axis, the first short baseline transducer as the origin, and the axis perpendicular to the X-axis and parallel to the water surface as the Y-axis. In the relative coordinate system, the coordinate A1 of the first short baseline transducer is (0, 0), the coordinate A2 of the second short baseline transducer is (a, 0), and the distances from the coordinate α(x1, y1) of the first synchronous sound source to the first short baseline transducer and the second short baseline transducer are ct1 and ct2, respectively, where c is the propagation speed of sound waves in water, t1 and t2 are the time differences between the sound waves emitted by the first synchronous sound source and the sound waves reaching the first short baseline array element and the second short baseline array element, respectively. The coordinate α(x1, y1) of the first synchronous sound source is calculated in real time using the following formula, and at the same time, the first synchronous sound source sends the depth z1 of the first synchronous sound source to the first short baseline transducer and the second short baseline transducer in a beacon coding manner;

[0011]

[0012] The distances from the coordinate β(x2, y2) of the second synchronous sound source to the first short baseline transducer and the second short baseline transducer are ct3 and ct4, respectively, where c is the propagation speed of sound waves in water, t3 and t4 are the time differences for the sound waves emitted by the second synchronous sound source to reach the first short baseline transducer and the second short baseline transducer, respectively. The coordinate β(x2, y2) of the second synchronous sound source is calculated in real time using the following formula, and at the same time, the second synchronous sound source sends the depth z2 of the second synchronous sound source to the first short baseline transducer and the second short baseline transducer in a beacon coding manner;

[0013]

[0014] (b) Draw the motion trajectory of the underwater cleaning robot

[0015] With the first synchronous sound source α(x1,y 1, z1) as the origin, take the axis passing through the origin and parallel to the X axis of the relative coordinate system as the X' axis, take the axis passing through the origin and parallel to the Y axis of the relative coordinate system as the Y' axis, take the axis perpendicular to the X' and Y' planes as the Z' axis, establish the X', Y' and Z' absolute coordinate systems, and calculate the coordinates β (x2-x1, y2-y 1, z2-z1), draw the motion trajectory of the underwater cleaning robot in the above absolute coordinate system.

[0016] The high-precision relative positioning method for an underwater cleaning robot of the present invention, wherein: the first short-base array element and the second short-base array element are fixed on the side wall of the cleaning ship between the working mother ship and the cleaning ship.

[0017] The high-precision relative positioning method for an underwater cleaning robot of the present invention, wherein: the first synchronous sound source is fixed to the bow or stern hull of the working mother ship through its magnetic base.

[0018] Based on the two beacon positions (reference points) fixed on the hull of the cleaning ship, the relative coordinate position of the underwater cleaning robot on the hull of the cleaning ship relative to the two fixed beacon positions (reference points) is established in combination with the draft, length and width of the cleaning ship. The three-dimensional spatial position of the underwater cleaning robot relative to the two fixed beacon positions (reference points) in each measurement cycle can be obtained. By summarizing the position relative to the working mother ship during the long-term underwater measurement cycle, the real-time spatial position change of the underwater cleaning robot relative to the mother ship can be obtained, and the cleaning trajectory of the underwater cleaning robot on the hull of the working mother ship can be displayed and recorded.

[0019] Compared with the traditional underwater acoustic positioning + GPS method, the high-precision relative positioning method for underwater cleaning robots of the present invention has the following technical and engineering advantages:

[0020] (1) This solution uses the fixed point (reference point) on the cleaning ship as a reference to locate the underwater cleaning robot. Combined with the relative coordinate system established by the structural dimensions of the working mother ship, the relative coordinate system and the absolute coordinate system are converted with reference to the fixed reference point. The underwater cleaning robot can be relatively positioned and tracked relative to the two reference position points of the cleaning ship, which can eliminate the GPS of the traditional measurement method, eliminate the inherent measurement error and the underwater and surface coordinate conversion error, and improve the positioning accuracy of the system.

[0021] (2) This scheme uses the principle of simple synchronous short baseline two-element positioning + relative reference position. In addition to the advantages of simple installation structure, rapid deployment and recovery, and low cost engineering application, it can effectively reduce the influence of the base array attitude and heading caused by the shaking of cleaning ships and working ships caused by sea waves within the same period, and can meet the actual operation measurement needs under complex sea conditions. BRIEF DESCRIPTION OF THE DRAWINGS

[0022] Figure 1 Schematic diagram of the relationship between the working mother ship, the underwater cleaning robot and the cleaning ship in the high-precision relative positioning method for the underwater cleaning robot of the present application, in which X and Y are relative coordinate systems, and X', Y' and Z' are absolute coordinate systems;

[0023] Figure 2 This is a forward schematic diagram of the relationship between the working mother ship, the underwater cleaning robot and the cleaning ship in the high-precision relative positioning method for the underwater cleaning robot of the present application. For the sake of clarity, the first short base array element and the second short base array element are drawn on the outside of the cleaning ship. In fact, the first short base array element and the second short base array element are on the side wall of the cleaning ship between the working mother ship and the cleaning ship.

[0024] exist Figure 1 and Figure 2 In the figure, number 1 is the first synchronous sound source; number 2 is the second synchronous sound source; number 3 is the underwater cleaning robot; number 4 is the cleaning ship; number 5 is the working mother ship; number 6 is the first short base array element; number 7 is the second short base array element; number 61 is the first array frame; number 62 is the first short baseline transducer; number 71 is the second array frame; number 72 is the second baseline transducer. DETAILED DESCRIPTION

[0025] like Figure 1 and Figure 2As shown, the high-precision relative positioning method for an underwater cleaning robot of the present invention is used for positioning an underwater cleaning robot 3 on a working mother ship 5. The underwater cleaning robot 3 is fixed to the side wall of the working mother ship 5 through its magnetic base and is used to clean the side wall of the working mother ship 5. A second synchronous sound source 2 is installed on the underwater cleaning robot 3. A cleaning ship 4 is placed in the water near the working mother ship 5. A first synchronous sound source 1 is fixed on the bow or stern side wall of the working mother ship 5. A first short base array element 6 and a second short base array element 7 are fixed on the cleaning ship 4. The first short base array element 6 includes: a first array frame 61 and a first short baseline Transducer 62, the first short baseline transducer 62 is fixed at the bottom of the first array frame 61, and the first array frame 61 is fixed to the side wall of the cleaning ship 4; the second short base array element 7 includes: a second array frame 71 and a second short baseline transducer 72, the second short baseline transducer 72 is fixed at the bottom of the second array frame 71, and the second array frame 71 is fixed to the side wall of the cleaning ship 4; the first short base array element 6 and the second short base array element 7 are fixed on the side wall of the cleaning ship 4 between the working mother ship 5 and the cleaning ship 4, they are located at the same water depth on the same side of the cleaning ship 4, and the vertical distance between the first short baseline transducer 62 and the second short baseline transducer 72 is a.

[0026] High-precision relative positioning methods for underwater cleaning robots include:

[0027] (a) Calculate the coordinates of the underwater cleaning robot 3 and the first synchronous sound source 1 in the relative coordinate system

[0028] With the connecting line of the first short baseline transducer 62 and the second short baseline transducer 72 as the X-axis, the first short baseline transducer 62 as the origin, and the axis perpendicular to the X-axis and parallel to the water surface as the Y-axis, a relative coordinate system of the X-axis and the Y-axis is established. In the relative coordinate system, the coordinate A1 of the first short baseline transducer 62 is (0, 0), the coordinate A2 of the second short baseline transducer 72 is (a, 0), and the coordinate α(x1, y1) of the first synchronous sound source 1 is respectively to the first short baseline transducer 62 and the second short baseline The distances between the line transducers (72) are ct1 and ct2, where c is the propagation speed of sound waves in water, t1 and t2 are the time differences between the sound waves emitted by the first synchronous sound source 1 and the first short baseline array element 62 and the second short baseline array element 72, respectively. The coordinates α(x1, y1) of the first synchronous sound source 1 are calculated in real time using the following formula (1), and at the same time, the first synchronous sound source 1 sends the depth z1 of the first synchronous sound source 1 to the first short baseline transducer 62 and the second short baseline transducer (72) in a beacon coding manner;

[0029] According to the distance formula

[0030] Formula (1) and formula (2) can be derived

[0031]

[0032] The distances from the coordinate β(x2, y2) of the second synchronous sound source 2 to the first short baseline transducer 62 and the second short baseline transducer 72 are ct3 and ct4, respectively, where c is the propagation speed of sound waves in water, t3 and t4 are the time differences for the sound waves emitted by the second synchronous sound source 3 to reach the first short baseline transducer 62 and the second short baseline transducer 72, respectively. The coordinate β(x2, y2) of the second synchronous sound source 2 is calculated in real time using the following formula 2, and at the same time, the second synchronous sound source 2 sends the depth z2 of the second synchronous sound source 2 to the first short baseline transducer 62 and the second short baseline transducer 72 in a beacon coding manner;

[0033]

[0034] (b) Draw the motion trajectory of the underwater cleaning robot 3

[0035] With the first synchronous sound source 1α(x1,y 1, z1) as the origin, the axis passing through the origin and parallel to the X axis of the relative coordinate system as the X' axis, the axis passing through the origin and parallel to the Y axis of the relative coordinate system as the Y' axis, and the axis perpendicular to the X' and Y' planes as the Z' axis, establish the X', Y' and Z' absolute coordinate systems, and calculate the coordinates β (x2-x1, y2-y 1, z2-z1), by drawing the motion trajectory of the underwater cleaning robot 3 in the above absolute coordinate system, the trajectory of the underwater cleaning robot 3 on the side wall of the working mother ship 5 can be clearly seen, and the position of the side wall of the working mother ship 5 cleaned by the underwater cleaning robot 3 can be known.

[0036] The two receiving array elements of the shipborne synchronous short baseline array use a metal rigid connecting rod and are fixed on the side of the working mother ship 5 close to the offshore operation ship by downward installation. Each receiving array element has a receiving transducer, and the transducer is located at the bottom of the titanium alloy connecting rod, close to the seabed, which is convenient for the underwater cleaning robot 3 to operate the bottom of the ship. The receiving transducer connection cable is connected to the positioning system signal processing system to display the position information.

[0037] The present invention may also have many other embodiments. Without departing from the spirit and essence of the present invention, technicians familiar with the field may make various corresponding changes and modifications based on the present invention, but these changes and modifications should all fall within the scope of protection of the claims of the present invention.

Claims

1. A high-precision relative positioning method for an underwater cleaning robot, the method being used for positioning an underwater cleaning robot (3) on a work mother ship (5), the underwater cleaning robot (3) being attached to the side wall of the work mother ship (5) and being used for cleaning the side wall of the work mother ship (5), the underwater cleaning robot (3) being provided with a second synchronous sound source (2), the cleaning ship (4) being placed in water near the work mother ship (5), the first synchronous sound source (1) being fixed on the bow or stern side wall of the work mother ship (5), the first short base array element (6) and the second short base array element (7) being fixed on the cleaning ship (4), the first short base array element (6) comprising: A first array frame (61) and a first short baseline transducer (62), the first short baseline transducer (62) is fixed at the bottom end of the first array frame (61), and the first array frame (61) is fixed to the side wall of the cleaning ship (4); the second short base array element (7) comprises: a second array frame (71) and a second short baseline transducer (72), the second short baseline transducer (72) is fixed at the bottom end of the second array frame (71), and the second array frame (71) is fixed to the side wall of the cleaning ship (4); the first short baseline transducer (62) and the second short baseline transducer (72) are located at the same water depth on the same side of the cleaning ship (4), and the vertical distance between the first short baseline transducer (62) and the second short baseline transducer (72) is a, characterized in that: High-precision relative positioning methods for underwater cleaning robots include: (a), calculating the coordinates of the underwater cleaning robot (3) and the first synchronous sound source (1) in the relative coordinate system A relative coordinate system of the X-axis and the Y-axis is established with the line connecting the first short baseline transducer (62) and the second short baseline transducer (72) as the X-axis, the first short baseline transducer (62) as the origin, and the axis perpendicular to the X-axis and parallel to the water surface as the Y-axis. In the relative coordinate system, the coordinate A1 of the first short baseline transducer (62) is (0, 0), the coordinate A2 of the second short baseline transducer (72) is (a, 0), and the coordinates α (x1, y1) of the first synchronous sound source (1) are respectively connected to the first short baseline transducer (62) and the second short baseline transducer (72). The distances between the line transducers (72) are ct1 and ct2, wherein c is the propagation speed of sound waves in water, t1 and t2 are the time differences for the sound waves emitted by the first synchronous sound source (1) to reach the first short baseline array element (62) and the second short baseline array element (72), respectively. The coordinates α(x1, y1) of the first synchronous sound source (1) are calculated in real time using the following formula (1), and at the same time, the first synchronous sound source (1) sends the depth z1 of the first synchronous sound source (1) to the first short baseline transducer (62) and the second short baseline transducer (72) in a beacon coding manner; The distances of the coordinate β(x2, y2) of the second synchronous sound source (2) to the first short baseline transducer (62) and the second short baseline transducer (72) are ct3 and ct4, respectively, where c is the propagation speed of sound waves in water, t3 and t4 are the time differences for the sound waves emitted by the second synchronous sound source (3) to reach the first short baseline transducer (62) and the second short baseline transducer (72), respectively. The coordinate β(x2, y2) of the second synchronous sound source (2) is calculated in real time using the following formula (2), and at the same time, the second synchronous sound source (2) sends the depth z2 of the second synchronous sound source (2) to the first short baseline transducer (62) and the second short baseline transducer (72) in a beacon coding manner; (b) Draw the motion trajectory of the underwater cleaning robot (3) The first synchronous sound source (1) α(x1,y 1, z1) as the origin, the axis passing through the origin and parallel to the X axis of the relative coordinate system as the X' axis, the axis passing through the origin and parallel to the Y axis of the relative coordinate system as the Y' axis, and the axis perpendicular to the X' and Y' planes as the Z' axis, to establish the X', Y' and Z' absolute coordinate systems, and calculate the coordinates β (x2-x1, y2-y2) of the underwater cleaning robot (3) in the absolute coordinate system in real time. 1, z2-z1), draw the motion trajectory of the underwater cleaning robot (3) in the above absolute coordinate system.

2. The high-precision relative positioning method for an underwater cleaning robot according to claim 1, characterized in that: The first short base array element (6) and the second short base array element (7) are fixed on the side wall of the cleaning ship (4) between the working mother ship (5) and the cleaning ship (4).

3. The high-precision relative positioning method for an underwater cleaning robot according to claim 2, characterized in that: The first synchronous sound source (1) is fixed on the bow or stern hull of the working mother ship (5) through its magnetic base.