Parallel Dijkstra

Ich bin mit OpenMP zu machen, parallele version des Dijkstra-Algorithmus. Mein code besteht aus zwei teilen. Erste Teil ist die Ausführung durch einen thread (master). Dieser thread wählt neuen Knoten aus der Liste. Der zweite Teil ist die Ausführung von anderen threads. Diese threads ändern Entfernungen von Quelle zu anderen Knoten. Leider in meinem code ist Fehler, weil eine von vielen threads das ausführen der zweiten Teil plötzlich "verschwinden". Wahrscheinlich gibt es ein problem mit der Datensynchronisation, aber ich weiß nicht wo. Ich wäre dankbar, wenn jemand mir sagen könnte, wo liegt mein Fehler. Hier ist der code:

map<int, int> C;
map<int, int> S;
map<int, int> D;
int init;
int nu;
int u;
int p = 3;//omp_get_num_threads();
int d;
int n = graph->getNodesNum();

#pragma omp parallel shared(n, C, d, S, init, nu, u, D, graph, p) num_threads(p)
{
    int myId = omp_get_thread_num();
    if (myId == 0)
    {
        init = 0;
        nu = 0;

        u = to;
        while (init < p - 1)
        {
        }

        while (u != 0)
        {
            S[u] = 1;
            while (nu < p - 1)
            {
            }
            u = 0;
            d = INFINITY;
            for (int i = 1; i <= p - 1; ++i)
            {
                int j = C[i];
                if ((j != 0) && (D[j] < d))
                {
                    d = D[j];
                    u = j;
                }
            }
            nu = 0; 
        }
    }
    else
    {
        for (int i=myId; i<=n; i += p-1)
        {
            D[i] = INFINITY;
            S[i] = 0;
        }

        D[u] = 0;

        ++init; 
        while (init < p-1)
        {
        }
        while (u != 0)
        {
            C[myId] = 0;
            int d = INFINITY;

            for (int i = myId; i<=n; i+=p-1)
            {
                if (S[i] == 0)
                {
                    if (i != u)
                    {
                        int cost = graph->getCostBetween(u, i);
                        if (cost != INFINITY)
                        {
                            D[i] = min(D[i], D[u] + cost);
                        }
                    }
                    if ((d > D[i])) 
                    {                           
                        d = D[i];
                        C[myId] = i;
                    }
                }
            }
            ++nu;
            while (nu != 0)
            {
            }   
        }
    }       
}

}