Волновой алгоритм Ли

#include <iostream>
#include <vector>
#include <set>
using namespace std;

#define n 6

int G[6][6]{
{0, 1, 1, 0, 0, 0},
{1, 0, 1, 1, 0, 0},
{1, 1, 0, 1, 1, 0},
{0, 1, 1, 0, 1, 1},
{0, 0, 1, 1, 0, 1},
{0, 0, 0, 1, 1, 0}
};

void Lee(int S, int F) {
    S--;
    F--;
    int length, wawe[n];
    vector<int> NewFront, OldFront;
    for (int i = 0; i < n; i++)
        wawe[i] = -1;

    wawe[S] = 0;
    cout << "Wawe: " << endl;
    for (int k = 0; k < n; k++) {
        cout << wawe[k] << " ";
    }
    cout << endl;
    OldFront.push_back(S);
    cout << "NewFront: {} " << endl;
    cout << "OldFront: " <<S+1<< endl; 
    length = 0;
    cout << "Length " << length<<endl<<endl;
    while (true) {
        for (int i = 0; i < OldFront.size(); i++) {
            for (int j = 0; j < n; j++) {
                if (G[OldFront[i]][j] == 1&&wawe[j]) {
                    if (wawe[j] == -1) {
                        if (j == F) { 
                            wawe[j]++;
                            NewFront.push_back(j);
                            break; 
                        }
                       
                        wawe[j]++;
                    }
                       
                    NewFront.push_back(j);
                }
            }
        }
        cout << "Wawe: " << endl;
        for (int k = 0;k<n; k++) {
            cout <<wawe[k]<<" ";
        }
        cout << endl;
        cout << "NewFront: " << endl;
        for (int k = 0; k < NewFront.size(); k++) {
           cout << NewFront[k]+1 << " ";
        }
        cout << endl;
        cout << "OldFront: " << endl;
        for (int k = 0; k < OldFront.size(); k++) {
            cout << OldFront[k]+1 << " ";
        }
        cout << endl;
        cout << "length " << length+1 << endl;
        cout << endl;
        if (NewFront.empty()) {
            cout << "Нет пути";
            break;
        }
        for (int m = 0; m < NewFront.size(); m++) {
            if (NewFront[m] == F) {
                cout <<endl<< "Путь найден" << endl;
                for (int d = F; d >= 0; d--) {
                    for (int j = 0; j < n; j++) {
                        if (G[d][j] && wawe[d] - wawe[d - 1] == 1) cout << d+1 << " ";
                    }
                }
cout <<"Длина пути: "<<length+1;
                return;
            }
        }
        OldFront = NewFront;
        NewFront = {};
        length++;
    }

}

int main()
{
    setlocale(LC_ALL, "Russian");
    Lee(1, 6);
    
}

Пытаюсь написать алгоритм ли в соответствии с википедией. Но я не понимаю,как восстановить путь. Длина у меня выводится,а путь без понятия как вывести. И вообще возможно ли вывести не только один кратчайший путь,но и все возможные кратчайшие пути(их 3 в моем графе).