Add in removeNodesAroundObstacle