Нужна помощь с реализацией алгоритма Габова для нахождения кратчайших путей с помощью масштабирования

Нужна помощь с написанием программы на С++, а именно алгоритма Габова нахождения кратчайших путей с помощью масштабирования. Вся сложность в том, что на русском языке информации про этот алгоритм очень мало(Кормен, Алгоритмы: построение и анализ, изд.3, с 718 - единственное упоминание). Пробовал искать на англоязычных сайтах, нашёл псевдокод, но с реализацией проблема.Ссылка на сайт с псевдокодом - https://pdfs.semanticscholar.org/b4db/ebb43dbe4fd261a32f80f86f2f98b246a2eb.pdf

Вот мой нерабочий код, сделанный с псевдокода:

#include <cstdio>
#include <cstring>
#include <queue>
#include <iostream>
#include <cmath>
#include <vector>
#include<functional>
#include <fstream>
using namespace std;
int n;
int maxW(int** g)
{
    int max = g[0][0];
    for (int i = 0; i < n; i++)
    {
        for (int j = 0; j < n; j++)
        {
            if (g[i][j] > max)
            {
                max = g[i][j];
            }
        }
    }
    return max;
}
void Gabow(int s, int** G)
{
    vector <int> dist(n,INT_MAX);
    int w = log2(maxW(G));
    priority_queue <int, vector <int>, greater <int> > q;
    dist[s] = 0;
    q.push(dist[s]);
    while (!q.empty())
    {
        int u = q.top();
        q.pop();
        for (int i = 0; i < n; i++)
        {
            for (int j = 0; j < n; j++)
            {
                if (G[i][j] != 0)
                {
                    int wi = G[i][j] >> w;
                    if (dist[j] > u + wi)
                    {
                        dist[j] = u + wi;
                        q.push(dist[j]);
                    }
                }
            }
        }
    }
    while (w > 0)
    {
        w--;
        vector <int> extradist(n, INT_MAX);
        extradist[s] = 0;
        priority_queue <pair<int,int>,vector<pair<int,int>>,greater<pair<int,int>> > q;
        q.push(make_pair(extradist[s],dist[s]));
        while (!q.empty())
        {
            pair<int,int> u = q.top();
            q.pop();
            for (int i = 0; i < n; i++)
            {
                for (int j = 0; j < n; j++)
                {
                    if (G[i][j] != 0)
                    {
                        int wi = G[i][j] >> w;
                        int l = wi + 2 * (u.second - dist[j]);
                        if (extradist[j] > u.first + l)
                        {
                            extradist[j] = u.first + l;
                            q.push(make_pair(extradist[j],dist[j]));
                        }
                    }
                }
            }
        }
        for (int i = 0; i < n; i++)
        {
            if (dist[i] < INT_MAX)
            {
                dist[i] = 2 * dist[i] + extradist[i];
            }
        }
    }
    for (int i = 0; i < n; i++)
    {
        cout << dist[i] << " ";
    }
}
int main()
{
    ifstream infile("graph.txt");
    infile >> n;
    int** mas = new int*[n];
    for (int i = 0; i < n; i++)
    {
        mas[i] = new int[n];
    }
    for (int i = 0; i < n; i++)
    {
        for (int j = 0; j < n; j++)
        {
            infile >> mas[i][j];
        }
    }
    int start = 0;
    Gabow(start,mas);
    infile.close();
    for (int i = 0; i < n; i++)
    {
        delete[]mas[i];
    }
    delete[]mas;
    return 0;
}

Пример входных данных (матрица смежности):

4
0 2 0 0
0 0 1 9
6 0 0 3 
0 0 0 0

Вывод алгоритма: 0 2 1 3
Правильный вывод: 0 3 4 7