Missions were not completing successfully because they were waiting for
the current waypoint number to be 1 higher than was possible