Pathfinding fixes & build