Rapid positioning method for underwater robot

By distributing the position rope and light source in the underwater environment and combining the capture equipment of the underwater robot for coordinate calculation, the fast and high-precision self-positioning of the underwater robot is achieved, and the high cost, complexity and operation difficulty of the existing technology is solved. The problem has improved the reliability and efficiency of the operation.

CN119043280APending Publication Date: 2024-11-29CHINA THREE GORGES CORPORATION +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411167257.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-23
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

The existing underwater robot positioning technology has high cost, complexity, versatility limitations and operational difficulty, especially in complex underwater environments, which increases operational risks and economic burdens.

Method used

By setting the position rope in a fixed spacing cloth in the water and laying light sources at equal intervals on the rope, the underwater robot capture equipment records the pitch angle and water depth data, and calculate the relative spatial coordinates in the established coordinate system to achieve rapid self-positioning of the underwater robot .

Benefits of technology

Reduces positioning errors and risk of loss, improves the reliability and efficiency of underwater operations, reduces dependence on expensive equipment, reduces initial investment and maintenance costs, improves operational convenience and safety, and is suitable for a variety of underwater Work scenario.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119043280A_ABST
    Figure CN119043280A_ABST
Patent Text Reader

Abstract

An underwater robot rapid positioning method comprises the following steps that S1, at least two positioning ropes are arranged in water at a fixed interval, and light sources are arranged on the positioning ropes at equal intervals; s2, adjusting the pose of the underwater robot, enabling capturing equipment on the underwater robot to be aligned with the light sources on the two positioning ropes in sequence, recording the pitch angle of the underwater robot when light spots of the light sources are located in the dead center of a picture of the capturing equipment, reading water depth data of the underwater robot at the same time, and calculating relative space coordinates by establishing a coordinate system, during the positioning mode, the underwater robot keeps the water depth unchanged. According to the method, the positioning precision and stability of the underwater robot are improved, the cost is reduced, the cost performance is improved, the operation efficiency is improved, repeatability is achieved, and the underwater robot can quickly return to the target position according to historical coordinates even if the underwater robot gets lost.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of underwater robot positioning, and in particular to a method for rapid positioning of an underwater robot. Background Art

[0002] In the water conservancy and hydropower industry, the application of underwater robots is particularly extensive and important. During the construction and operation of large reservoirs and hydropower stations, regular inspection and maintenance of key structures such as underwater dams, water diversion tunnels, and gates are necessary measures to ensure project safety and extend their service life. Traditional manual diving inspections are not only inefficient, but also extremely risky, especially in deep water, complex water flow or low visibility environments. Therefore, underwater robots with high-precision navigation and rapid positioning capabilities have become the preferred tools. They can complete precise inspections and maintenance operations without endangering the safety of personnel.

[0003] When we deeply explore the technical requirements for underwater rapid positioning of underwater robots, we have to face up to several core issues. These challenges are not only related to technical limitations, but also directly affect the economy and ease of operation of practical applications, especially in the specific field of water conservancy and hydropower industry.

[0004] 1) High cost and complexity: At present, achieving high-precision underwater positioning often relies on high-end positioning equipment, such as sonar systems, underwater LiDAR or inertial navigation systems (INS), etc. These devices are not only expensive, but also usually need to be integrated with large or professional underwater robots. This means that the high initial investment and subsequent maintenance costs have become a major obstacle to the popularization of the industry. In addition, the operation and maintenance of these complex systems require professional technicians, which invisibly increases the learning cost and human resource investment, which is a difficult threshold to cross for many small and medium-sized hydropower enterprises or projects.

[0005] 2) Limitations of versatility and adaptability: Although underwater robots on the market can meet most needs in basic applications such as appearance inspection and defect detection, their positioning capabilities are limited when faced with certain complex environments. Especially when hydrological conditions are changeable, the water is turbid, or there is a lack of obvious reference points underwater, even robots equipped with standard navigation systems may drift due to signal interference and difficulty in visual recognition. This uncertainty not only reduces operational efficiency, but may also endanger the safety of the robot itself and increase the risk of mission failure.

[0006] 3) Operation difficulty and safety considerations: For operators, when the underwater environment is complex and changeable, and there is a lack of effective real-time positioning feedback, it is difficult to ensure that the robot is always on the preset path or target area, which can easily lead to "lost" phenomenon. In this case, the process of retrieving the robot is time-consuming and laborious, which not only affects the progress of the task, but also may increase the risk of accidents due to blind search, posing a threat to personnel safety.

[0007] In summary, developing a method that is cost-effective, easy to operate, and can stably provide relatively accurate positioning information in complex underwater environments has become an urgent problem that needs to be solved in the water conservancy and hydropower industry and other related fields.

[0008] Under the background of the rapid development of underwater robot technology, underwater rapid positioning, as one of the core technologies, has attracted extensive attention from many scientific research institutions and enterprises. In order to overcome the unique challenges brought by the underwater environment, such as signal transmission obstacles, visibility limitations, and complex water flow conditions, a variety of positioning technologies have emerged, each of which attempts to solve the positioning problem of underwater robots with different principles and methods. The following are some of the more mature and widely used technical means in the field of underwater robot positioning, including but not limited to vision-based autonomous positioning, satellite and hydroacoustic joint positioning system, RSM positioning method, relay buoy positioning method, low-frequency ultra-short baseline positioning, etc. Although these technologies have promoted the practical application of underwater robots to a certain extent, they still face limitations in terms of cost, accuracy, and scope of application, which encourages researchers to continuously explore more efficient, economical, and universal new positioning strategies. The following is a brief analysis of these existing technologies.

[0009] (1) Autonomous positioning method based on vision: This method uses underwater capture equipment to capture the surrounding environment features, and compares them with pre-built underwater maps through image matching technology to achieve autonomous positioning. For example, the application of SLAM (Simultaneous Localization and Mapping) technology in underwater robots can create a map in an unknown environment. Figure 1 However, this method is limited by underwater visibility and feature repeatability, and the positioning accuracy will be greatly reduced in complex or turbid waters.

[0010] (2) Based on a combination of satellite and hydroacoustic positioning systems: Considering the unavailability of GPS underwater, researchers have developed positioning solutions that combine surface GPS with underwater acoustic beacons, such as the LBL (Long BaseLine) and LBL-Acoustic Modem systems. These systems deploy GPS-located acoustic beacons on the water surface, and the underwater robot determines its own position by receiving and analyzing the time difference of arrival of sound waves. Although the positioning accuracy is high, the equipment cost is high and is greatly affected by underwater sound propagation conditions.

[0011] (3) Underwater robot positioning method based on RSM (Radio Signal Measurement): The RSM method uses the propagation characteristics of underwater radio waves for positioning. Although the propagation distance of radio waves in water is limited, combined with the deployment of multiple base stations, relative positioning within a certain range can be achieved. This method is suitable for offshore or shallow water areas, but its positioning capabilities are limited in deep water or long distances.

[0012] (4) Positioning method based on relay buoy: By deploying a relay buoy with GPS on the water surface and linking it with the underwater robot through acoustic or wireless communication, the robot's position can be indirectly determined. This method is highly flexible and suitable for a variety of underwater operation scenarios, but the deployment and maintenance costs of the buoy and potential communication interference are its main disadvantages.

[0013] (5) Positioning method based on low-frequency ultra-short baseline (USBL): USBL technology uses the characteristics of low-frequency sound waves propagating in water to determine the three-dimensional position of the underwater robot by calculating the time difference between the sound waves emitted from both ends of the baseline to the underwater robot and then returning. This technology performs well in deep-water operations and has high positioning accuracy, but it has high requirements for the linearity of the sound wave propagation path, and its performance may deteriorate in complex seabed terrain.

[0014] (6) Inertial navigation system and multi-sensor fusion positioning: Combining inertial sensors such as INS, gyroscopes, and accelerometers with one or more of the above external positioning technologies, the overall positioning accuracy and robustness are improved through data fusion algorithms. Especially in environments without natural or artificial landmarks, this method can provide continuous self-positioning information, although there will be accumulated errors in long-term operation.

[0015] (7) Magnetic dead reckoning positioning: Using changes in the Earth's magnetic field for navigation is not as accurate as other methods, but it provides an alternative in extreme environments where there are no visual or acoustic clues. It is suitable for underwater environments where specific geological structures are more obvious.

[0016] (8) Underwater LiDAR positioning: Although the technology is still under development, underwater LiDAR can perform three-dimensional scanning and positioning with high definition by emitting laser pulses and analyzing echo information. It is particularly suitable for precise positioning of complex structures, but the cost and energy consumption are relatively high.

[0017] In summary, the existing underwater robot positioning technologies have their own advantages and disadvantages. In practical applications, it is often necessary to select a suitable positioning solution based on the specific operating environment and task requirements. However, most of these technologies have problems such as high cost, limited environmental adaptability or complex operation. In order to meet a wider range of application needs, exploring more efficient, accurate and economical positioning methods is still an important research topic. Summary of the invention

[0018] In order to solve the current technical problems, the main purpose of the present invention is to provide a method for rapid positioning of an underwater robot with high cost-effectiveness, accurate positioning and easy operation.

[0019] The technical solution adopted by the present invention is: a method for rapid positioning of an underwater robot, comprising the following steps: S1. At least two positioning ropes are arranged at fixed intervals in the water, and light sources are arranged at equal intervals on the positioning ropes; S2. The underwater robot adjusts its posture so that the capture device on the underwater robot is aligned with the light sources on the two positioning ropes in turn, and records the pitch angle of the underwater robot when the light spot of the light source is located in the center of the capture device screen. At the same time, the underwater robot reads its own water depth data, and calculates the relative space coordinates by establishing a coordinate system. During the positioning mode, the underwater robot maintains a constant water depth.

[0020] Two positioning ropes are laid in parallel and extend vertically downward into the water, defined as rope No. 0 and rope No. 1, and the spacing between the positioning ropes is W.

[0021] The number of light sources is determined according to the water depth, visibility and hydrological conditions. They can be numbered 0, 1, 2, 3…n from top to bottom, where light source number 0 is located on the water surface with a water depth of 0 meters, and the remaining numbered light sources are arranged at equal intervals with a spacing of H.

[0022] With the No. 0 light source of the No. 0 rope as the origin, a rectangular coordinate system is established, with the line connecting the No. 0 light source of the No. 0 rope and the No. 0 light source of the No. 1 rope as the X-axis, and the positive direction is from the No. 0 rope to the No. 1 rope; the No. 0 rope is the Y-axis, and the positive direction is vertically downward; the Z-axis is perpendicular to the above two axes, and the side where the underwater robot is launched into the water is the positive direction.

[0023] O(i,j) represents the jth light source on the ith rope, where i is 0 or 1, and j is 0, 1, 2…n. In this coordinate system, the coordinates corresponding to O(i,j) are (i×W, j×H, 0).

[0024] When the underwater robot needs to be positioned after entering the water, the onboard capture device is turned to the O(0,j) light source so that the light source is within the picture. The positioning mode is turned on and the robot adjusts its own position so that the light source is located in the center of the picture. The machine pitch angle α at this time is recorded, and then the robot is adjusted to aim at the O(1,j) light source. The above operation is repeated and the pitch angle β is recorded. The underwater robot maintains the water depth h.

[0025] The coordinates of the underwater robot are determined in the established coordinate system through the pitch angles α, β and water depth h data.

[0026] The method to determine the coordinates of the underwater robot in the coordinate system is as follows: Mark the underwater robot as A, and the foot of the perpendicular of A on the plane XY is E. Draw a straight line parallel to the X-axis through E, intersecting the two positioning ropes at B and C respectively; draw a perpendicular line O(0,j)O(1,j) through A, intersecting O(0,j)O(1,j) at D, and connecting ED, where ∠O(0,j)AB = α, ∠O(1,j)AC = β, and the vertical distance from point A to the XZ plane is h; O(0,j)B = O(1,j) C = ED = h –j×H. In the right triangle O(0,j)BA, we can use the trigonometric relationship to get ; Similarly, we can get: ; Given BC = W, in triangle ABC, use Heron's formula to calculate the area S: ; (1) in, ; And the area of ​​triangle ABC is ; (2) Combine formulas (1) and (2) and substitute the known conditions to solve AE, which is the Z-axis coordinate value of A. In the right triangle AEB, use the Pythagorean theorem to calculate BE, which is the X-axis coordinate value of A;

[0027] The Y-axis coordinate value of A is h.

[0028] The underwater robot automatically enters the positioning mode according to the set interval time Δt and records the coordinate data in the coordinate system; the coordinate values ​​of each point are plotted and displayed in the coordinate system to generate the travel path of the underwater robot; when the underwater robot loses its direction, the coordinates before the direction is lost are called and compared with the current coordinates to obtain the direction and distance of the target point relative to the current point, and return to the target point accordingly.

[0029] A plurality of positioning ropes are provided, and the light source on each positioning rope has different light source information, forming one or more coordinate grids that reference each other.

[0030] The present invention has the following beneficial effects: 1. Improved positioning accuracy and stability: By setting up fixed positioning ropes and equally spaced light sources, combined with the underwater robot's capture equipment and simple geometric calculations, rapid and high-precision self-positioning in underwater environments is achieved. This method reduces positioning errors and disorientation caused by environmental factors, and significantly improves the reliability and efficiency of underwater operations.

[0031] 2. Cost reduction and cost-effectiveness: The present invention provides an economical positioning solution that does not rely on expensive professional positioning equipment, such as high-end sonar systems, underwater LiDAR or complex inertial navigation systems. This not only reduces the initial investment cost, but also reduces the subsequent maintenance expenses, making the application of underwater robots affordable for more users in water conservancy, hydropower and other industries, accelerating the popularization of technology and the development of the industry.

[0032] 3. Enhanced operational convenience and safety: The control system and interface designed by the invention are intuitive and easy to use, allowing operators to easily grasp the precise position of the underwater robot, reducing the complexity of operation and improving the safety of the entire operation process. Through the automated positioning mode and instant coordinate display, manual search after the robot gets lost is avoided, reducing potential personal safety risks.

[0033] 4. Improve work efficiency and repeatability: By automatically recording coordinate data and generating a travel path, the underwater robot can repeat inspections along the original path. Even if it loses its way, it can quickly return to the target location based on historical coordinates, greatly improving the continuity and efficiency of operations and reducing unnecessary repetitive processes.

[0034] 5. Flexible expansion and application potential: The technical framework of the present invention is simple and flexible, and can be easily adjusted and optimized according to different underwater operation requirements, such as increasing the number of positioning ropes or combining fixed-point underwater sonar, further broadening its scope of application in different application scenarios. BRIEF DESCRIPTION OF THE DRAWINGS

[0035] In order to more clearly illustrate the specific implementation methods of the present invention or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0036] Figure 1Schematic diagram of the coordinate system of the present invention.

[0037] Figure 2 This is a schematic diagram of the calculation of the positioning method of the present invention.

[0038] In the figure: Light source 1, underwater robot 2. DETAILED DESCRIPTION

[0039] The technical solution of the present invention will be described clearly and completely below in conjunction with the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0040] Embodiment 1: like Figure 1 , 2 As shown, the present invention provides a method for rapid positioning of an underwater robot, comprising the following steps: S1. At least two positioning ropes are arranged at fixed intervals in the water, and light sources 1 are arranged at equal intervals on the positioning ropes; S2. The underwater robot 2 adjusts its posture so that the capture device on the underwater robot 2 is aligned with the light sources 1 on the two positioning ropes in turn, and records the pitch angle of the underwater robot 2 when the light spot of the light source 1 is located in the center of the capture device screen. At the same time, the underwater robot 2 reads its own water depth data and calculates the relative spatial coordinates by establishing a coordinate system. During the positioning mode, the underwater robot 2 maintains a constant water depth.

[0041] The capture device can be a camera or a sonar transmitting and receiving unit.

[0042] This method effectively improves the main pain points of the existing technology, such as high cost, lack of adaptability and complex operation, and has shown significant beneficial effects, especially in water conservancy and hydropower and other fields that require underwater operations. This method improves the positioning accuracy and stability of underwater robots, reduces costs and improves cost-effectiveness, improves operating efficiency and is repeatable. Even if the robot loses its way, it can quickly return to the target position based on historical coordinates. Its main features are as follows: 1. Positioning ropes and light sources: Two positioning ropes are laid out at fixed intervals in the water, and light sources are installed at equal intervals on the ropes to form a series of fixed reference points. These light sources serve as visual markers and provide clear positioning references for the underwater robot.

[0043] 2. Coordinate system construction: With a specific light source as the origin, a rectangular coordinate system is established, and each light source is numbered and its coordinates are defined to facilitate accurate positioning of the underwater robot in the coordinate system.

[0044] 3. Capture device and pitch angle measurement: The underwater robot uses the capture device on board to capture the image of the light source, adjusts its own posture so that the light source is located in the center of the picture, records the pitch angle at this time, and combines it with the water depth information to calculate the precise position of the robot through simple trigonometric geometric relationships.

[0045] 4. Automatic positioning and path tracking: The robot can automatically enter the positioning mode, record coordinate data at predetermined time intervals, and draw the path of travel. When lost, it can quickly trace back through historical coordinate data, calculate the direction and distance between the current position and the target position, and autonomously navigate back to the original path.

[0046] 5. Economy and ease of operation: The entire solution is designed with emphasis on cost-effectiveness, reducing reliance on expensive positioning equipment, simplifying operating procedures, and improving the economy and safety of underwater operations.

[0047] The present embodiment is described in detail below: See also Figure 1 , two positioning ropes are arranged in parallel and extend vertically downward into the water, defined as rope No. 0 and rope No. 1, and the spacing between the positioning ropes is W. In this embodiment, W is set to 10 meters.

[0048] A certain number of light sources 1 are arranged on the positioning rope, and the number of light sources 1 is determined according to the water depth, visibility, hydrological conditions, etc., and can be numbered 0, 1, 2, 3...n from top to bottom. The light source numbered 0 is located on the water surface, with a water depth of 0 meters, and the light sources 1 with other numbers are arranged at equal intervals, with a spacing of H. In this embodiment, the number of light sources set for each positioning rope is 3, and the spacing H=10 meters.

[0049] See also Figure 1 , take the No. 0 light source of the No. 0 rope as the origin, establish a rectangular coordinate system, take the No. 0 light source of the No. 0 rope and the No. 0 light source of the No. 1 rope as the X-axis, and the direction from the No. 0 rope to the No. 1 rope is the positive direction; take the No. 0 rope as the Y-axis, and the direction is vertically downward as the positive direction; the Z-axis is perpendicular to the above two axes, and the side where the underwater robot 2 enters the water is the positive direction.

[0050] O(i,j) represents the jth light source of the ith rope, where i is 0 or 1, and j is 0, 1, 2, ... n. In this coordinate system, the coordinates corresponding to O(i,j) are (i×W, j×H, 0). In this embodiment, the light sources used for positioning are numbered O(0,1) and O(1,1), and their coordinates are (0,10,0) and (10,10,0) respectively.

[0051] The underwater robot 2 can enter the water from any position, but in order to ensure the accuracy and stability of the data, it is preferably entered into the water near the positioning rope, or directly from position O(0,0). In this embodiment, the robot enters the water from position O(0,0).

[0052] When the underwater robot 2 needs to be positioned after entering the water, the onboard capture device is turned toward the O(0,j) light source so that the light source is within the picture, the positioning mode is turned on, the robot adjusts its own position so that the light source is located in the center of the picture, and the machine pitch angle α at this time is recorded, and then the robot is adjusted to align with the O(1,j) light source, and the above operation is repeated to record the pitch angle β, and the underwater robot maintains the water depth h. In this embodiment, the pitch angle α = 45°, the pitch angle β = 45°, and the underwater robot maintains the water depth h = 15 meters.

[0053] The pitch angles α, β and water depth h data are automatically calculated in the control system of the underwater robot 2 to determine the coordinates of the underwater robot 2 in the established coordinate system.

[0054] For details, see Figure 2 , the method for determining the coordinates of the underwater robot 2 in the coordinate system is as follows: Mark underwater robot 2 as A, and the foot of A on plane XY is E. Draw a straight line parallel to the X-axis through E, intersecting the two positioning ropes at B and C respectively; draw a perpendicular line O(0,j)O(1,j) through A, intersecting O(0,j)O(1,j) at D, and connecting ED, where ∠O(0,j)AB = α, ∠O(1,j)AC = β, and the vertical distance from point A to the XZ plane is h; O(0,j)B = O(1,j) C = ED = h –j×H. In the right triangle O(0,j)BA, we can use the trigonometric relationship to get ; Similarly, we can get: ; Given BC = W, in triangle ABC, use Heron's formula to calculate the area S: ; (1) in, ; And the area of ​​triangle ABC is ; (2) Combine formulas (1) and (2) and substitute the known conditions to solve AE, which is the Z-axis coordinate value of A. In the right triangle AEB, use the Pythagorean theorem to calculate BE, which is the X-axis coordinate value of A; ; The Y-axis coordinate value of A is h.

[0055] In summary, the coordinates of the underwater robot can be accurately determined in the above-established coordinate system through the two pitch angles α, β and the water depth h. The coordinates are automatically calculated as (BE, h, AE) in the robot's control system according to the above formula.

[0056] In this embodiment, α = 45°, β = 45°, h = 15, W = 10, and the coordinate values ​​of the underwater robot are calculated as (5, 15, 0).

[0057] Embodiment 2: Based on the first embodiment, the underwater robot 2 automatically enters the positioning mode according to the set interval time Δt and records the coordinate data in the coordinate system; the coordinate values ​​of each point are plotted and displayed in the coordinate system to generate the travel path of the underwater robot. In this embodiment, the recording time interval is set to 10 minutes.

[0058] If necessary, the underwater robot can repeat the inspection of the area to be inspected along the original path.

[0059] When the underwater robot loses its direction, the coordinates before the direction is lost can be called in time, and the current coordinates can be obtained by the method of Example 1. The coordinates before the direction is lost are compared and calculated with the current coordinates to obtain the direction and distance of the target point relative to the current point, and then return to the target point accordingly, and then continue the subsequent inspection work.

[0060] Embodiment three: A plurality of positioning ropes are provided, and the light source 1 on each positioning rope has different light source information, forming one or more coordinate grids that reference each other.

[0061] Specifically, the embodiment uses multiple positioning ropes, which are evenly arranged in the underwater operation area, and light sources with unique identification are installed at equal intervals on each positioning rope. In addition to the orderly arrangement of positions, these light sources also have different color codes, flashing frequencies and specific flashing patterns to facilitate the underwater robot to identify and distinguish. The precise coordinate information, color, flashing characteristics and patterns of all light sources are pre-stored in the control system database of the underwater robot.

[0062] Implementation steps: 1. Laying out positioning ropes and light sources: Three or more positioning ropes are flexibly laid out according to the size and complexity of the work area to form one or more coordinate grids that reference each other. Multiple light sources are installed on each rope, and these light sources are differentiated in color, flashing frequency and mode, so that the robot can accurately identify even at a long distance or in a complex environment.

[0063] 2. Light source information encoding and storage: The coordinates, color coding, flashing frequency and pattern of each light source are recorded in detail and synchronized with the control system’s database as reference data for robot positioning.

[0064] 3. Underwater positioning process: After entering the water, the robot uses a camera to capture visible light sources, and quickly matches the corresponding coordinate information from the database by identifying the color, flashing frequency and pattern of the light source. Combined with the robot's own pitch angle and water depth readings, its precise position in the multi-dimensional coordinate system can be determined through simple trigonometric calculations.

[0065] 4. Large-scale positioning and repeated inspection: The multi-rope layout can cover a wider operating area. The robot can switch between multiple reference points as needed to achieve continuous positioning and navigation in a large area. Once the initial inspection is completed, the robot can repeat the inspection along the original path based on the historical path coordinates, improving work efficiency and inspection consistency.

[0066] The solution of using multiple positioning ropes expands the positioning range and improves the positioning accuracy in complex environments; the multiple properties of the light source are used to improve the robustness and recognition efficiency of positioning; and it is easy to achieve accurate tracking and inspection of repeated paths.

[0067] Embodiment 4: This embodiment uses underwater sonar equipment to replace traditional optical positioning light sources, and achieves remote and accurate positioning through the characteristics of sound wave reflection. The sonar system consists of a small number of sonar transmitting and receiving devices on positioning ropes, and directly calculates the position information of the robot relative to the sonar source by using the time difference and intensity difference of the sound waves.

[0068] Implementation steps: 1. Sonar equipment deployment: Sonar transmitting and receiving units are installed at the edge of the working area or at key nodes. These units are fixed by a few positioning ropes, avoiding the deployment of a large number of ropes and light sources, and reducing the complexity of deployment and maintenance.

[0069] 2. Sonar signal processing: The underwater robot has a built-in sonar receiver that receives signals from different sonar sources and directly calculates the relative distance and angle information to each sonar source by analyzing the time difference and intensity of the signal arrival.

[0070] 3. Real-time positioning calculation: The control unit calculates the robot's three-dimensional coordinates in real time based on sonar information, without the need for complex visual recognition processes, which improves the speed and automation of positioning.

[0071] 4. Flexible positioning over a wide range: The sonar system has a long detection distance and strong penetration ability. It can achieve accurate positioning over a wide range even in poor visibility or complex hydrological conditions. It is suitable for underwater operating environments of all sizes.

[0072] The use of sonar positioning reduces the dense deployment of hardware facilities, reduces costs and complexity; provides a longer detection range and stronger environmental adaptability; realizes fast and direct coordinate calculation, and simplifies the positioning process.

[0073] The present invention proposes a method for rapid underwater positioning of an underwater robot, aiming to solve the pain points of the prior art, such as high cost, poor adaptability, and complex operation, especially in water conservancy and hydropower and other fields requiring underwater operations. The beneficial effects of the invention mainly include: The present invention proposes a method for rapid underwater positioning of an underwater robot, which effectively improves the main pain points of the prior art, such as high cost, poor adaptability, and complex operation, and shows significant beneficial effects, especially in water conservancy and hydropower and other fields requiring underwater operations. Specifically, these beneficial effects include: 1. Improved positioning accuracy and stability: By setting up fixed positioning ropes and equally spaced light sources, combined with the underwater robot's capture equipment and simple geometric calculations, rapid and high-precision self-positioning in underwater environments is achieved. This method reduces positioning errors and disorientation caused by environmental factors, and significantly improves the reliability and efficiency of underwater operations.

[0074] 2. Cost reduction and cost-effectiveness: The present invention provides an economical positioning solution that does not rely on expensive professional positioning equipment, such as high-end sonar systems, underwater LiDAR or complex inertial navigation systems. This not only reduces the initial investment cost, but also reduces the subsequent maintenance expenses, making the application of underwater robots affordable for more users in water conservancy, hydropower and other industries, accelerating the popularization of technology and the development of the industry.

[0075] 3. Enhanced operational convenience and safety: The control system and interface designed by the invention are intuitive and easy to use, allowing operators to easily grasp the precise position of the underwater robot, reducing the complexity of operation and improving the safety of the entire operation process. Through the automated positioning mode and instant coordinate display, manual search after the robot gets lost is avoided, reducing potential personal safety risks.

[0076] 4. Improve work efficiency and repeatability: By automatically recording coordinate data and generating a travel path, the underwater robot can repeat inspections along the original path. Even if it loses its way, it can quickly return to the target location based on historical coordinates, greatly improving the continuity and efficiency of operations and reducing unnecessary repetitive processes.

[0077] 5. Flexible expansion and application potential: The technical framework of the present invention is simple and flexible, and can be easily adjusted and optimized according to different underwater operation requirements, such as increasing the number of positioning ropes or combining fixed-point underwater sonar, further broadening its scope of application in different application scenarios.

[0078] In summary, the present invention not only solves the core technical problem of underwater robot positioning, but also promotes the advancement of underwater operation technology and the development of related industries, and has significant economic and social benefits.

[0079] Finally, it should be noted that the above-described embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit the present invention. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some or all of the technical features thereof may be replaced by equivalents. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the scope of the technical solutions of the embodiments of the present invention.

Claims

1. A method for rapid positioning of an underwater robot, characterized in that: The following steps are involved: S1. At least two positioning ropes are arranged at fixed intervals in the water, and light sources are arranged at equal intervals on the positioning ropes; S2. The underwater robot adjusts its posture so that the capture device on the underwater robot is aligned with the light sources on the two positioning ropes in turn, and records the pitch angle of the underwater robot when the light spot of the light source is located in the center of the capture device screen. At the same time, the underwater robot reads its own water depth data, and calculates the relative space coordinates by establishing a coordinate system. During the positioning mode, the underwater robot maintains a constant water depth.

2. A method for rapid positioning of an underwater robot according to claim 1, characterized in that: Two positioning ropes are laid in parallel and extend vertically downward into the water, defined as rope No. 0 and rope No. 1, and the spacing between the positioning ropes is W.

3. The method for rapid positioning of an underwater robot according to claim 2, characterized in that: The number of light sources is determined according to the water depth, visibility and hydrological conditions. They can be numbered 0, 1, 2, 3…n from top to bottom, where light source number 0 is located on the water surface with a water depth of 0 meters, and the remaining numbered light sources are arranged at equal intervals with a spacing of H.

4. The method for rapid positioning of an underwater robot according to claim 3, characterized in that: With the No. 0 light source of the No. 0 rope as the origin, a rectangular coordinate system is established, with the line connecting the No. 0 light source of the No. 0 rope and the No. 0 light source of the No. 1 rope as the X-axis, and the positive direction is from the No. 0 rope to the No. 1 rope; the No. 0 rope is the Y-axis, and the positive direction is vertically downward; the Z-axis is perpendicular to the above two axes, and the side where the underwater robot is launched into the water is the positive direction.

5. The method for rapid positioning of an underwater robot according to claim 4, characterized in that: O(i,j) represents the jth light source on the ith rope, where i is 0 or 1, and j is 0, 1, 2…n. In this coordinate system, the coordinates corresponding to O(i,j) are (i×W, j×H, 0).

6. A method for rapid positioning of an underwater robot according to claim 5, characterized in that: When the underwater robot needs to be positioned after entering the water, the onboard capture device is turned to the O(0,j) light source so that the light source is within the picture. The positioning mode is turned on and the robot adjusts its own position so that the light source is located in the center of the picture. The machine pitch angle α at this time is recorded, and then the robot is adjusted to aim at the O(1,j) light source. The above operation is repeated and the pitch angle β is recorded. The underwater robot maintains the water depth h.

7. A method for rapid positioning of an underwater robot according to claim 6, characterized in that: The coordinates of the underwater robot are determined in the established coordinate system through the pitch angles α, β and water depth h data.

8. The method for rapid positioning of an underwater robot according to claim 7, characterized in that: The method to determine the coordinates of the underwater robot in the coordinate system is as follows: Mark the underwater robot as A, and the foot of the perpendicular of A on the plane XY is E. Draw a straight line parallel to the X-axis through E, intersecting the two positioning ropes at B and C respectively; draw a perpendicular line O(0,j)O(1,j) through A, intersecting O(0,j)O(1,j) at D, and connecting ED, where ∠O(0,j)AB = α, ∠O(1,j)AC = β, and the vertical distance from point A to the XZ plane is h; O(0,j)B = O(1,j) C = ED = h –j×H. In the right triangle O(0,j)BA, we can use the trigonometric relationship to get ; Similarly, we can get: ; Given BC = W, in triangle ABC, use Heron's formula to calculate the area S: ;(1) in, ; And the area of ​​triangle ABC is ; (2) Combine formulas (1) and (2) and substitute the known conditions to solve AE, which is the Z-axis coordinate value of A. In the right triangle AEB, use the Pythagorean theorem to calculate BE, which is the X-axis coordinate value of A; ; The Y-axis coordinate value of A is h.

9. The method for rapid positioning of an underwater robot according to claim 1, characterized in that: The underwater robot automatically enters the positioning mode according to the set interval time Δt and records the coordinate data in the coordinate system; the coordinate values ​​of each point are plotted and displayed in the coordinate system to generate the travel path of the underwater robot; when the underwater robot loses its direction, the coordinates before the direction is lost are called and compared with the current coordinates to obtain the direction and distance of the target point relative to the current point, and return to the target point accordingly.

10. The method for rapid positioning of an underwater robot according to claim 1, characterized in that: A plurality of positioning ropes are provided, and the light source on each positioning rope has different light source information, forming one or more coordinate grids that reference each other.