DART
6.10.1
|
#include <FCLCollisionGroup.hpp>
Public Types | |
using | FCLCollisionManager = dart::collision::fcl::DynamicAABBTreeCollisionManager |
Public Member Functions | |
FCLCollisionGroup (const CollisionDetectorPtr &collisionDetector) | |
Constructor. More... | |
virtual | ~FCLCollisionGroup ()=default |
Destructor. More... | |
CollisionDetectorPtr | getCollisionDetector () |
Return collision detection engine associated with this CollisionGroup. More... | |
ConstCollisionDetectorPtr | getCollisionDetector () const |
Return (const) collision detection engine associated with this CollisionGroup. More... | |
void | addShapeFrame (const dynamics::ShapeFrame *shapeFrame) |
Add a ShapeFrame to this CollisionGroup. More... | |
void | addShapeFrames (const std::vector< const dynamics::ShapeFrame * > &shapeFrames) |
Add ShapeFrames to this CollisionGroup. More... | |
template<typename... Others> | |
void | addShapeFramesOf (const dynamics::ShapeFrame *shapeFrame, const Others *... others) |
Add a ShapeFrame, and also add ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | addShapeFramesOf (const std::vector< const dynamics::ShapeFrame * > &shapeFrames, const Others *... others) |
Add ShapeFrames, and also add ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | addShapeFramesOf (const CollisionGroup *otherGroup, const Others *... others) |
Add ShapeFrames of other CollisionGroup, and also add another ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | addShapeFramesOf (const dynamics::BodyNode *bodyNode, const Others *... others) |
Add ShapeFrames of BodyNode, and also add another ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | addShapeFramesOf (const dynamics::MetaSkeleton *skeleton, const Others *... others) |
Add ShapeFrames of MetaSkeleton, and also add another ShapeFrames of other various objects. More... | |
void | addShapeFramesOf () |
Do nothing. More... | |
template<typename... Others> | |
void | subscribeTo (const dynamics::ConstBodyNodePtr &bodyNode, const Others &... others) |
Add ShapeFrames of bodyNode, and also subscribe to the BodyNode so that the results from this CollisionGroup automatically reflect any changes that are made to bodyNode. More... | |
template<typename... Others> | |
void | subscribeTo (const dynamics::ConstSkeletonPtr &skeleton, const Others &... others) |
Add ShapeFrames of skeleton, and also subscribe to the Skeleton so that the results from this CollisionGroup automatically reflect any changes that are made to skeleton. More... | |
void | subscribeTo () |
Do nothing. More... | |
void | removeShapeFrame (const dynamics::ShapeFrame *shapeFrame) |
Remove a ShapeFrame from this CollisionGroup. More... | |
void | removeShapeFrames (const std::vector< const dynamics::ShapeFrame * > &shapeFrames) |
Remove ShapeFrames from this CollisionGroup. More... | |
template<typename... Others> | |
void | removeShapeFramesOf (const dynamics::ShapeFrame *shapeFrame, const Others *... others) |
Remove a ShapeFrame, and also remove ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | removeShapeFramesOf (const std::vector< const dynamics::ShapeFrame * > &shapeFrames, const Others *... others) |
Remove ShapeFrames, and also remove ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | removeShapeFramesOf (const CollisionGroup *otherGroup, const Others *... others) |
Remove ShapeFrames of other CollisionGroup, and also remove another ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | removeShapeFramesOf (const dynamics::BodyNode *bodyNode, const Others *... others) |
Remove ShapeFrames of BodyNode, and also remove another ShapeFrames of other various objects. More... | |
template<typename... Others> | |
void | removeShapeFramesOf (const dynamics::MetaSkeleton *skeleton, const Others *... others) |
Remove ShapeFrames of MetaSkeleton, and also remove another ShapeFrames of other various objects. More... | |
void | removeShapeFramesOf () |
Do nothing. More... | |
void | removeAllShapeFrames () |
Remove all the ShapeFrames in this CollisionGroup. More... | |
template<typename... Others> | |
void | unsubscribeFrom (const dynamics::BodyNode *bodyNode, const Others *... others) |
Unsubscribe from bodyNode. More... | |
template<typename... Others> | |
void | unsubscribeFrom (const dynamics::Skeleton *skeleton, const Others *... others) |
Unsubscribe from skeleton. More... | |
bool | hasShapeFrame (const dynamics::ShapeFrame *shapeFrame) const |
Return true if this CollisionGroup contains shapeFrame. More... | |
std::size_t | getNumShapeFrames () const |
Return number of ShapeFrames added to this CollisionGroup. More... | |
const dynamics::ShapeFrame * | getShapeFrame (std::size_t index) const |
Get the ShapeFrame corresponding to the given index. More... | |
bool | collide (const CollisionOption &option=CollisionOption(false, 1u, nullptr), CollisionResult *result=nullptr) |
Perform collision check within this CollisionGroup. More... | |
bool | collide (CollisionGroup *otherGroup, const CollisionOption &option=CollisionOption(false, 1u, nullptr), CollisionResult *result=nullptr) |
Perform collision check with other CollisionGroup. More... | |
double | distance (const DistanceOption &option=DistanceOption(false, 0.0, nullptr), DistanceResult *result=nullptr) |
Get the minimum signed distance between the Shape pairs in this CollisionGroup. More... | |
double | distance (CollisionGroup *otherGroup, const DistanceOption &option=DistanceOption(false, 0.0, nullptr), DistanceResult *result=nullptr) |
Get the minimum signed distance between the Shape pairs where a pair consist of two shapes from each groups (one from this CollisionGroup and one from otherGroup). More... | |
bool | raycast (const Eigen::Vector3d &from, const Eigen::Vector3d &to, const RaycastOption &option=RaycastOption(), RaycastResult *result=nullptr) |
Performs raycast to this collision group. More... | |
void | setAutomaticUpdate (bool automatic=true) |
Set whether this CollisionGroup will automatically check for updates. More... | |
bool | getAutomaticUpdate () const |
Get whether this CollisionGroup is set to automatically check for updates. More... | |
void | update () |
Check whether this CollisionGroup's subscriptions or any of its objects need an update, and then update them if they do. More... | |
void | removeDeletedShapeFrames () |
Remove any ShapeFrames that have been deleted. More... | |
Protected Types | |
using | ObjectInfoList = std::vector< std::unique_ptr< ObjectInfo > > |
Protected Member Functions | |
void | initializeEngineData () override |
Initialize the collision detection engine data such as broadphase algorithm. More... | |
void | addCollisionObjectToEngine (CollisionObject *object) override |
Add CollisionObject to the collision detection engine. More... | |
void | addCollisionObjectsToEngine (const std::vector< CollisionObject * > &collObjects) override |
Add CollisionObjects to the collision detection engine. More... | |
void | removeCollisionObjectFromEngine (CollisionObject *object) override |
Remove CollisionObject from the collision detection engine. More... | |
void | removeAllCollisionObjectsFromEngine () override |
Remove all the CollisionObjects from the collision detection engine. More... | |
void | updateCollisionGroupEngineData () override |
Update the collision detection engine data such as broadphase algorithm. More... | |
FCLCollisionManager * | getFCLCollisionManager () |
Return FCL collision manager that is also a broad-phase algorithm. More... | |
const FCLCollisionManager * | getFCLCollisionManager () const |
Return FCL collision manager that is also a broad-phase algorithm. More... | |
void | updateEngineData () |
Update engine data. More... | |
Protected Attributes | |
std::unique_ptr< FCLCollisionManager > | mBroadPhaseAlg |
FCL broad-phase algorithm. More... | |
CollisionDetectorPtr | mCollisionDetector |
Collision detector. More... | |
ObjectInfoList | mObjectInfoList |
Information about ShapeFrames and CollisionObjects that have been added to this CollisionGroup. More... | |
Private Types | |
using | SkeletonSource = CollisionSource< dynamics::WeakConstMetaSkeletonPtr, dynamics::BodyNode > |
using | SkeletonSources = std::unordered_map< const dynamics::MetaSkeleton *, SkeletonSource > |
using | BodyNodeSource = CollisionSource< dynamics::WeakConstBodyNodePtr > |
using | BodyNodeSources = std::unordered_map< const dynamics::BodyNode *, BodyNodeSource > |
Private Member Functions | |
ObjectInfo * | addShapeFrameImpl (const dynamics::ShapeFrame *shapeFrame, const void *source) |
Implementation of addShapeFrame. More... | |
void | removeShapeFrameInternal (const dynamics::ShapeFrame *shapeFrame, const void *source) |
Internal version of removeShapeFrame. More... | |
bool | updateSkeletonSource (SkeletonSources::value_type &entry) |
Internal function called to update a Skeleton source. More... | |
bool | updateBodyNodeSource (BodyNodeSources::value_type &entry) |
Internal function called to update a BodyNode source. More... | |
bool | updateShapeFrame (ObjectInfo *object) |
Internal function called to update a ShapeFrame. More... | |
Private Attributes | |
bool | mUpdateAutomatically |
Set this to true to have this CollisionGroup check for updates automatically. More... | |
SkeletonSources | mSkeletonSources |
Skeleton sources that this group is subscribed to. More... | |
BodyNodeSources | mBodyNodeSources |
BodyNode sources that this group is susbscribed to. More... | |
ShapeFrameObserver | mObserver |
The object that observes the Shape Frames that this group cares about. More... | |
Friends | |
class | FCLCollisionDetector |
|
privateinherited |
|
privateinherited |
using dart::collision::FCLCollisionGroup::FCLCollisionManager = dart::collision::fcl::DynamicAABBTreeCollisionManager |
|
protectedinherited |
|
privateinherited |
|
privateinherited |
dart::collision::FCLCollisionGroup::FCLCollisionGroup | ( | const CollisionDetectorPtr & | collisionDetector | ) |
Constructor.
|
virtualdefault |
Destructor.
|
overrideprotectedvirtual |
Add CollisionObjects to the collision detection engine.
Implements dart::collision::CollisionGroup.
|
overrideprotectedvirtual |
Add CollisionObject to the collision detection engine.
Implements dart::collision::CollisionGroup.
|
inherited |
Add a ShapeFrame to this CollisionGroup.
|
privateinherited |
Implementation of addShapeFrame.
The source argument tells us whether this ShapeFrame is being requested explicitly by the user or implicitly through a BodyNode, Skeleton, or other CollisionGroup.
|
inherited |
Add ShapeFrames to this CollisionGroup.
|
inherited |
Do nothing.
This function is for terminating the recursive variadic template function template<typename...> addShapeFramesOf().
|
inherited |
Add ShapeFrames of other CollisionGroup, and also add another ShapeFrames of other various objects.
|
inherited |
Add ShapeFrames of BodyNode, and also add another ShapeFrames of other various objects.
|
inherited |
Add ShapeFrames of MetaSkeleton, and also add another ShapeFrames of other various objects.
|
inherited |
Add a ShapeFrame, and also add ShapeFrames of other various objects.
The other various objects can be any of ShapeFrame, std::vector<ShapeFrame>, CollisionGroup, BodyNode, and Skeleton.
Note that this function adds only the ShapeFrames of each object at the moment of this function is called. The aftwerward changes of the objects does not affect on this CollisionGroup.
|
inherited |
Add ShapeFrames, and also add ShapeFrames of other various objects.
|
inherited |
Perform collision check with other CollisionGroup.
Return false if the engine type of the other CollisionGroup is different from this CollisionObject engine.
|
inherited |
Perform collision check within this CollisionGroup.
|
inherited |
Get the minimum signed distance between the Shape pairs where a pair consist of two shapes from each groups (one from this CollisionGroup and one from otherGroup).
Note that the distance between shapes within the same CollisionGroup are not accounted.
The detailed results are stored in the given DistanceResult if provided.
The results can be different by DistanceOption. By default, non-negative minimum distance (distance >= 0) is returned for all the shape pairs without computing nearest points.
|
inherited |
Get the minimum signed distance between the Shape pairs in this CollisionGroup.
The detailed results are stored in the given DistanceResult if provided.
The results can be different by DistanceOption. By default, non-negative minimum distance (distance >= 0) is returned for all the shape pairs without computing nearest points.
|
inherited |
Get whether this CollisionGroup is set to automatically check for updates.
|
inherited |
Return collision detection engine associated with this CollisionGroup.
|
inherited |
Return (const) collision detection engine associated with this CollisionGroup.
|
protected |
Return FCL collision manager that is also a broad-phase algorithm.
|
protected |
Return FCL collision manager that is also a broad-phase algorithm.
|
inherited |
Return number of ShapeFrames added to this CollisionGroup.
|
inherited |
Get the ShapeFrame corresponding to the given index.
|
inherited |
Return true if this CollisionGroup contains shapeFrame.
|
overrideprotectedvirtual |
Initialize the collision detection engine data such as broadphase algorithm.
This function will be called whenever ShapeFrame is either added to or removed from this CollisionGroup.
Implements dart::collision::CollisionGroup.
|
inherited |
Performs raycast to this collision group.
[in] | from | The start point of the ray in world coordinates. |
[in] | to | The end point of the ray in world coordinates. |
[in] | option | The raycast option. |
[in] | result | The raycast result. |
|
overrideprotectedvirtual |
Remove all the CollisionObjects from the collision detection engine.
Implements dart::collision::CollisionGroup.
|
inherited |
Remove all the ShapeFrames in this CollisionGroup.
|
overrideprotectedvirtual |
Remove CollisionObject from the collision detection engine.
Implements dart::collision::CollisionGroup.
|
inherited |
Remove any ShapeFrames that have been deleted.
This will be done automatically for ShapeFrames that belong to subscriptions.
Returns true if one or more ShapeFrames were removed; otherwise returns false.
|
inherited |
Remove a ShapeFrame from this CollisionGroup.
If this ShapeFrame was being provided by any subscriptions, then calling this function will unsubscribe from those subscriptions, because otherwise this ShapeFrame would simply be put back into the CollisionGroup the next time the group gets updated.
|
privateinherited |
Internal version of removeShapeFrame.
This will only remove the ShapeFrame if it is unsubscribed from all sources.
|
inherited |
Remove ShapeFrames from this CollisionGroup.
|
inherited |
Do nothing.
This function is for terminating the recursive variadic template function template<typename...> removeShapeFramesOf().
|
inherited |
Remove ShapeFrames of other CollisionGroup, and also remove another ShapeFrames of other various objects.
If this CollisionGroup is subscribed to otherGroup, then this function will also unsubscribe from it.
|
inherited |
Remove ShapeFrames of BodyNode, and also remove another ShapeFrames of other various objects.
If this CollisionGroup is subscribed to bodyNode, then this function will also unsubscribe from it.
|
inherited |
Remove ShapeFrames of MetaSkeleton, and also remove another ShapeFrames of other various objects.
If this CollisionGroup is subscribed to skeleton, then this function will also unsubscribe from it.
|
inherited |
Remove a ShapeFrame, and also remove ShapeFrames of other various objects.
The other various objects can be any of ShapeFrame, std::vector<ShapeFrame>, CollisionGroup, BodyNode, and Skeleton.
Note that this function removes only the ShapeFrames of each object at the moment of this function is called. The aftwerward changes of the objects does not affect on this CollisionGroup.
|
inherited |
Remove ShapeFrames, and also remove ShapeFrames of other various objects.
|
inherited |
Set whether this CollisionGroup will automatically check for updates.
|
inherited |
Do nothing.
This function is for terminating the recursive variadic template.
|
inherited |
Add ShapeFrames of bodyNode, and also subscribe to the BodyNode so that the results from this CollisionGroup automatically reflect any changes that are made to bodyNode.
This does likewise for the objects in ...others.
|
inherited |
Add ShapeFrames of skeleton, and also subscribe to the Skeleton so that the results from this CollisionGroup automatically reflect any changes that are made to skeleton.
This does likewise for the objects in ...others.
|
inherited |
Unsubscribe from bodyNode.
The ShapeFrames of the BodyNode will also be removed if no other source is requesting them for this group.
|
inherited |
Unsubscribe from skeleton.
The ShapeFrames of the skeleton will also be removed if no other source is requesting them for this group.
|
inherited |
Check whether this CollisionGroup's subscriptions or any of its objects need an update, and then update them if they do.
If automatic updating is turned on, then this will be called each time collide() is.
This can be called manually in order to control when collision objects get created or destroyed. Those procedures can be time-consuming, so it may be useful to control when it occurs.
|
privateinherited |
Internal function called to update a BodyNode source.
|
overrideprotectedvirtual |
Update the collision detection engine data such as broadphase algorithm.
This function will be called ahead of every collision checking.
Implements dart::collision::CollisionGroup.
|
protected |
Update engine data.
This function should be called before the collision detection is performed by the engine in most cases.
|
privateinherited |
Internal function called to update a ShapeFrame.
|
privateinherited |
Internal function called to update a Skeleton source.
|
friend |
|
privateinherited |
BodyNode sources that this group is susbscribed to.
|
protected |
FCL broad-phase algorithm.
|
protectedinherited |
Collision detector.
|
protectedinherited |
Information about ShapeFrames and CollisionObjects that have been added to this CollisionGroup.
|
privateinherited |
The object that observes the Shape Frames that this group cares about.
|
privateinherited |
Skeleton sources that this group is subscribed to.
|
privateinherited |
Set this to true to have this CollisionGroup check for updates automatically.
Default is true.