Avoid Obstacle function test

testing the function of Avoid Obstacle
Obstacle 1