39 #ifndef HPP_FCL_GEOMETRIC_SHAPES_H 40 #define HPP_FCL_GEOMETRIC_SHAPES_H 42 #include <boost/math/constants/constants.hpp> 78 void computeLocalAABB();
103 void computeLocalAABB();
110 return 8*halfSide.prod();
116 Vec3f s (halfSide.cwiseAbs2() * V);
117 return (
Vec3f (s[1] + s[2], s[0] + s[2], s[0] + s[1]) / 3).asDiagonal();
133 void computeLocalAABB();
140 FCL_REAL I = 0.4 * radius * radius * computeVolume();
141 return I * Matrix3f::Identity();
146 return 4 * boost::math::constants::pi<FCL_REAL>() * radius * radius * radius / 3;
169 void computeLocalAABB();
176 return boost::math::constants::pi<FCL_REAL>() * radius * radius *((halfLength * 2) + radius * 4/3.0);
181 FCL_REAL v_cyl = radius * radius * (halfLength * 2) * boost::math::constants::pi<FCL_REAL>();
182 FCL_REAL v_sph = radius * radius * radius * boost::math::constants::pi<FCL_REAL>() * 4 / 3.0;
184 FCL_REAL h2 = halfLength * halfLength;
186 FCL_REAL ix = v_cyl * (h2 / 3. + r2 / 4.) + v_sph * (0.4 * r2 + h2 + 0.75 * radius * halfLength);
187 FCL_REAL iz = (0.5 * v_cyl + 0.4 * v_sph) * radius * radius;
191 0, 0, iz).finished();
214 void computeLocalAABB();
221 return boost::math::constants::pi<FCL_REAL>() * radius * radius * (halfLength * 2) / 3;
227 FCL_REAL ix = V * (0.4 * halfLength * halfLength + 3 * radius * radius / 20);
228 FCL_REAL iz = 0.3 * V * radius * radius;
232 0, 0, iz).finished();
237 return Vec3f(0, 0, -0.5 * halfLength);
258 void computeLocalAABB();
265 return boost::math::constants::pi<FCL_REAL>() * radius * radius * (halfLength * 2);
271 FCL_REAL ix = V * (radius * radius / 4 + halfLength * halfLength / 3);
272 FCL_REAL iz = V * radius * radius / 2;
275 0, 0, iz).finished();
297 bool keepTriangles,
const char* qhullCommand = NULL);
302 void computeLocalAABB();
316 unsigned char const&
count ()
const {
return count_; }
317 unsigned int & operator[] (
int i) { assert(i<count_);
return n_[i]; }
318 unsigned int const& operator[] (
int i)
const { assert(i<count_);
return n_[i]; }
332 neighbors(NULL), nneighbors_(NULL), own_storage_(false) {}
349 void computeCenter();
352 template <
typename PolygonT>
class Convex;
383 return std::abs(n.dot(p) - d);
387 void computeLocalAABB();
401 void unitNormalTest();
430 return std::abs(n.dot(p) - d);
434 void computeLocalAABB();
448 void unitNormalTest();
Definition: collision_object.h:57
Vec3f halfSide
box side half-length
Definition: geometric_shapes.h:100
NODE_TYPE getNodeType() const
Get node type: a box.
Definition: geometric_shapes.h:106
bool own_storage_
Definition: geometric_shapes.h:346
NODE_TYPE getNodeType() const
Get node type: a cone.
Definition: geometric_shapes.h:217
Halfspace()
Definition: geometric_shapes.h:372
Vec3f n
Plane normal.
Definition: geometric_shapes.h:393
Matrix3f computeMomentofInertia() const
compute the inertia matrix, related to the origin
Definition: geometric_shapes.h:224
Vec3f computeCOM() const
compute center of mass
Definition: geometric_shapes.h:235
FCL_REAL halfLength
Half Length along z axis.
Definition: geometric_shapes.h:211
Sphere(FCL_REAL radius_)
Definition: geometric_shapes.h:125
Definition: collision_object.h:57
OBJECT_TYPE
object type: BVH (mesh, points), basic geometry, octree
Definition: collision_object.h:53
Cylinder along Z axis. The cylinder is defined at its centroid.
Definition: geometric_shapes.h:243
Main namespace.
Definition: AABB.h:43
FCL_REAL signedDistance(const Vec3f &p) const
Definition: geometric_shapes.h:376
Definition: geometric_shapes.h:311
Matrix3f computeMomentofInertia() const
compute the inertia matrix, related to the origin
Definition: geometric_shapes.h:179
Halfspace(const Vec3f &n_, FCL_REAL d_)
Construct a half space with normal direction and offset.
Definition: geometric_shapes.h:361
bool initialize(MeshCollisionTraversalNode< BV, RelativeTransformationIsIdentity > &node, BVHModel< BV > &model1, Transform3f &tf1, BVHModel< BV > &model2, Transform3f &tf2, CollisionResult &result, bool use_refit=false, bool refit_bottomup=false)
Initialize traversal node for collision between two meshes, given the current transforms.
Definition: traversal_node_setup.h:407
Eigen::Matrix< FCL_REAL, 3, 3 > Matrix3f
Definition: data_types.h:68
NODE_TYPE getNodeType() const
Get node type: a capsule.
Definition: geometric_shapes.h:172
Half Space: this is equivalent to the Plane in ODE. The separation plane is defined as n * x = d; Poi...
Definition: geometric_shapes.h:357
Matrix3f computeMomentofInertia() const
compute the inertia matrix, related to the origin
Definition: geometric_shapes.h:138
FCL_REAL computeVolume() const
compute the volume
Definition: geometric_shapes.h:263
ConvexBase()
Construct an uninitialized convex object Initialization is done with ConvexBase::initialize.
Definition: geometric_shapes.h:331
Infinite plane.
Definition: geometric_shapes.h:405
Vec3f c
Definition: geometric_shapes.h:82
FCL_REAL computeVolume() const
compute the volume
Definition: geometric_shapes.h:144
virtual ~ShapeBase()
Definition: geometric_shapes.h:59
Box()
Definition: geometric_shapes.h:97
Definition: collision_object.h:57
Base class for all basic geometric shapes.
Definition: geometric_shapes.h:54
Matrix3f computeMomentofInertia() const
compute the inertia matrix, related to the origin
Definition: geometric_shapes.h:268
Halfspace(FCL_REAL a, FCL_REAL b, FCL_REAL c, FCL_REAL d_)
Construct a plane with normal direction and offset.
Definition: geometric_shapes.h:367
Definition: collision_object.h:53
TriangleP(const Vec3f &a_, const Vec3f &b_, const Vec3f &c_)
Definition: geometric_shapes.h:73
ShapeBase()
Definition: geometric_shapes.h:57
FCL_REAL radius
Radius of the cone.
Definition: geometric_shapes.h:208
double FCL_REAL
Definition: data_types.h:66
FCL_REAL distance(const Vec3f &p) const
Definition: geometric_shapes.h:428
Center at zero point, axis aligned box.
Definition: geometric_shapes.h:86
Definition: collision_object.h:57
unsigned int * n_
Definition: geometric_shapes.h:314
Plane(const Vec3f &n_, FCL_REAL d_)
Construct a plane with normal direction and offset.
Definition: geometric_shapes.h:409
NODE_TYPE getNodeType() const
Get node type: a plane.
Definition: geometric_shapes.h:437
Cone(FCL_REAL radius_, FCL_REAL lz_)
Definition: geometric_shapes.h:202
Triangle stores the points instead of only indices of points.
Definition: geometric_shapes.h:70
FCL_REAL computeVolume() const
compute the volume
Definition: geometric_shapes.h:174
Cone The base of the cone is at and the top is at .
Definition: geometric_shapes.h:199
Plane(FCL_REAL a, FCL_REAL b, FCL_REAL c, FCL_REAL d_)
Construct a plane with normal direction and offset.
Definition: geometric_shapes.h:415
FCL_REAL d
Plane offset.
Definition: geometric_shapes.h:396
FCL_REAL d
Plane offset.
Definition: geometric_shapes.h:443
unsigned char count_
Definition: geometric_shapes.h:313
FCL_REAL radius
Radius of the sphere.
Definition: geometric_shapes.h:130
int num_points
Definition: geometric_shapes.h:309
Plane()
Definition: geometric_shapes.h:420
FCL_REAL radius
Radius of the cylinder.
Definition: geometric_shapes.h:252
Vec3f n
Plane normal.
Definition: geometric_shapes.h:440
Box(const Vec3f &side_)
Definition: geometric_shapes.h:93
Center at zero point sphere.
Definition: geometric_shapes.h:122
FCL_REAL computeVolume() const
compute the volume
Definition: geometric_shapes.h:219
Capsule It is where is the distance between the point x and the capsule segment AB...
Definition: geometric_shapes.h:154
Definition: collision_object.h:57
NODE_TYPE
traversal node type: bounding volume (AABB, OBB, RSS, kIOS, OBBRSS, KDOP16, KDOP18, kDOP24), basic shape (box, sphere, capsule, cone, cylinder, convex, plane, triangle), and octree
Definition: collision_object.h:56
Base for convex polytope.
Definition: geometric_shapes.h:281
FCL_REAL computeVolume() const
compute the volume
Definition: geometric_shapes.h:108
unsigned char const & count() const
Definition: geometric_shapes.h:316
Definition: collision_object.h:57
Cylinder(FCL_REAL radius_, FCL_REAL lz_)
Definition: geometric_shapes.h:246
NODE_TYPE getNodeType() const
Get node type: a conex polytope.
Definition: geometric_shapes.h:305
Capsule(FCL_REAL radius_, FCL_REAL lz_)
Definition: geometric_shapes.h:157
FCL_REAL signedDistance(const Vec3f &p) const
Definition: geometric_shapes.h:423
FCL_REAL halfLength
Half Length along z axis.
Definition: geometric_shapes.h:255
Eigen::Matrix< FCL_REAL, 3, 1 > Vec3f
Definition: data_types.h:67
Convex polytope.
Definition: convex.h:53
NODE_TYPE getNodeType() const
get the node type
Definition: geometric_shapes.h:80
The geometry for the object for collision or distance computation.
Definition: collision_object.h:63
NODE_TYPE getNodeType() const
Get node type: a half space.
Definition: geometric_shapes.h:390
Neighbors * neighbors
Definition: geometric_shapes.h:323
Definition: collision_object.h:57
Definition: collision_object.h:57
Definition: collision_object.h:57
Vec3f center
center of the convex polytope, this is used for collision: center is guaranteed in the internal of th...
Definition: geometric_shapes.h:326
FCL_REAL radius
Radius of capsule.
Definition: geometric_shapes.h:163
unsigned int * nneighbors_
Definition: geometric_shapes.h:344
FCL_REAL halfLength
Half Length along z axis.
Definition: geometric_shapes.h:166
OBJECT_TYPE getObjectType() const
Get object type: a geometric shape.
Definition: geometric_shapes.h:62
FCL_REAL distance(const Vec3f &p) const
Definition: geometric_shapes.h:381
#define HPP_FCL_DLLAPI
Definition: config.hh:64
Matrix3f computeMomentofInertia() const
compute the inertia matrix, related to the origin
Definition: geometric_shapes.h:113
NODE_TYPE getNodeType() const
Get node type: a sphere.
Definition: geometric_shapes.h:136
Vec3f * points
An array of the points of the polygon.
Definition: geometric_shapes.h:308
NODE_TYPE getNodeType() const
Get node type: a cylinder.
Definition: geometric_shapes.h:261
Box(FCL_REAL x, FCL_REAL y, FCL_REAL z)
Definition: geometric_shapes.h:89