Obstacle Expansion Node implemented