Simple python code for astar path search,just for learning astar