推箱子

#include<iostream>
#include<queue>
using namespace std;
queue<int>q1;
queue<int>q2;
queue<int>q3;
queue<int>q4;
int step[10][10][10][10]={0};
int dr[4]={0,1,0,-1};//东南西北；
int dc[4]={1,0,-1,0};
int rx,ry,sx,sy,tx,ty;
char mig[10][10];//迷宫地图；
void readdate();//读数据；
void init();//初始化；
int fbs();//主程序；
int s,b1,b2;
int canmoveto(int x,int y,int dire);
int moveto1(int x,int dire);
int moveto2(int y,int dire);
int moveto3(int x,int y,int dire);
int moveto4(int x,int y,int dire);
int main()
{
    int sum,sum1;
    readdate();
    init();
    sum=fbs();
    if(sum==-1)
    {
        cout<<-1<<endl;
        return 0;
    }
    cout<<sum<<endl;
    return 0;
}

void readdate()//读入数据；
{
    int i,j;
    for(i=0;i<10;i++)
    {
        for(j=0;j<10;j++)
        {
            cin>>mig[i][j];
            if(mig[i][j]=='4')
            {
                rx=i;ry=j;
            }
            else if(mig[i][j]=='2')
            {
                sx=i;sy=j;
            }
            else if(mig[i][j]=='3')
            {
                tx=i;ty=j;
            }
        }
    }
}

void init()//初始化；
{
    q1.push(rx);
    q2.push(ry);//人的坐标；
    q3.push(sx);
    q4.push(sy);//箱子的坐标；
    step[rx][ry][sx][sy]=0;
    mig[rx][ry]='0';//很重要，因为你用的是坐标，为了方便，全化成0，注意是字符；
    mig[sx][sy]='0';
}

int fbs()
{
    int i,u1,u2,v1,v2;
    int c1,c2;
    while(!q1.empty())
    {
        u1=q1.front();q1.pop();
        u2=q2.front();q2.pop();
        b1=q3.front();q3.pop();
        b2=q4.front();q4.pop();
        for(i=0;i<4;i++)
        {
            s=canmoveto(u1,u2,i);
            if(s!=0)
            {
                if(s==1)//人向前走；
                {
                    v1=moveto1(u1,i);
                    v2=moveto2(u2,i);
                    c1=b1;
                    c2=b2;
                }
                else if(s==2)//人推箱子走；
                {
                    v1=moveto1(u1,i);
                    v2=moveto2(u2,i);
                    c1=moveto3(b1,b2,i);
                    c2=moveto4(b1,b2,i);
                }
                if(c1==tx&&c2==ty)
                {
                    return step[u1][u2][b1][b2]+1;
                }
                else if(step[v1][v2][c1][c2]==0)
                {
                    step[v1][v2][c1][c2]=step[u1][u2][b1][b2]+1;
                    q1.push(v1);
                    q2.push(v2);
                    q3.push(c1);
                    q4.push(c2);
                }
            }
        }
    }
    return -1;
}

int canmoveto(int x,int y,int dire)
{
    int row,col;
    row=x+dr[dire];
    col=y+dc[dire];
    if((row!=b1||col!=b2)&&row<=9&&row>=0&&col<=9&&col>=0&&mig[row][col]=='0')
    {
        return 1;
    }
    else if(row==b1&&col==b2)
    {
        if((mig[row+dr[dire]][col+dc[dire]]=='0'||mig[row+dr[dire]][col+dc[dire]]=='3')&&row+dr[dire]<=9&&row+dr[dire]>=0&&col+dc[dire]<=9&&col+dc[dire]>=0)
        {
            return 2;
        }
    }
    return 0;
}

int moveto1(int x,int dire)
{
    int row;
    row=x+dr[dire];
    return row;
}

int moveto2(int y,int dire)
{
    int col;
    col=y+dc[dire];
    return col;
}

int moveto3(int x,int y,int dire)
{
    return x+dr[dire];
}

int moveto4(int x,int y,int dire)
{
    return y+dc[dire];

}

思路很清晰，不过多解释，套用模板，基本上就出来了。

希望小伙伴们尽早解决问题。