added AStarPlanner from my previous homework