Abstract
Aiming at the problems of low success rate, long time and tortuous path of the traditional Rapidly-exploring Random Trees series of algorithms for path planning, this paper proposes the optimal path sampling algorithm based on the potential function (AP-RRT*), which solves the path planning problem of the manipulator in three-dimensional space. First, the potential function is defined and the concept of sampling termination distance is proposed. Second, a secondary sampling strategy is proposed in combination with the potential function to improve the planning speed and increase the coverage rate. Third, adaptive weights and adaptive step size are used to dynamically adjust the planning direction and distance, thereby improving the planning efficiency. Moreover, when performing node reconnection, dynamic retrieval circles are set to ensure path quality while reducing computational consumption. Finally, the improved algorithm, along with other algorithms, is simulated and experimentally verified in MATLAB and ROS. The results show that the AP-RRT* algorithm is superior in terms of path length, planning time, iterations, number of waypoints and success rate.
Similar content being viewed by others
Data availability
Some or all data, models, or code that support the findings of this study are available from the corresponding author upon reasonable request.
References
Suarez, A., Heredia, G., Ollero, A.: Physical-virtual impedance control in ultralightweight and compliant dual-arm aerial manipulators. IEEE Robot. Autom. Lett. 3(3), 2553–2560 (2018)
Sang, H., You, Y., Sun, X., et al.: The hybrid path planning algorithm based on improved A* and artificial potential field for unmanned surface vehicle formations. Ocean Eng. 223, 108709 (2021)
Ju C, Luo Q, Yan X, editors. Path planning using an improved a-star algorithm. in 2020 11th International Conference on Prognostics and System Health Management (PHM-2020 Jinan); 2020: IEEE.
Noto M, Sato H, editors. A method for the shortest path search by extended Dijkstra algorithm. Smc 2000 conference proceedings. in 2000 ieee international conference on systems, man and cybernetics.'cybernetics evolving to systems, humans, organizations, and their complex interactions'(cat. no. 0; 2000: IEEE.
Karaman S, Walter MR, Perez A, et al., editors. Anytime motion planning using the RRT. in 2011 IEEE international conference on robotics and automation; 2011: IEEE.
Bohlin R, Kavraki LE, editors. Path planning using lazy PRM. Proceedings 2000 ICRA. Millennium conference. IEEE international conference on robotics and automation. Symposia proceedings (Cat. No. 00CH37065); 2000: IEEE.
Zhou, X., Ma, H., Gu, J., et al.: Parameter adaptation-based ant colony optimization with dynamic hybrid mechanism. Eng. Appl. Artif. Intell. 114, 105139 (2022)
Deng, W., Xu, J., Zhao, H.: An improved ant colony optimization algorithm based on hybrid strategies for scheduling problem. IEEE Access. 7, 20281–20292 (2019)
Khaksar, W., Hong, T.S., Khaksar, M., et al.: Sampling-based tabu search approach for online path planning. Adv. Robot. 26(8–9), 1013–1034 (2012)
Hu S, Nagai T. Explainable autonomous robots in continuous state space based on graph-structured world model. Adv. Robot. 2023:1–17.
Wu, X., Xu, L., Zhen, R., et al.: Biased sampling potentially guided intelligent bidirectional RRT∗ algorithm for UAV path planning in 3D environment. Math. Probl. Eng. 2019, 1–12 (2019)
Qi, J., Yang, H., Sun, H.: MOD-RRT*: A sampling-based algorithm for robot path planning in dynamic environment. IEEE Trans. Industr. Electron. 68(8), 7244–7251 (2020)
LaValle S. Rapidly-exploring random trees: a new tool for path planning. Res. Rep. 9811. 1998.
Karaman S, Frazzoli E, editors. Optimal kinodynamic motion planning using incremental sampling-based methods. in 49th IEEE conference on decision and control (CDC); 2010: IEEE.
Akgun B, Stilman M, editors. Sampling heuristics for optimal motion planning in high dimensions. in 2011 IEEE/RSJ international conference on intelligent robots and systems; 2011: IEEE.
Gammell JD, Srinivasa SS, Barfoot TD, editors. Informed RRT: Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic. in 2014 IEEE/RSJ international conference on intelligent robots and systems; 2014: IEEE.
Li, Y., Wei, W., Gao, Y., et al.: PQ-RRT*: an improved path planning algorithm for mobile robots. Expert Syst. Appl. 152, 113425 (2020)
Kang, J.-G., Lim, D.-W., Choi, Y.-S., et al.: Improved RRT-connect algorithm based on triangular inequality for robot path planning. Sensors. 21(2), 333 (2021)
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. Ind. Electron. 62(2), 1080–1090 (2014)
Zhang, Z.-w, Jia, Y.-w, Su, Q.-q, et al.: ATS-RRT*: an improved RRT* algorithm based on alternative paths and triangular area sampling. Adv. Robot. 37(10), 605–620 (2023)
Mohammed, H., Romdhane, L., Jaradat, M.A.: RRT* N: an efficient approach to path planning in 3D for static and dynamic environments. Adv. Robot. 35(3–4), 168–180 (2021)
Hsueh, H.-Y., Toma, A.-I., Ali Jaafar, H., et al.: Systematic comparison of path planning algorithms using PathBench. Adv. Robot. 36(11), 566–581 (2022)
Hara, Y., Tomono, M.: Moving object removal and surface mesh mapping for path planning on 3D terrain. Adv. Robot. 34(6), 375–387 (2020)
Korf, R.E.: Depth-first iterative-deepening: an optimal admissible tree search. Artif. Intell. 27(1), 97–109 (1985)
Stentz, A.: Optimal and efficient path planning for partially known environments [M], pp. 203–220. Intelligent Unmanned Ground Vehicles. Springer, New York (1997)
Wang, J., Chi, W., Li, C., et al.: Neural RRT*: learning-based optimal path planning. IEEE Trans. Autom. Sci. Eng. 17(4), 1748–1758 (2020)
Hao, K., Zhao, J., Li, Z., et al.: Dynamic path planning of a three-dimensional underwater AUV based on an adaptive genetic algorithm. Ocean Eng. 263, 112421 (2022)
Tang H. An overview of research and prospect on ant colony algorithm. J. Mudanjiang Coll. Educ., 2009.
J. Kennedy and R. Eberhart, Particle swarm optimization. Proceedings of International Conference on Neural Network (ICNN), vol. 4, 1995, pp. 1942–1948.
Zhang, H., Yuan, M., Liang, Y., Liao, Q.: A novel particle swarm optimization based on prey–predator relationship. Appl. Soft Comput. 68, 202–218 (2018)
Ye, W., Feng, W., Fan, S.: A novel multi-swarm particle swarm optimization with dynamic learning strategy. Appl. Soft Comput. 61, 832–843 (2017)
H. Zhao, C. Lei, N. Jiang. A Path Planning Method of Robot Arm Obstacle Avoidance Based on Dynamic Recursive Ant Colony Algorithm. ICMECS 2018 IEEE, 2018, 256–259
Houssein, E.H., Gad, A.G., Hussain, K., et al.: Major advances in particle swarm optimization: theory, analysis, and application. Swarm Evol. Comput. 63, 100868 (2021)
Jia Z, Cheng H, Tian M. Path Planning Using Adaptive RRT*-Connect Algorithm Base on NURBS Curve Smoothing[C]//2023 IEEE 13th International Conference on CYBER Technology in Automation, Control, and Intelligent Systems (CYBER). IEEE, 2023: 1137–1142.
Acknowledgements
This work was supported in part by Jiangsu Province Graduate Practice Innovation Project (422003272), the Humanities and Social Sciences of Ministry of Education Planning Fund (21YJA630111), the Natural Science Foundation of Jiangsu Province (BK20201162), Changzhou Science and Technology Program Project (CM20223014) and Chang-Zhou Science and Technology Program Project (CJ20220207).
Author information
Authors and Affiliations
Contributions
Shu, Liang, and Sun have written the code section of this article and the article, while Yuan and Pei have controlled the overall content
Corresponding author
Ethics declarations
Competing interests
The authors declare no competing interests.
Conflict of interest
The authors declare that they have no known competing financial interests or personal relationships that could have appeared to influence the work reported in this paper.
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
Shu, R., Yuan, M., Liang, Z. et al. Research on optimal path sampling algorithm of manipulator based on potential function. Int J Intell Robot Appl (2024). https://doi.org/10.1007/s41315-023-00316-9
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s41315-023-00316-9