The breadth first path finder (because why complicate life with floating points and astar) - View it on GitHub