迷宫问题

参照了文章：http://blog.csdn.net/afeiluo/article/details/9162631
该问题可以结合广度优先和深度优先

//迷宫问题---广度优先搜索-----队列
#include <stdio.h>
#include <queue>
#include <iostream>
using namespace std;
#define MAX_ROW 5
#define MAX_COL 5

struct point
{
    int row;
    int col;
};

queue<point> s;

int maze[MAX_ROW][MAX_COL] =
{
    0,0,0,0,0,
    0,0,0,1,0,
    0,1,0,0,0,
    0,0,0,0,0,
    0,0,0,1,0
};

void print_maze()
{
    for(int i=0; i<MAX_ROW; ++i)
    {
        for(int j=0; j<MAX_COL; ++j)
        {
            printf("%d ",maze[i][j]);
        }
        printf("\n");
    }
    printf("************************\n");
}

struct point predecessor[MAX_ROW][MAX_COL] =
{
    {{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
    {{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
    {{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
    {{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
    {{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}}
};

void visit(int row,int col,struct point pre)
{
    point visit_point = {row,col};
    maze[row][col] = 2;
    predecessor[row][col] = pre;
    s.push(visit_point);
}

int main()
{
    point p = {0,0};
    maze[p.row][p.col] = 2;
    s.push(p);
    while(!s.empty())
    {
        p = s.front();
        s.pop();
        //抵达目的地
        if(p.row == MAX_ROW-1 && p.col == MAX_COL-1)
        {
            break;
        }

        //向下移动
        if(p.row+1 < MAX_ROW && maze[p.row+1][p.col]==0)
        {
            visit(p.row+1,p.col,p);
        }

        //向右移动
        if(p.col+1 < MAX_COL && maze[p.row][p.col+1]==0)
        {
            visit(p.row,p.col+1,p);
        }

        //向上移动
        if(p.col-1 >= 0 && maze[p.row][p.col-1]==0)
        {
            visit(p.row,p.col-1,p);
        }
        //向左移动
        if(p.row-1>=0 && maze[p.row-1][p.col]==0)
        {
            visit(p.row-1,p.col,p);
        }
        print_maze();
    }
    if(p.row == MAX_ROW-1 && p.col == MAX_COL-1)
    {
        printf("(%d,%d)\n",p.row,p.col);
        while(predecessor[p.row][p.col].row != -1)
        {
            p = predecessor[p.row][p.col];
            printf("(%d,%d)\n",p.row,p.col);
        }
    }
    else
    {
        cout <<"NO Path"<<endl;
    }
    return 0;
}