队列SPFA

这几天对队列有着很强的兴趣，现在我终于知道为什么这么多人热衷于SPFA了，这个算法真有很大的魅力，我也被迷住了（02哈哈）

我想说一下我对于SPFA的认识，首先SPFA可以处理负权边，这是其他的算法所办不到的，当然不能处理负环图，所有的算法都不可以处理这种图，因为这种图根本没有最短路。

SPFA感觉接近暴力的一种做法，它的复杂度也是不确定的，最高可以卡成 N*M（这不是暴力是什么！），可以将算法想象成遍历一颗搜索树，SPFA的搜索路径对应着其走过的点，其走过的点在同一条路径中不可能走两次，否则就形成的负环，当其扩展出来的点的权值并不能更新时，那么我们就放弃这种做法，因为在继续扩展下去也没有意义。我们可以将SPFA每一次从队列里走出来的点都可以当成最优点，但是这只是可能是最优点，当每次“最优点被更新时”我们只能再次的将新的最优点的权值加进队列，此时如果队列维护的只是一个距离状态，那么我们就可以更新，如果维护的状态跟路径有关，那么需要注意下。

附上一道例题：
问题描述
　　目前在一个很大的平面房间里有 n 个无线路由器,每个无线路由器都固定在某个点上。任何两个无线路由器只要距离不超过 r 就能互相建立网络连接。
　　除此以外,另有 m 个可以摆放无线路由器的位置。你可以在这些位置中选择至多 k 个增设新的路由器。
　　你的目标是使得第 1 个路由器和第 2 个路由器之间的网络连接经过尽量少的中转路由器。请问在最优方案下中转路由器的最少个数是多少?
输入格式
　　第一行包含四个正整数 n,m,k,r。(2 ≤ n ≤ 100,1 ≤ k ≤ m ≤ 100, 1 ≤ r ≤ 108)。
　　接下来 n 行,每行包含两个整数 xi 和 yi,表示一个已经放置好的无线 路由器在 (xi, yi) 点处。输入数据保证第 1 和第 2 个路由器在仅有这 n 个路由器的情况下已经可以互相连接(经过一系列的中转路由器)。
　　接下来 m 行,每行包含两个整数 xi 和 yi,表示 (xi, yi) 点处可以增设 一个路由器。
　　输入中所有的坐标的绝对值不超过 108,保证输入中的坐标各不相同。
输出格式
　　输出只有一个数,即在指定的位置中增设 k 个路由器后,从第 1 个路 由器到第 2 个路由器最少经过的中转路由器的个数。

#include <iostream>
#include <cstring>
#include <queue>

using namespace std;

const int N = 210, INF = 0x3f3f3f3f;

typedef pair<int, int> PII;

typedef long long LL;

int map[N][N], n, m, k, r;

PII edgs[N];

bool vis[N][N];

int distances[N][N];

void SPFA()
{
	memset(distances, 0x3f, sizeof distances);
	queue<PII> q;
	distances [0][0] = 0;
	q.push({ 0, 0 });
	vis[0][0] = true;
	while (q.size())
	{
		PII t = q.front();
		q.pop();
		int point = t.first, dis = t.second;

		vis[point][dis] = false;
		for (int i = 0; i < n + m; i++)
		{
			if (dis + (i >= n) > k) continue;
			if (map[point][i] != 0 && distances[i][dis + (i >= n)] > distances[point][dis] + map[point][i])
			{
				distances[i][dis + (i >= n)] = distances [point][dis] + map[point][i];
				if (!vis[i][dis + (i >= n)])
				{
					q.push({ i, dis + (i >= n) });
					vis[i][dis + (i >= n)] = true;
				}

			}
		}


	}

	return;
}

int main()
{
	scanf("%d %d%d%d", &n, &m, &k, &r);
	for (int i = 0; i < n + m; i++)
	{
		int x, y;
		scanf("%d %d", &x, &y);
		edgs[i] = { x, y };
	}
	for (int i = 0; i < n + m; i++)
	{
		map[i][i] = 0;
		for (int j = i + 1; j < n + m; j++)
		{
		    if (((LL)edgs[i].first - edgs[j].first) * ((LL)edgs[i].first  - edgs[j].first) + ((LL)edgs[i].second - edgs[j].second) * ((LL)edgs[i].second - edgs[j].second) <= (LL)r * r)
			{
				map[i][j] = map[j][i] = 1;
			}
		}
		
	}
	SPFA();
	int res = INF;
	for (int i = 0; i <= k; i++)
	{
		res = min(res, distances[1][i]);
	}
	printf("%d", res - 1);
	return 0;
}