CN113670284A - Large misalignment angle fast alignment method of compass alignment/reverse inertial attitude update combination - Google Patents
Large misalignment angle fast alignment method of compass alignment/reverse inertial attitude update combination Download PDFInfo
- Publication number
- CN113670284A CN113670284A CN202110905596.XA CN202110905596A CN113670284A CN 113670284 A CN113670284 A CN 113670284A CN 202110905596 A CN202110905596 A CN 202110905596A CN 113670284 A CN113670284 A CN 113670284A
- Authority
- CN
- China
- Prior art keywords
- alignment
- compass
- attitude
- data
- time
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/38—Testing, calibrating, or compensating of compasses
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
A big misalignment angle fast alignment method of compass alignment/reverse inertia attitude update combination comprises the following steps: (1) and determining the time length of the repeated data and the course attitude angle at the initial moment according to the precision requirement and the carrier environment. (2) And running compass alignment in the data length to obtain the course attitude angle of the data ending moment. The heading and attitude angle errors at the end of the data are reduced compared to the initial time. (3) And reversely extrapolating the course attitude angle from the ending moment by utilizing the reversed inertial sensor data in the time length to obtain the course and the attitude angle corresponding to the initial moment data. (4) And (4) taking the attitude angle obtained by the back-pushing as an initial value, repeatedly utilizing inertial sensor data in a time length, and operating the compass alignment algorithm for the 2 nd time to obtain the course and the attitude angle with smaller errors. (5) And (5) repeating the steps (3) and (4) until the compass alignment end condition is met.
Description
Technical Field
The invention relates to a large misalignment angle fast alignment method of compass alignment/reverse inertial attitude update combination, which combines the characteristics of course convergence of a compass system along with time and high updating precision of short-term inertial attitude, repeatedly applies acquired inertial sensor data and repeatedly carries out forward compass alignment and reverse inertial attitude update for many times. The method can realize compass alignment which can be achieved only in a long time in a short time, and improve the alignment speed.
Background
With the increase of the demand of human beings for marine resources, marine exploration and development become an important task for the vigorous development of countries in the world. Besides the detection and operation equipment, the navigation and positioning of the device are also an essential link in ocean detection and development. The performance of navigation has a significant impact on the effectiveness of ocean engineering, and therefore researchers have conducted research on navigation and positioning of underwater vehicles during near-shore terrain mapping, target searching, and other tasks. Among them, alignment is a technical bottleneck that restricts the navigation accuracy. Particularly, under the emergency water entering condition, the precise alignment is not performed for enough time, so that the initial misalignment angle is large, and a large positioning error occurs in the navigation process, and therefore how to realize the rapid alignment of the large misalignment angle of the underwater vehicle becomes a problem to be solved urgently.
The strapdown compass is used as a dynamic alignment method and widely applied to navigation of underwater vehicles. The alignment time is one of the key performance parameters of the strapdown compass, and the alignment time and the alignment precision of the strapdown compass cannot be obtained at the same time in general. Compass alignment is divided into two stages, namely horizontal alignment and azimuth alignment, wherein the horizontal alignment is relatively fast and high in precision, and the azimuth alignment is a technical bottleneck limiting compass alignment performance. The azimuth error of the traditional compass alignment method is convergent, but as the initial misalignment angle increases, a longer convergence time is required to achieve the same alignment accuracy. In the offshore sub-carrier, emergency entry situation, there is not enough time and a relatively steady state for initial alignment. The initial misalignment angle upon emergency entry into water is also large, which presents a severe challenge to the implementation of fast, high precision alignment.
Disclosure of Invention
The technical problem to be solved by the invention is as follows: the fast compass alignment method is researched by combining the characteristics of convergence of course of compass algorithm along with time and high updating precision of short-term inertial attitude, repeatedly utilizing inertial measurement data in a short time and updating and combining the compass and the inertial attitude. A new solution is provided for the application of fast alignment methods at large misalignment angles.
The technical solution of the invention is as follows: a big misalignment angle fast alignment method of compass alignment/reverse inertia attitude update combination is characterized by comprising the following steps:
(1) and determining the time length of the repeated data and the course attitude angle at the initial moment according to the precision requirement and the carrier environment.
(2) And running compass alignment in the data length to obtain the course attitude angle of the data ending moment. The heading and attitude angle errors at the end of the data are reduced compared to the initial time.
(3) And reversely extrapolating the course attitude angle from the ending moment by utilizing the reversed inertial sensor data in the time length to obtain the course and the attitude angle corresponding to the initial moment data. Because the updating error of the inertial attitude is smaller in a short period, the attitude after a period of time convergence can be transmitted to the initial time to generate a new initial value of the course attitude angle. Compared with the initial course attitude angle obtained without reverse operation, the initial attitude angle obtained by back-pushing is closer to a true value, and the precision is higher.
(4) And (4) taking the attitude angle obtained by the back-pushing as an initial value, repeatedly utilizing inertial sensor data in a time length, and operating the compass alignment algorithm for the 2 nd time to obtain the course and the attitude angle with smaller errors.
(5) And (5) repeating the steps (3) and (4) for multiple times until the compass alignment end condition is met.
The principle of the invention is as follows: first, using inertial sensor data over a period of time T to
Performing compass alignment for the initial value to obtain
While the compass calculation is carried out, the data (comprising gyroscope and accelerometer data) of the section is stored; then is provided with
Starting as an initial value, updating the inertial attitude in a reverse direction by applying data of a gyroscope and an accelerometer to obtain an initial attitude and a course which are closer to the actual initial attitude
And repeating the calculation for multiple times until the requirements of application precision and time are met.
Compared with the prior art, the invention has the advantages that:
(1) according to the characteristic that the compass alignment can be aligned under a moving base and the inertial attitude update has high precision in a short period, the compass alignment and the inertial attitude update are comprehensively applied to align a large misalignment angle, error convergence is realized by using an algorithm, and the converged alignment precision is transmitted to the data initial time by using reverse inertial attitude update. And a foundation is laid for the quick convergence of the next alignment error.
(2) The method carries out compass alignment operation for N times and reverse inertial attitude updating algorithm (N-1) times and alignment ending condition judgment for (N-1) times, and the time consumed for running the algorithm is T + (N-1). DELTA.t. Usually, the time of T is selected to be dozens of seconds, the compass algorithm occupies a short program, the time for carrying out one-time centralized continuous operation compass alignment, reverse inertial attitude updating and alignment ending condition judgment by using data with the time length within T is set to be delta T, and the delta T is far smaller than the T. The method consumes T + (N-1). DELTA.t time, but can obtain the alignment precision which can be achieved only by N.T time length data. That is, the method of the present invention can greatly shorten the alignment time while satisfying the alignment accuracy.
Drawings
FIG. 1 is a schematic diagram of a compass-based alignment/inertial navigation fast alignment method according to the present invention;
FIG. 2 is a flowchart illustrating the end of compass alignment procedure according to the present invention;
FIG. 3 is a flow chart of the compass/inertia combination fast alignment method under a large misalignment angle according to the present invention.
Detailed Description
The method of the technical solution of the present invention is shown in fig. 1, the compass alignment end judgment process is shown in fig. 2, the complete step flow chart is shown in fig. 3, and the specific implementation steps are as follows:
(1) firstly, according to the precision requirement and the carrier environment, the time length of the repeated data is determined to be T ═ Tm-t0Wherein the initial time t0Has an attitude angle of
In case of emergency
The error is large.
(2) Then, from t0To tmThe internally running compass is aligned to obtain tmAttitude angle of time
Compared with
Attitude and heading errors are reduced. Since a relatively short time length of T is selected, it is usual
The accuracy requirements are not met. Compass alignment is required to be continued until the precision requirement is met. But this does not meet the rapidity of alignment required for some applications. To increase the speed of alignment. The invention provides the method for repeatedly utilizing the data to carry out next compass alignment, so that the attitude and heading error is further reduced.
(3) Compass alignment is advanced in time. After performing one alignment, the time has reached tmTime of day, and the next compass alignment needs to be from t0Starting at a moment, so the text adopts a reverse inertial attitude updating method, using tmTime t0Reverse inertial sensor data of time of day will
From tmReversely pushing back the moment to obtain the course and the attitude angle corresponding to the moment data
Because the updating error of the inertial attitude is smaller in a short period, the attitude converged after a period of time can be transmitted to the moment, and a new attitude heading is generated. And
in contrast to the above-mentioned results,
closer to the true value. This corresponds to a reduction of the initial error of the time of day data.
(4) Then use
As an initial value, reuse t0To tmThe inertial sensor data in the time period and the 2 nd-time running of the compass alignment algorithm obtain smaller errors
(5) Finally, repeating the steps (3) and (4) N-1 times until the alignment precision requirement is met
And taking the application precision requirement as a judgment basis for the alignment end.
Those skilled in the art will appreciate that the invention may be practiced without these specific details.
Claims (4)
1. A big misalignment angle fast alignment method of compass alignment/reverse inertia attitude update combination is characterized by comprising the following steps:
(1) and determining the time length of the repeated data and the course attitude angle at the initial moment according to the precision requirement and the carrier environment.
(2) And running compass alignment in the data length to obtain the course attitude angle of the data ending moment. The heading and attitude angle errors at the end of the data are reduced compared to the initial time.
(3) And reversely extrapolating the course attitude angle from the ending moment by utilizing the reversed inertial sensor data in the time length to obtain the course and the attitude angle corresponding to the initial moment data. Because the updating error of the inertial attitude is smaller in a short period, the attitude after a period of time convergence can be transmitted to the initial time to generate a new initial value of the course attitude angle. Compared with the initial course attitude angle obtained without reverse operation, the initial attitude angle obtained by back-pushing is closer to a true value, and the precision is higher.
(4) And (4) taking the attitude angle obtained by the back-pushing as an initial value, repeatedly utilizing inertial sensor data in a time length, and operating the compass alignment algorithm for the 2 nd time to obtain the course and the attitude angle with smaller errors.
(5) And (5) repeating the steps (3) and (4) for multiple times until the compass alignment end condition is met.
2. The method of claim 1 for fast alignment with large misalignment angle of compass alignment/inverse inertial attitude update combination, wherein: according to the characteristic that the compass alignment can be aligned under a moving base and the inertial attitude update has high precision in a short period, the compass alignment and the inertial attitude update are comprehensively applied to align a large misalignment angle, error convergence is realized by using an algorithm, and the converged alignment precision is transmitted to the data initial time by using reverse inertial attitude update. And a foundation is laid for the quick convergence of the next alignment error.
3. The method of claim 1 for fast alignment with large misalignment angle of compass alignment/inverse inertial attitude update combination, wherein: the method of the invention can greatly shorten the alignment time while meeting the alignment precision. The method repeatedly applies data with a period of time, and from the first updating of the reverse inertial attitude, the alignment operation is not required to be performed after waiting for the next sampling moment, but is continuous operation, so that the method consumes less time, and can obtain the alignment accuracy which can be achieved only by the data with the time length of several times. That is to say, under the condition of achieving the same alignment precision, the method needs less time consumption and improves the alignment speed.
4. The method of claim 1 for fast alignment with large misalignment angle of compass alignment/inverse inertial attitude update combination, wherein: and setting a precision threshold of compass alignment in advance according to application requirements, taking the difference between the results of the latest two compass alignments, ending the circulation if the threshold is reached, taking the result of the last compass alignment as the alignment result, and continuing the circulation if the threshold is not reached.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110905596.XA CN113670284A (en) | 2021-08-05 | 2021-08-05 | Large misalignment angle fast alignment method of compass alignment/reverse inertial attitude update combination |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110905596.XA CN113670284A (en) | 2021-08-05 | 2021-08-05 | Large misalignment angle fast alignment method of compass alignment/reverse inertial attitude update combination |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN113670284A true CN113670284A (en) | 2021-11-19 |
Family
ID=78541736
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110905596.XA Pending CN113670284A (en) | 2021-08-05 | 2021-08-05 | Large misalignment angle fast alignment method of compass alignment/reverse inertial attitude update combination |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113670284A (en) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111735474A (en) * | 2020-06-14 | 2020-10-02 | 西北工业大学 | Moving base compass alignment method based on data backtracking |
| CN112985368A (en) * | 2021-02-09 | 2021-06-18 | 西北工业大学 | Rapid compass alignment method of underwater vehicle before launching of mobile carrying platform |
-
2021
- 2021-08-05 CN CN202110905596.XA patent/CN113670284A/en active Pending
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111735474A (en) * | 2020-06-14 | 2020-10-02 | 西北工业大学 | Moving base compass alignment method based on data backtracking |
| CN112985368A (en) * | 2021-02-09 | 2021-06-18 | 西北工业大学 | Rapid compass alignment method of underwater vehicle before launching of mobile carrying platform |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110304270A (en) | Omnidirectional emission control method, device, computer equipment for carrier rocket | |
| CN106052684B (en) | Mobile robot IMU/UWB/code wheel loose combination navigation system and method adopting multi-mode description | |
| CN109141911B (en) | The acquisition methods and device of the control amount of unmanned vehicle performance test | |
| CN109724592B (en) | AUV geomagnetic bionic navigation method based on evolutionary gradient search | |
| CN107316455A (en) | Shared storing cycle method and apparatus, server and readable storage medium storing program for executing | |
| CN102853833B (en) | Rapid damping method of strap-down inertial navigation system | |
| CN110906930A (en) | AUV (autonomous underwater vehicle) combined underwater gravity lighthouse submarine navigation method and system | |
| CN110865539A (en) | Unmanned ship tracking error constraint control method under random interference | |
| CN106679662A (en) | Combined underwater robot navigation method based on TMA (target motion analysis) technology and single beacon | |
| CN109115212B (en) | Method for extracting full-range attitude angle of inertial navigation system | |
| CN106813663B (en) | Inertial navigation data and satellite navigation data synchronization method | |
| CN113670284A (en) | Large misalignment angle fast alignment method of compass alignment/reverse inertial attitude update combination | |
| CN105785416A (en) | Single-frequency single-epoch GNSS quick positioning method at the presence of base line restriction | |
| CN109918812A (en) | A kind of general change face program of azimuth pitch type antenna crosses top processing method | |
| CN111176292B (en) | Wave glider path tracking control method based on side margin | |
| CN105631179A (en) | Carrier transient response indication method based on star satellite load couple analysis result | |
| CN113686333B (en) | Strapdown inertial navigation full-attitude representation method for radar array surface rotation | |
| Liu et al. | DVL dead-reckoning navigation method based on beam measurements | |
| CN107462865B (en) | Course error compensation method based on single-standard positioning double-precision difference optimization | |
| CN114115319B (en) | Spacecraft attitude maneuver path planning method under time-varying constraint | |
| CN116150873A (en) | Method for building unmanned ship digital capability model | |
| CN112985368B (en) | Rapid compass alignment method of underwater vehicle before launching of mobile carrying platform | |
| CN109649689B (en) | Limited thrust orbital transfer gravity loss calculation method and thrust calculation device | |
| CN113031433A (en) | Method and device for controlling communication-in-motion servo system | |
| RU2615848C1 (en) | Moving vessel control method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20211119 |
|
| WD01 | Invention patent application deemed withdrawn after publication |