Gaussian particle filter based pose and motion estimation

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.

An Improved Gaussian Particle Filter Algorithm Using KLD-Sampling

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.

A kind of fast Gaussian particle filter based on Artificial Fish School Algorithm

This paper proposes an improved Gaussian particle filter integratingthe Artificial Fish School Algorithm to optimise the measured values to improve the overall estimation accuracy of the system.Meanwhile,it also solves the problems of susceptibility to interference and insufficient estimation accuracy in nonlinear systems.Furthermore,since the calculation time of the fusion algorithm increases,in order to ensure the speed of state estimation,the linear transformation of standard particle swarm is used to replace the particle sampling link of Gaussian particle filter.Simulation results show that the calculation speed of a fast Gaussian Particle Filter based on the Artificial Fish School Algorithm is 21.7%faster than the Particle Filter based on the Artificial Fish School Algorithm.Compared with Particle Filter,Gaussian particle filter,and the Artificial Fish School Algorithm,the proposed algorithm has a higher accuracy.

An evolutionary particle filter based EM algorithm and its application

In this paper, an evolutionary recursive Bayesian estimation algorithm is presented, which incorporates the latest observation with a new proposal distribution, and the posterior state density is represented by a Gaussian mixture model that is recovered from the weighted particle set of the measurement update step by means of a weighted expectation-maximization algorithm. This step replaces the resampling stage needed by most particle filters and relieves the effect caused by sample impoverishment. A nonlinear tracking problem shows that this new approach outperforms other related particle filters.

Object Detection and Tracking Method of AUV Based on Acoustic Vision

This paper describes a new framework for object detection and tracking of AUV including underwater acoustic data interpolation, underwater acoustic images segmentation and underwater objects tracking. This framework is applied to the design of vision-based method for AUV based on the forward looking sonar sensor. First, the real-time data flow （underwater acoustic images） is pre-processed to form the whole underwater acoustic image, and the relevant position information of objects is extracted and determined. An improved method of double threshold segmentation is proposed to resolve the problem that the threshold cannot be adjusted adaptively in the traditional method. Second, a representation of region information is created in light of the Gaussian particle filter. The weighted integration strategy combining the area and invariant moment is proposed to perfect the weight of particles and to enhance the tracking robustness. Results obtained on the real acoustic vision platform of AUV during sea trials are displayed and discussed. They show that the proposed method can detect and track the moving objects underwater online, and it is effective and robust.