基于组合EKF的自主水下航行器SLAM

SLAM of AUV Based on the Combined EKF

  • 摘要: 针对标准扩展卡尔曼滤波(EKF)在噪声统计特性不准确、系统模型与实际模型无法完全匹配情况下滤波精度严重下降的问题,提出了一种基于Sage-Husa自适应EKF和强跟踪EKF组合的SLAM(同步定位与地图构建)算法.首先建立了AUV(自主水下航行器)的动力学模型、特征模型以及传感器的测量模型,然后通过Hough变换进行特征提取,最终采用组合EKF实现了自主水下航行器的同步定位与地图构建.海试数据仿真试验表明本文所提方法降低了噪声统计特性时变以及模型不精确对系统的影响,提高了SLAM系统的精确性和鲁棒性.

     

    Abstract: A simultaneous localization and mapping(SLAM) algorithm based on the combined EKF(extended Kalman filter) of Sage-Husa adaptive EKF and strong tracking EKF is presented to solve the decrease of filtering accuracy of standard EKF when the statistical characteristics of noise are not accurate and the model builded can not match with the actual one completely.Firstly,the dynamic model,feature model and sensor measurement model of AUV(autonomous underwater vehicle) are set up.Then,feature extraction is implemented through Hough transform,and SLAM of AUV is realized with the combined EKF eventually.Simulation with trial data shows that the described method reduces the influence of both the time-variance of statistical characteristics of noise and the inaccuracy of model,and enhances the accuracy and robustness of SLAM system.

     

/

返回文章
返回