39 #ifndef HPP_FCL_BVH_UTILITY_H 40 #define HPP_FCL_BVH_UTILITY_H 52 BVHModel<BV>*
BVHExtract(
const BVHModel<BV>& model,
const Transform3f& pose,
const AABB& aabb);
void getExtentAndCenter(Vec3f *ps, Vec3f *ps2, Triangle *ts, unsigned int *indices, int n, Matrix3f &axes, Vec3f ¢er, Vec3f &extent)
Compute the bounding volume extent and center for a set or subset of points, given the BV axises...
Main namespace.
Definition: AABB.h:43
void getCovariance(Vec3f *ps, Vec3f *ps2, Triangle *ts, unsigned int *indices, int n, Matrix3f &M)
Compute the covariance matrix for a set or subset of points. if ts = null, then indices refer to poin...
Eigen::Matrix< FCL_REAL, 3, 3 > Matrix3f
Definition: data_types.h:74
void circumCircleComputation(const Vec3f &a, const Vec3f &b, const Vec3f &c, Vec3f ¢er, FCL_REAL &radius)
Compute the center and radius for a triangle's circumcircle.
BVHModel< BV > * BVHExtract(const BVHModel< BV > &model, const Transform3f &pose, const AABB &aabb)
Extract the part of the BVHModel that is inside an AABB. A triangle in collision with the AABB is con...
double FCL_REAL
Definition: data_types.h:68
FCL_REAL maximumDistance(Vec3f *ps, Vec3f *ps2, Triangle *ts, unsigned int *indices, int n, const Vec3f &query)
Compute the maximum distance from a given center point to a point cloud.
void getRadiusAndOriginAndRectangleSize(Vec3f *ps, Vec3f *ps2, Triangle *ts, unsigned int *indices, int n, const Matrix3f &axes, Vec3f &origin, FCL_REAL l[2], FCL_REAL &r)
Compute the RSS bounding volume parameters: radius, rectangle size and the origin, given the BV axises.
Eigen::Matrix< FCL_REAL, 3, 1 > Vec3f
Definition: data_types.h:73