| 123456789101112131415161718192021222324252627282930 |
- function d = distancePointPlane(point, plane)
- %DISTANCEPOINTPLANE Signed distance betwen 3D point and plane.
- %
- % D = distancePointPlane(POINT, PLANE)
- % Returns the euclidean distance between point POINT and the plane PLANE,
- % given by:
- % POINT : [x0 y0 z0]
- % PLANE : [x0 y0 z0 dx1 dy1 dz1 dx2 dy2 dz2]
- % D : scalar
- %
- % See also:
- % planes3d, points3d, intersectLinePlane
- %
- % ---------
- % author : David Legland
- % INRA - TPV URPOI - BIA IMASTE
- % created the 18/02/2005.
- %
- % HISTORY
- % normalized plane normal
- n = normalizeVector3d(cross(plane(:,4:6), plane(:, 7:9), 2));
- % Uses Hessian form, ie : N.p = d
- % I this case, d can be found as : -N.p0, when N is normalized
- d = -sum(bsxfun(@times, n, bsxfun(@minus, plane(:,1:3), point)), 2);
|
