An improved FastSLAM based on the robust square-root cubature Kalman filter (RSRCKF) with partial genetic resampling is proposed in this paper. In the proposed method, RSRCKF is used to design the proposal distribution of FastSLAM and to estimate environment landmarks. The proposed method does not require a priori knowledge of the noise statistics. In addition, to increase diversity, it uses the genetic operators-based strategy to further improve the particle diversity. In fact, a partial genetic resampling operation is carried out to maintain the diversity of particles. The proposed method is compared with other methods via simulation and experimental data. It can be seen from the results that the proposed method provides significantly more accurate and robust estimation results compared with other methods even with fewer particles and unknown a priori. In addition, the consistency of the proposed method is better than that of other methods.

The High-degree Cubature Kalman Filter (HCKF) is proposed as a novel methodology based on the arbitrary degree spherical rule, which can achieve better performance than the traditional Kalman filter. However, it also has a large calculation burden when used in a high-dimension and high-degree of accuracy estimation system. The number of sampling points of an HCKF increases polynomially with increasing state-space dimensions, which further increases the calculation burden. The reduction of the number of the state-space dimensions is the main contribution of this study. A strategy for HCKF based on the partitioning of the state-space and orthogonal principle is introduced, referred to as the Multiple Robust HCKF (MRHCKF). It is shown that this technique can effectively reduce the calculation burden for the high-dimension system with robust performance. Numerical simulations are performed for the example of high-dimension relative position and attitude estimation to show that the proposed method can obtain nearly the same performance as the HCKF, while drastically reducing computational complexity.

The objective of this paper is to accurately determine mobile robots' position and orientation by integrating information received from odometry and an inertial sensor. The position and orientation provided by odometry are subject to different types of errors. To improve the odometry, an inertial measurement unit is exploited to give more reliable attitude information. However, the nonlinear dynamic of these systems and their complexities such as different sources of errors make navigation difficult. Since the dynamic models of navigation systems are nonlinear in practice, in this study, a Cubature Kalman Filter (CKF) has been proposed to estimate and correct the errors of these systems. The information from odometry and a gyroscope are integrated using a CKF. Simulation results are provided to illustrate the superiority and the higher reliability of the proposed approach in comparison with conventional nonlinear filtering algorithms such as an Extended Kalman Filter (EKF).

A robust state estimation technique based on the Huber-based Cubature Kalman Filter (HCKF) is proposed for Global Positioning System (GPS) navigation processing. The Cubature Kalman Filter (CKF) employs a third-degree spherical-radial cubature rule to compute the Gaussian weighted integration, such that the numerical instability induced by round-off errors can be avoided. In GPS navigation, the filter-based estimation of the position and velocity states can be severely degraded due to contaminated measurements caused by outliers or deviation from a Gaussian distribution assumption. For the signals contaminated with non-Gaussian noise or outliers, a robust scheme combining the Huber M-estimation methodology and the CKF framework is beneficial where the Huber M-estimation methodology is used to reformulate the measurement information of the CKF. GPS navigation processing using the HCKF algorithm has been carried out and the performance has been compared to those based on the Extended Kalman Filter (EKF), Unscented Kalman Filter (UKF) and CKF approaches. Simulation and experimental results presented in this paper confirm the effectiveness of the method.

A new nonlinear robust filter is proposed in this paper to deal with the outliers of an integrated Global Positioning System/Strapdown Inertial Navigation System (GPS/SINS) navigation system. The influence of different design parameters for an H∞ cubature Kalman filter is analysed. It is found that when the design parameter is small, the robustness of the filter is stronger. However, the design parameter is easily out of step in the Riccati equation and the filter easily diverges. In this respect, a singular value decomposition algorithm is employed to replace the Cholesky decomposition in the robust cubature Kalman filter. With large conditions for the design parameter, the new filter is more robust. The test results demonstrate that the proposed filter algorithm is more reliable and effective in dealing with the outliers in the data sets produced by the integrated GPS/SINS system.