SMACC
Loading...
Searching...
No Matches
Classes | Enumerations | Functions
cl_move_group_interface Namespace Reference

Classes

class  CbAttachObject
 
class  CbCircularPivotMotion
 
class  CbCircularPouringMotion
 
class  CbDetachObject
 
class  CbEndEffectorRotate
 
class  CbExecuteLastTrajectory
 
class  CbMoveCartesianRelative
 
class  CbMoveCartesianRelative2
 
class  CbMoveEndEffector
 
class  CbMoveEndEffectorRelative
 
class  CbMoveEndEffectorTrajectory
 
class  CbMoveJoints
 
class  CbMoveKnownState
 
class  CbMoveLastTrajectoryInitialState
 
class  CbMoveNamedTarget
 
class  CbUndoLastTrajectory
 
class  ClMoveGroup
 
class  CpTrajectoryHistory
 
struct  EvIncorrectInitialPosition
 
struct  EvJointDiscontinuity
 
struct  EvMoveGroupMotionExecutionFailed
 
struct  EvMoveGroupMotionExecutionSucceded
 
class  GraspingComponent
 
struct  TrajectoryHistoryEntry
 

Enumerations

enum class  ComputeJointTrajectoryErrorCode { SUCCESS , INCORRECT_INITIAL_STATE , JOINT_TRAJECTORY_DISCONTINUITY }
 

Functions

std::string currentJointStatesToString (moveit::planning_interface::MoveGroupInterface &moveGroupInterface, std::map< std::string, double > &targetJoints)
 

Enumeration Type Documentation

◆ ComputeJointTrajectoryErrorCode

Function Documentation

◆ currentJointStatesToString()

std::string cl_move_group_interface::currentJointStatesToString ( moveit::planning_interface::MoveGroupInterface &  moveGroupInterface,
std::map< std::string, double > &  targetJoints 
)

Definition at line 35 of file cb_move_joints.cpp.

36 {
37 auto state = moveGroupInterface.getCurrentState();
38 auto vnames = state->getVariableNames();
39
40 std::stringstream ss;
41
42 for(auto& tgj: targetJoints)
43 {
44 auto it = std::find(vnames.begin(),vnames.end(), tgj.first);
45 auto index = std::distance(vnames.begin(), it);
46
47 ss << tgj.first << ":" << state->getVariablePosition(index) << std::endl;
48 }
49
50 return ss.str();
51 }

Referenced by cl_move_group_interface::CbMoveJoints::moveJoints().

Here is the caller graph for this function: