Navigation of a mobile robot in a dynamic environment using a point cloud map

Abstract

In this paper, we consider autonomous navigation of a wheeled mobile robot in a dynamic environment using a 3D point cloud map. We consider four kinds of 2D maps: static global map, dynamic global map, global cost map, and local cost map; to plan a feasible path of the robot to adapt to a dynamic environment. We consider a mobile robot for plant patrolling in a 3D environment with plane slopes but not rough terrain for which a 2D environment map suffices. We propose 2D static global map for robot navigation by projecting prior measured 3D point cloud map data on a horizontal plane with considering the climbing ability of the robot. We also build a 2D dynamic global map by projecting a real-time 3D point cloud on the 2D static global map by SLAM. Accumulated errors of SLAM can be canceled using some landmarks placed in the environment. A global planner calculates an optimal global path that minimizes the distance from an initial robot pose (position and orientation) to a goal pose (position and orientation) by A* algorithm based on the global cost map which is built from the dynamic global map. However, this process should take much time. To avoid moving obstacles, the TEB (Timed Elastic Band) local planner is used to calculate an optimal local path based on a local cost map which is given by a real-time local 3D point cloud. To demonstrate the effectiveness of the proposed system, experiments were carried out. In the experiment, we use an AR card as a landmark for simplification of implementation. We prove that the robot can navigate in a dynamic environment and accumulated errors can be canceled by the AR cards placed in the environment as landmarks.

This is a preview of subscription content, access via your institution.

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6
Fig. 7
Fig. 8
Fig. 9
Fig. 10
Fig. 11
Fig. 12
Fig. 13
Fig. 14
Fig. 15
Fig. 16
Fig. 17

Notes

  1. 1.

    The method [19] can be also applicable to project the points into a local ground. It can segment multiple planes. However, it requires a higher density 3D point cloud and takes much time for processing. In this phase, we consider a local area and can assume that there is only one ground plane around the robot roughly. We can apply faster algorithm to segment one plane such as [20, 21].

References

  1. 1.

    Eitan M, Eric B, Tully F, Brian G, Kurt K (2010) The office marathon: robust navigation in an indoor office environment. In: Proceedings in IEEE international conference on robotics and automation, pp 300–307

  2. 2.

    Ellips M, Golnaz H (2007) Robot path planning in 3D space using binary integer programming. J Comput Inf Eng 1(5):1255–1260

    Google Scholar 

  3. 3.

    Andrew J. D, Nobuyuki K, (2001) 3D simultaneous localisation and map-building using active vision for a robot moving on undulating terrain. In: Proceedings of IEEE international conference on computer vision and pattern recognition, pp 394–391

  4. 4.

    Konstantinos C, Ioannis K, Antonios G (2015) Thorough robot navigation based on SVM local planning. J Robot Auton Syst 70(1):166–180

    Google Scholar 

  5. 5.

    David W, Matthew M, Kevin B, Andrew H, Alfred AR, Marc R (2010) Autonomous navigation for BigDog. In: Proceedings of IEEE international conference on robotics and automation, pp 4736–4741

  6. 6.

    Malcolm M, Martin M, Henrik A, Achim JL (2017) SLAM auto-complete: completing a robot map using an emergency map. In: Proceedings of IEEE international symposium on safety, security and rescue robotics, pp 35–40

  7. 7.

    John M, Michael K, Cesar C, Jose N, John JL (2013) Real-time 6-DOF multi-session visual SLAM over large-scale environments. J Robot Auton Syst 61(10):1144–1158

    Article  Google Scholar 

  8. 8.

    Aisha W.B, Michael K, Hordur J, John J.L (2012) Dynamic pose graph SLAM: long-term mapping in low dynamic environments. In: Proceedings of IEEE/RSJ international conference on intelligent robots and systems, pp 1871–1877

  9. 9.

    Pablo M, Ahmed H, David M, de la Arturo E (2018) Global and local path planning study in a ROS-based research platform for autonomous vehicles. J Adv Transp 2018:1–10

    Google Scholar 

  10. 10.

    Michael M, Sebastian T, Daphne K, Ben W (2003) FastSLAM 2.0: an improved particle filtering algorithm for simultaneous localization and mapping that provably converges. In: Proceedings of the international conference on artificial intelligence, pp 1151–1156

  11. 11.

    Morgan Q, Brian G, Ken C, Josh F, Tully F, Jeremy L, Eric B, Rob W, Ng A (2009) ROS: an open-source robot operating system. In: Proceedings of IEEE international conference on robotics and automation, open-source software workshop

  12. 12.

    Giorgio G, Cyrill S, Wolfram B (2005) Improving grid-based slam with Rao-Blackwellized particle filters by adaptive proposals and selective resampling. In: Proceedings of IEEE international conference on robotics and automation, pp 2443–2448

  13. 13.

    Arnaud D, Nando de F, Kevin M, Stuart R (2000) Rao-Blackwellized partcile filtering for dynamic bayesian networks. In: Proceedongs of conference on uncertainty in artificial intelligence, pp 176–183

  14. 14.

    Kurt K (2000) A gradient method for realtime robot control. In: Proceedings of IEEE/RSJ international conference on intelligent robots and systems, pp 639–646

  15. 15.

    Rösmann C, Hoffmann F, Bertram T (2015) Planning of multiple robot trajectories in distinctive topologies. In: Proceedings of IEEE European conference on mobile robots, pp 1–6

  16. 16.

    Watanabe M, Onoguchi E, Kweon I, Kuno Y (1992) Architecture of behavior-based mobile robot in dynamic environment. In: Proceedings of IEEE international conference on robotics and automation, pp 2711–2718

  17. 17.

    Zhu A, Yang SX (2007) Neurofuzzy-based approach to mobile robot navigation in unknown environments. IEEE Trans Syst 37(4):610–621

    Google Scholar 

  18. 18.

    Engedy I, Horvath G (2010) Artificial neural network based local motion planning of a wheeled mobile robot. In: Proceedings of IEEE international conference on computational intelligence and informatics, pp 213–218

  19. 19.

    Abdul N, David B, Geoff W (2016) Robust segmentation for large volumes of laser scanning three-dimensional point cloud data. IEEE Trans Geosci Remote Sens 54(8):4790–4805

    Article  Google Scholar 

  20. 20.

    Dimitris Z, Izzat I, Nikolaos P (2017) Fast segmentation of 3D point clouds: a paradigm on LiDAR data for autonomous vehicle applications. In: Proceedings of IEEE international conference on robotics and automation, pp 5067–5073

  21. 21.

    Ahmed H, Pablo M, David M, Arturo E, Jose M (2016) Autonomous off-road navigation using stereo-vision and laser-rangefinder fusion for outdoor obstacles detection. In: Proceedings of IEEE international conference on intelligent vehicles symposium, pp 104–109

Download references

Acknowledgements

A part of this study was carried out as a collaborative research with BESTERRA Co., Ltd.

Author information

Affiliations

Authors

Corresponding author

Correspondence to Xixun Wang.

Additional information

Publisher's Note

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

About this article

Verify currency and authenticity via CrossMark

Cite this article

Wang, X., Mizukami, Y., Tada, M. et al. Navigation of a mobile robot in a dynamic environment using a point cloud map. Artif Life Robotics 26, 10–20 (2021). https://doi.org/10.1007/s10015-020-00617-3

Download citation

Keywords

  • Mobile robot
  • Point cloud map
  • SLAM
  • Path planning
  • Dynamic environment