Create an A* search algorithm for more efficiently finding the shortest path

[FaronBracy]

https://en.wikipedia.org/wiki/A*_search_algorithm

This should perform better than the current Dijkstra algorithm.