On WSN-Aided Simultaneous Localization and Mapping Based on Particle Filtering
LI Yang-ming1,2,3, MENG Qing-hu1, LIANG Hua-wei1,3, LI Shuai1,2,3, CHEN Wan-ming1,2,3
1. Center for Biomimetic Sensing and Control Research, Institute of Intelligent Machines, Chinese Academy of Sciences, Hefei 230031, China; 2. Department of Automation, School of Information Science and Technology, University of Science and Technology of China, Hefei 230026, China; 3. The Key Laboratory of Biomimetic Sensing and Advanced Robot Technology, Anhui Province, Hefei 230031, China
Abstract:A novel WSN-aided SLAM(simultaneous localization and mapping)method is proposed for mobile robot to solve two main problems in traditional SLAM methods,i.e.,high dimensions in problem spaces and difficulties in multi- target data association.Model for the WSN-aided SLAM method is.built,and noises are analyzed.Then a distributed particle filtering(PF)data fusion algorithm suitable for this method is developed.The key steps,such as particle initializa- tion,prediction,sequential importance sampling,resampling,are particularly analyzed,and the validity and efficiency of the method are testified by simulation experiment.The experiment results demonstrate that,when the PF algorithm is used and the WSN is integrated for aided navigation,the dimensions of problem spaces can be greatly reduced,the multi-target data association problems can be solved and blind nodes can be located with high precision independent of the anchor node.The precision of localization and mapping for mobile robots can be effectively improved,and the error accumulation of inertial navigation can be effectively suppressed especially when the robot closed-loop track is not required.
[1] 张恒,樊晓平.移动机器人同步定位与地图构建过程中的轨迹规划研究[J].机器人,2006,28(3):285~290.Zhang Heng,Fan Xiao-ping.Mobile robot trajectory planning in simultaneous localization and mapping problem[J].Robot,2006,28(3):285~290.
[2] Durrant-Whyte H,Bailey T.Simultaneous localization and mapping:Part[J].IEEE Robotics and Automation Magazine,2006,13(2):99~108.
[3] Huang S D,Dissanayake G.Convergence and consistency analysis for extended Kalman filter based SLAM[J].IEEE Transactious on Robotics,2007,23(5):1036~1049.
[4] Davey S J.Simultaneous localization and map building using the probabilistic multi-hypothesis tracker[J].IEEE Transactions on Robotics,2007,23(2):271~280.
[5] 邓宏彬,贾云得,刘书华,等.一种基于无线传感器网络的星球漫游机器人定位算法[J].机器人,2007,29(4):384~388.Deng Hong-bin,Jia Yun-de,Liu Su-hua.et al.A planetary rovor localization algorithm based on wireless sensor network[J].Robot,2007,29(4):384~388.
[6] Bevly DM,Parkinson B.Cascaded Kalman filters for accurate estimation of multiple biases,dead-reckoning navigation,and full slate feedback control of ground vehicles[J].IEEE Transactions on Control Systems Technology,2007,15(2):199~208.
[7] Li Y M,Meng M Q H,CheII W M.Data fusion based on RBF and nonparametric estimation for localization in wireless aensor networks[A].Proceedings of the IEEE Conference on Robotics and Biomimetics[C].Piscamway,NJ,USA:IEEE,2007.1361~1365.
[8] Doucct A,Godsill S.Andrieu C.On sequential Monte Carlo sampling methods for Bayesian filtering[J].Statistics and Computing,2000,10(3):197~208.
[9] Godsiil S,Doncet A,West M.Maximum a posteriori sequence estimation using Monte-Cado particle filters[J].Annalg of the Iustimte of Stafistical Mathematics,2001,53(1):82~96.
[10] 梁华为,陈万明,李帅,等.基于无线传感器网络的移动目标导航方法[J].传感技术学报,2007,20(7):1620~1624.Liang Hua-wei,Chen Wan-ming.Li Shuai.et al.Navigation algorithm for mobile object based on wireless sensor networks[J].Chinese Journal of Sensors and Actuators.2007.20(7):1620~1624.