CN111060140B - Polar region inertial navigation error obtaining method under earth ellipsoid model - Google Patents
Polar region inertial navigation error obtaining method under earth ellipsoid model Download PDFInfo
- Publication number
- CN111060140B CN111060140B CN201911424397.6A CN201911424397A CN111060140B CN 111060140 B CN111060140 B CN 111060140B CN 201911424397 A CN201911424397 A CN 201911424397A CN 111060140 B CN111060140 B CN 111060140B
- Authority
- CN
- China
- Prior art keywords
- error
- coordinate system
- grid
- earth
- equation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000004364 calculation method Methods 0.000 claims abstract description 14
- 239000011159 matrix material Substances 0.000 claims description 16
- 230000001133 acceleration Effects 0.000 claims description 7
- 230000005484 gravity Effects 0.000 claims description 7
- 230000000694 effects Effects 0.000 abstract description 3
- 230000003321 amplification Effects 0.000 description 3
- 238000003199 nucleic acid amplification method Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
Images
Classifications
-
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/12—Simultaneous equations, e.g. systems of linear equations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/13—Differential equations
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Algebra (AREA)
- Operations Research (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
The invention relates to a polar region inertial navigation error obtaining method under an earth ellipsoid model.A calculation error source under the earth ellipsoid model is added into an attitude error equation; the speed error equation expresses the grid speed as a grid speed true value and a grid speed error, and each error source is added; and the position error equation adopts a rectangular coordinate system to solve the position, and the error source is added into a grid calculation value containing a grid position truth value and a grid position error. Compared with the prior art, the effect is as follows: according to the method, the error model of polar region inertial navigation calculation under the earth ellipsoid model is established, the influence of the earth ellipsoid model on the accuracy of the error propagation process is reduced, and the accuracy of the model is improved, so that the accuracy of combined navigation and transfer alignment in the polar region is improved.
Description
Technical Field
The invention belongs to the field of inertial navigation, and relates to a polar region inertial navigation error obtaining method under a terrestrial ellipsoid model.
Background
The core of the inertial navigation system algorithm is mechanical arrangement, and the inertial navigation system algorithm mainly comprises two types: the mechanical arrangement of the north-pointing direction and the mechanical arrangement of the wandering direction. The north-pointing azimuth inertial navigation mechanical arrangement concept is simple and clear in physical significance, but the north-pointing arrangement has the problems of azimuth calculation overflow, error amplification and the like in high-latitude areas. When the calculation accuracy of the azimuth gyro command velocity term is gradually reduced along with the increase of the latitude until the calculation overflows, the calculation error of the horizontal velocity is seriously amplified, and even the overflow is generated. Therefore, the north-seeking system cannot normally work in high-latitude areas, is only suitable for navigation in middle-latitude and low-latitude areas, and the working area of the north-seeking system cannot exceed 75 degrees. The wandering azimuth inertial navigation mechanical programming has singular values when extracting position information from a position direction cosine matrix in a high-latitude area, so that the wandering azimuth inertial navigation system cannot realize navigation in a polar region range and only can finish resolving of an attitude direction cosine matrix and the position direction cosine matrix. In addition, the problems of longitude calculation error amplification and wandering azimuth calculation error amplification similar to those of a north-pointing azimuth inertial navigation system also exist in a high-latitude area, so that the wandering azimuth inertial navigation is mechanically organized to normally work but cannot complete the orientation and positioning tasks in the high-latitude area under the condition of not inputting position and azimuth information.
The Greenwich meridian is used as the heading reference, so that the problem of directional reference caused by meridian convergence can be avoided. The carrier is located the point department and is on a parallel with the plane of greenwich mean meridian as the graticule mesh plane, regard as the tangent plane with the horizontal plane that the carrier is located, graticule mesh plane and tangent plane's intersecting line define for graticule mesh north to, graticule mesh north is to the contained angle of same geographical direction for sigma, graticule mesh sky to coincide with geographical coordinate system sky, graticule mesh east is in tangent plane and constitutes right hand rectangular coordinate system with graticule mesh north is perpendicular, this is the graticule mesh coordinate system. The position information of the grid system under the output rectangular coordinate can be matched with the navigation map of the polar region for use, so that the Greenwich grid mechanical layout is a more suitable polar region inertial navigation layout scheme at present.
However, an error model for the conventional polar region grid inertial solution is derived under an earth sphere model, an error equation cannot accurately describe an error propagation process, a principle error is introduced into a mathematical model, and the accuracy of combined navigation and transfer alignment in a polar region is influenced.
The invention provides
Disclosure of Invention
Technical problem to be solved
In order to avoid the defects of the prior art, the invention provides a polar region inertial navigation error obtaining method under a terrestrial ellipsoid model.
Technical scheme
A polar region inertial navigation error obtaining method under an earth ellipsoid model is characterized by comprising an attitude error equation, a speed error equation and a position error equation;
the method comprises the following steps:
step 1: calculating the relationship between the position error of the rectangular coordinate system and the longitude and latitude errors of the geographic coordinate system
Wherein: (x, y, z) represents the position of a rectangular coordinate system, (L, λ, h) represents the longitude, latitude and altitude of a geographic coordinate system, e is the earth oblateness, R N Principal radius of curvature, R, of earth-unitary fourth of twelve earthly branches M The radius of curvature of the meridian of the earth;
geographic coordinate system error: delta P e =A -1 ·δR e
Step 2, calculating a speed error equation: and expressing the grid speed as grid speed and grid speed error, adding each error source to obtain a speed error equation:
wherein: v. of G Is the grid velocity, δ v G The grid speed error is obtained;
wherein:representing a rotation matrix between the carrier coordinate system and the grid coordinate system, f b Representing accelerometer output, g G The gravity acceleration under the grid coordinate system is represented,the rotational angular velocity of the earth under the grid coordinate system is represented,representing the rotation angular rate of the grid coordinate system relative to the earth;
differential equation of grid velocity error
Wherein: f. of G Is the output of the accelerometer under the grid coordinate system,is the earth rotation angular velocity error under the grid coordinate system,is the error of grid coordinate system with respect to the rotation angular rate of the earth, δ g G Is the gravity acceleration error, phi G Is the error in the attitude of the object,is the accelerometer error;
step 3, calculating an attitude error equation: adding a calculation error source under an earth ellipsoid model into an attitude differential equation in grid inertial navigation solution:
wherein:is the relative inertia of grid coordinate systemThe angular velocity of rotation of the linear coordinate system,it is the error of the gyroscope that is,is the east-direction velocity of the grid coordinate system,is the north velocity of the grid coordinate system.
Step 4, calculating a position error differential equation:
wherein,
is a rotation matrix of the grid coordinate system relative to the earth coordinate system,is a rotation matrix of the geographic coordinate system relative to the grid coordinate system,a rotation matrix of the terrestrial coordinate system with respect to the geographic coordinates.
Advantageous effects
The invention provides a polar region inertial navigation error obtaining method under a terrestrial ellipsoid model.
Attitude error equation: a calculation error source (a gyroscope error, an earth rotation angular rate error and a grid relative earth rotation angular rate error) under an earth ellipsoid model is added into an attitude differential equation in grid inertial navigation resolving. And the relationship between the position error of the core rectangular coordinate system of the earth ellipsoid model and the longitude and latitude error of the geographic coordinate system. According to the position relation of two coordinate systems, a first-order full increment is established and expressed in a matrix form, and is brought into a position error to complete an attitude error equation.
The velocity error equation: and expressing the grid speed as a grid speed true value and a grid speed error, and adding various error sources (attitude calculation error, table addition error, gravity vector error, earth rotation angular rate error and grid coordinate system relative earth rotation angular rate error) to obtain a speed error equation.
Position error equation: and solving the position by adopting a rectangular coordinate system, adding an error source (grid speed error and grid attitude matrix error) into a grid calculated value containing a grid position true value and a grid position error, and calculating to obtain a position error equation.
Compared with the prior art, the invention has the following effects: according to the method, the error model of polar region inertial navigation calculation under the earth ellipsoid model is established, the influence of the earth ellipsoid model on the accuracy of the error propagation process is reduced, and the accuracy of the model is improved, so that the accuracy of combined navigation and transfer alignment in the polar region is improved.
Drawings
FIG. 1: definition of grid coordinate system
A plane parallel to the meridian plane of Greenwich mean is taken as a grid plane at the P point where the carrier is located, a horizontal plane where the carrier is located is taken as a tangent plane, an intersection line of the grid plane and the tangent plane is defined as the north direction of the grid, the east direction of the grid and the north direction of the grid are perpendicular to each other in the tangent plane, the sky direction of the grid and the sky direction of a geographic coordinate system coincide to form a right-hand rectangular coordinate system, and a grid coordinate system (e) is represented by G (G) E 、e N 、e U Representing the east, north and sky directions of a geographic coordinate system;representing grid coordinate system east, north and sky)
FIG. 2: rotation relationship between grid north and geographical north
The north direction of the grid coordinate system and the direction of the geographic coordinate system form an included angle sigma. It can be seen from the figure that the rotation relationship is coordinate rotation performed by taking the day coordinate axis as a rotation axis
Detailed Description
The invention will now be further described with reference to the following examples and drawings:
1. relationship between position error of rectangular coordinate system and longitude and latitude errors of geographic coordinate system
The relationship between the position of the rectangular coordinate system and the longitude, latitude and height of the geographic coordinate system is as follows: (x, y, z) represents the position of a rectangular coordinate system, (L, λ, h) represents the longitude, latitude and altitude of a geographic coordinate system, and e is the earth oblateness.
Considering the main curvature radius R of the earth-unitary fourth of twelve earthly branches in a short time N And the radius of curvature R of the meridian of the earth M The variation is small and constant.
First order full increment of the rectangular coordinate system error (δ x, δ y, δ z):
written in matrix form as:
δR e =A·δP e
rewriting to geographical coordinate system error representation:
δP e =A -1 ·δR e
2. equation of speed error
The velocity differential equation in the grid coordinate system is:
v G the velocity in the grid coordinate system is represented,presentation carrierRotation matrix between body coordinate system and grid coordinate system, f b Representing accelerometer output, g G The gravity acceleration under the grid coordinate system is represented,the rotational angular velocity of the earth under the grid coordinate system is represented,representing the angular rate of rotation, g, of the grid coordinate system relative to the earth G Is the grid coordinate system gravitational acceleration, when there is an error:
wherein (delta v) G The error in the speed of the grid is,is the earth rotation angular velocity error under the grid coordinate system,is the error of grid coordinate system with respect to the rotation angular rate of the earth, δ g G Is the gravity acceleration error, phi G Is the error in the attitude of the object,is accelerometer error):
substituted into the velocity differential equation and neglecting the second order small quantity to obtain (Accelerometer error under grid coordinate system):
here, the rotation angle rate of the earth under the grid coordinate system is expressed as follows (the included angle between the north direction of the grid coordinate system and the direction of the geographic coordinate system is σ):
then, the rotational angular velocity error of the earth in the grid coordinate system can be expressed as:
it can be abbreviated as:
the grid coordinate system is expressed in relation to the angular rate of rotation of the earth asThe north-direction speed of the grid coordinate system is represented,representing the grid coordinate system moving direction speed):
here:
the error of the grid coordinate system with respect to the angular rate of rotation of the earth is expressed as:
specifically, unfolding:
wherein:
if, order:
and:
the coefficient matrix for δ h is Q
Therefore, the error of the grid coordinate system with respect to the rotation angular rate of the earth is collated as:
order:
irrespective of δ g G Then the velocity error equation under the grid coordinate system is:
3. equation of attitude error
wherein the error of the grid coordinate system with respect to the angular rate of rotation of the earthError of grid coordinate system relative to rotation angular rate of earthWhile the velocity differential equation has been described, the attitude error differential equation in the grid system is as follows.
4. Differential equation of position error
Position error equation of grid coordinate system:
the representation under the geographic coordinate system is:
FIG. 1: a plane parallel to the meridian plane of Greenwich mean is taken as a grid plane at the P point where the carrier is located, a horizontal plane where the carrier is located is taken as a tangent plane, an intersection line of the grid plane and the tangent plane is defined as the north direction of the grid, the east direction of the grid and the north direction of the grid are perpendicular to each other in the tangent plane, the sky direction of the grid and the sky direction of a geographic coordinate system coincide to form a right-hand rectangular coordinate system, and a grid coordinate system (e) is represented by G (G) E 、e N 、e U Representing the east, north and sky directions of a geographic coordinate system;representing the grid coordinate system east, north, and sky).
Claims (1)
1. A polar region inertial navigation error obtaining method under an earth ellipsoid model is characterized by comprising an attitude error equation, a speed error equation and a position error equation;
the method comprises the following steps:
step 1: calculating the relationship between the position error of the rectangular coordinate system and the longitude and latitude errors of the geographic coordinate system:
wherein: (x, y, z) represents the position of a rectangular coordinate system, (L, λ, h) represents the longitude, latitude and altitude of a geographic coordinate system, e is the earth oblateness, R N Principal radius of curvature, R, of earth fourth prime circle M The radius of curvature of the meridian of the earth;
geographic coordinate system error: delta P e =A -1 ·δR e
Step 2, calculating a speed error equation: and expressing the grid speed as grid speed and grid speed error, adding each error source to obtain a speed error equation:
wherein: v. of G Is the grid velocity, δ v G The grid speed error is obtained;
wherein:representing a rotation matrix between the carrier coordinate system and the grid coordinate system, f b Representing accelerometer output, g G The gravity acceleration under the grid coordinate system is represented,representing the rotation angular rate of the earth under the grid coordinate system,representing the rotation angular rate of the grid coordinate system relative to the earth;
grid velocity error differential equation:
wherein: f. of G Is the output of the accelerometer under the grid coordinate system,is the earth rotation angular velocity error under the grid coordinate system,is the error of grid coordinate system relative to the rotation angular rate of the earth, δ g G Is the gravity acceleration error, phi G Is the error in the attitude of the object,is the accelerometer error;
step 3, calculating an attitude error equation: adding a calculation error source under an earth ellipsoid model into an attitude differential equation in grid inertial navigation solution:
wherein:is the rotation angular velocity of the grid coordinate system relative to the inertial coordinate system, it is the error of the gyroscope that is,is the east-direction velocity of the grid coordinate system,is the grid coordinate system north velocity;
step 4, calculating a position error differential equation:
wherein,
is a rotation matrix of the grid coordinate system relative to the terrestrial coordinate system, is a rotation matrix of the geographic coordinate system relative to the grid coordinate system,a rotation matrix of the terrestrial coordinate system with respect to the geographic coordinates.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911424397.6A CN111060140B (en) | 2019-12-31 | 2019-12-31 | Polar region inertial navigation error obtaining method under earth ellipsoid model |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911424397.6A CN111060140B (en) | 2019-12-31 | 2019-12-31 | Polar region inertial navigation error obtaining method under earth ellipsoid model |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111060140A CN111060140A (en) | 2020-04-24 |
CN111060140B true CN111060140B (en) | 2022-08-02 |
Family
ID=70306195
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911424397.6A Active CN111060140B (en) | 2019-12-31 | 2019-12-31 | Polar region inertial navigation error obtaining method under earth ellipsoid model |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111060140B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112539745B (en) * | 2020-08-13 | 2021-09-21 | 哈尔滨工业大学 | Dual-coordinate system conversion navigation algorithm based on assistance of external sensor |
CN113465599B (en) * | 2021-06-04 | 2023-08-01 | 北京信息科技大学 | Positioning and orientation method, device and system |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10048074B1 (en) * | 2017-03-16 | 2018-08-14 | Honeywell International Inc. | Polar region operating attitude and heading reference system |
CN110196048A (en) * | 2019-05-27 | 2019-09-03 | 哈尔滨工程大学 | A kind of grid inertial navigation method that polar region is updated without longitude |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7509216B2 (en) * | 2004-03-29 | 2009-03-24 | Northrop Grumman Corporation | Inertial navigation system error correction |
CN104215242B (en) * | 2014-09-30 | 2017-03-15 | 东南大学 | A kind of polar region inertial navigation based on coordinate system of laterally vacillating |
CN107543545B (en) * | 2017-10-30 | 2019-07-19 | 中国人民解放军国防科技大学 | Polar region double-navigation inertial navigation system positioning information fusion method |
CN109737958A (en) * | 2019-03-08 | 2019-05-10 | 哈尔滨工程大学 | A kind of acoustics tests the speed the polar region grid inertial navigation error inhibition method of auxiliary |
CN110196066B (en) * | 2019-05-10 | 2022-07-15 | 西北工业大学 | Virtual polar region method based on unchanged grid attitude speed information |
CN110457813B (en) * | 2019-08-08 | 2022-07-05 | 西北工业大学 | Virtual polar region method based on transverse geographic coordinate system |
-
2019
- 2019-12-31 CN CN201911424397.6A patent/CN111060140B/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10048074B1 (en) * | 2017-03-16 | 2018-08-14 | Honeywell International Inc. | Polar region operating attitude and heading reference system |
CN110196048A (en) * | 2019-05-27 | 2019-09-03 | 哈尔滨工程大学 | A kind of grid inertial navigation method that polar region is updated without longitude |
Non-Patent Citations (1)
Title |
---|
基于统一横向坐标系的极区地球椭球模型导航方法;卞鸿巍等;《中国惯性技术学报》;20181015(第05期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN111060140A (en) | 2020-04-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109813311B (en) | Unmanned aerial vehicle formation collaborative navigation method | |
CN104655131B (en) | Inertial navigation Initial Alignment Method based on ISTSSRCKF | |
CN103900608B (en) | A kind of low precision inertial alignment method based on quaternary number CKF | |
CN108426575B (en) | Strapdown inertial navigation polar region transverse navigation method improved by earth ellipsoid model | |
CN112595350B (en) | Automatic calibration method and terminal for inertial navigation system | |
CN105371844A (en) | Initialization method for inertial navigation system based on inertial / celestial navigation interdependence | |
CN104697520B (en) | Integrated gyro free strap down inertial navigation system and gps system Combinated navigation method | |
CN105910606A (en) | Direction adjustment method based on angular velocity difference | |
CN103557864A (en) | Initial alignment method for micro electro mechanical system (MEMS) strap-down inertial navigation adaptive square-root cubature Kalman filtering (SCKF) | |
CN110196066B (en) | Virtual polar region method based on unchanged grid attitude speed information | |
CN111060140B (en) | Polar region inertial navigation error obtaining method under earth ellipsoid model | |
CN102679978A (en) | Initial alignment method of static base of rotary type strap-down inertial navigation system | |
CN105841698A (en) | AUV rudder angle precise real-time measurement system without zero setting | |
CN111722295B (en) | Underwater strapdown gravity measurement data processing method | |
CN107907898A (en) | Polar region SINS/GPS Integrated Navigation Algorithms based on grid frame | |
CN110221331B (en) | Inertia/satellite combined navigation dynamic filtering method based on state transformation | |
CN116222551A (en) | Underwater navigation method and device integrating multiple data | |
CN110514200B (en) | Inertial navigation system and high-rotation-speed rotating body attitude measurement method | |
CN106092098B (en) | A kind of carrier navigation attitude measurement method based on gyro and inclinator | |
CN106441297B (en) | The gravity error vector acquisition methods and device of inertial navigation system | |
CN106643726B (en) | Unified inertial navigation resolving method | |
CN112229421B (en) | Strapdown inertial navigation shaking base coarse alignment method based on optimal estimation of Litsea group | |
Zhang et al. | Research on auto compensation technique of strap-down inertial navigation systems | |
CN110906927B (en) | Gravity acceleration simplified algorithm under solidification coordinate system | |
CN109387221B (en) | Post-processing self-alignment method of micro-inertial navigation system |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |