Terrain-Aware Autonomous Navigation