Abstract
The slow convergence rate and large cost of the initial solution limit the performance of rapidly exploring random tree star (RRT*). To address this issue, this paper proposes a modified RRT* algorithm (defined as FF-RRT*) that creates an optimal initial solution with a fast convergence rate. An improved hybrid sampling method is proposed to speed up the convergence rate by decreasing the iterations and overcoming the application limitation of the original hybrid sampling method towards concave cavity obstacle. The improved hybrid sampling method combines the goal bias sampling strategy and random sampling strategy, which requires a few searching time, resulting in a faster convergence rate than the existing method. Then, a parent node is created for the sampling node to optimize the path. Finally, the performance of FF-RRT* is validated in four simulation environments and compared with the other algorithms. The FF-RRT* shortens 32% of the convergence time in complex maze environment and 25% of the convergence time in simple maze environment compared to F-RRT*. And in a complex maze with a concave cavity obstacle, the average convergence time of Fast-RRT* in this environment is 134% more than the complex maze environment compared to 12% with F-RRT* and 34% with FF-RRT*. The simulation results show that FF-RRT* possesses superior performance compared to the other algorithms, and also fits with a much more complex environment.
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.Avoid common mistakes on your manuscript.
Introduction
Due to the advantage of convenience and the universality of application, there is an increasing interest in mobile robots. Path planning is one of the prime concerns to be explored in mobile robots. Generally speaking, path planning is to generate a feasible and optimal path between the source and destination in a preset environment with several performance indicators, such as distance cost and work time. Nowadays, path planning algorithms have been applied substantially in many fields including, but not limited to, unmanned aerial vehicles [1, 2], additive manufacturing [3, 8] and biology [9]. It is worth noting that the detection algorithm [10] lays the foundation for path planning by identifying the external environment.
Path planning becomes a hot issue and a lot of research is being conducted. Nowadays, there are several commonly used path-planning algorithms: artificial potential field methods [11], geometric algorithms [12], grid-based searches [13], sampling-based algorithms [14, 15], and learning-based algorithms [16, 17]. Although the learning-based algorithm shows superior performance in path planning, its reliability of it needs to be further verified theoretically. Benefiting from the excellent performance, increasing attention has been focused on the sample-based algorithm in the current study. Rapidly exploring Random Trees (RRT) is a typical representation of sample-based algorithm. Compared to other algorithms, RRT can find a feasible solution without complicated computation. However, the path created by RRT is not optimal. To solve this problem, the RRT* is proposed [18]. It mainly introduces two procedures, ChooseParent and Rewire procedure, into RRT to increase the number of samples and generate an optimal path. However, the increased number of samples leads to its slow convergence. It cannot generate the optimal path during the limited time. In addition, the optimization effect is not satisfactory. To solve the problem, researchers have proposed many RRT*-variants in recent years.
Introducing a sampling strategy is one of the useful ways. On the one hand, the sampling strategy can be applied to the initial path of RRT*. RRT*-Smart [19] obtains an optimal path by applying the intelligent sampling method in RRT*. However, the algorithm only adapted to the environment containing obstacles with simple geometries. Informed-RRT* [20] generates an elliptical sampling region according to the start and goal point, which is continuously narrowed with the sampling process, to quickly gain the optimal path. However, once the generated prolate hyper-spheroid is bigger than the planning problem domain, the algorithm has poor performance. On the other hand, the sampling strategy can also be applied to searching the nodes during the path planning process. P-RRT* [21] determines the extension direction by artificial potential fields. Based on it, PQ-RRT* [22] combines it with Quick-RRT* [23] to further shorten the convergence time. Moreover, AFG-RRT* [24] and improved bidirectional RRT∗ [25] are also applied to the artificial field to ensure directional exploration. Wang et al. use a CNN model trained with the successful example to predict the extension direction and guide the generation of nodes [26]. G-RRT* [27] and ED-RRT* [28] shorten the sampling process by goal-oriented sampling. The Fast-RRT* [29] introduces the hybrid sampling strategy to narrow the sampling area and shorten the convergence rate. It is worth noting that the applicability of the hybrid sampling method is poor in the complex environment with concave cavity obstacle. Since these algorithms mainly reduce the convergence rate by improving the quality of sampling, the optimization effect is still not satisfactory.
In addition to the improved sampling strategy, reducing nodes is another effective way. Karaman et al. use the heuristic function to calculate the path cost [30]. The point will be cut off if it cannot decrease the cost. MOD-RRT* [31] expands the tree with a goal point to calculate the cost between nodes and the goal point and cut off the node which brings the additional cost. Except for reducing the tree nodes, reducing path nodes can also improve the convergence rate. In this field, Jeong et al. propose Quick-RRT* [23], which applies triangular inequality to improve the RRT*. Inspired by Quick-RRT*, Kang et al. [32] use the triangular inequality to improve the performance of RRT-Connect [33]. Furthermore, Liao et al. proposed the F-RRT* [34]. By applying the FindReachest procedure with triangular inequality and the CreatNode procedure with dichotomy method, the path cost is greatly reduced. It is worth noting that the parameter Ddichotomy needs to be identified because F-RRT ∗ with a smaller Ddichotomy not only improves the quality of the path but also increases the computation time. It is useful to combine the sampling strategy algorithm with F-RRT* to improve the quality of sampling to compensate for the increasing computation time.
This paper proposes a sampling-improved path planning algorithm, FF-RRT*. FF-RRT* takes advantage of Fast-RRT* and F-RRT* and overcomes the weakness of these two algorithms. The hybrid sampling method is improved to achieve effective sampling and overcome the application limitation of the original hybrid sampling method. The search scopes of the ChooseParent and Rewire procedures are expanded to optimize the path and shorten the convergence time. The CreatNode process creates a new parent node based on the dichotomy method to get an optimal parent node to \(x_{{{\text{rand}}}}\). Compared with F-RRT* and Fast-RRT*, FF-RRT* generates an optimal path with a short convergence time and has superior environment adaptability. The theoretical analysis is provided for the characteristics of FF-RRT*. And the superior performance of FF-RRT* is validated by the comparative simulations with four simulation environments.
This paper is organized as follows: "Problem definition" introduces the path planning problem. "Related work" introduces the related work of FF-RRT*. "FF-RRT*" states the FF-RRT*. "Analysis" presents a theoretical analysis of completeness, optimality, and computational complexity. Four simulation environments are used in "Simulation results" to demonstrate the performance of FF-RRT* compared with F-RRT* and Fast-RRT*. Finally, a summary is given in "Conclusion".
Problem definition
Let \(X \subseteq R^{c}\) be the workspace, where \(c \in N,c \ge 2\). Let \(X_{{{\text{obs}}}} \subset X\) be the obstacle region, and the collision-free region is \(X_{{{\text{free}}}} = X - X_{{{\text{obs}}}}\). \(x_{{\text{s}}}\) and \(x_{{\text{g}}}\) are source and destination. The path is described as a function \(\phi\).
Path planning aims to generate a path \(\phi\) that begins at the initial point \(\phi (0) = x_{{\text{s}}}\) and reaches the destination \(\phi (1) = x_{{\text{g}}}\) and \(\phi (\upsilon ) \in X_{{{\text{free}}}}\) for all \(\upsilon \in [0,1][0,1]\). The \(\phi\) that fulfills the requirement is called a feasible path. Based on the definition above, the path planning problem can be described as generate a feasible path in the workspace \(X\) with the initial conditions \(\{ x_{{\text{s}}} ,X_{{{\text{obs}}}} ,x_{{\text{g}}} \}\). Definitions 1 and 2 present, respectively, the feasibility and optimal path planning problem.
Definition 1.
Feasible path planning is to generate \(\phi\) such that \(\phi (0) = x_{{\text{s}}}\), and \(\phi (1) = x_{{\text{g}}}\) and \(\phi (\upsilon ) \in X_{{{\text{free}}}}\) for all \(\upsilon \in [0,1]\).
Definition 2.
Optimal path planning is to find a \(\phi^{*}\) that match the optimal condition \(c(\phi^{*} ) = \min \{ c(\phi ):\phi {\text{ is feasible}}\}\), where \(c(\phi )\) represents the cost of \(\phi\).
Related work
This section mainly introduces the related work of the proposed method. The main improvement of Fast-RRT* [29] and F-RRT* [34] compared to RRT* is introduced subsequently.
Fast-RRT*
The pseudocode of Fast-RRT* is outlined in Algorithm 1. Fast-RRT* has two improvements compared to RRT*. Firstly, hybrid sampling is used to select the \(x_{{{\text{rand}}}}\) instead of random sampling by RRT. The goal bias strategy and the constraint sampling are combined to improve the sampling quality. The position of the previous sampling node \(x_{{{\text{p\_rand}}}}\) and a value \(\lambda\) are used in the sampling process, and \(0 < \lambda < 1\). HybridSampling procedure is outlined in Algorithm 2. Secondly, the Backtracking procedure is applied to improve the ChooseParent procedure. The ancestor node set of \(x_{{{\text{rand}}}}\) is generated by tracking from the temporary parent node to the start point. And the parent node of \(x_{{{\text{rand}}}}\) is replaced by the node with the lowest path cost in the set. The improved ChooseParent procedure of Fast-RRT* is shown in Algorithm 3. The Backtracking procedure is outlined in Algorithm 4. However, although the hybrid sampling method accelerates the sampling process, it has applicability limitation towards some special obstacle scenes.
![figure a](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figa_HTML.png)
![figure b](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figb_HTML.png)
![figure c](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figc_HTML.png)
![figure d](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figd_HTML.png)
F-RRT*
The F-RRT* is outlined in Algorithm 5. F-RRT* has also two improvements compared to RRT*, the FindReachest and CreatNode procedure. By comparison, the FindReachest procedure is the same as the Backtracking procedure. Hence, in Algorithm 5, the improved ChooseParent procedure is the same as in Fast-RRT*. Compared to Fast-RRT*, F-RRT* introduces the CreatNode procedure to get an optimal path. The CreatNode procedure creates a new parent node \(x_{{{\text{create}}}}\) based on the dichotomy method. A parameter Ddichotomy is used to determine whether satisfies the requirements. The CreatNode procedure is shown in Algorithm 6. Meanwhile, compared with Fast-RRT*, F-RRT* continues to adopt the Rewire procedure of RRT*, which is shown in Algorithm 7. However, the CreatNode procedure not only improves the quality of the path but also increases the computation time.
![figure e](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Fige_HTML.png)
![figure f](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figf_HTML.png)
![figure g](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figg_HTML.png)
FF-RRT*
This paper proposes the FF-RRT* algorithm, which combines the advantages of Fast-RRT* and F-RRT* and overcomes the weakness of these two algorithms. FF-RRT is shown in Algorithm 8. The improved hybrid sampling method is used to improve the sampling quality to compensate for the large computation time generated by the CreatNode procedure of F-RRT* and remove the applicability limitation of Fast-RRT*.
First, the tree node is sampled by the improved HybridSampling procedure. The improved HybridSampling procedure is outlined in Algorithm 9. Different from the original hybrid sampling outlined in Algorithm 2, the improved hybrid sampling combines the random sampling strategy and the constrained sampling strategy to overcome the application limits of the original hybrid sampling. Second, the search scopes of the ChooseParent and Rewire procedures are expanded to the ancestor of the temporary parent node to accelerate the convergence rate. The improved ChooseParent procedure is the same as Fast-RRT* and F-RRT*. The improved Rewire procedure is shown in Algorithm 10. Thirdly, the CreatNode procedure is adopted to generate an optimal parent node for \(x_{{{\text{rand}}}}\) based on the dichotomy method to generate an optimal path. The FF-RRT* is constructed as shown in Fig. 1. And the comparison between FF-RRT* and related works is illustrated in Table 1.
![figure h](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figh_HTML.png)
![figure i](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figi_HTML.png)
![figure j](http://media.springernature.com/lw685/springer-static/image/art%3A10.1007%2Fs40747-023-01111-6/MediaObjects/40747_2023_1111_Figj_HTML.png)
The improved HybridSampling procedure
Inspired by the Fast-RRT*, we replace the random sampling with improved hybrid sampling to achieve goal-orientation. Figure 1 illustrates the sampling area of both random sampling and original hybrid sampling in a simple environment. Figure 2a shows the sampling area of random sampling in the pink area, and Fig. 2b shows the node created by the original hybrid sampling is constrained in the green area. It is obvious that the quality of the node sampled by hybrid sampling is greater than the random sampling in the simple obstacle environment. However, in a complex environment with a concave cavity obstacle, the performance of the original hybrid sampling is poor, which is shown in Fig. 3. The original hybrid sampling cannot generate the node to escape from the obstacle in one iteration. In contrast, random sampling can do it. Hence, we combine the random and constrained sampling to improve the original hybrid sampling procedure, shown in Algorithm 11. Compared to the original hybrid sampling, the goal bias strategy is replaced by the random sampling method. And the sampling process can quickly escape from the concave cavity obstacle with random sampling under a certain probability. As a result, the applicability of hybrid sampling is increased.
The improved ChooseParent procedure
Compared to RRT*, the ChooseParent procedure is shown in Fig. 4. The parent node of \(x_{{{\text{rand}}}}\) is replaced by the farthest ancestor node that can be reached. The rad pot represents the \(x_{rand}\), the blue pot represents the \(x_{{{\text{present}}}}\), the green pots represent the nodes in \(X_{{{\text{near}}}}\), the red line presents the created connection relationship. The parent node of \(x_{{{\text{rand}}}}\) will be replaced by the farthest ancestor node that can be reached.
The CreatNode procedure
To get close to the obstacle to decrease the path cost, we create an optimal parent node for \(x_{{{\text{rand}}}}\) during the CreatNode procedure. The CreatNode procedure is shown in Fig. 5.
The improved Rewire procedure
Compared to F-RRT*, the improved Rewire procedure is shown in Fig. 6. As long as there are no obstacles between \(X_{{{\text{near}}}}\) and \(x_{{{\text{present}}}}\), the parent node of \(X_{{{\text{near}}}}\) will be replaced by \(x_{{{\text{present}}}}\). The grey dashed lines present the rewired nodes’ original connection relationship.
Analysis
Probabilistic completeness
RRT processes the probabilistic completeness characteristic and RRT* inherits it [18]. Additionally, Li et al. prove Fast-RRT* inherits this property [29]. Theorem 1 describes the probabilistic completeness of FF-RRT*.
Theorem 1.
For any feasible path planning problems, the probability of finding a feasible path by FF-RRT* approaches one, i.e.,
where \(Q_{n}^{{{\text{FF - RRT}}*}}\) is the set of nodes generated by FF-RRT* after n iteration.
Proof of Theorem 1.
In the FF-RRT*, the improved HybridSampling method is just used to improve the sampling quality. Additionally, the CreateNode and improved Rewire procedure just optimal the path and change the connection relationship. The adjustments of FF-RRT* do not destroy the connectivity. The path can still connect \({\text{x}}_{{\text{s}}}\) and \(x_{{\text{g}}}\). Hence, the FF-RRT* processes the probabilistic completeness as Fast-RRT*.
Asymptotic optimality
RRT* has the asymptotic optimality characteristic compared to RRT [18]. Theorem 2 states that FF-RRT* inherits the asymptotic optimality characteristic.
Theorem 2.
For any given feasible path planning problem, the FF-RRT* can generate the optimum path as the number of iterations approaches infinity:
where \(Y_{n}^{{{\text{FF - RRT}}*}}\) represents the cost of the path generated by FF-RRT* after n iterations, \(C^{*}\) represents the minimum cost.
Proof of Theorem 2.
Firstly, the differences between Fast-RRT* and RRT* are HybridSampling and Rewire procedure. The HybridSampling procedure is used to improve the sampling quality, which does not influence the asymptotic optimality characteristic. Additionally, Fast-RRT* does not adopt the Rewire procedure as RRT*. Therefore, the Fast-RRT* combined with the Rewire procedure can inherit the asymptotic optimality characteristic. With the improved HybridSampling procedure and the improved Rewire procedure, the FF-RRT* is just an improved method of Fast-RRT* combined with the Rewire procedure, so the FF-RRT* also inherits the asymptotic optimality characteristic.
Computational complexity
Theorem 3 states FF-RRT* has the same computational complexity as F-RRT*.
Theorem 3.
For any given feasible path planning problem, there will be a constant \(\varepsilon_{1}\) to match:
where \(S_{n}^{i}\) is the number of procedures executed by algorithm i after n iterations.
Proof of Theorem 3.
The differences between FF-RRT* and F-RRT* are the improved HybridSampling procedure and the improved Rewire procedure. For the improved HybridSampling procedure, it just improves the sampling quality by constraining the sampling area and does not increase the computation amount. For the improved Rewire procedure, it just changes the connection between nodes compared to Rewire procedure. Hence, Theorem 3 is proved.
Simulation results
FF-RRT* is simulated in 2-dimensional map, which contains four test environments. In the simulation, the performance of FF-RRT* is compared with Fast-RRT* and F-RRT, because they are the basement of FF-RRT* and are the latest representations of the variant of RRT*. Every algorithm was repeated 100 times during the simulation to resist randomness.
The simulation will compare the performance of algorithms by three indicators: Ci, which is the cost of the generated path by algorithm i; Ni, which is the number of iterations to generate the path by algorithm i, Ti, which is the time of generating the path by algorithm i. The algorithm will stop once the feasible path is found or the max iteration is reached. The simulation is implemented on an AMD Ryzen 7 5800X CPU with 8G of RAM. The simulation environments are illustrated in Fig. 7. The four simulation environments are the same size 9000 × 6000.
During the simulation process, the parameters that need to be identified are \(R_{{{\text{near}}}}\),\(n_{\max }\), Ddichotomy, \(\lambda\). In the simulation process, \(n_{\max } = 30,000\). In the sampling procedure, \(\lambda = 0.5\). In the improved ChooseParent procedure, \(R_{{{\text{near}}}} = 200\). And in CreatNode procedure, referring to the Reference [34], we did the simulation to choose the value of \(D_{{{\text{dichotomy}}}}\). The relationship between the performance of the F-RRT* in the cluttered environment and \(D_{{{\text{dichotomy}}}}\) is shown in Fig. 8. It can be seen that when the \(D_{{{\text{dichotomy}}}}\) increases, CF-RRT* increases, while TF−RRT* decreases simultaneously. To avoid the additional computation time, the value of \(D_{{{\text{dichotomy}}}}\) is set as 300.
Simple maze
Figure 9 shows the performance of the three algorithms in a simple maze environment. It can be seen that F-RRT* and the proposed algorithm, FF-RRT* generate a path that is closer to obstacles and have a better initial solution than Fast-RRT*. Figure 10 shows the statistics of Ci, Ni, Ti and Table 2 illustrates the average value of Ci, Ni, Ti with 100 simulations. The average of Ci for Fast-RTT* is higher than the average of Ci for F-RRT* and FF-RRT*, which also shows that the last two algorithms generate a more optimal path than Fast-RRT*. And according to the box height, the performances of the last two algorithms are more stable. Additionally, the average value of Ni and Ti for FF-RRT* are lower than the F-RRT*. By the improved HybridSampling procedure, there is a 35% reduction in the average value of Ni and a 25% reduction in the average value, which shows that FF-RRT* has a faster convergence rate than F-RRT*. Meanwhile, since the Ni for FF-RRT* has no significant difference from it for Fast-RRT*, the Ti for FF-RRT* is still higher than the Ti for Fast-RRT*. It is because that the application of dichotomy. Based on the above analysis, the proposed method, FF-RRT* can generate a more optimal path than Fast-RTT* with a less convergence time than F-RRT*.
Complex maze
Figure 11 shows the performance of algorithms in complex maze environment. It can be also clearly seen that F-RRT* and the proposed algorithm, FF-RRT* generate a path that is closer to obstacles and have better performance than Fast-RRT*. Figure 12 shows the statistics Ci, Ni, Ti. The statistics result show that FF-RRT* can generate a more optimal path than Fast-RTT* with a less convergence time than F-RRT* in a complex maze environment. Table 3 illustrates the average value of Ci, Ni, Ti in a complex maze environment. Combing with statistics in Table 2, the FF-RRT* shortens 32% of the Ti in a complex maze environment and 25% of the Ti in a simple maze environment compared to F-RRT*, which shows that the more complex the maze environment becomes, the better the FF-RRT* performs compared to F-RRT*.
Complex maze with concave cavity obstacle
Figure 13 illustrated the performance of algorithms in the complex maze with a concave cavity obstacle environment. It can be seen that the Fast-RRT* needs to take much more iterations to get out of the concave cavity obstacle compared to F-RRT* and FF-RRT*, which shows the applicability limits of the original hybrid sampling method. Figure 14 shows the performance of the three algorithms of Ci, Ni, Ti. It can be also seen from the box that the average of Ni for Fast-RTT* is higher than the average of Ni for F-RRT* and FF-RRT*, which also shows the poor performance of Fast-RRT* towards concave cavity obstacle. However, the Ti of Fast-RRT* is still the lowest of the three algorithms. It is because the increased iterations mainly appear in the beginning and most of them are quickly skipped over, leading to a low cost per iteration. Table 4 illustrates the average value of Ci, Ni, Ti. It can be obtained by calculation that the average Ti of Fast-RRT* in this environment is 134% more than in the complex maze environment compared to 12% with F-RRT* and 34% with FF-RRT*. The comparison result shows the poor performance of the original hybrid sampling method and the effectiveness of the improved hybrid sampling method for concave cavity obstacle. Based on the above analysis, the proposed method, FF-RRT*, has stronger applicability compared to Fast-RRT* by the improved hybrid sampling method.
Cluttered environment
Figure 15 illustrates the performances of algorithms in a cluttered environment. Different from the other two environments, it cannot be seen that F-RRT* and FF-RRT* generate a more optimal path than Fast-RRT*. It is because the distance between two obstacles is relatively small, which weakens the performance of the dichotomy method. Additionally, comparing Fig. 15c to (b), the quality of searching direction is improved by the improved HybridSampling procedure. Figure 16 shows the statistics Ci, Ni, Ti. The statistics result show that FF-RRT* can generate a more optimal path than Fast-RTT* with a less convergence time than F-RRT*. Table 5 illustrates the average value of Ci, Ni, Ti. Combing with the statistics in Table 3, the last two algorithms shorten 15% of the Ci in a cluttered environment compared to 20% in a complex maze environment, which shows that FF-RRT* performs better in a maze environment.
From the above analysis, FF-RRT* has a superior performance compared to Fast-RRT* and F-RRT*. The boxes show that FF-RRT* can generate a more optimal solution than Fast-RRT* and the optimal path generated by the FF-RRT* requires fewer iterations than F-RRT*. Moreover, the application limits of the original hybrid sampling method are overcome by the improved HybridSampling procedure. We sum up that FF-RRT* is suitable for more complex environments than Fast-RRT* and can generate an optimal path with a faster convergence rate.
Conclusion
A novel sampling-improved path planning algorithm, FF-RRT* is proposed in the paper. By combining and improving the adjustments of F-RRT* and Fast-RRT*, the FF-RRT* can obtain an optimal path with a short convergence time. The major imp of FF-RRT* is to propose the improved HybridSampling procedure and introduce it into the F-RRT* to improve sampling quality and decrease the iterations to increase the convergence rate. Additionally, the improved HybridSampling procedure is applicable to the environment with concave cavity obstacle, which overcomes the application limitation of the original HybridSampling procedure in Fast-RRT*. The superior performance of the FF-RRT* was verified by numerical simulation compared to F-RRT* and Fast-RRT*. The FF-RRT* shortens 32% of the convergence time in complex maze environment and 25% of the convergence time in simple maze environment compared to F-RRT*. And in a complex maze with a concave cavity obstacle, the average convergence time of Fast-RRT* in this environment is 134% more than the complex maze environment compared to 12% with F-RRT* and 34% with FF-RRT*.
Although the FF-RRT* algorithm can effectively decrease the convergence time by improved HybridSampling procedure, the increased computation problem caused by the application of dichotomy has not been fundamentally solved. Additionally, the applicability to three-dimensional environment [35, 36] is also a valuable research direction. Meanwhile, when actually used for certain robots, such as drones, the continuity of the generated paths needs to be guaranteed [37, 38]. Hence, how to decrease the computation time of dichotomy fundamentally and maintain the continuity of the generated path in a three-dimensional environment is our future study direction.
Data availability
The data that support the findings of this study are available from the corresponding author upon reasonable request.
Abbreviations
- \(X\) :
-
Workspace
- \(X_{{{\text{obs}}}}\) :
-
The obstacle region
- \(X_{{{\text{free}}}}\) :
-
The collision-free region
- \(x_{{\text{s}}}\),\(x_{{\text{g}}}\) :
-
Source and destination
- \(\phi\), \(\phi^{*}\) :
-
Path and optimal path
- \(H\) :
-
The node tree
- \(Q\) :
-
The node set of the tree
- \(L\) :
-
Connection of every node
- \(x_{{{\text{rand}}}}\) :
-
The random node created by sampling process
- \(X_{{{\text{near}}}}\) :
-
A circular region centered on \(x_{{{\text{rand}}}}\)
- \(R_{{{\text{near}}}}\) :
-
The Radius length of \(X_{{{\text{near}}}}\)
- \(x_{{{\text{p\_rand}}}}\) :
-
The node generated by the last sample
- \(\lambda\) :
-
A random value used in the sampling process of Fast-RRT*
- \(\lambda_{r}\) :
-
A standard value used in the sampling process of Fast-RRT*
- \(n_{\max }\) :
-
The maximum number of iterations
- \(x_{{{\text{parent}}}}\) :
-
The parent node of the random node
- D dichotomy :
-
A parameter for the dichotomy method in F-RRT*
- \(Q_{n}^{{{\text{FF - RRT}}*}}\) :
-
The set of nodes generated by FF-RRT* after n iteration
- \(Y_{n}^{{{\text{FF - RRT}}*}}\) :
-
The cost of the path generated by FF-RRT* after n iterations
- \(C^{*}\) :
-
The minimum cost
- \(S_{n}^{i}\) :
-
The number of procedures executed by algorithm i after n iterations
- C i :
-
The cost of the generated path by algorithm i
- N i :
-
The number of iterations to generate the path by algorithm i
- T i :
-
The time of generating the path by algorithm i
- A i :
-
Sum of turning angles by algorithm i
References
Aggarwal S, Kumar N (2019) Path planning techniques for unmanned aerial vehicles: a review, solutions, and challenges. Comput Commun. https://doi.org/10.1016/j.comcom.2019.10.014
Fan J, Chen X, Liang X (2022) UAV trajectory planning based on bi-directional APF-RRT* algorithm with goal-biased. Expert Syst Appl. https://doi.org/10.1016/j.eswa.2022.119137
Jin Y, He Y, Jianke Du (2017) A novel path planning methodology for extrusion-based additive manufacturing of thin-walled parts. Int J Comput Integr Manuf. https://doi.org/10.1080/0951192X.2017.1307526
Jiang J, Ma Y (2020) Path planning strategies to optimize accuracy, quality, build time and material use in additive manufacturing: a review. Micromachines. https://doi.org/10.3390/mi11070633
Rezazadeh J, Moradi M, Ismail AS, Dutkiewicz E (2014) Superior path planning mechanism for mobile beacon-assisted localization in wireless sensor networks. IEEE Sens J. https://doi.org/10.1109/JSEN.2014.2322958
Yildiz D, Karagol S (2021) Path planning for mobile-anchor based wireless sensor networks localization: obstacle-presence schemes. Sensors. https://doi.org/10.3390/s21113697
Vargas ÁJO, Serrano JEC, Acuña LC, Martinez-Santos JC (2020) Path planning for non-playable characters in arcade video games using the wavefront algorithm. In: 2020 IEEE games, multimedia, animation and multiple realities conference (GMAX)
Ghanatian M, Yazdi MRH, Masouleh MT (2021) Experimental study on reducing the oscillations of a cable-suspended parallel robot for video capturing purposes using simulated annealing and path planning. In: 2021 7th International conference on signal processing and intelligent systems (ICSPIS), Tehran, Iran
Koul S, Horiuchi TK (2019) Waypoint path planning with synaptic-dependent spike latency. IEEE Trans Circuits Syst I Regul Pap 66(4):1544–1557
Shen LZ, Tao HF, Ni YZ, Wang Y, Vladimir S (2023) Improved YOLOv3 model with feature map cropping for multi-scale road object detection. Meas Sci Technol. https://doi.org/10.1088/1361-6501/acb075
Pan ZH, Zhang CX, Xia YQ, Xiong H, Shao XD (2022) An improved artificial potential field method for path planning and formation control of the multi-UAV systems. IEEE Trans Circuits Syst II Express Briefs 69(3):1129–1133
Zhu LF, Yao S, Li BY, Song AG, Jia YY, Jun M (2021) A geometric folding pattern for robot coverage path planning. In: 2021 IEEE international conference on robotics and automation, May 30–June 5
Mouad B, Lamine M, Abderazzak L (2021) FDA*: a focused single-query grid based path planning algorithm. J Autom Mob Robot Intell Syst 15(3):37–43
LaValle SM (1998) Rapidly-exploring random trees: a new tool for path planning
Justice D, Larkin F, Hyoshin P, Masashi M, Masahiro O, Su H (2022) A sampling-based path planning algorithm for improving observations in tropical cyclone. Earth Space Sci 9:2020EA001498. https://doi.org/10.1029/2020EA001498
He ZC, Dong L, Sun CY, Wang JW (2022) Asynchronous multithreading reinforcement-learning-based path planning and tracking for unmanned underwater vehicle. IEEE Trans Syst Man Cybern Syst 52(5):2757–2769
Shahnlia R, Mian MR, Chang SY, Peng LM (2022) A reinforcement learning-based path planning for collaborative UAVs. In: Proceedings of the 37th ACM/SIGAPP symposium on applied computing, pp 1938–1943. https://doi.org/10.1145/3477314.3507052
Karaman S, Frazzoli E (2011) Sampling-based algorithms for optimal motion planning. Int J Robot Res 30:846–894
Islam F, Nasir J, Malik U, Ayaz Y, Hasan O (2012) RRT*-smart: rapid convergence implementation of RRT* towards optimal solution. In: 2012 IEEE international conference on mechatronics and automation, IEEE, pp 1651–1656
Gammell JD, Srinivasa SS, Barfoot TD (2014) 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
Qureshi AH, Ayaz Y (2016) Potential functions based sampling heuristic for optimal path planning. Auton Robot 40:1079–1093
Li Y, Wei W, Gao Y, Wang D, Fan Z (2020) PQ-RRT*: an improved path planning algorithm for mobile robots. Expert Syst Appl 152:113425
Jeong I-B, Lee S-J, Kim J-H (2019) Quick-RRT*: triangular inequality-based implementation of RRT* with improved initial solution and convergence rate. Expert Syst Appl 123:82–90
Mishra UA, Métillon M, Caro S (2021) Kinematic stability based AFG-RRT* path planning for cable-driven parallel robots. In: The 2021 IEEE international conference on robotics and automation (ICRA 2021), May 2021, Xi’an, China. ffhal-03182298
Ge QY, Li AJ, Li SH, Du HP, Huang X, Niu CH (2021) Improved bidirectional RRT∗ path planning method for smart vehicle. Math Probl Eng 2021:1–14. https://doi.org/10.1155/2021/6669728
Wang J, Chi W, Li C, Wang C, Meng MQ-H (2020) Neural RRT*: learning-based optimal path planning. IEEE Trans Autom Sci Eng 17:1748–1758
Ganesan S, Natarajan S, Thondiyath A (2021) G-RRT*: goal-oriented sampling-based RRT* path planning Algorithm for mobile robot navigation with improved convergence rate. In: 5th international conference of the robotics society, 23, pp 1–6
Li JY, Wang KZ, Chen ZH, Wang JK (2022) An improved RRT* path planning algorithm in dynamic environment. Communications in computer and information science, vol 1713. Springer, Singapore. https://doi.org/10.1007/978-981-19-9195-0_25
Li Q, Wang J, Li H, Wang B, Feng C (2022) Fast-RRT*: an improved motion planner for mobile robot in two-dimensional space. IEEJ Trans Electr Electron Eng 17:200–208
Karaman S, Walter MR, Perez A, Frazzoli E, Teller S (2011) Anytime motion planning using the RRT*. In: 2011 IEEE international conference on robotics and automation, IEEE, pp 1478–1483
Qi J, Yang H, Sun HX (2021) MOD-RRT*: a sampling-based algorithm for robot path planning in dynamic environment. IEEE Trans Ind Electron 68(8):7244–7251
Kang J, Lim D, Choi Y, Jang W, Jung J (2021) Improved RRT-connect algorithm based on triangular inequality for robot path planning. Sensors 21(333):1–32
Kuffner JJ Jr., LaValle SM (2000) RRT-connect: an efficient approach to single-query path planning. In: Proceedings of the 2000 IEEE international conference on robotics & automation, pp 995–1001
Liao B, Wan F, Hua Y, Ma R, Zhu S, Qing X (2021) F-RRT*: an improved path planning algorithm with improved initial solution and convergence rate. Expert Syst Appl 184:115457
Wang XY, Yang YP, Wang D, Zhang ZJ (2021) Mission-oriented cooperative 3D path planning for modular solar-powered aircraft with energy optimization. Chin J Aeronaut 35:98–109. https://doi.org/10.1016/j.cja.2021.04.015
Aiello G, Valavanis KP, Rizzo A (2022) Fixed-wing UAV energy efficient 3D path planning in cluttered Environments. J Intell Robot Syst 105:60. https://doi.org/10.1007/s10846-022-01608-1
Ji W, An J, Cho MG, Kim C (2021) Integration of path planning, trajectory generation and trajectory tracking control for aircraft mission autonomy. Aerosp Scie Technol 118:107014. https://doi.org/10.1016/j.ast.2021.107014
Luo Y, Lu JK, Zhang Y, Zheng K, Qin Q, He L, Liu Y (2022) Near-ground delivery drones path planning design based on BOA-TSAR algorithm. Drones 6(12):393. https://doi.org/10.3390/drones6120393
Acknowledgements
This work was supported by the National Natural Science Foundation of China [grant number 62103439], China Postdoctoral Science Foundation [grant number 2020M683716] and the Natural Science Basic Research Program of Shaanxi Province [grant number 2021JQ-364].
Author information
Authors and Affiliations
Corresponding author
Ethics declarations
Conflict of interest
The authors declare no conflict of interest.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Open Access This article is licensed under a Creative Commons Attribution 4.0 International License, which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons licence, and indicate if changes were made. The images or other third party material in this article are included in the article's Creative Commons licence, unless indicated otherwise in a credit line to the material. If material is not included in the article's Creative Commons licence and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder. To view a copy of this licence, visit http://creativecommons.org/licenses/by/4.0/.
About this article
Cite this article
Cong, J., Hu, J., Wang, Y. et al. FF-RRT*: a sampling-improved path planning algorithm for mobile robots against concave cavity obstacle. Complex Intell. Syst. 9, 7249–7267 (2023). https://doi.org/10.1007/s40747-023-01111-6
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s40747-023-01111-6