推荐订阅源

     想了一个寻路算法，用C++实现了一下，界面用MFC完成的很简单。用20x20的方形区域作为迷宫，为了方便，随机选取了大约1/3的格子作为路障，禁止通过。规则是在只能想前后左右四个方向移动的前提下找到从入口（默认左上角）到出口（默认右下角）的最短路径。

     源代码下载：https://files.cnblogs.com/GhostZCH/MFCMaze.rar(如果你下载了，希望你能留下只言片语，哪怕是“+1”也好，谢谢)

     说来这个算法也不算难，借鉴了路由器建立路由表的算法，更加简化一些。熟悉TCP/IP协议的筒子们一定会记得路由表建立的原来，这个算法也一样，把每一个单元看成一个路由器，在它上下左右的四个格子可以看做与它联通的四个路由器。每个单元与相邻的单元交换路由信息，直到稳定下来，这样就获得了每个单元到出口的路由信息。所谓的路由信息并不是一条完整地路径，只保存了到达出口的跳数(距离)和下一跳（下一步）的位置。这样如果存在从入口到出口的路径就可以找出来。如果在与相邻单位交换信息时，只保存最短的路径，就可以得到最短路径，同时最短路选择也避免了绕圈形成死循环的问题。

      界面很简单，进入程序或者点击建立迷宫时生成一个随机迷宫，点击寻找路径后电脑会执行寻路算法，通过提示框提示寻路是否成功及迭代次数，如果成功显示路径和每个格子到出口的距离。黑色为障碍，灰色为可通过区域，绿色为电脑找到的路径，数字标明该格子到出口（右下角）的最短距离，没有数字的灰色格子说明这个格子与出口不连通。如上图中的左下区域。虽然结果只显示了从左上到右下的最短路径，事实上算法已经计算出每个格子（与出口联通的）到达出口的最短路径和距离。

下面的两组图片是生成的迷宫和找到的路径，运行时间没有计算，人工观测都小于1秒。有兴趣的筒子可以验证一下是不是最短的路径。

寻路的核心代码如下：

    数据用的是“vector<Block *> _blocks”按照行优先的格式存下来的，在之前生成迷宫的时候就已经控制了入口和出口不是障碍，所以一开始先把出口的位置数据初始化了一下，剩下的就是迭代了。括号有十层，确实有点晕了，事实上不建议这样写代码的，超过五层括号就让人很迷惑了。但是考虑到程序本身比较小，既是不拆分函数也只有50行，不算变态（有一次需要读懂一个700行的函数，泪奔啊！！），循环体内部的逻辑也比较简单，没有太复杂的，所以就一个函数搞定，当然还是不建议大家这么做的。

 1 int Grid::InitMap()
 2 {
 3     Block* target = _blocks.at(_height*_width-1);
 4     target->CanReach(true);
 5     target->JumpCount(0);
 6 
 7     int times = 0;
 8     bool ischanged = true;
 9     //迭代到收敛，每个格子有最短个路径的长度和下一跳地址
10     while(ischanged)
11     {
12         times ++;
13         ischanged = false;
14 
15         // 逐格闻讯周围格子路径
16         for (int i=0;i<_height;i++)
17         {
18             for (int j =0;j<_width;j++)
19             { 
20                 //问询邻居,选择最短的路径更新自己的路由信息
21                 Block* block = Get(i,j);
22                 if (block->CanPass())
23                 {
24                     for (int ii=-1;ii<2;ii++)//-1到1
25                     {
26                         for (int jj=-1;jj<2;jj++)//-1到1
27                         {
28                             if(abs(ii)+abs(jj)==1)//只选四邻域
29                             {
30                                 int x = i+ii;
31                                 int y = j+jj;
32                                 if (x>=0&&y>=0&&x<_height&&y<_width)//处于格子中的邻域
33                                 {
34                                     // 邻接格子中比自己路径短的更新自己的路径
35                                     Block *tmp = Get(x,y);//某个邻接的格子
36                                     if (tmp->CanReach()&&(tmp->JumpCount()+1)<block->JumpCount())
37                                     {
38                                         block->CanReach(true);//设置可到达
39                                         block->JumpCount(tmp->JumpCount()+1);//设置跳数为邻近格子的跳数+1
40                                         block->NextJump(x*_width+y);//下一跳地址是邻接的格子
41                                         ischanged = true;
42                                     }
43                                 }//end if
44                             }//end if 
45                         }//end for jj
46                     }//end for ii
47                 }//end if
48             }//end for j
49         }//end for i
50     }// end while
51     return times;
52 }

顺便多贴几张结果图，当然也有寻路失败的：