The Path Planning Algorithm Research Based on Cost Field for Autonomous Vehicles

This path planning algorithm is used for the autonomous vehicle driving in the unstructured road. The gradient grid which is obtained from the point cloud data is used as the cost field. Considering the traffic-ability of autonomous vehicle, the cost field needs to be corrected by the High-resolution gradient and elevation grid in this paper. Then transforming the grid model into the network-node model. In this way, the cost field model can be used for the optimal path algorithm, such as the Dijkstra algorithm.