Fixed A*.
Now A* works on a grid, not my graph.