Optimal motion planning of autonomous vehicles in three dimensional terrains | IEEE Conference Publication | IEEE Xplore