增加A*寻路算法