create function "set_reached_waypoint_number" and "set_current_waypoint_number"