完成基本A*搜索算法