1

我发现了一个对我实现 A* 非常有用的代码。但我面临一个问题。我需要计算曼哈顿距离,我尝试实现一个,但它不起作用。此代码提供欧几里得距离的计算。

public Node(Node parentNode, Node goalNode, int gCost,int x, int y)
    {

        this.parentNode = parentNode;
        this._goalNode = goalNode;
        this.gCost = gCost;
        this.x=x;
        this.y=y;
        InitNode();
    }

    private void InitNode()
    {
        this.g = (parentNode!=null)? this.parentNode.g + gCost:gCost;
        this.h = (_goalNode!=null)? (int) Euclidean_H():0;
    }

    private double Euclidean_H()
    {
        double xd = this.x - this._goalNode .x ;
        double yd = this.y - this._goalNode .y ;
        return Math.Sqrt((xd*xd) + (yd*yd));
    }

代码使用c#。非常感谢你。

4

1 回答 1

4

A 和 B 之间的曼哈顿距离(又名L1-norm)是

Sum(abs(a[i] - b[i]))

当 A 和 B 之间的欧几里得一(又名L2-norm)是

Sqrt(Sum((a[i] - b[i])**2))

其中 a[i], b[i] 是 A 点和 B 点的对应坐标。所以代码可能是

private double Manhattan_H()
{
  double xd = this.x - this._goalNode.x;
  double yd = this.y - this._goalNode.y;

  return Math.Abs(xd) + Math.Abs(yd);
}
于 2013-11-15T10:12:45.083 回答