To adjust the samples of filtering adaptively,an improved Gaussian particle filter algorithm based on Kullback-Leibler divergence(KLD)-sampling(KLGPF)is proposed in this paper.During the process of sampling,the algori...To adjust the samples of filtering adaptively,an improved Gaussian particle filter algorithm based on Kullback-Leibler divergence(KLD)-sampling(KLGPF)is proposed in this paper.During the process of sampling,the algorithm calculates the KLD to adjust the size of the particle set between the discrete probability density function of particles and the true posterior probability density function.KLGPF has significant effect when the noise obeys Gaussian distribution and the statistical characteristics of noise change abruptly.Simulation results show that KLGPF could maintain a good estimation effect when the noise statistics changes abruptly.Compared with the particle filter algorithm using KLD-sampling(KLPF),the speed of KLGPF increases by 28%under the same conditions.展开更多
Determination of relative three-dimensional （3D） position, orientation, and relative motion between two reference frames is an important problem in robotic guidance, manipulation, and assembly as well as in other fi...Determination of relative three-dimensional （3D） position, orientation, and relative motion between two reference frames is an important problem in robotic guidance, manipulation, and assembly as well as in other fields such as photogrammetry. A solution to pose and motion estimation problem that uses two-dimensional （2D） intensity images from a single camera is desirable for real-time applications. The difficulty in performing this measurement is that the process of projecting 3D object features to 2D images is a nonlinear transformation. In this paper, the 3D transformation is modeled as a nonlinear stochastic system with the state estimation providing six degrees-of-freedom motion and position values, using line features in image plane as measuring inputs and dual quaternion to represent both rotation and translation in a unified notation. A filtering method called the Gaussian particle filter （GPF） based on the panicle filtering concept is presented for 3D pose and motion estimation of a moving target from monocular image sequences. The method has been implemented with simulated data, and simulation results are provided along with comparisons to the extended Kalman filter （EKF） and the unscented Kalman filter （UKF） to show the relative advantages of the GPF. Simulation results showed that GPF is a superior alternative to EKF and UKF.展开更多
To solve the problem of information fusion in the strapdown inertial navigation system(SINS)/celestial navigation system(CNS)/global positioning system(GPS) integrated navigation system described by the nonlinear/non-...To solve the problem of information fusion in the strapdown inertial navigation system(SINS)/celestial navigation system(CNS)/global positioning system(GPS) integrated navigation system described by the nonlinear/non-Gaussian error models,a new algorithm called the federated unscented particle filtering(FUPF) algorithm was introduced.In this algorithm,the unscented particle filter(UPF) served as the local filter,the federated filter was used to fuse outputs of all local filters,and the global filter result was obtained.Because the algorithm was not confined to the assumption of Gaussian noise,it was of great significance to integrated navigation systems described by the non-Gaussian noise.The proposed algorithm was tested in a vehicle's maneuvering trajectory,which included six flight phases:climbing,level flight,left turning,level flight,right turning and level flight.Simulation results are presented to demonstrate the improved performance of the FUPF over conventional federated unscented Kalman filter(FUKF).For instance,the mean of position-error decreases from(0.640×10-6 rad,0.667×10-6 rad,4.25 m) of FUKF to(0.403×10-6 rad,0.251×10-6 rad,1.36 m) of FUPF.In comparison of the FUKF,the FUPF performs more accurate in the SINS/CNS/GPS system described by the nonlinear/non-Gaussian error models.展开更多
基金the China Postdoctoral Science Foundation(No.171980)the National Natural Science Foundation of China(Nos.61973160,51505221)Key Laboratory Fund of Science and Technology on Communication Networks(No.6142104180114).
文摘To adjust the samples of filtering adaptively,an improved Gaussian particle filter algorithm based on Kullback-Leibler divergence(KLD)-sampling(KLGPF)is proposed in this paper.During the process of sampling,the algorithm calculates the KLD to adjust the size of the particle set between the discrete probability density function of particles and the true posterior probability density function.KLGPF has significant effect when the noise obeys Gaussian distribution and the statistical characteristics of noise change abruptly.Simulation results show that KLGPF could maintain a good estimation effect when the noise statistics changes abruptly.Compared with the particle filter algorithm using KLD-sampling(KLPF),the speed of KLGPF increases by 28%under the same conditions.
基金Project (No. 2006J0017) supported by the Natural Science Foundation of Fujian Province, China
文摘Determination of relative three-dimensional （3D） position, orientation, and relative motion between two reference frames is an important problem in robotic guidance, manipulation, and assembly as well as in other fields such as photogrammetry. A solution to pose and motion estimation problem that uses two-dimensional （2D） intensity images from a single camera is desirable for real-time applications. The difficulty in performing this measurement is that the process of projecting 3D object features to 2D images is a nonlinear transformation. In this paper, the 3D transformation is modeled as a nonlinear stochastic system with the state estimation providing six degrees-of-freedom motion and position values, using line features in image plane as measuring inputs and dual quaternion to represent both rotation and translation in a unified notation. A filtering method called the Gaussian particle filter （GPF） based on the panicle filtering concept is presented for 3D pose and motion estimation of a moving target from monocular image sequences. The method has been implemented with simulated data, and simulation results are provided along with comparisons to the extended Kalman filter （EKF） and the unscented Kalman filter （UKF） to show the relative advantages of the GPF. Simulation results showed that GPF is a superior alternative to EKF and UKF.
基金Project(60535010) supported by the National Nature Science Foundation of China
文摘To solve the problem of information fusion in the strapdown inertial navigation system(SINS)/celestial navigation system(CNS)/global positioning system(GPS) integrated navigation system described by the nonlinear/non-Gaussian error models,a new algorithm called the federated unscented particle filtering(FUPF) algorithm was introduced.In this algorithm,the unscented particle filter(UPF) served as the local filter,the federated filter was used to fuse outputs of all local filters,and the global filter result was obtained.Because the algorithm was not confined to the assumption of Gaussian noise,it was of great significance to integrated navigation systems described by the non-Gaussian noise.The proposed algorithm was tested in a vehicle's maneuvering trajectory,which included six flight phases:climbing,level flight,left turning,level flight,right turning and level flight.Simulation results are presented to demonstrate the improved performance of the FUPF over conventional federated unscented Kalman filter(FUKF).For instance,the mean of position-error decreases from(0.640×10-6 rad,0.667×10-6 rad,4.25 m) of FUKF to(0.403×10-6 rad,0.251×10-6 rad,1.36 m) of FUPF.In comparison of the FUKF,the FUPF performs more accurate in the SINS/CNS/GPS system described by the nonlinear/non-Gaussian error models.
