基于一致性的FastSLAM算法的优化
Optimization of FastSLAM Algorithm Based on Consistency
摘要: 本文从可观测性的角度研究FastSLAM算法的一致性问题并对算法进行了改进。相比较于传统的FastSLAM算法，一种改进的FastSLAM算法被提出从而获得更好的一致性性能。首先，在重要性采样阶段，对象标记法用于清晰地标注单个粒子状态。此外，在地图估计阶段，将第一估计雅可比矩阵(FEJ)与扩展卡尔曼滤波相结合以此提高了算法的一致性。最后，通过仿真实例验证了改进的FastSLAM算法的有效性。
Abstract: In this paper, the consistency of FastSLAM algorithm is improved from the perspective of observability. Rather than the traditional ones, an improved FastSLAM algorithm is proposed to achieve better consistent performance of FastSLAM. First, in the importance sampling phase, the object labeling method is used to clearly label individual particle states. Moreover, in the stage of map estimation, the First Estimates Jacobian (FEJ) is combined with the extended Kalman filtering to improve the consistency of the algorithm. Finally, the effectiveness of the proposed improved FastSLAM algorithm is validated through a simulation example.
文章引用：耿小毛. 基于一致性的FastSLAM算法的优化[J]. 理论数学, 2024, 14(1): 302-317. https://doi.org/10.12677/PM.2024.141031

参考文献

[1] Davison, A.J., Reid, I.D., Molton, N.D., et al. (2007) Monoslam: Real-Time Single Camera Slam. IEEE Transactions on Pattern Analysis and Machine Intelligence, 29, 1052-1067. [Google Scholar] [CrossRef] 
[2] 刘俊恺. 基于ROS平台的FastSLAM算法改进与应用研究[D]: [硕士学位论文]. 南昌: 华东交通大学, 2019.
[3] Martinez-Cantin, R. and Castellanos, J.A. (2005) Unscented Slam for Large-Scale Outdoor Environments. The IEEE/RSJ International Conference on Intelligent Robots & Systems, Edmonton, AB, 2-6 August 2005, 3427-3432. [Google Scholar] [CrossRef] 
[4] Montemerlo, M., Thrun, S., Koller, D., et al. (2002) FastSLAM: A Factored Solution to the Simultaneous Localization and Mapping Problem. The 18th National Conference on Artificial Intelligence (AAAI), California, 28 July-1 August 2002, 593-598.
[5] 赵挽东. 复杂场景下机器人SLAM算法研究[D]: [硕士学位论文]. 哈尔滨: 哈尔滨工程大学, 2019.
[6] Julier, S.J. and Uhlmann, J.K. (2001) A Counter Example to the Theory of Simultaneous Localization and Map Building. The 2001 ICRA, IEEE International Conference on Robotics and Automation, Seoul, 21-26 May 2001, 4238-4243.
[7] Bar-Shalom, Y., Kirubarajan, T. and Li, X.R. (2001) Estimation with Applications to Tracking and Navigation. John Wiley & Sons, New York. [Google Scholar] [CrossRef] 
[8] Castellanos, J.A., Neira, J. and Tardós, J.D. (2004) Limits to the Con-sistency of Ekf-Based Slam. IFAC Proceedings Volumes, 37, 716-721. [Google Scholar] [CrossRef] 
[9] Huang, G. (2017) Towards Consistent Filtering for Dis-crete-Time Partially-Observable Nonlinear Systems. Systems & Control Letters, 106, 87-95. [Google Scholar] [CrossRef] 
[10] 姜晓燕. 基于粒子滤波和一致性分析的同时定位与地图构建算法研究[D]: [硕士学位论文]. 青岛: 中国海洋大学, 2014.
[11] Murphy, K.P. (1999) Bayesian Map Learning in Dynamic Environments. Advances in Neural Information Processing Systems, 12, 1015-1021.
[12] Montemerlo, M., Thrun, S., Koller, D., et al. (2003) FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Locali-zation and Mapping That Provably Converges. The IJCAI, 3, 1151-1156.
[13] He, B., Liang, Y., Feng, X., et al. (2012) Auv Slam and Experiments Using a Mechanical Scanning Forward-Looking Sonar. Sensors, 12, 9386-9410. [Google Scholar] [CrossRef] [PubMed]
[14] Zhang, L., Meng, X.J. and Chen, Y.W. (2009) Convergence and Con-sistency Analysis for FastSLAM. The 2009 IEEE Intelligent Vehicles Symposium, Xi’an, 3-5 June 2009, 447-452.
[15] Vo, B.T. and Vo, B.N. (2013) Labeled Random Finite Sets and Multi-Object Conjugate Priors. IEEE Transactions on Signal Processing, 61, 3460-3475. [Google Scholar] [CrossRef] 
[16] Vo, B.N., Vo, B.T. and Phung, D. (2014) Labeled Random Finite Sets and the Bayes Multi-Target Tracking Filter. IEEE Transactions on Signal Processing, 62, 6554-6567. [Google Scholar] [CrossRef] 
[17] Huang, G.P., Mourikis, A.I. and Roumeliotis, S.I. (2008) Analysis and Improvement of the Consistency of Extended Kalman Filter-Based Slam. 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, 19-23 May 2008, 473-479. [Google Scholar] [CrossRef] 
[18] Huang, G., Mourikis, A.I. and Roumeliotis, S.I. (2010) Observability-Based Rules for Designing Consistent Ekf Slam Estimators. International Journal of Robotics Research, 29, 502-528. [Google Scholar] [CrossRef] 
[19] Huang, G., Mourikis, A.I. and Roumeliotis, S.I. (2009) A First-Estimates Jacobian Ekf for Improving Slam Consistency. In: Khatib, O., Kumar, V. and Pappas, G.J., Eds., Experimental Robotics, Vol. 54, Springer, Berlin Heidelberg, 373-382. [Google Scholar] [CrossRef] 
[20] Fox, D. (2003) Adapting the Sample Size in Particle Filters through Kld-Sampling. The International Journal of Robotics Research, 22, 985-1003. [Google Scholar] [CrossRef] 
[21] Johnson, N.L., Kotz, S. and Balakrishnan, N. (1995) Con-tinuous Univariate Distributions. 2nd Edition, Vol. 289, John Wiley & Sons, New York.
[22] SLAM-Algorithms-Octave.
https://github.com/kiran-mohan/SLAM-Algorithms-Octave.git
[23] FastSLAM.
https://github.com/XiaoLiSean/fastSLAM.git

为你推荐