Lean4 implementation of the A* algorithm, loosely based on https://en.wikipedia.org/wiki/A*_search_algorithm