Fixing oscillations in path follower when next target is behind robot