Поиск в ширину на графе

#include "stdafx.h"
#include "stdafx.h"
#include <iostream>
#include <conio.h>
#include<vector>
#include<queue>
using namespace std;
int main()
{
vector < vector<int> > g; // граф
int n=4; // число вершин
int s=0; // стартовая вершина (вершины везде нумеруются с нуля)
g[0][0]=0;
g[0][1]=1;
g[0][2]=1;
g[0][3]=0;
g[1][0]=1;
g[1][1]=0;
g[1][2]=0;
g[1][3]=0;
g[2][0]=1;
g[2][1]=0;
g[2][2]=0;
g[2][3]=1;
g[3][0]=0;
g[3][1]=0;
g[3][2]=1;
g[3][3]=0;
queue<int> q;
q.push (s);
vector<bool> used (n, false);
vector<int> d (n), p (n);
used[s] = true;
p[s] = -1;
while (!q.empty()) 
{
    int v = q.front();
    q.pop();
    for (size_t i=0; i<g[v].size(); ++i) 
    {
        int to = g[v][i];
        if (!used[to]) 
        {
            used[to] = true;
            q.push (to);
            d[to] = d[v] + 1;
            p[to] = v;
        }
    }
}
int to = 2;
if (!used[to])
    cout << "Нет!";
else {
    vector<int> path;
    for (int v=to; v!=-1; v=p[v])
        path.push_back (v);
    reverse (path.begin(), path.end());
    cout << "Путь: ";
    for (size_t i=0; i<path.size(); ++i)
        cout << path[i] + 1 << " ";
}
}

int n = 4;
vector< vector<int> > g(n, vector<int>(n));