Initial A* added. Not used for exploring yet.