Create astar.py

simple A* best path finding algorithm