46struct CollisionRequest;
60 return o == other.o && r == other.r;
64 return !(*
this == other);
69 static kIOS_Sphere encloseSphere(
const kIOS_Sphere& s0,
70 const kIOS_Sphere& s1) {
71 Vec3f d = s1.o - s0.o;
76 if (diff_r * diff_r >= dist2) {
83 float dist = (float)std::sqrt(dist2);
85 s.r = dist + s0.r + s1.r;
87 s.o = s0.o + d * ((s.r - s0.r) / dist);
98 if (!res)
return false;
100 for (
size_t k = 0; k < num_spheres; ++k) {
101 if (spheres[k] != other.
spheres[k])
return false;
111 kIOS_Sphere spheres[5];
137 *
this = *
this + other;
A class describing the kIOS collision structure, which is a set of spheres.
Definition: kIOS.h:53
#define HPP_FCL_DLLAPI
Definition: config.hh:64
bool operator!=(const kIOS &other) const
Difference operator.
Definition: kIOS.h:108
kIOS & operator+=(const kIOS &other)
Merge the kIOS and another kIOS.
Definition: kIOS.h:136
FCL_REAL depth() const
Depth of the kIOS.
kIOS_Sphere spheres[5]
The (at most) five spheres for intersection.
Definition: kIOS.h:111
FCL_REAL distance(const Matrix3f &R0, const Vec3f &T0, const kIOS &b1, const kIOS &b2, Vec3f *P=NULL, Vec3f *Q=NULL)
Approximate distance between two kIOS bounding volumes.
bool operator==(const kIOS_Sphere &other) const
Definition: kIOS.h:59
bool overlap(const kIOS &other) const
Check collision between two kIOS.
kIOS & operator+=(const Vec3f &p)
A simple way to merge the kIOS and a point.
FCL_REAL width() const
Width of the kIOS.
bool overlap(const kIOS &other, const CollisionRequest &, FCL_REAL &sqrDistLowerBound) const
Check collision between two kIOS.
FCL_REAL height() const
Height of the kIOS.
FCL_REAL r
Definition: kIOS.h:57
KDOP< N > translate(const KDOP< N > &bv, const Vec3f &t)
translate the KDOP BV
bool overlap(const Matrix3f &R0, const Vec3f &T0, const AABB &b1, const AABB &b2)
Check collision between two aabbs, b1 is in configuration (R0, T0) and b2 is in identity.
FCL_REAL volume() const
Volume of the kIOS.
bool contain(const Vec3f &p) const
Check whether the kIOS contains a point.
FCL_REAL size() const
size of the kIOS (used in BV_Splitter to order two kIOSs)
FCL_REAL distance(const kIOS &other, Vec3f *P=NULL, Vec3f *Q=NULL) const
The distance between two kIOS.
bool operator==(const kIOS &other) const
Equality operator.
Definition: kIOS.h:96
const Vec3f & center() const
Center of the kIOS.
Definition: kIOS.h:148
unsigned int num_spheres
The number of spheres, no larger than 5.
Definition: kIOS.h:114
OBB obb
@ OBB related with kIOS
Definition: kIOS.h:117
Vec3f o
Definition: kIOS.h:56
bool operator!=(const kIOS_Sphere &other) const
Definition: kIOS.h:63
kIOS operator+(const kIOS &other) const
Return the merged kIOS of current kIOS and the other one.
Eigen::Matrix< FCL_REAL, 3, 3 > Matrix3f
Definition: data_types.h:68
Eigen::Matrix< FCL_REAL, 3, 1 > Vec3f
Definition: data_types.h:66
double FCL_REAL
Definition: data_types.h:65
Main namespace.
Definition: broadphase_bruteforce.h:44
request to the collision algorithm
Definition: collision_data.h:235
Oriented bounding box class.
Definition: OBB.h:52