Docking recovery integrated navigation method based on improved Gaussian distance iterative algorithm

An iterative algorithm and integrated navigation technology, applied in the field of navigation, can solve the problems of easy divergence, complex calculation process, and difficult practical application, and achieve the effect of good stability and accuracy and preventing huge errors.

Pending Publication Date: 2020-10-02
JIANGSU DIYI GROUP
View PDF2 Cites 2 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

The patent document with the application number CN201611201932.8 discloses "a target positioning and identification method", which mainly uses magnetic anomaly technology for measurement, but its method requires a high signal-to-noise ratio. For the actual magnetic anomaly signal, its The convergence speed and convergence cannot be guaranteed, it is difficult to carry out practical application, and it is not suitable for large-scale application
The patent document with the application number CN201910455748.3 discloses "a target positioning algorithm based on the distance and bearing dictionary", which establishes different distance-bearing joint dictionaries for different environments. Although the distance and bearing of the target can be jointly estimated, the calculation The process is too complicated, the accuracy of real-time and state estimation is not high, and problems such as divergence are prone to occur

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Docking recovery integrated navigation method based on improved Gaussian distance iterative algorithm
  • Docking recovery integrated navigation method based on improved Gaussian distance iterative algorithm
  • Docking recovery integrated navigation method based on improved Gaussian distance iterative algorithm

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0046] The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments.

[0047] Such as figure 1 As shown, the straight-line homing stage 1, this stage means that the recovery device 5 uses the ultra-short baseline to locate the AUV autonomous vehicle 6, and reaches the straight-line tracking point 2, thereby entering the tracking process of the straight-line tracking stage 3; using the ultra-short baseline to provide The relative position and attitude information of the AUV is used to adjust the position of the AUV and the recovery device, so that the AUV can be sailed to the central axis 7 while consuming a relatively short distance from the docking axis, so that the attitude of the AUV is consistent with the central axis, thereby entering the heading Adjustment stage 4 is conducive to further real-time docking.

[0048] Such as figure 2 As shown, it is a segmented diagram of the overall track of the AUV in the...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention discloses a docking recovery integrated navigation method based on an improved Gaussian distance iterative algorithm. The docking recovery integrated navigation method comprises the following steps: 1) segmenting a track of an AUV into a plurality of connected straight line segments; 2) calculating the coordinate of each position point by utilizing dead reckoning to obtain a coordinate equation set; 3) linearizing the error by using Taylor series expansion, setting a position initial value and an iteration threshold of the AUV, solving a correction amount of the AUV position by using a least square method, comparing the correction amount with the iteration threshold, and stopping iteration if the correction amount is less than the iteration threshold; 4) if the correction amount is greater than an iteration threshold, updating the step length by adopting a trust region method to continue iteration; 5) solving the coordinate of the last point of the straight line segment as the initial point of the next straight line segment, and repeating the above steps for iteration. The method can effectively correct the speed and position errors of the AUV, enables the whole system to have higher filtering precision and stability, and provides guarantee for the safe recovery of the AUV.

Description

technical field [0001] The invention relates to a navigation method, in particular to a combined navigation method based on an improved Gaussian distance iterative algorithm. Background technique [0002] The ocean, which covers 70% of the earth's area, is rich in resources, but the current methods for human exploration of the ocean are limited and expensive. As an important tool for developing the ocean, underwater robots are the key to opening the door to the ocean. The autonomous underwater robot AUV carries its own power supply and equipment, and does not need to rely on the mother ship to supply power through cables. It can transmit information to the mother ship through communication methods such as signal optical cables, acoustic communication, or satellite communication. Due to the advantages of small size, wide range of activities, and high concealment, AUV can independently complete marine tasks, and has become a research hotspot in various countries. It is precis...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
Patent Type & Authority Applications(China)
IPC IPC(8): G01C21/20
CPCG01C21/203
Inventor 王建明姚国强戚华凤包灵卉曾庆军戴晓强
Owner JIANGSU DIYI GROUP
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products