![]() |
Tesseract 0.28.4
|
A FCL implementation of the discrete contact manager. More...
#include <fcl_discrete_managers.h>

Public Types | |
| using | Ptr = std::shared_ptr<FCLDiscreteBVHManager> |
| using | ConstPtr = std::shared_ptr<const FCLDiscreteBVHManager> |
| using | UPtr = std::unique_ptr<FCLDiscreteBVHManager> |
| using | ConstUPtr = std::unique_ptr<const FCLDiscreteBVHManager> |
| Public Types inherited from tesseract::collision::DiscreteContactManager | |
| using | Ptr = std::shared_ptr<DiscreteContactManager> |
| using | ConstPtr = std::shared_ptr<const DiscreteContactManager> |
| using | UPtr = std::unique_ptr<DiscreteContactManager> |
| using | ConstUPtr = std::unique_ptr<const DiscreteContactManager> |
Public Member Functions | |
| FCLDiscreteBVHManager (std::string name="FCLDiscreteBVHManager") | |
| FCLDiscreteBVHManager (const FCLDiscreteBVHManager &)=delete | |
| FCLDiscreteBVHManager & | operator= (const FCLDiscreteBVHManager &)=delete |
| FCLDiscreteBVHManager (FCLDiscreteBVHManager &&)=delete | |
| FCLDiscreteBVHManager & | operator= (FCLDiscreteBVHManager &&)=delete |
| std::string | getName () const override final |
| Get the name of the contact manager. | |
| DiscreteContactManager::UPtr | clone () const override final |
| Clone the manager. | |
| bool | addCollisionObject (const tesseract::common::LinkId &id, const int &mask_id, const CollisionShapesConst &shapes, const tesseract::common::VectorIsometry3d &shape_poses, bool enabled=true) override final |
| Add a object to the checker. | |
| bool | addCollisionObjects (const std::vector< CollisionObjectSpec > &objects) override final |
| Add a batch of collision objects, applying one broadphase update per batch where the backend supports it. | |
| const CollisionShapesConst & | getCollisionObjectGeometries (const tesseract::common::LinkId &id) const override final |
| Get a collision objects collision geometries. | |
| const tesseract::common::VectorIsometry3d & | getCollisionObjectGeometriesTransforms (const tesseract::common::LinkId &id) const override final |
| Get a collision objects collision geometries transforms. | |
| bool | hasCollisionObject (const tesseract::common::LinkId &id) const override final |
| Find if a collision object already exists. | |
| bool | removeCollisionObject (const tesseract::common::LinkId &id) override final |
| Remove an object from the checker. | |
| bool | removeCollisionObjects (const std::vector< tesseract::common::LinkId > &ids) override final |
| Remove a batch of collision objects, applying one broadphase and cache update per batch where the backend supports it. | |
| bool | enableCollisionObject (const tesseract::common::LinkId &id) override final |
| Enable an object. | |
| bool | disableCollisionObject (const tesseract::common::LinkId &id) override final |
| Disable an object. | |
| bool | isCollisionObjectEnabled (const tesseract::common::LinkId &id) const override final |
| Check if collision object is enabled. | |
| void | setCollisionObjectsTransform (const tesseract::common::LinkId &id, const Eigen::Isometry3d &pose) override final |
| Set a single collision object's transforms. | |
| Eigen::Isometry3d | getCollisionObjectsTransform (const tesseract::common::LinkId &id) const override final |
| Get the world transform of a single collision object. | |
| void | setCollisionObjectsTransform (const tesseract::common::LinkIdTransformMap &transforms) override final |
| Set a series of collision object's transforms. | |
| void | setCollisionObjectsTransform (const std::vector< tesseract::common::LinkId > &ids, const tesseract::common::VectorIsometry3d &poses) override final |
| Set a series of collision object's transforms. | |
| const std::vector< tesseract::common::LinkId > & | getCollisionObjects () const override final |
| Get all collision objects. | |
| void | setActiveCollisionObjects (const std::unordered_set< tesseract::common::LinkId > &ids) override final |
| Set which collision objects can move. | |
| const std::unordered_set< tesseract::common::LinkId > & | getActiveCollisionObjects () const override final |
| Get which collision objects can move. | |
| void | setCollisionMarginData (CollisionMarginData collision_margin_data) override final |
| Set the contact distance threshold. | |
| const CollisionMarginData & | getCollisionMarginData () const override final |
| Get the contact distance threshold. | |
| void | setCollisionMarginPairData (const CollisionMarginPairData &pair_margin_data, CollisionMarginPairOverrideType override_type=CollisionMarginPairOverrideType::REPLACE) override final |
| Set the contact distance thresholds for which collision should be considered on a per pair basis. | |
| void | setDefaultCollisionMargin (double default_collision_margin) override final |
| Set the default collision margin. | |
| void | setCollisionMarginPair (const tesseract::common::LinkId &id1, const tesseract::common::LinkId &id2, double collision_margin) override final |
| Set the margin for a given contact pair. | |
| void | incrementCollisionMargin (double increment) override final |
| Increment the collision margin data by some value. | |
| void | setContactAllowedValidator (std::shared_ptr< const tesseract::common::ContactAllowedValidator > validator) override final |
| Set the active function for determining if two links are allowed to be in collision. | |
| std::shared_ptr< const tesseract::common::ContactAllowedValidator > | getContactAllowedValidator () const override final |
| Get the active function for determining if two links are allowed to be in collision. | |
| void | contactTest (ContactResultMap &collisions, const ContactRequest &request) override final |
| Perform a contact test for all objects based. | |
| void | addCollisionObject (const fcl_internal::COW::Ptr &cow) |
| Add a fcl collision object to the manager. | |
| virtual void | setActiveCollisionObjects (const std::vector< tesseract::common::LinkId > &ids) |
| Set which collision objects can move by vector (delegates to set overload). | |
| virtual void | setActiveCollisionObjects (std::initializer_list< tesseract::common::LinkId > ids) |
| Set which collision objects can move by initializer list (delegates to set overload). | |
| virtual void | setCollisionObjectsTransform (const std::unordered_set< tesseract::common::LinkId > &ids, const tesseract::common::LinkIdTransformMap &state) |
| Set the transforms of a set of collision objects from a transform map. | |
| virtual void | setCollisionObjectsTransform (const std::vector< tesseract::common::LinkId > &ids, const tesseract::common::LinkIdTransformMap &state) |
| Set the transforms of a list of collision objects from a transform map. | |
| Public Member Functions inherited from tesseract::collision::DiscreteContactManager | |
| DiscreteContactManager (const DiscreteContactManager &)=delete | |
| DiscreteContactManager & | operator= (const DiscreteContactManager &)=delete |
| DiscreteContactManager (DiscreteContactManager &&)=delete | |
| DiscreteContactManager & | operator= (DiscreteContactManager &&)=delete |
| virtual bool | setCollisionObjectsEnabled (const std::unordered_map< tesseract::common::LinkId, bool > &enabled) |
| Enable or disable a batch of collision objects, applying one broadphase update per batch where the backend supports it. | |
| bool | setCollisionObjectsEnabled (const std::vector< tesseract::common::LinkId > &ids, bool enabled) |
| Enable or disable a batch of collision objects that all take the same state. | |
| virtual void | applyContactManagerConfig (const ContactManagerConfig &config) |
| Applies settings in the config. | |
A FCL implementation of the discrete contact manager.
|
finaloverridevirtual |
Get the name of the contact manager.
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Clone the manager.
This is to be used for multi threaded application. A user should make a clone for each thread.
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Add a object to the checker.
| id | The LinkId of the object, must be unique. |
| mask_id | User defined id which gets stored in the results structure. |
| shapes | A vector of shapes that make up the collision object. |
| shape_poses | A vector of poses for each shape, must be same length as shapes |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Add a batch of collision objects, applying one broadphase update per batch where the backend supports it.
Observably equivalent to calling addCollisionObject once per entry, in order. A false return still leaves every object that was added registered; only the failing ones are absent. Within one batch a repeated id behaves as the repeated single calls do: the last entry naming that id decides both the object and its position in getCollisionObjects(), and if that last entry fails the id is left unregistered even when an earlier entry for it succeeded. Equivalence covers returns, not throws: building an object may throw, and a backend that builds the whole batch before it mutates anything then leaves the manager untouched where the repeated single calls would have left the earlier entries applied.
| objects | The objects to add |
Reimplemented from tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Get a collision objects collision geometries.
| id | The collision object's LinkId |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Get a collision objects collision geometries transforms.
| id | The collision object's LinkId |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Find if a collision object already exists.
| id | The LinkId of the collision object |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Remove an object from the checker.
| id | The LinkId of the object |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Remove a batch of collision objects, applying one broadphase and cache update per batch where the backend supports it.
Observably equivalent to calling removeCollisionObject once per id, in order. Within one batch a repeated id behaves as the repeated single calls do: the first occurrence removes it and the second reports it absent.
| ids | The LinkIds to remove; ids the manager does not hold are skipped |
Reimplemented from tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Enable an object.
| id | The LinkId of the object |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Disable an object.
| id | The LinkId of the object |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Check if collision object is enabled.
| id | The LinkId of the object |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set a single collision object's transforms.
| id | The LinkId of the object |
| pose | The transformation in world |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Get the world transform of a single collision object.
| id | The LinkId of the object |
| std::out_of_range | if the LinkId is not registered with the manager |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set a series of collision object's transforms.
| transforms | A transform map <LinkId, pose> |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set a series of collision object's transforms.
| ids | The LinkIds of the objects |
| poses | The poses, one per id |
| std::runtime_error | if ids and poses differ in size |
Reimplemented from tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Get all collision objects.
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set which collision objects can move.
| ids | A set of LinkIds identifying the active collision objects |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Get which collision objects can move.
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set the contact distance threshold.
| collision_margin_data | The contact distance |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Get the contact distance threshold.
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set the contact distance thresholds for which collision should be considered on a per pair basis.
| pair_margin_data | Contains the pair collision margins that will replace the current settings |
| override_type | This determines how the provided CollisionMarginData is applied |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set the default collision margin.
| default_collision_margin | New default collision margin |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set the margin for a given contact pair.
The order of the object ids does not matter, that is handled internal to the class.
| obj1 | The first object id. Order doesn't matter |
| obj2 | The Second object id. Order doesn't matter |
| collision_margin | contacts with distance < collision_margin are considered in collision |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Increment the collision margin data by some value.
| increment | The value to increment the collision margin value |
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Set the active function for determining if two links are allowed to be in collision.
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Get the active function for determining if two links are allowed to be in collision.
Implements tesseract::collision::DiscreteContactManager.
|
finaloverridevirtual |
Perform a contact test for all objects based.
| collisions | The contact results data |
| request | The contact request data |
Implements tesseract::collision::DiscreteContactManager.
| void tesseract::collision::FCLDiscreteBVHManager::addCollisionObject | ( | const fcl_internal::COW::Ptr & | cow | ) |
Add a fcl collision object to the manager.
| cow | The tesseract fcl collision object |
|
virtual |
Set which collision objects can move by vector (delegates to set overload).
Reimplemented from tesseract::collision::DiscreteContactManager.
|
virtual |
Set which collision objects can move by initializer list (delegates to set overload).
Reimplemented from tesseract::collision::DiscreteContactManager.
|
virtual |
Set the transforms of a set of collision objects from a transform map.
| ids | The LinkIds of the objects to update |
| state | A transform map that must contain every id |
| std::out_of_range | if an id is absent from state |
Reimplemented from tesseract::collision::DiscreteContactManager.
|
virtual |
Set the transforms of a list of collision objects from a transform map.
| std::out_of_range | if an id is absent from state |
Reimplemented from tesseract::collision::DiscreteContactManager.