Problem:
チーズ (Cheese)

問題

今年も JOI 町のチーズ工場がチーズの生産を始め，ねずみが巣から顔を出した．JOI 町は東西南北に区画整理されていて，各区画は巣，チーズ工場，障害物，空き地のいずれかである．ねずみは巣から出発して全てのチーズ工場を訪れチーズを 1 個ずつ食べる．

この町には，N 個のチーズ工場があり，どの工場も１種類のチーズだけを生産している．チーズの硬さは工場によって異なっており，硬さ 1 から N までのチーズを生産するチーズ工場がちょうど 1 つずつある．

ねずみの最初の体力は 1 であり，チーズを 1 個食べるごとに体力が 1 増える．ただし，ねずみは自分の体力よりも硬いチーズを食べることはできない．

ねずみは，東西南北に隣り合う区画に 1 分で移動することができるが，障害物の区画には入ることができない．チーズ工場をチーズを食べずに通り過ぎることもできる．すべてのチーズを食べ終えるまでにかかる最短時間を求めるプログラムを書け．ただし，ねずみがチーズを食べるのにかかる時間は無視できる．

入力

入力は H+1 行ある．1 行目には 3 つの整数 H，W，N (1 ≤ H ≤ 1000，1 ≤ W ≤ 1000，1 ≤ N ≤ 9) がこの順に空白で区切られて書かれている．2 行目から H+1 行目までの各行には，'S'，'1', '2', ..., '9'，'X'，'.' からなる W 文字の文字列が書かれており，各々が各区画の状態を表している．北から i 番目，西から j 番目の区画を (i,j) と記述することにすると (1 ≤ i ≤ H, 1 ≤ j ≤ W)，第 i+1 行目の j 番目の文字は，区画 (i,j) が巣である場合は 'S' となり，障害物である場合は 'X' となり，空き地である場合は '.' となり，硬さ 1, 2, ..., 9 のチーズを生産する工場である場合はそれぞれ '1', '2', ..., '9' となる．入力には巣と硬さ 1, 2, ..., N のチーズを生産する工場がそれぞれ 1 つずつある．他のマスは障害物または空き地であることが保証されている．ねずみは全てのチーズを食べられることが保証されている．

出力

すべてのチーズを食べ終えるまでにかかる最短時間（分）を表す整数を 1 行で出力せよ．

入出力例

入力例 1

3 3 1
S..
...
..1

出力例 1

4

入力例 2

4 5 2
.X..1
....X
.XX.S
.2.X.

出力例 2

12

入力例 3

10 10 9
.X...X.S.X
6..5X..X1X
...XXXX..X
X..9X...X.
8.X2X..X3X
...XX.X4..
XX....7X..
X..X..XX..
X...X.XX..
..X.......

出力例 3

91

問題文と自動審判に使われるデータは、情報オリンピック日本委員会が作成し公開している問題文と採点用テストデータです。

Solution in JAVA (judge verdict: Accepted)

import java.io.BufferedReader;
import java.io.IOException;
import java.io.InputStreamReader;
import java.util.ArrayDeque;
import java.util.Arrays;

public class Main {

	public static void main(String[] args) throws IOException {
		// TODO ?????????????????????????????????????????????
		BufferedReader br = new BufferedReader(new InputStreamReader(System.in));

		String[] tmpArray = br.readLine().split(" ");

		int h = Integer.parseInt(tmpArray[0]);
		int w = Integer.parseInt(tmpArray[1]);
		int n = Integer.parseInt(tmpArray[2]);

		char[][] matrix = new char[h][w];
		Point[] cheese = new Point[n + 1];
		int cheeseID = 0;
		
		for(int i = 0; i < h; i++){
			String tmp = br.readLine();
			for(int j = 0 ; j < w; j++){
				matrix[i][j] = tmp.charAt(j);
				if(Character.isDigit(matrix[i][j])){
					cheese[matrix[i][j] - '0'] = new Point(j, i);
				}
				
				else if(matrix[i][j] == 'S'){
					cheese[0] = new Point(j, i);
				}
			}
						
		}
		
		int dist = 0;
		for(int i = 1; i <= n; i++){
			int tmpdist = bfs(matrix, cheese[i - 1].x, cheese[i - 1].y, cheese[i].x, cheese[i].y);
			dist += tmpdist;
//			System.out.println((i-1)+"to"+i+ " "+tmpdist);
		}
		
		System.out.println(dist);

	}

	static int bfs(char[][] matrix, int startX, int startY, int goalX, int goalY){
		ArrayDeque<Point> queue = new ArrayDeque<Point>();

		int[][] dist = new int[matrix.length][matrix[0].length];
		for(int i = 0; i < dist.length ; i++){
			Arrays.fill(dist[i], Integer.MAX_VALUE);
		}

		queue.add(new Point(startX, startY));
		dist[startY][startX] = 0;

//		int currentDist = 1;
		int x;
		int y;
		while(!queue.isEmpty()){
			Point p = queue.poll();
			
			x = p.x;
			y = p.y;
			
//			if(x == goalX && y == goalY){
//				break;
//			}
			
			//???
			if(y > 0 && matrix[y - 1][x] != 'X' && dist[y - 1][x] > dist[y][x] + 1){
				dist[y - 1][x] = dist[y][x] + 1;
				queue.push(new Point(x, y - 1));
			}
			//???
			if(y < matrix.length - 1 && matrix[y + 1][x] != 'X' && dist[y + 1][x] > dist[y][x] + 1){
				dist[y + 1][x] = dist[y][x] + 1;
				queue.push(new Point(x, y + 1));
			}
			//???
			if(x > 0 && matrix[y][x - 1] != 'X' && dist[y][x - 1] > dist[y][x] + 1){
				dist[y][x - 1] = dist[y][x] + 1;
				queue.push(new Point(x - 1, y));
			}
			//???
			if(x < matrix[0].length - 1 && matrix[y][x + 1] != 'X' && dist[y][x + 1] > dist[y][x] + 1){
				dist[y][x + 1] = dist[y][x] + 1;
				queue.push(new Point(x + 1, y));
			}
			
			//System.out.println("queue size"+queue.size());
//			currentDist++;
		}

		//debug
//		for(int i =0 ; i < dist.length ; i++){
//			for(int j = 0; j < dist[0].length ; j++){
//				System.out.printf("%11d", dist[i][j]);
//			}
//			System.out.println();
//		}
		return dist[goalY][goalX];
	}

}

class Point {
	short x;
	short y;

	public Point(int x, int y){
		this.x = (short)x;
		this.y = (short)y;
	}
}