摘要
Mobile robot systems performing simultaneous localization and mapping(SLAM) are generally plagued by non-Gaussian noise.To improve both accuracy and robustness under non-Gaussian measurement noise,a robust SLAM algorithm is proposed.It is based on the square-root cubature Kalman filter equipped with a Huber' s generalized maximum likelihood estimator(GM-estimator).In particular,the square-root cubature rule is applied to propagate the robot state vector and covariance matrix in the time update,the measurement update and the new landmark initialization stages of the SLAM.Moreover,gain weight matrices with respect to the measurement residuals are calculated by utilizing Huber' s technique in the measurement update step.The measurement outliers are suppressed by lower Kalman gains as merging into the system.The proposed algorithm can achieve better performance under the condition of non-Gaussian measurement noise in comparison with benchmark algorithms.The simulation results demonstrate the advantages of the proposed SLAM algorithm.
Mobile robot systems performing simultaneous localization and mapping ( SLAM) are generally plagued by non-Gaussian noise.To improve both accuracy and robustness under non-Gaussian meas-urement noise, a robust SLAM algorithm is proposed.It is based on the square-root cubature Kal-man filter equipped with a Huber’ s generalized maximum likelihood estimator ( GM-estimator) .In particular, the square-root cubature rule is applied to propagate the robot state vector and covariance matrix in the time update, the measurement update and the new landmark initialization stages of the SLAM.Moreover, gain weight matrices with respect to the measurement residuals are calculated by utilizing Huber’ s technique in the measurement update step.The measurement outliers are sup-pressed by lower Kalman gains as merging into the system.The proposed algorithm can achieve bet-ter performance under the condition of non-Gaussian measurement noise in comparison with benchmark algorithms.The simulation results demonstrate the advantages of the proposed SLAM algorithm.
基金
Supported by the National High Technology Research and Development Program of China(2010AA09Z104)
the Fundamental Research Funds of the Zhejiang University(2014FZA5020)
关键词
卡尔曼滤波器
SLAM
GM估计
平方根
贝尔
容积
非高斯噪声
机器人系统
square-root cubature Kalman filter, simultaneous localization and mapping(SLAM), Huber' s GM-estimator, robustness