Integrated Threat Assessment for Trajectory Planning of Intelligent Vehicles

This paper reports an effort to improve plan of vehicle trajectory using an approach with rapidly-exploring random trees (RRT), which has been widely adopted in the prior art for complex and dynamic traffic environment. Design and implement of an integrated threat assessment is presented that evaluates threats of the trajectory. A node and trajectory evaluation index was introduced into the proposed RRT algorithm to connect an appropriate node and select the best trajectory. The contribution of this paper is on the threat assessment that takes into account not only obstacle avoidance but also stability. The simulation is conducted and the results show that the proposed method works as expected and is valid and effective.