已解决:对不起。我正在不正确地重建路径。我认为 closedSet 只有从开始到结束的所有航点,但它也有其他一些航点。我想念理解这个概念。现在它工作正常!
我仍然在 A* 上遇到一些麻烦。
我的角色正在寻找他的路径,但有时,根据我在地图上单击的位置,算法会找到最短路径或路径,但有许多不应选择的节点。
我尝试遵循Wikipedia和A* Pathfinding for Beginner 的实现,但它们给了我相同的结果。我不知道是启发式还是算法本身,但有些不对劲。
这是单击两个不同节点的问题示例:http: //i.imgur.com/gtgxi.jpg
这是 Pathfind 类:
import java.util.ArrayList;
import java.util.Collections;
import java.util.TreeSet;
public class Pathfind {
public Pathfind(){
}
public ArrayList<Node> findPath(Node start, Node end, ArrayList<Node> nodes){
ArrayList<Node> openSet = new ArrayList<Node>();
ArrayList<Node> closedSet = new ArrayList<Node>();
Node current;
openSet.add(start);
while(openSet.size() > 0){
current = openSet.get(0);
current.setH_cost(ManhattanDistance(current, end));
if(start == end) return null;
else if(closedSet.contains(end)){
System.out.println("Path found!");
return closedSet;
}
openSet.remove(current);
closedSet.add(current);
for(Node n : current.getNeigbours()){
if(!closedSet.contains(n)){
if(!openSet.contains(n) || (n.getG_cost() < (current.getG_cost()+10))){
n.setParent(current);
n.setG_cost(current.getG_cost()+10);
n.setH_cost(ManhattanDistance(n, end));
if(!openSet.contains(n))
openSet.add(n);
Collections.sort(openSet);
}
}
}
}
return null;
}
private int ManhattanDistance(Node start, Node end){
int cost = start.getPenalty();
int fromX = start.x, fromY = start.y;
int toX = end.x, toY = end.y;
return cost * (Math.abs(fromX - toX) + Math.abs(fromY - toY));
}
}