CN113077055A - Distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM - Google Patents
Distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM Download PDFInfo
- Publication number
- CN113077055A CN113077055A CN202110327231.3A CN202110327231A CN113077055A CN 113077055 A CN113077055 A CN 113077055A CN 202110327231 A CN202110327231 A CN 202110327231A CN 113077055 A CN113077055 A CN 113077055A
- Authority
- CN
- China
- Prior art keywords
- particle
- box
- particles
- bin
- updating
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N20/00—Machine learning
-
- 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/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Computing Systems (AREA)
- General Engineering & Computer Science (AREA)
- Medical Informatics (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Automation & Control Theory (AREA)
- Investigating, Analyzing Materials By Fluorescence Or Luminescence (AREA)
Abstract
The invention relates to a distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM, which is a method for fusion positioning of distributed self-adaptive multi-source information, belongs to the field of positioning and orientation and machine learning, and is characterized by comprising the following steps: (1) determining an average value and an envelope estimation value of adjacent extreme points; (2) determining a residual signal; (3) determining a frequency modulated signal and an envelope signal; (4) performing LMD decomposition to determine a first PF component; (5) establishing an ICA mathematical model; (6) constructing a PNN neural network; (7) a discriminant function of the output variable is determined. The invention effectively solves the problem of the influence of the background noise of the complex environment on the positioning accuracy, improves the filtering efficiency, effectively improves the system operation efficiency, reduces the system response time, improves the system operation speed and accelerates the target positioning updating frequency.
Description
Technical Field
The invention relates to the field of positioning and orientation and machine learning, in particular to a method for performing fusion positioning on distributed self-adaptive multi-source information.
Background
At present, for the positioning of a target in a complex environment, multiple data sources are mainly formed on the basis of multiple sensors, and the position information of the target is accurate through algorithm fusion. The traditional multi-source fusion algorithm generally adopts a high-order correction CKF multi-element fusion method and an NLOS algorithm. For the high-order correction CKF multi-element fusion algorithm, because the order of the self-adaptive high-order correction function is dynamically adjusted according to the positioning error, strict requirements are imposed on the extraction and the judgment of the error, and meanwhile, the noise of the environmental background is not easy to remove, and an interference source is easy to generate. For the NLOS algorithm, because the measurement noise of the fusion filter is dynamically adjusted according to the result settlement residual matrix, the initial value dependence on the feature point depth and the covariance matrix is large, and if the setting is not correct, or the estimated values are inconsistent, the deviation is generated. The complexity of the environment background and the continuous transformation of the target position cause that the technology has larger error deviation probability in practical application.
For the positioning of the target in the complex environment, the key point is the efficient and stable removal of the environmental background noise and the positioning. Therefore, higher requirements are put on the target positioning in complex environments. Aiming at the problems, a distributed self-adaptive multi-source fusion positioning method is provided, a strict interval boundary containing an accurate solution is obtained by adopting interval analysis operation, and the filtering of environmental background noise can be realized on the premise of not being constrained by a system model. Meanwhile, the performance advantages of few particles required by box particle filtering and high running speed are fully utilized, the firefly algorithm is integrated, the extended interval Kalman filtering is combined, the refreshing speed of system positioning information is improved, and the target positioning accuracy and robustness are improved.
Disclosure of Invention
Aiming at the problems in the prior art, the technical problem to be solved by the invention is to provide a distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM, and the specific flow of the method is shown in FIG. 1.
The technical scheme comprises the following implementation steps:
(1) determining the weighted sum of the uniform PDFs p (x):
where x denotes a random variable, i denotes a count unit, N denotes the number of uniformly mixed PDFs, and wiIndicates the probability density, [ x ] corresponding to the ith bin particle]Represents a box particle, U[x]Represents PDF, [ x ] with bin particles as a support seti]The (i) th bin of particles is represented,
(2) predicting probability density p (x) at time k +1k+1|z1,k):
At time k, assume xkThe PDF under the state is expressed as:
according to the time updating step, for the probability density at the k +1 moment:
in the formula, k represents time, xkIs a system state vector, zkIn order to observe the vector, the vector is,the probability density of the ith bin particle at time k,the state vector of the ith bin particle at time k,the PDF for the support set at time k for the ith bin particle,representing supporting header particles of(ii) uniform PDF, [ f [)]To contain the function, [ V ]k]A bin particle corresponding to state transition noise at time k +1, [ Uk]To control the input bin particles.
(3) Determination of State posterior PDFp (x)k+1|z1,k+1):
In the formula etak+1To normalize the coefficient, [ Z ]k+1]Representing the actual observation of the bin particle, SS, at time k +1ψiRepresented as a CSP, is shown to predict the bin particles and constrain them by the relationship of the observation function to the actual observed bin particles to eliminate the excess from the original bin particles.The state value of the ith bin particle at the time k +1,to be composed ofThe constraint is carried out so that,to be composed ofConfined box particle xk+1In order to support the PDF of the set,for a new box of particles after constraint, | [ X ]]And | is the volume of the box particle.
Selecting a proper threshold value, executing random subdivision resampling, and randomly selecting a certain one-dimensional state subinterval of the box particles obtained at the current moment for uniform division according to the resampling times, so that the box particles keep a proper size.
In the formula (I), the compound is shown in the specification,the fluorescence intensity of the ith bin at time k +1,for the predicted observation of the ith bin particle at time k +1, [ Z ]k+1]Is an actual observation. Instead of comparing the fluorescence intensity values between each bin of particles, a comparison is made using the actual observations and the predicted observations for each bin of particles.
(5) Updating global optimal box particle [ g ]k+1]:
Determining the degree of attraction β between the box particles:
wherein N (0,1) is a Gaussian distribution random vector having a mean value of 0 and a variance of 1,as random weight terms, βmIs the maximum attraction, gamma is the light intensity absorption coefficient, diThe spatial distance between the bin particle at time k +1 and the globally optimal bin particle. When the position update is completed, the fluorescence brightness value of the box particle is calculated and compared, and the global optimal box particle [ g ] is updatedk+1]:
In the formula, I ([ X ]) is the fluorescent brightness of the box particle.
Where rand is a random number that is subject to uniform distribution. By updating the positions of the box particles, the box particles are guided to move towards the positions of the globally optimal box particles by utilizing the guiding function exerted by the attraction degree in the updating process. And setting the maximum iteration number, stopping the iteration of the algorithm when the fluorescence brightness function value is larger than the set iteration termination threshold value, and otherwise, continuing the iteration until the maximum iteration number is reached.
(7) Determining innovation and interval Kalman gain:
in the formula (I), the compound is shown in the specification,to be novel, I is the identity matrix,for actual observation, an uncertain interval vector is observed before, a common vector is observed after,in order to observe the inclusion of the function,the interval Kalman gain is represented by the gain of the interval Kalman,in order to carry out the interval polymerization operation,is a Jacobian matrix of intervals,representing the observed noise interval covariance matrix. Updating the environment map construction:
in the formula (I), the compound is shown in the specification,is a constrained interval position vector. And completing environmental characteristic estimation, observing and correlating data collected by the sensor, updating by using EIKF, and perfecting map information.
Compared with the prior art, the invention has the advantages that:
(1) the influence of the background noise of the complex environment on the positioning accuracy is effectively solved, and the filtering efficiency is improved.
(2) The method effectively improves the system operation efficiency, reduces the system response time, improves the system operation speed and accelerates the target positioning update frequency.
Drawings
For a better understanding of the present invention, reference is made to the following further description taken in conjunction with the accompanying drawings.
FIG. 1 is a flow chart of the steps for establishing a distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM;
FIG. 2 is a flow chart of a method for establishing a distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM;
FIG. 3 is a result of locating four sets of distributed multi-source information using the present invention;
detailed description of the preferred embodiments
The present invention will be described in further detail below with reference to examples.
The data selected by the implementation case come from a typical demonstration area of an underground shielding space, 1000 groups of samples are shared in total, wherein 5 scenes including an underground tunnel, a railway tunnel, an underground mall, an underground parking lot and a subway station are provided, each scene has 200 groups of data, 140 groups of samples are extracted from each data in the 5 groups of scenes by adopting a random sampling method to serve as a training set, and the rest are used as a testing set. Finally, the total number of samples used as the training set is 700 and the total number of samples used as the test set is 300.
The overall flow of the distributed multi-source fusion positioning method provided by the invention is shown in figure 1, and the specific steps are as follows:
(1) determining the weighted sum of the uniform PDFs p (x):
in the formula, x represents a random variable, i represents a counting unit, N represents the number of uniformly mixed PDFs, the value is 20, and wiIndicates the probability density, [ x ] corresponding to the ith bin particle]Represents a box particle, U[x]Represents PDF, [ x ] with bin particles as a support seti]The (i) th bin of particles is represented,
(2) predicting probability density p (x) at time k +1k+1|z1,k):
At time k, assume xkThe PDF under the state is expressed as:
according to the time updating step, for the probability density at the k +1 moment:
in the formula, k represents time, xkIs a system state vector, zkIn order to observe the vector, the vector is,the probability density of the ith bin particle at time k,the state vector of the ith bin particle at time k,the PDF for the support set at time k for the ith bin particle,representing supporting header particles of(ii) uniform PDF, [ f [)]To contain the function, [ V ]k]A bin particle corresponding to state transition noise at time k +1, [ Uk]To control the input bin particles.
(3) Determination of State posterior PDFp (x)k+1|z1,k+1):
In the formula etak+1To normalize the coefficient, [ Z ]k+1]Indicating that the bin particle was actually observed at time k +1,expressed as a CSP, expressed as a predicted box particle passage observation function andthe relation of actual observation box particles is restrained and used for eliminating redundant parts in the original box particles.The state value of the ith bin particle at the time k +1,to be composed ofThe constraint is carried out so that,to be composed ofConfined box particle xk+1In order to support the PDF of the set,for a new box of particles after constraint, | [ X ]]And | is the volume of the box particle.
Selecting a proper threshold value, executing random subdivision resampling, and randomly selecting a certain one-dimensional state subinterval of the box particles obtained at the current moment for uniform division according to the resampling times, so that the box particles keep a proper size.
In the formula (I), the compound is shown in the specification,the fluorescence intensity of the ith bin at time k +1,for the predicted observation of the ith bin particle at time k +1, [ Z ]k+1]Is an actual observation. Instead of comparing the fluorescence intensity values between each bin of particles, a comparison is made using the actual observations and the predicted observations for each bin of particles.
(5) Updating global optimal box particle [ g ]k+1]:
Determining the degree of attraction β between the box particles:
wherein N (0,1) is a Gaussian distribution random vector having a mean value of 0 and a variance of 1,as random weight terms, βmThe maximum attraction is 0.85, gamma is the light intensity absorption coefficient and is 1, and diThe spatial distance between the bin particle at time k +1 and the globally optimal bin particle. When the position update is completed, the fluorescence brightness value of the box particle is calculated and compared, and the global optimal box particle [ g ] is updatedk+1]:
In the formula, I ([ X ]) is the fluorescent brightness of the box particle.
Where rand is a random number that is subject to uniform distribution. By updating the positions of the box particles, the box particles are guided to move towards the positions of the globally optimal box particles by utilizing the guiding function exerted by the attraction degree in the updating process. And setting the maximum iteration number, stopping the iteration of the algorithm when the fluorescence brightness function value is larger than the set iteration termination threshold value, and otherwise, continuing the iteration until the maximum iteration number is reached.
(7) Determining innovation and interval Kalman gain:
in the formula (I), the compound is shown in the specification,to be novel, I is the identity matrix,for actual observation, an uncertain interval vector is observed before, a common vector is observed after,in order to observe the inclusion of the function,the interval Kalman gain is represented by the gain of the interval Kalman,in order to carry out the interval polymerization operation,is a Jacobian matrix of intervals,representing the observed noise interval covariance matrix. Updating the environment map construction:
in the formula (I), the compound is shown in the specification,is a constrained interval position vector. And completing environmental characteristic estimation, observing and correlating data collected by the sensor, updating by using EIKF, and perfecting map information.
In order to verify the accuracy of the invention in positioning distributed multi-source information, four groups of multi-source information positioning experiments are carried out on the invention, and the experimental results are shown in fig. 3. As can be seen from fig. 3, the accuracy of the distributed multi-source fusion positioning method provided by the invention for positioning the distributed multi-source information is kept above 96%, and the method can achieve higher accuracy on the basis of ensuring stability, and has good positioning effect. The distributed multi-source fusion positioning method established by the invention is effective, provides a better method for establishing an accurate fusion positioning method model, and has certain practicability.
Claims (1)
1. The invention is characterized in that: (1) determining a weighted sum of the uniform PDFs; (2) predicting the probability density at the k +1 moment; (3) determining state posterior PDF; (4) updating the fluorescence brightness of the box particles; (5) updating global optimal box particles; (6) updating the bin particle position; (7) determining innovation and interval Kalman gain; the method specifically comprises the following seven steps:
the method comprises the following steps: determining the weighted sum of the uniform PDFs p (x):
where x denotes a random variable, i denotes a count unit, N denotes the number of uniformly mixed PDFs, and wiIndicates the summary corresponding to the ith bin particleSpecific density, [ x ]]Represents a box particle, U[x]Represents PDF, [ x ] with bin particles as a support seti]The (i) th bin of particles is represented,
step two: predicting probability density p (x) at time k +1k+1|z1,k):
At time k, assume xkThe PDF under the state is expressed as:
according to the time updating step, for the probability density at the k +1 moment:
in the formula, k represents time, xkIs a system state vector, zkIn order to observe the vector, the vector is,the probability density of the ith bin particle at time k,the state vector of the ith bin particle at time k,the PDF for the support set at time k for the ith bin particle,representing supporting header particles of(ii) uniform PDF, [ f [)]To contain the function, [ V ]k]A bin particle corresponding to state transition noise at time k +1, [ Uk]To control the input of bin particles;
step three: determination of State posterior PDFp (x)k+1|z1,k+1):
In the formula etak+1To normalize the coefficient, [ Z ]k+1]Indicating that the bin particle was actually observed at time k +1,expressed as a CSP, expressed as a predicted box particle, constrained by the relationship of the observation function and the actual observation box particle, and used for eliminating redundant parts in the original box particle;the state value of the ith bin particle at the time k +1,to be composed ofThe constraint is carried out so that,to be composed ofConfined box particle xk+1In order to support the PDF of the set,for a new box of particles after constraint, | [ X ]]L is the volume of the box particle;
selecting a proper threshold value, executing random sub-division resampling, and randomly selecting a certain one-dimensional state subinterval of the box particles obtained at the current moment for uniform division according to the number of resampling times so that the box particles keep a proper size;
In the formula (I), the compound is shown in the specification,the fluorescence intensity of the ith bin at time k +1,for the predicted observation of the ith bin particle at time k +1, [ Z ]k+1]Is an actual observation; comparing the actual observation value with the predicted observation value of each box particle to replace the comparison of the fluorescence brightness value between each box particle;
step five: updating global optimal box particle [ g ]k+1]:
Determining the degree of attraction β between the box particles:
wherein N (0,1) is a Gaussian distribution random vector having a mean value of 0 and a variance of 1,as random weight terms, βmIs the maximum attraction, gamma is the light intensity absorption coefficient, diThe spatial distance between the bin particles at the moment k +1 and the global optimal bin particles is taken as the distance; when the position update is completed, the fluorescence brightness value of the box particle is calculated and compared, and the global optimal box particle [ g ] is updatedk+1]:
Wherein I ([ X ]) is the fluorescent brightness of the box particle;
In the formula, rand is a random number which is subject to uniform distribution; updating the positions of the box particles, and guiding the box particles to move towards the positions of the globally optimal box particles by utilizing the guiding function exerted by the attraction degree in the updating process; setting the maximum iteration number, stopping the iteration of the algorithm when the value of the fluorescence brightness function is larger than the set iteration termination threshold, and otherwise, continuing the iteration until the maximum iteration number is reached;
step seven: determining innovation and interval Kalman gain:
in the formula (I), the compound is shown in the specification,to be novel, I is the identity matrix,for actual observation, there is an uncertainty before being observedAfter being observed, is a normal vector,in order to observe the inclusion of the function,the interval Kalman gain is represented by the gain of the interval Kalman,in order to carry out the interval polymerization operation,is a Jacobian matrix of intervals,representing an observation noise interval covariance matrix; updating the environment map construction:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110327231.3A CN113077055A (en) | 2021-03-26 | 2021-03-26 | Distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110327231.3A CN113077055A (en) | 2021-03-26 | 2021-03-26 | Distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113077055A true CN113077055A (en) | 2021-07-06 |
Family
ID=76610567
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110327231.3A Pending CN113077055A (en) | 2021-03-26 | 2021-03-26 | Distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113077055A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118500386A (en) * | 2024-07-22 | 2024-08-16 | 中国空气动力研究与发展中心设备设计与测试技术研究所 | Wind tunnel model attitude measurement system based on multisource sensor data fusion |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107246873A (en) * | 2017-07-03 | 2017-10-13 | 哈尔滨工程大学 | A kind of method of the mobile robot simultaneous localization and mapping based on improved particle filter |
CN107589748A (en) * | 2017-08-21 | 2018-01-16 | 江苏科技大学 | AUV autonomous navigation methods based on UnscentedFastSLAM algorithms |
CN109459033A (en) * | 2018-12-21 | 2019-03-12 | 哈尔滨工程大学 | A kind of robot of the Multiple fading factor positions without mark Fast synchronization and builds drawing method |
CN110602647A (en) * | 2019-09-11 | 2019-12-20 | 江南大学 | Indoor fusion positioning method based on extended Kalman filtering and particle filtering |
-
2021
- 2021-03-26 CN CN202110327231.3A patent/CN113077055A/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107246873A (en) * | 2017-07-03 | 2017-10-13 | 哈尔滨工程大学 | A kind of method of the mobile robot simultaneous localization and mapping based on improved particle filter |
CN107589748A (en) * | 2017-08-21 | 2018-01-16 | 江苏科技大学 | AUV autonomous navigation methods based on UnscentedFastSLAM algorithms |
CN109459033A (en) * | 2018-12-21 | 2019-03-12 | 哈尔滨工程大学 | A kind of robot of the Multiple fading factor positions without mark Fast synchronization and builds drawing method |
CN110602647A (en) * | 2019-09-11 | 2019-12-20 | 江南大学 | Indoor fusion positioning method based on extended Kalman filtering and particle filtering |
Non-Patent Citations (1)
Title |
---|
罗景文,秦世引: "基于智能优化箱粒子滤波的移动机器人FastSLAM", 《北京航空航天大学学报》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118500386A (en) * | 2024-07-22 | 2024-08-16 | 中国空气动力研究与发展中心设备设计与测试技术研究所 | Wind tunnel model attitude measurement system based on multisource sensor data fusion |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101975575B (en) | Multi-target tracking method for passive sensor based on particle filtering | |
CN111798991B (en) | LSTM-based method for predicting population situation of new coronary pneumonia epidemic situation | |
CN111832462B (en) | Frequency hopping signal detection and parameter estimation method based on deep neural network | |
CN101281648A (en) | Method for tracking dimension self-adaption video target with low complex degree | |
CN115327616B (en) | Automatic positioning method for mine microseism focus driven by massive data | |
CN113393032B (en) | Track circulation prediction method based on resampling | |
CN111191786A (en) | Transfer learning algorithm based on active learning | |
CN116796141A (en) | GBDT regression model-based office building energy consumption prediction method | |
CN113077055A (en) | Distributed multi-source fusion positioning method based on FBPF-EIKF-FastSLAM | |
CN118485113A (en) | New energy typical output generation model construction method, device, equipment and medium | |
CN115691140B (en) | Analysis and prediction method for space-time distribution of automobile charging demand | |
CN117131654A (en) | Target observation method based on nonlinear optimal disturbance of pre-analysis initial guess condition | |
CN117036917A (en) | Automatic error correction method based on deep learning | |
CN115097437B (en) | Underwater target tracking track approaching intersection solving method based on label multiple Bernoulli detection front tracking algorithm | |
CN114679683B (en) | Indoor intelligent positioning method based on derived fingerprint migration | |
CN114199992B (en) | Method and system for detecting corrosion of tank wall of oil storage tank | |
CN116106890A (en) | Radar target track starting method based on quantum particle swarm and LGBM | |
CN114172770B (en) | Modulation signal identification method of quantum root tree mechanism evolution extreme learning machine | |
CN103473562A (en) | Automatic training and identifying system for specific human body action | |
Gao et al. | Cultural quantum-inspired shuffled frog leaping algorithm for direction finding of non-circular signals | |
CN113011597A (en) | Deep learning method and device for regression task | |
CN111931412A (en) | Underwater target noise LOFAR spectrogram simulation method based on generative countermeasure network | |
CN116776230B (en) | Method and system for identifying signal based on feature imprinting and feature migration | |
Yang et al. | Multi-task Meta Label Correction for Time Series Prediction | |
CN112762921B (en) | Robot probability map updating method based on humanoid memory mechanism |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210706 |