Local Path Planning of the Autonomous Vehicle Based on Adaptive Improved RRT Algorithm in Certain Lane Environments

: Given that the rapidly exploring random tree algorithm (RRT) and its variants cannot efﬁciently solve problems of path planning of autonomous vehicles, this paper proposes a new, adaptive improved RRT algorithm. Firstly, an adaptive directional sampling strategy is introduced to avoid excessive search by reducing the randomness of sampling points. Secondly, a reasonable node selection strategy is used to improve the smoothness of the path by utilizing a comprehensive criterion that combines angle and distance. Thirdly, an adaptive node expansion strategy is utilized to avoid invalid expansion and make the generated path more reasonable. Finally, the expanded ellipse is used to realize vehicle obstacle avoidance in advance, and the post-processing strategy removes redundant line segments of the initial path to improve its quality. The simulation results show that the quality of the planned path is signiﬁcantly improved. This path followed successfully has good trajectory stability, which shows the proposed algorithm’s effectiveness and practicability in autonomous vehicles’ local path planning.


Introduction
As a kind of wheeled mobile robot, an autonomous vehicle plays an essential role in reducing traffic accidents, easing traffic jams, improving traffic efficiency, etc. [1]. The autonomous vehicle is typically capable of recognition, decision making, and tracking control [2][3][4][5]. As a critical component of autonomous driving, path planning has become a popular research topic. Path planning is defined as finding a collision-free path from the initial state to the target state in a configuration space where obstacles can be seen [6,7].
Up to now, many algorithms regarding path planning have been presented. The artificial potential field method is a virtual force method whose basic idea is to design the movement of autonomous vehicles under the combined force of an attractive force generated by the target point and a repulsion force generated by the obstacle [8]. This method is simple to compute, and the planned path is safe and feasible, but it is easy to fall into the local minimum trap, that is, the local minimum point [9][10][11]. The algorithm combining the artificial potential field method and the elastic band model can gain an ideal path when applied to vehicle path planning [12]. Nevertheless, its computation model is complex, resulting in low search efficiency. Dijkstra algorithm and A* algorithm can obtain the shortest path in rasterized environments, but the generated path consists of broken lines, which leads to poor smoothness [13][14][15]. The rapidly exploring random tree algorithm (RRT), a typical sampling-based method, is a single-query motion path planning algorithm. Its advantages include probability completeness, low computational cost, a natural extension for non-holonomic constraints, and simple environment modeling [16][17][18].

1.
This method uses the sampling node method based on heuristic information to make the random tree grow more directionally and utilizes the adaptive sampling space and the adaptive step size to speed up its convergence.

2.
The road environment constraints and the vehicle's constraint method gained by a magnifying mechanism considering the motion characteristics of the vehicle are considered to make the vehicle achieve an excellent behavior of avoiding obstacles. 3.
A heuristic node selection mechanism is introduced to select the nearest tree node so that the vehicle moves smoothly at less cost. 4.
The post-processing, including the pruning method and the cubic B-spline, is used to optimize the generated path to make the path satisfy the requirement of autonomous vehicle driving.
The article is organized as follows: Section 2 discusses the road environment and the non-integrality constraint of the vehicle to construct constraints of path planning. The adaptive improved algorithm is presented in Section 3. Experiments and results for demonstrating the relevant performance of various algorithms and the superiorities of the proposed algorithm are offered in Section 4, and the conclusions are provided thereafter.

Preliminaries
In this section, we introduce the road environment method of path planning and design the constraints of the road environment. Furthermore, the vehicle model with non-integrality constraint is presented to prove that the steering constraint of the vehicle should be taken into account in the growth of the random tree.

Road Environment Geometries
The road environments consisting of a straight road environment and a curved road environment are established after obtaining the surrounding road information. The straight road environment can be established directly according to the road length and width. As to the curved road environment shown in Figure 1, S is the starting point of planning, F is the location point of the obstacle, G is the target point of planning, W is the width of the road, and the origin O of the road reference coordinate frame is defined as a point on the road center line. A cubic equation of one variable can construct the center-line of the road to meet the curvature requirements [12], which is given by where y r represents the value of the y axis and x represents the horizontal distance from the origin O. A, B, C and D are parameters of the equation. The position vector P xy of the road center line, as described in Figure 2, is given by P xy = xe x + ye y (2) ctuators 2022, 11, x FOR PEER REVIEW

Preliminaries
In this section, we introduce the road environment method of path pla sign the constraints of the road environment. Furthermore, the vehicle mo integrality constraint is presented to prove that the steering constraint should be taken into account in the growth of the random tree.

Road Environment Geometries
The road environments consisting of a straight road environment and environment are established after obtaining the surrounding road info straight road environment can be established directly according to the ro width. As to the curved road environment shown in Figure 1, S is the sta planning, F is the location point of the obstacle, G is the target point of plan width of the road, and the origin O of the road reference coordinate frame point on the road center line. A cubic equation of one variable can constru line of the road to meet the curvature requirements [12], which is given by

Road Environment Geometries
The road environments consisting of a straight road environme environment are established after obtaining the surrounding ro straight road environment can be established directly according to width. As to the curved road environment shown in Figure 1, S is planning, F is the location point of the obstacle, G is the target point width of the road, and the origin O of the road reference coordinate point on the road center line. A cubic equation of one variable can line of the road to meet the curvature requirements [12], which is gi   Under the boundary conditions y(0) = 0 and y (0) = 0, the unit tangent vector and unit normal vector of a point on the center line of the road can be represented by Equations (3) and (4), respectively. Thus, the points on the left and right boundaries of the road can be represented by Equation (5), and any point on the road can be represented by Equation (6).
where W is the width of the road and n is the scalar value along the unit normal vector e n . Considering that the included angle between the tangent of the road curve and the x axis of the road reference coordinate frame is minimal, we can assume n = y − y r . Thus, the position vector of a point on the road can be approximately expressed as:

Constraints of Road Environment
To be followed effectively by an autonomous vehicle, a path must meet constraints of the road environment when planning; in other words, the growth of the random tree must meet constraints of the road environment. Equation (8) expresses the conditions to be satisfied by the random tree nodes.
where P start is the starting point, P goal is the goal point, B le f t and B right are the left and the right borders of the road, respectively, and b is the width of the vehicle.

The Vehicle Model with Non-Integrality Constraint
To deal with the path tracking problem, the non-integrality constraint of the vehicle must be considered. A simplified vehicle model is shown in Figure 3 [33]. Owing to pure rolling of the wheel in the plane, the speed direction of the vehicle body must point to its main axis at any moment of motion, that is, to meet Equations (9) and (10).
where (x, y) is the position of the vehicle mass center in the reference coordinate frame, θ is the included angle between the vehicle longitudinal axis and the x axis of the reference coordinate frame, β is the steering angle of the vehicle front wheel and |β| ≤ β max .
Through the above analysis, the steering radius of the vehicle needs to be considered in the extension of the tree nodes. Through the above analysis, the steering radius o in the extension of the tree nodes.

Basic RRT
The RRT algorithm gradually builds a path from root node of the random tree to the target point by sea then iteratively adding new randomly selected nodes the target point.
Algorithm 1 shows the basic RRT algorithm. T

Basic RRT
The RRT algorithm gradually builds a path from the starting point regarded as the root node of the random tree to the target point by searching the feasible region space and then iteratively adding new randomly selected nodes as leaf nodes toward the region of the target point.
Algorithm 1 shows the basic RRT algorithm. The random sampling point P rand is generated by the RANDOM_STATE function. Among the existing tree nodes, the one nearest to P rand is selected as the extension node P near by the NEAREST_NEIGHBOR function, and a line is drawn to connect P rand and P near . P new is generated in the direction of this line by the EXTEND function. Then, if there is no collision between the obstacle and the line between P near and P new , the latter is added to the random tree as a new leaf node. The above processes is repeated, and the search is ended when the distance between P new and P goal is less than the threshold D limit . Finally, the planned path is generated by the GET_PATH function, as shown in Algorithm 2. 1. T_init (P init ) 2. While DISTANCE (P new , P goal ) do 3. P rand ←RANDOM_STATE ( ) 4. P near ←NEAREST_NEIGHBOR (T, P rand ) 5. P new ←EXTEND (T, P rand , P near ) 6. if DISTANCE (P new , P goal ) ≤ D limit then 7. Return T 8. endif 9. endWhile 10. path←GET_PATH (T) Algorithm 2: Function GET_PATH (T) 1. Var path_set; 2. path_set.Add_Node (T.node n ); 3. while 4. i←Pre_Node_Index n ; 5.
path_set.Back_Add_Node (T.node i ); 6. if i = 1 7. break; 8. endif 9. i←i + 1; 10. endwhile 11. path←path_set The result of the basic RRT algorithm applied to the vehicle path planning is shown in Figure 4. The green lines represent all branches of the random search tree, and the red line represents the planned path from the starting point (0, −1.875) to the target point (120, −1.875). From this graph, we can find that the random search tree attempts to explore the entire road space due to uniformly random sampling and a fixed extension step, which results in too many redundant searches and means that this planned path cannot be tracked by the vehicle because of significant changes in curvature. What is more, it is easy to cause instability or collision with obstacles in the driving process when the vehicle starts avoiding the obstacle close to it. The result of the basic RRT algorithm applied to the vehicle path planning is sh in Figure 4. The green lines represent all branches of the random search tree, and the line represents the planned path from the starting point (0, −1.875) to the target point ( −1.875). From this graph, we can find that the random search tree attempts to explore entire road space due to uniformly random sampling and a fixed extension step, w results in too many redundant searches and means that this planned path canno tracked by the vehicle because of significant changes in curvature. What is more, it is to cause instability or collision with obstacles in the driving process when the veh starts avoiding the obstacle close to it.

Adaptive Improved RRT Algorithm
Based on the above analysis of vehicle path planning problems caused by using basic RRT algorithm, this paper proposes a different RRT variant applying to the l path planning of the autonomous vehicle. The adaptive improved RRT algorithm aim generate an initial path quickly and then improve the quality of the initial path in allowed time to meet the requirements of vehicle driving. Compared with the basic R plenty of novel heuristics are discussed in collision detection, state sampling, node s tion, node expansion, and path post-processing to optimize the algorithm's perform suitable for vehicle path planning. Algorithm 3 shows the algorithm process of the a tive improved RRT.

Adaptive Improved RRT Algorithm
Based on the above analysis of vehicle path planning problems caused by using the basic RRT algorithm, this paper proposes a different RRT variant applying to the local path planning of the autonomous vehicle. The adaptive improved RRT algorithm aims to generate an initial path quickly and then improve the quality of the initial path in the allowed time to meet the requirements of vehicle driving. Compared with the basic RRT, plenty of novel heuristics are discussed in collision detection, state sampling, node selection, node expansion, and path post-processing to optimize the algorithm's performance suitable for vehicle path planning. Algorithm 3 shows the algorithm process of the adaptive improved RRT.
Path planning is described in the adaptive improved RRT algorithm to find a feasible passage from the starting point to the goal point. The random tree is initialized from the starting point. A novel EFFECTIVE_RANDOM _STATE function aims to make the sampling states more directional. The EFFECTIVE_NEAREST _NEIGHBOR function considering the vehicle's non-integrality constraint is used to guide the random tree growth. Furthermore, the EFFECTIVE_EXTEND function is employed to help the random tree grow more flexibly. In each iteration, the COLLISION_DISTANCE function is used to evaluate whether the new point has reached the goal point. When the new point reaches the goal point, the GET_PATH function will find a broken line connecting the starting point and the goal point. Afterward, the PRUNING function removes redundant connecting lines based on the included angle constraint to obtain a feasible path after smoothing by the SMOOTHING function. The specific details of all heuristics are described below.

Collision Detection
In order to avoid the collision between the host vehicle and the obstacle vehicle, we use the secure ellipse method, which is scaled up appropriately to envelope the obstacle vehicle. What is more, we add the distance of advanced obstacle avoidance adjusting according to the host vehicle's speed to the semi-major axis of the ellipse to make the impact of the obstacle vehicle on the host vehicle occur at a longer distance, as shown in Figure 5. If the tree node expanded by the random tree does not intersect with the expanded safety ellipse, that is, the connecting line between the new node and its parent node does not intersect with the obstacle vehicle, the newly extended node meets the requirements of the obstacle avoidance. Equation (11) shows that the new node does not collide with the expanded safety ellipse.
where (x, y) is the point on the line between the new node and its parent node, (x ob , y ob ) is the position of the obstacle vehicle, a is the half-length of the obstacle vehicle, s is the expansion coefficient of the safety ellipse, v is the speed of the host vehicle, µ is the friction coefficient, and g is the acceleration of gravity. The secure ellipse is not only an easy and effective collision detection method but also ensures that the host vehicle can stay away from the obstacle vehicle in the corresponding driving direction at a safe distance.

Adaptive Directed Sampling Strategy
The basic RRT uses uniform random sampling to explore the entire sampling space, which will cause lots of unnecessary searches and a low convergence rate. To solve this problem, a novel heuristic mechanism, including the adaptive sampling space and the dynamic sampling method, is introduced to process the selection of the sampling space and random sampling states to improve search efficiency. It can make the random tree grow toward the target point and make the distance of the generated path from the reference trajectory small as possible.

Adaptive Sampling Space
The status of the local path planning of the autonomous vehicle during the driving process determines that its driving state is forward. Consequently, we introduce a method of the adaptive sampling space to obtain P nearest that is the node closest to the target on the random tree and then form an adaptive sampling space between the nearest tree node P nearest and the target point P goal , which can avoid unnecessary searches in the area where the random tree has grown to improve the search efficiency. Equation (12) is the expression for this method.
where zonewidth is the width of the sampling space, Samplezone x is the length of the adaptive sampling space, Samplezone y is the length of the adaptive sampling space, and P goal x and P nearest x are the x coordinates of the target point and the nearest tree node in the reference coordinate frame.

Dynamic Sampling
We adopt an improved method combining the biased target with double sampling states to avoid the minimum problem caused by the biased target and generate a random sampling state tending to the target. Equation (13) shows the calculation of the random sampling state P rand .
where ρ goal is the biased probability, the DoubleRand( ) function is to generate the sampling state under the condition of using the method of double sampling states. In this function, the generation of the final sampling state is no longer determined by the closest distance to the target point but by the measurement function C r of the sampling state. Thus, P rand is the sampling state corresponding to the minimum value of C r . Equation (14) is the expression for the measurement function C r .
where D g is the Euclidean distance from the sampling state to the target point and D r is the distance from the sampling state to the reference trajectory S 0 , which is cut off from the global path or keeps horizontal with the lane line. D r can make the sampling state closer to the reference trajectory to shorten the length of the final path. ω 1 and ω 2 are adaptive and ω 1 + ω 2 = 1. Equation (15) shows the computation of ω 1 and ω 2 .
where ϑ is the fixed weighted value of the distance D g , D m is the distance between the tree node P near and the obstacle point P obstacle , D s is the horizontal projection distance of the semi-major axis of the security ellipse on the x axis in the cartesian coordinate frame. ω 1 and ω 2 change adaptively with the change of D m . ω 1 and ω 2 are given fixed values when D m ≥ D s , which can ensure that the selected random sampling state P rand tends to close to the target point and the reference trajectory line. The closer the distance is to the obstacle, the smaller ω 2 becomes and ω 1 is the opposite when D m < D s , which makes the ratio of D r to C r decreased, that is to say, the choice of P rand is given priority according to the distance D g . Here, ϑ is limited less than one so that this improved method takes effect. The adaptive weighted coefficients can make the random tree quickly escape from the surroundings of obstacles in the growth process and speed up the convergence of this algorithm. The adaptive directed sampling strategy keeps the random property of the RRT algorithm and can explore the space faster and more effectively. Algorithm 4 shows the adaptive directed random sampling strategy used in the adaptive improved RRT.

Reasonable Node Selection Strategy
After obtaining the random sampling state P rand , the next step is to select a tree node to expand. According to the non-integrality constraint of the vehicle, the size of the included angle between the lines composed of tree nodes should be considered when selecting the nearest neighbor node to decrease the influence of newly added nodes on twists and turns of the entire path. Thus, a more reasonable node selection strategy is proposed to change the selection mode of the nearest tree node P near to meet the steering requirement of the autonomous vehicle. This strategy can result in little change in the curvature of the planned path to ensure the driving stability of the autonomous vehicle. As shown in Figure 6, the included angle α is calculated between the line between the child node T i and the parent node T j and the line between the child node T i and the random sampling state P rand on the random tree. If it is less than the steering angle β, which is less than or equal to β max of the front wheel of the vehicle, the child node T i on the random tree is added to the set T s of tree nodes satisfying the included angle requirement. Equation (16) shows the conditions for adding nodes to the set T s .  After obtaining the set T s , a more useful measurement function is introduced to select the tree node in the set T s . The value C p of the measurement function is the weighted sum of the distance cost D p and the angle cost A p . P near is determined as the adjacent tree node corresponding to the minimum value of C p . Equations (17)-(21) show how to calculate the cost of selecting P near .
where n 1 and n 2 are weighted coefficients of the distance cost D p and the angle cost A p , respectively. D p and A p are the normalization values of the distance D p and the angle A p , respectively. D p is the weighted sum of the distance D t that is the distance from the tree node belonging to the set T s to the sampling state P rand and D o that is the distance from that tree node to the target point P goal . m 1 and m 2 are the weighted coefficients of D t and D o , respectively. The selection strategy of the nearest neighbor node P near prevents the random tree from purely expanding to the feasible region, which can cause the random tree to grow smoothly and toward the target point. As a result, there is a natural balance between the faster growth of the random tree and the better quality of the final generated path in the planned time.

Adaptive Node Extension Strategy
The RRT algorithm will extend the selected node P near to the sampling state P rand when the nearest tree node P near is determined. Due to the adoption of a fixed step size, the random tree either easily leads to collision with obstacles or is slow to converge, resulting in low flexibility and low security. To solve this problem, an adaptive step strategy is designed to use a smaller step when the distance between the nearest tree node P near and the obstacle gets smaller to slow down the growth of the random tree and make the path search more detailed and secure. On the contrary, the step size increases when the distance between the nearest tree node P near and the obstacle increases to improve the growth efficiency of the random tree. Meanwhile, the step size has a minimum threshold to ensure the most basic expansion. Equation (22) shows how to calculate the adaptive step size L.
where L max is the maximum fixed step, D l is the distance between the nearest tree node P near and the obstacle point P obstacle . The random tree reduces several invalid calculations based on the adaptive step size strategy when extending, which can accelerate the running speed of the algorithm, improve the efficiency of the search, and improve the stability of the algorithm.

Post-Processing Strategy
After the random tree has grown, the next step is to find and optimize the initial path. Because of the random sampling of the RRT algorithm, the initial path is very tortuous and extremely unsmooth, with many unnecessary turning points, resulting in the condition that the autonomous vehicle has severe mechanical wear when tracking. Therefore, an efficient post-processing strategy is required.
Algorithm 5 outlines the working of the post-processing strategy. It consists of path getting, path pruning, and path smoothing. Path pruning is used to process the initial path to remove unnecessary nodes based on the maximum curvature constraints. Then, the remaining nodes are smoothed by the cubic B-spline curve interpolation.

Path Pruning
Lines 3-25 in Algorithm 5 are the path pruning part of the post-processing strategy. A set Q 0 of nodes of the valid path from the forward point of the target point to the parent point of the starting point is obtained by reversely searching the random tree utilizing the function GET_PATH ( ).
Based on the set Q 0 , the first path point, the parent node of the starting point, is defined as the root point q root , and the second path point, namely the starting point, is defined as the current point q temp . Afterward, we connect that current point and the first subsequent path point with a line segment and then continue to connect that current point and one of all subsequent path points with a line segment successively in sequence until there is an intersection between the line segment and the obstacle space. In this case, the parent node of the collision point, that is, the path point resulting in the intersection is defined as the forward point q head , and the collision point is defined as the double-forward point q dou_head . Meanwhile, the included angle between the line between the forward point q head and the current point q temp and the line between the current point q temp and the root point q root , and the included angle between the line between the forward point q head and the current point q temp and the line between the forward point q head and the double-forward point q dou_head are calculated. When they all are less than the steering angle of the wheel β, the current point q temp is defined as the new root point q root , and the forward point q head is defined as the new current point q temp . On the contrary, we continue to make the parent node of the forward point q head be defined as the forward point q head and make the forward point q head be defined as the double-forward point q dou_head successively in sequence, and continually calculate the included angle between the line between the forward point q head and the current point q temp and the line between the current point q temp and the root point q root , and the included angle between the line between the forward point q head and the current point q temp and the line between the forward point q head and the double-forward point q dou_head until those angles are less than the steering angle of the wheel β. Thus, the current point q temp and the forward point q head are defined as both a new root point q root and a new current point q temp . Then, the preceding operations are performed on subsequent path points until the goal point is found. Such path pruning can minimize the number of line segments forming the initial path and reduce unnecessary costs in the distance of the path under the condition of meeting the requirement of the included angle between path points. Specifically, as shown in Figure 7, the black polyline is the initial path obtained by the reverse search. Because the connecting lines between the blue nodes P 1 , P 2 , P 3 , P 4 , P 5 , and P 6 do not intersect with the expanded safe ellipse, these nodes can be connected directly by line segments to delete the redundant nodes between them and have no sharp angles between those line segments, thus obtaining a relatively gentle path sequence. In addition, the included angles of the connecting lines between these nodes are less than β; that is, α 1 , α 2 , α 3 , and α 4 are less than β.
for each node q i ∈Q 2 9.
if Collision_Free q temp , q i )

Cubic B-Spline Smoothing Method
Because the curvature of the path processed by path pruning is not conti essential to optimize the path to make the vehicle drive steadily and safely. T can make local adjustments to the path without changing the entire shape o when smoothing and make the generated path have the advantages of continu ture, and so on, which makes it widely used in motion planning [34][35][36]. The cubic B-spline is used to interpolate and fit the path points obtained by the pa to achieve the purpose of path smoothing. Equation (23) shows how to calculat B-spline curve.
For making the curve tangent to the first and last sides of the path genera path pruning and passing through the first and last path points, the node ve cubic B-spline can be set to keep the nodes at both ends having four times repe The length of the generated path is shortened to the maximum extent, an necessary back and forth steering belonging to this path is removed after usin processing strategy. Meanwhile, this path can meet the vehicle steering constr

Simulation Experiments
In this section, we verify the performance of the adaptive improved RRT through simulation experiments for the convenience of expression. The simula iments are divided into two parts. In the first part, we verify the correctness a ority of this algorithm in certain lane environments by comparing it with basic

Cubic B-Spline Smoothing Method
Because the curvature of the path processed by path pruning is not continuous, it is essential to optimize the path to make the vehicle drive steadily and safely. The B-spline can make local adjustments to the path without changing the entire shape of the path when smoothing and make the generated path have the advantages of continuous curvature, and so on, which makes it widely used in motion planning [34][35][36]. Therefore, the cubic B-spline is used to interpolate and fit the path points obtained by the path pruning to achieve the purpose of path smoothing. Equation (23) shows how to calculate the cubic B-spline curve.
where N i,4 (u) is the basic function of the cubic B-spline curve, corresponding to the control point P i . It can be obtained using Cox-de Boor recursion. Equations (24) and (25) show how to calculate the basic function of the cubic B-spline curve.
For making the curve tangent to the first and last sides of the path generated by the path pruning and passing through the first and last path points, the node vector of the cubic B-spline can be set to keep the nodes at both ends having four times repetition.
The length of the generated path is shortened to the maximum extent, and some unnecessary back and forth steering belonging to this path is removed after using the post-processing strategy. Meanwhile, this path can meet the vehicle steering constraints.

Simulation Experiments
In this section, we verify the performance of the adaptive improved RRT algorithm through simulation experiments for the convenience of expression. The simulation experiments are divided into two parts. In the first part, we verify the correctness and superiority of this algorithm in certain lane environments by comparing it with basic RRT, bidirectional RRT, biased RRT, and RRT-connect. In the second part, the road environments are simulated in CarSim. Then, an appropriate vehicle model and driver model selected in the model database of CarSim are used to simulate the driving process of the actual vehicle to verify the effectiveness and practicability of this algorithm.

Performance Comparison of Several RRT Algorithms
To compare the performance of the adaptive improved RRT algorithm with other algorithms, we constructed two road scenarios, in which the host vehicle is represented in blue, the obstacle vehicle is represented in yellow, the lane borders are represented in solid black curves, and the road center line is represented in a dashed orange curve. Figure 8a shows the straight road environment, and Figure 8b shows the curved road environment. All parameters in the whole simulation process are shown in Tables 1 and 2. Actuators 2022, 11, x FOR PEER REVIEW To compare the performance of the adaptive improved RRT algori algorithms, we constructed two road scenarios, in which the host vehicle in blue, the obstacle vehicle is represented in yellow, the lane borders are solid black curves, and the road center line is represented in a dashed orang 8a shows the straight road environment, and Figure 8b shows the curved ment. All parameters in the whole simulation process are shown in Table   Left-    For describing the performance of the algorithm more objectively, the definition of benchmarking parameters to describe the simulation results of the algorithm quantitatively is as follows: Node: The number of nodes in the constructed graph. Length: The length of the generated path. Segment: the number of line segments that make up the generated path. The adaptive improved RRT algorithm specifically refers to the number of line segments of the path before the smoothing process.
Time: The amount of time spent on the planning process in seconds. Thirty simulations were performed on each algorithm to offset the random deviation of a single test. Tables 3 and 4, respectively, showed the average number of nodes, path length, segments, and running time of those algorithms in straight and curved road environments. Compared with the biased RRT, the bidirectional RRT, and the RRT-connect, the planning time and the path length of the basic RRT were the largest, and those of the other three algorithms were reduced to a certain extent, which was because the biased RRT increased the number of the goal point as the sampling point in the sampling process, the bidirectional RRT explored feasible space through the simultaneous growth of two trees, and the RRT-connect added the greedy method to the growth process of the two trees. The path length of the RRT-connect was more than that of the bidirectional RRT, which indicated that the greedy method might extend trees regardless of goodness in that direction, causing a negative optimization of the path length. As for the adaptive improved RRT algorithm, the number of tree nodes and path segments was relatively minimal compared with the basic RRT and the biased RRT, especially in path segments, but was relatively larger than the RRT-connect when considering the feasibility of the path. Compared with the bidirectional RRT, the number of tree nodes of the adaptive improved RRT algorithm was more significant, but the number of the path segments was relatively small. The main reason is that the adaptive improved RRT algorithm is based on the framework of the basic RRT and takes path pruning into account. The smaller number of path segments of the adaptive improved RRT algorithm can reduce the control points to facilitate smoothing and decrease the difficulty of autonomous driving. For the average planning time, the performance of the adaptive improved algorithm was superior to that of the basic RRT and was under that of the biased RRT, the bidirectional RRT, and RRT-connect, in the straight road environment. When applied to the curved road environment, the adaptive improved algorithm needed to take more time to plan the path than other algorithms did. However, compared with the other four algorithms, the path length generated by the adaptive improved RRT was minimal, mainly due to a series of novel heuristics, including adaptive directed sampling, reasonable node selection, and path pruning. In general, the adaptive improved RRT algorithm greatly improved the quality of the path, but it needed to appropriately sacrifice the planning time when applied to the curved road environment.   Figures 9 and 10 showed the paths planned by the algorithms in the straight road environment and the curved road environment, respectively. The blue dotted curve, the red dashed curve, the black dash-dotted curve, the purple dotted curve, and the solid green curve were the paths planned by the basic RRT, the bidirectional RRT, the biased RRT, the RRT-connect, and the adaptive improved RRT, respectively. From those, we could see that the paths generated by the basic RRT, the bidirectional RRT, the biased RRT, and RRT-connect were broken lines, including too many unnecessary and irregular steering corners, and their curvatures changed significantly and were discontinuous, which indicated that these paths did not satisfy the steering requirements of autonomous driving. The path generated by the adaptive improved RRT was desirable, the smoothest without the unnecessary detour, and the trend of its extension was natural, resulting in it being very easy to track this path for the autonomous vehicle. At the same time, we could see that the paths generated by the basic RRT, the bidirectional RRT, the biased RRT, and RRT-connect, respectively, were always starting to avoid a collision when close to the obstacle. On the contrary, the path generated by the adaptive improved RRT started to avoid a collision at a safe distance from the obstacle, which was vital for safe driving, and the safe distance could be automatically adjusted depending on the host vehicle's speed.
Actuators 2022, 11, x FOR PEER REVIEW 17 of 22 Figures 9 and 10 showed the paths planned by the algorithms in the straight road environment and the curved road environment, respectively. The blue dotted curve, the red dashed curve, the black dash-dotted curve, the purple dotted curve, and the solid green curve were the paths planned by the basic RRT, the bidirectional RRT, the biased RRT, the RRT-connect, and the adaptive improved RRT, respectively. From those, we could see that the paths generated by the basic RRT, the bidirectional RRT, the biased RRT, and RRT-connect were broken lines, including too many unnecessary and irregular steering corners, and their curvatures changed significantly and were discontinuous, which indicated that these paths did not satisfy the steering requirements of autonomous driving. The path generated by the adaptive improved RRT was desirable, the smoothest without the unnecessary detour, and the trend of its extension was natural, resulting in it being very easy to track this path for the autonomous vehicle. At the same time, we could see that the paths generated by the basic RRT, the bidirectional RRT, the biased RRT, and RRT-connect, respectively, were always starting to avoid a collision when close to the obstacle. On the contrary, the path generated by the adaptive improved RRT started to avoid a collision at a safe distance from the obstacle, which was vital for safe driving, and the safe distance could be automatically adjusted depending on the host vehicle's speed.

Path Following Validation
In order to evaluate the effectiveness and practicality of the adaptive improved RRT algorithm, it is necessary to follow the planned path by an autonomous vehicle. Once the path generation process was completed, the path-following experiment was simulated in CarSim. When the host vehicle follows the path, its yaw velocity and lateral acceleration Figures 9 and 10 showed the paths planned by the algorithms in the straight road environment and the curved road environment, respectively. The blue dotted curve, the red dashed curve, the black dash-dotted curve, the purple dotted curve, and the solid green curve were the paths planned by the basic RRT, the bidirectional RRT, the biased RRT, the RRT-connect, and the adaptive improved RRT, respectively. From those, we could see that the paths generated by the basic RRT, the bidirectional RRT, the biased RRT, and RRT-connect were broken lines, including too many unnecessary and irregular steering corners, and their curvatures changed significantly and were discontinuous, which indicated that these paths did not satisfy the steering requirements of autonomous driving. The path generated by the adaptive improved RRT was desirable, the smoothest without the unnecessary detour, and the trend of its extension was natural, resulting in it being very easy to track this path for the autonomous vehicle. At the same time, we could see that the paths generated by the basic RRT, the bidirectional RRT, the biased RRT, and RRT-connect, respectively, were always starting to avoid a collision when close to the obstacle. On the contrary, the path generated by the adaptive improved RRT started to avoid a collision at a safe distance from the obstacle, which was vital for safe driving, and the safe distance could be automatically adjusted depending on the host vehicle's speed.

Path Following Validation
In order to evaluate the effectiveness and practicality of the adaptive improved RRT algorithm, it is necessary to follow the planned path by an autonomous vehicle. Once the path generation process was completed, the path-following experiment was simulated in

Path Following Validation
In order to evaluate the effectiveness and practicality of the adaptive improved RRT algorithm, it is necessary to follow the planned path by an autonomous vehicle. Once the path generation process was completed, the path-following experiment was simulated in CarSim. When the host vehicle follows the path, its yaw velocity and lateral acceleration can be obtained as dynamic performance indicators for monitoring the stability of the path. The followed path is represented in the red dashed line, and the target path is represented in the solid black line.
We considered the straight road scenario described in Figure 8a; namely, the host vehicle moved at a constant speed of 60 km/h in the middle of the right lane, and the obstacle vehicle was in front of the host vehicle along this lane. The result that the host vehicle could successfully avoid the collision with the obstacle vehicle is shown in Figure 11a. The target path and the followed path are shown in Figure 11b. The following error between the followed path and the target path was within 0.1 m, as shown in Figure 11c, and it was small and quite satisfactory. The yaw velocity of the host vehicle was within 4 deg/s, and its lateral acceleration was within the range of 0.15 g, respectively shown in Figure 11d,e. Therefore, the host vehicle could remain stable in the simulation, and the trajectory could be considered acceptable.
Actuators 2022, 11, x FOR PEER REVIEW vehicle could successfully avoid the collision with the obstacle vehicle is shown i 11a. The target path and the followed path are shown in Figure 11b. The followi between the followed path and the target path was within 0.1 m, as shown in Fig  and it was small and quite satisfactory. The yaw velocity of the host vehicle was deg/s, and its lateral acceleration was within the range of 0.15 g, respectively s Figures 11d,e. Therefore, the host vehicle could remain stable in the simulation, trajectory could be considered acceptable.  This local path planning could also deal with the curved road scenario, as sh Figure 8b. We used the method described in the construction of the road environ build a curved road environment. The initial curvature of the road was equal to 0, final curvature of the road was equal to 0.0012 within a horizontal distance of 200 host vehicle moved in the right lane at a constant speed of 60 km/h, and the obst hicle was also in front of the host vehicle along this lane. The result of the plan shown in Figure 12a; the host vehicle could avoid collision with the obstacle ve front of it on the curved road successfully. The followed path and the target p shown in Figure 12b. The following error between the followed path and the targ was within the range of 0.1 m and was small, as shown in Figure 12c. The yaw vel the host vehicle was within 4 deg/s, and its lateral acceleration was within 0.15 g, tively, as shown in Figures 12d,e. Therefore, the given trajectory was also consid be feasible. This local path planning could also deal with the curved road scenario, as shown in Figure 8b. We used the method described in the construction of the road environment to build a curved road environment. The initial curvature of the road was equal to 0, and the final curvature of the road was equal to 0.0012 within a horizontal distance of 200 m. The host vehicle moved in the right lane at a constant speed of 60 km/h, and the obstacle vehicle was also in front of the host vehicle along this lane. The result of the planning is shown in Figure 12a; the host vehicle could avoid collision with the obstacle vehicle in front of it on the curved road successfully. The followed path and the target path are shown in Figure 12b. The following error between the followed path and the target path was within the range of 0.1 m and was small, as shown in Figure 12c. The yaw velocity of the host vehicle was within 4 deg/s, and its lateral acceleration was within 0.15 g, respectively, as shown in Figure 12d,e. Therefore, the given trajectory was also considered to be feasible. This local path planning could also deal with the curved road scenario, as sh Figure 8b. We used the method described in the construction of the road environ build a curved road environment. The initial curvature of the road was equal to 0, final curvature of the road was equal to 0.0012 within a horizontal distance of 200 host vehicle moved in the right lane at a constant speed of 60 km/h, and the obst hicle was also in front of the host vehicle along this lane. The result of the pla shown in Figure 12a; the host vehicle could avoid collision with the obstacle ve front of it on the curved road successfully. The followed path and the target p shown in Figure 12b. The following error between the followed path and the tar was within the range of 0.1 m and was small, as shown in Figure 12c. The yaw ve the host vehicle was within 4 deg/s, and its lateral acceleration was within 0.15 g tively, as shown in Figures 12d,e. Therefore, the given trajectory was also consid be feasible.

Conclusions
In this paper, with the aim of remedying the deficiencies of the basic RRT al in the quality of the planning path in certain lane environments, the adaptive im RRT algorithm is proposed to solve the local path planning problem of autonomo cles. This algorithm adopts the adaptive directed sampling strategy, making the

Conclusions
In this paper, with the aim of remedying the deficiencies of the basic RRT algorithm in the quality of the planning path in certain lane environments, the adaptive improved RRT algorithm is proposed to solve the local path planning problem of autonomous vehicles. This algorithm adopts the adaptive directed sampling strategy, making the random tree grow toward a direction near the reference trajectory line and the target point and avoiding unnecessary sampling in an already sampled space to improve sampling efficiency. It uses the reasonable node selection strategy to make the random tree grow more directionally, improving the length and the smoothness of the path to a certain extent. Meanwhile, the adaptive node expansion strategy is introduced to make the expansion of nodes change with the distance from the obstacle, improving the success rate of extension. The amplified constraint is used to ensure that the generated path can avoid the obstacle in advance at a safe distance. The post-processing strategy is employed to improve the quality of the path, making the generated path obtain the shortest length and meet the steering requirements. Simulation results show that the adaptive improved RRT algorithm is successful and feasible in local path planning and can plan a high-quality path in a certain lane environment. The proposed algorithm is instructive for the global path planning of autonomous vehicles in structured road environments and provides a test sample for the tracking control method developed in the subsequent research. Meanwhile, it can also apply to the local path planning of wheeled robots.
From the perspective of the future development of the autonomous vehicle, the algorithm proposed by this paper still has limitations needing to be overcome. The planning time is not very satisfactory, especially when planning a path in the curved road environment, and no actual on-site experiment was carried out to test the performance of the improved algorithm in practice. In our future proceedings, a parallel calculation will be integrated to speed up the running of the algorithm, further reducing the planning time. In addition, we will implement the actual on-site experiment to test the gap between the simulated and actual performance of the improved algorithm after the preparation of other modules, including environmental perception, tracking control, and vehicle platform.