public float DistanceTo(Coordinate coordinate)
{
return((float)Math.Sqrt(Math.Pow(this.X - coordinate.X, 2) + Math.Pow(this.Y - coordinate.Y, 2) + Math.Pow(this.Z - coordinate.Z, 2)));
}
public Coordinate Normalize(Coordinate origin)
{
Coordinate coordinate = this.Subtract(origin);
return(coordinate.Normalize());
}
public float AngleTo(Coordinate b)
{
Coordinate tmp = b.Subtract(this);
return((float)Math.Atan2(tmp.X, tmp.Y));
}
