CN116429096A - Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system - Google Patents

Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system Download PDF

Info

Publication number
CN116429096A
CN116429096A CN202310149585.2A CN202310149585A CN116429096A CN 116429096 A CN116429096 A CN 116429096A CN 202310149585 A CN202310149585 A CN 202310149585A CN 116429096 A CN116429096 A CN 116429096A
Authority
CN
China
Prior art keywords
geomagnetic
navigation
information
inertial
magnetometer
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
Application number
CN202310149585.2A
Other languages
Chinese (zh)
Inventor
高东
梁宇潇
韩鹏
卞春江
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
National Space Science Center of CAS
Original Assignee
National Space Science Center of CAS
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by National Space Science Center of CAS filed Critical National Space Science Center of CAS
Priority to CN202310149585.2A priority Critical patent/CN116429096A/en
Publication of CN116429096A publication Critical patent/CN116429096A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/166Mechanical, construction or arrangement details of inertial navigation systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • G01C21/08Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/30Assessment of water resources

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Environmental & Geological Engineering (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geology (AREA)
  • Navigation (AREA)

Abstract

The invention provides a geomagnetic inertial fusion navigation method and a geomagnetic inertial fusion navigation system, wherein the method comprises the following steps: carrying out quick estimation on the geomagnetic abnormal field model by utilizing differential measurement information of inertial navigation and a magnetometer; using the estimated geomagnetic abnormal field model as a basis, inputting a measurement result of continuously tracking the geomagnetic abnormal field by a magnetometer, and estimating position change information; correcting a position drift of the inertial navigation using the estimated position change; and repeating the steps to determine the position information and realize geomagnetic inertia fusion autonomous navigation. The invention has the advantages that: the method is different from a geomagnetic matching navigation method, and does not need the support of regional geomagnetic diagrams. The system can provide autonomous navigation service for the low-altitude unmanned aerial vehicle and the underwater vehicle in any global scope, lays a foundation for autonomous operation of the system in any global scope, is a subversion of geomagnetic matching navigation technology, and has great significance and application value.

Description

Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system
Technical Field
The invention belongs to the field of autonomous navigation of low-altitude vehicles and underwater submarines, and particularly relates to a geomagnetic inertial fusion navigation method and system.
Background
The geomagnetic navigation is to measure the geomagnetic field by utilizing a magnetometer, compare the geomagnetic measured value with a geomagnetic model or geomagnetic map, and determine the current position of the platform through a navigation algorithm, so that the geomagnetic navigation is a navigation mode which has strong autonomy and high anti-interference capability and can be used all the day. Autonomous navigation services may be provided for various mobile platforms in the event that a Global Navigation Satellite System (GNSS) is disturbed, or even destroyed.
From the technical route realized by geomagnetic navigation, geomagnetic navigation is divided into two modes of geomagnetic filtering navigation and geomagnetic matching navigation. Geomagnetic filtering navigation is carried out by comparing geomagnetic measurement data with geomagnetic main magnetic field model data, and the position of a platform is determined through a navigation algorithm, so that the method is suitable for high altitude and orbital vehicles; geomagnetic matching type navigation is used for comparing geomagnetic measurement data with geomagnetic map data of geomagnetic abnormal fields, and the position of the platform is determined through a matching method, so that the method is suitable for low-altitude aircrafts and underwater submarines.
Because geomagnetic matching navigation needs to utilize geomagnetic map data and geomagnetic measurement data to match so as to determine the position information of the platform, geomagnetic field information of an application area needs to be measured in advance and a geomagnetic map is constructed when the technology is applied; or geomagnetic matching type navigation can only be used in an area with a priori geomagnetic map, so that geomagnetic matching type navigation cannot provide autonomous navigation service for a platform in a non-cooperative area or an area without the priori geomagnetic map, namely if a low-altitude unmanned plane and an underwater vehicle in China use geomagnetic matching navigation technology, intelligent autonomous operation in the non-cooperative area cannot be realized, and autonomous operation of global content cannot be realized.
The geomagnetic navigation technology independent of the priori geomagnetic map is studied, so that the geomagnetic navigation technology can be used in any global area, and the low-altitude unmanned aerial vehicle and the underwater vehicle in China can have autonomous navigation capability in any global area, thereby laying a foundation for autonomous operation in any global area.
Disclosure of Invention
The invention aims to overcome the defect that the prior geomagnetic navigation technology is required to depend on a priori geomagnetic map.
In order to achieve the above object, the present invention provides a geomagnetic inertial fusion navigation method, which includes:
step 1: carrying out quick estimation on the geomagnetic abnormal field model by utilizing differential measurement information of inertial navigation and a magnetometer;
step 2: using the estimated geomagnetic abnormal field model as a basis, inputting a measurement result of continuously tracking the geomagnetic abnormal field by a magnetometer, and estimating position change information;
step 3: correcting a position drift of the inertial navigation using the estimated position change;
step 4: and (3) repeating the steps 1-3, determining position change information, and realizing geomagnetic inertia fusion autonomous navigation.
As an improvement of the above method, the step 1 specifically includes:
calculating differential information between two measurements of position and geomagnetic field, respectively, using inertial navigation measurement data and magnetometer measurement data
Figure BDA0004090409770000021
And->
Figure BDA0004090409770000022
Figure BDA0004090409770000023
Figure BDA0004090409770000024
Wherein,,
Figure BDA0004090409770000025
is a measurement value of adjacent two inertial navigation; />
Figure BDA0004090409770000026
Geomagnetic anomaly field value measured for i+1 magnetometer,/g>
Figure BDA0004090409770000027
Geomagnetic abnormal field values measured by the magnetometer i times;
by means of
Figure BDA0004090409770000028
And->
Figure BDA0004090409770000029
And carrying out geomagnetic abnormal field model estimation.
As an improvement of the above method, the step 2 specifically includes:
obtaining estimated position change information using
Figure BDA00040904097700000210
Figure BDA00040904097700000211
Wherein,,
Figure BDA00040904097700000212
differential information which is the information of the geomagnetic field measurement for two times; mu (mu) 0 Is vacuum magnetic permeability; />
Figure BDA00040904097700000213
A magnetic moment of a geomagnetic abnormal field represented by a magnetic dipole; />
Figure BDA00040904097700000214
Position information from a measuring point to the center of a magnetic moment of the geomagnetic abnormal field; r is the position scalar information from the measuring point to the magnetic moment center of the geomagnetic abnormal field; t is the vector transpose.
As an improvement of the above method, the step 3 specifically includes:
by means of
Figure BDA00040904097700000215
Substitute->
Figure BDA00040904097700000216
Performing inertial navigation recursion to make the real position change information equal to +.>
Figure BDA00040904097700000217
The invention also provides a geomagnetic inertial fusion navigation system, which comprises:
the geomagnetic abnormal field estimation module is used for rapidly estimating a geomagnetic abnormal field model by utilizing differential measurement information of inertial navigation and a magnetometer;
the position change estimation module is used for inputting a measurement result of continuously tracking the geomagnetic abnormal field by the magnetometer by using the estimated geomagnetic abnormal field model as a basis, and estimating position change information;
a modified inertial navigation position drift module for modifying a position drift of the inertial navigation using the estimated position change;
and the position information determining module is used for determining position change information and realizing geomagnetic inertia fusion autonomous navigation.
As an improvement of the above system, the processing procedure of the geomagnetic abnormal field estimation module includes:
calculating differential information between two measurements of position and geomagnetic field, respectively, using inertial navigation measurement data and magnetometer measurement data
Figure BDA0004090409770000031
And->
Figure BDA0004090409770000032
Figure BDA0004090409770000033
Figure BDA0004090409770000034
Wherein,,
Figure BDA0004090409770000035
is a measurement value of adjacent two inertial navigation; />
Figure BDA0004090409770000036
Geomagnetic anomaly field value measured for i+1 magnetometer,/g>
Figure BDA0004090409770000037
Geomagnetic abnormal field values measured by the magnetometer i times;
by means of
Figure BDA0004090409770000038
And->
Figure BDA0004090409770000039
And carrying out geomagnetic abnormal field model estimation.
As an improvement of the above system, the processing procedure of the position change estimation module includes:
obtaining estimated position change information using
Figure BDA00040904097700000310
Figure BDA00040904097700000311
Wherein,,
Figure BDA00040904097700000312
differential information which is the information of the geomagnetic field measurement for two times; mu (mu) 0 Is vacuum magnetic permeability; />
Figure BDA00040904097700000313
A magnetic moment of a geomagnetic abnormal field represented by a magnetic dipole; />
Figure BDA00040904097700000314
Position information from a measuring point to the center of a magnetic moment of the geomagnetic abnormal field; r is the position scalar information from the measuring point to the magnetic moment center of the geomagnetic abnormal field; t is the vector transpose.
As an improvement of the above system, the process of modifying the inertial navigation position drift module includes:
by means of
Figure BDA00040904097700000315
Substitute->
Figure BDA00040904097700000316
Performing inertial navigation recursion to make the real position change information equal to +.>
Figure BDA00040904097700000317
Compared with the prior art, the invention has the advantages that:
1. the geomagnetic inertial fusion navigation method is different from a geomagnetic matching navigation method, and does not need the support of regional geomagnetic diagrams.
2. The geomagnetic inertial fusion navigation method can provide autonomous navigation service for the low-altitude unmanned aerial vehicle and the underwater vehicle in any global range, lays a foundation for autonomous operation of the low-altitude unmanned aerial vehicle and the underwater vehicle in any global range, is a subversion of geomagnetic matching navigation technology, and has great significance and application value.
Drawings
FIG. 1 is a schematic diagram of a geomagnetic inertial fusion navigation method;
FIG. 2 is a flow chart showing the core processing of the geomagnetic inertial fusion navigation method;
FIG. 3 is a flow chart of a geomagnetic inertial fusion navigation method.
Detailed Description
The technical scheme of the invention is described in detail below with reference to the accompanying drawings.
The invention provides a novel autonomous navigation method which is different from geomagnetic matching navigation in that geomagnetic abnormal field geomagnetic images of a navigation application area need to be acquired in advance and only the geomagnetic abnormal field needs to be tracked and measured, so that geomagnetic/inertial fusion autonomous navigation is realized under the participation of inertial navigation. The basic principle is as follows: firstly, carrying out online quick estimation on geomagnetic abnormal fields in a certain area by utilizing inertial navigation position information; then tracking and measuring geomagnetic anomalies by utilizing a magnetometer, and inverting the change information of the position; and finally, correcting the position drift of inertial navigation by utilizing the inverted position change information, and realizing a high-precision geomagnetic/inertial fusion autonomous navigation technology. The schematic diagram is shown in fig. 1.
The invention relates to a geomagnetic inertial fusion navigation method, which uses inertial navigation and magnetometer as measurement sensors. Firstly, a measured value of inertial navigation is utilized to rapidly estimate a geomagnetic anomaly, then, the position change information is inverted based on continuous tracking measurement of a magnetometer on the anomaly field, and finally, the position drift information of inertial navigation is corrected by utilizing the position change information, so that a geomagnetic/inertial fusion navigation technology with high precision is realized. As shown in fig. 2, the core of the algorithm is: quick estimation of geomagnetic abnormal field, tracking measurement of geomagnetic abnormal field, inversion estimation of position change information and correction of inertial navigation position drift.
Example 1:
the invention provides a geomagnetic inertial fusion navigation method, which comprises the following steps:
step 1: carrying out quick estimation on the geomagnetic abnormal field model by utilizing differential measurement information of inertial navigation and a magnetometer; the geomagnetic abnormal field model used in the method is a geomagnetic abnormal field model which is universal in the prior art.
Step 2: continuously tracking measurement information of a geomagnetic abnormal field by using a magnetometer as input, and estimating position change information of a carrier by using an estimated geomagnetic abnormal field model as a basis;
step 3: correcting the position drift of the inertial navigation by using the estimated position change of the carrier;
step 4: and (3) repeating the steps 1-3, optimally determining carrier position information, and realizing geomagnetic/inertial fusion autonomous navigation.
The geomagnetic inertial fusion navigation method comprises the following specific implementation steps:
step 1: fast estimation of geomagnetic anomaly field model based on differential information
Calculating differential information between two measurements of position and geomagnetic field, respectively, using inertial navigation measurement data and magnetometer measurement data
Figure BDA0004090409770000051
And->
Figure BDA0004090409770000052
Wherein:
Figure BDA0004090409770000053
in the method, in the process of the invention,
Figure BDA0004090409770000054
for the measurement of two adjacent inertial navigation systems, +.>
Figure BDA0004090409770000055
For drift information of the respective inertial navigation, in two adjacent measurements, the drift information of the inertial navigation is very close and can be considered equal.
Figure BDA0004090409770000056
In the method, in the process of the invention,
Figure BDA0004090409770000057
for measurement values of i+1 magnetometer, < >>
Figure BDA0004090409770000058
For the measurement value of i times magnetometer, the measurement value contains geomagnetic abnormal field +.>
Figure BDA0004090409770000059
And geomagnetic Main magnetic field->
Figure BDA00040904097700000510
In the course of the measurement of two adjacent magnetometers, it is considered that the change in the main magnetic field is small, i.e.>
Figure BDA00040904097700000511
Differential measurement information using inertial navigation
Figure BDA00040904097700000512
Differential measurement information with magnetometer +.>
Figure BDA00040904097700000513
The geomagnetic abnormal field model can be estimated quickly. The differential measurement information not only effectively eliminates the drift information of inertial navigation, but also removes the information of the main magnetic field of the earth, so that the high-precision estimation of geomagnetic abnormal field models can be realized, and a foundation is laid for the estimation of the subsequent position change information.
Step 2: position change information estimation based on geomagnetic anomaly field module tracking measurement
Geomagnetic anomaly fields can be represented as:
Figure BDA00040904097700000514
the difference operation is performed on the above equation, and the following can be obtained:
Figure BDA00040904097700000515
wherein,,
Figure BDA00040904097700000516
for geomagnetic field measurement information +.>
Figure BDA00040904097700000517
Differential information which is the information of the geomagnetic field measurement for two times; mu (mu) 0 Is vacuum magnetic permeability; />
Figure BDA00040904097700000518
A magnetic moment of a geomagnetic abnormal field represented by a magnetic dipole; />
Figure BDA00040904097700000519
Position information from a measuring point to the center of a magnetic moment of the geomagnetic abnormal field; r is the position scalar information from the measuring point to the magnetic moment center of the geomagnetic abnormal field; />
Figure BDA00040904097700000520
For the position change information corresponding to geomagnetic measurement difference information, there is +>
Figure BDA0004090409770000061
T is the vector transpose. Thus from the measured value +.>
Figure BDA0004090409770000062
Position change information can be obtained->
Figure BDA0004090409770000063
Laying a foundation for subsequent inertial navigation correction.
Step 3: inertial navigation position drift correction
When using geomagnetic anomaly estimation position change information, since the geomagnetic anomaly field model has high estimation accuracy, the estimated position change information
Figure BDA0004090409770000064
Does not contain drift over time. So use->
Figure BDA0004090409770000065
The uncorrected inertial navigation contains position change information of drift, and the inertial navigation comprises the following steps in the two measuring processes:
Figure BDA0004090409770000066
the method comprises the following steps:
Figure BDA0004090409770000067
Figure BDA0004090409770000068
for information of the change of position between two measurements, i.e. +.>
Figure BDA0004090409770000069
During navigation
Figure BDA00040904097700000610
The middle is due to->
Figure BDA00040904097700000611
Is present, therefore->
Figure BDA00040904097700000612
Will be greater than->
Figure BDA00040904097700000613
I.e.
Figure BDA00040904097700000614
By means of
Figure BDA00040904097700000615
Substitute->
Figure BDA00040904097700000616
Performing inertial navigation recursion, namely, order
Figure BDA00040904097700000617
The inertial navigation position drift error information delta P can be removed, and high-precision geomagnetic/inertial fusion navigation information is further achieved.
Step 4: optimal estimation of the most value information
And continuing to optimize the geomagnetic abnormal field model by using the corrected inertial navigation measurement information and magnetometer measurement information, and continuing to perform geomagnetic/inertial fusion navigation in an iterative mode to realize optimal position information estimation.
The geomagnetic inertial fusion navigation method provided by the invention can realize autonomous navigation of low-altitude aircrafts and underwater submarines without depending on prior maps. The navigation technique can be used in any region of the world since it does not rely on any external support. Autonomous navigation is a foundation for realizing autonomous operation of an operation platform, and the geomagnetic/inertial fusion navigation method independent of priori geomagnetic diagrams can lay a foundation for global autonomous operation of a low-altitude unmanned aerial vehicle and an underwater vehicle.
Example 2:
the invention also provides a geomagnetic inertial fusion navigation system, which comprises:
the geomagnetic abnormal field estimation module is used for rapidly estimating a geomagnetic abnormal field model by utilizing differential measurement information of inertial navigation and a magnetometer;
the position change estimation module is used for inputting a measurement result of continuously tracking the geomagnetic abnormal field by the magnetometer by using the estimated geomagnetic abnormal field model as a basis, and estimating position change information;
a modified inertial navigation position drift module for modifying a position drift of the inertial navigation using the estimated position change;
and the position information determining module is used for determining position change information and realizing geomagnetic/inertial fusion autonomous navigation.
The innovation point of the invention is that: tracking and measuring the geomagnetic abnormal field by utilizing a magnetometer, rapidly estimating the geomagnetic abnormal field model on line, inverting the position change information of the carrier, correcting the position drift of inertial navigation, and further realizing geomagnetic/inertial fusion navigation. The technology can realize geomagnetic/inertial fusion navigation of the low-altitude aircraft and the underwater vehicle without relying on a priori geomagnetic map.
Finally, it should be noted that the above embodiments are only for illustrating the technical solution of the present invention and are not limiting. Although the present invention has been described in detail with reference to the embodiments, it should be understood by those skilled in the art that modifications and equivalents may be made thereto without departing from the spirit and scope of the present invention, which is intended to be covered by the appended claims.

Claims (8)

1. A geomagnetic inertial fusion navigation method, the method comprising:
step 1: carrying out quick estimation on the geomagnetic abnormal field model by utilizing differential measurement information of inertial navigation and a magnetometer;
step 2: using the estimated geomagnetic abnormal field model as a basis, inputting a measurement result of continuously tracking the geomagnetic abnormal field by a magnetometer, and estimating position change information;
step 3: correcting a position drift of the inertial navigation using the estimated position change;
step 4: and (3) repeating the steps 1-3, determining position change information, and realizing geomagnetic inertia fusion autonomous navigation.
2. The geomagnetic inertial fusion navigation method of claim 1, wherein the step 1 specifically includes:
calculating differential information between two measurements of position and geomagnetic field, respectively, using inertial navigation measurement data and magnetometer measurement data
Figure FDA0004090409760000011
And->
Figure FDA0004090409760000012
Figure FDA0004090409760000013
Figure FDA0004090409760000014
Wherein,,
Figure FDA0004090409760000015
Figure FDA0004090409760000016
is a measurement value of adjacent two inertial navigation; />
Figure FDA0004090409760000017
Geomagnetic anomaly field value measured for i+1 magnetometer,/g>
Figure FDA0004090409760000018
Geomagnetic abnormal field values measured by the magnetometer i times;
by means of
Figure FDA0004090409760000019
And->
Figure FDA00040904097600000110
And carrying out geomagnetic abnormal field model estimation.
3. The geomagnetic inertial fusion navigation method of claim 2, wherein the step 2 specifically includes:
obtaining estimated position change information using
Figure FDA00040904097600000111
Figure FDA00040904097600000112
Wherein,,
Figure FDA00040904097600000113
differential information which is the information of the geomagnetic field measurement for two times; mu (mu) 0 Is vacuum magnetic permeability; />
Figure FDA00040904097600000114
A magnetic moment of a geomagnetic abnormal field represented by a magnetic dipole; />
Figure FDA00040904097600000115
Position information from a measuring point to the center of a magnetic moment of the geomagnetic abnormal field; r is the position scalar information from the measuring point to the magnetic moment center of the geomagnetic abnormal field; t is the vector transpose.
4. The geomagnetic inertial fusion navigation method of claim 3, wherein the step 3 specifically includes:
by means of
Figure FDA00040904097600000116
Substitute->
Figure FDA00040904097600000117
Performing inertial navigation recursion to make the real position change information equal to +.>
Figure FDA00040904097600000118
5. A geomagnetic inertial fusion navigation system, wherein the system includes:
the geomagnetic abnormal field estimation module is used for rapidly estimating a geomagnetic abnormal field model by utilizing differential measurement information of inertial navigation and a magnetometer;
the position change estimation module is used for inputting a measurement result of continuously tracking the geomagnetic abnormal field by the magnetometer by using the estimated geomagnetic abnormal field model as a basis, and estimating position change information;
a modified inertial navigation position drift module for modifying a position drift of the inertial navigation using the estimated position change;
and the position information determining module is used for determining position change information and realizing geomagnetic inertia fusion autonomous navigation.
6. The geomagnetic inertial fusion navigation system of claim 5, wherein the processing of the geomagnetic anomaly field estimation module includes:
calculating differential information between two measurements of position and geomagnetic field, respectively, using inertial navigation measurement data and magnetometer measurement data
Figure FDA0004090409760000021
And->
Figure FDA0004090409760000022
Figure FDA0004090409760000023
Figure FDA0004090409760000024
Wherein,,
Figure FDA0004090409760000025
is a measurement value of adjacent two inertial navigation; />
Figure FDA0004090409760000026
Geomagnetic anomaly field value measured for i+1 magnetometer,/g>
Figure FDA0004090409760000027
Geomagnetic abnormal field values measured by the magnetometer i times;
by means of
Figure FDA0004090409760000028
And->
Figure FDA0004090409760000029
And carrying out geomagnetic abnormal field model estimation.
7. The geomagnetic inertial fusion navigation system of claim 6, wherein the processing of the position variation estimation module includes:
obtaining estimated position change information using
Figure FDA00040904097600000210
Figure FDA00040904097600000211
Wherein,,
Figure FDA00040904097600000212
differential information which is the information of the geomagnetic field measurement for two times; mu (mu) 0 Is vacuum magnetic permeability; />
Figure FDA00040904097600000213
A magnetic moment of a geomagnetic abnormal field represented by a magnetic dipole; />
Figure FDA00040904097600000214
Position information from a measuring point to the center of a magnetic moment of the geomagnetic abnormal field; r is the position scalar information from the measuring point to the magnetic moment center of the geomagnetic abnormal field; t is the vector transpose.
8. The geomagnetic inertial fusion navigation system of claim 7, wherein the process of modifying the inertial navigation position drift module includes:
by means of
Figure FDA0004090409760000031
Substitute->
Figure FDA0004090409760000032
Performing inertial navigation recursion to make the real position change information equal to +.>
Figure FDA0004090409760000033
CN202310149585.2A 2023-02-22 2023-02-22 Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system Pending CN116429096A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310149585.2A CN116429096A (en) 2023-02-22 2023-02-22 Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310149585.2A CN116429096A (en) 2023-02-22 2023-02-22 Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system

Publications (1)

Publication Number Publication Date
CN116429096A true CN116429096A (en) 2023-07-14

Family

ID=87091469

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310149585.2A Pending CN116429096A (en) 2023-02-22 2023-02-22 Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system

Country Status (1)

Country Link
CN (1) CN116429096A (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2523753C1 (en) * 2013-01-09 2014-07-20 Федеральное государственное бюджетное образовательное учреждение высшего профессионального образования "Саратовский государственный технический университет имени Гагарина Ю.А." (СГТУ имени Гагарина Ю.А.) Method of personal autonomous navigation
CN108089434A (en) * 2017-12-11 2018-05-29 北京控制工程研究所 A kind of skin Nano satellite attitude acquisition method based on magnetometer
CN110440796A (en) * 2019-08-19 2019-11-12 哈尔滨工业大学 Pipe robot positioning device and method based on rotating excitation field and inertial navigation fusion
CN111158055A (en) * 2019-12-31 2020-05-15 浙江大学 Three-dimensional magnetic source dynamic detection system and detection method
CN113834483A (en) * 2021-11-23 2021-12-24 北京航空航天大学 Inertial/polarization/geomagnetic fault-tolerant navigation method based on observability degree
CN115096294A (en) * 2022-05-30 2022-09-23 吉林大学 Multi-parameter underwater magnetic target body positioning method
CN115542225A (en) * 2022-10-12 2022-12-30 中国科学院国家空间科学中心 Correction method for improving magnetic measurement precision of suspension wire torsion balance device

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2523753C1 (en) * 2013-01-09 2014-07-20 Федеральное государственное бюджетное образовательное учреждение высшего профессионального образования "Саратовский государственный технический университет имени Гагарина Ю.А." (СГТУ имени Гагарина Ю.А.) Method of personal autonomous navigation
CN108089434A (en) * 2017-12-11 2018-05-29 北京控制工程研究所 A kind of skin Nano satellite attitude acquisition method based on magnetometer
CN110440796A (en) * 2019-08-19 2019-11-12 哈尔滨工业大学 Pipe robot positioning device and method based on rotating excitation field and inertial navigation fusion
CN111158055A (en) * 2019-12-31 2020-05-15 浙江大学 Three-dimensional magnetic source dynamic detection system and detection method
CN113834483A (en) * 2021-11-23 2021-12-24 北京航空航天大学 Inertial/polarization/geomagnetic fault-tolerant navigation method based on observability degree
CN115096294A (en) * 2022-05-30 2022-09-23 吉林大学 Multi-parameter underwater magnetic target body positioning method
CN115542225A (en) * 2022-10-12 2022-12-30 中国科学院国家空间科学中心 Correction method for improving magnetic measurement precision of suspension wire torsion balance device

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
叶建成等: "航天器内部磁场环境主动补偿方法", 空间科学学报, vol. 40, no. 1, 31 December 2020 (2020-12-31) *
高东等: "一种地磁/惯性深度融合导航方法", 中国惯性技术学报, vol. 30, no. 4, 31 August 2022 (2022-08-31) *

Similar Documents

Publication Publication Date Title
CN110779521A (en) Multi-source fusion high-precision positioning method and device
CN109556631B (en) INS/GNSS/polarization/geomagnetic combined navigation system alignment method based on least squares
CN113203418B (en) GNSSINS visual fusion positioning method and system based on sequential Kalman filtering
CN107796391A (en) A kind of strapdown inertial navigation system/visual odometry Combinated navigation method
CN110514203B (en) Underwater integrated navigation method based on ISR-UKF
CN104729506A (en) Unmanned aerial vehicle autonomous navigation positioning method with assistance of visual information
JP4412381B2 (en) Direction detection device
CN113551668B (en) Spacecraft inertia/star starlight vector/starlight refraction combined navigation method
CN103674021A (en) Integrated navigation system and method based on SINS (Strapdown Inertial Navigation System) and star sensor
CN108151737A (en) A kind of unmanned plane bee colony collaborative navigation method under the conditions of the mutual observed relationships of dynamic
CN109612460B (en) Plumb line deviation measuring method based on static correction
CN111156986B (en) Spectrum red shift autonomous integrated navigation method based on robust adaptive UKF
CN109000639B (en) Attitude estimation method and device of multiplicative error quaternion geomagnetic tensor field auxiliary gyroscope
CN111856536A (en) GNSS/INS tight combination positioning method based on inter-system difference wide-lane observation
CN103278165A (en) Remanence-calibration-based autonomous navigation method of magnetic survey and starlight backup based on
CN108151765B (en) Positioning and attitude measuring method for online real-time estimation and compensation of magnetometer error
CN110887472B (en) Polarization-geomagnetic information deep fusion fully-autonomous attitude calculation method
CN110887476B (en) Autonomous course and attitude determination method based on polarization-astronomical included angle information observation
Wang et al. An adaptive multiple backtracking UKF method based on Krein space theory for marine vehicles alignment process
Wang et al. Land vehicle navigation using odometry/INS/vision integrated system
CN117320148A (en) Multi-source data fusion positioning method, system, electronic equipment and storage medium
CN116429096A (en) Geomagnetic inertial fusion navigation method and geomagnetic inertial fusion navigation system
CN116026324A (en) Cross-domain navigation system and method for water-air cross-medium craft
CN114397480B (en) Acoustic Doppler velocimeter error estimation method, device and system
CN105841717B (en) A kind of Strapdown Inertial Navigation System course error rapid correction 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