Astar path finding part1