Finished a-star + probe.
Bug fix to visited sets for PlanSketches.