广度优先（迷宫找人）

import java.util.LinkedList;

public class One {
    public static void main(String args[]){
        int n,m,p,q;//n,m为数组实际迷宫的行列，p，q为目标地的数组行纵号
        int a[][]=new int[51][51],book[][]=new int[51][51];//迷宫和标记数组
        int d[][]={{0,1},{1,0},{0,-1},{-1,0}};//方向数组，用于遍历各个方向
        Scanner scanner=new Scanner(System.in);
        System.out.println("请输入迷宫行列数:");
        n=scanner.nextInt();
        m=scanner.nextInt();
        System.out.println("输入迷宫:");
        for(int i=1;i<=n;i++){
            for(int j=1;j<=m;j++){
                a[i][j]=scanner.nextInt();
            }
            System.out.println("");
        }
        System.out.println("请输入目的地数组坐标:");
        p=scanner.nextInt();
        q=scanner.nextInt();
        LinkedList<Note> list=new LinkedList<Note>();
        //初始化链表第一个点
        list.add(new Note(1,1,0));
        book[1][1]=1;
        int tx,ty,flag=0;//tx,ty用于表示扩展的数组行列号,flag用于表示是否找到了目的点
        while(!list.isEmpty()){
            for(int k=0;k<=3;k++){//链表第一个点的扩展（四个方向）
                tx=list.getFirst().x+d[k][0];
                ty=list.getFirst().y+d[k][1];
                //判断是否出界，或者有障碍，或者已经走过了
                if(tx<1||ty<1||tx>n||ty>m||a[tx][ty]==1||book[tx][ty]==1)continue;
                list.add(new Note(tx,ty,list.getFirst().step+1));//若没有过界，也没有障碍物，则把该扩展点加入到链表后面
                if(tx==p&&ty==q){//若该扩展点为目的地，则flag=1表示找到了目的地，并且停止继续查找
                    flag=1;
                    break;
                }
            }
            if(flag==1)break;//若找到了目的地，停止扩展
            list.removeFirst();
        }
        System.out.println(list.getLast().step);
    }
}
class Note{
    int x,y,step;
    Note(int x,int y,int step){
        this.x=x;
        this.y=y;
        this.step=step;
    }
}