CN107367276A - A kind of INS profile constraints series terrain matching algorithm - Google Patents
A kind of INS profile constraints series terrain matching algorithm Download PDFInfo
- Publication number
- CN107367276A CN107367276A CN201710425792.0A CN201710425792A CN107367276A CN 107367276 A CN107367276 A CN 107367276A CN 201710425792 A CN201710425792 A CN 201710425792A CN 107367276 A CN107367276 A CN 107367276A
- Authority
- CN
- China
- Prior art keywords
- matching
- positioning
- ins
- terrain
- information
- 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
Links
- 238000000034 method Methods 0.000 claims abstract description 20
- 230000006978 adaptation Effects 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 2
- 230000008878 coupling Effects 0.000 abstract 1
- 238000010168 coupling process Methods 0.000 abstract 1
- 238000005859 coupling reaction Methods 0.000 abstract 1
- 230000003068 static effect Effects 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 4
- 238000001914 filtration Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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
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)
- Radar Systems Or Details Thereof (AREA)
Abstract
The present invention relates to a kind of INS profile constraints series terrain matching algorithm, step：(1) continuous terrain match positioning is carried out using conventional sequence terrain match algorithm；(2) INS positioning and terrain match positioning result in storage matching position fixing process；(3) after the continuous coupling positioning more than once, using INS profile constraints method proposed by the present invention, matching criterior is collectively formed by elevation statics correlation and trajectory shape correlation, carries out follow-up terrain match positioning.The present invention forms trajectory shape by using multiple matching, can effectively suppress the positioning jump problem in terrain match.
Description
Technical Field
The invention relates to an INS track constraint sequence terrain matching algorithm, and belongs to the technical field of navigation.
Background
In an INS-based navigation system, due to the characteristic of INS error accumulation over time, other navigation methods are usually required to be periodically corrected, and sequence terrain matching algorithms represented by TERCOM algorithm (see Golden J p. terrain navigation (TERCOM): a cruise mission knowledge aid J. Image processing for missing knowledge 1980,238:10-18.), ICCP algorithm (see kernel W, Lei Y, Wei D, et al.
The sequence terrain matching algorithm has the advantages of simple application and reliable performance, and has the defects of low average positioning precision of the algorithm and easy jumping problem in the continuous positioning process. The jump problem means that after multiple matching locations, the estimated location is close to the real location, but a certain matching location after that suddenly generates a larger error. The source of the jump problem is the relative independence of the terrain matching, i.e. there is no necessary link between the positioning errors of any two terrain matches.
In order to improve the positioning accuracy of terrain matching, numerous algorithms, such as feature matching, particle filtering, etc., are proposed. Although the positioning accuracy is effectively improved by the algorithm, the corresponding calculated amount is greatly increased, and the practical engineering application is severely restricted. The method for directly combining the sequence terrain matching and INS positioning results by utilizing Kalman filtering is a method for utilizing INS information, but due to the lack of a real-time effective estimation method for terrain matching errors, optimal combination cannot be realized by filtering, and the problem of positioning jump cannot be restrained.
Disclosure of Invention
The invention solves the problems: the method solves the problem of positioning jump easily occurring in the existing sequence terrain matching algorithm, ensures the integral convergence of positioning errors, thereby improving the terrain matching positioning precision, and has simple and convenient calculation and convenient application.
The technical points of the invention are as follows:
1. track shape calculation method
Variables O and X represent INS positioning and terrain matching positioning respectively, and the k-th INS and matching positioning result can be represented as O respectivelyk＝(Ok,x,Ok,y)TAnd Xk＝(Xk,x,Xk,y)T. Between the kth and the kth-1 positioning, the trajectory shape information provided by the INS may be represented as Ok-Xk-1The track shape information given by terrain matching can be represented as Xk-Xk-1。
If statistics are counted from the first matching, the track shape information provided by the INS may be represented as the track shape information by the kth matching
Wherein,represents the INS shape information accumulated between the m-th match and the k-th match.
If statistics are counted from the first matching, the track shape information provided by the terrain matching can be represented as the track shape information by the k-th matching
SM＝[Δk，1… Δk，k-2Δk，k-1](2)
Wherein, Deltak,m＝Xk-XmAnd represents the matching shape information accumulated between the m-th matching to the k-th matching.
2. Matching criterion calculation method
(1) If the measurement high program column is eMThe elevation sequence obtained at the search position (i, j) is eS(i,j)，The correlation value of the elevation sequence can be expressed as
ED(i,j)＝f[eM,eS(i,j)](3)
(2) If the current matching is the k-th matching, the track shape information S provided by the INSIAs shown in equation (1), at the search position (i, j), the terrain matches the provided track shape information SM(i, j) the formula (2) wherein X iskIs replaced by Xk(i, j). The correlation value of the track shape is
SD(i,j)＝||SM(i,j)-SI|| (4)
(3) The comprehensive judgment index is
Φ(i,j)＝ED(i,j)+KS×SD(i,j) (5)
In the formula KSDetermining the trust level of INS information if the shape information SMAnd SIIn meters, then KS2-10 can be taken.
3. Queue structure storing positioning information
And setting the queue length N, and only using the track shape formed by N matching results before the current matching position, thereby ensuring the timeliness of the information. And when the aircraft enters the adaptation area and starts continuous matching and positioning, respectively storing the INS and the matching and positioning information by using the queue, and recording the current matching and positioning times n. When N is less than N, only using the first N data of the queue in the INS track constraint method; when N > N, then the queue full information is used in the INS trajectory constraint method. N may generally take an integer of around 5.
4. Attenuation factor to improve information timeliness
The attenuation factor enables the algorithm to mainly improve the tracking performance of a track shape sequence formed by the nearest point column, reduces the influence of old information and enables the algorithm to be sensitive. The track shape correlation value after the attenuation factor is introduced is
SD(i,j)＝||α(SM(i,j)-SI)|| (6)
Wherein α ═ diag { λN-1,λN-2…, λ,1, which is the attenuation factor diagonal weighting matrix, 0 < λ < 1.
The technical scheme of the invention is as follows: an INS trajectory constraint sequence terrain matching algorithm comprises the following steps:
(1) after the aircraft enters the adaptation area, after each matching positioning, the INS positioning and matching positioning information is respectively stored by using a queue with the length of N, and the matching times are recorded.
(2) And when the next matching is carried out, on one hand, the elevation sequence correlation value ED is calculated according to a sequence terrain matching algorithm, and on the other hand, the track shape correlation value SD is calculated according to the current matching times by utilizing the positioning information stored in the queue. And forming a comprehensive judgment criterion phi by the elevation sequence correlation value and the track shape correlation value, and searching the optimal matching value in the search window to serve as a matching positioning point.
(3) And updating the queue information, and correcting the INS by using the matching positioning result.
In the step (1), the length N of the queue structure is generally 5.
The track shape correlation value calculating method in the step (2) is that SD (i, j) | | | α (S)M(i,j)-SI)||，SMInformation on the shape of the track provided by terrain matching, SIRepresenting the trajectory shape information provided by the INS, α is a damping factor diagonal weighting matrix.
The method for calculating the comprehensive judgment criterion in the step (2) comprises the following steps: Φ (i, j) ═ ED (i, j) + KS× SD (i, j), where KSFor adjusting the factor, if the shape information SMAnd SIIn meters, then KS2-10 can be taken.
Compared with the prior art, the invention has the advantages that:
(1) the method is improved on the basis of the traditional sequence terrain matching algorithm, has small calculation and storage amount and is easy to realize in engineering.
(2) The invention adopts an INS track constraint method, utilizes the characteristic of higher precision in the short term of INS positioning, and utilizes the track shape to constrain positioning jump, thereby improving the precision and stability of the terrain matching algorithm.
(3) And a queue storage and attenuation factor method is adopted, and the real-time performance and the effectiveness of the information are ensured by using positioning results which are nearest to the current positioning moment.
Drawings
FIG. 1 is a flow chart of an embodiment of the matching scheme of the present invention;
FIG. 2 is a flow chart of an INS trajectory constraint method proposed by the present invention.
Detailed Description
As shown in fig. 1, the present invention is specifically implemented as follows:
(1) location information storage
And after the aircraft enters the adaptation area, recording the matching time t as 0, and after each matching positioning, recording the matching time t as t + 1. And initializing two queues with the length of N, wherein the queues are respectively used for storing INS positioning information before each matching positioning and storing the matching positioning information after the matching positioning.
(2) Trajectory constraint matching
If t is 0, namely the first matching, the traditional sequence terrain matching algorithm is directly used for positioning and INS correction.
If t is greater than 0, an INS trajectory constraint matching algorithm is adopted, as shown in fig. 2, specifically:
firstly, according to the current matching times, calculating the track shape information S provided by the INS by using the INS and the matching positioning information stored in the queueIAnd the reference is used as the track shape reference.
Secondly, according to a traditional sequence terrain matching algorithm, windowing is carried out according to a 3 sigma criterion and the position in a search window is traversed according to the positioning error. When traversing the position (i, j) in the window, on the one hand, the elevation sequence correlation value ED (i, j) is calculated and, on the other hand, the track shape information S matching the position is calculatedM(i, j) and calculating it from the reference SIThe track shape correlation value SD (i, j). The two are combined to obtain a comprehensive judgment index phi (i, j).
And finally, selecting the position with the minimum phi value in the window as an optimal matching point, updating queue information, and performing INS correction.
(3) Waiting for the next match until the vehicle leaves the match area.
The above examples are provided only for the purpose of describing the present invention, and are not intended to limit the scope of the present invention. The scope of the invention is defined by the appended claims. Various equivalent substitutions and modifications can be made without departing from the spirit and principles of the invention, and are intended to be within the scope of the invention.
Claims (4)
1. An INS trajectory constraint sequence terrain matching algorithm is characterized by comprising the following steps:
(1) after the aircraft enters the adaptation area, after each matching positioning, the INS positioning and matching positioning information is respectively stored by using a queue with the length of N, and the matching times are recorded.
(2) In the next matching, on one hand, according to the traditional sequence terrain matching algorithm, the elevation sequence correlation value ed (elevation difference) is calculated, and on the other hand, according to the current matching times, the track shape correlation value sd (shape difference) is calculated by using the positioning information stored in the queue.
(3) And forming a comprehensive judgment criterion phi by the elevation sequence correlation value and the track shape correlation value, and searching the optimal matching value in the search window to serve as a matching positioning point.
(4) And updating the queue information, and correcting the INS by using the matching positioning result.
2. The one-dimensional terrain matching algorithm based on the trajectory constraint method as recited in claim 1, wherein: in the step (1), the structure for storing the positioning information is a queue, and the length N may be an integer of about 5.
3. The one-dimensional terrain matching algorithm based on the track constraint method as recited in claim 1, wherein the track shape correlation value in the step (2) is calculated by using SD (i, j) | | α (S)M(i,j)-SI)||，SMInformation on the shape of the track provided by terrain matching, SIRepresenting the trajectory shape information provided by the INS, α is a damping factor diagonal weighting matrix.
4. The one-dimensional terrain matching algorithm based on the trajectory constraint method as recited in claim 1, wherein: the method for calculating the comprehensive judgment criterion in the step (3) comprises the following steps: Φ (i, j) ═ ED (i, j) + KS× SD (i, j), where KSFor adjusting the factor, if the shape information SMAnd SIIn meters, then KS2-10 can be taken.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710425792.0A CN107367276B (en) | 2017-06-08 | 2017-06-08 | Terrain matching algorithm for INS (inertial navigation System) track constraint sequence |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710425792.0A CN107367276B (en) | 2017-06-08 | 2017-06-08 | Terrain matching algorithm for INS (inertial navigation System) track constraint sequence |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107367276A true CN107367276A (en) | 2017-11-21 |
| CN107367276B CN107367276B (en) | 2022-02-18 |
Family
ID=60305477
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710425792.0A Active CN107367276B (en) | 2017-06-08 | 2017-06-08 | Terrain matching algorithm for INS (inertial navigation System) track constraint sequence |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107367276B (en) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20050063610A1 (en) * | 2003-09-18 | 2005-03-24 | Donghui Wu | Edge based alignment algorithm |
| US20070010940A1 (en) * | 2005-07-05 | 2007-01-11 | Containertrac, Inc. | Automatic past error corrections for location and inventory tracking |
| CN101339036A (en) * | 2008-08-20 | 2009-01-07 | 北京航空航天大学 | Terrain auxiliary navigation method and apparatus |
| CN101819044A (en) * | 2009-02-26 | 2010-09-01 | 爱信艾达株式会社 | Guider and navigation program |
| CN102426018A (en) * | 2011-08-19 | 2012-04-25 | 北京航空航天大学 | Terrain auxiliary navigation method based on mixed terrain contour matching TERCOM algorithm and particle filtering |
| CN102809376A (en) * | 2012-08-06 | 2012-12-05 | 哈尔滨工程大学 | Isoline-based assistant navigation positioning method |
| CN106643714A (en) * | 2017-03-15 | 2017-05-10 | 北京航空航天大学 | Autonomous real-time airborne terrain-aided inertial navigation method and system |
-
2017
- 2017-06-08 CN CN201710425792.0A patent/CN107367276B/en active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20050063610A1 (en) * | 2003-09-18 | 2005-03-24 | Donghui Wu | Edge based alignment algorithm |
| US20070010940A1 (en) * | 2005-07-05 | 2007-01-11 | Containertrac, Inc. | Automatic past error corrections for location and inventory tracking |
| CN101339036A (en) * | 2008-08-20 | 2009-01-07 | 北京航空航天大学 | Terrain auxiliary navigation method and apparatus |
| CN101819044A (en) * | 2009-02-26 | 2010-09-01 | 爱信艾达株式会社 | Guider and navigation program |
| CN102426018A (en) * | 2011-08-19 | 2012-04-25 | 北京航空航天大学 | Terrain auxiliary navigation method based on mixed terrain contour matching TERCOM algorithm and particle filtering |
| CN102809376A (en) * | 2012-08-06 | 2012-12-05 | 哈尔滨工程大学 | Isoline-based assistant navigation positioning method |
| CN106643714A (en) * | 2017-03-15 | 2017-05-10 | 北京航空航天大学 | Autonomous real-time airborne terrain-aided inertial navigation method and system |
Non-Patent Citations (2)
| Title |
|---|
| METZGER, J 等: "Adaptations of a comparison technique for terrain navigation", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
| 张红伟: "基于ICCP算法的水下潜器地形辅助定位改进方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107367276B (en) | 2022-02-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110006423B (en) | Self-adaptive inertial navigation and visual combined navigation method | |
| CN112632202B (en) | Dynamic map matching method based on high-order hidden Markov model | |
| CN111507906B (en) | Method and apparatus for debouncing with neural networks for fault tolerance and surge robustness | |
| CN106772351B (en) | Kalman filter method based on the memory of limited step | |
| CN103776449B (en) | A kind of initial alignment on moving base method that improves robustness | |
| EP2867616A2 (en) | Wide beam sar focusing method using navigation solution derived from autofocus data | |
| CN107192375A (en) | A kind of unmanned plane multiple image adaptive location bearing calibration based on posture of taking photo by plane | |
| CN107367276B (en) | Terrain matching algorithm for INS (inertial navigation System) track constraint sequence | |
| CN114567288B (en) | Distribution collaborative nonlinear system state estimation method based on variable decibels | |
| CN113375663A (en) | Multi-source information fusion self-adaptive navigation method based on performance estimation | |
| CN108469609B (en) | Detection information filtering method for radar target tracking | |
| CN114323007A (en) | Carrier motion state estimation method and device | |
| CN111160594B (en) | Method and device for estimating arrival time and storage medium | |
| CN109375160B (en) | Angle measurement error estimation method in pure-azimuth passive positioning | |
| CN117111641A (en) | Unmanned aerial vehicle route deviation rectifying method, device, equipment and storage medium | |
| CN117291295A (en) | JMIMUA-BiGRU ship track prediction method and system based on improved whale algorithm | |
| CN111896002B (en) | Terrain-assisted navigation matching area online planning and suitability analysis method and system | |
| US20230078005A1 (en) | Navigation assistance method for a mobile carrier | |
| CN113624219A (en) | Magnetic compass ellipse fitting error compensation method based on OPTICS algorithm | |
| CN114519255A (en) | Vehicle track prediction method, device and storage medium | |
| CN115014321A (en) | Bionic polarization multi-source fusion orientation method based on adaptive robust filtering | |
| CN110712768B (en) | Method for determining initial frame position of control moment gyro group | |
| Chen et al. | Tendency-based approach for link travel time estimation | |
| US9372719B2 (en) | Information processing device for correcting procedure | |
| CN108332751B (en) | Multi-source fusion positioning method and device, electronic equipment and storage medium |
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 |