Function swri_geometry_util::DistanceFromPlane

Function Documentation

double swri_geometry_util::DistanceFromPlane(const tf2::Vector3 &plane_normal, const tf2::Vector3 &plane_point, const tf2::Vector3 &point)

Calculate the distance from a point to a plane.

Parameters:

  • plane_normal – [in] The normal vector of the plane.

  • plane_point – [in] A point on the plane.

  • point – [in] The point to measure the distance of.

Returns:

The distance of the point from the plane.