Added a heuristic for a* that works.