Problem:
Problem D: Twirling Robot

Let's play a game using a robot on a rectangular board
covered with a square mesh (Figure D-1).
The robot is initially set at the start square in the northwest corner
facing the east direction.
The goal of this game is to lead the robot
to the goal square in the southeast corner.

Figure D-1: Example of a board

The robot can execute the following five types of commands.

"Straight":

Keep the current direction of the robot, and move forward to the next square.

"Right":

Turn right with 90 degrees from the current direction, and move forward to the next square.

"Back":

Turn to the reverse direction, and move forward to the next square.

"Left":

Turn left with 90 degrees from the current direction, and move forward to the next square.

"Halt":

Stop at the current square to finish the game.

Each square has one of these commands assigned as shown in Figure D-2.
The robot executes the command assigned to the square where it resides,
unless the player gives another command to be executed instead.
Each time the player gives an explicit command,
the player has to pay the cost that depends on the command type.

Figure D-2: Example of commands assigned to squares

The robot can visit the same square several times during a game.
The player loses the game when the robot goes out of the board
or it executes a "Halt" command before arriving at the goal square.

Your task is to write a program that calculates the minimum cost to lead the robot
from the start square to the goal one.

Input

The input is a sequence of datasets.
The end of the input is indicated by a line containing two zeros separated by a space.
Each dataset is formatted as follows.

w h

s(1,1) ... s(1,w)

s(2,1) ... s(2,w)

...

s(h,1) ... s(h,w)

c0 c1 c2 c3

The integers h and w are the numbers of rows and columns of the board,
respectively.
You may assume 2 ≤ h ≤ 30 and 2 ≤ w ≤ 30.
Each of the following h lines consists of w numbers delimited by a space.
The number s(i, j) represents the command assigned to the square
in the i-th row and the j-th column as follows.

0: "Straight"

1: "Right"

2: "Back"

3: "Left"

4: "Halt"

You can assume that a "Halt" command is assigned to the goal square.
Note that "Halt" commands may be assigned to other squares, too.

The last line of a dataset contains four integers
c0, c1, c2, and c3, delimited by a space,
indicating the costs that the player has to pay
when the player gives
"Straight", "Right", "Back", and "Left" commands
respectively.
The player cannot give "Halt" commands.
You can assume that all the values of
c0, c1, c2, and c3
are between 1 and 9, inclusive.

Output

For each dataset, print a line only having a decimal integer indicating the minimum cost
required to lead the robot to the goal.
No other characters should be on the output line.

Sample Input

8 3
0 0 0 0 0 0 0 1
2 3 0 1 4 0 0 1
3 3 0 0 0 0 0 4
9 9 1 9
4 4
3 3 4 0
1 2 4 4
1 1 1 0
0 2 4 4
8 7 2 1
2 8
2 2
4 1
0 4
1 3
1 0
2 1
0 3
1 4
1 9 3 1
0 0

Output for the Sample Input

1
11
6

Solution in JAVA (judge verdict: Wrong Answer)

import java.util.Comparator;
import java.util.PriorityQueue;
import java.util.Scanner;


public class Main{
	static int[][] map=new int[30][30];  //?????????
	static int ch, cw, cd;
	static int h, w;  //map?????????
	static Node[][][] node;  //?????????
	static PriorityQueue<Node> open_queue;
	static Node currentNode;  //?¨?????????????



	public static void main(String[] args) {
		Scanner sc = new Scanner(System.in);
		int c0,c1,c2,c3;  //??´????????????????????¢?????????

		while(true){
			w=sc.nextInt();
			h=sc.nextInt();

			if(w==0 && h==0){break;}

			for(int i=0;i<h;i++){  //??????????????±??????
				for(int j=0;j<w;j++){
					map[i][j]=sc.nextInt();
				}
			}
			c0=sc.nextInt();
			c1=sc.nextInt();
			c2=sc.nextInt();
			c3=sc.nextInt();

			node=new Node[h][w][4];  //?????\??????
			for(int i=0;i<h;i++){
				for(int j=0;j<w;j++){
					for(int k=0;k<4;k++){
						node[i][j][k]=new Node();
						node[i][j][k].Nh=i;
						node[i][j][k].Nw=j;
						node[i][j][k].Nd=k;
					}
				}
			}
			for(int k=0;k<4;k++){
				node[0][0][k].Start=true;
				node[h-1][w-1][k].Goal=true;
			}

			for(int i=0;i<h;i++){  //???????????\??????
				for(int j=0;j<w;j++){
					for(int k=0;k<4;k++){
						if(k==0){node[i][j][k].cost=c0;}
						else if(k==1){node[i][j][k].cost=c1;}
						else if(k==2){node[i][j][k].cost=c2;}
						else if(k==3){node[i][j][k].cost=c3;}
					}
				}
			}

			for(int i=0;i<h;i++){   //map??¨?????´???????????????0
				for(int j=0;j<w;j++){
					for(int k=0;k<4;k++){
						if(map[i][j]==0){node[i][j][0].cost=0;}
						else if(map[i][j]==1){node[i][j][1].cost=0;}
						else if(map[i][j]==2){node[i][j][2].cost=0;}
						else if(map[i][j]==3){node[i][j][3].cost=0;}
					}
				}
			}

			Dykstra();
		}
	}

	static void Dykstra(){
		open_queue = new PriorityQueue<Node>(1, new MyComparator());
		open_queue.add(node[0][0][0]);
		node[0][0][0].f=0;
		while(true){
			currentNode=open_queue.poll();
			if(currentNode.Goal==true){
				break;
			}
			Calc();
		}
		System.out.println(currentNode.f);
	}
	static void Calc(){
		ch=currentNode.Nh;
		cw=currentNode.Nw;
		cd=currentNode.Nd;  //0??? 1??? 2??? 3???
		//System.out.println(currentNode.f);

		if(ch>0){  //??????
			if(cd==0){
				if(node[ch-1][cw][2].f>currentNode.f+node[ch][cw][3].cost){
					node[ch-1][cw][2].f=currentNode.f+node[ch][cw][3].cost;  //???????????????????????????
					open_queue.add(node[ch-1][cw][2]);
				}
			}
			else if(cd==1){
				if(node[ch-1][cw][2].f>currentNode.f+node[ch][cw][1].cost){
					node[ch-1][cw][2].f=currentNode.f+node[ch][cw][1].cost; //???????????????????????????
					open_queue.add(node[ch-1][cw][2]);
				}
			}
			else if(cd==2){
				if(node[ch-1][cw][2].f>currentNode.f+node[ch][cw][0].cost){
					node[ch-1][cw][2].f=currentNode.f+node[ch][cw][0].cost; //???????????´???????????????
					open_queue.add(node[ch-1][cw][2]);
				}
			}
			else if(cd==3){
				if(node[ch-1][cw][2].f>currentNode.f+node[ch][cw][2].cost){
					node[ch-1][cw][2].f=currentNode.f+node[ch][cw][2].cost; //??????????????¢????????????
					open_queue.add(node[ch-1][cw][2]);
				}
			}
		}
		if(ch<h-1){  //??????
			if(cd==0){
				if(node[ch+1][cw][3].f>currentNode.f+node[ch][cw][1].cost){
					node[ch+1][cw][3].f=currentNode.f+node[ch][cw][1].cost;  //???????????????????????????
					open_queue.add(node[ch+1][cw][3]);
				}
			}
			else if(cd==1){
				if(node[ch+1][cw][3].f>currentNode.f+node[ch][cw][3].cost){
					node[ch+1][cw][3].f=currentNode.f+node[ch][cw][3].cost; //???????????????????????????
					open_queue.add(node[ch+1][cw][3]);
				}
			}
			else if(cd==2){
				if(node[ch+1][cw][3].f>currentNode.f+node[ch][cw][2].cost){
					node[ch+1][cw][3].f=currentNode.f+node[ch][cw][2].cost; //??????????????¢????????????
					open_queue.add(node[ch+1][cw][3]);
				}
			}
			else if(cd==3){
				if(node[ch+1][cw][3].f>currentNode.f+node[ch][cw][0].cost){
					node[ch+1][cw][3].f=currentNode.f+node[ch][cw][0].cost; //???????????´???????????????
					open_queue.add(node[ch+1][cw][3]);
				}
			}
		}
		if(cw>0){  //??????
			if(cd==0){
				if(node[ch][cw-1][1].f>currentNode.f+node[ch][cw][2].cost){
					node[ch][cw-1][1].f=currentNode.f+node[ch][cw][2].cost;  //??????????????¢????????????
					open_queue.add(node[ch][cw-1][1]);
				}
			}
			else if(cd==1){
				if(node[ch][cw-1][1].f>currentNode.f+node[ch][cw][0].cost){
					node[ch][cw-1][1].f=currentNode.f+node[ch][cw][0].cost; //???????????´???????????????
					open_queue.add(node[ch][cw-1][1]);
				}
			}
			else if(cd==2){
				if(node[ch][cw-1][1].f>currentNode.f+node[ch][cw][3].cost){
					node[ch][cw-1][1].f=currentNode.f+node[ch][cw][3].cost; //???????????????????????????
					open_queue.add(node[ch][cw-1][1]);
				}
			}
			else if(cd==3){
				if(node[ch][cw-1][1].f>currentNode.f+node[ch][cw][1].cost){
					node[ch][cw-1][1].f=currentNode.f+node[ch][cw][1].cost; //???????????????????????????
					open_queue.add(node[ch][cw-1][1]);
				}
			}
		}
		if(cw<w-1){  //??????
			if(cd==0){
				if(node[ch][cw+1][0].f>currentNode.f+node[ch][cw][0].cost){
					node[ch][cw+1][0].f=currentNode.f+node[ch][cw][0].cost;  //???????????´???????????????
					open_queue.add(node[ch][cw+1][0]);
				}
			}
			else if(cd==1){
				if(node[ch][cw+1][0].f>currentNode.f+node[ch][cw][2].cost){
					node[ch][cw+1][0].f=currentNode.f+node[ch][cw][2].cost; //??????????????¢????????????
					open_queue.add(node[ch][cw+1][0]);
				}
			}
			else if(cd==2){
				if(node[ch][cw+1][0].f>currentNode.f+node[ch][cw][1].cost){
					node[ch][cw+1][0].f=currentNode.f+node[ch][cw][1].cost; //???????????????????????????
					open_queue.add(node[ch][cw+1][0]);
				}
			}
			else if(cd==3){
				if(node[ch][cw+1][0].f>currentNode.f+node[ch][cw][3].cost){
					node[ch][cw+1][0].f=currentNode.f+node[ch][cw][3].cost; //???????????????????????????
					open_queue.add(node[ch][cw+1][0]);
				}
			}
		}
	}
}



class Node{
	int cost; //??´????????????????????¢?????????
	int f; //?????????
	int Nh, Nw, Nd;  //??´?????¨??????
	boolean Start;
	boolean Goal;
	
	public Node(){
		cost=Integer.MAX_VALUE;
		f=Integer.MAX_VALUE;
		Nh=0;
		Nw=0;
		Nd=0;
		Start=false;
		Goal=false;
	}
}


class MyComparator implements Comparator<Object>{
    public int compare(Object obj1, Object obj2) {

        Node num1 = (Node)obj1;
        Node num2 = (Node)obj2;

        if(num1.f>num2.f) {
            return 1;
        } else if(num1.f<num2.f) {
            return -1;
        } else{
            return 0;
        }
    }
}