我对这种事情很陌生,并使用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
添加一些关于代码质量的评论也很不错。
答案 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.