Self-positioning system and self-positioning identification method of deepwater underwater robot of irregular dam surface of reservoir

Abstract

The present invention provides a self-positioning system of a deepwater underwater robot of an irregular dam surface of a reservoir, including cross reflection metal plates arranged on the irregular dam surface, and an underwater robot provided with a control motherboard, a water level indicator and a sonar system, wherein the water level indicator and the sonar system are respectively connected with the control motherboard, and the control motherboard is connected with a computer via a cable. The cross reflection metal plate has known coordinates and has four quadrants. A sonar signal emitted by the sonar system is reflected by the cross reflection metal plate to generate sonar reflection signals of four quadrants, and the sonar signals in the effective quadrants correspond to known coordinate parameters of the cross reflection metal plate so as to obtain the horizontal distance between the underwater robot and the irregular dam surface. The water level indicator is used for calculating the vertical position of the underwater robot. The computer calculates accurate positioning of the underwater robot according to the horizontal position and the vertical position. The present invention has the beneficial effects of being able to accurately obtain the positioning coordinates of the underwater robot in the deepwater of the irregular dam surface of the reservoir.

Claims

1. A self-positioning system of a deepwater underwater robot of an irregular dam surface of a reservoir, comprising: cross reflection metal plates arranged on an upstream surface of the irregular dam surface, an underwater robot provided with a control motherboard, a water level indicator, and a sonar system; wherein the water level indicator and the sonar system are respectively connected with the control motherboard, and the control motherboard is connected with a computer via a cable; wherein each cross reflection metal plate has known coordinates and has four quadrants; wherein a sonar signal emitted by the sonar system is reflected by the cross reflection metal plate to generate sonar reflection signals of four quadrants, and the sonar signals in the effective quadrants correspond to known coordinate parameters of the cross reflection metal plate so as to obtain the horizontal distance between the underwater robot and the irregular dam surface; wherein the water level indicator is used for calculating the vertical distance between the underwater robot and the water surface; and wherein the computer calculates accurate positioning of the underwater robot according to the horizontal distance, the vertical distance, and the coordinates of the cross reflection metal plate on the irregular dam surface.

2. The self-positioning system of the deepwater underwater robot of the irregular dam surface of the reservoir of claim 1, wherein the cross reflection metal plates are arranged on the surface along the horizontal direction and the vertical direction, the cross reflection metal plates are arranged in a lattice shape, and the horizontal distance and the vertical distance of the adjacent cross reflection metal plates are 5-6 m.

3. The self-positioning system of the deepwater underwater robot of the irregular dam surface of the reservoir of claim 1, wherein the lower part of the water level indicator and the lower part of the underwater robot are located on the same horizontal plane.

4. The self-positioning system of the deepwater underwater robot of the irregular dam surface of the reservoir of claim 1, wherein the cross reflection metal plate has a length of 35-40 cm, a thickness of 0.3-0.5 cm and a width of 15-20 cm, and the surface of the metal plate is smooth and is coated with silver-white reflective metal paint.

5. The self-positioning system of the deepwater underwater robot of the irregular dam surface of the reservoir of claim 1, wherein the irregular dam surface of the reservoir is located in a deep valley area with turbid water and numerous reflection sources.

6. A self-positioning identification method of a deepwater underwater robot of a gravity dam by using the system of claim 1, wherein the system comprises cross reflection metal plates arranged on an upstream surface of the irregular dam surface, and an underwater robot provided with a control motherboard, a water level indicator and a sonar system, wherein the water level indicator and the sonar system are respectively connected with the control motherboard, and the control motherboard is connected with a computer via a cable, the method comprising the following steps: first step, the cross reflection metal plate has known coordinates and has four quadrants, a sonar signal emitted by the sonar system is reflected by the cross reflection metal plate to generate sonar reflection signals of four quadrants, and the sonar signals in the effective quadrants correspond to known coordinate parameters of the cross reflection metal plate so as to obtain the horizontal distance between the underwater robot and the irregular dam surface; second step, the water level indicator is used for calculating the vertical distance between the underwater robot and the water surface; and third step, the computer calculates accurate positioning of the underwater robot according to the horizontal distance, the vertical distance, and the coordinates of the cross reflection metal plate on the irregular dam surface.

7. The self-positioning identification method of the deepwater underwater robot of the irregular dam surface of claim 6, wherein the cross reflection metal plates are arranged on the irregular dam surface along the horizontal direction and the vertical direction, the cross reflection metal plates are arranged in a lattice shape, and the horizontal distance and the vertical distance of the adjacent cross reflection metal plates are 5-6 m.

8. The self-positioning identification method of the deepwater underwater robot of the irregular dam surface of claim 6, wherein the lower part of the water level indicator and the lower part of the underwater robot are located on the same horizontal plane.

9. The self-positioning identification method of the deepwater underwater robot of the irregular dam surface of claim 6, wherein the cross reflection metal plate has a length of 35-40 cm, a thickness of 0.3-0.5 cm and a width of 15-20 cm.

10. The self-positioning identification method of the deepwater underwater robot of the irregular dam surface of claim 6, wherein the irregular dam surface of the reservoir is located in a deep valley area with turbid water and numerous reflection sources.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) FIG. 1 is a structural schematic diagram of the present invention;

(2) FIG. 2 is a schematic diagram of a cross reflection metal plate.

REFERENCE SIGNS

(3) 1. irregular dam surface; 2. cross reflection metal plate; 3. underwater robot; 4. sonar system; 5. water level indicator; 6. control motherboard; 7. cable; 8. Computer.

DETAILED DESCRIPTION OF THE INVENTION

(4) The technical solution of the present invention will be further illustrated below via specific embodiments.

(5) Referring to FIG. 1, a self-positioning system of a deepwater underwater robot of an irregular dam surface of a reservoir includes an irregular dam surface 1, cross reflection metal plates 2, an underwater robot 3, a sonar system 4, a water level indicator 5, a control motherboard 6, a cable 7, and a computer 8.

(6) The irregular dam surface 1 is located in a deep valley area, the water of the reservoir area is relatively turbid, the cross reflection metal plates 2 are arranged on an upstream surface of the irregular dam surface 1, the cross reflection metal plates 2 are arranged along the horizontal direction and the vertical direction respectively, the cross reflection metal plates 2 are arranged in a lattice shape, and the horizontal distance and the vertical distance are 5 m, the coordinates of the cross reflection metal plates 2 are known parameters, the cross reflection metal plate 2 is composed of one horizontal and one longitudinal metal plate vertical to each other, that is, the cross reflection metal plate 2 has four quadrants, as shown in FIG. 2. A sonar signal emitted by the sonar system 4 is reflected by the cross reflection metal plate 2 to generate sonar reflection signals of four quadrants, and the sonar signals in the effective quadrants correspond to known coordinate parameters of the cross reflection metal plate so as to obtain the horizontal position of the underwater robot, and the cross reflection metal plate 2 has a length of 40 cm, a thickness of 0.5 cm and a width of 20 cm.

(7) The sonar system 4, the water level indicator 5 and the control motherboard 6 are installed in the underwater robot 3, the lower part of the water level indicator 4 and the lower part of the underwater robot 3 are located on the same horizontal plane, the water level indicator 4 is connected with the computer 8 via the cable 7, the model number of the water level indicator 4 is BAG-4500s, the meter full scale is 3 MPa, the control motherboard 6 of the underwater robot 3 is composed of a controller, a communication interface, a power circuit and an MCU, the model number of the controller is ATmega8L, the model number of the communication interface is YN1100, the model number of the MCU is SWN-01, the model number of the cable is DBXH40.30+10.20, and the depth monitoring of the underwater robot 3 is achieved via the reading of the water level indicator 4 installed in the underwater robot 3.

(8) The sonar system 4 is connected with the control motherboard 6, and the control motherboard 6 is connected with the computer 8 via the cable 7; and the computer 8 reads the positioning coordinates and the analysis data of the underwater robot 3.

(9) A self-positioning identification method of a deepwater underwater robot of an irregular dam surface of a reservoir is provided. The cross reflection metal plate 2 has known coordinates and has four quadrants. A sonar signal emitted by the sonar system 4 is reflected by the cross reflection metal plate 2 to generate sonar reflection signals of four quadrants, and the sonar signals in the effective quadrants correspond to known coordinate parameters of the cross reflection metal plate 2 so as to obtain the horizontal distance between the underwater robot 3 and the irregular dam surface 1. The water level indicator 5 is used for calculating the vertical distance between the underwater robot 3 and the water surface. The computer calculates accurate positioning of the underwater robot according to the horizontal distance, the vertical distance, and the coordinates of the cross reflection metal plate on the irregular dam surface, to obtain accurate positioning coordinates of the underwater robot 3 in the muddy water of the deep valley area.

(10) For example, the two-point coordinates of the cross reflection metal plate 2 are A (x.sub.1, y.sub.1, z.sub.1), B (x.sub.2, y.sub.2, z.sub.2), and C (x.sub.3, y.sub.3, z.sub.3), the coordinate of the underwater robot 3 is (x.sub.4, y.sub.4, z.sub.4), the distance between the underwater robot 3 and the point A is 1, the distance between the underwater robot 3 and the point B is m, the distance between the underwater robot 3 and the point C is n, and the coordinate of the underwater robot 3 is:

(11) $\{\begin{array}{c}{x}_4=\frac{A\left(y_3-y_1\right)-B\left(y_2-y_1\right)}{2\left[\left(x_2-x_1\right)\left(y_3-y_1\right)-\left(x_3-x_1\right)\left(y_2-y_1\right)\right]}\\ x_4=\frac{A-2\left(x_2-x_1\right)x_5}{2\left(y_2-y_1\right)}\end{array}\{\begin{array}{c}A=l^2-m^2+2z_4\left(z_1-z_2\right)+z_2^2-z_1^2-y_1^2+y_2^2\\ B=l^2-n^2+2z_4\left(z_1-z_3\right)+z_3^2-z_1^2-y_1^2+y_3^2\end{array}$

(12) In the formula, x.sub.1 represents an abscissa of a cross reflection metal plate A and is known;

(13) y.sub.1 represents an ordinate of the cross reflection metal plate A and is known;

(14) z.sub.1 represents an applicate of the cross reflection metal plate A and is known;

(15) x.sub.2 represents an abscissa of the cross reflection metal plate B and is known;

(16) y.sub.2 represents an ordinate of the cross reflection metal plate B and is known;

(17) z.sub.2 represents an applicate of the cross reflection metal plate B and is known;

(18) x.sub.3 represents an abscissa of the cross reflection metal plate C and is known;

(19) y.sub.3 represents an ordinate of the cross reflection metal plate C and is known;

(20) z.sub.3 represents an applicate of the cross reflection metal plate C and is known;

(21) x.sub.4 represents an abscissa of the underwater robot;

(22) y.sub.4 represents an ordinate of the underwater robot;

(23) z.sub.4 represents an applicate of the underwater robot;

(24) z.sub.4 represents the reading of the water level indicator;

(25) l represents the distance between the underwater robot and the point A;

(26) m represents the distance between the underwater robot and the point B;

(27) n represents the distance between two coordinate positioning plates.

(28) Several embodiments of the present invention have been described. Nevertheless, it will be understood that various modifications may be made without departing from the spirit and scope of the invention. Accordingly, other embodiments are within the scope of the following claims.