CN102128625A - Initial matching method for use in gravimetric map matching in gravity-aided inertial navigation system - Google Patents

Initial matching method for use in gravimetric map matching in gravity-aided inertial navigation system Download PDF

Info

Publication number
CN102128625A
CN102128625A CN 201010592977 CN201010592977A CN102128625A CN 102128625 A CN102128625 A CN 102128625A CN 201010592977 CN201010592977 CN 201010592977 CN 201010592977 A CN201010592977 A CN 201010592977A CN 102128625 A CN102128625 A CN 102128625A
Authority
CN
China
Prior art keywords
inertial navigation
carrier
gravity
coupling
initial matching
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
CN 201010592977
Other languages
Chinese (zh)
Other versions
CN102128625B (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 CN201010592977A priority Critical patent/CN102128625B/en
Publication of CN102128625A publication Critical patent/CN102128625A/en
Application granted granted Critical
Publication of CN102128625B publication Critical patent/CN102128625B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

The invention discloses an initial matching method for use in gravimetric map matching in a gravity-aided inertial navigation system, which comprises: according to the characteristic of high short-term measurement precision of the inertial navigation system, building a geometric constraint model by using three parameters, namely running distance information L1 and L2, which are acquired by the inertial navigation system at adjacent moments t1 and t2 and t2 and t2, of a carrier body and relative steering angle theta at the moment t2 of the carrier body; and obtaining the initial value of the gravimetric map matching by according to isolines C1, C2 and C3 corresponding to the gravity values measured by a gravity sensor at the moments t1, t2 and t3 and according to a geometric constraint isoline matching algorithm. The method is an automatic initial matching method and has the characteristics of high precision and high robustness. The method can be used for initial matching in a passive navigation system such as landform/ geomagnetism/gravity-aided inertial navigation systems.

Description

The initial matching method of gravimetric map coupling in the gravity aided inertial navigation system
Technical field
The present invention relates to the initial matching method of gravimetric map coupling in the gravity aided inertial navigation system, be primarily aimed at the initial matching method of gravimetric map matching algorithm in the gravity aided inertial navigation.
Background technology
With regard to the passive airmanship of earth physical field aided inertial navigation, be not a fresh problem, early start be the landform aided inertial navigation research of land, and obtain tangible achievement beginning of the eighties late 1970s.In recent years, by the geodetic surveying technological achievement, the theory and the method for inertia/gravity, the passive integrated navigation of inertia/earth magnetism have caused domestic and international research institution and scholar's attention equally, have carried out Study on Technology such as the navigation of gravity coupling, the navigation of earth magnetism coupling in succession.The normal method that adopts of the technology of gravity aided inertial navigation is to continue to use the correlation technique of terrain match mostly at present, mainly contains SITAN algorithm, TERCOM algorithm etc.No matter be the SITAN algorithm, or the TERCOM algorithm, its basic procedure all is to measure geophysics field data on the carrier movement locus in real time by the sensor that carries on the carrier; Simultaneously, the carrier positional information that provides according to inertial navigation system, from navigation with obtaining the geophysics field data the reference to gravitational figure; Then this two group data set is given coupling and resolved computing machine, utilize matching algorithm to determine the best match position of carrier.
The data set matching problem can be traced back to the remote Sensing Image Analysis of later 1950s the earliest, Hobrough has carried out similarity analysis to the remote sensing analog image first at that time, the notion of images match has been proposed, to six the seventies, the research method of data set coupling is mostly based on the feature extraction to image, as, the quick Fourier transformation of Anuta (FFT) method, but,, make that the information of data set can not obtain reflection fully when feature extraction owing to extract the restriction of characterization method.Up to early eighties, Lucas has provided a kind of iterative algorithm at video image coupling, because this method directly searches at image data set, so the method for Lucas kept the character of image fully, thereby guaranteed the accuracy of coupling.To the early 1990s, Chen and Medioni, people such as Besl and McKay and Zhang rises to various concrete matching problems the matching problem between the data set respectively on the working foundation of Lucas, and ICP (the Iterated Closest Point that has independently proposed to find the solution the data set matching problem, be called for short: ICP) algorithm, especially the work of Besl and McKey has become a basis of data set matching problem, the ICP method has also become the general approach of finding the solution the data set matching problem and has been widely adopted, and has been widely used in gravimetric map (topomap/magnetic map) coupling of geophysical field aided inertial navigation.
The ICP algorithm is the research about global convergence, can can both work in any initial position error condition in theory, and in actual applications because the influence of the factors such as selection of objective function, corresponding relation selection, alternative types and initial position, nearly all existing method based on ICP all can only obtain the local optimum coupling, and the key that whether can obtain the global registration optimum is the selection of initial matching parameter.Selection problem at initial matching, people such as Hugli have proposed the SIC-range method based on the initial parameter division, people such as Chetverikov are by carrying out " cutting " to the range of choice of corresponding point in each step iteration, and progressively dwindle and revise the range of choice of corresponding point along with the carrying out of iteration, above method mainly comes from the similarity coupling to static remote sensing images, does not require real-time.In gravity aided inertial navigation system, owing to will guarantee long-time, the high-precision work of inertial navigation system, must revise the systematic error of inertial navigation system itself in real time, so gravity aided inertial navigation system has real-time and reliability requirement to matching algorithm.
Summary of the invention
Technology of the present invention is dealt with problems: overcome the deficiencies in the prior art, the initial matching method of gravimetric map coupling in a kind of gravity aided inertial navigation system is provided, can improve the reliability and the real-time of gravity aided inertial navigation system effectively, thereby there is the defective that the gravimetric map matching algorithm lost efficacy under the mistake condition in the positional information that can eliminate and overcome in inertial navigation system output.
The technical solution used in the present invention step is as follows: the initial matching method of gravimetric map coupling in a kind of gravity aided inertial navigation system, and performing step is as follows:
The first step judges that carrier has entered gravity field adaptive area Ψ, chooses three continuous sampled points of gravity field sensor that carrier carries, and three pairing times of sampled point are respectively t 1, t 2And t 3Constantly.
Second goes on foot, and determines the region of search Ω of carrier gravity match reference figure; Error profile characteristic function according to inertial navigation system that carrier carries, determine the distance error threshold value δ of current time inertia system, with the carrier current location information that inertial navigation system was provided is the center, and distance error threshold value δ is a radius, delimits the region of search Ω of gravity match reference figure.
The 3rd step made up high precision triangle geometry restricted model, and made up triangular space Γ.
In the 4th step, utilize gravity field sensor that carrier carries at t 1, t 2And t 3The gravity value of constantly being taked is obtained carrier at t 1, t 2And t 3The moment corresponding reference to gravitational field isoline C 1, C 2And C 3The point set P that is comprised 1, P 2And P 3
In the 5th step, based on triangle geometry restricted model isoline matching algorithm, it is right in all initial matching of current time to obtain carrier
Figure BSA00000389258600021
These initial matching are the initial matching collection to the sets definition of forming
Figure BSA00000389258600022
J is a natural number, and 1<j<N, N are a pairing set The coupling logarithm that is comprised, p j, q j, m jRepresent that respectively j initial matching is at isoline C 1, isoline C 2, isoline C 3Last pairing point.
The 6th step, adopt probability-weighted estimation model algorithm, the value function is these characteristics of quadratic function of the angular error factor and the distance error factor, and calculates initial matching and concentrate the cost value of respectively organizing data, finally obtains accurate initial matching value.
Delimit region of search Ω in described second step, its process is: at first according to the error profile characteristic function and the error model of inertial navigation system, determine the error of position information threshold value δ that inertial navigation system provides, the carrier current location that provides with inertial navigation system is the center then, the error threshold δ of inertial navigation system is a radius, delimit region of search Ω, thereby reduce to guarantee that carrier actual position information falls within the regional Ω under the region of search raising search speed precondition.
Described the 3rd step makes up high precision triangle geometry restricted model, and the triangular space Γ of definite triangle geometry model.Its process is: at first, utilize the inertial navigation system high characteristics of measuring accuracy in short-term, obtain inertial navigation system at adjacent moment t 1t 2Between and t 2t 3Between record the range information L that carrier travels 1, L 2, and carrier is at t 2Relative steering angle θ constantly makes up high-precision triangular form geometrical constraint model; Then, choose arbitrary triangle, suppose that the leg-of-mutton length of side is respectively a, b and c, and a>b>c; Represent this triangle with two parameter b/a and c/a, thereby by (x, y) triangle that constitutes of three points in the space converts that (b/a c/a) represents that with a point this space is triangle space Γ in the space to.
Described the 5th step is obtained the initial matching collection of all possible positions of carrier based on triangle geometry restricted model isoline coupling
Figure BSA00000389258600031
(j is a natural number, and 1<j<N, N are a pairing set The coupling logarithm that is comprised, p j, q j, m jRepresent that respectively j initial matching is at isoline C 1, isoline C 2, isoline C 3Last pairing point).Its process is: at first from point set P 1, P 2And P 3In get respectively that a bit to form triangle coupling right
Figure BSA00000389258600034
Calculate coupling then respectively to each the limit length of side a of corresponding triangle of institute i, b iAnd c i(i is a natural number, corresponding i of expression mate to); At last i coupling to projecting to triangle space, and judge whether subpoint falls in the triangular space Γ; Traversal point set P 1, P 2And P 3Middle having a few chosen subpoint and fallen into all interior couplings of triangular space Γ to forming the initial matching collection.
Described the 6th step is adopted probability-weighted estimation model algorithm, the value function is these characteristics of quadratic function of the angular error factor and the distance error factor, calculate initial matching and concentrate the cost value of respectively organizing data, the detailed process that those group data that replace the value minimum are the final initial matching of carrier position is as follows:
The cost function that makes up is:
cost=f(l,α) (1)
L represents the distance parameter between the correspondence position point that match point and inertial navigation system provide in the formula, and α represents the angle between the deflection of the corresponding point that deflection and inertial navigation system provided of match point.
From a pairing set
Figure BSA00000389258600035
In optional one group of coupling right
Figure BSA00000389258600036
It is right to calculate coupling respectively by formula (1)
Figure BSA00000389258600037
Pairing three match point p j, q jAnd m jCoupling cost value costp j, costq jAnd costm j, it is right to mate
Figure BSA00000389258600038
The coupling cost value
Figure BSA00000389258600039
Choose
Figure BSA000003892586000310
Middle pairing one group of minimum value is paired into the final initial matching value of carrier.
The present invention compares useful effect with existing technical method:
(1) at the real-time requirement, people such as present existing initial matching method such as Hugli have proposed the SIC-range method based on the initial parameter division, " cutting " method that people such as Chetverikov propose all is the similarity coupling at static remote sensing images, does not require real-time.Utilize the present invention, the high precision parameter that can directly utilize inertial navigation system to measure in short-term makes up the geometrical constraint model and directly obtains high precision real-time and reliable initial matching parameter in conjunction with the isoline matching algorithm, thereby there is the defective that the gravimetric map matching algorithm lost efficacy under the mistake condition in the positional information that can eliminate and overcome in inertial navigation system output.
(2) at the requirement of system to the matching algorithm real-time, domestic people such as Sun Feng utilize inertial navigation system short-time high-accuracy characteristics, employing is based on the isoline matching algorithm of error sum of squares cost function optimum, people such as Wu Taiqi have proposed a kind of gravimetric map matching process based on the straight-line segment mode, these two kinds of methods all are in order to obtain high-precision initial position message, but they all do rectilinear motion with the hypothesis carrier is precondition, therefore has certain limitation in practical application.The geometrical constraint model that the present invention proposes, it does the motion of any track applicable to carrier, has wide range of applications.
Description of drawings
Fig. 1 is a gravity aided inertial navigation ultimate principle block diagram;
Fig. 2 is a process flow diagram of the present invention;
Fig. 3 is the dead reckoning positioning principle block diagram of inertial navigation system;
The geometrical constraint model synoptic diagram that Fig. 4 makes up for the present invention;
The triangle space Γ synoptic diagram that Fig. 5 makes up for the present invention;
Fig. 6 is the isoline matching algorithm synoptic diagram that the present invention is based on the geometrical constraint model.
Embodiment
As shown in Figure 1, general main A, B, C and four modules of D of being divided into of traditional gravity aided inertial navigation system.The fundamental purpose of A module is that the gravity field sensor that utilizes on the carrier to be carried is measured the A/W field data on the carrier running orbit in real time; The fundamental purpose of B module is the carrier positional information that provides in real time of the inertial navigation system that utilizes on the carrier to be carried and finally obtains the reference to gravitational field data in conjunction with gravity reference figure; The purpose of C module is to utilize matching algorithm finally to obtain the optimal location information of carrier; The purpose of D module is to utilize the Optimum Matching positional information to adopt information fusion technology to revise the systematic error of inertial navigation system inside in real time.
The present invention mainly is the initial alignment method at matching algorithm in the C module, to improve the reliability and the real-time of gravity aided inertial navigation system.
As shown in Figure 2, the present invention will realize according to following steps:
The first step judges that carrier has entered gravity field adaptive area Ψ, chooses three continuous sampled points of gravity field sensor that carrier carries, and three pairing times of sampled point are respectively t 1, t 2And t 3Constantly.
Can use when the big site error in order to ensure matching algorithm, and the characteristics of the triangle restriction model of the present invention's structure, when judging that carrier has entered gravity field adaptive area Ψ, after choosing the geophysical field observed reading of three continuous sampled points of geophysics field sensor that carrier carries, write down three sampled point time corresponding and be respectively t 1, t 2And t 3Constantly.
Second goes on foot, and determines the region of search Ω of carrier gravity match reference figure; Error profile characteristic function according to inertial navigation system that carrier carries, determine the distance error threshold value δ of current time inertia system, with the carrier current location information that inertial navigation system was provided is the center, and distance error threshold value δ is a radius, delimits the region of search Ω of gravity match reference figure.
Inertial technology is very ripe at present, so at first according to the error profile characteristic function and the error model of inertial navigation system, determine the error of position information threshold value δ that the current time inertial navigation system provides, the carrier current location that provides with inertial navigation system is the center then, the error threshold δ of inertial navigation system is a radius, delimit the region of search Ω of gravity match reference figure, thereby reducing to guarantee that carrier actual position information falls within the region of search Ω of gravity match reference figure under the region of search raising search speed precondition.
The 3rd step made up high precision triangle geometry restricted model, and the triangular space Γ of definite triangle geometry model.
Utilize the inertial navigation system high characteristics of measuring accuracy in short-term, obtain inertial navigation system at adjacent moment t 1t 2Between and t 2t 3Between record the range information L that carrier travels 1, L 2, and carrier is at t 2Relative steering angle θ constantly makes up high-precision triangular form geometrical constraint model.
As shown in Figure 3, the localization method of inertial navigation system is to adopt the dead reckoning principle, according to the dead reckoning principle as can be known inertial navigation system in short-term, have high-precision measured value, so as shown in Figure 4, utilize adjacent t 1The time be carved into t 2The distance L of inertial navigation output in this time period constantly 1, t 2The time be carved into t 3The distance L of inertial navigation output in this time period constantly 2, and at t 2Inertial navigation system records the relative steering angle θ structure geometrical constraint model ABC of carrier constantly; Then, choose arbitrary triangle, suppose that the leg-of-mutton length of side is respectively a, b and c, and a>b>c; Represent this triangle with two parameter b/a and c/a, thereby by (x, y) triangle of three somes formations in the space converts (b/a to, c/a) represent with a point in the space, as shown in Figure 5, this space is triangle space Γ, and obtains the subpoint Q of high precision triangle geometry restricted model on triangle space Γ of structure 0
In the 4th step, utilize gravity field sensor that carrier carries at t 1, t 2And t 3The gravity value of constantly being taked is obtained carrier at t 1, t 2And t 3The moment corresponding reference to gravitational field isoline C 1, C 2And C 3The point set P that is comprised 1, P 2And P 3Its process is as follows:
As shown in Figure 6, isoline C 1Point set P in the Ω zone 1
Figure BSA00000389258600061
(i is a natural number, 0<i<L 1, L 1Expression point set P 1What comprise counts) be positioned at interval [P 10, P 1n] in; Isoline C 2Point set P in the Ω zone 2 (i is a natural number, 0<i<L 2, L 2Expression point set P 2What comprise counts) be positioned at interval [P 20, P 2n] in; And isoline C 3Point set P in the Ω zone 3
Figure BSA00000389258600063
(i is a natural number, 0<i<L 3, L 3Expression point set P 3What comprise counts) be positioned at interval [P 30, P 3n] in.
In the 5th step,, obtain the initial matching collection of carrier at current time based on triangle geometry restricted model isoline matching algorithm
Figure BSA00000389258600064
Figure BSA00000389258600065
(j is a natural number, and 1<j<N, N are a pairing set
Figure BSA00000389258600066
The coupling logarithm that is comprised, p j, q j, m jRepresent that respectively j initial matching is at isoline C 1, isoline C 2, isoline C 3Last pairing point).Its process is as follows:
At first from point set P 1, P 2And P 3In get respectively that a bit to form triangle coupling right
Figure BSA00000389258600067
Calculate coupling then respectively to each the limit length of side a of corresponding triangle of institute i, b iAnd c i(i is a natural number, corresponding i of expression mate to); Obtain i coupling at last to the subpoint Q on triangle space Γ iTraversal point set P 1, P 2And P 3Middle having a few obtained all triangles couplings to the projection point set Q (Q on triangle space Γ 1, Q 2..., Q k..., Q M) (k is a natural number, 1<k<M, M is counting that point set Q comprises), calculate subpoint Q iWith subpoint Q 0Between distance
Figure BSA00000389258600068
Choose
Figure BSA00000389258600069
The pairing coupling of all subpoints to forming the initial matching collection
Figure BSA000003892586000610
Figure BSA000003892586000611
(j is a natural number, and 1<j<N, N are a pairing set
Figure BSA000003892586000612
The coupling logarithm that is comprised, p j, q j, m jRepresent that respectively j initial matching is at isoline C 1, isoline C 2, isoline C 3Last pairing point).。
The 6th step, adopt probability-weighted estimation model algorithm, the value function is these characteristics of quadratic function of the angular error factor and the distance error factor, and calculates initial matching and concentrate the cost value of respectively organizing data, finally obtains accurate initial matching value.
The cost function that makes up is:
cost=f(l,α)=M 1l 2+M 2α 2 (1)
L represents the distance parameter between the correspondence position point that match point and inertial navigation system provide in the formula, and α represents the angle between the deflection of the corresponding point that deflection and inertial navigation system provided of match point, M 1Represent the distance weighted factor, M 2Expression angle weighting factor.
From a pairing set
Figure BSA000003892586000613
In optional one group of coupling right
Figure BSA000003892586000614
It is right to calculate coupling respectively by formula (1)
Figure BSA000003892586000615
Pairing three match point p j, q jAnd m jCoupling cost value costp j, costq jAnd costm j, it is right to mate
Figure BSA00000389258600071
The coupling cost value Choose
Figure BSA00000389258600073
Middle pairing one group of minimum value is paired into the final initial matching value of carrier.
The above only is a gravimetric map matching initial alignment methods in the gravity aided inertial navigation system, should be pointed out that in the building process of geometrical constraint model to have proposed t 1, t 2And t 3Be three adjacent moment constantly, if carrier is done strict rectilinear motion in certain time period, the user can be according to actual needs and in conjunction with the cumulative errors characteristic of inertial navigation system, desirable t 1, t iAnd t I+n(i, n are natural number, i 〉=2) must guarantee that wherein carrier is at t 1To t iInterior and t of the moment iTo t I+nIn do strict rectilinear motion, these uses also should be considered as protection scope of the present invention.
The content that is not described in detail in the instructions of the present invention belongs to this area professional and technical personnel's known prior art.

Claims (4)

1. the initial matching method of gravimetric map coupling in the gravity aided inertial navigation system is characterized in that step is as follows:
The first step judges that carrier has entered gravity field adaptive area Ψ, chooses three continuous sampled points of gravity field sensor that carrier carries, and three pairing times of sampled point are respectively t 1, t 2And t 3Constantly;
Second goes on foot, and determines the region of search Ω of carrier gravity match reference figure
At first according to the error profile characteristic function of inertial navigation system that carrier carries, determine the distance error threshold value δ of current time inertia system, be the center with the carrier current location information that inertial navigation system was provided then, distance error threshold value δ is a radius, delimit the region of search Ω of gravity match reference figure, thereby reducing to guarantee that carrier actual position information falls within the region of search Ω of gravity match reference figure under the region of search raising search speed precondition;
The 3rd step made up the triangle geometry restricted model, and made up triangular space Γ;
In the 4th step, utilize gravity field sensor that carrier carries at t 1, t 2And t 3The gravity value of constantly being taked is obtained carrier at t 1, t 2And t 3The moment corresponding reference to gravitational field isoline C 1, C 2And C 3The point set P that is comprised 1, P 2And P 3
In the 5th step, based on triangle geometry restricted model isoline matching algorithm, it is right in all initial matching of current time to obtain carrier
Figure FSA00000389258500011
These initial matching are the initial matching collection to the sets definition of forming
Figure FSA00000389258500012
J is a natural number, and 1<j<N, N are a pairing set
Figure FSA00000389258500013
The coupling logarithm that is comprised, p j, q j, m jRepresent that respectively j initial matching is at isoline C 1, isoline C 2, isoline C 3Last pairing point;
The 6th step, adopt probability-weighted estimation model algorithm, the value function is the quadratic function of the angular error factor and the distance error factor, calculates initial matching and concentrates the cost value of respectively organizing data, finally obtains accurate initial matching value.
2. the initial matching method of gravimetric map coupling in the gravity aided inertial navigation according to claim 1 system, it is characterized in that: described the 3rd step makes up the triangle geometry restricted model, and its process of structure triangular space Γ is: at first obtain inertial navigation system at adjacent moment t 1t 2Between and t 2t 3Between record the range information L that carrier travels 1, L 2, and carrier is at t 2Relative steering angle θ constantly makes up high-precision triangular form geometrical constraint model; Then, choose arbitrary triangle, suppose that the leg-of-mutton length of side is respectively a, b and c, and a>b>c; Represent this triangle with two parameter b/a and c/a, thereby by x, the triangle that three points in the y space constitute converts b/a to, represents that with a point this space is triangle space Γ in the c/a space.
3. the initial matching method of gravimetric map coupling in the gravity aided inertial navigation according to claim 1 system, it is characterized in that: described the 5th step is obtained the initial matching collection of all possible positions of carrier based on triangle geometry restricted model isoline matching algorithm
Figure FSA00000389258500014
Process be: at first from point set P 1, P 2And P 3In get respectively that a bit to form triangle coupling right
Figure FSA00000389258500021
Calculate coupling then respectively to each the limit length of side a of corresponding triangle of institute i, b iAnd c i, i is a natural number, i coupling of expression correspondence is right; At last i coupling to projecting to triangle space, and judge this coupling to subpoint and triangle geometry restricted model the distance lambda between the subpoint of triangular space iTraversal point set P 1, P 2And P 3Middle having a few chosen λ iAll couplings of<ξ are to forming the initial matching collection, the permissible error threshold value that ξ sets for the user.
4. the initial matching method of gravimetric map coupling in the gravity aided inertial navigation according to claim 1 system, it is characterized in that: described the 6th step is adopted probability-weighted estimation model algorithm, the value function is these characteristics of quadratic function of the angular error factor and the distance error factor, calculate initial matching and concentrate the cost value of respectively organizing data, the detailed process that those group data that replace the value minimum are the final initial matching of carrier position is as follows:
A. the cost function of Gou Jianing is:
cost=f(l,α) (1)
L represents the distance parameter between the correspondence position point that match point and inertial navigation system provide in the formula, and α represents the angle between the deflection of the corresponding point that deflection and inertial navigation system provided of match point;
B. from a pairing set
Figure FSA00000389258500022
In optional one group of coupling right
Figure FSA00000389258500023
It is right to calculate coupling respectively by formula (1) Pairing three match point p j, q jAnd m jCoupling cost value costp j, costq jAnd costm j, it is right to mate
Figure FSA00000389258500025
The coupling cost value
Figure FSA00000389258500026
Choose Middle pairing one group of minimum value is paired into the final initial matching value of carrier.
CN201010592977A 2010-12-08 2010-12-08 Initial matching method for use in gravimetric map matching in gravity-aided inertial navigation system Expired - Fee Related CN102128625B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201010592977A CN102128625B (en) 2010-12-08 2010-12-08 Initial matching method for use in gravimetric map matching in gravity-aided inertial navigation system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201010592977A CN102128625B (en) 2010-12-08 2010-12-08 Initial matching method for use in gravimetric map matching in gravity-aided inertial navigation system

Publications (2)

Publication Number Publication Date
CN102128625A true CN102128625A (en) 2011-07-20
CN102128625B CN102128625B (en) 2012-09-05

Family

ID=44266807

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201010592977A Expired - Fee Related CN102128625B (en) 2010-12-08 2010-12-08 Initial matching method for use in gravimetric map matching in gravity-aided inertial navigation system

Country Status (1)

Country Link
CN (1) CN102128625B (en)

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102706348A (en) * 2012-05-16 2012-10-03 北京航空航天大学 Gravimetric map fast matching method based on triangle
CN102809376A (en) * 2012-08-06 2012-12-05 哈尔滨工程大学 Isoline-based assistant navigation positioning method
CN105021182A (en) * 2015-06-03 2015-11-04 北京理工大学 Selection method for suitable matching area of gravity-aided inertial navigation
CN105157703A (en) * 2015-06-03 2015-12-16 北京理工大学 Evaluation method of navigability of gravity-assisted inertial navigation adaptation zone
CN105716605A (en) * 2016-03-30 2016-06-29 北京理工大学 Matching method of gravity-aided inertial navigation system
CN105737831A (en) * 2016-01-29 2016-07-06 北京理工大学 Variable-scale and variable-direction gravity sampling vector matching and positioning method based on particle filtering
CN108225310A (en) * 2017-12-22 2018-06-29 中国船舶重工集团公司第七0七研究所 A kind of Gravity-aided navigation path planning method
CN108362281A (en) * 2018-02-24 2018-08-03 中国人民解放军61540部队 A kind of Long baselines underwater submarine matching navigation method and system
CN108896040A (en) * 2018-03-30 2018-11-27 中国空间技术研究院 Sky sea integrated water diving device inertia/gravity Combinated navigation method and system
CN108955669A (en) * 2017-05-17 2018-12-07 田亮 A kind of heavy magnetic field combination navigation algorithm
CN109059964A (en) * 2018-09-19 2018-12-21 中国船舶重工集团公司第七0七研究所 A kind of inertial navigation based on gravity peak and the double calibration methods of gravity measurement
CN109141426A (en) * 2018-08-10 2019-01-04 中国空间技术研究院 A kind of preferred method in subaqueous gravity matching navigation adaptation area
CN110031001A (en) * 2019-05-21 2019-07-19 北京理工大学 A kind of adaptation area choosing method of Method in Gravity Aided INS
CN110081884A (en) * 2019-05-21 2019-08-02 北京理工大学 Method in Gravity Aided INS region suitability evaluation method based on virtual course
CN111397599A (en) * 2020-02-25 2020-07-10 河海大学 Improved ICCP (Integrated Circuit chip) underwater geomagnetic matching method based on triangular matching algorithm
CN113503871A (en) * 2021-05-19 2021-10-15 北京理工大学 Gravity matching method based on correlation filtering

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5339684A (en) * 1991-12-10 1994-08-23 Textron Inc. Gravity aided inertial navigation system
US20050004750A1 (en) * 2003-07-03 2005-01-06 Huddle James R. Method for the processing of non-continuous atom interferometer intertial instrument measurements and continuous wide bandwidth instrument measurements with a gravity database
CN101424534A (en) * 2008-12-09 2009-05-06 东南大学 Inertia/gravity combined navigation semi-physical object simulating device

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5339684A (en) * 1991-12-10 1994-08-23 Textron Inc. Gravity aided inertial navigation system
US20050004750A1 (en) * 2003-07-03 2005-01-06 Huddle James R. Method for the processing of non-continuous atom interferometer intertial instrument measurements and continuous wide bandwidth instrument measurements with a gravity database
CN101424534A (en) * 2008-12-09 2009-05-06 东南大学 Inertia/gravity combined navigation semi-physical object simulating device

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
《中国惯性技术学报》 20100228 夏冰等 基于SPSS的重力匹配区域选择算法 第81-84页 1-4 第18卷, 第1期 *
《海洋测绘》 20060131 孙岚 重力辅助惯性导航的匹配算法初探 第44-46页 1-4 第26卷, 第1期 *
《计算机仿真》 20101130 夏冰等 重力辅助导航联邦滤波算法仿真研究 第1-4,13页 1-4 第27卷, 第11期 *

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102706348A (en) * 2012-05-16 2012-10-03 北京航空航天大学 Gravimetric map fast matching method based on triangle
CN102706348B (en) * 2012-05-16 2015-05-20 北京航空航天大学 Gravimetric map fast matching method based on triangle
CN102809376A (en) * 2012-08-06 2012-12-05 哈尔滨工程大学 Isoline-based assistant navigation positioning method
CN102809376B (en) * 2012-08-06 2015-02-25 哈尔滨工程大学 Isoline-based assistant navigation positioning method
CN105021182A (en) * 2015-06-03 2015-11-04 北京理工大学 Selection method for suitable matching area of gravity-aided inertial navigation
CN105157703A (en) * 2015-06-03 2015-12-16 北京理工大学 Evaluation method of navigability of gravity-assisted inertial navigation adaptation zone
CN105021182B (en) * 2015-06-03 2018-04-24 北京理工大学 A kind of system of selection in Method in Gravity Aided INS adaptation area
CN105737831A (en) * 2016-01-29 2016-07-06 北京理工大学 Variable-scale and variable-direction gravity sampling vector matching and positioning method based on particle filtering
CN105737831B (en) * 2016-01-29 2019-02-12 北京理工大学 Mutative scale based on particle filter is changed direction gravity sample vector matching locating method
CN105716605A (en) * 2016-03-30 2016-06-29 北京理工大学 Matching method of gravity-aided inertial navigation system
CN105716605B (en) * 2016-03-30 2018-07-10 北京理工大学 A kind of Method in Gravity Aided INS system matches method
CN108955669A (en) * 2017-05-17 2018-12-07 田亮 A kind of heavy magnetic field combination navigation algorithm
CN108225310A (en) * 2017-12-22 2018-06-29 中国船舶重工集团公司第七0七研究所 A kind of Gravity-aided navigation path planning method
CN108225310B (en) * 2017-12-22 2020-08-25 中国船舶重工集团公司第七0七研究所 Gravity-assisted navigation track planning method
CN108362281A (en) * 2018-02-24 2018-08-03 中国人民解放军61540部队 A kind of Long baselines underwater submarine matching navigation method and system
CN108362281B (en) * 2018-02-24 2020-11-24 中国人民解放军61540部队 Long-baseline underwater submarine matching navigation method and system
CN108896040A (en) * 2018-03-30 2018-11-27 中国空间技术研究院 Sky sea integrated water diving device inertia/gravity Combinated navigation method and system
CN108896040B (en) * 2018-03-30 2021-03-26 中国空间技术研究院 Inertia/gravity combined navigation method and system for sky-sea integrated underwater vehicle
CN109141426A (en) * 2018-08-10 2019-01-04 中国空间技术研究院 A kind of preferred method in subaqueous gravity matching navigation adaptation area
CN109141426B (en) * 2018-08-10 2020-11-10 中国空间技术研究院 Method for matching navigation adaptation area by underwater gravity
CN109059964A (en) * 2018-09-19 2018-12-21 中国船舶重工集团公司第七0七研究所 A kind of inertial navigation based on gravity peak and the double calibration methods of gravity measurement
CN110031001A (en) * 2019-05-21 2019-07-19 北京理工大学 A kind of adaptation area choosing method of Method in Gravity Aided INS
CN110081884A (en) * 2019-05-21 2019-08-02 北京理工大学 Method in Gravity Aided INS region suitability evaluation method based on virtual course
CN110031001B (en) * 2019-05-21 2020-12-11 北京理工大学 Adaptive area selection method for gravity-assisted inertial navigation
CN111397599A (en) * 2020-02-25 2020-07-10 河海大学 Improved ICCP (Integrated Circuit chip) underwater geomagnetic matching method based on triangular matching algorithm
CN113503871A (en) * 2021-05-19 2021-10-15 北京理工大学 Gravity matching method based on correlation filtering
CN113503871B (en) * 2021-05-19 2024-04-16 北京理工大学 Gravity matching method based on correlation filtering

Also Published As

Publication number Publication date
CN102128625B (en) 2012-09-05

Similar Documents

Publication Publication Date Title
CN102128625B (en) Initial matching method for use in gravimetric map matching in gravity-aided inertial navigation system
CN103472823B (en) A kind of grating map creating method of intelligent robot
CN104061934B (en) Pedestrian indoor position tracking method based on inertial sensor
CN104121905B (en) Course angle obtaining method based on inertial sensor
CN108955675A (en) A kind of underground piping track detection system and method based on inertia measurement
CN103791902B (en) It is applicable to the star sensor autonomous navigation method of high motor-driven carrier
CN103674015B (en) Trackless positioning navigation method and device
CN109000642A (en) A kind of improved strong tracking volume Kalman filtering Combinated navigation method
CN103776446B (en) A kind of pedestrian's independent navigation computation based on double MEMS-IMU
CN104197935B (en) Indoor localization method based on mobile intelligent terminal
CN103822634B (en) A kind of Gravity Matching aided inertial navigation method based on the ICCP algorithm improved
CN103217154B (en) Method and device for locating underground personnel in coal mine
CN105783923A (en) Personnel positioning method based on RFID and MEMS inertial technologies
CN105043387A (en) Personal indoor positioning system based on inertial navigation aiding geomagnetism
CN103149580A (en) Global position system (GPS)/inertial navigation system (INS) combined navigation method based on strong tracking kalman filter (STKF) and wavelet neural network (WNN)
CN105865450A (en) Zero-speed update method and system based on gait
CN110057354A (en) One kind being based on the modified geomagnetic matching navigation method of magnetic declination
CN105246153A (en) High-density rapid collection method for indoor fingerprint positioning database
CN102168979B (en) Isoline matching method for passive navigation based on triangular constraint model
CN110412596A (en) A kind of robot localization method based on image information and laser point cloud
CN109141408A (en) A kind of error compensating method that growing defeated underground piping positioning system and implement system
CN107907134A (en) A kind of mileage information aids in the matched Vehicle positioning system of earth magnetism and method
CN104359496A (en) High-precision attitude correction method based on vertical deviation compensation
CN108919304A (en) POS error compensating method in a kind of traverse measurement system based on reference planes
CN104296741B (en) WSN/AHRS (Wireless Sensor Network/Attitude Heading Reference System) tight combination method adopting distance square and distance square change rate

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20120905

Termination date: 20211208