Computers, Materials & Continua DOI:10.32604/cmc.2022.022183 | |
Article |
Path Planning Based on the Improved RRT* Algorithm for the Mining Truck
1School of Instrument Science and Engineering, Southeast University, Nanjing, 210096, China
232184 PLA Troops, Beijing, 100071, China
3North Carolina State University, Raleigh, USA
*Corresponding Author: Dong Wang. Email: kingeast16@seu.edu.cn
Received: 30 July 2021; Accepted: 09 October 2021
Abstract: Planning a reasonable driving path for trucks in mining areas is a key point to improve mining efficiency. In this paper, a path planning method based on Rapidly-exploring Random Tree Star (RRT*) is proposed, and several optimizations are carried out in the algorithm. Firstly, the selection process of growth target points is optimized. Secondly, the process of selecting the parent node is optimized and a Dubins curve is used to constraint it. Then, the expansion process from tree node to random point is optimized by the gravitational repulsion field method and dynamic step method. In the obstacle detection process, Dubins curve constraint is used, and the bidirectional RRT* algorithm is adopted to speed up the iteration of the algorithm. After that, the obtained paths are smoothed by using the greedy algorithm and cubic B-spline interpolation. In addition, to verify the superiority and correctness of the algorithm, an unmanned mining vehicle kinematic model in the form of front-wheel steering is developed based on the Ackermann steering principle and simulated for CoppeliaSim. In the simulation, the Stanley algorithm is used for path tracking and Reeds-Shepp curve to adjust the final parking attitude of the truck. Finally, the experimental comparison shows that the improved bidirectional RRT* algorithm performs well in the simulation experiment, and outperforms the common RRT* algorithm in various aspects.
Keywords: RRT*; optimize; path smooth; coppeliaSim
Mineral resources, as the most important raw materials for industrial production, have become a top priority for research in various countries on how to mine them efficiently and intelligently. Some developed countries have conducted much research and development on “unmanned mines” [1–3]. The Canadian government's “Plan 2050” plans to transform the distant northern mines into smart mines. Finland, Sweden and other Nordic countries have also done some in-depth research in the field of mining equipment automation [4], and Australia was the first country that initiated the research on unmanned trucks [5]. As a medium for transporting materials, mining trucks are the top priority for realizing smart mines. Therefore, the unmanned mining area construction is the future trend, and the main technical difficulty lies in how to plan a suitable driving path for the mining truck in a complex environment, both to identify passable roads and to satisfy the movement characteristics of mining trucks, as well as the efficiency of the path.
In terms of this difficulty, many scholars have made numerous researches. First of all, to simulate the movement of the real vehicle, a kinematics model of the vehicle needs to be established. Some scholars have constructed the anti-skid model of the unmanned mining truck based on kinematics geometry and two different models considering the slip through the Kalman filter. Others proposed Ackermann steering model to solve the problem of vehicle kinematics steering in simulation, and modeling research based on Ackermann steering principle became mainstream. At the same time, vehicle path planning is one of the most classic optimization problems in the field of operational research optimization, and there are many algorithms. The common path planning methods include A*, D*, Dijkstra, Rapidly-exploring Random Tree (RRT), artificial potential field algorithm and so on [6–9]. Among them, the RRT algorithm [10] was proposed by Steven M Lavalle, which has the advantages of no need to model the space and having an absolute solution, but also has the defects of the unguided search process and low efficiency. To overcome these shortcomings, some scholars proposed the MI-RRT* algorithm [11] based on the RRT* algorithm [12]. This algorithm improves the RRT* algorithm through four modules: target bias model, dynamic compensation, limiting the number of RRT* nodes, and elliptical sampling. Based on these, some researchers established an environmental grid model based on GIS map of mine and solved the global path planning problem of intelligent truck with improved ant colony algorithm [13]. Some proposed an improved asymptotically optimal RRT algorithm based on goal-biased constrained sampling and goal-biased extending to improve the efficiency of path planning [14].
The research on kinematic modeling and path planning algorithms in the field of smart cars and unmanned vehicles has made great progress in recent years. However, the research on the connection between them is still lacking. The research on establishing and improving the kinematics model supported by the corresponding path planning algorithm mainly belongs to the field of robotics, and in field of vehicle simulation, most studies only uses simple differential rotation models or only simple geometry instead, and although the structure of such models is low in difficulty, the gap with the models of real vehicles is large. To this extent, the study lacks practical guidance.
In this paper, an improved bidirectional RRT* algorithm is proposed for the path planning of mining trucks. The optimization process and path smoothing process in the improved algorithm will be introduced in the second part. The third part is the experimental part. The superiority of the algorithm proposed in this paper is verified by comparing RRT* and the improved bidirectional RRT* on the same map and by comparing metrics such as running time, total number of iterations and successful expansion points. Finally, a truck model is built in CoppeliaSim to carry out the simulation experiment.
In order to find the truck's travel path in a complex mining environment, an improved bidirectional RRT* algorithm is proposed. The algorithm is optimized and improved on the RRT* proposed by Sertac and Emilio at MIT. It is mainly optimized in the following process: (1) the selection process of the growing target point is optimized by handing over the original random points and trying to grow toward the target point; (2) the process of selecting the parent node is optimized by including the distance from the tree node to the target point in the measurement, and the Dubins [15,16] curve is used for constraint, so that the obtained path is more realistic; (3) The expansion process from tree nodes to random points is optimized by the gravitational repulsion field method and dynamic step size method; (4) Dubins curves are used in the obstacle detection process to ensure that the obtained paths are larger than the minimum turning radius of the vehicle. In order to speed up the iteration speed, this paper finally chooses to use bidirectional RRT*. And the greedy algorithm and cubic B-spline interpolation are used to smooth the path to reduce the length of the path respectively.
2.1 Optimization in Random Sampling
The generation of random points in the original RRT* algorithm is completely random without intervention and lacks guidance, which will lead to a large amount of computation. The optimization idea adopted in this paper is that, given the probability threshold p, a random number q (0∼1 random distribution) is generated before each generation of random points. If q < p, then
2.2 Parent Node Selection Optimization
In the basic RRT* algorithm, the nearest tree node
Considering these two factors, the random tree [18] will approach to the end point in a “leading” way.
The concept of Dubins curve is introduced here. The Dubins curve takes into account the effect of turning radius on the motion of a vehicles or an aircraft and finds the shortest path curve between the initial and termination states of the object by geometric analysis [19]. In this paper, in addition to obstacle detection by Dubins curve, it is also applied to the process of obtaining the nearest tree node as discussed above. Because Ackermann vehicle has a minimum turning radius in actual motion, the Euclidean distance is not the shortest in the pratical sense, as shown in Fig. 1, the current vehicle state is a solid rectangle with three alternative targets shown as dashed lines, now the aim is to find the nearest target for the current vehicle, if only the Euclidean distance is considered, then there is no doubt that the first case is the closest with a Euclidean distance of 0 and the second case is the second. However, for the Ackerman car, in-situ steering and lateral translation are not possible due to the minimum turning radius, so in fact, the third case is the “closest” vehicle.
Therefore, Eq. (1) is modified like this:
In this paper, only the first term in Eq.(2) is changed to the Dobbins curve length, the reason is that during most of the algorithm running time, the distance between the target point and the random point is very large, and the difference between the Dobbins curve length and the Euclidean distance is very small, which is only obvious at the end, for this reason, the improved RRT* algorithm in this paper finally adopts a bidirectional RRT* algorithm, that is, to generate two trees from the starting point and the end point respectively random expansion trees. As a result, the apparent gap between the length of the Dobbins curve and the Euclidean distance near the end point is eliminated. In addition, the second term still retains the Euclidean distance from the target point to the random point, considering that replacing the Dobbins curve increases the computational effort.
2.3 Optimization of Tree Node to Random Point Expansion Process
The expansion from the nearest tree node to the random point is the core of the improved bidirectional RRT* algorithm, as shown in Fig. 2. In this paper, the gravitational repulsive force field method and dynamic step size method are used for optimization.
The artificial potential field method [20] introduces the idea of gravitational and repulsive forces similar to the electric potential field into the path planning algorithm. In the RRT* algorithm, the target point can be regarded as the gravitational field and the obstacle as the repulsive force field. In this way, the randomly expanding tree will move away from the obstacle while tending to expand towards the target, and the magnitude of this trend depends on the correlation coefficient, as shown in Fig. 3.
Assume that the expension step of the RRT* algorithm is
Referring to the common gravitational potential function model, where
Add a target gravitational function R(n):
Referring to the common repulsive potential field function model:
This paper proposed a target repulsion function T(n):
After adding the gravitational field and repulsive potential fields, the random growth function is
At the same time, the algorithm is optimized by dynamically extended step size
For step size
When the distance from the obstacle is far, the upper limit of step size is adopted. Compared with the traditional fixed step size, the dynamic step size can accelerate the growth of random tree in open areas. When near an obstacle, the fixed-step transmission often fails to pass the obstacle detection, falling to generate new tree nodes, which will also reduce the growth rate of the random tree. If the dynamic step size is adopted, this problem can be well solved due to its adaptability. Using dynamic step size can greatly improve the success rate of new node generation and effectively improve the overall algorithm efficiency.
2.4 Optimization of Obstacle Detection Process
The idea of RRT* algorithm or most RRT deformation algorithms in obstacle detection is basically to take a certain numerical sampling point
Since the research object is an Ackermann vehicle, and all points have directional parameters, the constraint of the minimum steering radius of the Ackermann vehicle will be ignored if only the line
2.5.1 Pruning Based on Greedy Algorithm
The main idea of the Greedy algorithm is to divide the solved problem into several subproblems and ask for the local optimal solution of each subproblem without considering the global one. Finally, the optimal solutions of each subproblem is superimposed to obtain the final solution.
The pruning process using greedy algorithm in this paper is as follows:
(1). Given that the set of Path points obtained by the RRT* algorithm
(2). Given
(a). If
(b). If
It is easy to find that the pruned path is still not optimal, which is determined by the nature of the greedy algorithm, as it can only produce a local optimal solution, if a smaller number of final path points and a smoother path are needed, it is necessary to increase the C (the traversal times under local problem), but the computation will be larger, so it is very important to balance these two points.
After pruning, the overall smoothing effect is obvious. However, the smoothing effect still needs further improvement for real vehicles due to the randomness of the direction parameters and the presence of the Dobbins curve constraint. Therefore, the cubic B-spline interpolation method is introduced as the second step of path smoothing.
2.5.2 Path Smoothing Based on Cubic B-Spline Interpolation
The advantage of B-spline interpolation is that it does not change the overall shape of the path significantly and only deals with the tortuous phenomena in a small range locally. Given that there are currently c + 1 points, the model of the cubic B-spline curve is as follows:
For
A key parameter S in the algorithm defaults to 0, which represents the smoothness of the curve after interpolation. The larger S is, the smoother the curve will be. The selection of S is the key factor in the success of path smoothing. Assuming
Referring to the idea of Greedy algorithm principle, a dynamic S-parameter algorithm is proposed and the specific procedure is as follows:
(1). Sampling on the smoothed curve
(2). If the obstacle detection passes, the final path is
3 Analysis and Discussions of Experiment Result
3.1 Performance of the Improved Bidirectional RRT* Algorithm
The evaluation indexes of improved bidirectional RRT* are as follows: running time, total iteration times, number of successful expansion points and path length. This paper used the map to test the improvement of the improved bidirectional RRT* algorithm over the original algorithm in different states. Firstly, the point (30, 90) was chosen as the starting point and (480, 480) was chosen as the end point. The results obtained by using the basic RRT* algorithm are shown in Fig. 4:
Then, the improved bidirectional RRT* algorithm was verified as shown in the following figure. In Fig. 5a, the specific parameters of the algorithm were as follows: dynamic step size is 40 ± 10, gravitational coefficient
First of all, it is obvious that the basic RRT* algorithm lacks target and traverses almost the entire map, and other trees can extend until the two trees intersect. Then, a brief comparison of the three cases of the improved bidirectional RRT* algorithm is made. In terms of commonality, they are superior to the ordinary RRT* algorithm in terms of both the number of iterations and time consumption. Fig. 5a belongs to the compromise case, where it can be seen that the extension tree has certain obstacle avoidance and target tendency, but neither is obvious. Fig. 5b belongs to the dominant gravitational field at the target point, which is the target point extending the tree branches under the dominant gravitational field. In general, the direction of the branch is considered irregular, but in Fig. 5b, most branches are oriented towards the target, in another word, the branches are attracted by the target point. The advantage of the gravitational field is that when it dominates, the expansion of the tree can be limited in a certain area, and a small search area will help improve the search efficiency. But when there are obstacles in the search range, as shown in this example, the overall efficiency of the algorithm becomes low, as the data analysis clearly illustrates. In some cases, the presence of a gravitational field can even cause a negative optimization. Finally, the situation in Fig. 5c shows the extremes situation of repulsive force field, it can be seen that when tree nodes are close to the obstacles, the expansion of the tree node will deviate from the obstacles due to the repulsive force of the obstacle. Although the repulsion parameters is large, the path searching process is very chaotic, it does not affect the overall algorithm, because only the path points for the next pruning are obtained, and it does not matter how these path points are obtained, the whole process only cares about the time and the number of iterations.
In this paper, the data of algorithm time consumption, number of iterations, and standard deviation of running time before and after algorithm optimization at the time of experiments are counted. Fig. 6 shows the comparison of the time consuming of different algorithms. It can be seen from the figure that the time consuming of the improved bidirectional RRT* algorithm is much lower than that of the basic RRT* algorithm, and the time consuming is further shortened after using the process optimization method proposed in this paper.
As shown in Fig. 7, the basic RRT* has the highest number of iterations, the bidirectional RRT* has the second highest number of iterations, and the improved bidirectional RRT* has the lowest number of iterations.
The parameters of the improved bidirectional RRT* algorithm selected here are the gravitational coefficient
Due to the efficiency of the optimized algorithm depends highly on the coefficient, such as gravity coefficient, repulsive force coefficient, how to find the right coefficient to improve the algorithm efficiency is a top priority. And then this paper will show the efficiency of the algorithm under several different coefficients to explore each factor's influence on the algorithm and summed up the relevant conclusions. The data in Tab. 1 for each group is based on 10 experiments.
From the situation of the seven test groups, when
The improvement of algorithms made by the repulsive force coefficient is mainly reflected in the expansion rate, namely, the detection probability through obstacles. As a result of the repulsive force coefficient, some points that cannot pass the obstacle detection can bypass obstacles and eventually achieve the expansion of the tree nodes. The expansion success rate in the data reflects this. And when the expanding success rate is high, the running time standard deviation of the corresponding algorithm is also reduced, and the stability is improved. On the contrary, when the gravity of the target point increases, the success rate of expansion does not improve, but tends to decrease. Therefore, through the comparison of these sets of experiments, this paper obtains the conclusion of optimizing the parameter settings of the RRT* algorithm.
First of all, the selection of the repulsion coefficient should not be too small, because the meaning of the existence of the repulsion force of the obstacle is to keep the point away from it. According to the above tests,
In the original model,
Secondly, the selection of the gravitational coefficient should be adjusted according to the actual map. Although the gravitational coefficient can cause a certain negative optimization when it is too large, the gravitational coefficient should not be completely discarded. From the two control experiments
In this paper, the effect of dynamic step size on the algorithm is also tested, the conclusion is that it has little effect on the algorithm speed and it can improve the success rate of expansion to a small extent and improve the overall algorithm stability.
In general, the principle of the optimizing RRT* algorithm for gravity and repulsion algorithm is as follows: the repulsion parameter
The 3D terrain and obstacle modeling of the mine site was carried out by Blender software. After importing CoppeliaSim, it was connected to Python and then imported into the algorithm for real-time control. In the simulation environment, as shown in Fig. 8, there are many obstacles, but there is at least one passable road between them. In this section, we conducted path planning simulation experiments by setting different starting points and target points. The top view of the map is shown as follows:
The kinematic model of unmanned mining vehicle based on Ackermann's principle uses the Stanley algorithm in optimal preview control to achieve path tracking after obtaining the vehicle path. However, the Stanley algorithm does not consider the Ackermann's geometric steering and always assumes the front wheel steering angle is the same. Therefore, the algorithm needs to be modified to make it compatible with the Ackermann geometric steering. Finally, the paths tracked under the Stanley algorithm can be seen in Fig. 9, with the axes representing the position of each waypoint on the map.
Then, in order to fully validate the robustness of the path planning algorithm for unmanned mining trucks, this section will be carried out multiple times by changing the end point. The specific validation results are as follows. The x and y axes in all of the following graphs represent the coordinate system in the map, and (x, y) represents the coordinates of each point on the map:
Firstly, the car was tested with the bottom right corner of the map as the starting point and the top right corner as the end point. The red line is the pruned path of the Dubins curve, and the blue line is the interpolated smooth path. The test results are shown in Fig. 10.
In the second case, the bottom right corner is taken as the starting point and the bottom left corner is taken as the end point. The test results are shown in Fig. 11.
In the third case, the starting point is the bottom right corner and the end point is the top left corner. The verification results are shown in Fig. 12.
Finally, the parking attitude of the truck is adjusted based on the Reeds-sheep algorithm. As shown in Fig. 13, the white vehicle is the target attitude, the yellow vehicle is the starting state, and the pink line segment is the track line of the vehicle. From the final vehicle position and attitude, the error is almost zero, which proves that the control method mentioned above and the error correction in straight line driving are effective.
In this paper, an improved bidirectional RRT* algorithm is proposed, which is applied to the path planning of mining trucks. Compared with the basic RRT* algorithm, the algorithm used in this paper mainly uses bidirectional RRT* and optimizes the path solving process of RRT*. These optimizations solve the problems of poor convergence, lack of stability and lack of guidance in the basic RRT algorithm. Finally, the path tracking based on Stanley algorithm is implemented by simulating a truck through simulation experiments in CoppeliaSim software, and the final results prove the correctness of the proposed method.
In the perspective of the future development of intelligent vehicles, even the improved bidirectional RRT* is based on model-driven, which will have limitations in practical application and cannot fully control the dynamic changes of vehicles. At present and for a long time to come, the direction of development should depend on algorithms such as RRT to react to dynamic situations in a timely manner through real-time data computation and local path planning.
Acknowledgement: This work was supported by the Suzhou Key industrial technology innovation project SYG202031.
Funding Statement: Suzhou Key industrial technology innovation project SYG202031.
Conflicts of Interest: The authors declare that they have no conflicts of interest to report regarding the present study.
1. Z. T. Li, B. M. Chang, S. G. Wang, A. F. Liu, F. Z. Zeng et al., “Dynamic compressive wide-band spectrum sensing based on channel energy reconstruction in cognitive internet of things,” IEEE Transactions on Industrial Informatics, vol. 14, no. 6, pp. 2598–2607, 2018. [Google Scholar]
2. Q. Y. Deng, Z. T. Li, J. B. Chen, F. Z. Zeng, H. M. Wang et al., “Dynamic spectrum sharing for hybrid access in OFDMA-based cognitive femtocell networks,” IEEE Transactions on Vehicular Technology, vol. 67, no. 11, pp. 10830–10840, 2018. [Google Scholar]
3. Z. T. Li, J. W. Kang, R. Yu, D. D. Ye, Q. Y. Deng et al., “Consortium blockchain for secure energy trading in industrial internet of things,” IEEE Transactions on Industrial Informatics, vol. 14, no. 8, pp. 3690–3700, 2018. [Google Scholar]
4. S. Q. Long, W. F. Long, Z. T. Li, K. L. Li, Y. Q. Xia et al., “A game-based approach for cost-aware task assignment with QoS constraint in collaborative edge and cloud environments,” IEEE Transactions on Parallel and Distributed Systems, vol. 32, no. 7, pp. 1629–1640, 2021. [Google Scholar]
5. A. H. Qureshi and Y. Ayaz, “Intelligent bidirectional rapidly-exploring random trees for optimal motion planning in complex cluttered environments,” Robotics and Autonomous Systems, vol. 68, pp. 1–11, 2015. [Google Scholar]
6. A. Cheng, D. M. Saxena and M. Likhachev, “Bidirectional heuristic search for motion planning with an extend operator,” in IEEE Int. Conf. on Intelligent Robots and Systems, Macau, China, pp. 7425–7430, 2019. [Google Scholar]
7. A. A. Ahmed and B. Akay, “A survey and systematic categorization of parallel k-means and fuzzy-c-means algorithms,” Computer Systems Science and Engineering, vol. 34, no. 5, pp. 259–281, 2019. [Google Scholar]
8. A. Alhussain, H. Kurdi and L. Altoaimy, “A neural network-based trust management system for edge devices in peer-to-peer networks,” Computers, Materials & Continua, vol. 59, no. 3, pp. 805–815, 2019. [Google Scholar]
9. A. Chhabra, G. Singh and K. S. Kahlon, “Qos-aware energy-efficient task scheduling on hpc cloud infrastructures using swarm-intelligence meta-heuristics,” Computers, Materials & Continua, vol. 64, no. 2, pp. 813–834, 2020. [Google Scholar]
10. A. Gumaei, M. Al-Rakhami and H. AlSalman, “Dl-har: Deep learning-based human activity recognition framework for edge computing,” Computers, Materials & Continua, vol. 65, no. 2, pp. 1033–1057, 2020. [Google Scholar]
11. J. Alexander, L. A. Shepp, J. A. Reeds and L. A. Shepp, “Optimal paths for a car that goes both forwards and backwards optimal paths for a car that goes both forwards and backwards,” Pacific Journal of Mathematics, vol. 145, no. 2, pp. 367–393, 1990. [Google Scholar]
12. P. An, “Path optimization method of autonomous intelligent obstacle avoidance for multi-joint submarine robot,” Journal of Coastal Research, vol. 82, pp. 288–293, 2018. [Google Scholar]
13. G. R. Li and S. Zhi, “The research on the path optimization of container truck based on ant colony algorithm and MAS,” in 2010 Int. Conf. on Web Information Systems and Mining, Sanya, China, pp. 370–375, 2010. [Google Scholar]
14. W. M. Zhang and S. X. Fu, “Mobile robot path planning based on improved RRT* algorithm,” Journal of Huazhong University of Science and Technology, vol. 49, no. 1, pp. 31–36, 2021. [Google Scholar]
15. F. Monroy-Pérez, “Non-Euclidean dubins’ problem,” Journal of Dynamical and Control Systems, vol. 4, no. 2, pp. 249–272, 1998. [Google Scholar]
16. M. Shanmugavel, A. T. Ã, B. White and Z. Rafa, “Co-operative path planning of multiple UAVs using dubins paths with clothoid arcs,” Control Engineering Practice, vol. 18, pp. 1084–1092, 2010. [Google Scholar]
17. M. Shanmugavel, S. K. V. Ragavan, H. J. Quek, R. U. Gobithaasan and A. R. M. Piah, “An experimental investigation into curvature uncertainties in executing piecewise continuous dubins curves in path planning,” in 2015 Third Int. Conf. on Artificial Intelligence, Modelling and Simulation, Kota Kinabalu, Malaysia, pp. 224–228, 2015. [Google Scholar]
18. S. Wang, J. H. Wang and Z. J. Jiang, “Auxiliary unmanned driving route planning algorithm based on mining road,” in 2017 IEEE Int. Conf. on Unmanned Systems, Beijing, China, pp. 494–499, 2017. [Google Scholar]
19. T. Hirakawa, T. Yamashita and H. Fujiyoshi, “Scene context-aware rapidly-exploring random trees for global path planning,” in 2019 IEEE Int. Conf. on Pervasive Computing and Communications Workshops, Kyoto, Japan, pp. 608–613, 2019. [Google Scholar]
20. N. García, R. Suárez and J. Rosell, “HG-Rrt∗: human-guided optimal random trees for motion planning,” in 2015 IEEE Int. Conf. on Emerging Technologies and Factory Automation, Luxembourg, Luxembourg, pp. 1–7, 2015. [Google Scholar]
This work is licensed under a Creative Commons Attribution 4.0 International License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited. |