uva10269(最短路)

题目的的意思就是马里奥要回家．

首先给出ａ，ｂ　，　ｍ　，ｌ　，ｋ．

ａ是城镇的数量　标记为　１　--->　ａ；

ｂ是城堡的数量　标记为　ａ　＋  1    --->   a +  b;

m是道路的数量.

现在马里奥在a+b这座城堡里 ,要回到 1;

不过马里奥有一双神奇的鞋子,可以飞快瞬间移动,每次最多移动  l   ,并且必须在是点到点,不能停在路上.

还有一个限制就是,鞋子不能经过城堡.

例如  城镇a - 城镇b - 城镇c 只要距离不超过l就可以用神奇的鞋子从a直接到c

但是 城镇a - 城堡b - 城镇c 就不能a到c因为鞋子飞的过程不能经过城堡,,也就是碰到城堡一定要停.

求马里奥回家最少走多少路.

首先先用floyd求出任意两点间,不经过城堡的最短路径,

用数组 d[u][v]表示到达u点,飞的次数为v的最短路.

然后用sfpa求最短路.

#include<stdio.h>
#include<string.h>
#include<queue>
using namespace std;
const int N = 105;
const int INF = 0x3f3f3f3f ;
int d[N][N];
int g[N][N];
int p[N];
int vis[N][N];
int a,b,m,l,k;
int spfa(int s) {
    queue<int> q1;
	queue<int> q2;
    memset(vis , 0 ,sizeof(vis));  
    for(int i = 1; i <= a + b; i++)   
        for (int j = 0 ; j <= k ;j++){
			d[i][j] = INF;
		}
	for (int i = 0 ; i <= k ;i++)
		d[a + b][i] = 0;
    q1.push(s);
	q2.push(k);
    while(!q1.empty()){
        int u = q1.front(); q1.pop();
		int v = q2.front(); q2.pop();
		vis[u][v] = 0;
        for(int i = 1; i <= a + b; i++) {  
            if(d[i][v] > d[u][v] + g[u][i]) {  
                d[i][v] = d[u][v] + g[u][i];  
                if(!vis[i][v]) {  
                    vis[i][v] = 1;  
                    q1.push(i);
					q2.push(v);	
                }
            }
			if(g[u][i] <= l && v > 0 && d[i][v - 1] > d[u][v]) {
				d[i][v - 1] = d[u][v];
				if(!vis[i][v - 1]) {
					vis[i][v - 1] = 1;
					q1.push(i);
					q2.push(v - 1);

				}
			}
        }
    }
}

void floyd() {
	for (int k = 1; k <= a; k++)
		for (int i = 1; i <= a + b; i++)
			for (int j = 1; j <= a + b; j++) {
				g[i][j] = g[i][j] <  g[i][k] + g[k][j] ? g[i][j] : g[i][k] + g[k][j];
			}
}
int main() {
	int t;
	int t1,t2,t3;
	scanf("%d",&t);
	while(t--) {
		memset(g, INF ,sizeof(g));
		scanf("%d%d%d%d%d",&a,&b,&m,&l,&k);
		for (int i = 0 ; i < m ;i++) {
			scanf("%d%d%d",&t1,&t2,&t3);
			g[t1][t2] = g[t2][t1] = t3;
		}
		floyd();
		spfa(a + b);
		int mm = INF;
		for (int i = 0 ; i <= k ;i++) {
			if(d[1][i] < mm)
				mm = d[1][i];
		}
		printf("%d\n",mm);
	}
}