Skip to main content
SpringerLink
Log in

Fast Four-Stage Local Motion Planning Method for Mobile Robot

  • Published:
Journal of Shanghai Jiaotong University (Science) Aims and scope Submit manuscript

Abstract

Mobile robot local motion planning is responsible for the fast and smooth obstacle avoidance, which is one of the main indicators for evaluating mobile robots’ navigation capabilities. Current methods formulate local motion planning as a unified problem; therefore it cannot satisfy the real-time requirement on the platform with limited computing ability. In order to solve this problem, this paper proposes a fast local motion planning method that can reach a planning frequency of 500 Hz on a low-cost CPU. The proposed method decouples the local motion planning as the front-end path searching and the back-end optimization. The front-end is composed of the environment topology analysis and graph searching. The back-end includes dynamically feasible trajectory generation and optimal trajectory selection. Different from the popular methods, the proposed method decomposes the local motion planning into four sub-modules, each of which aims to solve one problem. Combining four sub-modules, the proposed method can obtain the complete local motion planning algorithm which can fastly generate a smooth and collision-free trajectory. The experimental results demonstrate that the proposed method has the ability to obtain the smooth, dynamically feasible and collision-free trajectory and the speed of the planning is fast.

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

Similar content being viewed by others

References

  1. WANG M C. Path planning of mobile robots based on A* algorithm [D]. Shenyang, China: Shenyang University of Technology, 2017 (in Chinese).

    Google Scholar 

  2. DIJKSTRA E W. A note on two problems in connexion with graphs [J]. Numerische Mathematik, 1959, 1(1): 269–271.

    Article  MathSciNet  Google Scholar 

  3. ZHANG J, CHADHA R G, VELIVELA V, et al. P-CAP: Pre-computed alternative paths to enable aggressive aerial maneuvers in cluttered environments [C]//2018 IEEE/RSJ International Conference on Intelligent Robots and Systems. Madrid, Spain: IEEE, 2018: 8456–8463.

    Google Scholar 

  4. HOWARD T, PIVTORAIKO M, KNEPPER R A, et al. Model-predictive motion planning: Several key developments for autonomous mobile robots [J]. IEEE Robotics & Automation Magazine, 2014, 21(1): 64–73.

    Article  Google Scholar 

  5. MICELLI P, LIKHACHEV M. FOCS: Planning by fusion of optimal control & search and its application to navigation [C]//2018 IEEE/RSJ International Conference on Intelligent Robots and Systems. Madrid, Spain: IEEE, 2018: 8082–8088.

    Google Scholar 

  6. KUFFNER J J, LAVALLE S M. RRT-connect: An efficient approach to single-query path planning [C]//2000 IEEE International Conference on Robotics and Automation. San Francisco, CA, USA: IEEE, 2000: 995–1001.

    Google Scholar 

  7. HSU D, KAVRAKI L E, LATOMBE J C, et al. On finding narrow passages with probabilistic roadmap planners[C]//1998 3rd Workshop on the Algorithmic Foundations of Robotics. Natick, MA, USA: A K Peters, 1998: 141–153.

    Google Scholar 

  8. KARAMAN S, FRAZZOLI E. Sampling-based algorithms for optimal motion planning [J]. The International Journal of Robotics Research, 2011, 30(7): 846–894.

    Article  Google Scholar 

  9. GAMMELL J D, SRINIVASA S S, BARFOOT T D. Informed RRT*: Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic [C]//2014 IEEE/RSJ International Conference on Intelligent Robots and Systems. Chicago, IL, USA: IEEE, 2014: 2997–3004.

    Google Scholar 

  10. VONÁSEK V, PĚNIČKA R, KOZLÍKOVÑ B. Computing multiple guiding paths for sampling-based motion planning [C]//2019 19th International Conference on Advanced Robotics. Belo Horizonte, Brazil: IEEE, 2019: 374–381.

    Google Scholar 

  11. LI J X, DAI B, LI X H, et al. A real-time and predictive trajectory-generation motion planner for autonomous ground vehicles [C]//2017 9th International Conference on Intelligent Human-Machine Systems and Cybernetics. Hangzhou, China: IEEE, 2017: 108–113.

    Google Scholar 

  12. PADEN B, ČÁP M, YONG S Z, et al. A survey of motion planning and control techniques for self-driving urban vehicles [J]. IEEE Transactions on Intelligent Vehicles, 2016, 1(1): 33–55.

    Article  Google Scholar 

  13. MELLINGER D, KUMAR V. Minimum snap trajectory generation and control for quadrotors [C]//2011 IEEE International Conference on Robotics and Automation. Shanghai, China: IEEE, 2011: 2520–2525.

    Google Scholar 

  14. RICHTER C, BRY A, ROY N. Polynomial trajectory planning for aggressive quadrotor flight in dense indoor environments [M]//Robotics Research, Cham: Springer, 2016: 649–666.

    Chapter  Google Scholar 

  15. GAO F, WU W, LIN Y, et al. Online safe trajectory generation for quadrotors using fast marching method and Bernstein basis polynomial [C]//2018 IEEE International Conference on Robotics and Automation. Brisbane, Australia: IEEE, 2018: 344–351.

    Google Scholar 

  16. LUO S S, LI X H, SUN Z P. An optimization-based motion planning method for autonomous driving vehicle [C]//2020 3rd International Conference on Unmanned Systems. Harbin, China: IEEE, 2020: 739–744.

    Google Scholar 

  17. ZHOU B Y, GAO F, PAN J, et al. Robust real-time UAV replanning using guided gradient-based optimization and topological paths [C]//2020 IEEE International Conference on Robotics and Automation. Paris, France: IEEE, 2020: 1208–1214.

    Google Scholar 

  18. SIMÉON T, LAUMOND J P, NISSOUX C. Visibility-based probabilistic roadmaps for motion planning [J]. Advanced Robotics, 2000, 14(6): 477–493.

    Article  Google Scholar 

  19. HESS W, KOHLER D, RAPP H, et al. Real-time loop closure in 2D LIDAR SLAM [C]//2016 IEEE International Conference on Robotics and Automation. Stockholm, Sweden: IEEE, 2016: 1271–1278.

    Google Scholar 

  20. SAARINEN J, ANDREASSON H, STOYANOV T, et al. Normal distributions transform Monte-Carlo localization (NDT-MCL) [C]//2013 IEEE/RSJ International Conference on Intelligent Robots and Systems. Tokyo, Japan: IEEE, 2013: 382–389.

    Google Scholar 

  21. AHN J, SHIN S, KIM M, et al. Accurate path tracking by adjusting look-ahead point in pure pursuit method [J]. International Journal of Automotive Technology, 2021, 22(1): 119–129.

    Article  Google Scholar 

  22. LI X H, SUN Z P, CAO D P, et al. Development of a new integrated local trajectory planning and tracking control framework for autonomous ground vehicles [J]. Mechanical Systems and Signal Processing, 2017, 87: 118–137.

    Article  Google Scholar 

  23. KELLY A, NAGY B. Reactive nonholonomic trajectory generation via parametric optimal control [J]. The International Journal of Robotics Research, 2003, 22(7/8): 583–601.

    Article  Google Scholar 

  24. RÖSMANN C, HOFFMANN F, BERTRAM T. Planning of multiple robot trajectories in distinctive topologies [C]//2015 European Conference on Mobile Robots. Lincoln, UK: IEEE, 2015: 1–6.

    Google Scholar 

Download references

Funding

the National Key R&D Program of China (No. 2017YFB1301300)

Author information

Authors and Affiliations

  1. Center for System Reliability and Safety, University of Electronic Science and Technology of China, Chengdu, 611731, China

    Shan Huang  (黄 山) & Hongzhong Huang  (黄洪钟)

  2. EvenTec Co., Ltd., Chengdu, 610097, China

    Qi Zeng  (曾 奇)

Authors
  1. Shan Huang  (黄 山)
    View author publications

    You can also search for this author in PubMed Google Scholar

  2. Hongzhong Huang  (黄洪钟)
    View author publications

    You can also search for this author in PubMed Google Scholar

  3. Qi Zeng  (曾 奇)
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to Hongzhong Huang  (黄洪钟).

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Huang, S., Huang, H. & Zeng, Q. Fast Four-Stage Local Motion Planning Method for Mobile Robot. J. Shanghai Jiaotong Univ. (Sci.) (2022). https://doi.org/10.1007/s12204-022-2423-8

Download citation

  • Received:

  • Accepted:

  • Published:

  • DOI: https://doi.org/10.1007/s12204-022-2423-8

Key words

CLC number

Document code

Search

Navigation