Updated Astar to  return list of actions from start to goal