A* A星 算法 C语言 实现代码

关于A*算法，很早就想写点什么，可是貌似天天在忙活着什么，可事实又没有做什么，真是浮躁啊！所以今晚还是来写一下总结吧！

        A*算法是很经典的只能启发式搜索算法，关于只能搜索算法和一般的搜索算法(例如DFS，BFS之类)，在语言描述上的区别，我觉得用《代码大全》中的一句话描述的非常好：“驾驶汽车达到某人家，写成算法是：沿167号高速往南行至Puyallup，从XX出口后往山上开4.5英里，在一个杂货店旁边的红绿灯右转，接着在第一个路口左转，从左边的褐色大房子的车道进去就是；而启发式是：找出上一次我们给你寄的信，照着信上地址开车到这个镇，到了那里你问一下我们房子在那里，这里的每一个人都认识我们，肯定会有人愿意帮助你，如果你找不到人，就找一个电话亭打电话给我们，我们出来接你”。听上去还是有点抽象。那么下面我们具体看看A*算法！

注：本文的图形以及一些思想借助于http://www.policyalmanac.org/games/aStarTutorial.htm，非常感谢经典文   章！

                                                    

我们要想从绿色的点到红色的点，需要启发式得去找一条路径，到底怎么去找呢，开始没有办法，只能从开始点慢慢尝试！我们需要定义一个OPEN表，OPEN表中放的是什么呢？就是当前考虑的点，及其周边的点需要添加进来，作为可能的路径上的点。这样说可能有点抽象，那么先看下面：

                                                                  

我们从起始点开始搜索：

   1：从点A开始，并且把它作为待处理点存入一个OPEN表。你的路径可能会通过它包含的方格，也可能不会。基本上，这是一个待检查方格的列表。
   2：寻找起点周围(邻居)所有可到达或者可通过的方格，如果有障碍物方格。那么就不需要考虑他们，对于其他的吕剧节点也把他们加入OPEN表。这些邻居节点认当前点为父节点。(父节点的保存是必须的！因为当我们找到最后一个点的时候，需要通过父节点回溯，找到所有点直到开始节点！那么就是一个完整的路径！)
   3：从开启列表中删除点A，把它加入到一个CLOSE列表，列表中保存所有不需要再次检查的方格。

在这一点，你应该形成如图的结构。在图中，暗绿色方格是你起始方格的中心。它被用浅蓝色描边，以表示它被加入到关闭列表中了。所有的相邻格现在都在开启列表中，它们被用浅绿色描边。每个方格都有一个灰色指针反指他们的父方格，也就是开始的方格。

                                                                    

结下来我们应该选择哪一个点继续考虑呢！我想大家应该知道所谓的启发函数，所谓权值之类(此处所谓的权值就是路劲的长度)。YES，我们需要OPEN表中权值F最小的那个点！为什么呢，当然是权值越小，越靠近目标点咯！

对于权值我们设为F，那么F怎么计算到的！我们有两个项！G和H， 

G = 从起点A，沿着产生的路径，移动到网格上指定方格的路径耗费。
H = 从网格上那个方格移动到终点B的预估移动耗费。这经常被称为启发式的。这样叫的原因是因为它只是个猜测。我们没办法事先知道路径的长度。(但是我们需要知道：虽然只是猜测，但是只要是基于一个统一的标准，相对远近的趋势是不变的！这一点是很重要的！ )

例如：H值的估计采用“曼哈顿”法，也就是当前的点，到目标点，横向和纵向的格子数相加，就是H值！

           ( 注意：对于障碍物我们是不考虑是否跳过的问题！即，障碍物也当做正常的一个格子！这也是H值仅仅是预测的而已的原因！即所谓启发式！ )

那么对于第一幅图，起始点离终点的H值是：横向相差4个格子，纵向相差0个格子，那么H=4+0=4；

当然也有其他的办法，例如使用直线距离，sqrt( pow( des.x - src.x ) + pow( des.y - src.y ) )也是可以的~

对于G值！在这个例子，令水平或者垂直移动的耗费为10，对角线方向耗费为14。我们取这些值是因为沿对角线的距离是沿水平或垂直移动耗费的的根号2约1.414倍。为了简化，我们用10和14近似。有时候简化是很重要的~

( 其实距离只要反应了基本的倍数关系就可以了！ )

对于起始点以及周围点的G值，H值和F值，下图可以很清晰的看到！( 左上角是F，左下角是G，右下角是H )

                                          

对于G值，只要是横向和竖向的邻居，设为+10，斜向的邻居+14就可以了~计算真的很easy吧~呵呵~

对于H值，就是数格子就是咯~

F = G + H

注意上面的邻居节点都加入OPEN表了哦~~~   起点从OPEN中删除，加入CLOSE中~

接着计算：

然后从OPEN表中选择一个F值最小的然后考虑其周围邻居，再循环处理！直到终点加入CLOSE中，寻路结束！或者OPEN空了，没找到路径！

( 至于我们怎么选出最小的那个点呢！？我们使用堆排序处理的，对于选出最小值是很快的~ )

可以看到，F最小的是起始点右边的那个点，下面框框表示的~

                                  

然后再考虑其邻居：

此时对于其邻居有几种可能性！

1：邻居已经在CLOSE表中了，那么不需要考虑了~

2：邻居是障碍物，不需要考虑了e

3：邻居不在OPEN表中，那么将邻居加入OPEN，并将次邻居的父节点赋值为当前节点

4：邻居在OPEN中，那么需要看看此邻居点的G值与当前点的(G值+当前点到邻居点的距离(10或者14))的大小，如果从此点走更近(即G值更小)，那么将此点的父节点换成当前点！(注意：对于同一个点，G值下，那么F必须小！因为H是相同的！)

下面是进一步的图示： 

                                             

那么我们按照上面的思路，知道终点加入CLOSE表！（ 终极图示如下 ）

                                                  

最终我们可以得到路径：( 之前我们说过，由父节点往前回溯就很easy的得到路径了~ )

                                    

说了这么多，也不知道说的行不行，还是需要总结一下！

总结：

1：将起始点加入OPEN表中

2：循环直到OPEN为空或者终点加入CLOSE表中

否则：找到OPEN表中F值最小的节点(使用堆排序得到小值点)，将此点从OPEN删除，加入CLOSE！

  (此时最小点已经取出，那么需要从新排序OPEN表，是的第一个点是最小F的点！)

   对8个邻居进行处理：

若：1：邻居已经在CLOSE表中了，那么不需要考虑了~

2：邻居是障碍物，不需要考虑了e

3：邻居不在OPEN表中，那么将邻居加入OPEN，并将次邻居的父节点赋值为当前节点

4：邻居在OPEN中，那么需要看看此邻居点的G值与当前点的(G值+当前点到邻居点的距

     离 (10或者14))的大小，如果从此点走更近(即G值更小)，那么将此点的父节点换成当前           点！  (注意：对于同一个点，G值下，那么F必须小！因为H是相同的！)

     注意：当父节点改变后，OPEN表中的最小点可能会变化，那么需要再次排序得到最

        小点！

3：结束，根据退出循环的条件可以知道到底有没有找到路径！所以下面的工作就easy了~

      基本的原理就是这样的~

下面给一个简单的C语言的演示代码，只是为了演示原理，没有注重其他问题，所以大家莫怪啊~

注意：数组中1代表起点，2代表终点，0代表可以通过，3代表障碍物

[cpp]  view plain   copy

  print ?

1. #include <stdio.h>  
2. #include <stdlib.h>  
3.   
4. #define STARTNODE   1  
5. #define ENDNODE     2  
6. #define BARRIER     3  
7.   
8. typedef struct AStarNode  
9. {  
10.     int s_x;    // 坐标(最终输出路径需要)  
11.     int s_y;  
12.     int s_g;    // 起点到此点的距离( 由g和h可以得到f，此处f省略，f=g+h )  
13.     int s_h;    // 启发函数预测的此点到终点的距离  
14.     int s_style;// 结点类型：起始点，终点，障碍物  
15.     struct AStarNode * s_parent;    // 父节点  
16.     int s_is_in_closetable;     // 是否在close表中  
17.     int s_is_in_opentable;      // 是否在open表中  
18. }AStarNode, *pAStarNode;  
19.   
20. AStarNode  map_maze[10][10];        // 结点数组  
21. pAStarNode open_table[100];     // open表  
22. pAStarNode close_table[100];        // close表  
23. int<span style="white-space:pre">   </span>   open_node_count;  <span style="white-space:pre">  </span>// open表中节点数量  
24. int