AStart - Pathfinder in python