Revert PathFinding changes
Simplify Java AddObstacle