Fixed up pathfinding algorithm for using walk data