Skip to main content
SpringerLink
Log in

Particle swarm optimization for solving a scan-matching problem based on the normal distributions transform

  • Research Paper
  • Published:
Evolutionary Intelligence Aims and scope Submit manuscript

Abstract

In this paper, an evolutionary scan-matching approach is proposed to solve an optimization issue in simultaneous localization and mapping (SLAM). A rich literature has been invested in this direction, however, most of the proposed approaches lack fast convergence and simplicity regarding the optimization process, which should directly affect the accuracy of the environment’s map and the estimated pose. It is a line of research that is always active, offering various solutions to this issue. Among many SLAM methods, the normal distributions transform approach (NDT) has shown high performances, where numerous works have been published up to date and many studies demonstrate its efficiency wrt other methods. Nevertheless, few works have been interested to solve the optimization issue. The proposed solution is based on NDT scan-matching using particle swarm optimization (PSO) and it is dubbed NDT-PSO. The main contribution is to solve the pose estimation problem based on PSO and iterative NDT maps. The performances of the NDT-PSO approach have been proven in real experiments performed on a car-like mobile robot in both static and dynamic environments. NDT-PSO is tested for different swarm sizes, and the results show that 70 particles are more than enough to find the best particle while avoiding local minima even in loop closing. The algorithm is also suitable for real time applications, with an average runnnig time of \(145 \rm{ms}\) for 70 particles and 70 iterations of the optimization process. This value can be further reduced using fewer particles and iterations. The accuracy of the proposed approach is also evaluated wrt other SLAM methods widely used among the robot operating system community and it has been shown that NDT-PSO outperforms these algorithms.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Log in via an institution

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6
Fig. 7
Fig. 8

Similar content being viewed by others

Notes

  1. www.ros.org

References

  1. Dissanayake G, Durrant-Whyte H, Bailey T (2000) A computationally efficient solution to the simultaneous localisation and map building (slam) problem. In: IEEE international conference on robotics and automation (ICRA), pp 1009–1014

  2. Hahnel D, Burgard W, Fox D, Thrun S (2003) An efficient fastslam algorithm for generating maps of large-scale cyclic environments from raw laser range measurements. In: IEEE/RSJ international conference on intelligent robots and systems (IROS), pp 206–211

  3. Murphy KP (1999) Bayesian map learning in dynamic environments. Adv Neural Inf Process Syst 12:1015–1021

    Google Scholar 

  4. Khairuddin AR, Talib MS, Haron H (2015) Review on simultaneous localization and mapping (slam). In: 2015 IEEE international conference on control system, computing and engineering (ICCSCE), pp 85-90

  5. Singandhupe A, La H (2019) A review of slam techniques and security in autonomous driving. In: 2019 third IEEE international conference on robotic computing (IRC), pp 602-607

  6. Cadena C, Carlone L, Carrillo H et al (2016) Past, present, and future of simultaneous localization and mapping: toward the robust-perception age. In: IEEE Transactions on robotics, pp 1309–1332

  7. Sung-Hyeon J, Ung-Hee L, Tae-Yong K et al (2018) A robust slam algorithm using hybrid map approach. In: 2018 international conference on electronics, information, and communication (ICEIC)

  8. Choi J, Maurer M (2014) Hybrid map-based slam with rao-blackwellized particle filters. In: 17th international conference on information fusion (FUSION), pp 1-6

  9. Zhang T, Wu K, Song J et al (2017) Convergence and consistency analysis for a 3-dinvariant-ekf slam. In: IEEE robotics and automation letters

  10. Lee H, Chun J, Jeon K et al (2018) Efficient ekf-slam algorithm based on measurement clustering and real data simulations. In: 2018 IEEE 88th vehicular technology conference (VTC-Fall), pp 1-5

  11. Li J, Zhong R, Hu Q, Ai M (2016) Feature-based laser scan matching and its application for indoor mapping. Sensors 16(8):1265

    Article  Google Scholar 

  12. Wang D, Xue J, Tao Z et al (2018) Accurate mix-norm-based scan matching. In: IEEE/RSJ international conference on intelligent robots and systems (IROS)

  13. Wang J, Fujimoto Y (2017) Combination of the icp and the pso for 3d-slam. In: 43rd annual conference of the ieee industrial electronics society, IECON

  14. Zahran S, Moussa A, Sesay A et al (2018) Enhancement of real-time scan matching for uav indoor navigation using vehicle model. ISPRS Ann Photogramm Remote Sens Spat Inf Sci. https://doi.org/10.5194/isprs-annals

    Chapter  Google Scholar 

  15. Dokeroglu T, Sevinc E, Kucukyilmaz T, Cosar A (2019) A survey on new generation metaheuristic algorithms. Comput Ind Eng 137:106040

    Article  Google Scholar 

  16. Namadchian A, Ramezani M, Razmjooy N (2016) A new meta-heuristic algorithm for optimization based on variance reduction of guassian distribution. Majlesi J Ectr Eng 10(4):49

    Google Scholar 

  17. Ahmadianfar I, Bozorg-Haddad O, Chu X (2020) Gradient-based optimizer: a new metaheuristic optimization algorithm. Inf Sci 540:131–159

    Article  MathSciNet  Google Scholar 

  18. Razmjooy N, Estrela VV, Loschi HJ, Fanfan W (2019) A comprehensive survey of new meta-heuristic algorithms. Recent Advances in Hybrid Metaheuristics for Data Clustering. Wiley Publishing, New Jersey

    Google Scholar 

  19. Nedjah N, de Oliveira PJA (2020) Simultaneous localization and mapping using Swarm intelligence based methods. Exp Syst Appl 159:113547

    Article  Google Scholar 

  20. Xue J, Shen B (2020) A novel swarm intelligence optimization approach: sparrow search algorithm. Syst Sci Control Eng 8(1):22–34

    Article  Google Scholar 

  21. Jinran Wu et al (2020) An improved firefly algorithm for global continuous optimization problems. Exp Syst Appl 149:113340

    Article  Google Scholar 

  22. Razmjooy N, Ramezani M (2014) An improved quantum evolutionary algorithm based on invasive weed optimization. Indian J Sci Res 4(2):413–422

    Google Scholar 

  23. Razmjooy N, Khalilpour M, Ramezani M (2016) A new meta-heuristic optimization algorithm inspired by FIFA world cup competitions: theory and its application in PID designing for AVR system. J Control Autom Ectr Syst 27(4):419–440

    Article  Google Scholar 

  24. Wang D, Tan D, Liu L (2018) Particle swarm optimization algorithm: an overview. Soft Comput 22(2):387–408

    Article  Google Scholar 

  25. Bouraine S, Azouaoui O (2020) Safe motion planning based on a new encoding technique for tree expansion using particle swarm optimization. Robotica, pp 1-43, (in Press), Available online 10 September

  26. Zhu Q, Yuan M, Liu Y et al (2014) Research and application on fractional-order darwinian pso based adaptive extended kalman filtering algorithm. Int J Robot Autom 3:245–251

    Google Scholar 

  27. Lee H C, Park SK, Choi J S et al (2009) PSO-FastSlam: An improved FastSlam framework using particle swarm optimization.In: Proceedings of the 2009 IEEE international conference on systems, man, and cybernetics

  28. Liu D, Liu G, Yu M (2012) An improved FastSLAM framework based on particle swarm optimization and unscented particle filter. J Comput Inf Syst 8(7):2859–2866

    Google Scholar 

  29. Wu S, Li P, Zhao F et al (2017) FastSlam method based on gaussian particle swarm optimization.In: Advances in social science, education and humanities research (ASSEHR), volume 130, 2nd international forum on management, education and information technology application (IFMEITA 2017)

  30. Biber P, Strasser W (1996) The normal distributions transform: a new approach to laser scan matching.In: IEEE/RSJ international conference on intelligent robots and systems (IROS)

  31. Stoyanov T, Magnusson M, Andreasson H et al (2012) Fast and accurate scan registration through minimization of the distance between compact 3D NDT representations. Int J Robot Res 31(12):1377–1393

    Article  Google Scholar 

  32. Hong H, H. Lee B (2017) Probabilistic normal distributions transform representation for accurate 3-d point cloud registration. In: IEEE/RSJ international conference on intelligent robots and systems (IROS), pp 3333-3338

  33. Zaganidis A, Magnusson M, Duckett T, Cielniak G (2017) Semantic assisted 3-d normal distributions transform for scan registration in environments with limited structure. In: IEEE/RSJ international conference on intelligent robots and systems (IROS), pp 4064–4069

  34. Einhorn E, Gross HM (2015) Generic NDT mapping in dynamic environments and its application for lifelong SLAM. Robot Auton Syst 69:28–39

    Article  Google Scholar 

  35. Li Q, Xiong R, Vidal-Calleja T (2017) A GMM based uncertainty model for point clouds registration. Robot Auton Syst 91:349–362

    Article  Google Scholar 

  36. Wolcott RW, Eustice RM (2017) Robust LIDAR localization using multiresolution Gaussian mixture maps for autonomous driving. Int J Robot Res 36(3):292–319

    Article  Google Scholar 

  37. Shi Y, Eberhart R (1998) A modified particle swarm optimizer. IEEE World Congr Comput Intell. https://doi.org/10.1109/ICEC.1998.699146

    Article  Google Scholar 

  38. Schmiedel T, Einhorn E, Gross HM (2015) Iron: a fast interest point descriptor for robust ndt-map matching and its application to robot localization. In: IEEE/RSJ international conference on intelligent robots and systems (IROS), pp 3144–3151

  39. Magnusson M, Duckett T (2015) A comparison of 3d registration algorithms for autonomous underground mining vehicles. In: Proceedings of the European conference on mobile robotics (ECMR), pp 86–91

  40. Stoyanov T, Magnusson M, Almqvist H, Lilienthal AJ (2011) On the accuracy of the 3d normal distributions transform as a tool for spatial representation. In: Proceedings of the IEEE international conference on robotics and automation (ICRA), pp 4080–4085

  41. Saarinen J, Andreasson H, Stoyanov T, Lilienthal AJ (2018) Normal distribution transform monte-carlo localization (ndt-mcl). In: IEEE/RSJ international conference on intelligent robots and systems (IROS), pp 382-389

  42. Pang S, Kent D, Cai X et al (2018) 3d scan registration based localization for autonomous vehicles—a comparison of NDT and ICP under realistic conditions. In: 2018 IEEE 88th vehicular technology conference (VTC-Fall), pp 1–5

  43. Morita K, Hashimoto M, Takahashi K (2019) Point-cloud mapping and merging using mobile laser scanner. In: 2019 Third IEEE international conference on robotic computing (IRC), pp 417-418

  44. Li M, Zhu H, You S, Wang L, Tang C (2018) Efficient laser-based 3D SLAM for coal mine rescue robots. IEEE Access 7:14124–14138

    Article  Google Scholar 

  45. Stoyanov T, Magnusson M, Lilienthal AJ (2012) Point set registration through minimization of the l 2 distance between 3d-ndt models. In: Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), pp 5196–5201:

  46. Grisettiand G, Tipaldi GD, Stachniss C, Burgard W, Nardi D (2007) Fast and accurate SLAM with Rao-Blackwellized particle filters. Robot Auton Syst 55:30–38

    Article  Google Scholar 

  47. Kohlbrecher S, Meyer J, Yon Stryk O et al (2011) A flexible and scalable slam system with full 3d motion estimation. In: IEEE international symposium on safety, security and rescue robotics

  48. Moravec H, Elfes A (1985) High resolution maps from wide angle sonar. In: Proceedings of the IEEE international conference on robotics and automation (ICRA), pp 116–121

  49. Einhorn E, Gross H M (1987) Sensor integration for robot navigation: combining sonar and stereo range data in a grid-based representation. In: 26th IEEE conference on decision and control, pp 1802-1807

  50. Ypma TJ (1995) Historical development of the newton-raphson method. SIAM Rev 37:531–551

    Article  MathSciNet  Google Scholar 

  51. Olson EB (2009) Real-time correlative scan matching. In: IEEE international conference on robotics and automation (ICRA), pp 4387–4393

  52. Walter E (2014) Numerical methods and optimization: a consumer guide. Springer, Berlin

    MATH  Google Scholar 

  53. Dor AE (2012) Improvement of particle swarm optimization algorithms: applications in image segmentation and electronics. Dissertation, University Paris-Est

  54. VenkataRao R, Savsani VJ (2012) Mechanical design optimization using advanced optimization techniques. Springer, London

    Google Scholar 

  55. Kennedy J, Eberhart R (1995) Particle swarm optimization. In: IEEE international conference on neural networks, pp 1942–1948

  56. Clerc M, Kennedy J (2002) The particle swarm-explosion, stability, and convergence in a multidimensional complex space. IEEE Trans Evol Comput 6(1):58–73

    Article  Google Scholar 

  57. Poli R, Kennedy J, Blackwell T (2007) Particle swarm optimization. IEEE Trans Evol Comput Swarm Intell 1(1):33–57

    Google Scholar 

  58. Arumugam M, Rao Senthil MVC, Chandramohan A (2008) A new and improved version of particle swarm optimization algorithm with global-local best parameters. Knowl Inf syst 16(3):331–357

    Article  Google Scholar 

  59. Bonyadi MR, Michalewicz Z, Li X (2014) An analysis of the velocity updating rule of the particle swarm optimization algorithm. J Heuristics 20(4):417–452

    Article  Google Scholar 

  60. Li Z, Zhu T (2015) Research on global-local optimal information ratio particle swarm optimization for vehicle scheduling problem. In: International conference on intelligent human-machine systems and cybernetics, pp 92–96

  61. M’hamdi B, Teguar M, Mekhaldi A, (2016) Optimal design of Corona ring on HV composite insulator using PSO Approach with dynamic population size. IEEE Trans Dielectr Ectr Insul 23(2):1048–1057

    Article  Google Scholar 

  62. Thrun S, Burgard W, Fox D (2008) Probabilistic robotics. MIT press, Cambridge

    MATH  Google Scholar 

  63. Jeong-Jung K, Ju-Jang L (2015) Trajectory optimization with particle swarm optimization for manipulator motion planning. In: IEEE transactions on industrial informatics, pp 620–631

Download references

Author information

Authors and Affiliations

  1. Center for development of advanced technologies (CDTA), Cite 20 Aout 1956, Baba Hassen, Algiers, Algeria

    Sara Bouraine, Abdelhak Bougouffa & Ouahiba Azouaoui

Authors
  1. Sara Bouraine
    View author publications

    You can also search for this author in PubMed Google Scholar

  2. Abdelhak Bougouffa
    View author publications

    You can also search for this author in PubMed Google Scholar

  3. Ouahiba Azouaoui
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to Sara Bouraine.

Additional information

Publisher's Note

Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Bouraine, S., Bougouffa, A. & Azouaoui, O. Particle swarm optimization for solving a scan-matching problem based on the normal distributions transform. Evol. Intel. 15, 683–694 (2022). https://doi.org/10.1007/s12065-020-00545-y

Download citation

  • Received:

  • Revised:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s12065-020-00545-y

Keywords

Search

Navigation