making sure the robot doesnt get stuck in nav loops between waypoints