Continued work on AStar Algorithm