【java】走迷宫最短路径

来源:互联网 发布:java实现qq第三方登录 编辑:程序博客网 时间:2024/06/01 08:59

输入一个n*m的迷宫,1表示空地,0表示障碍物,输出从某个点到某个点的最短路径

样例输入:

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

0 0

0 3

样例输出:

DDDDRRUUURU

import java.util.LinkedList;import java.util.Queue;import java.util.Scanner;import java.util.Arrays;public class Main {public static void main(String[] args){Scanner scanner = new Scanner(System.in);while(scanner.hasNext()){int n=scanner.nextInt();int m=scanner.nextInt();int [][]maze=new int[n][m];int [][]visited=new int[n][m];int [][]fa=new int[n][m];//记录到该节点的上一个节点的坐标int [][]last_dir=new int[n][m];int []dx={-1,1,0,0};//四个方向int []dy={0,0,-1,1};char []dir={'U','D','L','R'};for(int i=0;i<n;i++){Arrays.fill(visited[i], 0);}for(int i=0;i<n;i++)for(int j=0;j<m;j++)maze[i][j]=scanner.nextInt();int src_x=scanner.nextInt();//起点int src_y=scanner.nextInt();int des_x=scanner.nextInt();//终点int des_y=scanner.nextInt();if(maze[src_x][src_y]!=1)continue;Queue<Integer> queue=new LinkedList<Integer>();queue.offer(src_x*m+src_y);//矩阵数组按0,1,2...n*m编号fa[src_x][src_y]=src_x*m+src_y;visited[src_x][src_y]=1;while(!queue.isEmpty()){int index=queue.poll();int x=index/m;int y=index%m;for(int i=0;i<4;i++){int nx=x+dx[i];int ny=y+dy[i];if(nx>=0&&nx<n&&ny>=0&&ny<m&&maze[nx][ny]==1&&visited[nx][ny]==0){queue.offer(nx*m+ny);visited[nx][ny]=1;fa[nx][ny]=index;last_dir[nx][ny]=i;}}}StringBuffer path=new StringBuffer();int fx=des_x;int fy=des_y;int index=des_x*m+des_y;while(fa[fx][fy]!=index){path.append(dir[last_dir[fx][fy]]);int x=fa[fx][fy]/m;int y=fa[fx][fy]%m;fx=x;fy=y;index=fx*m+fy;}System.out.println(path.reverse().toString());}scanner.close();}


0 0
原创粉丝点击