[Pathfinding] Changing to A* for now. Add construct path.