Iskanje v sirino [c++] problem

V soli smo dobli da mormo iz psevdo kode napisat program (Iskanje v sirino).Rabo bi pomoc kako dolociti posameznim elementov dolzino. Spodaj imam napisano kodo, in se mi zdi da dela vse vredi, le pri dolocanju dolzine nevem kaksne argumente bi moral napisat. Vsaka pomoc zazeljena Lp

void iskanje_v_sirino(sosednost polje[20][20],int d,int s)
{

 for( int i=0; i=0;i<d;i++)
 {
    if(polje[s][i].vrednost==1 )
    {
      polje[s][i].dolzina=0;
      polje[s][i].barva=0;
      polje[s][i].predhodnik=-1;    
      q.push(s);
      break;
    }
 }
     
    int v;
     do{
       v=q.front();
       q.pop();  
        int i=0;      
        for( ;i<d;i++)
        {
           if(polje[v][i].vrednost==1 )
           {
              if(polje[v][i].barva==0)
              {
  
                  polje[v][i].barva=1;   
                  polje[v][i].dolzina=polje[][].dolzina+1; //problem ? ? ?
                  polje[v][i].predhodnik=v;
                  
                  q.push(i);

              }
               polje[v][i].barva=2;
           }
        }
      }while(!(q.empty()));
}