Changed minimum waypoint altitiude to 1 m