SMACC2
Loading...
Searching...
No Matches
cl_moveit2z::CpGraspingComponent Class Reference

#include <cp_grasping_objects.hpp>

Inheritance diagram for cl_moveit2z::CpGraspingComponent:
Inheritance graph
Collaboration diagram for cl_moveit2z::CpGraspingComponent:
Collaboration graph

Public Member Functions

bool getGraspingObject (std::string name, moveit_msgs::msg::CollisionObject &object)
 
void createGraspableBox (std::string frameid, float x, float y, float z, float xl, float yl, float zl)
 
bool getGraspingObject (std::string name, moveit_msgs::msg::CollisionObject &object)
 
void createGraspableBox (std::string frameid, float x, float y, float z, float xl, float yl, float zl)
 
- Public Member Functions inherited from smacc2::ISmaccComponent
 ISmaccComponent ()
 
virtual ~ISmaccComponent ()
 
virtual std::string getName () const
 

Public Attributes

std::vector< std::string > fingerTipNames
 
std::string gripperLink_ = "gripper_link"
 
std::optional< std::string > currentAttachedObjectName
 

Private Attributes

std::map< std::string, moveit_msgs::msg::CollisionObject > graspingObjects
 

Additional Inherited Members

- Protected Member Functions inherited from smacc2::ISmaccComponent
virtual void onInitialize ()
 
template<typename TOrthogonal , typename TClient >
void onComponentInitialization ()
 
template<typename EventType >
void postEvent (const EventType &ev)
 
template<typename EventType >
void postEvent ()
 
template<typename TOrthogonal , typename TSourceObject >
void onOrthogonalAllocation ()
 
template<typename TOrthogonal , typename TSourceObject >
void onStateOrthogonalAllocation ()
 
template<typename TComponent >
void requiresComponent (TComponent *&requiredComponentStorage, bool throwExceptionIfNotExist)
 
template<typename TComponent >
void requiresComponent (std::string name, TComponent *&requiredComponentStorage, bool throwExceptionIfNotExist)
 
template<typename TComponent >
void requiresComponent (TComponent *&requiredComponentStorage, ComponentRequirement requirementType=ComponentRequirement::SOFT)
 
template<typename TComponent >
void requiresComponent (std::string name, TComponent *&requiredComponentStorage, ComponentRequirement requirementType=ComponentRequirement::SOFT)
 
template<typename TClient >
void requiresClient (TClient *&requiredClientStorage)
 
template<typename SmaccComponentType , typename TOrthogonal , typename TClient , typename... TArgs>
SmaccComponentType * createSiblingComponent (TArgs... targs)
 
template<typename SmaccComponentType , typename TOrthogonal , typename TClient , typename... TArgs>
SmaccComponentType * createSiblingNamedComponent (std::string name, TArgs... targs)
 
rclcpp::Node::SharedPtr getNode ()
 
rclcpp::Logger getLogger () const
 
ISmaccStateMachinegetStateMachine ()
 
- Protected Attributes inherited from smacc2::ISmaccComponent
ISmaccStateMachinestateMachine_
 
ISmaccClientowner_
 

Detailed Description

Definition at line 30 of file cp_grasping_objects.hpp.

Member Function Documentation

◆ createGraspableBox() [1/2]

void cl_moveit2z::CpGraspingComponent::createGraspableBox ( std::string frameid,
float x,
float y,
float z,
float xl,
float yl,
float zl )
inline

Definition at line 54 of file cp_grasping_objects.hpp.

56 {
57 RCLCPP_INFO_STREAM(
58 getLogger(), "[" << getName() << "] creating grasping object in planning scene: " << frameid);
59 moveit_msgs::msg::CollisionObject collision;
60 auto boxname = frameid;
61 ;
62 collision.id = boxname;
63 collision.header.frame_id = frameid;
64
65 collision.primitives.resize(1);
66 collision.primitives[0].type = collision.primitives[0].BOX;
67 collision.primitives[0].dimensions.resize(3);
68
69 collision.primitives[0].dimensions[0] = xl;
70 collision.primitives[0].dimensions[1] = yl;
71 collision.primitives[0].dimensions[2] = zl;
72
73 collision.primitive_poses.resize(1);
74 collision.primitive_poses[0].position.x = x;
75 collision.primitive_poses[0].position.y = y;
76 collision.primitive_poses[0].position.z = z;
77 collision.primitive_poses[0].orientation.w = 1.0;
78
79 graspingObjects[boxname] = collision;
80 }
std::map< std::string, moveit_msgs::msg::CollisionObject > graspingObjects
virtual std::string getName() const
rclcpp::Logger getLogger() const
const std::string frameid

References smacc2::ISmaccComponent::getLogger(), smacc2::ISmaccComponent::getName(), and graspingObjects.

Here is the call graph for this function:

◆ createGraspableBox() [2/2]

void cl_moveit2z::CpGraspingComponent::createGraspableBox ( std::string frameid,
float x,
float y,
float z,
float xl,
float yl,
float zl )

◆ getGraspingObject() [1/2]

bool cl_moveit2z::CpGraspingComponent::getGraspingObject ( std::string name,
moveit_msgs::msg::CollisionObject & object )
inline

Definition at line 41 of file cp_grasping_objects.hpp.

42 {
43 if (this->graspingObjects.count(name))
44 {
45 object = this->graspingObjects[name];
46 return true;
47 }
48 else
49 {
50 return false;
51 }
52 }

Referenced by cl_moveit2z::CbAttachObject::onEntry().

Here is the caller graph for this function:

◆ getGraspingObject() [2/2]

bool cl_moveit2z::CpGraspingComponent::getGraspingObject ( std::string name,
moveit_msgs::msg::CollisionObject & object )

Member Data Documentation

◆ currentAttachedObjectName

std::optional< std::string > cl_moveit2z::CpGraspingComponent::currentAttachedObjectName

◆ fingerTipNames

std::vector< std::string > cl_moveit2z::CpGraspingComponent::fingerTipNames

Definition at line 36 of file cp_grasping_objects.hpp.

Referenced by cl_moveit2z::CbAttachObject::onEntry().

◆ graspingObjects

std::map< std::string, moveit_msgs::msg::CollisionObject > cl_moveit2z::CpGraspingComponent::graspingObjects
private

Definition at line 33 of file cp_grasping_objects.hpp.

Referenced by createGraspableBox().

◆ gripperLink_

std::string cl_moveit2z::CpGraspingComponent::gripperLink_ = "gripper_link"

Definition at line 37 of file cp_grasping_objects.hpp.

Referenced by cl_moveit2z::CbAttachObject::onEntry().


The documentation for this class was generated from the following files: