public double GetDistanceSigned(double x, double y, double z)
{
if (!IsDefined)
{
throw new InvalidOperationException("Plane is not defined.");
}
var v = new Pnt3D(x, y, z);
double dotProd = GeomUtils.DotProduct(v, A, B, C);
return((dotProd - D) / LengthOfNormal);
}
public double?GetIntersectionFactor(Pnt3D lineStart, Pnt3D lineEnd)
{
if (!IsDefined)
{
throw new InvalidOperationException("Plane is not defined.");
}
// Required: any point on the plane p:
var p = new Pnt3D(Normal * D / LengthOfNormalSquared);
double denominator = GeomUtils.DotProduct(lineEnd - lineStart, Normal);
if (MathUtils.AreEqual(denominator, 0))
{
// The line is parallel to the plane.
return(null);
}
double t = GeomUtils.DotProduct(p - lineStart, Normal) /
denominator;
return(t);
}
/// <summary>
/// The perpendicular distance of the infinite line defined by the Start/End points of this
/// line to the specified point.
/// </summary>
/// <param name="point"></param>
/// <param name="inXY"></param>
/// <param name="distanceAlongRatio">The distance-along-ratio of the closest point on the line.</param>
/// <param name="pointOnLine"></param>
/// <returns></returns>
public double GetDistancePerpendicular(Pnt3D point, bool inXY,
out double distanceAlongRatio,
out Pnt3D pointOnLine)
{
// http://geomalgorithms.com/a02-_lines.html#Distance-to-Infinite-Line
Pnt3D w = point - StartPoint;
double c1, c2;
if (inXY)
{
c1 = GeomUtils.DotProduct(w.X, w.Y, 0, DirectionVector.X,
DirectionVector.Y, 0);
c2 = DirectionVector.Length2DSquared;
}
else
{
c1 = GeomUtils.DotProduct(w, DirectionVector);
c2 = DirectionVector.LengthSquared;
}
if (c2 < double.Epsilon)
{
// 0-length line: Distance to StartPoint
distanceAlongRatio = 0;
pointOnLine = (Pnt3D)StartPoint.Clone();
return(StartPoint.GetDistance(point, inXY));
}
distanceAlongRatio = c1 / c2;
pointOnLine = (Pnt3D)(StartPoint + distanceAlongRatio * DirectionVector);
return(pointOnLine.GetDistance(point, inXY));
}