forked from: A* pathfinder

