Create Obstacle Set Start Point Set Final Point