输入一个矩阵,输入初始坐标和目的坐标,输出最短路径(之一)及路径的各个坐标

//例如
//1 1 1 0 0 1
//0 1 1 1 0 0
//0 0 0 0 0 0
//0 0 1 1 0 0
//0 0 0 0 0 0
//1 1 1 0 0 1
//3 1 1 4
#include<stdio.h>
#include<string.h>
#include<queue>
using namespace std;
struct stu
{
    int x,y,step;
    int a[50];
} s;
int b[10][10],startx,starty,endx,endy,fx[4][2]= {0,1,0,-1,1,0,-1,0};
void bfs()
{
    int i;
    queue<stu>q;
    stu t;
    s.step=0,s.x=startx,s.y=starty,s.a[s.step]=(s.x-1)*6+s.y,b[s.x][s.y]=1;
    q.push(s);
    while(!q.empty())
    {
        s=q.front();
        q.pop();
        if(s.x==endx&&s.y==endy)
        {
            printf("%d\n",s.step);
            for(i=0; i<=s.step; i++)
                printf("%d %d\n",s.a[i]%6?s.a[i]/6+1:s.a[i]/6,s.a[i]%6?s.a[i]%6:6);
            break;
        }
        for(i=0; i<4; i++)
        {
            t.x=s.x+fx[i][0],t.y=s.y+fx[i][1];
            memcpy(t.a,s.a,sizeof(t.a));//s复制给t
            if(t.x>=1&&t.x<=6&&t.y>=1&&t.y<=6&&!b[t.x][t.y])
            {
                t.step=s.step+1,t.a[t.step]=(t.x-1)*6+t.y;
                q.push(t);
                b[t.x][t.y]=1;
            }
        }
    }
}
int main()
{
    int i,j;
    for(i=1; i<=6; i++)
        for(j=1; j<=6; j++)
            scanf("%d",&b[i][j]);  // 1表示墙,0表示路。
    scanf("%d%d%d%d",&startx,&starty,&endx,&endy);
    bfs();
}

posted @ 2016-10-22 15:26  xushukui  阅读(304)  评论(0编辑  收藏  举报