https://tusharr-patil.github.io/posts/a_star_algo/