Java資料結構BFS廣搜法解決迷宮問題

import java.util.LinkedList;
import java.util.Scanner;
 
public class Main {
	//n*m的地圖，(startx,starty)起點座標，(endx,endy)終點座標
	static int n, m, startx, starty, endx, endy;
	static int[][] map;//地圖
	static boolean[][] vistied;//標記當前點是否已經走過
	static int[][] step = { { 1, 0 }, { 0, 1 }, { -1, 0 }, { 0, -1 } };
	/*
	 * 上下左右移動遍歷搜尋 1 ,0 表示 x + 1 ，y + 0 向右移動，其他同理 如果為八向連通 則加上, { 1, 1 }, { 1, -1 }, {
	 * -1, 1 }, { -1, -1 } 代表斜向移動
	 */
	public static void main(String[] args) {
		Scanner sc = new Scanner(System.in);
		n = sc.nextInt();
		m = sc.nextInt();
		map = new int[n + 2][m + 2];//+2是為了防止點在邊界時，四方向移動造成下標出現-1越界。
		vistied = new boolean[n + 2][m + 2];
		// 錄入資料圖  下標（1~n）*（1~m）
		for (int i = 1; i <= n; i++) {
			for (int j = 1; j <= m; j++) {
				map[i][j] = sc.nextInt();
			}
		}
		//錄入起點和終點座標
		startx = sc.nextInt();
		starty = sc.nextInt();
		endx = sc.nextInt();
		endy = sc.nextInt();
		bfs(startx, starty);//BFS廣搜
	}
 
	private static void bfs(int x, int y) {
		point p = new point(x, y, 0);//初始化point類封裝x，y座標以及step步數
		LinkedList<point> queue = new LinkedList<point>();//需要用到的佇列
		queue.add(p);//將當前點入佇列
		vistied[x][y] = true;//標記成已存取
		boolean flag = false;//是否達到終點標記
		//只要佇列不為空，就說明還有路可走
		while (!queue.isEmpty()) {
			point first = queue.getFirst();//取出佇列的第一個點
			if (first.x == endx && first.y == endy) {//判斷當前點是否與終點座標重合
				System.out.println(first.step);//列印需要走的步數
				flag = true;//標記已經到達終點
				break;//結束BFS
			}
			//未到達終點則進行上下左右四個方向移動
			for (int i = 0; i < 4; i++) {
				//橫縱座標變換實現位置移動
				int newx = first.x + step[i][0];
				int newy = first.y + step[i][1];
				int newstep = first.step + 1;//每一動一次步數要+1
				//判斷移動後的新位置可以走，並且沒走過
				if (map[newx][newy] == 1 && vistied[newx][newy] == false) {
					point newp = new point(newx, newy, newstep);//封裝資料
					queue.add(newp);//入佇列
					vistied[newx][newy] = true;//標記已經走過
				}
			}
			queue.removeFirst();//四個方向判斷完成後，要將隊首元素出列
		}
		if (!flag)//如果無法到達終點提示
			System.out.println("NO");
	}
}
//定義一個位置點的class，方便封裝資料入佇列
class point {
	int x;
	int y;
	int step;//從起點走到當前點需要走的步數
 
	public point(int x, int y, int step) {
		this.x = x;
		this.y = y;
		this.step = step;
	}
}