Create CloserAStar

It works, but it's not ASTAR yet