Changed waypoint 0 to better position on ground