UVa 10047 - The Monocycle

求从起始点能到达终点的并且颜色与初始状态相同的最短路径

bfs求最短i路问题，只不过需要记录坐标、颜色、方向三种状态

#include <stdio.h>
#include <string.h>
typedef struct
{
    int x;
    int y;
    int cl;
    int di;
    int t;
}node;
node q[12550];
char map[30][30];
int vis[30][30][5][5],m,n,f,t;
int dx[5]={-1,0,1,0};
int dy[5]={0,1,0,-1};
int bfs(int x,int y)
{
    int front=0,rear=0;
    node s,u;
    s.x=x;s.y=y;s.cl=0;s.di=0;s.t=0;
    vis[x][y][0][0]=1;
    q[rear++]=s;
    while(front<rear)
    {
        s=q[front++];
        if(map[s.x][s.y]=='T'&&s.cl==0)
        {
            f=1;t=s.t;return 0;
        }
        int nx=s.x+dx[s.di];
        int ny=s.y+dy[s.di];
        if(nx>=0&&ny>=0&&nx<m&&ny<n&&!vis[nx][ny][(s.cl+1)%5][s.di]&&map[nx][ny]!='#')
        {
            u.x=nx;u.y=ny;u.cl=(s.cl+1)%5;u.di=s.di;u.t=s.t+1;
            q[rear++]=u;
            vis[nx][ny][u.cl][u.di]=1;
        }
        if(!vis[s.x][s.y][s.cl][(s.di+3)%4]&&map[s.x][s.y]!='#')
        {
            u.x=s.x;u.y=s.y;u.cl=s.cl;u.di=(s.di+3)%4;u.t=s.t+1;
            q[rear++]=u;
            vis[u.x][u.y][u.cl][u.di]=1;
        }
        if(!vis[s.x][s.y][s.cl][(s.di+1)%4]&&map[s.x][s.y]!='#')
        {
            u.x=s.x;u.y=s.y;u.cl=s.cl;u.di=(s.di+1)%4;u.t=s.t+1;
            q[rear++]=u;
            vis[u.x][u.y][u.cl][u.di]=1;
        }
    }
    return 0;
}
int main()
{
    int sx,sy,c=0;
    while(scanf("%d%d",&m,&n)==2)
    {
        if(!m&&!n)break;
        for(int i=0;i<m;i++)
        {
            scanf("%s",map[i]);
            for(int j=0;j<n;j++)
            {
                if(map[i][j]=='S')
                {
                    sx=i;sy=j;
                }
            }
        }
        memset(vis,0,sizeof(vis));
        f=0,t=0;
        bfs(sx,sy);
        if(c)printf("\n");
        printf("Case #%d\n",++c);
        if(!f)printf("destination not reachable\n");
        else printf("minimum time = %d sec\n",t);
    }
    return 0;
}