Autonomous underwater vehicle positioning method and underwater lighthouse positioning system

Through the underwater lighthouse positioning system, the positioning code information and time difference calculation are used to solve the problem of positioning errors and insufficient acoustic positioning systems of autonomous underwater vehicles, real-time positioning with high precision and wide coverage, and improving the real-time performance of acoustic positioning and reliability.

CN118914975AActive Publication Date: 2024-11-08SUZHOU JIUYU ZHIHAI TECHNOLOGY CO LTD

Patent Information

Application Number
CN202411130765.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-16
Publication Date
2024-11-08
Estimated Expiration
2044-08-16

AI Technical Summary

Technical Problem

The positioning and navigation of autonomous underwater vehicles in the underwater environment have problems such as inertial navigation system positioning errors and poor real-time performance of existing acoustic positioning systems, limited coverage, complex equipment deployment and great environmental impact.

Method used

The underwater lighthouse positioning system is adopted to send positioning code information through multiple positioning lighthouses set at the bottom of the water, the receiving equipment analyzes the lighthouse clock pulse and position information, calculates the target time difference and distance, determines the position of the autonomous underwater vehicle, and improves positioning accuracy and Real-time.

Benefits of technology

It realizes high-precision, wide coverage real-time positioning of autonomous underwater vehicles, eliminates drift errors in the inertial navigation system, and improves the real-time and reliability of acoustic positioning.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118914975A_ABST
    Figure CN118914975A_ABST
Patent Text Reader

Abstract

The invention provides a positioning method of an autonomous underwater vehicle and an underwater lighthouse positioning system, and the method comprises the steps: receiving positioning coding information sent by a positioning lighthouse, and analyzing a lighthouse clock pulse and lighthouse position information included in the positioning coding information; determining a target time difference between each lighthouse clock pulse and a clock signal corresponding to the data receiving equipment; according to the target time difference, determining a target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference; and determining target position information corresponding to the autonomous underwater vehicle according to each target distance and the lighthouse position information of the corresponding positioning lighthouse. According to the invention, high-precision and wide-coverage real-time positioning of the autonomous underwater vehicle can be realized, the drift error of an inertial navigation system can be effectively eliminated, and the real-time performance and reliability of acoustic positioning can be improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present disclosure relates to the field of underwater communication and navigation, and in particular to a positioning method for an autonomous underwater vehicle and an underwater lighthouse positioning system. Background Art

[0002] With the continuous deepening of global marine resource development and marine scientific research, the demand for autonomous underwater vehicles (AUVs) is growing. AUVs are widely used in marine surveying, environmental monitoring, resource exploration and other fields, and can perform long-term, multi-task operations in complex underwater environments. However, the positioning and navigation of AUVs in underwater environments have always been an important bottleneck restricting their operating capabilities and application scope. At present, the positioning technology of AUVs mainly relies on inertial navigation systems (INS) and acoustic positioning technology. The inertial navigation system obtains the motion state of the AUV and calculates its position through internal sensors (such as accelerometers and gyroscopes). However, due to the drift and error accumulation of sensors, the inertial navigation system will produce significant positioning errors during long-term operation, resulting in a decrease in positioning accuracy.

[0003] In order to solve the positioning error problem of the inertial navigation system, the existing technology usually introduces an acoustic positioning system. Technologies based on acoustic positioning include long baseline (LBL), short baseline (SBL) and ultra short baseline (USBL) positioning systems. However, the existing acoustic positioning systems still have shortcomings in practical applications, such as poor real-time performance, limited coverage, complex equipment deployment, and great environmental impact, and are difficult to implement in certain specific areas (such as the deep sea). Summary of the invention

[0004] The embodiments of the present disclosure at least provide a positioning method for an autonomous underwater vehicle and an underwater lighthouse positioning system, which can achieve high-precision, wide-coverage real-time positioning of the AUV, and can not only effectively eliminate the drift error of the inertial navigation system, but also improve the real-time and reliability of acoustic positioning.

[0005] The present disclosure provides a method for positioning an autonomous underwater vehicle, which is applied to a data receiving device disposed on the autonomous underwater vehicle in an underwater lighthouse positioning system, wherein the underwater lighthouse positioning system further comprises a plurality of positioning lighthouses disposed underwater. The method comprises:

[0006] Receive the positioning code information sent by the positioning lighthouse, and parse the lighthouse clock pulse and lighthouse position information included in the positioning code information;

[0007] determining a target time difference between each of the lighthouse clock pulses and a clock signal corresponding to the data receiving device;

[0008] Determining, based on the target time difference, a target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference;

[0009] The target position information corresponding to the autonomous underwater vehicle is determined according to each target distance and the lighthouse position information corresponding to the positioning lighthouse.

[0010] In an optional implementation manner, after parsing the lighthouse clock pulse and lighthouse position information included in the positioning code information, the method further includes:

[0011] Parsing the lighthouse identity information included in the positioning code information;

[0012] The positioning lighthouse that sends the positioning code information is determined based on the identity information.

[0013] In an optional embodiment, the positioning lighthouse releases the data antenna to float to the water surface according to a preset time calibration interval;

[0014] The satellite clock pulse sent by the positioning satellite is received through the data antenna, and the lighthouse clock pulse is calibrated according to the satellite clock pulse.

[0015] In an optional implementation manner, determining a target time difference between each of the lighthouse clock pulses and a clock signal corresponding to the data receiving device specifically includes:

[0016] Determine a first rising edge corresponding to the lighthouse clock pulse and a second rising edge corresponding to the clock signal corresponding to the data receiving device;

[0017] The difference between the time corresponding to the first rising edge and the time corresponding to the second rising edge is determined as the target time difference.

[0018] In an optional implementation, determining the target position information corresponding to the autonomous underwater vehicle according to each target distance and the lighthouse position information corresponding to the positioning lighthouse specifically includes:

[0019] For each of the positioning beacons, determining the target distance between the autonomous underwater vehicle and the positioning beacon;

[0020] For each of the positioning lighthouses, constructing a distance equation group corresponding to the target position information according to the lighthouse position information corresponding to the positioning lighthouse and the target distance;

[0021] The distance equation group is solved by using the least square method to determine the target position information corresponding to the autonomous underwater vehicle.

[0022] In an optional implementation, after calibrating the lighthouse clock pulse according to the satellite clock pulse, the method further includes:

[0023] The antenna recovery device arranged on the positioning lighthouse is controlled to recover the data antenna to the bottom of the water.

[0024] The present disclosure also provides a positioning device for an autonomous underwater vehicle, which is applied to a data receiving device disposed on the autonomous underwater vehicle in an underwater lighthouse positioning system, wherein the underwater lighthouse positioning system further comprises a plurality of positioning lighthouses disposed underwater, and the method comprises:

[0025] A coding information parsing module, used for receiving the positioning coding information sent by the positioning lighthouse, and parsing the lighthouse clock pulse and lighthouse position information included in the positioning coding information;

[0026] A time difference determination module, used to determine a target time difference between each of the lighthouse clock pulses and a clock signal corresponding to the data receiving device;

[0027] A distance determination module, configured to determine, based on the target time difference, a target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference;

[0028] The autonomous underwater vehicle position determination module is used to determine the target position information corresponding to the autonomous underwater vehicle according to each target distance and the lighthouse position information corresponding to the positioning lighthouse.

[0029] The disclosed embodiment also provides an underwater lighthouse positioning system, comprising a plurality of positioning lighthouses disposed underwater and a data receiving device disposed on an autonomous underwater vehicle;

[0030] The positioning lighthouse is used to send positioning coded information including lighthouse clock pulses and lighthouse position information to the data receiving device;

[0031] The data receiving device is used to receive the positioning code information sent by the positioning lighthouse, and to parse the lighthouse clock pulse and the lighthouse position information, to determine the target time difference between each of the lighthouse clock pulses and the clock signal corresponding to the data receiving device, and based on the target time difference, to determine the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference, and based on each of the target distances and the lighthouse position information corresponding to the positioning lighthouse, to determine the target position information corresponding to the autonomous underwater vehicle.

[0032] The present disclosure also provides an electronic device, including: a processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor communicates with the memory via the bus, and when the machine-readable instructions are executed by the processor, the above-mentioned positioning method for an autonomous underwater vehicle, or steps in any possible implementation of the above-mentioned positioning method for an autonomous underwater vehicle is executed.

[0033] The present disclosure also provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, the computer program executes the above-mentioned method for positioning an autonomous underwater vehicle, or the steps in any possible implementation of the above-mentioned method for positioning an autonomous underwater vehicle.

[0034] The present disclosure also provides a computer program product, including a computer program / instruction, which, when executed by a processor, implements the above-mentioned positioning method for an autonomous underwater vehicle, or the steps in any possible implementation of the above-mentioned positioning method for an autonomous underwater vehicle.

[0035] The present disclosure provided by the embodiment of the present disclosure provides a positioning method for an autonomous underwater vehicle, which is applied to a data receiving device arranged on the autonomous underwater vehicle in an underwater lighthouse positioning system, wherein the underwater lighthouse positioning system also includes a plurality of positioning lighthouses arranged on the bottom of the water, and receives the positioning code information sent by the positioning lighthouse, and parses the lighthouse clock pulse and lighthouse position information included in the positioning code information; determines the target time difference between each of the lighthouse clock pulses and the clock signal corresponding to the data receiving device; determines the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference according to the target time difference; determines the target position information corresponding to the autonomous underwater vehicle according to each of the target distances and the lighthouse position information corresponding to the positioning lighthouse. It can realize high-precision, wide-coverage real-time positioning of the autonomous underwater vehicle, which can not only effectively eliminate the drift error of the inertial navigation system, but also improve the real-time and reliability of acoustic positioning.

[0036] In order to make the above-mentioned objectives, features and advantages of the present disclosure more obvious and easy to understand, preferred embodiments are specifically cited below and described in detail with reference to the attached drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0037] In order to more clearly illustrate the technical solutions of the embodiments of the present disclosure, the following is a brief introduction to the drawings required for use in the embodiments. The drawings herein are incorporated into the specification and constitute a part of the specification. These drawings illustrate embodiments consistent with the present disclosure and are used together with the specification to illustrate the technical solutions of the present disclosure. It should be understood that the following drawings only illustrate certain embodiments of the present disclosure and should not be regarded as limiting the scope. For ordinary technicians in this field, other relevant drawings can also be obtained based on these drawings without creative work.

[0038] Figure 1 A schematic diagram of an underwater lighthouse positioning system provided by an embodiment of the present disclosure is shown;

[0039] Figure 2 A flow chart of a positioning method for an autonomous underwater vehicle provided by an embodiment of the present disclosure is shown;

[0040] Figure 3 A schematic diagram showing a positioning device for an autonomous underwater vehicle provided by an embodiment of the present disclosure is shown;

[0041] Figure 4 A schematic diagram of an electronic device provided by an embodiment of the present disclosure is shown. DETAILED DESCRIPTION

[0042] In order to make the purpose, technical scheme and advantages of the embodiments of the present disclosure clearer, the technical scheme in the embodiments of the present disclosure will be clearly and completely described below in conjunction with the drawings in the embodiments of the present disclosure. Obviously, the described embodiments are only part of the embodiments of the present disclosure, rather than all of the embodiments. The components of the embodiments of the present disclosure generally described and shown in the drawings here can be arranged and designed in various different configurations. Therefore, the following detailed description of the embodiments of the present disclosure provided in the drawings is not intended to limit the scope of the present disclosure for protection, but merely represents the selected embodiments of the present disclosure. Based on the embodiments of the present disclosure, all other embodiments obtained by those skilled in the art without making creative work belong to the scope of protection of the present disclosure.

[0043] It should be noted that similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, further definition and explanation thereof is not required in subsequent drawings.

[0044] The term "and / or" herein only describes an association relationship, indicating that three relationships may exist. For example, A and / or B may represent three situations: A exists alone, A and B exist at the same time, and B exists alone. In addition, the term "at least one" herein represents any combination of at least two of any one or more of a plurality of. For example, including at least one of A, B, and C may represent including any one or more elements selected from the set consisting of A, B, and C.

[0045] Research has found that in order to solve the positioning error problem of the inertial navigation system of autonomous underwater vehicles, the existing technology usually introduces an acoustic positioning system. Technologies based on acoustic positioning include long baseline (LBL), short baseline (SBL) and ultra-short baseline (USBL) positioning systems. However, the existing acoustic positioning systems still have shortcomings in practical applications, such as poor real-time performance, limited coverage, complex equipment deployment, and great environmental impact, and are difficult to implement in certain specific areas (such as the deep sea).

[0046] Based on the above research, the present disclosure provides a positioning method for an autonomous underwater vehicle, which is applied to a data receiving device arranged on an autonomous underwater vehicle in an underwater lighthouse positioning system, wherein the underwater lighthouse positioning system also includes a plurality of positioning lighthouses arranged on the bottom of the water, and receives the positioning code information sent by the positioning lighthouse, and parses the lighthouse clock pulse and lighthouse position information included in the positioning code information; determines the target time difference between each of the lighthouse clock pulses and the clock signal corresponding to the data receiving device; determines the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference according to the target time difference; determines the target position information corresponding to the autonomous underwater vehicle according to each of the target distances and the lighthouse position information corresponding to the positioning lighthouse. High-precision, wide-coverage real-time positioning of the autonomous underwater vehicle can be achieved, which can not only effectively eliminate the drift error of the inertial navigation system, but also improve the real-time and reliability of acoustic positioning.

[0047] To facilitate understanding of the present embodiment, a positioning method for an autonomous underwater vehicle disclosed in the embodiment of the present disclosure is first described in detail. The data receiving device provided on the autonomous underwater vehicle in the underwater lighthouse positioning system that executes the positioning method for the autonomous underwater vehicle provided in the embodiment of the present disclosure is arranged on the autonomous underwater vehicle.

[0048] See also Figure 1 As shown, it is a schematic diagram of an underwater lighthouse positioning system 10 provided by an embodiment of the present disclosure. Figure 1 As shown in FIG. 1 , the underwater lighthouse positioning system 10 includes a data receiving device 11 disposed on an autonomous underwater vehicle and a plurality of positioning lighthouses 12 disposed on the bottom of the water.

[0049] In a specific implementation, the positioning lighthouse 12 is fixed on the seabed, and its accurate geographic coordinates are known. Each lighthouse has an independent ID, and is regularly (such as every hour) synchronized with the positioning satellite through a floating antenna to ensure the accuracy of the system time. After the synchronization is completed, the antenna will be retracted to the bottom of the water. Each positioning lighthouse 12 sends acoustic positioning coded information including the lighthouse clock pulse and the lighthouse position information to the data receiving device 11, and the data receiving device 11 on the autonomous underwater vehicle receives and decodes the acoustic positioning coded information from the positioning lighthouse 12. By comparing with its own clock, the autonomous underwater vehicle can calculate its current position based on the position information of multiple underwater lighthouses, thereby achieving precise positioning.

[0050] Here, the positioning lighthouse 12 releases the data antenna to float to the water surface according to the preset time calibration interval; receives the satellite clock pulse sent by the positioning satellite through the data antenna, and calibrates the lighthouse clock pulse according to the satellite clock pulse, and after the calibration is completed, controls the antenna recovery equipment set on the positioning lighthouse 12 to recover the data antenna to the bottom of the water.

[0051] It should be noted that in order to improve positioning accuracy, the positioning lighthouses 12 should be evenly distributed in the predetermined navigation area of ​​the autonomous underwater vehicle, and the interval between every two positioning lighthouses 12 should be maintained within a certain range. Preferably, the interval between every two positioning lighthouses 12 can be 1 km.

[0052] As a possible implementation, the positioning lighthouse 12 can be powered by an external power supply or a submarine cable and installed on a submarine installation device. It also has an antenna retraction and extension control system. If there is a pile foundation or a location for installing an antenna, the antenna can be directly connected to the positioning lighthouse 12.

[0053] In this way, the autonomous underwater vehicle receives signals from multiple positioning lighthouses 12 and uses the time difference to calculate the distance between each positioning lighthouse 12, which can effectively improve the positioning accuracy, especially in complex underwater environments. In addition, since it does not need to surface frequently, the endurance of the autonomous underwater vehicle is significantly improved. Although the bandwidth of the acoustic signal is limited, the positioning information can be obtained in real time during the mission, without having to wait until the mission is completed.

[0054] The embodiment of the present application provides an underwater lighthouse positioning system, including a plurality of positioning lighthouses arranged at the bottom of the water and a data receiving device arranged on an autonomous underwater vehicle; the positioning lighthouse is used to send positioning code information including a lighthouse clock pulse and lighthouse position information to the data receiving device; the data receiving device is used to receive the positioning code information sent by the positioning lighthouse, and parse the lighthouse clock pulse and the lighthouse position information, determine the target time difference between each lighthouse clock pulse and the clock signal corresponding to the data receiving device, determine the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference according to the target time difference, and determine the target position information corresponding to the autonomous underwater vehicle according to each target distance and the lighthouse position information corresponding to the positioning lighthouse. High-precision, wide-coverage real-time positioning of the autonomous underwater vehicle can be achieved, which can not only effectively eliminate the drift error of the inertial navigation system, but also improve the real-time performance and reliability of acoustic positioning.

[0055] See also Figure 2 As shown, it is a flow chart of a positioning method of an autonomous underwater vehicle provided by an embodiment of the present disclosure. The method is applied to Figure 1 The data receiving device 11 in the underwater lighthouse positioning system 10 is provided on the autonomous underwater vehicle, and the method comprises steps S201 to S204, wherein:

[0056] S201, receiving the positioning code information sent by the positioning lighthouse, and parsing the lighthouse clock pulse and lighthouse position information included in the positioning code information.

[0057] In a specific implementation, a data receiving device installed on an autonomous underwater vehicle receives acoustic positioning code information sent by a positioning lighthouse installed on the bottom of the water, and parses out the lighthouse clock pulse and lighthouse position information carried in the positioning code information.

[0058] Here, the positioning lighthouse installed on the bottom of the water uses the characteristics of acoustic signals propagating in water to transmit the lighthouse clock pulse and lighthouse position information by continuously sending coded pulses.

[0059] Among them, the data receiving device can also parse the lighthouse identity information carried in the positioning code information, and determine the positioning lighthouse that sent the positioning code information based on the identity information.

[0060] Specifically, the positioning lighthouse sends a 32-bit encoded acoustic signal at fixed time intervals, which includes the lighthouse clock pulse, lighthouse location information, and lighthouse identification information. The lighthouse identification information is a unique ID code to ensure that the system can operate multiple lighthouses simultaneously in the same waters without signal confusion. The lighthouse clock pulse is generated by the lighthouse clock and used together with the lighthouse location information to correct the clock of the autonomous underwater vehicle and calculate the distance between the autonomous underwater vehicle and the positioning lighthouse.

[0061] Here, the coding of the positioning beacon can be in binary coding. The positioning coding information sent by each positioning beacon contains multiple acoustic pulses, which are arranged according to specific coding rules. Assuming that 32-bit binary coding is used, the signal of each beacon consists of two pulse sequences. Each positioning beacon generates two consecutive 32-bit pulse sequences, and each bit corresponds to an acoustic pulse. For example, the ID of beacon A is "101010...", and the ID of beacon B is "010101...". Different beacons can be distinguished by these pulse sequences.

[0062] Furthermore, the data receiving device on the autonomous underwater vehicle captures the acoustic signal emitted by the positioning lighthouse and converts it into a digital signal. The received pulse sequence is parsed and the lighthouse ID contained in the signal is determined by comparing it with a predetermined coding table. Since each lighthouse ID is unique, the autonomous underwater vehicle can accurately identify which lighthouse is sending the signal.

[0063] Optionally, in an underwater environment, the signal may be affected by noise, reflection and multipath effects. Therefore, the coding technology of the positioning beacon needs to have strong anti-interference capabilities. Redundant coding, spread spectrum technology and signal filtering processing can be used. Redundant coding adds redundant bits during encoding, and can restore the original information through error correction technology when the signal is damaged or partially lost; spread spectrum technology uses spread spectrum technology such as DSSS or FHSS to reduce the interference between the signal and environmental noise and improve the stability and reliability of the signal; autonomous underwater vehicles can use filtering and digital signal processing technology to remove errors caused by noise and multipath effects and enhance decoding accuracy.

[0064] S202: Determine a target time difference between each of the lighthouse clock pulses and a clock signal corresponding to the data receiving device.

[0065] In a specific implementation, the underwater mission of an autonomous underwater vehicle usually lasts for a long time. During this period, the accuracy error of the internal clock of the autonomous underwater vehicle will accumulate, resulting in position deviation. This accumulated error will affect the navigation accuracy of the autonomous underwater vehicle.

[0066] Here, the clock accuracy of the autonomous underwater vehicle is an important factor affecting the positioning accuracy. The clock signal generated by the crystal oscillator (oscillator) used inside the autonomous underwater vehicle will produce tiny errors over time, and these errors will accumulate and affect the positioning accuracy.

[0067] The accuracy of a crystal oscillator is usually expressed in parts per million (PPM), which is one million times the ratio of the crystal oscillator frequency error to its nominal frequency. Assume that the nominal frequency of the crystal oscillator is f n , the actual frequency is f, then the PPM error calculation formula is:

[0068]

[0069] Specifically, the larger the PPM error, the larger the crystal frequency deviation, resulting in a more significant time error. Over time, the error of the AUV clock will accumulate. For example, assuming that the AUV crystal produces a time deviation of 3.6ms per hour (i.e., a deviation of 3.6ms per hour). The position error is calculated in combination with the speed of sound.

[0070] Here, usually in seawater, the speed of sound is about 1500 m / s. A time deviation of 3.6 ms will cause a distance error of: position deviation = 1500 m / s × 3.6 ms = 5.4 m, which means that the position of the autonomous underwater vehicle may deviate by about 5.4 m per hour.

[0071] Therefore, every hour, the autonomous underwater vehicle will deviate by 5.4m. If accurate measurement and navigation are to be carried out, a positioning lighthouse installed on the bottom of the water is required for positioning.

[0072] Furthermore, time synchronization between the autonomous underwater vehicle and the positioning lighthouse is crucial. If the time is not synchronized, it will cause positioning errors. Therefore, in the system design, the data transmission antenna is regularly floated to the surface through the positioning lighthouse to synchronize with the GPS or Beidou satellite. The antenna can float on the water surface through the control mechanism, and the antenna is retracted to the bottom of the water after synchronization is completed to ensure that the time of the positioning lighthouse is accurate. After the autonomous underwater vehicle receives the acoustic signal of the positioning lighthouse, it uses the lighthouse clock pulse of the positioning lighthouse to calibrate its own clock.

[0073] As a possible implementation, a method for determining the target time difference between a lighthouse clock pulse and a clock signal corresponding to a data receiving device may be: determining a first rising edge corresponding to the lighthouse clock pulse, and a second rising edge corresponding to the clock signal corresponding to the data receiving device; and determining the difference between the time corresponding to the first rising edge and the time corresponding to the second rising edge as the target time difference.

[0074] S203: Determine, based on the target time difference, a target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference.

[0075] In a specific implementation, the distance between each positioning beacon and the autonomous underwater vehicle can be determined based on the propagation speed of the acoustic signal underwater and the pulse signal time difference between the positioning coded information sent by the positioning beacon received by the data receiving device on the autonomous underwater vehicle.

[0076] Exemplarily, after receiving the positioning code information C1 sent by positioning beacon B1 and the positioning code information C2 sent by positioning beacon B2, the autonomous underwater vehicle compares its own clock signal with C1 and C2 respectively, and calculates the time difference between the rising edge and C1 to be 0.1s, and the time difference between the rising edge and C2 to be 0.2s. Based on the speed of sound in seawater, which is approximately 1500m / s, it can be determined that the distance between the autonomous underwater vehicle and the positioning beacon B1 is 150m, and the distance between the autonomous underwater vehicle and the positioning beacon B2 is 300m.

[0077] S204: Determine the target position information corresponding to the autonomous underwater vehicle according to each target distance and the lighthouse position information corresponding to the positioning lighthouse.

[0078] In specific implementations, in order to obtain more accurate positioning results, it is usually necessary to use the positioning code information sent by three or more positioning lighthouses. The positioning code information sent by a single positioning lighthouse can only provide horizontal distance information, and cannot accurately provide depth information. Through multiple positioning lighthouses, the autonomous underwater vehicle can accurately locate its position in three-dimensional space.

[0079] As a possible implementation, the target position information of the autonomous underwater vehicle can be implemented based on the following steps 1 to 3:

[0080] Step 1: for each positioning lighthouse, determine the target distance between the autonomous underwater vehicle and the positioning lighthouse.

[0081] Step 2: For each positioning lighthouse, construct a distance equation group corresponding to the target position information according to the lighthouse position information corresponding to the positioning lighthouse and the target distance.

[0082] Step 3: Use the least square method to solve the distance equation group to determine the target position information corresponding to the autonomous underwater vehicle.

[0083] In a specific implementation, assuming that the target position information coordinates of the autonomous underwater vehicle are (x, y, z), and the lighthouse position information corresponding to the positioning lighthouse is (x1, y1, z1), (x2, y2, z2), ..., then the distance d1, d2, ... between the autonomous underwater vehicle and each lighthouse can be expressed as:

[0084]

[0085] Here, the lighthouse position information corresponding to different positioning lighthouses and the distance between the autonomous underwater vehicle and each positioning lighthouse can be used to obtain a set of equations corresponding to the target position information coordinates (x, y, z). The set of equations is further solved by the least squares method or other numerical methods to obtain the target position information of the autonomous underwater vehicle.

[0086] The embodiment of the present application provides a positioning method for an autonomous underwater vehicle, which is applied to a data receiving device arranged on the autonomous underwater vehicle in an underwater lighthouse positioning system, wherein the underwater lighthouse positioning system also includes a plurality of positioning lighthouses arranged on the bottom of the water, and receives the positioning code information sent by the positioning lighthouse, and parses the lighthouse clock pulse and lighthouse position information included in the positioning code information; determines the target time difference between each of the lighthouse clock pulses and the clock signal corresponding to the data receiving device; determines the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference according to the target time difference; determines the target position information corresponding to the autonomous underwater vehicle according to each of the target distances and the lighthouse position information corresponding to the positioning lighthouse. The high-precision, wide-coverage real-time positioning of the autonomous underwater vehicle can be realized, which can not only effectively eliminate the drift error of the inertial navigation system, but also improve the real-time and reliability of acoustic positioning.

[0087] Those skilled in the art will appreciate that, in the above method of specific implementation, the order in which the steps are written does not imply a strict execution order and does not constitute any limitation on the implementation process. The specific execution order of the steps should be determined by their functions and possible internal logic.

[0088] Based on the same inventive concept, the embodiment of the present disclosure also provides a face liveness detection device corresponding to the face liveness detection method. Since the principle of solving the problem by the device in the embodiment of the present disclosure is similar to the above-mentioned face liveness detection method in the embodiment of the present disclosure, the implementation of the device can refer to the implementation of the method, and the repeated parts will not be repeated.

[0089] See also Figure 3 , Figure 3 Schematic diagram of a positioning device for an autonomous underwater vehicle provided in an embodiment of the present disclosure. The device is used in Figure 1The underwater lighthouse positioning system 10 shown in FIG. 1 is provided with a data receiving device 11 on the autonomous underwater vehicle, and the underwater lighthouse positioning system 10 also includes a plurality of positioning lighthouses 12 arranged on the bottom of the water. Figure 3 As shown in FIG. , the positioning device 300 of the autonomous underwater vehicle provided in the embodiment of the present disclosure includes:

[0090] The coding information parsing module 310 is used to receive the positioning coding information sent by the positioning lighthouse, and parse the lighthouse clock pulse and lighthouse position information included in the positioning coding information.

[0091] The time difference determination module 320 is used to determine the target time difference between each of the lighthouse clock pulses and the clock signal corresponding to the data receiving device.

[0092] The distance determination module 330 is used to determine the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference according to the target time difference.

[0093] The autonomous underwater vehicle position determination module 340 is used to determine the target position information corresponding to the autonomous underwater vehicle according to each target distance and the lighthouse position information corresponding to the positioning lighthouse.

[0094] For descriptions of the processing flow of each module in the device and the interaction flow between each module, reference may be made to the relevant descriptions in the above method embodiment, which will not be described in detail here.

[0095] The present disclosure provides a positioning device for an autonomous underwater vehicle, which is applied to a data receiving device arranged on an autonomous underwater vehicle in an underwater lighthouse positioning system. The underwater lighthouse positioning system also includes a plurality of positioning lighthouses arranged on the bottom of the water. The positioning coding information sent by the positioning lighthouse is received, and the lighthouse clock pulse and lighthouse position information included in the positioning coding information are parsed; the target time difference between each of the lighthouse clock pulses and the clock signal corresponding to the data receiving device is determined; according to the target time difference, the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference is determined; according to each of the target distances and the lighthouse position information corresponding to the positioning lighthouse, the target position information corresponding to the autonomous underwater vehicle is determined. High-precision, wide-coverage real-time positioning of the autonomous underwater vehicle can be achieved, which can not only effectively eliminate the drift error of the inertial navigation system, but also improve the real-time and reliability of acoustic positioning.

[0096] Corresponds to Figure 2 The positioning method of the autonomous underwater vehicle in the present disclosure also provides an electronic device 400, such as Figure 4FIG. 4 is a schematic diagram of the structure of an electronic device 400 provided in an embodiment of the present disclosure, including:

[0097] Processor 41, memory 42, and bus 43; memory 42 is used to store execution instructions, including memory 421 and external memory 422; memory 421 here is also called internal memory, which is used to temporarily store operation data in processor 41 and data exchanged with external memory 422 such as hard disk. Processor 41 exchanges data with external memory 422 through memory 421. When the electronic device 400 is running, the processor 41 communicates with the memory 42 through bus 43, so that the processor 41 executes Figure 2 Steps in a method for positioning an autonomous underwater vehicle.

[0098] The present disclosure also provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the steps of the method for positioning an autonomous underwater vehicle described in the above method embodiment are executed. The storage medium may be a volatile or non-volatile computer-readable storage medium.

[0099] The present disclosure also provides a computer program product, which includes computer instructions. When the computer instructions are executed by a processor, the steps of the positioning method for the autonomous underwater vehicle described in the above method embodiment can be executed. For details, please refer to the above method embodiment, which will not be repeated here.

[0100] The computer program product may be implemented in hardware, software or a combination thereof. In one optional embodiment, the computer program product is implemented as a computer storage medium. In another optional embodiment, the computer program product is implemented as a software product, such as a software development kit (SDK).

[0101] Those skilled in the art can clearly understand that, for the convenience and simplicity of description, the specific working process of the device described above can refer to the corresponding process in the aforementioned method embodiment, and will not be repeated here. In the several embodiments provided in the present disclosure, it should be understood that the disclosed device and method can be implemented in other ways. The device embodiments described above are merely schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some communication interfaces, and the indirect coupling or communication connection of the device or unit can be electrical, mechanical or other forms.

[0102] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0103] In addition, each functional unit in each embodiment of the present disclosure may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.

[0104] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable storage medium that is executable by a processor. Based on this understanding, the technical solution of the present disclosure, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product, which is stored in a storage medium and includes several instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present disclosure. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.

[0105] Finally, it should be noted that the above-described embodiments are only specific implementation methods of the present disclosure, which are used to illustrate the technical solutions of the present disclosure, rather than to limit them. The protection scope of the present disclosure is not limited thereto. Although the present disclosure is described in detail with reference to the above-described embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-described embodiments within the technical scope disclosed in the present disclosure, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present disclosure, and should be included in the protection scope of the present disclosure. Therefore, the protection scope of the present disclosure should be based on the protection scope of the claims.

Claims

1. A positioning method for an autonomous underwater vehicle, characterized in that: A data receiving device disposed on an autonomous underwater vehicle in an underwater lighthouse positioning system, wherein the underwater lighthouse positioning system further comprises a plurality of positioning lighthouses disposed underwater, and the method comprises: Receive the positioning code information sent by the positioning lighthouse, and parse the lighthouse clock pulse and lighthouse position information included in the positioning code information; determining a target time difference between each of the lighthouse clock pulses and a clock signal corresponding to the data receiving device; Determining, based on the target time difference, a target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference; The target position information corresponding to the autonomous underwater vehicle is determined according to each target distance and the lighthouse position information corresponding to the positioning lighthouse.

2. The method according to claim 1, characterized in that After parsing the lighthouse clock pulse and lighthouse position information included in the positioning code information, the method further includes: Parsing the lighthouse identity information included in the positioning code information; The positioning lighthouse that sends the positioning code information is determined based on the identity information.

3. The method according to claim 1, characterized in that: The positioning beacon releases the data antenna to float to the water surface according to a preset time calibration interval; The satellite clock pulse sent by the positioning satellite is received through the data antenna, and the lighthouse clock pulse is calibrated according to the satellite clock pulse.

4. The method according to claim 1, characterized in that Determining a target time difference between each of the lighthouse clock pulses and a clock signal corresponding to the data receiving device specifically includes: Determine a first rising edge corresponding to the lighthouse clock pulse and a second rising edge corresponding to the clock signal corresponding to the data receiving device; The difference between the time corresponding to the first rising edge and the time corresponding to the second rising edge is determined as the target time difference.

5. The method according to claim 1, characterized in that Determining the target position information corresponding to the autonomous underwater vehicle according to each of the target distances and the lighthouse position information corresponding to the positioning lighthouse specifically includes: For each positioning lighthouse, determining the target distance between the autonomous underwater vehicle and the positioning lighthouse; For each of the positioning lighthouses, constructing a distance equation group corresponding to the target position information according to the lighthouse position information corresponding to the positioning lighthouse and the target distance; The distance equation group is solved by using the least square method to determine the target position information corresponding to the autonomous underwater vehicle.

6. The method according to claim 3, characterized in that After calibrating the lighthouse clock pulse according to the satellite clock pulse, the method further comprises: The antenna recovery device arranged on the positioning lighthouse is controlled to recover the data antenna to the bottom of the water.

7. A positioning device for an autonomous underwater vehicle, characterized in that: A data receiving device for use in an underwater lighthouse positioning system and disposed on an autonomous underwater vehicle, wherein the underwater lighthouse positioning system further comprises a plurality of positioning lighthouses disposed underwater, and the device comprises: A coding information parsing module, used for receiving the positioning coding information sent by the positioning lighthouse, and parsing the lighthouse clock pulse and lighthouse position information included in the positioning coding information; A time difference determination module, used to determine a target time difference between each of the lighthouse clock pulses and a clock signal corresponding to the data receiving device; A distance determination module, configured to determine, based on the target time difference, a target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference; The autonomous underwater vehicle position determination module is used to determine the target position information corresponding to the autonomous underwater vehicle according to each target distance and the lighthouse position information corresponding to the positioning lighthouse.

8. An underwater lighthouse positioning system, characterized in that: It includes a plurality of positioning lighthouses disposed on the bottom of the water and a data receiving device disposed on an autonomous underwater vehicle; The positioning lighthouse is used to send positioning coded information including lighthouse clock pulses and lighthouse position information to the data receiving device; The data receiving device is used to receive the positioning code information sent by the positioning lighthouse, and to parse the lighthouse clock pulse and the lighthouse position information, to determine the target time difference between each of the lighthouse clock pulses and the clock signal corresponding to the data receiving device, and based on the target time difference, to determine the target distance between the autonomous underwater vehicle and the positioning lighthouse corresponding to the target time difference, and based on each of the target distances and the lighthouse position information corresponding to the positioning lighthouse, to determine the target position information corresponding to the autonomous underwater vehicle.

9. An electronic device, characterized in that: include: A processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor and the memory communicate via the bus, and when the machine-readable instructions are executed by the processor, the steps of the positioning method for an autonomous underwater vehicle as described in any one of claims 1 to 6 are performed.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, which, when executed by a processor, executes the steps of the method for positioning an autonomous underwater vehicle according to any one of claims 1 to 6.

Citation Information

Patent Citations

  • Positioning method, device and system and computer storage medium

    CN108445453A

  • AUV cluster underwater communication detection data collection system and method

    CN117459156A

  • Transportable submarine intervention and exploration device for locating or recovery of e.g. cargo aircraft black box, has sub-marine engine including memory for storing reception instants of signals emitted by acoustic emitter

    FR2942770A1

  • Method and Apparatus for Synchronizing Clocks Underwater Using Light and Sound

    US20150188695A1

Cited By

  • Self-adaptive positioning navigation system suitable for underwater motion platform AUV (Autonomous Underwater Vehicle)

    CN122429782A

  • Underwater robot navigation positioning method based on single beacon ranging and kinetic model

    CN122590901A