写一个C++算法，SPFA最短路径算法

SPFA最短路径算法是一种动态规划算法，用于求解一个图中从源点到其余各点的最短路径。该算法的基本思想是：从源点开始，依次访问当前未访问过的最近邻点，并加以更新距离，直到某个点的最短路径已经确定，再向外扩展，直到所有点都被访问为止。具体实现步骤如下：1. 将源点加入集合Q中；
2. 从Q中取出最近邻点v；
3. 令d[v]为从源点s到点v的最短距离；
4. 更新Q中其他点的最短距离，即 d[w] = min (d[w], d[v]+len[v][w])，其中len[v][w]为从点v到点w的距离；
5. 重复步骤2-4，直到Q为空。