[Pathfinding] Rewrote finding the lowest fcost. computePath now called.