查找相邻节点 星形寻路C++

Find Adjacent Nodes A Star Path-Finding C++

本文关键字:寻路 C++ 节点 查找      更新时间:2023-10-16

有没有更好的方法来处理我的 A Star 算法的 FindAdjacent() 函数?它非常混乱,并且没有正确设置父节点。当它尝试查找路径时,它会无限循环,因为节点的父节点具有节点的 pent,并且父节点始终彼此。

任何帮助都会很棒。这是我的函数:

void AStarImpl::FindAdjacent(Node* pNode)
{
    for (int i = -1; i <= 1; i++)
    {
        for (int j = -1; j <= 1; j++)
        {
            if (pNode->mX != Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mX 
                || pNode->mY != Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mY)
            {
                if (pNode->mX + i <= 14 && pNode->mY + j <= 14)
                {
                    if (pNode->mX + i >= 0 && pNode->mY + j >= 0)
                    {
                        if (Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mTypeID != NODE_TYPE_SOLID)
                        {
                            if (find(mOpenList.begin(), mOpenList.end(), &Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j]) == mOpenList.end())
                            {
                                Map::GetInstance()->mMap[pNode->mX+i][pNode->mY+j].mParent = &Map::GetInstance()->mMap[pNode->mX][pNode->mY];
                                mOpenList.push_back(&Map::GetInstance()->mMap[pNode->mX+i][pNode->mY+j]);
                            }
                        }
                    }
                }
            }
        }
    }
    mClosedList.push_back(&Map::GetInstance()->mMap[pNode->mX][pNode->mY]);
}

如果你想要更多的代码,只要问,我可以发布它。

您可以使用 continue 来减少嵌套 if 的数量。一般来说,以下两个代码块是等效的:

while(conditionA){
    if(conditionB){
        doStuff();
    }
}
while(conditionA){
    if (!conditionB){continue;}
    doStuff();
}

我们可以使用此原则来减少代码中嵌套 if 的数量。

void AStarImpl::FindAdjacent(Node* pNode)
{
    for (int i = -1; i <= 1; i++)
    {
        for (int j = -1; j <= 1; j++)
        {
            if (pNode->mX == Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mX && pNode->mY == Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mY){continue;}
            if (pNode->mX + i > 14 || pNode->mY + j > 14){continue;}
            if (pNode->mX + i < 0 || pNode->mY + j < 0){continue;}
            if (Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mTypeID == NODE_TYPE_SOLID){continue;}
            if (find(mOpenList.begin(), mOpenList.end(), &Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j]) != mOpenList.end()){continue;}
            Map::GetInstance()->mMap[pNode->mX+i][pNode->mY+j].mParent = &Map::GetInstance()->mMap[pNode->mX][pNode->mY];
            mOpenList.push_back(&Map::GetInstance()->mMap[pNode->mX+i][pNode->mY+j]);
        }
    }
    mClosedList.push_back(&Map::GetInstance()->mMap[pNode->mX][pNode->mY]);
}

如果我正确理解了你的第一个if条件,你只是试图断言pNode不是它自己的邻居。在这种情况下,您可以将代码更改为:

void AStarImpl::FindAdjacent(Node* pNode)
{
    for (int i = -1; i <= 1; i++)
    {
        for (int j = -1; j <= 1; j++)
        {
            if (i == 0 && j == 0){continue;}
            if (pNode->mX + i > 14 || pNode->mY + j > 14){continue;}
            if (pNode->mX + i < 0 || pNode->mY + j < 0){continue;}
            if (Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mTypeID == NODE_TYPE_SOLID){continue;}
            if (find(mOpenList.begin(), mOpenList.end(), &Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j]) != mOpenList.end()){continue;}
            Map::GetInstance()->mMap[pNode->mX+i][pNode->mY+j].mParent = &Map::GetInstance()->mMap[pNode->mX][pNode->mY];
            mOpenList.push_back(&Map::GetInstance()->mMap[pNode->mX+i][pNode->mY+j]);
        }
    }
    mClosedList.push_back(&Map::GetInstance()->mMap[pNode->mX][pNode->mY]);
}

理想情况下,FindAdjacent 方法根本不需要修改开放集或封闭集。 相反,让它返回所有邻居,无论它们是打开的还是关闭的。如果要将这些邻居添加到打开或封闭的集合中,或者检查它们是否是这些集合的成员,则应在实际实现 aStar 算法的方法中完成。

Vector<Node> AStarImpl:FindAdjacent(Node* pNode)
{
    Vector<Node> neighbors;
    for (int i = -1; i <= 1; i++)
    {
        for (int j = -1; j <= 1; j++)
        {
            if (i == 0 && j == 0){continue;}
            if (pNode->mX + i > 14 || pNode->mY + j > 14){continue;}
            if (pNode->mX + i < 0 || pNode->mY + j < 0){continue;}
            if (Map::GetInstance()->mMap[pNode->mX + i][pNode->mY + j].mTypeID == NODE_TYPE_SOLID){continue;}
            neighbors.push_back(Map::GetInstance()->mMap[pNode->mX+i][pNode->mY+j]);
        }
    }
    return neighbors;
}

多次执行一些相同的操作。您可以通过将这些操作的结果存储在变量中来使您的意图更加清晰。这样做不会使代码更短,但可能会使其更具可读性。

Vector<Node> AStarImpl:FindAdjacent(Node* pNode)
{
    Vector<Node> neighbors;
    for (int i = -1; i <= 1; i++)
    {
        for (int j = -1; j <= 1; j++)
        {
            if (i == 0 && j == 0){continue;}
            int x = pNode->mX + i;
            int y = pNode->mY + j;
            if (x > 14 || y > 14){continue;}
            if (x < 0 || y < 0){continue;}
            Node candidate = Map::GetInstance()->mMap[x][y];
            if (candidate.mTypeID == NODE_TYPE_SOLID){continue;}
            neighbors.push_back(candidate);
        }
    }
    return neighbors;
}