皮卡丘逃亡

【简要题意】跨越空地代价为1，跨越障碍代价为5，求从(x1,y1)到(x2,y2)的最小代价。
网格图的长宽均小于500.

【分析】spfa水过。。。。数据范围非常小所以用$\Theta (n\ast m)$卡掉也无所谓。

【code】

#include<queue>
#include<cstdio>
#include<cstring>
#include<iostream>
#include<algorithm>
using namespace std;
const int maxn=510;
int dist[maxn][maxn],g[maxn][maxn];
int n,m,T;
inline void read(int &x){
	x=0;int fl=1;char tmp=getchar();
	while(tmp<'0'||tmp>'9'){if(tmp=='-')fl=-fl;tmp=getchar();}
	while(tmp>='0'&&tmp<='9') x=(x<<1)+(x<<3)+tmp-'0',tmp=getchar();
	x=x*fl;
}
struct node{int x,y;};
int data[4][2]={{1,0},{-1,0},{0,1},{0,-1}};
void spfa(int x,int y){
	queue<node>q;
	q.push((node){x,y});
	while(!q.empty()){
		node u=q.front(),v;q.pop();
		for(int i=0;i<4;i++){
			v.x=u.x+data[i][0],v.y=u.y+data[i][1];
			if(v.x<1||v.y<1||v.x>n||v.y>m) continue;
			if(g[v.x][v.y]==1){
				if(dist[v.x][v.y]<dist[u.x][u.y]-5)
					dist[v.x][v.y]=dist[u.x][u.y]-5,q.push(v);
			}
			else{
				if(dist[v.x][v.y]<dist[u.x][u.y]-1)
					dist[v.x][v.y]=dist[u.x][u.y]-1,q.push(v);
			}
		}
	}
}
int main(){
	freopen("pikaqiu.in","r",stdin);
	freopen("pikaqiu.out","w",stdout);
	cin>>T>>n>>m;
	memset(dist,-1,sizeof(dist));
	for(int i=1;i<=n;i++)
		for(int j=1;j<=m;j++) read(g[i][j]);
	for(int i=1;i<=n;i++)
		for(int j=1;j<=m;j++)
			if(g[i][j]==5)dist[i][j]=T,spfa(i,j);
	for(int i=1;i<=n;i++)
		for(int j=1;j<=m;j++){
			if(g[i][j]==9) cout<<dist[i][j]<<endl;
		}
	return 0;
}