A Goal-Biased RRT Path Planning Approach for Autonomous Ground Vehicle

For the application of autonomous ground vehicle (AGV) operating in unstructured environment, a path planning method based on an improved goal-biased Rapidly-exploring Random Trees (bias-RRT) is proposed. The algorithm combines random sampling with numerical optimization to achieve fast convergence speed and satisfy constraints. KD-Tree and potential field of the environment are implemented to increase the sampling efficiency, and cubic B-splines are used to smooth the path for better tracking performance. The algorithm improves the efficiency of searching while guarantee safety and quality of the planned path. Simulation results verify the effectiveness of the proposed method.