POJ 迷宫问题+基础bfs

#include"stdio.h"#include"stdlib.h"struct dd{    int x;    int y;};int  map[5][5];int dir[4][2]={1,0,-1,0,0,1,0,-1};          //方向 struct dd queue[50],record[5][5];           //队列和路径 void bfs(){    struct dd next,current;   //表示下一个节点的坐标，表示当前节点     int head,end,i;    head=end=0;                             current.x=queue[end].x;   //将第一个放进队列的元素设为当前    current.y=queue[end].y;     end++;    while(head<end)    {        current=queue[head++];                    for(i=0;i<4;i++)                //从四个方向开始选取路径         {            next.x=current.x+dir[i][0];            next.y=current.y+dir[i][1];            if(next.x<5&&next.y<5&&next.x>=0&&next.y>=0&&map[next.x][next.y]==0)            {                record[next.x][next.y].x=current.x;         //保存第一个到达这个点的坐标（因为当next被走过之后会被标记                record[next.x][next.y].y=current.y;             //因此不用担心会被其他的节点访问）                 if(next.x==4 && next.y==4)                {                    return ;                }                else                {                    queue[end++]=next;                    map[next.x][next.y]=1;                 }            }        }     }}int main(){    int i,j,m,n,k;    for(i=0;i<5;i++)    for(j=0;j<5;j++)    {        scanf("%d",&map[i][j]);    }    map[0][0]=1;            //将起点标记为走过     queue[0].x=0;            //将起点入队     queue[0].y=0;    bfs();    i=j=4;    k=0;    queue[k].x=4;    queue[k++].y=4;    while(i!=0||j!=0)                //将从终点到起点的路径保存            {        m=i;n=j;        i=record[m][n].x;        j=record[m][n].y;        queue[k].x=i;        queue[k++].y=j;    }    for(i=k-1;i>=0;i--)    {        printf("(%d, %d)\n",queue[i].x,queue[i].y);    }    return 0;}