CN113280811A - Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data - Google Patents

Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data Download PDF

Info

Publication number
CN113280811A
CN113280811A CN202110496775.2A CN202110496775A CN113280811A CN 113280811 A CN113280811 A CN 113280811A CN 202110496775 A CN202110496775 A CN 202110496775A CN 113280811 A CN113280811 A CN 113280811A
Authority
CN
China
Prior art keywords
terrain
resolution
area
inertial navigation
data
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.)
Granted
Application number
CN202110496775.2A
Other languages
Chinese (zh)
Other versions
CN113280811B (en
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.)
Beihang University
Original Assignee
Beihang University
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 Beihang University filed Critical Beihang University
Priority to CN202110496775.2A priority Critical patent/CN113280811B/en
Publication of CN113280811A publication Critical patent/CN113280811A/en
Application granted granted Critical
Publication of CN113280811B publication Critical patent/CN113280811B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/165Navigation; 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 combined with non-inertial navigation instruments

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

The invention discloses a self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data, which comprises the following steps: (1) configuring terrain database information with different resolutions in a flight area through a configuration file; (2) the method comprises the steps that a flight carrier obtains terrain elevation data of the highest resolution in real time in the process of executing a flight task according to terrain database information described in a configuration file; (3) and adaptively adjusting filtering parameters and executing an adaptive terrain-assisted inertial navigation algorithm according to the highest resolution of the terrain data of the region where the current flight carrier is located. The self-adaptive terrain-assisted inertial navigation method provided by the invention can enable the carrier to adopt terrain elevation data with different resolutions aiming at different flight areas in the flight process, thereby improving the adaptability of the terrain-assisted navigation algorithm and improving the performance of the terrain-assisted navigation algorithm to the greatest extent.

Description

Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data
Technical Field
The invention relates to the technical field of navigation and positioning, in particular to a self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data.
Background
The technology of Terrain Assisted Navigation (TAN) is generated in the late 50 s of the 40 s of the 20 th century, and due to the advantages of autonomy, concealment, strong anti-interference capability and all-weather work, the TAN is widely valued and researched in a combined Navigation system and is successfully applied to cruise missiles, airplanes and ships. The current main terrain aided navigation algorithms comprise two types, one type is TERCOM (Tertain Container matching) terrain Contour matching algorithm based on batch processing technology; the other type is a sitan (san ia inertia Terrain Aided navigation) Terrain Aided navigation algorithm based on Terrain linearization and kalman filtering technology.
During the period of 'eighty-five', the university of Beijing aerospace has made intensive research on the theory and algorithm of Terrain-assisted navigation, and developed the BITAN (Beihang inertia Tertain Aided navigation) algorithm on the basis of SITAN. Compared with SITAN, BITAN has higher real-time performance and reliability, so that BITAN is widely applied to the field of terrain-assisted navigation and positioning. However, the currently mainstream terrain assisted navigation algorithm only supports single-resolution terrain elevation data, and adaptive filtering parameters need to be preset according to the resolution of an adopted terrain elevation database before performing terrain assisted navigation calculation, so that the adaptability of the terrain assisted navigation algorithm is greatly limited. If the self-adaption support of the terrain elevation data with different resolutions of the carrier in the flight process can be realized, the method has important practical significance for improving the adaptability of the terrain aided navigation algorithm and improving the performance of the terrain aided navigation to the maximum extent.
Therefore, how to provide an adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain elevation data is a problem that needs to be solved by those skilled in the art.
Disclosure of Invention
In view of the above, the invention provides a self-adaptive terrain-aided inertial navigation method supporting multi-resolution terrain data, so as to solve the limitation that the current terrain-aided navigation algorithm only supports single-resolution terrain elevation data and cannot adapt to the multi-resolution terrain elevation data in a flight area.
In order to achieve the purpose, the invention adopts the following technical scheme:
the invention provides a self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data, which comprises the following steps of:
s1: configuring the terrain elevation database information with different resolutions adopted in the flight area through a configuration file;
s2: the method comprises the steps that a flight carrier obtains terrain elevation data with the highest resolution in real time in the process of executing a flight task according to terrain elevation database information described in a configuration file;
s3: and adaptively adjusting filtering parameters and executing an adaptive terrain-assisted inertial navigation algorithm according to the highest resolution of the terrain data of the region where the current flight carrier is located.
Further, in S1, configuring, by using a configuration file, terrain elevation database information of different resolutions used in the flight area, where the specific configuration information includes:
(1) the total number of terrain elevation databases with different resolutions in the flight area;
(2) absolute path information stored in each resolution terrain elevation database;
(3) the data format storage type of each resolution terrain elevation database;
(4) the data file storage type of each resolution terrain elevation database;
(5) grid resolution of each resolution terrain elevation database;
(6) the terrain elevation precision of each resolution terrain elevation database; and
(7) and the number of rows and columns of a single file in each resolution terrain elevation database.
Further, in the S2, the flight carrier acquires, in real time, the terrain elevation data of the highest resolution in the area where the carrier is located according to the terrain elevation database information described in the configuration file during the process of executing the flight mission, where the specific strategy is as follows:
and taking the position indicated by the inertial navigation system as a center, determining a minimum search range according to the length and the width of a set search area, gradually searching terrain elevation data in the current flight area of the carrier according to the information of a terrain elevation database configured in a configuration file according to the resolution, and acquiring the terrain elevation data with the highest resolution for subsequent terrain-assisted inertial navigation calculation.
Further, the adaptive terrain-assisted inertial navigation algorithm in S3 includes adaptation of the terrain adaptability analysis method and adaptation of the terrain-assisted inertial navigation algorithm.
The self-adaption of the terrain adaptability analysis method can self-adaptively adjust various parameters and indexes of the adaptability analysis aiming at terrain elevation data with different resolutions, so that the adaptability analysis conditions of terrain databases with different resolutions are adapted, and the adaptability area of the terrain adaptability analysis method is more reasonably determined;
further, a specific strategy for realizing the self-adaption of the terrain matching adaptability analysis method is as follows:
(1) setting the matching area as a planning area with fixed length and width, wherein the width is determined by taking a flight path of a flight carrier entering terrain matching as a center and taking 2-3 times of the maximum error of the inertial navigation system as a radius; the length may take the same value as the width.
(2) Calculating the number of rows and columns of the planned area and acquiring terrain elevation data in the planned area according to the size of the planned area and the terrain resolution; calculating the characteristic parameters of the terrain in the planning area, evaluating the adaptability of the terrain in the planning area by adopting the following criteria,
Figure BDA0003054736830000031
wherein σNThe ratio of the measurement noise of the radar barometer to the measurement noise of the terrain database; sigmahIs the terrain standard deviation; sigmazIs the roughness of the terrain. The terrain area satisfying the above condition (i.e., Rule ═ True) is a matchable area, and otherwise, the terrain area is an unmatchable area.
The self-adaption of the terrain auxiliary inertial navigation algorithm can self-adaptively adjust related filtering parameters aiming at terrain elevation data with different resolutions, so that the filter is adaptive to the terrain elevation data with the current resolution, the performance of the filter is more stable, and the filtering result is more reliable.
Further, the terrain-assisted navigation algorithm adopts an inertial terrain-assisted navigation BITAN algorithm, which comprises a search mode and a tracking mode.
In the search mode, a single-state parallel Kalman filter is adopted, and the state equation and the measurement equation are respectively
Figure BDA0003054736830000041
Figure BDA0003054736830000042
In the formula, k is epoch time, j is 1,2, and m is a serial number of the parallel kalman filter; δ h is a state parameter, ωkIs the process noise at epoch time k, σhSearching a process noise standard deviation of the filter; zkIs an observed quantity, gamma, at the time of k epochkObserved noise at time k epoch, σzTo measure the standard deviation of the noise; and N represents a normal distribution.
A five-state Kalman filter is adopted in the tracking mode, and the state parameters are as follows:
X=[δx δy δh δvx δvy]T (4)
in the formula, δ x, δ y, δ z are position errors in the east direction, the north direction and the sky direction respectively; delta vx,δvyEast and north velocity errors.
The state equation and the observation equation of the five-state Kalman filter are respectively as follows:
Figure BDA0003054736830000043
Figure BDA0003054736830000044
wherein F is a state transition matrix, W is a process noise vector, Q is a process noise covariance matrix,
Figure BDA0003054736830000045
is the state value, Z is the observed quantity, and H is the measurement matrix.
Further, the specific steps for realizing the terrain-assisted inertial navigation algorithm self-adaptation are as follows:
step 31: judging whether the current area of the flight carrier is a matchable area according to different resolution terrain adaptability self-adaptive analysis methods, and judging whether the resolution of a terrain elevation database of the areas where the carrier is located at the previous moment and the next moment is changed;
step 32: and if the resolution ratio of the terrain elevation database of the area where the carrier is located at the current moment is changed and the area where the carrier is located is a matchable area, re-initializing the BITAN algorithm to enter a search mode, and adjusting the variance of the process noise in the search mode and the variance of the process noise in the tracking mode according to the resolution ratio of the currently adopted terrain elevation database in the same proportion so as to be matched with the accuracy of the currently adopted terrain elevation database.
Step 33: and if the resolution of the terrain elevation database of the area where the carrier is located at the current moment is not changed, continuing to execute the BITAN algorithm.
According to the technical scheme, compared with the prior art, the performance influence of the terrain elevation data with different resolutions on the terrain auxiliary inertial navigation algorithm is considered, and the filtering parameters are adaptively adjusted according to the adopted terrain elevation data with different resolutions, so that the adaptive terrain auxiliary inertial navigation algorithm is realized. The invention can improve the adaptability of the terrain aided navigation algorithm to terrain elevation data with different resolutions, thereby solving the limitation that the existing terrain aided navigation algorithm only supports terrain elevation data with single resolution and can not adapt to multi-resolution terrain elevation data in a flight area.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to the provided drawings without creative efforts.
Fig. 1 is a flowchart of an adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain elevation data according to an embodiment of the present invention.
Fig. 2 is an illustration of profile information in an embodiment of the invention.
Fig. 3 is a specific flowchart for implementing the terrain-assisted inertial navigation algorithm adaptation according to the embodiment of the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
An adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data, as shown in fig. 1, comprises the following steps:
s1: configuring the terrain elevation database information with different resolutions adopted in the flight area through a configuration file;
specifically, as shown in fig. 2, the configuration file includes specific configuration information:
(1) the total number of terrain elevation databases with different resolutions in the flight area;
(2) absolute path information stored in each resolution terrain elevation database;
(3) the data format storage type of each resolution terrain elevation database;
(4) the data file storage type of each resolution terrain elevation database;
(5) grid resolution of each resolution terrain elevation database;
(6) the terrain elevation precision of each resolution terrain elevation database;
(7) and the number of rows and columns of a single file in each resolution terrain elevation database.
S2: the method comprises the steps that a flight carrier obtains terrain elevation data with the highest resolution in real time in the process of executing a flight task according to terrain elevation database information described in a configuration file;
specifically, the specific strategy for acquiring the terrain elevation data with the highest resolution below the carrier flight in real time according to the configuration file is as follows: and taking the position indicated by the inertial navigation system as a center, determining a minimum search range according to the length and the width of a set search area, gradually searching terrain elevation data in the current flight area of the carrier according to the information of a terrain elevation database configured in a configuration file according to the resolution, and acquiring the terrain elevation data with the highest resolution for subsequent terrain-assisted inertial navigation calculation.
S3: and adaptively adjusting filtering parameters and executing an adaptive terrain-assisted inertial navigation algorithm according to the highest resolution of the terrain data of the region where the current flight carrier is located.
Specifically, the adaptive terrain-assisted inertial navigation comprises the adaptation of a terrain adaptability analysis method and the adaptation of a terrain-assisted inertial navigation algorithm.
The specific strategy of the terrain adaptability analysis method self-adaptation is as follows:
(1) setting the matching area as an area with fixed length and width, wherein the width is determined by taking a flight path of a flight carrier entering terrain matching as a center and taking 2-3 times of the maximum error of inertial navigation as a radius; the length may take the same value as the width.
(2) Calculating the number of rows and columns of the planned area and acquiring terrain elevation data in the planned area according to the size of the planned area and the terrain resolution; calculating topographical feature parameters including elevation standard deviation σ in a planned areahAnd the height measurement signal-to-noise ratio sigmaNTopographic roughness σzAnd evaluating the terrain adaptability in the planning area by adopting the following criteria,
Figure BDA0003054736830000071
the terrain area satisfying the above condition (i.e., Rule ═ True) is a matchable area, and otherwise, the terrain area is an unmatchable area.
Elevation standard deviation sigmahThe calculation formula for describing the discrete degree of each grid point in the terrain elevation reference map and the total relief degree of the terrain in the whole area is as follows:
Figure BDA0003054736830000072
in the formula, MhThe terrain mean value is calculated by the following formula:
Figure BDA0003054736830000073
in the formula, m is the number of rows of the grid elevation reference map, n is the number of columns of the grid elevation reference map, and h (i, j) is the terrain height value of the ith row and jth column of the grid elevation reference map.
Roughness of the terrain sigmazDescribing the average smoothness of the whole terrain area, and marking finer local fluctuation, and the calculation formula is as follows:
Figure BDA0003054736830000081
in the formula, QxTopographic roughness, Q, of adjacent grids in the x-directionyThe calculation formulas of the terrain roughness of the adjacent grids in the y direction are respectively as follows:
Figure BDA0003054736830000082
Figure BDA0003054736830000083
the terrain-assisted inertial navigation algorithm employs a BITAN terrain-assisted inertial navigation algorithm that includes a search mode and a tracking mode.
Specifically, the parallel Kalman filter in single state is adopted in the search mode, and the state equation and the measurement equation are respectively
Figure BDA0003054736830000084
Figure BDA0003054736830000085
In the formula, k is epoch time, j is 1,2, and m is the serial number of the parallel filter; δ h is a state parameter, ωkFor process noise at time of k epoch, σhSearching a process noise standard deviation of the filter; zkIs the observed quantity at the time of k epoch, γ k is the observed noise at the time of k epoch, σzTo measure the standard deviation of the noise; and N represents a normal distribution.
Specifically, a five-state kalman filter is adopted in the tracking mode, and the state parameters are as follows:
X=[δx δy δh δvx δvy]T (9)
in the formula, δ x, δ y, δ z are position errors in three directions of the northeast; delta vx,δvyEast and north velocity errors.
The state equation and the observation equation of the five-state Kalman filter are respectively as follows:
Figure BDA0003054736830000091
Figure BDA0003054736830000092
wherein F is a state transition matrix, W is a process noise vector, Q is a process noise covariance matrix,
Figure BDA0003054736830000093
is a state value, Z is an observed quantityAnd H is a measurement matrix.
The expressions of the state transition matrix and the measurement matrix are respectively as follows:
Figure BDA0003054736830000094
in the formula, hxAnd hyAre the slopes in the x and y directions of the terrain obtained by a terrain stochastic linearization technique.
Specifically, a specific flow for realizing the terrain-assisted inertial navigation algorithm self-adaptation is shown in fig. 3, and includes the following steps:
step 1): judging whether the current area of the flight carrier is a matchable area or not, and judging whether the resolution of a terrain elevation database of the areas of the carrier at the previous moment and the later moment is changed or not;
step 2): if the resolution ratio of the terrain elevation database of the area where the carrier is located at the current moment is changed and the area where the carrier is located is a matchable area, the BITAN algorithm is reinitialized to enter a search mode, and the standard deviation (namely sigma) of the process noise in the search mode is adjusted in the same proportion according to the resolution ratio of the terrain elevation database adopted at the current momenth) And a matrix of variance (i.e., Q) of process noise in tracking mode to match the accuracy of the currently deployed terrain elevation database.
Step 3): and if the resolution of the terrain elevation database of the area where the carrier is located at the current moment is not changed, continuously executing the BITAN algorithm.
Those of ordinary skill in the art will understand that: all or part of the above embodiments can be implemented by program instructions or related hardware, and the program may be stored in a computer-readable storage medium, and when executed, the program performs the steps including the above embodiments; and the aforementioned storage medium includes: various media capable of storing program codes, such as a removable Memory device, a Read-Only Memory (ROM), a Random Access Memory (RAM), a magnetic disk, and an optical disk.
The embodiments in the present description are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. The device disclosed by the embodiment corresponds to the method disclosed by the embodiment, so that the description is simple, and the relevant points can be referred to the method part for description.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be applied to other embodiments without departing from the spirit or scope of the invention. Thus, the present invention is not intended to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.

Claims (7)

1. An adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data, comprising the steps of:
s1: configuring the terrain elevation database information with different resolutions adopted in the flight area through a configuration file;
s2: the method comprises the steps that a flight carrier obtains terrain elevation data with the highest resolution in real time in the process of executing a flight task according to terrain elevation database information described in a configuration file;
s3: and adaptively adjusting filtering parameters and executing an adaptive terrain-assisted inertial navigation algorithm according to the highest resolution of the terrain data of the region where the current flight carrier is located.
2. The adaptive terrain assisted inertial navigation method supporting multi-resolution terrain data according to claim 1, wherein the configuration file in S1 is used to configure the terrain elevation database information of different resolutions used in the flight area, and the specific configuration information includes:
(1) the total number of terrain elevation databases with different resolutions in the flight area;
(2) absolute path information stored in each resolution terrain elevation database;
(3) the data format storage type of each resolution terrain elevation database;
(4) the data file storage type of each resolution terrain elevation database;
(5) grid resolution of each resolution terrain elevation database;
(6) the terrain elevation precision of each resolution terrain elevation database; and
(7) and the number of rows and columns of a single file in each resolution terrain elevation database.
3. The adaptive terrain-assisted inertial navigation method supporting multiresolution terrain data as claimed in claim 1, wherein in step S2, the flight vehicle acquires the highest-resolution terrain elevation data of the area where the vehicle is located in real time according to the terrain elevation database information described in the configuration file during the execution of the flight mission, and the specific strategy is as follows:
and taking the position indicated by the inertial navigation system as a center, determining a minimum search range according to the length and the width of a set search area, gradually searching the terrain elevation data of the current area of the carrier according to the terrain elevation database information described in the configuration file from high resolution to low resolution, and acquiring the terrain elevation data with the highest resolution.
4. An adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data according to claim 1, wherein the adaptive terrain-assisted inertial navigation algorithm in S3 includes adaptation of a terrain adaptability analysis method and adaptation of a terrain-assisted inertial navigation algorithm;
the self-adaption of the terrain adaptability analysis method can self-adaptively adjust various parameters and indexes of the adaptability analysis aiming at terrain elevation data with different resolutions, so that the adaptability analysis conditions of terrain databases with different resolutions are adapted, and the adaptability area of the terrain adaptability analysis method is more reasonably determined;
the self-adaption of the terrain auxiliary inertial navigation algorithm can self-adaptively adjust related filtering parameters aiming at terrain elevation data with different resolutions, so that the filter is adaptive to the terrain elevation data with the current resolution, the performance of the filter is more stable, and the filtering result is more reliable.
5. The adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data according to claim 4, wherein the specific strategy for realizing the adaptation of the terrain adaptability analysis method is as follows:
(1) setting the matching area as a planning area with fixed length and width, wherein the width is determined by taking a flight path of a flight carrier entering terrain matching as a center and taking 2-3 times of the maximum error of the inertial navigation system as a radius; the length is equal to the width;
(2) calculating the number of rows and columns of the planned area and acquiring terrain elevation data in the planned area according to the size of the planned area and the terrain resolution; calculating the characteristic parameters of the terrain in the planning area, evaluating the adaptability of the terrain in the planning area by adopting the following criteria,
Figure FDA0003054736820000021
wherein σNThe ratio of the measurement noise of the radar barometer to the measurement noise of the terrain database; sigmahIs the terrain standard deviation; sigmazFor the terrain roughness, the terrain area satisfying the condition Rule ═ True is a matchable area, otherwise, the terrain area is a non-matchable area.
6. The adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data according to claim 5, wherein the terrain-assisted navigation algorithm employs an inertial terrain-assisted navigation BITAN algorithm, the algorithm comprising a search mode and a tracking mode;
in the search mode, a single-state parallel Kalman filter is adopted, and the state equation and the measurement equation are respectively as follows:
Figure FDA0003054736820000031
Figure FDA0003054736820000032
in the formula, k is epoch time, j is 1,2, and m is a serial number of the parallel kalman filter; δ h is a state parameter, ωkFor process noise at time of k epoch, σhSearching a process noise standard deviation of the filter; zkIs an observed quantity, gamma, at the time of k epochkObserved noise at time k epoch, σzTo measure the standard deviation of the noise; n represents a normal distribution;
a five-state Kalman filter is adopted in the tracking mode, and the state parameters are as follows:
X=[δx δy δh δvx δvy]T (4)
in the formula, δ x, δ y, δ z are position errors in the east direction, the north direction and the sky direction respectively; delta vx,δvyVelocity errors for east and north;
the state equation and the observation equation of the five-state Kalman filter are respectively as follows:
Figure FDA0003054736820000033
Figure FDA0003054736820000034
wherein F is a state transition matrix, W is a process noise vector, Q is a process noise covariance matrix,
Figure FDA0003054736820000035
is the state value, Z is the observed quantity, and H is the measurement matrix.
7. The adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data according to claim 6, wherein the specific steps for realizing the adaptation of the terrain-assisted inertial navigation algorithm are as follows:
step 31: judging whether the current area of the flight carrier is a matchable area according to different resolution terrain adaptability self-adaptive analysis methods, and judging whether the resolution of a terrain elevation database of the areas where the carrier is located at the previous moment and the next moment is changed;
step 32: if the resolution ratio of the terrain elevation database of the area where the carrier is located at the current moment is changed and the area where the carrier is located is a matchable area, the BITAN algorithm is reinitialized to enter a search mode, and the variance of the process noise in the search mode and the variance of the process noise in the tracking mode are adjusted in the same proportion according to the resolution ratio of the currently adopted terrain elevation database, so that the process noise is matched with the accuracy of the currently adopted terrain elevation database;
step 33: and if the resolution of the terrain elevation database of the area where the carrier is located at the current moment is not changed, continuing to execute the BITAN algorithm.
CN202110496775.2A 2021-05-07 2021-05-07 Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data Active CN113280811B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110496775.2A CN113280811B (en) 2021-05-07 2021-05-07 Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110496775.2A CN113280811B (en) 2021-05-07 2021-05-07 Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data

Publications (2)

Publication Number Publication Date
CN113280811A true CN113280811A (en) 2021-08-20
CN113280811B CN113280811B (en) 2023-03-21

Family

ID=77278132

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110496775.2A Active CN113280811B (en) 2021-05-07 2021-05-07 Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data

Country Status (1)

Country Link
CN (1) CN113280811B (en)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5272639A (en) * 1992-01-14 1993-12-21 Honeywell Inc. Terrain referenced navigation electromagnetic-gravitational correlation
US5331562A (en) * 1992-01-16 1994-07-19 Honeywell Inc. Terrain referenced navigation-adaptive filter distribution
US20050273257A1 (en) * 2004-06-03 2005-12-08 Hager James R Methods and systems for enhancing accuracy of terrain aided navigation systems
CN101339036A (en) * 2008-08-20 2009-01-07 北京航空航天大学 Terrain auxiliary navigation method and apparatus
US20120022784A1 (en) * 2010-06-25 2012-01-26 Thales Navigation filter for a navigation system using terrain correlation
CN106643714A (en) * 2017-03-15 2017-05-10 北京航空航天大学 Autonomous real-time airborne terrain-aided inertial navigation method and system
CN107314768A (en) * 2017-07-06 2017-11-03 上海海洋大学 Underwater terrain matching aided inertial navigation localization method and its alignment system
CN109029434A (en) * 2018-06-29 2018-12-18 电子科技大学 Based on the Sang Diya inertia terrain auxiliary navigation method pushed away under adaptive scale
CN111896002A (en) * 2020-07-22 2020-11-06 北京航空航天大学 Method and system for online planning and adaptability analysis of terrain-assisted navigation matching area

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5272639A (en) * 1992-01-14 1993-12-21 Honeywell Inc. Terrain referenced navigation electromagnetic-gravitational correlation
US5331562A (en) * 1992-01-16 1994-07-19 Honeywell Inc. Terrain referenced navigation-adaptive filter distribution
US20050273257A1 (en) * 2004-06-03 2005-12-08 Hager James R Methods and systems for enhancing accuracy of terrain aided navigation systems
CN101339036A (en) * 2008-08-20 2009-01-07 北京航空航天大学 Terrain auxiliary navigation method and apparatus
US20120022784A1 (en) * 2010-06-25 2012-01-26 Thales Navigation filter for a navigation system using terrain correlation
CN106643714A (en) * 2017-03-15 2017-05-10 北京航空航天大学 Autonomous real-time airborne terrain-aided inertial navigation method and system
CN107314768A (en) * 2017-07-06 2017-11-03 上海海洋大学 Underwater terrain matching aided inertial navigation localization method and its alignment system
CN109029434A (en) * 2018-06-29 2018-12-18 电子科技大学 Based on the Sang Diya inertia terrain auxiliary navigation method pushed away under adaptive scale
CN111896002A (en) * 2020-07-22 2020-11-06 北京航空航天大学 Method and system for online planning and adaptability analysis of terrain-assisted navigation matching area

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
徐振烊等: "水下地形辅助导航适宜地图分辨率的选取", 《水下无人系统学报》 *
程传奇等: "基于改进型MAD算法的地形辅助惯性导航", 《电子测量技术》 *
赵龙 等: "不同传感器精度下的地磁轮廓匹配定位性能分析", 《物理学报》 *
赵龙: "鲁棒惯性地形辅助导航算法研究", 《物理学报》 *

Also Published As

Publication number Publication date
CN113280811B (en) 2023-03-21

Similar Documents

Publication Publication Date Title
CN110146909B (en) Positioning data processing method
CN108931245A (en) The local method for self-locating and equipment of mobile robot
CN106643714B (en) A kind of autonomous airborne profile aided inertial navigation method and system in real time
EP1524500B1 (en) Method for planning a trajectory
CN102096086B (en) Self-adaptive filtering method based on different measuring characteristics of GPS (Global Positioning System)/INS (Inertial Navigation System) integrated navigation system
CN103379619A (en) Method and system for positioning
CN108896040B (en) Inertia/gravity combined navigation method and system for sky-sea integrated underwater vehicle
CN113252038B (en) Course planning terrain auxiliary navigation method based on particle swarm optimization
CN111238467A (en) Bionic polarized light assisted unmanned combat aircraft autonomous navigation method
US11465782B2 (en) Systems and methods for autonomous deorbiting of a spacecraft
CN107123134A (en) A kind of Dangerous Rock Body landslide monitoring method of feature based
Wang et al. Matching error of the iterative closest contour point algorithm for terrain-aided navigation
CN111895995B (en) PSO-based aircraft formation multidimensional geomagnetic matching navigation method and system
CN101806905A (en) Navigation positioning method and device for agricultural machines
CN116642482A (en) Positioning method, equipment and medium based on solid-state laser radar and inertial navigation
CN111854769A (en) Pose data processing method and device, map generation equipment and storage medium
CN115265532A (en) Auxiliary filtering method for marine integrated navigation
CN113252039B (en) Terrain-assisted navigation-oriented particle swarm fast matching method
CN113280811B (en) Self-adaptive terrain-assisted inertial navigation method supporting multi-resolution terrain data
CN111896002B (en) Terrain-assisted navigation matching area online planning and suitability analysis method and system
CN117872416A (en) Positioning calibration method, positioning calibration device, computer equipment and storage medium
CN113465616B (en) Track abnormal point detection method and device, electronic equipment and storage medium
CN111174974B (en) Vehicle suspension heave measurement method and system
CN117268395B (en) Unmanned aerial vehicle map matching position jump suppression method
Zhang et al. A robust particle filter for ambiguous updates of underwater terrain-aided navigation

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