CN102778230B - Gravity gradient auxiliary positioning method of artificial physical optimization particle filtering - Google Patents

Gravity gradient auxiliary positioning method of artificial physical optimization particle filtering Download PDF

Info

Publication number
CN102778230B
CN102778230B CN201210194633.1A CN201210194633A CN102778230B CN 102778230 B CN102778230 B CN 102778230B CN 201210194633 A CN201210194633 A CN 201210194633A CN 102778230 B CN102778230 B CN 102778230B
Authority
CN
China
Prior art keywords
particle
gravity gradient
auxiliary positioning
error
particle filter
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.)
Expired - Fee Related
Application number
CN201210194633.1A
Other languages
Chinese (zh)
Other versions
CN102778230A (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.)
Liaoning Technical University
Original Assignee
Liaoning Technical 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 Liaoning Technical University filed Critical Liaoning Technical University
Priority to CN201210194633.1A priority Critical patent/CN102778230B/en
Publication of CN102778230A publication Critical patent/CN102778230A/en
Application granted granted Critical
Publication of CN102778230B publication Critical patent/CN102778230B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Navigation (AREA)

Abstract

The invention provides a gravity gradient auxiliary positioning method of artificial physical optimization particle filtering. The method comprises the following steps of: determining the initial position parameter of a carrier through a GPS (global positioning system), and binding the initial position parameter into a navigation computer; warming up and preparing by a strapdown inertial navigation system, collecting data output by an optical fiber gyroscope and a quartz accelerometer and treating the data; and improving the particle distribution through introducing artificial physical optimization, overcoming the particle degradation problem of particle filtering, and reducing the calculation amount and the required iterations. Repulsive force is introduced by the artificial physical optimization particle filtering algorithm during the process of improving the particle distribution, particle sets are prevented from being excessively overlapped or crowded, and uniform covering capability is ensured to be formed by the posterior probability density by particle universality and optimized particle sets; through continuous updating and recursion of the artificial physical optimization particle filtering, the position error of an inertial navigation system is rectified after being estimated and calculated, thus the position error of the gravity gradient auxiliary positioning method tends to be zero gradually. The artificial physical optimization particle filtering algorithm disclosed by the invention enables the system to have good stability while the system estimation accuracy is improved.

Description

A kind of artificial physics is optimized the gravity gradient assisted location method of particle filter
(1) technical field
What the present invention relates to is a kind of measuring method, and in particular a kind of artificial physics is optimized the gravity gradient assisted location method of particle filter.
(2) background technology
, good concealment completely autonomous owing to having, can provide continuously position, speed and attitude parameter, inertial navigation system is the basic navigation system of submarine navigation device always.But well-known, due to the intrinsic reason of inertia device, the positioning error of inertial navigation system accumulates in time, long-term accuracy is difficult to guarantee.The requirements at the higher level that modern war proposes navigation and positioning accuracy, continuous appearance and the development of various inertia base Combinated navigation methods have been promoted, as Terrain-aided Navigation, geomagnetic auxiliary navigation etc. combines with inertial navigation system, to overcome the deficiency of pure-inertial guidance system, effectively reduce the requirement to inertial navigation system.Gravity gradient assisted location method meets the development trend of gravity field measuring technique, make full use of the potential accuracy of gravity gradient auxiliary positioning and sourceless characteristic and provide hi-Fix parameter for optimal in structure, to improving the disguised and long-term autonomous of carrier, to navigate by water ability significant.
Because particle filter is applicable to the state estimation problem of nonlinear system, so be applied to the optimal State Estimation of non-linear non-Gauss's problems such as target following, navigator fix.But the defect that elementary particle filtering algorithm itself exists causes filtering result occurs Divergent Phenomenon, and particle degradation phenomena embodies obviously in gravity gradient auxiliary positioning, can not guarantee the stability of system.Particle filter lacks the ability that generates new particle, and when last particle can not represent real posterior probability density, particle filter algorithm will be failed.Therefore, the problem that particle is accelerated to degenerate is improved, and just can impel particle filter to be well used in gravity gradient auxiliary positioning.
The correlative study scheme that particle is degenerated is the popular problem that this area research is inquired into always, typically improves particle filter and has Auxiliary Particle Filter, without mark particle filter, canonical particle filter etc.In recent years, have scholar to propose swarm intelligence and particle filter to merge mutually, the core of improving particle filter due to swarm intelligence is to improve resampling, optimizes distribution of particles.Therefore effect and the realizability of these class methods depend on optimized algorithm used itself.Due to some swarm intelligence algorithm, conventionally there is the problems such as search capability is poor, early convergence, be therefore directly introduced into particle filter not only to fall flat, also may cause algorithm to become more complicated.For as above problem, patent of the present invention proposes a kind ofly artificial physics optimization method is introduced to particle filter to improve that particle is degenerated and the filtering algorithm of samples impoverishment problem, and by this algorithm application in gravity gradient auxiliary positioning.
(3) summary of the invention
Technology of the present invention is dealt with problems and is: overcome the deficiencies in the prior art, provide a kind of artificial physics to optimize the gravity gradient assisted location method of particle filter.
Technical solution of the present invention is: a kind of artificial physics is optimized the gravity gradient assisted location method of particle filter, it is characterized in that particle filter completes after one-step prediction, artificial physics is optimized particle filter algorithm the candidate's particle collection obtaining is considered as to the individuality in artificial physics solution space, by optimization, generate new suggestion and distribute, newer particle collection is carried out to weights normalization and resampling.In this algorithm, fictitious force has determined particle motion track, for particle is assembled to high likelihood region, stipulates that all particles are subject to the gravitation of the maximum particle of weights, makes system have better stability, is conducive to alliance error and goes to zero gradually.Its concrete steps are as follows:
(1) by GPS, determine the initial position parameters of carrier, they are bound to navigational computer;
(2) strapdown inertial navitation system (SINS) is carried out preheating preparation, gathers the data of fibre optic gyroscope and quartz accelerometer output and data are processed;
(3) artificial physics is optimized the realization of particle filter algorithm;
1) initialization
From posterior probability Density Distribution, sample, weight is set to 1/N.Perception radius r is set simultaneously s, the threshold value D of gravitation and repulsion th, fictitious force coefficient K a1, K a2, the parameters such as iterations, perception matrix c, fictitious force matrix F and the zero setting of current iteration number of times.
2) prediction
Sample from the importance density function of sampling new particle collection calculate particle weights.
3) optimize distribution of particles
A) calculate particle s iwith s jbetween Euclidean distance d (s i, s j), i, j=1,2 ... N
B) calculate s ito s jperception matrix c ( s i , s j ) = 1 d ( s i , s j ) ≤ r s 0 d ( s i , s j ) > r s , I, j=1,2 ... N, r sfor perception radius.
C) calculate particle s ifictitious force F (s i, s j)
F ( s i , s j ) = K a 1 [ d ( s i , s j ) - D th ] x j - x i d ( s i , s j ) c ( s i , s j ) = 0 K a 2 [ D th - d ( s i , s j ) ] x j - x i d ( s i , s j ) c ( s i , s j ) = 1 d ( s i , s j ) > D th K a 2 [ d ( s i , s j ) - D th ] x j - x i d ( s i , s j ) c ( s i , s j ) = 1 d ( s i , s j ) < D th
D) calculate particle s ithe F (i) that makes a concerted effort being subject to
If F (i) > maximum displacement restriction L max, F (i)=L max; If F (i) < least displacement restriction L min, F (i)=L min.
E) new particle s more iposition
x′ i=x i+F i
Wherein, x ' iposition for after upgrading, is subject to the restriction of least displacement and maximum displacement, i.e. x ' i∈ [L min, L max].Meet after optimal conditions or iterations, optimized algorithm stops.
F) calculate new particle weights, upgrade the particle of weights maximum
4) obtain new particle collection, iteration optimization finishes.Recalculate new particle weights normalization
5) resample
If number of effective particles is less than the threshold value of setting, particle filter algorithm resamples
6) state estimation
Calculated single particle suffered close the renewal of carrying out particle position after fictitious force, with this, reduce calculated amount and required iterations, improve convergence of algorithm speed.Artificial physics is optimized particle algorithm by introduce repulsive force in improving the process of distribution of particles, avoids particle collection too overlapping or crowded, with this, realizes particle diversity and the distribution to posterior probability density.
(4) foundation of the auxiliary combined filter model of gravity gradient;
The combined filter model of deriving based on gravity gradient auxiliary positioning on INS errors equation basis, chooses longitude and latitude error, velocity error, attitude error, accelerometer bias and gyroscopic drift as state variable.The tight anabolic process of gravity gradient auxiliary positioning and inertial navigation system is using gravity gradient as observed quantity.Consider that gravity gradient observed reading is the function of carrier actual position, based on gravity gradient auxiliary positioning observation equation, can be expressed as:
Wherein, y jk(j, k=x, y, z) is gravity gradient observed reading; represent true carrier positions the gravity gradient at place; V represents observation noise.Gravity gradient and carrier actual position are typical nonlinear relationship, because inertial navigation system can not directly provide carrier actual position therefore, conventional linear-apporximation filtering method is by Nonlinear Vector function at current time Filtering Estimation near get single order Taylor series expansion:
Obtain the error observation equation of approximately linear:
Due to the general file layout that adopts discrete graticule mesh of benchmark gradient map of gravity gradient auxiliary positioning, there is corresponding relation in gravity gradient value and position coordinates, therefore based on gravity gradient auxiliary positioning observation equation, is difficult to represent with analytical function.By given system state initial value and initial variance battle array, the posteriority that particle filter can generate initial time site error distributes with therefore, two important parameters in the observation equation of gravity gradient auxiliary positioning obtain by particle filter method.Through one-step prediction, particle filter just can directly calculate from benchmark gradient map as prediction probability density.As up-to-date observed reading y jkduring arrival, particle filter, again by the importance density function, utilizes the difference between prediction Grad and observation Grad, and more new particle weights obtain system state.If the true posteriority that particle collection can not representative system state distributes, the difference between the prediction Grad of reading in benchmark gradient map so and observation Grad is larger, and weights are less, and vice versa.Particle filter is by constantly upgrading and recursion, proofreaies and correct after estimating the site error of inertial navigation system, thereby alliance error is gone to zero gradually.
The present invention's advantage is compared with prior art: the present invention optimizes by introducing artificial physics, improves distribution of particles, overcomes the particle degenerate problem of particle filter, has reduced calculated amount and required iterations.From artificial physics, optimizing particle filter implementation procedure can find out, this algorithm by having introduced repulsive force in improving the process of distribution of particles, avoided particle collection too overlapping or crowded, guaranteed that the particle set pair posterior probability density after particle diversity and optimization forms uniform covering power.Artificial physics is optimized particle algorithm when improving system estimation precision, makes system have better stability, is conducive to alliance error and goes to zero gradually.
The effect useful to the present invention is described as follows:
Under VC++ simulated conditions, the method is carried out to emulation experiment:
The artificial physics that patent of the present invention is carried is optimized particle filter algorithm and is applied to gravity gradient auxiliary positioning, adopt particle filter algorithm and particle group optimizing particle filter algorithm to contrast simultaneously, investigate feasibility and reliability that artificial physics is optimized particle algorithm.
Simulated conditions: strapdown inertial navigation system isolated operation 2 hours, then introduce gravity gradient auxiliary positioning.Artificial physics is optimized particle algorithm parameter: get perceived distance r s=150 meters, threshold value D th=10 meters, filtering initial value x 0=0.1, P 0=2, artificial physics is optimized particle algorithm and particle group optimizing particle filter algorithm population is all taken as 100, and site error initial value is 2000 meters, and iteration optimization number of times is 20 times.Particle algorithm population 2000,500 meters of site error initial values.The filtering cycle is taken as 10 seconds, observation noise in experimentation
Utilize method of the present invention to obtain three kinds of algorithms to the estimated result of site error (accompanying drawing 2) and each posteriority distribution of particles curve (accompanying drawing 3) constantly, result shows estimated result that artificial physics optimizes particle filter algorithm more steadily and estimated accuracy is better than particle filter algorithm and particle group optimizing particle filter algorithm.
(4) accompanying drawing explanation
Fig. 1 is the gravity gradient assisted location method process flow diagram that a kind of artificial physics of the present invention is optimized particle filter;
Fig. 2 is the estimated result curves of three kinds of particle filter methods of the present invention to inertial navigation system error;
Fig. 3 is the posteriority distribution of particles curve of each moment three kinds of particle filter methods of the present invention.
(5) embodiment
Below in conjunction with accompanying drawing, the specific embodiment of the present invention is described in detail:
(1) by GPS, determine the initial position parameters of carrier, they are bound to navigational computer;
(2) strapdown inertial navitation system (SINS) is carried out preheating preparation, gathers the data of fibre optic gyroscope and quartz accelerometer output and data are processed;
(3) realization of artificial physics particle filter algorithm;
1) initialization
From posterior probability Density Distribution, sample, weight is set to 1/N.Perception radius r is set simultaneously s, the threshold value D of gravitation and repulsion th, fictitious force coefficient K a1, K a2, the parameters such as iterations, perception matrix c, fictitious force matrix F and the zero setting of current iteration number of times.
2) prediction
Sample from the importance density function of sampling new particle collection calculate particle weights.
3) optimize distribution of particles
A) calculate particle s iwith s jbetween Euclidean distance d (s i, s j), i, j=1,2 ... N
B) calculate s ito s jperception matrix c ( s i , s j ) = 1 d ( s i , s j ) &le; r s 0 d ( s i , s j ) > r s , I, j=1,2 ... N, r sfor perception radius.
C) calculate particle s ifictitious force F (s i, s j)
F ( s i , s j ) = K a 1 [ d ( s i , s j ) - D th ] x j - x i d ( s i , s j ) c ( s i , s j ) = 0 K a 2 [ D th - d ( s i , s j ) ] x j - x i d ( s i , s j ) c ( s i , s j ) = 1 d ( s i , s j ) > D th K a 2 [ d ( s i , s j ) - D th ] x j - x i d ( s i , s j ) c ( s i , s j ) = 1 d ( s i , s j ) < D th - - - ( 1 )
D) calculate particle s ithe F (i) that makes a concerted effort being subject to
If F (i) > maximum displacement restriction L max, F (i)=L max; If F (i) < least displacement restriction L min, F (i)=L min.
E) new particle s more iposition
x′ i=x i+F i (2)
Wherein, x ' iposition for after upgrading, is subject to the restriction of least displacement and maximum displacement, i.e. x ' i∈ [L min, L max].Meet after optimal conditions or iterations, optimized algorithm stops.
F) calculate new particle weights, upgrade the particle of weights maximum
4) obtain new particle collection, iteration optimization finishes.Recalculate new particle weights normalization
5) resample
If number of effective particles is less than the threshold value of setting, particle filter algorithm resamples
6) state estimation
Calculated single particle suffered close the renewal of carrying out particle position after fictitious force, with this, reduce calculated amount and required iterations, improve convergence of algorithm speed.Artificial physics is optimized particle algorithm by introduce repulsive force in improving the process of distribution of particles, avoids particle collection too overlapping or crowded, with this, realizes particle diversity and the distribution to posterior probability density.
(4) foundation of the auxiliary combined filter model of gravity gradient;
The combined filter model of deriving based on gravity gradient auxiliary positioning on INS errors equation basis, chooses longitude and latitude error, velocity error, attitude error, accelerometer bias and gyroscopic drift as state variable.The tight anabolic process of gravity gradient auxiliary positioning and inertial navigation system is using gravity gradient as observed quantity.Consider that gravity gradient observed reading is the function of carrier actual position, based on gravity gradient auxiliary positioning observation equation, can be expressed as:
Wherein, y jk(j, k=x, y, z) is gravity gradient observed reading; represent true carrier positions the gravity gradient at place; V represents observation noise.Gravity gradient and carrier actual position are typical nonlinear relationship, because inertial navigation system can not directly provide carrier actual position therefore, conventional linear-apporximation filtering method is by Nonlinear Vector function at current time Filtering Estimation near get single order Taylor series expansion:
Obtain the error observation equation of approximately linear:
Due to the general file layout that adopts discrete graticule mesh of benchmark gradient map of gravity gradient auxiliary positioning, there is corresponding relation in gravity gradient value and position coordinates, therefore based on gravity gradient auxiliary positioning observation equation, is difficult to represent with analytical function.By given system state initial value and initial variance battle array, the posteriority that particle filter can generate initial time site error distributes with therefore, two important parameters in the observation equation of gravity gradient auxiliary positioning obtain by particle filter method.Through one-step prediction, particle filter just can directly calculate from benchmark gradient map as prediction probability density.As up-to-date observed reading y jkduring arrival, particle filter, again by the importance density function, utilizes the difference between prediction Grad and observation Grad, and more new particle weights obtain system state.If the true posteriority that particle collection can not representative system state distributes, the difference between the prediction Grad of reading in benchmark gradient map so and observation Grad is larger, and weights are less, and vice versa.Particle filter is by constantly upgrading and recursion, proofreaies and correct after estimating the site error of inertial navigation system, thereby alliance error is gone to zero gradually.

Claims (1)

1. artificial physics is optimized a gravity gradient assisted location method for particle filter, it is characterized in that comprising the following steps:
(1) by GPS, determine the initial position parameters of carrier, they are bound to navigational computer;
(2) strapdown inertial navitation system (SINS) is carried out preheating preparation, gathers the data of fibre optic gyroscope and quartz accelerometer output and data are processed;
(3) artificial physics is optimized the realization of particle filter algorithm;
1) initialization
From posterior probability Density Distribution, sample, weight is set to 1/N, and perception radius r is set simultaneously s, the threshold value D of gravitation and repulsion th, fictitious force coefficient K a1, K a2, the parameters such as iterations, perception matrix c, fictitious force matrix F and the zero setting of current iteration number of times;
2) prediction
Sample from the importance density function of sampling new particle collection calculate particle weights;
3) optimize distribution of particles
A) calculate particle s iwith s jbetween Euclidean distance d (s i, s j), i, j=1,2 ... N;
B) calculate s ito s jperception matrix c ( s i , s j ) = 1 d ( s i , s j ) &le; r s 0 d ( s i , s j ) > r s , I, j=1,2 ... N, r sfor perception radius;
C) calculate particle s ifictitious force F (s i, s j)
F ( s i , s j ) = K a 1 [ d ( s i , s j ) - D th ] x j - x i d ( s i , s j ) c ( s i , s j ) = 0 K a 2 [ D th - d ( s i , s j ) ] x j - x i d ( s i , s j ) c ( s i , s j ) = 1 d ( s i , s j ) > D th K a 2 [ d ( s i , s j ) - D th ] x j - x i d ( s i , s j ) c ( s i , s j ) = 1 d ( s i , s j ) < D th ;
D) calculate particle s ithe F that makes a concerted effort being subject to i
If F i> maximum displacement restriction L max, F i=L max; If F i< least displacement restriction L min, F i=L min;
E) new particle s more iposition
x′ i=x i+F i
Wherein, x ' iposition for after upgrading, is subject to the restriction of least displacement and maximum displacement, i.e. x ' i∈ [L min, L max], meeting after optimal conditions or iterations, optimized algorithm stops;
F) calculate new particle weights, upgrade the particle of weights maximum;
4) obtain new particle collection, iteration optimization finishes, and recalculates new particle weights normalization;
5) resample
If number of effective particles is less than the threshold value of setting, particle filter algorithm resamples;
6) state estimation
Calculated single particle suffered close the renewal of carrying out particle position after fictitious force, with this, reduce calculated amount and required iterations, improve convergence of algorithm speed, artificial physics is optimized particle algorithm by introduce repulsive force in improving the process of distribution of particles, avoid particle collection too overlapping or crowded, with this, realize particle diversity and the distribution to posterior probability density;
(4) foundation of the auxiliary combined filter model of gravity gradient;
The combined filter model of deriving based on gravity gradient auxiliary positioning on INS errors equation basis, choose longitude and latitude error, velocity error, attitude error, accelerometer bias and gyroscopic drift as state variable, the tight anabolic process of gravity gradient auxiliary positioning and inertial navigation system is using gravity gradient as observed quantity, consider that gravity gradient observed reading is the function of carrier actual position, based on gravity gradient auxiliary positioning observation equation, can be expressed as:
Wherein, y jk(j, k=x, y, z) is gravity gradient observed reading; represent true carrier positions the gravity gradient at place; V represents observation noise, and gravity gradient and carrier actual position are typical nonlinear relationship, because inertial navigation system can not directly provide carrier actual position therefore, conventional linear-apporximation filtering method is by Nonlinear Vector function at current time Filtering Estimation near get single order Taylor series expansion:
Obtain the error observation equation of approximately linear:
The general file layout that adopts discrete graticule mesh of benchmark gradient map due to gravity gradient auxiliary positioning, there is corresponding relation in gravity gradient value and position coordinates, therefore based on gravity gradient auxiliary positioning observation equation, be difficult to represent with analytical function, by given system state initial value and initial variance battle array, the posteriority that particle filter can generate initial time site error distributes with therefore, two important parameters in the observation equation of gravity gradient auxiliary positioning obtain by particle filter method, and through one-step prediction, particle filter just can directly calculate from benchmark gradient map as prediction probability density, as up-to-date observed reading y jkduring arrival, particle filter passes through the importance density function again, utilize the difference between prediction Grad and observation Grad, more new particle weights obtain system state, if the true posteriority that particle collection can not representative system state distributes, difference between the prediction Grad of reading in benchmark gradient map so and observation Grad is larger, weights are less, vice versa, particle filter is by constantly upgrading and recursion, after estimating the site error of inertial navigation system, proofread and correct, thereby alliance error is gone to zero gradually.
CN201210194633.1A 2012-06-14 2012-06-14 Gravity gradient auxiliary positioning method of artificial physical optimization particle filtering Expired - Fee Related CN102778230B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210194633.1A CN102778230B (en) 2012-06-14 2012-06-14 Gravity gradient auxiliary positioning method of artificial physical optimization particle filtering

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210194633.1A CN102778230B (en) 2012-06-14 2012-06-14 Gravity gradient auxiliary positioning method of artificial physical optimization particle filtering

Publications (2)

Publication Number Publication Date
CN102778230A CN102778230A (en) 2012-11-14
CN102778230B true CN102778230B (en) 2014-10-29

Family

ID=47123229

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210194633.1A Expired - Fee Related CN102778230B (en) 2012-06-14 2012-06-14 Gravity gradient auxiliary positioning method of artificial physical optimization particle filtering

Country Status (1)

Country Link
CN (1) CN102778230B (en)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105180938B (en) * 2015-06-03 2018-02-02 北京理工大学 A kind of gravity sample vector matching locating method based on particle filter
CN105157704A (en) * 2015-06-03 2015-12-16 北京理工大学 Bayesian estimation-based particle filter gravity-assisted inertial navigation matching method
CN105021197A (en) * 2015-06-26 2015-11-04 四川理工学院 ILOPF-based quadrotor attitude estimation method
CN105737831B (en) * 2016-01-29 2019-02-12 北京理工大学 Mutative scale based on particle filter is changed direction gravity sample vector matching locating method
CN105716605B (en) * 2016-03-30 2018-07-10 北京理工大学 A kind of Method in Gravity Aided INS system matches method
CN108073742B (en) * 2016-11-17 2021-08-10 北京机电工程研究所 Method for estimating flight state of intercepted missile tail section based on improved particle filter algorithm
CN107063249A (en) * 2017-04-17 2017-08-18 重庆邮电大学 A kind of gravity gradient aids in INS field positioner
CN107024206A (en) * 2017-04-17 2017-08-08 重庆邮电大学 A kind of integrated navigation system based on GGI/GPS/INS
CN108415096B (en) * 2018-02-08 2019-06-28 武汉科技大学 Subaqueous gravity gradient object detection method based on Newton iteration method
CN110567441B (en) * 2019-07-29 2021-09-28 广东星舆科技有限公司 Particle filter-based positioning method, positioning device, mapping and positioning method
CN111238483A (en) * 2020-02-12 2020-06-05 上海海事大学 Low-power-consumption terrain auxiliary navigation system and method based on SIR particle filtering method
CN113534222A (en) * 2020-04-17 2021-10-22 宝马股份公司 Method for vehicle positioning, device for vehicle positioning and vehicle

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102360451A (en) * 2011-10-11 2012-02-22 江苏科技大学 Artificial fish-swarm based particle filtering method

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100601960B1 (en) * 2004-08-05 2006-07-14 삼성전자주식회사 Simultaneous localization and map building method for robot

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102360451A (en) * 2011-10-11 2012-02-22 江苏科技大学 Artificial fish-swarm based particle filtering method

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
"Marginalized Particle Filter for Accurate and Reliable Terrain-Aided Navigation";PER-JOHAN NORDLUND;《AEROSPACE AND ELECTRONIC SYSTEMS》;20091231;第45卷(第4期);全文 *
"全加速度计惯性导航与重力梯度测量系统设计";刘凤鸣;《中国惯性技术学报》;20090430;第17卷(第2期);全文 *
"运动平台上基于粒子滤波的目标跟踪技术";孙伟;《航空计算技术》;20100930;第40卷(第5期);全文 *
PER-JOHAN NORDLUND."Marginalized Particle Filter for Accurate and Reliable Terrain-Aided Navigation".《AEROSPACE AND ELECTRONIC SYSTEMS》.2009,第45卷(第4期),
刘凤鸣."全加速度计惯性导航与重力梯度测量系统设计".《中国惯性技术学报》.2009,第17卷(第2期),
孙伟."运动平台上基于粒子滤波的目标跟踪技术".《航空计算技术》.2010,第40卷(第5期),

Also Published As

Publication number Publication date
CN102778230A (en) 2012-11-14

Similar Documents

Publication Publication Date Title
CN102778230B (en) Gravity gradient auxiliary positioning method of artificial physical optimization particle filtering
CN107289933B (en) Double card Kalman Filtering navigation device and method based on MEMS sensor and VLC positioning fusion
CN104655131B (en) Inertial navigation Initial Alignment Method based on ISTSSRCKF
CN104075715B (en) A kind of underwater navigation localization method of Combining with terrain and environmental characteristic
Nassar Improving the inertial navigation system (INS) error model for INS and INS/DGPS applications
CN109000642A (en) A kind of improved strong tracking volume Kalman filtering Combinated navigation method
CN104635251B (en) A kind of INS/GPS integrated positionings determine appearance new method
CN104344837B (en) Speed observation-based redundant inertial navigation system accelerometer system level calibration method
CN110455287A (en) Adaptive Unscented kalman particle filter method
CN105890592B (en) Vehicle position information prediction technique based on Online-WSVR algorithm
CN105180938B (en) A kind of gravity sample vector matching locating method based on particle filter
Song et al. Neural-network-based AUV navigation for fast-changing environments
CN107830858B (en) Gravity-assisted mobile phone heading estimation method
CN111735474B (en) Moving base compass alignment method based on data backtracking
CN106643806B (en) A kind of inertial navigation system alignment precision appraisal procedure
CN106643715A (en) Indoor inertial navigation method based on bp neural network improvement
CN103557864A (en) Initial alignment method for micro electro mechanical system (MEMS) strap-down inertial navigation adaptive square-root cubature Kalman filtering (SCKF)
CN108931791A (en) Defend used tight integration clock deviation update the system and method
CN104374401A (en) Compensating method of gravity disturbance in strapdown inertial navigation initial alignment
CN101871782A (en) Position error forecasting method for GPS (Global Position System)/MEMS-INS (Micro-Electricomechanical Systems-Inertial Navigation System) integrated navigation system based on SET2FNN
CN105157704A (en) Bayesian estimation-based particle filter gravity-assisted inertial navigation matching method
CN102162733A (en) Method for correcting autonomous underwater vehicle (AUV) dead reckoning navigation error in real time based on space vector modulation (SVM)
CN102519485A (en) Gyro information-introduced double-position strapdown inertial navigation system initial alignment method
CN111207773B (en) Attitude unconstrained optimization solving method for bionic polarized light navigation
CN102645223A (en) Serial inertial navigation vacuum filtering correction method based on specific force observation

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

Granted publication date: 20141029

Termination date: 20150614

EXPY Termination of patent right or utility model