ported and adapted Astar algorithm from example