1054: [HAOI2008]移动玩具

#include<iostream>
#include<cstdio>
#include<cstring>
#include<queue>
using namespace std;
const int dx[4]={0,1,0,-1};
const int dy[4]={1,0,-1,0};
bool vis[500005];
int mp[10][10];
void cod(int s){
for(int i=1;i<=4;i++)
for(int j=1;j<=4;j++){
mp[i][j]=s&1;
s>>=1;
}
}
int recod(){
int ans=0;
for(int i=4;i>=1;i--)
for(int j=4;j>=1;j--){
ans<<=1;
ans|=mp[i][j];
}
return ans;
}
int bfs(int s,int t){
if(s==t)return 0;
queue<int>q,d;q.push(s);d.push(0);vis[s]=true;
while(!q.empty()){
int u=q.front(),tmp=d.front();q.pop();d.pop();
cod(u);
for(int i=1;i<=4;i++)
for(int j=1;j<=4;j++)
if(mp[i][j]){
for(int k=0;k<4;k++){
int tx=i+dx[k],ty=j+dy[k];
if(mp[tx][ty]||tx<1||tx>4||ty<1||ty>4)continue;
mp[tx][ty]=1;
mp[i][j]=0;
int v=recod();
if(!vis[v]){
vis[v]=true;
q.push(v);d.push(tmp+1);
if(v==t)return tmp+1;
}
mp[i][j]=1;
mp[tx][ty]=0;
}
}
}
}
char ch[10];
int main(){
for(int i=1;i<=4;i++){
scanf("%s",ch+1);
for(int j=1;j<=4;j++)
mp[i][j]=ch[j]-'0';
}
int s=recod();
for(int i=1;i<=4;i++){
scanf("%s",ch+1);
for(int j=1;j<=4;j++)
mp[i][j]=ch[j]-'0';
}
int t=recod();
printf("%d",bfs(s,t));
return 0;
}