Drive and Recover a 4WD vehicle in a Bush Terrain