Obstacle avoidance(TASK3) added