地下迷宫---BFS

小青蛙有一天不小心落入了一个地下迷宫,小青蛙希望用自己仅剩的体力值P跳出这个地下迷宫。
为了让问题简单,假设这是一个n*m的格子迷宫,迷宫每个位置为0或者1,0代表这个位置有障碍物,
小青蛙达到不了这个位置;1代表小青蛙可以达到的位置。
小青蛙初始在(0,0)位置,地下迷宫的出口在(0,m-1)(保证这两个位置都是1,并且保证一定有起点到终点可达的路径),
小青蛙在迷宫中水平移动一个单位距离需要消耗1点体力值,
向上爬一个单位距离需要消耗3个单位的体力值,向下移动不消耗体力值,
当小青蛙的体力值等于0的时候还没有到达出口,小青蛙将无法逃离迷宫。
现在需要你帮助小青蛙计算出能否用仅剩的体力值跳出迷宫(即达到(0,m-1)位置)。
输入描述:
输入包括n+1行:
第一行为三个整数n,m(3 <= m,n <= 10),P(1 <= P <= 100)
接下来的n行:
每行m个0或者1,以空格分隔
输出描述:
如果能逃离迷宫,则输出一行体力消耗最小的路径,输出格式见样例所示;如果不能逃离迷宫,则输出”Can not escape!”。
测试数据保证答案唯一
输入例子:
4 4 10
1 0 0 1
1 1 0 1
0 1 1 1
0 0 1 1
输出例子:
[0,0],[1,0],[1,1],[2,1],[2,2],[2,3],[1,3],[0,3]

class Point{
    public int x,y,b;
    public Point prev;
    public Point(int x,int y,int b){
        this.x=x;
        this.y=y;
        this.b=b;
    }
}
public class 地下迷宫 {
    public static void main(String[]args){
        Scanner sc=new Scanner(System.in);
        int n=sc.nextInt();
        int m=sc.nextInt();
        int p=sc.nextInt();
        int [][]a=new int[n][m];
        boolean [][]visit=new boolean[n][m];
        for(int i=0;i<n;i++){
            for(int j=0;j<m;j++){
                a[i][j]=sc.nextInt();
            }
        }
        sc.close();
        Point first=new Point(0,0,p);
        Queue<Point>q=new LinkedList<>();
        q.add(first);
        visit[0][0]=true;
        int max=-1;
        Point maxP=null;
        while(!q.isEmpty()){
            Point cur=q.poll();
            if(cur.x==0&&cur.y==m-1){//到达终点
                if(cur.b>max){//剩余血量最大
                    max=cur.b;
                    maxP=cur;
                }
            }else{
                //不超界&&可走&&没走过&&走后血量还有
                //x是上下,y是左右
                if(cur.y-1>=0&&a[cur.x][cur.y-1]!=0&&!visit[cur.x][cur.y-1]&&cur.b-1>=0){//向左走
                    Point left=new Point(cur.x,cur.y-1,cur.b-1);
                    left.prev=cur;
                    q.add(left);
                    visit[cur.x][cur.y-1]=true;
                }
                if(cur.y+1<m&&a[cur.x][cur.y+1]!=0&&!visit[cur.x][cur.y+1]&&cur.b-1>=0){//向右走
                    Point right=new Point(cur.x,cur.y+1,cur.b-1);
                    right.prev=cur;
                    q.add(right);
                    visit[cur.x][cur.y+1]=true;
                }
                if(cur.x-1>=0&&a[cur.x-1][cur.y]!=0&&!visit[cur.x-1][cur.y]&&cur.b-3>=0){//向上走
                    Point up=new Point(cur.x-1,cur.y,cur.b-3);
                    up.prev=cur;
                    q.add(up);
                    visit[cur.x-1][cur.y]=true;
                }
                if(cur.x+1<n&&a[cur.x+1][cur.y]!=0&&!visit[cur.x+1][cur.y]&&cur.b>=0){//向下走
                    Point down=new Point(cur.x+1,cur.y,cur.b);
                    down.prev=cur;
                    q.add(down);
                    visit[cur.x+1][cur.y]=true;
                }
            }
        }
        if(maxP==null){
            System.out.println("Can not escape!");
        }else{
            Stack<Point>stk=new Stack<>();
            while(maxP!=null){
                stk.push(maxP);
                maxP=maxP.prev;
            }
            while(stk.size()>1){
                Point tmp=stk.pop();
                System.out.print("["+tmp.x+","+tmp.y+"],");
            }
            Point tmp=stk.pop();
            System.out.println("["+tmp.x+","+tmp.y+"]");
        }
    }
}