Abstract
For path planning problems based on Rapidly exploring Random Trees (RRT), most new nodes merely explore the environment unless they are sampled directly from the subset that can optimize the path. This paper proposes the Dynamic RRT algorithm, which aims to plan a feasible path while balancing the convergence time and path length in an environment with randomly distributed obstacles. It estimates the length of a path from the start node to the goal node that is constrained to pass through an extended tree node, and this path length is heuristically taken as the major axis diameter of the informed subset. Then new node sampling is performed directly in this subset to optimize the estimated path. In addition, the idea of dynamic programming is employed to decompose the planning problem into subproblems by updating the node selected through Pareto dominance as the new start node to optimize the distance to the goal. Simulation results confirm the performance of the proposed algorithm in balancing the convergence time and path length and demonstrate that the convergence time is faster than that of RRT, while the path length is better than that of RRT*. Dynamic RRT also shows better performance than Lower Bound Tree-RRT(LBT-RRT), and Informed RRT* takes more time to compute a path of the same length.
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.Code availability
The source code in this paper will be disclosed upon acceptance for publication of this paper. Before accepting, please E-mail to 2,399,496,491@qq.com if the source code is needed.
References
Ji, S., et al.: Learning-Based Automation of Robotic Assembly for Smart Manufacturing. Proc. of the IEEE. 109, 423–440 (2021)
Perzylo, A., et al.: SMErobotics Smart Robots for Flexible Manufacturing. IEEE ROBOT AUTOM MAG. 26, 78–90 (2019)
Hvilshoj, M., et al.: Autonomous industrial mobile manipulation (AIMM): past, present and future. Industrial Robot-the International Journal of Robotics Research and Application. 39, 120–135 (2012)
Roa, M.A., Berenson, D., Huang, W.: Mobile Manipulation: Toward Smart Manufacturing. IEEE Robot. Autom. Mag. 22, 14–15 (2015)
Gonzalez, A.G.C., et al.: Supervisory Control-Based Navigation Architecture: A New Framework for Autonomous Robots in Industry 4.0 Environments. IEEE Trans. Indust. Inf. 14, 1732–1743 (2018)
Pan, C., et al.: A Novel Algorithm for Wafer Sojourn Time Analysis of Single-Arm Cluster Tools With Wafer Residency Time Constraints and Activity Time Variation. IEEE Transactions on Systems Man Cybernetics-Systems. 45, 805–818 (2015)
Li, Z., et al.: A Fault-Tolerant Method for Motion Planning of Industrial Redundant Manipulator. IEEE Trans. Industr. Inf. 16, 7469–7478 (2020)
Baumann, D., et al.: Wireless Control for Smart Manufacturing: Recent Approaches and Open Challenges. Proc. IEEE 109, 441–467 (2021)
Li, S., Han, K., Li, X., et al.: Hybrid Trajectory Replanning-Based Dynamic Obstacle Avoidance for Physical Human-Robot Interaction. J Intell Robot Syst 103, 41 (2021)
Hart, P.E., Nilsson, N.J., Raphael, B.: A Formal Basis for the Heuristic Determination of Minimum Cost Paths. IEEE Transactions on Systems Science and Cybernetics. 4, 100–107 (1968)
Karaman, S. and E. Frazzoli.: Incremental Sampling-based Algorithms for Optimal Motion Planning. in Robotics: Sci. Syst. 2010. (2010). https://doi.org/10.48550/arXiv.1005.0416
Chiang, H.T.L., et al.: RL-RRT: Kinodynamic Motion Planning via Learning Reachability Estimators From RL Policies. IEEE Robotics and Automation Letters. 4, 4298–4305 (2019)
Wang, J.K., et al.: Neural RRT*: Learning-Based Optimal Path Planning. IEEE Trans. Autom. Sci. Eng. 17, 1748–1758 (2020)
Li, Y., et al.: Neural Network Approximation Based Near-Optimal Motion Planning With Kinodynamic Constraints Using RRT. IEEE Trans. Industr. Electron. 65, 8718–8729 (2018)
Lavalle, S.M.: Rapidly-exploring random trees : A new tool for path planning. Research Report. https://www.researchgate.net/publication/2639200_Rapidly-Exploring_Random_Trees_A_New_Tool_for_Path_Planning. (1998)
Kavraki, L.E., et al.: Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Trans. Robot. Autom. 12, 566–580 (1996)
Wang, J.K., Meng, M.Q.H., Khatib, O.: EB-RRT: Optimal Motion Planning for Mobile Robots. IEEE Trans. Autom. Sci. Eng. 17, 2063–2073 (2020)
Kusuma, M., Riyanto, and C. Machbub.: Humanoid Robot Path Planning and Rerouting Using A-Star Search Algorithm. 2019 IEEE International Conference on Signals and Systems (Icsigsys). (2019). https://doi.org/10.1109/ICSIGSYS.2019.8811093
An, B., Kim, J., Park, F.C.: An Adaptive Stepsize RRT Planning Algorithm for Open-Chain Robots. IEEE Robotics and Automation Letters. 3, 312–319 (2018)
Wang, W., Zuo, L., Xu, X.: A Learning-based Multi-RRT Approach for Robot Path Planning in Narrow Passages. J. Intell. Rob. Syst. 90, 81–100 (2018)
Aguinaga, I., Borro, D., Matey, L.: Parallel RRT-based path planning for selective disassembly planning. Int. J. Adv. Manuf. Technol. 36, 1221–1233 (2008)
Bruce, J. and M.M. Veloso.: Real-time randomized path planning for robot navigation. Robocup 2002: Robot Soccer World Cup Vi. 2752, 288–295 (2003)
Jr, J. and S.M. Lavalle.: RRT-Connect: An Efficient Approach to Single-Query Path Planning. in Proceedings of the 2000 IEEE International Conference on Robotics and Automation, ICRA 2000, April 24–28, 2000, San Francisco, CA, USA. (2000).
Moon, C.B., Chung, W.: Kinodynamic Planner Dual-Tree RRT (DT-RRT) for Two-Wheeled Mobile Robots Using the Rapidly Exploring Random Tree. IEEE Trans. Industr. Electron. 62, 1080–1090 (2015)
Karaman, S., Frazzoli, E.: Sampling-based algorithms for optimal motion planning. Int. J. Robot. Res. 30, 846–894 (2011)
Chen, L., et al.: A Fast and Efficient Double-Tree RRT*-Like Sampling-Based Planner Applying on Mobile Robotic Systems. IEEE-Asme Transactions on Mechatronics. 23, 2568–2578 (2018)
Gammell, J.D., S.S. Srinivasa, and T.D. Barfoot.: Informed RRT*: Optimal Sampling-based Path Planning Focused via Direct Sampling of an Admissible Ellipsoidal Heuristic. 2014 IEEE/Rsj International Conference on Intelligent Robots and Systems (Iros 2014). 2997–3004 (2014)
Salzman, O., Halperin, D.: Asymptotically Near-Optimal RRT for Fast, High-Quality Motion Planning. IEEE Trans. Rob. 32, 473–483 (2016)
Qi, J., Yang, H., Sun, H.X.: MOD-RRT*: A Sampling-Based Algorithm for Robot Path Planning in Dynamic Environment. IEEE Trans. Industr. Electron. 68, 7244–7251 (2021)
Gammell, J.D., S.S. Srinivasa, and T.D. Barfoot.: On Recursive Random Prolate Hyperspheroids. Eprint Arxiv, (2014). https://doi.org/10.48550/arXiv.1403.7664
Sun, H.Y., Farooq, M.: Note on the generation of random points uniformly distributed in hyper-ellipsoids. Proceedings of the Fifth International Conference on Information Fusion I, 489–496 (2002)
Gammell, J.D. and T.D. Barfoot.: The Probability Density Function of a Transformation-based Hyperellipsoid Sampling Technique. Stat., (2014). https://doi.org/10.48550/arXiv.1404.1347
De Ruiter, A.H.J., Forbe, J.R.: On the Solution ofWahba’s Problem on S O (n). Journal of the Astronautical Sciences. 60, 1–31 (2014)
Guo, G., et al.: Predicting Pareto Dominance in Multi-objective Optimization Using Pattern Recognition. in Second International Conference on Intelligent System Des. Eng. Appl. (2012). https://doi.org/10.1109/ISdea.2012.589
Sanders and Robert: The Pareto Principle: its Use and Abuse. J. Serv. Mark. 1(37), 40 (1987)
Funding
This work is supported by the Key project's funding of NSFC (No.61836010).
Author information
Authors and Affiliations
Contributions
All authors contributed to the study conception and design. Penglei Zhao wrote the manuscript and did the research. Technical support was provided by Yinghui Chang, Weikang Wu, Hongyin Luo, Zhixin Zhou. Valuable comments on manuscript revisions were put forward by Yanping Qiao, Ying Li, Chenhui Zhao, Zenan Huang, Bijing Liu, Xiaojie Liu, Shan He. Prof. Donghui Guo provided manuscript writing guidance. All authors read and approved the final manuscript.
Corresponding author
Ethics declarations
Ethics approval
Not applicable.
Competing interests
The authors have no relevant financial or non-financial interests to disclose.
Consent to participate
Not applicable.
Consent for publication
Not applicable.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Zhao, P., Chang, Y., Wu, W. et al. Dynamic RRT: Fast Feasible Path Planning in Randomly Distributed Obstacle Environments. J Intell Robot Syst 107, 48 (2023). https://doi.org/10.1007/s10846-023-01823-4
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s10846-023-01823-4