The CartesianControlClientROS2 class implements ICartesianControl client side.

#include <CartesianControlClientROS2.hpp>

Inheritance diagram for CartesianControlClientROS2:

Public Member Functions
yarp::dev::ReturnValue	getState (roboticslab::ICartesianControl::ControllerState &state) override
	Current state and position.

yarp::dev::ReturnValue	solvePose (const std::vector< double > &xd, std::vector< double > &q) override
	Inverse kinematics.

yarp::dev::ReturnValue	moveJoint (const std::vector< double > &xd) override
	Move in joint space.

yarp::dev::ReturnValue	moveLinear (const std::vector< double > &xd) override
	Linear move to target position.

yarp::dev::ReturnValue	moveVelocity (const std::vector< double > &xdotd) override
	Linear move with given velocity.

yarp::dev::ReturnValue	gravityCompensation () override
	Gravity compensation.

yarp::dev::ReturnValue	forceControl (const std::vector< double > &fd) override
	Force control.

yarp::dev::ReturnValue	stopControl () override
	Stop control.

yarp::dev::ReturnValue	changeTool (const std::vector< double > &x) override
	Change tool.

yarp::dev::ReturnValue	actuateTool (roboticslab::ICartesianControl::Actuator command) override
	Actuate tool.

void	pose (const std::vector< double > &x) override
	Achieve pose.

void	twist (const std::vector< double > &xdot) override
	Instantaneous velocity steps.

void	wrench (const std::vector< double > &w) override
	Exert force.

yarp::dev::ReturnValue	setParameter (roboticslab::ICartesianControl::Config vocab, double value) override
	Set a configuration parameter.

yarp::dev::ReturnValue	getParameter (roboticslab::ICartesianControl::Config vocab, double *value) override
	Retrieve a configuration parameter.

yarp::dev::ReturnValue	setParameters (const std::map< roboticslab::ICartesianControl::Config, double > &params) override

yarp::dev::ReturnValue	getParameters (std::map< roboticslab::ICartesianControl::Config, double > &params) override

bool	open (yarp::os::Searchable &config) override

bool	close () override

Public Member Functions inherited from roboticslab::ICartesianControl
virtual	~ICartesianControl ()=default
	Destructor.

virtual bool	stat (std::vector< double > &x, int state=nullptr, double timestamp=nullptr)

virtual bool	inv (const std::vector< double > &xd, std::vector< double > &q)

virtual bool	movj (const std::vector< double > &xd)

virtual bool	relj (const std::vector< double > &xd)

virtual bool	movl (const std::vector< double > &xd)

virtual bool	movv (const std::vector< double > &xdotd)

virtual bool	gcmp ()

virtual bool	forc (const std::vector< double > &fd)

virtual bool	wait (double timeout=0.0)

virtual bool	tool (const std::vector< double > &x)

virtual bool	act (int command)

virtual bool	setParameter (int vocab, double value)

virtual bool	getParameter (int vocab, double *value)

virtual bool	setParameters (const std::map< int, double > &params)

virtual bool	getParameters (std::map< int, double > &params)

virtual yarp::dev::ReturnValue	setParameters (const std::map< Config, double > &params)=0
	Set multiple configuration parameters.

virtual yarp::dev::ReturnValue	getParameters (std::map< Config, double > &params)=0
	Retrieve multiple configuration parameters.

Public Member Functions inherited from CartesianControlClientROS2_ParamsParser
bool	parseParams (const yarp::os::Searchable &config) override

std::string	getDeviceClassName () const override

std::string	getDeviceName () const override

std::string	getDocumentationOfDeviceParams () const override

std::vector< std::string >	getListOfParams () const override

bool	getParamValue (const std::string &paramName, std::string &paramValue) const override

std::string	getConfiguration () const override

Private Member Functions
bool	configureRosHandlers ()

bool	populateRosParameters ()

yarp::dev::ReturnValue	sendTrajectoryGoal (roboticslab::ICartesianControl::Mode mode, const std::vector< double > &xd)

Private Attributes
rclcpp::Node::SharedPtr	m_node

roboticslab::ros2utils::Spinner::Ptr	m_spinner

rclcpp::Publisher< geometry_msgs::msg::Pose >::SharedPtr	m_pose

rclcpp::Publisher< geometry_msgs::msg::Twist >::SharedPtr	m_twist

rclcpp::Publisher< geometry_msgs::msg::Wrench >::SharedPtr	m_wrench

rclcpp::Subscription< geometry_msgs::msg::PoseStamped >::SharedPtr	m_state

rclcpp_action::Client< rl_cartesian_control_msgs::action::PoseTrajectory >::SharedPtr	m_trajectory

rclcpp::Client< rl_cartesian_control_msgs::srv::MoveVelocity >::SharedPtr	m_move_v

rclcpp::Client< rl_cartesian_control_msgs::srv::ForceControl >::SharedPtr	m_force

rclcpp::Client< rl_cartesian_control_msgs::srv::ChangeTool >::SharedPtr	m_tool

rclcpp::Client< rl_cartesian_control_msgs::srv::SolvePose >::SharedPtr	m_inv

rclcpp::Client< rl_cartesian_control_msgs::srv::ActuateTool >::SharedPtr	m_act

rclcpp::Client< std_srvs::srv::Trigger >::SharedPtr	m_gcmp

rclcpp::Client< std_srvs::srv::Trigger >::SharedPtr	m_stop

rclcpp::Client< rcl_interfaces::srv::GetParameters >::SharedPtr	m_get_params

rclcpp::Client< rcl_interfaces::srv::SetParameters >::SharedPtr	m_set_params

std::mutex	m_mutex_state

geometry_msgs::msg::PoseStamped	m_pose_last

std::atomic< float >	m_progress {1.0f}

std::atomic< bool >	m_success {false}

std::vector< std::string >	m_supported_parameters

Additional Inherited Members
Public Types inherited from roboticslab::ICartesianControl
enum class	Vocabs { OK = yarp::os::createVocab32('o','k') , FAILED = yarp::os::createVocab32('f','a','i','l') , SET = yarp::os::createVocab32('s','e','t') , GET = yarp::os::createVocab32('g','e','t') , NOT_SET = yarp::os::createVocab32('n','s','e','t') }
	General-purpose vocabs. More...

enum class	RPC { STATE = yarp::os::createVocab32('s','t','a','t') , INV = yarp::os::createVocab32('i','n','v') , MOVEJ = yarp::os::createVocab32('m','o','v','j') , MOVEL = yarp::os::createVocab32('m','o','v','l') , MOVEV = yarp::os::createVocab32('m','o','v','v') , GCMP = yarp::os::createVocab32('g','c','m','p') , FORCE = yarp::os::createVocab32('f','o','r','c') , STOP = yarp::os::createVocab32('s','t','o','p') , TOOL = yarp::os::createVocab32('t','o','o','l') , ACT = yarp::os::createVocab32('a','c','t') }
	RPC vocabs. More...

enum class	Streaming { POSE = yarp::os::createVocab32('p','o','s','e') , TWIST = yarp::os::createVocab32('t','w','s','t') , WRENCH = yarp::os::createVocab32('w','r','n','c') }
	Streaming vocabs. More...

enum class	Mode { NONE = yarp::os::createVocab32('n','c','t','l') , MOVEJ = yarp::os::createVocab32('m','o','v','j') , MOVEL = yarp::os::createVocab32('m','o','v','l') , MOVEV = yarp::os::createVocab32('m','o','v','v') , GCMP = yarp::os::createVocab32('g','c','m','p') , FORCE = yarp::os::createVocab32('f','o','r','c') }
	Controller mode vocabs. More...

enum class	Actuator { NONE = yarp::os::createVocab32('a','c','n') , CLOSE = yarp::os::createVocab32('a','c','c','g') , OPEN = yarp::os::createVocab32('a','c','o','g') , STOP = yarp::os::createVocab32('a','c','s','g') , GENERIC = yarp::os::createVocab32('a','c','g') }
	Actuator control vocabs. More...

enum class	Config { GAIN = yarp::os::createVocab32('c','p','c','g') , TRAJ_DURATION = yarp::os::createVocab32('c','p','t','d') , TRAJ_REF_SPD = yarp::os::createVocab32('c','p','t','s') , TRAJ_REF_ACC = yarp::os::createVocab32('c','p','t','a') , CMC_PERIOD = yarp::os::createVocab32('c','p','c','p') , FRAME = yarp::os::createVocab32('c','p','f') , STREAMING_CMD = yarp::os::createVocab32('c','p','s','c') }
	Controller configuration vocabs. More...

Public Attributes inherited from CartesianControlClientROS2_ParamsParser
const std::string	m_device_classname = {"CartesianControlClientROS2"}

const std::string	m_device_name = {"CartesianControlClientROS2"}

bool	m_parser_is_strict = false

const parser_version_type	m_parser_version = {}

std::string	m_provided_configuration

const std::string	m_local_defaultValue = {"cartesian_control_client_ros2"}

const std::string	m_remote_defaultValue = {"cartesian_control_server_ros2"}

std::string	m_local = {"cartesian_control_client_ros2"}

std::string	m_remote = {"cartesian_control_server_ros2"}

Member Function Documentation

◆ actuateTool()

yarp::dev::ReturnValue CartesianControlClientROS2::actuateTool ( roboticslab::ICartesianControl::Actuator command )

overridevirtual

Send control command to actuate the robot's tool, if available.

Parameters

command One of the available ICartesianControl::Actuator vocabs.

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ changeTool()

yarp::dev::ReturnValue CartesianControlClientROS2::changeTool ( const std::vector< double > & x )

overridevirtual

Unload current tool if any and append new tool frame to the kinematic chain.

Parameters

x	6-element vector describing new tool tip with regard to current end-effector frame in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians).

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ forceControl()

yarp::dev::ReturnValue CartesianControlClientROS2::forceControl ( const std::vector< double > & fd )

overridevirtual

Apply desired forces in task space.

Parameters

fd	6-element vector describing desired force exerted by the TCP in cartesian space; first three elements denote linear force (Newton), last three denote torque (Newton*meters).

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ getParameter()

yarp::dev::ReturnValue CartesianControlClientROS2::getParameter	(	roboticslab::ICartesianControl::Config	vocab,
		double *	value
	)

overridevirtual

Ask the controller to retrieve a parameter of 'double' type.

Parameters

vocab	YARP-encoded vocab (parameter key).
value	Parameter value encoded as a double.

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ getState()

yarp::dev::ReturnValue CartesianControlClientROS2::getState ( roboticslab::ICartesianControl::ControllerState & state )

overridevirtual

Inform on control state, get robot position and perform forward kinematics.

Parameters

state Controller state data.

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ gravityCompensation()

yarp::dev::ReturnValue CartesianControlClientROS2::gravityCompensation ( )

overridevirtual

Enable gravity compensation.

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ moveJoint()

yarp::dev::ReturnValue CartesianControlClientROS2::moveJoint ( const std::vector< double > & xd )

overridevirtual

Perform inverse kinematics and move to desired position in joint space using absolute coordinates.

Parameters

xd	6-element vector describing desired position in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians).

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ moveLinear()

yarp::dev::ReturnValue CartesianControlClientROS2::moveLinear ( const std::vector< double > & xd )

overridevirtual

Move to end position along a line trajectory.

Parameters

xd	6-element vector describing desired position in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians).

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ moveVelocity()

yarp::dev::ReturnValue CartesianControlClientROS2::moveVelocity ( const std::vector< double > & xdotd )

overridevirtual

Move along a line with constant velocity.

Parameters

xdotd 6-element vector describing desired velocity in cartesian space; first three elements denote translational velocity (meters/second), last three denote angular velocity (radians/second).

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ pose()

void CartesianControlClientROS2::pose ( const std::vector< double > & x )

overridevirtual

Move to desired position instantaneously, no further intermediate calculations are expected other than computing the inverse kinematics.

Parameters

x	6-element vector describing desired instantaneous pose in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians).

Implements roboticslab::ICartesianControl.

◆ setParameter()

yarp::dev::ReturnValue CartesianControlClientROS2::setParameter	(	roboticslab::ICartesianControl::Config	vocab,
		double	value
	)

overridevirtual

Ask the controller to store or update a parameter of 'double' type.

Parameters

vocab	YARP-encoded vocab (parameter key).
value	Parameter value encoded as a double.

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ solvePose()

yarp::dev::ReturnValue CartesianControlClientROS2::solvePose	(	const std::vector< double > &	xd,
		std::vector< double > &	q
	)

overridevirtual

Perform inverse kinematics (using robot position as initial guess), but do not move.

Parameters

xd	6-element vector describing desired position in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians).
q	Vector describing current position in joint space (meters or degrees).

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ stopControl()

yarp::dev::ReturnValue CartesianControlClientROS2::stopControl ( )

overridevirtual

Halt current control loop if any and cease movement.

Returns: true on success, false otherwise

Implements roboticslab::ICartesianControl.

◆ twist()

void CartesianControlClientROS2::twist ( const std::vector< double > & xdot )

overridevirtual

Move in instantaneous velocity increments.

Parameters

xdot	6-element vector describing velocity increments in cartesian space; first three elements denote translational velocity (meters/second), last three denote angular velocity (radians/second).

Implements roboticslab::ICartesianControl.

◆ wrench()

void CartesianControlClientROS2::wrench ( const std::vector< double > & w )

overridevirtual

Make the TCP exert the desired force instantaneously.

Parameters

w	6-element vector describing desired force exerted by the TCP in cartesian space; first three elements denote linear force (Newton), last three denote torque (Newton*meters).

Implements roboticslab::ICartesianControl.

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

libraries/YarpPlugins/CartesianControlClientROS2/CartesianControlClientROS2.hpp
libraries/YarpPlugins/CartesianControlClientROS2/CartesianControlClientROS2.cpp
libraries/YarpPlugins/CartesianControlClientROS2/DeviceDriverImpl.cpp
libraries/YarpPlugins/CartesianControlClientROS2/ICartesianControlImpl.cpp

Public Member Functions

Private Member Functions

Private Attributes

Additional Inherited Members

Member Function Documentation

◆ actuateTool()

◆ changeTool()

◆ forceControl()

◆ getParameter()

◆ getState()

◆ gravityCompensation()

◆ moveJoint()

◆ moveLinear()

◆ moveVelocity()

◆ pose()

◆ setParameter()

◆ solvePose()

◆ stopControl()

◆ twist()

◆ wrench()