模拟退火方差缩减的FastSLAM算法在AUV导航定位中的应用  

Application of FastSLAM based on simulated annealing variance reduction in navigation and localization of AUV

作　　者：王宏健[1] 王晶[1] 曲丽萍[1,2] 刘振业 

机构地区：[1]哈尔滨工程大学自动化学院,黑龙江哈尔滨150001 [2]北华大学电气信息工程学院,吉林吉林132021

出　　处：《哈尔滨工程大学学报》2013年第3期338-344,共7页Journal of Harbin Engineering University

基　　金：国家自然科学基金资助项目(E091002/50979017);教育部高等学校博士学科点专项科研基金资助项目(20092304110008);中央高校基本科研业务费专项资金资助项目(HEUCFZ 1026);哈尔滨市科技创新人才(优秀学科带头人)研究专项资金项目资助项目(2012RFXXG083)

摘　　要：由于标准FastSLAM中存在粒子退化及重采样引起的粒子贫化,导致自主水下航行器(AUV)位置估计精度严重下降的问题,提出了一种基于粒子权值方差缩减的FastSLAM算法.利用模拟退火的降温函数产生自适应指数渐消因子来降低粒子权值的方差,进而增加有效粒子数,以此取代标准FastSLAM中的重采样步骤.建立AUV的运动学模型、特征模型及传感器的测量模型,通过霍夫变换进行特征提取.利用方差缩减FastSLAM算法,基于海试数据进行了AUV同步定位与构图仿真试验,结果表明所提方法能够保证粒子的多样性,并且降低粒子的退化程度,提高了AUV定位与地图构建系统的准确性及稳定性.The FastSLAM algorithm based on variance reduction of particle weight was presented in order to solve the decrease of estimated accuracy of AUV（autonomous underwater vehicle）,location due to particles degeneracy and the sample impoverishment as a result of resampling in standard FastSLAM.The variance of particle weight was decreased by generating an adaptive exponential fading factor,which came from the thought of cooling function in simulated annealing.The effective particle number was increased by application of FastSLAM based on simulated annealing variance reduction in navigation and localization of AUV.Resampling in standard FastSLAM was replaced with it.Establish the kinematic model of AUV,feature model and measurement models of sensors,and make feature extraction with Hough transform.The experiment of AUV＇s simultaneous localization and mapping using simulated annealing variance reduction FastSLAM was based on trial data.The results indicate that the method described in this paper maintains the diversity of the particles,however,weakens the degeneracy,while at the same time enhances the accuracy stability of AUV＇s navigation and localization system.

关 键 词：FASTSLAM 权值方差缩减 样本退化 样本贫化 霍夫变换 

分 类 号：TP242.6[自动化与计算机技术—检测技术与自动化装置]