Vector3D.Distance C# (CSharp) Method

    public static double Distance(Vector3D a, Vector3D b)
    {
        Vector3D vector = new Vector3D (a.x - b.x, a.y - b.y, a.z - b.z);
        return Math.Sqrt (vector.x * vector.x + vector.y * vector.y + vector.z * vector.z);
    }

        float IMyPathVertex <MyNavigationPrimitive> .EstimateDistanceTo(IMyPathVertex <MyNavigationPrimitive> other)
        {
            MyNavigationPrimitive primitive = other as MyNavigationPrimitive;

            return(!ReferenceEquals(this.Group, primitive.Group) ? ((float)Vector3D.Distance(this.WorldPosition, primitive.WorldPosition)) : Vector3.Distance(this.Position, primitive.Position));
        }