最短路径dijkstra算法及其优先队列的优化

最短路径问题：对任意给出的图G(V,E)和起点S，终点T，如何求从S到T的最短路径。解决最短路径问题的算法有Dijkstra算法，Bellman-Ford算法，SPFA算法和Floyd算法。

Dijkstra算法描述

主要用于解决单源最短路径问题，即给定图G(V,E)和起点s，通过算法得到S到达其他每个顶点的最短距离。

算法步骤：设置集合S存放已被访问的顶点，然后执行n次下面的每个步骤(n为顶点个数)

（1）每次从集合V-S（未被访问的顶点）中选择与起点S的最短距离最小的一个顶点记为u，访问并加入集合s

（2）之后，令顶点u为中介点，优化起点S与所有从u可以到达的顶点v之间的最短距离。

集合S可以用一个布尔型数组来实现，当vis[i]==true时表示顶点vi已被访问。

令int型数组d[]表示从起点到任意顶点的最短距离，初始时给起点s的d[s]赋值为0，其余为很大的值，可以用二进制编码的十六进制0x3fffffff来表示inf，即不可到达。

伪代码实现

Dijkstra(G,d[],s)
{
    初始化；
    for(循环n次)
    {
        u=使d[u]最小的还未被访问过的顶点的标号；
        记u已被访问；
        for(从u出发能到达的所有顶点v)
        {
            if(v未被访问&&以u为中介点使s到顶点v的最短距离最优)
            {
                优化d[v];
            }
        }
    }
}

邻接矩阵代码实现(适用于点数不超过1000)

const int maxn=1000;
const int INF=0x3fffffff;

int n,G[maxn][maxn];
int d[maxn];
bool vis[maxn]={false};

void Dijkstra(int s)
{
    fill(d,d+maxn,INF);
    d[s]=0;
    for(int i=0;i<n;i++)
    {
        int u=-1,MIN=INF;
        for(int j=0;j<n;j++)
        {
            if(vis[j]==false&&d[j]<MIN)
            {
                u=j;
                MIN=d[j];
            }
        }
        if(u==-1) retunr;  //找不到小于INF的d[u]，说明剩下的点和起点s不连通
        vis[u]=true;
        f