地下迷宫---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+"]");        }    }}