Roadblocks问题(dijkstra算法)

代码：《挑战程序设计竞赛》2.5.6

#include<iostream>
#include<vector>
#include <queue>
#include<algorithm>
using namespace std;
int N, R;
#define MAX_N 100
#define INF 1000
class edge
{
public:
	int to, from, cost;
	edge()
	{
		this->to = 0;
		this->from = 0;
		this->cost = 0;
	}

};
typedef pair<int, int> P; //first是最短距离， second是编号

vector<edge> G[MAX_N];  //创建无向图的邻接表
int dist[MAX_N];  //记录最短距离
int dist2[MAX_N];  //记录次短距离
int N, R;  //N为顶点个数
void solve()
{
	priority_queue<P, vector<P>, greater<P> > que;
	fill(dist, dist + N, INF);
	fill(dist2, dist2 + N, INF);   //初始化
	dist[0] = 0;
	que.push(P(0, 0));

	while (!que.empty())
	{
		P p = que.top();  //记录值最小的编号点
		que.pop();   
		int v = p.second, d = p.first;  //记录下编号，距离
		if (dist2[v] < d) continue;  //如果到点v的次短距离小于最短距离，跳过此轮循环
		for (int i = 0; i < G[v].size(); i++)
		{
			edge& e = G[v][i];  //记录下点v指向 v指向的第i个点的路径
			int d2 = d + e.cost;  //v点距离加上该条路径的距离
			if (dist[e.to] > d2)  //如果该边指向的点的当前距离 大于 v点距离加上该条路径的距离
			{
				swap(dist[e.to], d2);  //更新该点的距离值， 并将d2变为原来的最短路径值
				que.push(P(dist[e.to], e.to));  //将成功更新的点压入队列
			}
			if (dist2[e.to] > d2&& dist[e.to] < d2) //如果到该点的当前次短距离 大于d2且 当前最短距离小于d2
			{
				dist2[e.to] = d2;   //更新次短距离
				que.push(P(dist2[e.to], e.to));  //压入队列
			}
		}
		cout << dist2[N - 1] << endl;

	}



}



int main()
{
	//初始化图，并调用函数

	return 0;
}