Driving on Point Clouds: Motion Planning, Trajectory Optimization, and Terrain Assessment in Generic Nonplanar Environments
path planning for autonomous vehicles in unknown semi - structured environments .