广度优先搜索 最短路径 队列

//============================================================================
// Name        : Bfs.cpp
// Author      : judyge
// Version     :
// Copyright   : Your copyright notice
// Description : Hello World in C++, Ansi-style
//============================================================================

#include<iostream>
using namespace std;
int map[5][5];
int vis[5][5];
struct node{
    int x;
    int y;
    int pre;
}edge[100];  //节点队列
int front=0,rear=1;//队头，队尾
int dir[4][2]={{0,-1},{1,0},{0,1},{-1,0}};   //四种方向
void f(int i)//根据pre  倒向追踪法路径
{
    if(edge[i].pre!=-1)
    {
        f(edge[i].pre);
        cout<<"("<<edge[i].x<<", "<<edge[i].y<<")"<<endl;
    }
}
void BFS(int x,int y)
{
    edge[front].x=x;   //开始时节点
    edge[front].y=y;
    edge[front].pre=-1;
    while(front<rear)//队列为空时终止
    {
        int u;
        for(u=0;u<4;u++)    //下一节点---四个方向
        {
        	//从队头取一个  找他的下一节点
            int x=edge[front].x+dir[u][0];
            int y=edge[front].y+dir[u][1];
            //下一节点  如果被遍历---或是墙----或是障碍物
            if(x<0||x>=5||y<0||y>=5||vis[x][y]==1||map[x][y]==1)
                continue;   //找下一个方向
            else  //下一节点  如果没遍历---不是墙----不是障碍物
            {
                vis[x][y]=1;   //下节点设置为遍历过
                map[x][y]=1;
                edge[rear].x=x;//下一节点--入队
                edge[rear].y=y;
                edge[rear].pre=front; //记录他的前一节点
                rear++;
            }
            if(x==4&&y==4)//如果下一个节点为 4，4
                f(front);    // 找到他以前的路径打印 算一个解法
        }
        front++;//对头出队
    }
}
int main()
{
    int i,j;
    for(i=0;i<5;i++)
    {
        for(j=0;j<5;j++)
        {
            cin>>map[i][j];   //输入图
        }
    }
    memset(vis,0,sizeof(vis));
    cout<<"("<<"0, 0)"<<endl;
    BFS(0,0);
    cout<<"(4, 4)"<<endl;
    return 0;
}

//============================================================================
// Name        : bfs2.cpp
// Author      : judyge
// Version     :
// Copyright   : Your copyright notice
// Description : Hello World in C++, Ansi-style
//============================================================================

#include<stdio.h>
//四个方向
const int di[4] = {0,1,0,-1},
          dj[4] = {1,0,-1,0};
//地图
unsigned maze[5][5] = {
    2, 1, 0, 0, 0,
    0, 1, 0, 1, 0,
    0, 0, 0, 0, 0,
    0, 1, 1, 1, 0,
    0, 0, 0, 1, 0},
    head = 0, tail = 1;
//节点队列
struct { int i, j; } que[23] = {0};

void print_maze(void)
{
    int i, j;
    for (i = 0; i < 5; i++) {
        for (j = 0; j < 5; j++)
            printf("%d ", maze[i][j]);
        putchar('\n');
    }
    printf("*********\n");
}//输出路径

int main(void)
{
    while (head != tail) {
        head = (head + 1) % 23;   //头节点出队
        int i;
        for (i = 0; i < 4; i++)
        	//如果下一节点不是墙 不是障碍物 没有被遍历
            if (que[head].i + di[i] >= 0 && que[head].i + di[i] < 5
                && que[head].j + dj[i] >= 0 && que[head].j +dj[i] < 5
                && maze[que[head].i + di[i]][que[head].j +dj[i]] == 0)
            {
            	// 下一节点入队
                    que[tail = (tail + 1) % 23].i = que[head].i + di[i];
                    que[tail].j = que[head].j +dj[i];

                    maze[que[head].i + di[i]][que[head].j +dj[i]] = 2;
                   //标记已经遍历过

                    if (que[head].i + di[i] == 4 && que[head].j +dj[i] == 4) {
                        printf("Have path.\n");//如果找到出口
              }
            }
        print_maze();   //打印地图状况
    }
    printf("No path.\n");
    return 0;
}