Obstacle to closedList

Obstacles are added to the closedList correctly.