Pathfinding Algorithm Python Example