Finish abstract AStar algorithm. Agree on infrastructure before continuing.