Philipp Krüsi, Paul Furgale, Michael Bosse, Roland Siegwart. Driving on Point Clouds: Motion Planning, Trajectory Optimization, and Terrain Assessment in Generic Nonplanar Environments. J. Field Robotics, 34(5):940-984, 2017. [doi]
Abstract is missing.