spaf算法求最短路径

# include <iostream>
# include <queue>
using namespace std;
#define N 7
int g[7][7] = {
{0,24,8,15,-1,-1,-1},
{24,0,-1,-1,6,-1,3},
{8,-1,0,-1,7,3,-1},
{15,-1,-1,0,-1,-1,4},
{-1,6,7,-1,0,2,9},
{-1,-1,3,-1,2,0,3},
{-1,3,-1,4,9,3,0}
};
int dis[N]={0}; //保存到个点的最短距离
bool is[N];  //判断节点是否在队列中
void spaf(int w)
{
    memset(is,false,sizeof(is));  //初始化
    memset(dis,-1,sizeof(dis)); //初始化
    queue<int> queue;
    queue.push(w); //w点入队列  最后的结果就是w点到其他各点的最短距离
    dis[w] = 0; 
    is[w] = true;
    while(!queue.empty())
    {
        int x = queue.front();  //出队列  把x作为起点
        is[x] = false;  
        queue.pop();
        for(int i = 0;i<N;i++)
        {
            if(g[x][i] != -1) //如果 x点到i的是通的
            {
                if(dis[i] == -1 || dis[x] + g[x][i] <dis[i]) //如果原来的起点到i点不通 或者 以x点作为起点是距离更小
                {
                    dis[i] = dis[x] + g[x][i];  //刷新最短路径
                    if(is[i] == false) //如果此时i点还不在队列里
                    {
                        queue.push(i); //i点入队
                        is[i] = true;
                    }
                }
            }
        }
    }

}
int main()
{
    spaf(0);
    for(int i =0;i<N;i++)
    {
        printf("%d ",dis[i]);
    }
    return 0;
}