如何解决最近邻启发式

我正在尝试在一个小例子中解决 tsp 的最近邻启发式问题，该示例具有 2d 数组C++。这是我现在的代码。我想创建起点节点从 0 到 6 的游览，以便我可以在之后比较它们（哪个节点的距离最小）。但是，调试后我有点知道我的问题在哪里，但我不明白为什么它不起作用。我visited[i+1]不是在下一个索引上保存最小的索引。

void getNearestNeighbor(float distanceMatrix[][6], int startNode, int visited[6]){
    bool unvisited[6]{ 1,1,1,1,1,1 };
    visited[0] = { startNode };
    unvisited[startNode] = false;
    for (int i = 0; i < 5; i++)
    {
        float smallestDistance = 100.0;
        int smallestIndex =visited[i];
        for (int j = 0; j < 6; j++)
        {
            if (visited[i] != j && unvisited[j] == true)
            {
                if (smallestDistance > distanceMatrix[visited[i]][j])
                {
                    smallestDistance = distanceMatrix[visited[i]][j];
                    smallestIndex = j;
                }
            }
        }
        visited[i+1] = smallestIndex;
        unvisited[smallestIndex] = false;
        //cout << visited[i] << endl;
    }
}   
int main()
{
    int visited[6]; 
    float distanceMatrix[6][6]{
        { 0, 17, 11, 5.39, 10.8, 8.6 },
        { 17, 0, 10.2, 12.5, 19.1, 25.6 },
        { 11, 10.2, 0, 9.85, 18.8, 19 },
        { 5.39, 12.5, 9.85, 0, 8.94, 13.5 },
        { 10.8, 19.1, 18.8, 8.94, 0, 14 },
        { 8.6, 25.6, 19, 13.5, 14, 0 } };

    for (int srtNode = 0; srtNode < 6; srtNode++)
    {
        getNearestNeighbor(distanceMatrix, srtNode, visited);
        cout << visited[srtNode];
        //calcDistance(distanceMatrix, visited);
    }
    system("pause");
    return EXIT_SUCCESS;
}