https://remp3indir.net/a-pathfinding-algorithm-explanation-and-python-example/