Reworked UnitGoals. AStar tuned up. Resolved unit blocking.