启发式搜索
启发式搜索是结合广搜和最短路径思想的一种算法。广搜本质上是一种暴力的搜索算法,围绕起点将所有能走的路径全部进入队列,再根据队列依次出发进行下轮的搜索。但是广搜会有非常多的浪费搜索,与终点完全反方向的地方也会进行搜索。
启发式搜索的实现
而启发式搜索会在广搜的基础上增加三个条件:G-与起点的物理距离,H-与终点的物理距离,F-G和H两者之和;并且使用优先队列维护每次进行搜索的点总是优先队列中与F最小的点。
代码实现:
预处理node结点需要记录位置以及走过的路径步数,以及当前点到终点的距离h,由于需要用堆来存储结点所以需要重写<操作符;
首先接收地图
首先将起点进入优先队列,每次选取队列中距离终点物理距离最小的结点进行遍历,当这个点能走的话则先计算它与终点的物理距离,并进入优先队列。在走到终点时输出步数以及当前地图。
计算与终点的距离;
这里希望能看到最优路径,设置了prex,prey两个数组,记录每一步的前一个点,最后到达终点时反向深搜回起点并将每一步都转成字母o;
最终结果:
可以看到虽然用了一个障碍,但是整体还是朝终点走去。