Adding Sort() to pathfinding queue. A* was busted.