迷宫问题

Description
定义一个二维数组：
int maze[5][5] = {

0, 1, 0, 0, 0,

0, 1, 0, 1, 0,

0, 0, 0, 0, 0,

0, 1, 1, 1, 0,

0, 0, 0, 1, 0,

};

它表示一个迷宫，其中的1表示墙壁，0表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。
Input
一个5 × 5的二维数组，表示一个迷宫。最短路径保证有唯一解。
Output
左上角到右下角的最短路径，格式如样例所示。
Sample Input Copy
0 1 0 0 0
0 1 0 1 0
0 0 0 0 0
0 1 1 1 0
0 0 0 1 0
Sample Output Copy
(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

解题思路
使用两个双向队列存储走过的点，一个队列存储正在走的点，一个队列存储最优解的点。

AC代码

#include<bits/stdc++.h>
using namespace std;
#define ios ios::sync_with_stdio(false); cin.tie(NULL);
//const int N = 110;
int n;
int m;
int mp[5][5];
int ans;//走的步数
int nice;//最优解的步数
int fx[]= {0,1,0,-1};
int fy[]= {-1,0,1,0};
struct node
{
    int a;
    int b;
}str,cnt[25];
int k;
deque<node>p;//暂存每一次的路径
deque<node>q;//存储最优路径
bool vis[5][5];
bool check(int x,int y)
{
    if(x>=0&&x<5&&y>=0&&y<5&&mp[x][y]==0&&!vis[x][y])
    {
        return true;
    }
    return false;
}

void dfs(int x,int y,int ans)
{
    if(ans>nice) return ;
    if(x==4&&y==4)
    {
        if(ans<nice)
        {
            nice = ans;
            while(!q.empty())
            {
                q.pop_back();
            }
            k=0;
            while(!p.empty())
            {
                q.push_back(p.front());
                cnt[k] = p.front();
                p.pop_front();
                k++;
            }
            for(int i=0; i<k; i++)
            {
                p.push_back(cnt[i]);
            }
        }
        return ;
    }

    for(int i=0; i<4; i++)
    {
        str.a = x+fx[i];
        str.b = y+fy[i];
        if(check(str.a,str.b))
        {
            p.push_back(str);
            vis[x][y] = true;
            dfs(str.a,str.b,ans+1);
            vis[x][y] = false;
            p.pop_back();

        }
    }
    return ;
}


int main()
{
    for(int i=0; i<5; i++)
    {
        for(int j=0; j<5; j++)
        {
            cin>>mp[i][j];
        }
    }
    nice=100;
    dfs(0,0,0);
    cout<<'('<<0<<", "<<0<<')'<<endl;
    while(!q.empty())
    {
        cout<<'('<<q.front().a<<", "<<q.front().b<<')'<<endl;
        q.pop_front();
    }
    return 0;
}