BFS题目解析--无人机问题

BFS题目解析–无人机问题

题目

S 公司正在筹备无人机包裹投递业务，设计了一种投递算法，准备对其进行测试。在测试环境中，假设要投递的城市为 N x M 的网格形状。同时，给定 K 栋大楼的位置和楼层数。在测试中，无人机将从网格左上角出发，前往待投递包裹的大楼楼层。
无人机的起始高度为第一层，移动到相邻网格或上下移动一层将消耗一个单位的电池电量。
此外，如果无人机进入错误的大楼或楼层，会收到投诉。因此，无人机必须在与目的地相邻的网格上平稳飞行，而后上下左右移动，方可完成投递。计算出完成投递所需的最小耗电量。无人机不得离开网格。

如上 [图] 所示，N = 5，M = 5，网格中的数字表示大楼的编号，而括号中的数字表示大楼的楼层数。
如果投递目的地为 1 号大楼第二层，则无人机将前往 (4,1)，此时其高度将升高 2 个单位，达到 3 个单位。随后，它将越过 4 号大楼，从 (4,3) 降低 1 个单位的高度，进入 1 号大楼第二层。此时，无人机消耗了九个单位的电池电量。
如果无人机投递失败，将输出 -1。

[限制条件]
1.N 和 M 为介于 5 到 100 之间的整数。
2.大楼数量 K 为介于 1 到 200 之间的整数。
3.大楼的楼层数为介于 1 到 100 之间的整数。
4.(1, 1) 位置没有大楼。
5.无人机的高度必须至少为 1，并且可以无限高。
6.待投递大楼的编号为介于 1 到 K 之间的整数。
7.待投递大楼的楼层数至少为 1 层，并且不得超过该栋大楼的总楼层数。

[输入]
首先，给定测试用例数量 T，后面接着输入 T 种测试用例。在每个测试用例的第一行，给定 N、M 和 K，以空格分隔。在第二行，给定待投递大楼的编号和楼层。接下来的 K 行，每行给定一栋大楼的位置坐标和楼层数，从 1 号大楼开始。

[输出]
按标准格式依次输出每个测试用例的答案。每个测试用例，都输出“#x”（其中 x 表示测试用例编号，从 1 开始）加上一个空格（不包含引号），然后输出相关测试用例的答案。

[输入和输出示例]
(输入)
1
5 5 5
1 2
3 3 5
3 2 5
2 3 2
4 2 2
1 4 9

(输出)
#1 9

(sample_input.txt 的输出)
#1 9
#2 -1
#3 109
#4 208
#5 1
#6 2
#7 6
#8 13
#9 16
#10 24
#11 12
#12 25
#13 26
#14 43
#15 27
#16 80
#17 77
#18 158
#19 19
#20 39

思路

这道题我选择用bfs进行搜索，因为bfs直接输出的是最短路径，所以直接输出最小耗电量。具体思路可以看代码的注释。

代码

import java.util.Scanner;
import java.util.*;
import java.util.Queue;
import java.util.LinkedList;

class Position{
   //三维空间位置类，横坐标，竖坐标，楼层高,以及耗电量steps
	int x,y,h,steps;
	
	public Position(int x, int y, int h,int steps) {
   
		this.x = x;
		this.y = y;
		this.h = h;
		this.steps = steps;
	}
  
}


public class wurenjibaoguotoudi {
   
	static int [][]dir = {
   {
   1,0},{
   -1,0},{
   0,1},{
   0,-1}};
	static int T,N,M,K;//N*M的网格，K栋楼

	public static void main(String[] args) throws Exception{
   
		Scanner sc