我正在尝试用Java实现基本的RRT(快速浏览随机树)算法。我有一个类TreeNode,它保存节点的x和y位置,并在ArrayList中保存它拥有的所有子节点。在我的主程序中,我有树的根。如果我想在树中找到最近的邻居,我会调用此代码。调用该方法时,根节点为“node”,minAbstand为Integer.MAX_VALUE
private void NEAREST_NEIGHBOUR(int xrand, int yrand, TreeNode node, int minAbstand) {
if((Math.sqrt(Math.pow(node.getxPos()-xrand, 2) + Math.pow(node.getyPos()-yrand, 2))) <= minAbstand){//normal method to find the distance
minAbstand = (int) Math.sqrt(Math.pow(node.getxPos()-xrand, 2) + Math.pow(node.getyPos()-yrand, 2));
xnearest = node;
}
for(int i = 0; i < node.getNodes().size(); i++){
NEAREST_NEIGHBOUR(xrand, yrand, node.getNodes().get(i), minAbstand);
}
}
我以为我会递归遍历所有节点并找到距离最短的节点。在NEAREST_NEIGHBOUR方法之后,最近的邻居应该保存在xnearest中。现在我通过这种方法将新节点添加到最近的节点:
xnearest.addNode(xnew)
。
addNode是TreeNode类中调用arraylist.add(node)的方法,因此只需将节点添加到ArrayList即可。在此之后,新节点应该是最近节点的“子节点”。然后从头开始: - 创建随机节点, - 找到最近节点到随机节点, - 将随机节点添加到最近节点,... 但实际上并非如此。
在突出显示的区域中,您可以看到它没有选择距离最短的节点。我在那里做错了什么?
整个代码:
private void doRRT(Canvas canvas, PaintEvent e, int K, int deltaT){
for(int i = 0; i < K; i++){
xrand = new TreeNode(new Random().nextInt(canvas.getSize().x * 2) - 500, new Random().nextInt(canvas.getSize().y * 2) - 300);
NEAREST_NEIGHBOUR(xrand.getxPos(), xrand.getyPos(), xstart, Integer.MAX_VALUE);
NEW_STATE(xrand.getxPos(), xrand.getyPos(), deltaT);
e.gc.drawRectangle(xnearest.getxPos() - 1, xnearest.getyPos() - 1, 2, 2);
e.gc.drawLine(xnearest.getxPos(), xnearest.getyPos(), xnew.getxPos(), xnew.getyPos());
}
}
private void NEW_STATE(int xrand, int yrand, int deltaT) {
int nearx = xnearest.getxPos(), neary = xnearest.getyPos();
if(Math.sqrt(Math.pow(nearx - xrand, 2) + Math.pow(neary - yrand, 2)) > deltaT){
float faktor = (float) (Math.sqrt(Math.pow(nearx - xrand, 2) + Math.pow(neary - yrand, 2)) / deltaT);
xnew = new TreeNode((int) (nearx + (xrand - nearx)/ faktor), (int) (neary + (yrand - neary)/ faktor));
} else {
xnew = new TreeNode(xrand, yrand);
}
xnearest.addNode(xnew);
}
private void NEAREST_NEIGHBOUR(int xrand, int yrand, TreeNode node, int minAbstand) {
counter2++;
if((Math.sqrt(Math.pow(node.getxPos()-xrand, 2) + Math.pow(node.getyPos()-yrand, 2))) < minAbstand){
minAbstand = (int) Math.sqrt(Math.pow(node.getxPos()-xrand, 2) + Math.pow(node.getyPos()-yrand, 2));
xnearest = node;
}
for(int i = 0; i < node.getNodes().size(); i++){
NEAREST_NEIGHBOUR(xrand, yrand, node.getNodes().get(i), minAbstand);
}
}
TreeNode类:
TreeNode(int x, int y){
xPos = x;
yPos = y;
nodes = new ArrayList<TreeNode>();
}
public ArrayList<TreeNode> getNodes() {
return nodes;
}
public int getxPos() {
return xPos;
}
public int getyPos() {
return yPos;
}
public void addNode(TreeNode node){
nodes.add(node);
}
解决方案?
现在这样吗?递归真的很棘手
private int NEAREST_NEIGHBOUR(int xrand, int yrand, TreeNode node, int minAbstand) {
if((Math.sqrt(Math.pow(node.getxPos()-xrand, 2) + Math.pow(node.getyPos()-yrand, 2))) < minAbstand){
minAbstand = (int) Math.sqrt(Math.pow(node.getxPos()-xrand, 2) + Math.pow(node.getyPos()-yrand, 2));
xnearest = node;
}
for(int i = 0; i < node.getNodes().size(); i++){
minAbstand = NEAREST_NEIGHBOUR(xrand, yrand, node.getNodes().get(i), minAbstand);
}
return minAbstand;
}
答案 0 :(得分:1)
我必须纠正自己:NEAREST_NEIGHBOUR
方法有一个失败的逻辑。看:
方法启动时,将已收回的minAbstand
与当前已评估节点的距离进行比较。并且,如果它更低,则minAbstand
值已更新,以便递归地限制当前子树内的搜索标准。到目前为止,非常好。
但是,兄弟姐妹的子树怎么样?我的意思是:当完全浏览当前子树时,当前方法调用结束,从而将控件返回到调用方法,调用方法本身就在先前的递归帧中。 但是遗漏了本地变量的值(例如minAbstand
)。
您需要的是返回minAbstand
作为NEAREST_NEIGHBOUR
的返回值,并在每次递归调用时更新它。