Графы, нахождение наименьшего пути между вершинами обходом в ширину

#include <iostream>
#include <queue>
using namespace std;
 
int main()
{
    int n; //количество вершин
    int s(0); //длина пути
    int a, b; //начало и конец пути
    cin >> n; //считываем количество вершин
    vector<int> used(n, 0); //массив уже пройденных вершин
    vector<int> next(n, -1); //массив восстановления пути
    vector< vector<int> > g(n, vector<int> (n)); //матрица смежности
    for (int i = 0; i < n; ++i)
    for (int j = 0; j < n; ++j)
        cin >> g[i][j]; //считывание матрицы смежности - 1 = ребро, 0 = ребра нет
    cin >> a >> b; //считываем начальную и конечную точки 
    --a; --b; //уменьшаем на единицу для удобности
    bool ok = false; //дошли ли до искомой вершины
    queue<int> q; //очередь для обхода в ширину
    q.push(a); //начальная вершина для обхода
    while (!q.empty() && !ok) //пока не пройдем по всем вершинам или не найдем нужную
    {
        ++s; //увеличиваем путь
        int w = q.front(); //временная переменная, чтобы проще обращаться к нашей текущей вершине
        used[w] = 1; //помечаем нашу вершину посещенной, чтобы не зацикливаться
        for (int i = 0; i < n; ++i)
        {
            if (g[w][i] && !used[i]) //если есть ребро из нашей вершины в i-тую и мы в ней не были
            {
                next[w] = i; //следующая для нашего пути вершина - i-тая
                if (i == b) //если i-тая вершина конечная
                    ok = true; //выход
                else
                    q.push(i); //иначе - обходим и ее тоже
            }
        }
        q.pop(); //удаляем уже пройденную вершину
    }
    if (ok)
    {
        cout << s << endl; //длина пути
        for (int i = a; i != -1; i = next[i])
            cout << i + 1 << ' '; //выводим все вершины в порядке прохождения
        cout << '\n';
    }
    else
        cout << -1 << endl; //если мы так и не дошли до искомой - выводим '-1'
    return 0;
}

#include <iostream>
#include <queue>
using namespace std;
 
int main()
{
    int n;      //количество вершин
    int a, b;  //начало и конец пути
    cin >> n; //считываем количество вершин
    vector<int> next(n, -1);  //массив восстановления пути
    vector<int> used(n, 0);  //массив уже пройденных вершин
    vector<int> dist(n);    //массив длины пути от начальной вершины
    vector< vector<int> > g(n, vector<int> (n)); //матрица смежности
    for (int i = 0; i < n; ++i) //n столбцов матрицы
    for (int j = 0; j < n; ++j) //n строк матрицы
        cin >> g[i][j]; //считывание матрицы смежности - 1 = ребро, 0 = ребра нет
    cin >> a >> b;     //считываем начальную и конечную точки
    --a; --b;         //уменьшаем на единицу для удобности
    bool ok = false; //дошли ли до искомой вершины
    queue<int> q;   //очередь для обхода в ширину
    q.push(a);     //начальная вершина для обхода
    dist[a] = 0;  //длина от начальной до начальной - 0
    while (!q.empty() && !ok) //пока не пройдем по всем вершинам или не найдем нужную
    {
        int w = q.front(); //временная переменная, чтобы проще обращаться к нашей текущей вершине
        used[w] = 1;      //помечаем нашу вершину посещенной, чтобы не зацикливаться
        for (int i = 0; i < n; ++i)
        {
            if (g[w][i] && !used[i]) //если есть ребро из нашей вершины в i-тую и мы в ней не были
            {
                dist[i] = dist[w] + 1; //длина пути до i-той вершины - длина пути текущей вершины + 1
                next[w] = i; //следующая для нашего пути вершина - i-тая
                if (i == b) //если i-тая вершина конечная
                    ok = true; //выход
                else
                    q.push(i); //иначе - обходим и ее тоже
            }
        }
        q.pop(); //удаляем уже пройденную вершину
    }
    if (ok) //если мы вышли, потому что дошли до искомой
    {
        cout << dist[b] << endl;  //длина пути
        for (int i = a; i != -1; i = next[i])
            cout << i + 1 << ' '; //выводим все вершины в порядке прохождения
        cout << '\n';
    }
    else
        cout << -1 << endl; //если мы так и не дошли до искомой - выводим '-1'
    return 0;
}