Mobile Robot's Path Planning Algorithm Combines RRT* and CBS

Research Article
Open access

Mobile Robot's Path Planning Algorithm Combines RRT* and CBS

Xingjin He 1* , Yanting Guo 2
  • 1 School of North cross school shanghai    
  • 2 American School of Milan    
  • *corresponding author 3250873118@qq.com
Published on 24 January 2025 | https://doi.org/10.54254/2755-2721/2024.20627
ACE Vol.131
ISSN (Print): 2755-273X
ISSN (Online): 2755-2721
ISBN (Print): 978-1-83558-939-7
ISBN (Online): 978-1-83558-940-3

Abstract

The A* algorithm is widely used in robot navigation because it ensures finding the shortest path and speeds up the search through heuristic functions. However, the A* algorithm needs to build multi-node paths in advance, which requires a lot of memory and time when facing large maps. In addition, it may only be able to find local optimal solutions, and thus has some limitations when applied to warehouse robot navigation. This paper explores the feasibility and effectiveness of using RRT* algorithm instead of A * algorithm in the field of warehouse robot navigation and tries to combine RRT* algorithm with CBS algorithm to avoid collision between robots. And the combination of RRT* algorithm and CBS algorithm is simulated in simulated obstacles based on MATLAB and compared with the existing A * algorithm and CBS algorithm and concluded that the combination of RRT* algorithm and CBS algorithm improves the efficiency of the path planning of the mobile robot to a certain extent. The algorithm can be used in multi-obstacle warehouse robots and hospital transportation.

Keywords:

Warehouse Robot, Optimal Path Algorithm, Collision Avoidance

He,X.;Guo,Y. (2025). Mobile Robot's Path Planning Algorithm Combines RRT* and CBS. Applied and Computational Engineering,131,110-116.
Export citation

1. Introduction

1.1. Background

Warehouse robotics is gradually being embraced by small and medium-sized businesses as technology develops and society advances, and e-commerce and online shopping proliferate, leading to a demand for efficient warehouse operations [1]. Traditional warehouse management relies on a large number of manual labors to handle, sort and manage goods, resulting in high labor costs, low efficiency and slow speed of manual handling and sorting in the warehouse. In the process of manual operation, there may be goods falling, equipment failure and other safety hazards. With the progress of society, warehouse automation gradually replaces manual labor [2]. In today's society, problems such as low computational efficiency, long waiting time for robots, and collision of multiple robots occur frequently in warehouse management, making warehouse transportation extremely inefficient.

Many traditional methods, such as the A* algorithm, can achieve good results in warehouses with fewer fixed obstacles in the number of goods and fewer mobile warehouse robots. However, as the number of fixed obstacles increases, the timeout problem becomes serious when the A* algorithm is applied to path planning for multiple warehouse robots. Compared with the A* algorithm, the RRT* algorithm is more advantageous in solving complex obstacles [3]. In each expansion step of the RRT* algorithm, the algorithm not only expands the nodes of the tree, but also tries to optimize the path by reconnecting existing nodes. This greatly improves the efficiency in dealing with multiple stationary obstacle problems.

The CBS algorithm is a widely used multi-robot path planning algorithm that finds optimal paths for multiple warehouse robots by resolving their optimal path conflicts [4]. The basic method is to plan the optimal path for each warehouse robot individually, if there is a conflict between the optimal paths of warehouse robots, CBS will generate child nodes, then calculate the global cost function of each child node, and then find the node with the smallest cost in the whole constraint tree [5]. This process is repeated until a path is found where all robots can reach their destinations safely. By this method, CBS can effectively deal with the conflict problem among multiple robots and find the global optimal solution [6]. Therefore, compared to the CBS algorithm and the A* algorithm, this thesis combines the RRT* algorithm with the CBS algorithm with the aim of improving the algorithmic runtime for warehouse robots facing complex obstacles. The difference between this algorithm (RRT* algorithm combined with CBS algorithm) and the traditional algorithms available in the market (A* algorithm combined with CBS algorithm) is that the RRT* algorithm referenced in this algorithm is progressively optimized, and with the increase in the number of iterations and sampling points, the obtained paths will be optimized accordingly, and thus the path planning time is shorter compared to the traditional algorithm (A* algorithm combined with CBS algorithm). Shorter path planning time. This algorithm (combination of RRT* algorithm and CBS algorithm) can be applied to the real problem of warehouse robotics, where warehouse robot path planning is faced with multiple robots and multiple obstacles.

1.2. Proposed idea

Conflict-Based Search (CBS) and Rapidly-exploring Random Tree Star (RRT*) are prominent algorithms used in robot path planning, each addressing different aspects of the problem. CBS is designed for multi-agent path planning, focusing on coordinating several agents navigating through a shared environment. It operates by initially finding a coarse solution that may have conflicts between agents and then iteratively resolving these conflicts through a high-level search strategy. This involves adding constraints to the problem and using a low-level path planning algorithm, such as A* or Dijkstra's, to find feasible paths that adhere to the new constraints [7]. The iterative nature of CBS helps in efficiently finding a conflict-free solution by progressively refining the agents' paths. On the other hand, RRT* is an extension of the Rapidly-exploring Random Tree (RRT) algorithm, aimed at optimizing paths for single-agent planning in continuous spaces. RRT* builds a tree by randomly sampling points and expanding the tree towards these points. It enhances path quality through a process called rewiring, where the newly added nodes are used to potentially shorten existing paths. This incremental optimization allows RRT* to converge to an asymptotically optimal path, making it suitable for scenarios where high-quality paths are required [8]. While CBS excels in managing multiple agents and avoiding collisions, RRT* is valued for its ability to refine paths and improve their quality over time. After seeing the pros of CBS and RRT*, it is easy to assume putting it together is a great idea, and that is exactly what we propose is this paper.

1.3. How it works

In the beginning each agent plans a path on its own using RRT*. To achieve this, the RRT* algorithm is used to help each agent identify an ideal route that spans its origin and destination locations without running into any obstacles.

Once the initial paths are planned, CBS look for conflicts between these paths. It results in a conflict if two or more of these agents are programmed to inhabit the same position (most often all-in) at some time, or if their paths get too close for comfort. If CBS finds a conflict, it handles this by adding constraints. The involved constraints require the affected agents to re-plan their trajectories using RRT* such that they do not yield within the conflict configurations.

Final Path: Paths that are free from conflict where each agent can navigate from its start state to the goal states while navigating through other agents. CBS (Conflict-Based Search) makes sure that the last paths are conflict-free and optimizes them using an RRT* path planner;

1.4. Pseudo Code

Initialize:

Start node q_start

Goal node q_goal

Create a tree `T' with 'q_start' as the root which is empty

While q_goal has not been reached:

a. Generate randomly node q_rand in the search space

b. Search within T for the node which is closest to q_rand, called it as q_nearest

c. Construct a new node q_new by moving in the direction towards q_rand starting at q_nearest, with a range Δq

d. Proceed and logic: If and only if the node q_new there are no obstacles, the node q_new is added to the tree T and the node is connected q_nearest to q_new: T.

e. If there is a distance δ e that compares the two initial newly created corners q_new and q_goal and if v is the distance adopted:

- Then put the goal q_goal into the tree T and cut off the running of the algorithm.

If q_goal has now been attained:

A path to q_goal from << q_start will be traced backwards by looking at the parent of each node.

Return the path

2. Result

Time taken (seconds) for path planning using different algorithms

In the simulations, different arrangements of obstacles is set to see the difference between RRT* and A* in different surroundings.

Test 1.

/word/media/image1.png

Figure 1. Pathfinding uses CBS with A* (right), and Pathfinding uses CBS with RRT* (left)

Table 1. Time spent by pathfinding using A* and CBS (below), and Time spent by Pathfinding using CBS with RRT* (above)

Algorithm/Agent

1

2

3

4

5

RRT* travel time

21

46

41

28

22

A* travel time

27

66

55

41

30

In the first simulation, all the obstacles are evenly distributed in the entire plain. And RRT* constantly outperforms the A* with their travel times. The travel time for RRT ranged from 21 seconds to 46 seconds while the travel time for A* ranged from 27 to 66. This suggests that in a complex situation, RRT* is more efficient than A* in navigation with multi agent path planning.

Test 2.

/word/media/image2.png

Figure 2. Pathfinding uses CBS with A* (right), and Pathfinding uses CBS with RRT* (left)

Table 2. Time spent by pathfinding using A* and CBS (below), and Time spent by Pathfinding using CBS with RRT* (above)

Algorithm/Agent

1

2

3

4

5

RRT* travel time

18

14

27

30

36

A* travel time

23

16

36

43

39

For the second simulation with the same terrain as the first one, RRT* once again outperformed A* by a lot. Especially shown in the first 3 agents. The time for the agents using RRT* to get to their destination ranged from 14 seconds to 36 seconds, while the time for the agents using A* to get to their destination ranged from 16 seconds to 43 seconds. Once again RRT* is faster than A* showing that the first graph isn’t a coincidence.

Test 3.

/word/media/image3.png

Figure 3. Pathfinding uses CBS with A* (right), and Pathfinding uses CBS with RRT* (left)

Table 3. Time spent by pathfinding using A* and CBS (below), and Time spent by Pathfinding using CBS with RRT* (above)

Algorithm/Agent

1

2

3

4

5

RRT* travel time

33

6

8

13

13

A* travel time

36

4

16

10

17

In the third simulation, the plain has lots of obstacles and they are high noisily located from each othe. In this case RRT* travel times are slightly faster overall—from 6 to 33 seconds. A* this time out competed RRT*in some cases, their time range is from 4-36. This is because since the obstacles are clustered it is likely that there is a straight forward path that A* can take which is often faster than the route RRT* provided.

Test 4.

/word/media/image4.png

Figure 4. Pathfinding uses CBS with A* (right), and Pathfinding uses CBS with RRT* (left)

Table 4. Time spent by pathfinding using A* and CBS (below), and Time spent by Pathfinding using CBS with RRT* (above)

Algorithm/Agent

1

2

3

4

5

RRT* travel time

29

34

15

15

26

A* travel time

31

32

14

16

30

The fourth simulation is different. It uses a plain with no obstacles. Which is why some agent where able to arrive to their destination using RRT* and others using A*. This is because it is easy for A* to just find a straight path that requires a turn their being fast. However, if RRT* finds a straight path from start to end, it will still be faster than A*. This is shown in the result, the travel times for RRT* ranges from 15 to 34 seconds, while the travel time for A* ranges from 14 to 32 seconds, which indicate that both algorithms perform similarly when the path is clear, with RRT* still maintaining a slight advantage.

Test 5.

/word/media/image5.png

Figure 5. Pathfinding uses CBS with A* (right), and Pathfinding uses CBS with RRT* (left)

Table 5. Time spent by pathfinding using A* and CBS (below), and Time spent by Pathfinding using CBS with RRT* (above)

Algorithm/Agent

1

2

3

4

5

RRT* travel time

30

18

20

23

16

A* travel time

29

17

26

30

21

In the final test, which also have groups of obstacles clustered all together. Both algorithms show similar results, tut this time it is similar because the start and end are closer than most other simulations so it is easy for A* to just find one straight line to the end. But RRT* is still slightly faster when compared with A*. RRT* times range from 16 to 30 seconds, and A* times from 17 to 30 seconds. This shows that even when the situation is easier for A* RRT* still can be faster.

As shown in Figures 1 to 5, the warehouse robots utilize different algorithms for the same starting and ending points. The results are shown in Table 1; the warehouse robot mostly takes less time when the CBS with RRT* algorithm is applied. The main feature of the RRT* algorithm is the ability to find an initial path quickly and then, as the number of sampling points increases, optimize until the target point is found or a set maximum number of cycles is reached. The RT* algorithm is asymptotically optimized; as the number of iterations increases, the resulting path is more and more optimized, and the optimal path can never be derived in a finite amount of time.

3. Discussion

In the research of this thesis (CBS and RRT* combined algorithm) the optimal path algorithm for warehouse robots facing complex environments was solved. However, in the operation of the algorithm the following problem arises: the algorithm is not able to plan the path in continuous time, this problem makes the algorithm slow in the operation of the computation and not able to move the warehouse robot effectively at the same time. So, the algorithm will be optimized in the future so that the warehouse robot algorithm can solve the optimal path planning problem in the face of different robots with different speeds by reducing the discrete nature of the paths and increasing the time factor in continuous time.

4. Conclusion

With the increased demand for shopping by young people, the use of warehouse robots has become important in the efficient management of warehouses. Although there are many robot path algorithms in the society nowadays, many warehouse robot algorithms have many shortcomings to cope with the problem of complex obstacles. In this paper, we propose an improved robot navigation and multi-robot collision avoidance algorithm that combines the RRT* algorithm and the CBS algorithm. This algorithm eliminates the large amount of multi-obstacle processing in the A * algorithm compared to the A * algorithm, so that the robot can move in more directions, based on the CBS algorithm, thus effectively shortening the path planned by the robot. By testing the CBS and RRT* algorithms together several times in complex environments, this study found that the combination of the CBS and RRT* algorithms had a significant impact on complex obstacle problem solving in warehouses. It is expected that this algorithm will be utilized in today's productive society. Future research on warehouse robotics algorithms will focus on increasing the time factor into the algorithm, focusing on increasing the time efficiency of warehouse robot path planning. Additionally, these studies are currently based on computer simulations and more field experiments will be needed in the future to further refine them.

Acknowledgement

All the authors contributed equally to this work and should be considered as co-first author


References

[1]. Licardo, Josip Tomo, Mihael Domjan, and Tihomir Orehovački. 2024. "Intelligent Robotics—A Systematic Review of Emerging Technologies and Trends" Electronics 13, no. 3: 542. https://doi.org/10.3390/electronics13030542

[2]. Dhaliwal, Amandeep. (2020). The Rise of Automation and Robotics in Warehouse Management. 10.1201/9781003032410-5.

[3]. Zammit, Christian & Van Kampen, Erik-Jan. (2021). Comparison between A* and RRT Algorithms for 3D UAV Path Planning. Unmanned Systems. 10. 10.1142/S2301385022500078.

[4]. Chen, Xin & Li, Yanjie & Liu, Lintao. (2019). A Coordinated Path Planning Algorithm for Multi-Robot in Intelligent Warehouse *. 2945-2950. 10.1109/ROBIO49542.2019.8961586.

[5]. Yang, Liwei, Ping Li, Song Qian, He Quan, Jinchao Miao, Mengqi Liu, Yanpei Hu, and Erexidin Memetimin. 2023. "Path Planning Technique for Mobile Robots: A Review" Machines 11, no. 10: 980. https://doi.org/10.3390/machines11100980

[6]. Guni Sharon, Roni Stern, Ariel Felner, Nathan R. Sturtevant, Conflict-based search for optimal multi-agent pathfinding, Artificial Intelligence, Volume 219, 2015, Pages 40-66, ISSN 0004-3702, https://doi.org/10.1016/j.artint.2014.11.006.

[7]. Liao, B., Zhu, S., Hua, Y. et al. A decoupling method for solving the multi-agent path finding problem. Complex Intell. Syst. 9, 6767–6780 (2023). https://doi.org/10.1007/s40747-023-01088-2

[8]. Noreen, Iram & Khan, Amna & Habib, Zulfiqar. (2016). Optimal Path Planning using RRT* based Approaches: A Survey and Future Directions. International Journal of Advanced Computer Science and Applications. 7. 10.14569/IJACSA.2016.071114.


Cite this article

He,X.;Guo,Y. (2025). Mobile Robot's Path Planning Algorithm Combines RRT* and CBS. Applied and Computational Engineering,131,110-116.

Data availability

The datasets used and/or analyzed during the current study will be available from the authors upon reasonable request.

Disclaimer/Publisher's Note

The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of EWA Publishing and/or the editor(s). EWA Publishing and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

About volume

Volume title: Proceedings of the 2nd International Conference on Machine Learning and Automation

ISBN:978-1-83558-939-7(Print) / 978-1-83558-940-3(Online)
Editor:Mustafa ISTANBULLU
Conference website: https://2024.confmla.org/
Conference date: 21 November 2024
Series: Applied and Computational Engineering
Volume number: Vol.131
ISSN:2755-2721(Print) / 2755-273X(Online)

© 2024 by the author(s). Licensee EWA Publishing, Oxford, UK. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license. Authors who publish this series agree to the following terms:
1. Authors retain copyright and grant the series right of first publication with the work simultaneously licensed under a Creative Commons Attribution License that allows others to share the work with an acknowledgment of the work's authorship and initial publication in this series.
2. Authors are able to enter into separate, additional contractual arrangements for the non-exclusive distribution of the series's published version of the work (e.g., post it to an institutional repository or publish it in a book), with an acknowledgment of its initial publication in this series.
3. Authors are permitted and encouraged to post their work online (e.g., in institutional repositories or on their website) prior to and during the submission process, as it can lead to productive exchanges, as well as earlier and greater citation of published work (See Open access policy for details).

References

[1]. Licardo, Josip Tomo, Mihael Domjan, and Tihomir Orehovački. 2024. "Intelligent Robotics—A Systematic Review of Emerging Technologies and Trends" Electronics 13, no. 3: 542. https://doi.org/10.3390/electronics13030542

[2]. Dhaliwal, Amandeep. (2020). The Rise of Automation and Robotics in Warehouse Management. 10.1201/9781003032410-5.

[3]. Zammit, Christian & Van Kampen, Erik-Jan. (2021). Comparison between A* and RRT Algorithms for 3D UAV Path Planning. Unmanned Systems. 10. 10.1142/S2301385022500078.

[4]. Chen, Xin & Li, Yanjie & Liu, Lintao. (2019). A Coordinated Path Planning Algorithm for Multi-Robot in Intelligent Warehouse *. 2945-2950. 10.1109/ROBIO49542.2019.8961586.

[5]. Yang, Liwei, Ping Li, Song Qian, He Quan, Jinchao Miao, Mengqi Liu, Yanpei Hu, and Erexidin Memetimin. 2023. "Path Planning Technique for Mobile Robots: A Review" Machines 11, no. 10: 980. https://doi.org/10.3390/machines11100980

[6]. Guni Sharon, Roni Stern, Ariel Felner, Nathan R. Sturtevant, Conflict-based search for optimal multi-agent pathfinding, Artificial Intelligence, Volume 219, 2015, Pages 40-66, ISSN 0004-3702, https://doi.org/10.1016/j.artint.2014.11.006.

[7]. Liao, B., Zhu, S., Hua, Y. et al. A decoupling method for solving the multi-agent path finding problem. Complex Intell. Syst. 9, 6767–6780 (2023). https://doi.org/10.1007/s40747-023-01088-2

[8]. Noreen, Iram & Khan, Amna & Habib, Zulfiqar. (2016). Optimal Path Planning using RRT* based Approaches: A Survey and Future Directions. International Journal of Advanced Computer Science and Applications. 7. 10.14569/IJACSA.2016.071114.