An underwater acoustic navigation and localization method based on particle filter algorithm
A particle filter algorithm, navigation and positioning technology, applied in navigation, surveying and mapping and navigation, navigation calculation tools, etc., can solve problems such as equivalent sound velocity error, large positioning error of underwater vehicles, and failure of underwater vehicle positioning. Achieve the effect of reducing possibility, improving accuracy, and realizing long-distance precise underwater acoustic positioning and navigation
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment 1
[0038] The following combination Figure 1 to Figure 6 Embodiment 1 of the present application will be described.
[0039] Such as figure 1 As shown, this embodiment provides a particle filter algorithm-based underwater acoustic navigation and positioning method, including: step 1, according to the second position coordinates of the beacon and the pulse positioning signal between the aircraft and the beacon, construct an acoustic navigation model, Among them, the pulse positioning signal is sent by the beacon to the aircraft;
[0040] Specifically, such as figure 2 As shown, set the Y-axis direction to 0°, and the coordinates of the three beacons are B1(0,0), B2(r,0) and The initial position of the aircraft is A(3r / 4, r / 5), and the aircraft moves in a straight line at a constant speed along the track 201 with a speed of 2.5m / s and a heading of 75° clockwise. In practical applications, even if the aircraft moves in a straight line at a uniform speed, it will be affected b...
Embodiment 2
[0078] After calculating the first position coordinates and the equivalent sound velocity of the aircraft through Embodiment 1, a signal delay model can also be constructed, and the third position coordinates of the aircraft can be calculated by using the equivalent sound velocity, and then the weighting algorithm can be used, according to the first The position coordinates and the third position coordinates are used to calculate the fourth position coordinates of the aircraft, including:
[0079] Step 7: Construct a signal delay model based on the pulse positioning signals received by the aircraft from multiple propagation paths, where the pulse positioning signal is sent by the beacon to the aircraft, the number of propagation paths is determined by the current water environment, and the signal delay model The calculation formula is:
[0080]
[0081] In the formula, y * (n) is the pulse positioning signal transmitted by the beacon received by the aircraft, s(n) is the p...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 


