棋盘游戏（BFS或DFS）

题目描述

    有一个6*6的棋盘，每个棋盘上都有一个数值，现在又一个起始位置和终止位置，请找出一个从起始位置到终止位置代价最小的路径：     1、只能沿上下左右四个方向移动     2、总代价是没走一步的代价之和     3、每步（从a,b到c,d）的代价是c,d上的值与其在a,b上的状态的乘积     4、初始状态为1     每走一步，状态按如下公式变化：（走这步的代价%4）+1。

输入描述:

    每组数据一开始为6*6的矩阵，矩阵的值为大于等于1小于等于10的值，然后四个整数表示起始坐标和终止坐标。

输出描述:

    输出最小代价。

示例1

输入

1 1 1 1 1 1
1 1 1 1 1 1
1 1 1 1 1 1
1 1 1 1 1 1
1 1 1 1 1 1
1 1 1 1 1 1
0 0 5 5

输出

23

#include<stdio.h>
#include<string.h>
#include<stdlib.h>
#include<math.h>
#include<vector>
#include<map>
#include<set>
#include<queue>
#include<stack>
#include<algorithm>
using namespace std;
#define INF 0x3f3f3f3f
int chess[6][6],visit[6][6];
int mincost,startx,starty,endx,endy;
int dir[4][2]={{0,1},{0,-1},{1,0},{-1,0}};

int feasible(int x,int y) {
    if(x>=0&&x<6&&y>=0&&y<6&&visit[x][y]==0) {
        return 1;
    }
    return 0;
}

void DFS(int x,int y,int sum,int state) {
    int i,cot;
	if(sum<mincost){
		if(x==endx&&y==endy) { 
				mincost=sum;
			return;
		}
		for(i=0;i<4;i++)
		{
			int tmpx=x+dir[i][0];
			int tmpy=y+dir[i][1];
			if(feasible(tmpx,tmpy)){
				cot=state*chess[tmpx][tmpy]; 
				visit[tmpx][tmpy]=1;
				DFS(tmpx,tmpy,sum+cot,cot%4+1);
				visit[tmpx][tmpy]=0;
			}
		}
	}
}
int main() {
    int i,j;
    for(i=0; i<6; i++)
        for(j=0; j<6; j++)
            scanf("%d",&chess[i][j]);
		scanf("%d%d%d%d",&startx,&starty,&endx,&endy);
		memset(visit,0,sizeof(visit));
		mincost=INF;visit[startx][starty]=1;
		DFS(startx,starty,0,1);
		printf("%d\n",mincost);
		return 0;
}