Алгоритм Прима, нахождение МОД Опции

[Andrewshkovskii]

Давно не виделись..всем привет! вот код неправильно работающего алгоритма Прима ( http://www.software.unn.ac.ru/cluster/cgi-...work=10&topic=1 ). Помогите найти ошибку, он не правильно считает минимальное остовное дерево (мод http://ru.wikipedia.org/wiki/Остовное_дерево ).
Код строго на с++. МОД необходимо представлять ввиде матрицы.
Уже не знаю что делать, глаза ошибки не могут найти..

int dm[matrixSize][matrixSize];//матрица смежности графа
 int sm[matrixSize][matrixSize];//матрица МОД
 int used[matrixSize];//использованные вершины
 int count=0;
 int min ;
 
 for (int i=0; i< matrixSize; ++i)
  {
   used[i]=0;
    for(int j=0;j< matrixSize;++j)
       sm[i][j]=0;
  }
 
 used[0]=1;
 do {
     min=std::numeric_limits<int>::max();
     for(int i=0;i<matrixSize;++i)
     {
        if (used[i]!=0)
         {
            for(int j=0;j<matrixSize;++j)
                if ( (dm[j][i] < min) && (dm[j][i]!=0) && (used[j])==0)
                    min=dm[j][i];
          }
     }
 for(int i=0;i < matrixSize;++i)
   for(int j=0;j<matrixSize;++j)
        if( (dm[j][i]== min) && (used[j]==0))
            {
                used[j] =1;
                sm[j][i]= sm[i][j] = min;
                count++;
                i=matrixSize;
                break;
            }
       }while(count  < matrixSize-1);