一个A星寻路算法C++小样例,可参考我的博客