Make sure the navigation does not get stuck when snapping into the next waypoint position
Resolves #40
Hi! Nothing visual to show here, both the short and long version are “it used to get stuck while navigating before, now it does not anymore”.
This endless loop could be broken by aborting the currently running job (it also occurred in navigation triggered by jobs) was a real pain when testing the object-in-object logic, as the bug only really triggered in short distance navigation, which was mostly the case then. So, happy to see this one fixed, time to look at the greener pastures of feature development again!