HDU 1195 Open the Lock

广搜……

#include<iostream>  
#include<cstdio>  
#include<cstring>  
#include<queue>  
using namespace std;  
struct node  
{  
    int num[4],step;  
};  
node start,end;  
bool visit[10][10][10][10],flag;  

void bfs()  
{  
    int i;  
    node p,q;  
    queue<node> Q;  
    memset(visit,false,sizeof(visit));  
    flag=true;  
    start.step=0;  
    p=start;  
    visit[p.num[0]][p.num[1]][p.num[2]][p.num[3]]=true;  
    Q.push(p);  
    while(!Q.empty())  
    {  
        p=Q.front();Q.pop();  
        flag=true;  
        for(i=0;i<4;i++)  
        if(p.num[i]!=end.num[i])  
        {  
            flag=false;  
            break;  
        };  
        if(flag)  
        {  
            printf("%d
",p.step);  
            return;  
        }  
        for(i=0;i<4;i++)//+1  
        {  
            q=p;  
            if(p.num[i]==9) q.num[i]=1;  
            else q.num[i]=p.num[i]+1;  
            q.step=p.step+1;  
            if(!visit[q.num[0]][q.num[1]][q.num[2]][q.num[3]])  
            {  
                visit[q.num[0]][q.num[1]][q.num[2]][q.num[3]]=true;  
                Q.push(q);  
            }  
        }  
        for(i=0;i<4;i++)//-1  
        {  
            q=p;  
            if(p.num[i]==1) q.num[i]=9;  
            else q.num[i]=p.num[i]-1;  
            q.step=p.step+1;  
            if(!visit[q.num[0]][q.num[1]][q.num[2]][q.num[3]])  
            {  
                visit[q.num[0]][q.num[1]][q.num[2]][q.num[3]]=true;  
                Q.push(q);  
            }  
        }  
        for(i=0;i<3;i++)//相邻交换  
        {  
            q=p;  
            q.num[i]=p.num[i+1];  
            q.num[i+1]=p.num[i];  
            q.step=p.step+1;  
            if(!visit[q.num[0]][q.num[1]][q.num[2]][q.num[3]])  
            {  
                visit[q.num[0]][q.num[1]][q.num[2]][q.num[3]]=true;  
                Q.push(q);  
            }  
        }  
    }  
}  

int main()  
{  
    int cas,i;  
    char chf[5],chl[5];  
    scanf("%d",&cas);  
    while(cas--)  
    {  
        scanf("%s%s",chf,chl);  
        for(i=0;i<4;i++)  
        {  
             start.num[i]=chf[i]-'0';  
             end.num[i]=chl[i]-'0';  
        }  
        bfs();  
    }  
    return 0;  
}