SMACC2
Loading...
Searching...
No Matches
Classes | Enumerations | Functions
cl_moveit2z 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  ClMoveit2z
 
class  CpGraspingComponent
 
class  CpTFListener
 
class  CpTrajectoryHistory
 
struct  EvIncorrectInitialPosition
 
struct  EvJointDiscontinuity
 
struct  EvMoveGroupMotionExecutionFailed
 
struct  EvMoveGroupMotionExecutionSucceded
 
struct  TfPoseTrack
 
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

Enumerator
SUCCESS 
INCORRECT_INITIAL_STATE 
JOINT_TRAJECTORY_DISCONTINUITY 

Definition at line 43 of file cb_move_end_effector_trajectory.hpp.

Function Documentation

◆ currentJointStatesToString()

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

Definition at line 49 of file cb_move_joints.cpp.

52{
53 auto state = moveGroupInterface.getCurrentState();
54
55 if (state == nullptr) return std::string();
56
57 auto vnames = state->getVariableNames();
58
59 std::stringstream ss;
60
61 for (auto & tgj : targetJoints)
62 {
63 auto it = std::find(vnames.begin(), vnames.end(), tgj.first);
64 auto index = std::distance(vnames.begin(), it);
65
66 ss << tgj.first << ":" << state->getVariablePosition(index) << std::endl;
67 }
68
69 return ss.str();
70}

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

Here is the caller graph for this function: