Fixing some graph bugs
A* pt 1