AStar searching assignment