6.4.2

把书上例子特殊化了，初始化了输入矩阵，并且将障碍物的格初始化，书上的位置输出好像有问题。

#include<stdio.h>
#include<string.h>

const int MAXN=100+10;
int n=6,m=5;
char name[5]={'L','D','R','U','O'};
int q[MAXN*MAXN],maze[6][5]={{1,1,0,1,1},{1,0,1,1,1},{1,0,1,0,0},{1,0,1,1,1},{1,1,1,0,1},{1,1,1,1,1}};
int father[MAXN][MAXN],dist[MAXN][MAXN],vis[MAXN][MAXN];
int dx[4]={0,1,0,-1},dy[4]={-1,0,1,0};
int last_dir[MAXN][MAXN],dir[MAXN];

void bfs(int x,int y)
{
	int front=0,rear=0,d,u;
	u=x*m+y;
	vis[x][y]=1;
	dist[x][y]=0;
	father[x][y]=u;
	q[rear++]=u;
	while(front<rear){
		u=q[front++];
		x=u/m;
		y=u%m;
		for(d=0;d<4;d++){
			int nx=x+dx[d];
			int ny=y+dy[d];
			if(nx>=0&&nx<n&&ny>=0&&ny<m&&maze[nx][ny]&&!vis[nx][ny]){
				int v=nx*m+ny;
				q[rear++]=v;
				vis[nx][ny]=1;
				father[nx][ny]=u;
				dist[nx][ny]=dist[x][y]+1;
				last_dir[nx][ny]=d;
			}
		}
	}
}

void print_path(int x, int y)
{
	int c=0;
	//while(1){
		int fx=father[x][y]/m;
		int fy=father[x][y]%m;
        if(fx!=x||fy!=y){
            print_path(fx,fy);
            putchar(name[last_dir[x][y]]);
        }
       
}

int main()
{
	
    
    int i,j;
    for(i=0;i<6;i++){
        for(j=0;j<5;j++)last_dir[i][j]=4;
    }
    bfs(0,0);
    for(i=0;i<6;i++){
        for(j=0;j<5;j++){
           printf("%c",name[last_dir[i][j]]);
            printf(" ");
        }
        printf("\n");
    }
}