Basic A* for python based on a grid system