Replaced the setArrived methods to the last waypointchecks.

:family: