一般bfs ,据说可以用万能的打印。
#include<stdio.h>
int quene[250][3],head,tail,path[250],maze[6][6];
void visit(int row,int col)
{
quene[tail][0]=row;
quene[tail][1]=col;
quene[tail++][2]=head-1;
maze[row][col]=-1;
}
void bfs()
{
int row,col,pre,i;
head=0;tail=1;
quene[0][0]=1;
quene[0][1]=1;
quene[0][2]=-1;
maze[1][1]=-1;
while(head!=tail)
{
row=quene[head][0];
col=quene[head++][1];
if(row==5&&col==5)
break;
if(col+1<6&&maze[row][col+1]==0)
visit(row,col+1);
if(row+1<6&&maze[row+1][col]==0)
visit(row+1,col);
if(col-1>0&&maze[row][col-1]==0)
visit(row,col-1);
if(row-1>0&&maze[row-1][col]==0)
visit(row-1,col);
}
pre=head-1;
i=0;
while(pre!=-1)
{
path[i++]=pre;
pre=quene[pre][2];
}
for(int j=i-1;j>=0;--j)
printf("(%d, %d)\n",quene[path[j]][0]-1,quene[path[j]][1]-1);
}
int main()
{
for(int i=1;i<6;++i)
for(int j=1;j<6;++j)
scanf("%d",&maze[i][j]);
bfs();
return 0;
}