Some cleanup to pathfinding; initial wall support