https://remp3indir.net/code-review-java-pathfinding-lee-algorithm/