Terrain Aware Traverse Planning For Mars Rovers