C ++ A * Pathfinding导致无限循环

时间:2017-01-28 17:19:45

标签: c++ a-star

我对这种事情很陌生,并使用this tutorial来编写我的代码。

基本上,调用我的函数会导致我的代码崩溃,显而易见的问题是我会导致无限循环,但我无法看到它。

看看:

std::vector<Vector2> TileMap::pathFind(Vector2 pathStart, Vector2 pathEnd){
    struct Node{
        Vector2 pos;
        int f;
        inline Node operator=(Node a){
            pos = a.pos;
            f = a.f;
        }
    };
    std::vector<Node> openList;
    std::vector<Vector2> closedList;
    closedList.push_back(pathStart);

    Vector2 currentNode = pathStart;
    do{
        if(currentNode.x - 1 >= 0){ //NORTH
            Node node;
            node.pos = Vector2(currentNode.x-1, currentNode.y);
            node.f = 1 + (std::abs(pathEnd.x - node.pos.x)+std::abs(pathEnd.y - node.pos.y));
            openList.push_back(node);
        }
        if(currentNode.x + 1 <= MAP_WIDTH){ //SOUTH
            Node node;
            node.pos = Vector2(currentNode.x+1, currentNode.y);
            node.f = 1 + (std::abs(pathEnd.x - node.pos.x)+std::abs(pathEnd.y - node.pos.y));
            openList.push_back(node);
        }
        if(currentNode.y - 1 >= 0){ //WEST
            Node node;
            node.pos = Vector2(currentNode.x, currentNode.y-1);
            node.f = 1 + (std::abs(pathEnd.x - node.pos.x)+std::abs(pathEnd.y - node.pos.y));
            openList.push_back(node);
        }
        if(currentNode.y + 1 <= MAP_HEIGHT){ //EAST
            Node node;
            node.pos = Vector2(currentNode.x, currentNode.y+1);
            node.f = 1 + (std::abs(pathEnd.x - node.pos.x)+std::abs(pathEnd.y - node.pos.y));
            openList.push_back(node);
        }//step 2 now

        if(!(openList.empty())){
            Node minimum = openList[0];
            int num = 0;
            for(auto i : openList){
                num++;
                if(minimum.f > i.f){
                    minimum = i;
                }
            }
            currentNode = minimum.pos;
            closedList.push_back(minimum.pos);
            openList.erase(
            std::remove_if(openList.begin(), openList.end(), [&](Node & node) {
                return node.pos == minimum.pos;
            }), openList.end());
        }

        if(currentNode == pathEnd){
            openList.clear();
        }
    }while(!(openList.empty()));
    return closedList;
}

我使用了一个简单的Vector2结构,我在这里写了一个头文件:

#ifndef VECTOR2_H_INCLUDED
#define VECTOR2_H_INCLUDED

struct Vector2{
    int x;
    int y;
    Vector2(int x, int y){
        this->x = x;
        this->y = y;
    }
    Vector2(){
        this->x = 0;
        this->y = 0;
    }

    inline Vector2 operator=(Vector2 a){
        x=a.x;
        y=a.y;
    }

    bool operator==(Vector2 a){
        return (x==a.x && y==a.y);
    }
};

#endif // VECTOR2_H_INCLUDED

添加一些关于代码质量的评论也很不错。

1 个答案:

答案 0 :(得分:0)

问题是你没有正确计算node.f. 参考提供的教程,

F = G + H

其中G是从A到当前平方的成本,H是从当前平方到B的估计成本。但是,回头看这部分的代码:

node.f = 1 + (std::abs(pathEnd.x - node.pos.x)+std::abs(pathEnd.y - node.pos.y));

似乎G始终为1,而其余代码用于计算H.在这种情况下,G应该是从A到currentNode加1的步骤,因为它需要一步移动

所以,最重要的部分是,只保存F是不够的。必须保存G才能在其他方格中计算F.

编辑:我们不使用(std::abs(currentNode.x -pathStart.x)+std::abs(currentNode.y - pathStart.y) + 1的原因是因为我们可能无法绕道而不能到达当前的广场。 e.g。

+---+
|   |
| | |
|S|E|
+-+-+

假设现在我们在E点开始从S点开始。 使用(std::abs(currentNode.x -pathStart.x)+std::abs(currentNode.y - pathStart.y) + 1,距离仅为1.但是,需要5个步骤才能转到E.