Problem:
Problem C: Push!!

Mr. Schwarz was a famous powerful pro wrestler. He starts a part time job as a warehouseman.
His task is to move a cargo to a goal by repeatedly pushing the cargo in the warehouse, of course,
without breaking the walls and the pillars of the warehouse.

There may be some pillars in the warehouse. Except for the locations of the pillars, the floor of
the warehouse is paved with square tiles whose size fits with the cargo. Each pillar occupies the
same area as a tile.

Initially, the cargo is on the center of a tile. With one push, he can move the cargo onto the
center of an adjacent tile if he is in proper position. The tile onto which he will move the cargo
must be one of (at most) four tiles (i.e., east, west, north or south) adjacent to the tile where
the cargo is present.

To push, he must also be on the tile adjacent to the present tile. He can only push the cargo in
the same direction as he faces to it and he cannot pull it. So, when the cargo is on the tile next
to a wall (or a pillar), he can only move it along the wall (or the pillar). Furthermore, once he
places it on a corner tile, he cannot move it anymore.

He can change his position, if there is a path to the position without obstacles (such as the cargo
and pillars) in the way. The goal is not an obstacle. In addition, he can move only in the four
directions (i.e., east, west, north or south) and change his direction only at the center of a tile.

As he is not so young, he wants to save his energy by keeping the number of required pushes
as small as possible. But he does not mind the count of his pedometer, because walking is very
light exercise for him.

Your job is to write a program that outputs the minimum number of pushes required to move
the cargo to the goal, if ever possible.

Input

The input consists of multiple maps, each representing the size and the arrangement of the
warehouse. A map is given in the following format.

w h
d11 d12 d13 ... d1w
d21 d22 d23 ... d2w
...
dh1 dh2 dh3 ... dhw

The integers w and h are the lengths of the two sides of the floor of the warehouse in terms of
widths of floor tiles. w and h are less than or equal to 7. The integer dij represents what is
initially on the corresponding floor area in the following way.

0: nothing (simply a floor tile)

1: a pillar

2: the cargo

3: the goal

4: the warehouseman (Mr. Schwarz)

Each of the integers 2, 3 and 4 appears exactly once as dij in the map. Integer numbers in an
input line are separated by at least one space character. The end of the input is indicated by a
line containing two zeros.

Output

For each map, your program should output a line containing the minimum number of pushes.
If the cargo cannot be moved to the goal, -1 should be output instead.

Sample Input

5 5
0 0 0 0 0
4 2 0 1 1
0 1 0 0 0
1 0 0 0 3
1 0 0 0 0
5 3
4 0 0 0 0
2 0 0 0 0
0 0 0 0 3
7 5
1 1 4 1 0 0 0
1 1 2 1 0 0 0
3 0 0 0 0 0 0
0 1 0 1 0 0 0
0 0 0 1 0 0 0
6 6
0 0 0 0 0 3
0 0 0 0 0 0
0 0 0 0 0 0
0 0 0 0 0 0
0 2 0 0 0 0
4 0 0 0 0 0
0 0

Output for the Sample Input

5
-1
11
8

Solution in JAVA (judge verdict: Accepted)

import java.util.*;
public class Main {
	int INF = 1 << 24;
	int [] vx = {0,1,0,-1};
	int [] vy = {1,0,-1,0};
	int w, h;
	
	class C implements Comparable<C>{
		int x, y, cx, cy, step;
		public C(int nowx, int nowy, int cx, int cy, int step) {
			this.x = nowx;
			this.y = nowy;
			this.cx = cx;
			this.cy = cy;
			this.step = step;
		}
		@Override
		public String toString() {
			return "C [x=" + x + ", y=" + y + ", cx=" + cx + ", cy=" + cy
					+ ", step=" + step + "]";
		}
		@Override
		public int compareTo(C o) {
			if(this.step < o.step) return -1;
			if(this.step > o.step) return 1;
			return 0;
		}
		
	}
	
	private void doit(){
		Scanner sc = new Scanner(System.in);
		while(true){
			w = sc.nextInt();
			h = sc.nextInt();
			if((w|h) == 0) break;
			int [][] map = new int[h][w];
			int sx = -1, sy = -1, cx = -1, cy = -1;
			for(int i = 0; i < h; i++){
				for(int j = 0; j < w; j++){
					int input = sc.nextInt();
					if(input == 4){
						map[i][j] = 0;
						sx = j;
						sy = i;
					}
					else if(input == 2){
						map[i][j] = 0;
						cx = j;
						cy = i;
					}
					else{
						map[i][j] = input;
					}
				}
			}
			
			PriorityQueue<C> open = new PriorityQueue<C>();
			open.add(new C(sx, sy, cx, cy, 0));
			boolean [][][][] close = new boolean[h][w][h][w];
			close[sy][sx][cy][cx] = true;
			int ans = INF;
			
			while(! open.isEmpty()){
				C now = open.poll();
				
				for(int i = 0; i < 4; i++){
					int nextx = now.x + vx[i];
					int nexty = now.y + vy[i];
					if(isOUT(nextx, nexty)) continue;
					if(map[nexty][nextx] == 1) continue;
					
					if(nexty == now.cy && nextx == now.cx){
						int xx = nextx + vx[i];
						int yy = nexty + vy[i];
						if(isOUT(xx, yy)) continue;
						if(map[yy][xx] == 1) continue;
						
						if(map[yy][xx] == 3){
							ans = now.step + 1;
							continue;
						}
						if(close[nexty][nextx][yy][xx]) continue;
						close[nexty][nextx][yy][xx] = true;
						C next = new C(nextx, nexty, xx, yy, now.step + 1);
						open.add(next);
					}
					else{
						int xx = now.cx;
						int yy = now.cy;
						if(close[nexty][nextx][yy][xx]) continue;
						close[nexty][nextx][yy][xx] = true;
						C next = new C(nextx, nexty, now.cx, now.cy, now.step);
						open.add(next);
					}
				}
			}
			System.out.println(ans == INF ? -1 : ans);
		}
	}
	
	private boolean isOUT(int nextx, int nexty) {
		if(0 <= nextx && nextx < w && 0 <= nexty && nexty < h){
			return false;
		}
		return true;
	}

	public static void main(String[] args) {
		Main obj = new Main();
		obj.doit();
	}
}