Stabilize the obstacle avoidance