path_follower should not get stuck in front of walls