Second-order divided difference filter for vision-based relative navigation

A second-order divided difference filter (SDDF) is derived for integrating line of sight measurement from vision sensor with acceleration and angular rate measurements of the follower to estimate the precise relative position,velocity and attitude of two unmanned aerial vehicles (UAVs).The second-order divided difference filter which makes use of multidimensional interpolation formulations to approximate the nonlinear transformations could achieve more accurate estimation and faster convergence from inaccurate initial conditions than standard extended Kalman filter.The filter formulation is based on relative motion equations.The global attitude parameterization is given by quarternion,while a generalized three-dimensional attitude representation is used to define the local attitude error.Simulation results are shown to compare the performance of the second-order divided difference filter with a standard extended Kalman filter approach.

Application of Adaptive Divided Difference Filter on GPS/IMU Integrated Navigation System

The efficient and accurate approximate nonlinear filters have been widely used in the estimation of states and parameters of dynamical systems. In this paper, an adaptive divided difference filter is designed for precise estimation of states and parameters of micromechanical gyro navigation system. Based on the investigation of nonlinear divided difference filter the adaptive divided difference filter(ADDF) was designed, which takes account of the incorrect time-varying noise statistics of dynamical systems and compensation of the nonlinearity effects neglected by linearization. And its performance is superior to that of DDF and extended Kalman filter(EKF). Simulation results indicate that the advantages of the proposed nonlinear filters make them attractive alternatives to the extended Kalman filter.

Square-root divided difference Rauch-Tung-Striebel smoother

A square-root version of the divided difference Rauch-Tung-Striebel (RTS) smoother is proposed in this paper. The square-root variant essentially propagates the square roots of the covariance matrices and can consistently improve the numerical stability because all the resulting covariance matrices are guaranteed to stay positive semi-definite. Furthermore, the square-root form ensures reliable implementation in an embedded system with fixed or limited precision although it is algebraically equivalent to the standard form. The new smoothing algorithm is tested in a challenging two-dimensional maneuvering target tracking problem with unknown and time-varying turn rate, and its performance is compared with that of other de-facto standard filters and smoothers. The simulation results indicate that the proposed RTS smoother markedly outperforms the associated filters and gives slightly smaller error than an unscented-based RTS smoother.

New sigma point filtering algorithms for nonlinear stochastic systems with correlated noises

New sigma point filtering algorithms, including the unscented Kalman filter （UKF） and the divided difference filter （DDF）, are designed to solve the nonlinear filtering problem under the condition of correlated noises. Based on the minimum mean square error estimation theory, the nonlinear optimal predictive and correction recursive formulas under the hypothesis that the input noise is correlated with the measurement noise are derived and can be described in a unified framework. Then, UKF and DDF with correlated noises are proposed on the basis of approximation of the posterior mean and covariance in the unified framework by using unscented transformation and second order Stirling＇s interpolation. The proposed UKF and DDF with correlated noises break through the limitation that input noise and measurement noise must be assumed to be uneorrelated in standard UKF and DDF. Two simulation examples show the effectiveness and feasibility of new algorithms for dealing with nonlinear filtering issue with correlated noises.