A* Pathfinding progress. Only one bug to fix.