Блог

Когда мне был задан некоторый псевдокод, меня попросили запрограммировать алгоритм поиска A * на C . Я запрограммировал алгоритм, и он успешно компилируется, но я не получаю результат, который мне нужно получить, чтобы знать, что мой алгоритм работает правильно. И теперь я пару дней боролся, пытаясь выяснить проблемы в моем программировании.

Не мог бы кто-нибудь любезно просмотреть мой текущий код и дать мне несколько советов и указаний о том, где я должен искать, чтобы исправить свой код? Или указать мне правильное направление?

Спасибо миллион, если вы решите мне помочь! Я был бы очень признателен.

Инструкции по назначению, если необходимо

НЕКОТОРЫЕ ПРИМЕЧАНИЯ: я заменил открытые и закрытые векторы int на открытые и закрытые векторы bool. Просто к вашему сведению, если вы сравните инструкции с моим текущим кодом. Кроме того, операторы «cout << » TEST 1 » << endl; // delete» были просто моей попыткой проверить, действительно ли выполняется весь цикл и функция while. Еще раз спасибо, если вы решите мне помочь.

 double ASTARSearch()
{

    const int nodesAmt = 8;
    char labels[nodesAmt] = {'S', 'A', 'B', 'C', 'D', 'E', 'F', 'G'};
    
    double distanceMatrix[nodesAmt][nodesAmt] =
    {
        { INT_MAX, 3, INT_MAX, INT_MAX, 4, INT_MAX, INT_MAX, INT_MAX         },
        { 3, INT_MAX, 4, INT_MAX, 5, INT_MAX, INT_MAX, INT_MAX               },
        { INT_MAX, 4, INT_MAX, 4, INT_MAX, 5, INT_MAX, INT_MAX               },
        { INT_MAX, INT_MAX, 4, INT_MAX, INT_MAX, INT_MAX, 5, 1.4             },
        { 4, 5, INT_MAX, INT_MAX, INT_MAX, 2, INT_MAX, INT_MAX               },
        { INT_MAX, INT_MAX, 5, INT_MAX, 2, INT_MAX, 4, INT_MAX               },
        { INT_MAX, INT_MAX, INT_MAX, 5, INT_MAX, 4, INT_MAX, INT_MAX         },
        { INT_MAX, INT_MAX, INT_MAX, 1.4, INT_MAX, INT_MAX, INT_MAX, INT_MAX }
    };
    
    double heuristicCosts[nodesAmt] = {10, 10, 6, 1.4, 9, 7, 2, 0};
    
    vector<bool> open(nodesAmt);
    vector<bool> closed(nodesAmt);
    vector<int> gScore(nodesAmt, INT_MAX);
    vector<int> fScore(nodesAmt, INT_MAX);
    
    int cameFrom[nodesAmt];
    
    const int START = 0;
    
    open.at(START) = true;
    
    gScore[START] = 0;
    
    fScore[START] = heuristicCosts[START];
    
    cout << " TEST 1 " << endl; // delete
    
    bool empty = false;
    
    while (empty == false)
    {
        int minDist = INFINITY, current = 0;
        
        for (int i = 0; i < nodesAmt; i  )
        {
            if (open[i] == true)
            {
                if (fScore.at(i) < minDist)
                {
                    minDist = fScore.at(i);
                    current = i;
                }
            }
        }
        
        cout << " TEST 2 " << endl; // delete

        
        if (current == (nodesAmt - 1)) // all part 3 stuff
        {
            int to = nodesAmt - 1;
            int from = cameFrom[to];
            
            while (true)
            {
                cout << labels[from] << " -> " << labels[to] << endl;
                
                if (from == START)
                {
                    break;
                }
                
                to = from;
                from = cameFrom[to];
            }
            
            return 0;
        }
        
        cout << " TEST 3 " << endl; // delete

        
        open[current] = false;
        closed[current] = true;
        
        double neighbors[nodesAmt];
        
        for (int i = 0; i < nodesAmt; i  )
        {
            neighbors[i] = distanceMatrix[current][i];
        }
        
        for (int i = 0; i < nodesAmt; i  )
        {
            if (neighbors[i] == INT_MAX)
            {
                continue;
            }
            
            int g = gScore[current]   neighbors[i];
            int f = g   heuristicCosts[i];
            
            if (open[i] == false)
            {
                open[i] = true;
            }
            else if (open[i] == true amp;amp; f >= fScore[i])
            {
                continue;
            }
            else if (open[i] == true amp;amp; f < fScore[i])
            {
                cameFrom[i] = current;
                gScore[i] = g;
                fScore[i] = gScore[i]   heuristicCosts[i];
            }
            else if (closed[i] == true amp;amp; f < fScore[i])
            {
                closed[i] = false;
                open[i] = true;
            }
            else
            {
                
            }
        }
        
        cout << " TEST 4 " << endl; // delete
        
        for (int i = 0; i < nodesAmt; i  )
        {
            int tally = 0;
            if (open[i] == false)
            {
                tally  ;
            }
        
            if (tally == 8)
            {
                empty = true;
            }
            cout << " TEST 6 " << endl; // delete

        }

    }
    
    cout << " TEST 5 " << endl; // delete

    return 0;
}