Joint Velocity Controller. More...

#include <joint_velocity_controller.h>

Inheritance diagram for effort_controllers::JointVelocityController:

Public Member Functions
void	getCommand (double &cmd)
	Get latest velocity command to the joint: revolute (angle) and prismatic (velocity). More...

void	getGains (double &p, double &i, double &d, double &i_max, double &i_min)
	Get the PID parameters. More...

void	getGains (double &p, double &i, double &d, double &i_max, double &i_min, bool &antiwindup)
	Get the PID parameters. More...

std::string	getJointName ()
	Get the name of the joint this controller uses. More...

bool	init (hardware_interface::EffortJointInterface *robot, const std::string &joint_name, const control_toolbox::Pid &pid)

bool	init (hardware_interface::EffortJointInterface *robot, ros::NodeHandle &n)
	The init function is called to initialize the controller from a non-realtime thread with a pointer to the hardware interface, itself, instead of a pointer to a RobotHW. More...

	JointVelocityController ()

void	printDebug ()
	Print debug info to console. More...

void	setCommand (double cmd)
	Give set velocity of the joint for next update: revolute (angle) and prismatic (velocity) More...

void	setGains (const double &p, const double &i, const double &d, const double &i_max, const double &i_min, const bool &antiwindup=false)
	Set the PID parameters. More...

void	starting (const ros::Time &time)
	This is called from within the realtime thread just before the first call to update. More...

void	update (const ros::Time &time, const ros::Duration &period)
	Issues commands to the joint. Should be called at regular intervals. More...

	~JointVelocityController ()

Public Member Functions inherited from controller_interface::Controller< hardware_interface::EffortJointInterface >
virtual bool	init (T *, ros::NodeHandle &)

virtual bool	init (T *, ros::NodeHandle &, ros::NodeHandle &)

Public Member Functions inherited from controller_interface::ControllerBase
virtual void	aborting (const ros::Time &)

virtual void	aborting (const ros::Time &)

bool	abortRequest (const ros::Time &time)

bool	abortRequest (const ros::Time &time)

	ControllerBase ()=default

	ControllerBase (const ControllerBase &)=delete

	ControllerBase (ControllerBase &&)=delete

bool	isAborted () const

bool	isAborted () const

bool	isInitialized () const

bool	isInitialized () const

bool	isRunning () const

bool	isRunning () const

bool	isStopped () const

bool	isStopped () const

bool	isWaiting () const

bool	isWaiting () const

ControllerBase &	operator= (const ControllerBase &)=delete

ControllerBase &	operator= (ControllerBase &&)=delete

bool	startRequest (const ros::Time &time)

bool	startRequest (const ros::Time &time)

virtual void	stopping (const ros::Time &)

virtual void	stopping (const ros::Time &)

bool	stopRequest (const ros::Time &time)

bool	stopRequest (const ros::Time &time)

void	updateRequest (const ros::Time &time, const ros::Duration &period)

void	updateRequest (const ros::Time &time, const ros::Duration &period)

virtual void	waiting (const ros::Time &)

virtual void	waiting (const ros::Time &)

bool	waitRequest (const ros::Time &time)

bool	waitRequest (const ros::Time &time)

virtual	~ControllerBase ()=default

Public Attributes
double	command_

hardware_interface::JointHandle	joint_

Public Attributes inherited from controller_interface::ControllerBase
	ABORTED

	CONSTRUCTED

	INITIALIZED

	RUNNING

enum controller_interface::ControllerBase:: { ... }	state_

	STOPPED

	WAITING

Private Member Functions
void	setCommandCB (const std_msgs::Float64ConstPtr &msg)
	Callback from /command subscriber for setpoint. More...

Private Attributes
std::unique_ptr< realtime_tools::RealtimePublisher< control_msgs::JointControllerState > >	controller_state_publisher_

int	loop_count_

control_toolbox::Pid	pid_controller_

ros::Subscriber	sub_command_

Additional Inherited Members
Public Types inherited from controller_interface::ControllerBase
typedef std::vector< hardware_interface::InterfaceResources >	ClaimedResources

Protected Member Functions inherited from controller_interface::Controller< hardware_interface::EffortJointInterface >
std::string	getHardwareInterfaceType () const

bool	initRequest (hardware_interface::RobotHW *robot_hw, ros::NodeHandle &root_nh, ros::NodeHandle &controller_nh, ClaimedResources &claimed_resources) override

Detailed Description

Joint Velocity Controller.

This class controls velocity using a pid loop.

ROS interface

Parameters

type	Must be "effort_controllers::JointVelocityController"
joint	Name of the joint to control.
pid	Contains the gains for the PID loop around velocity. See: control_toolbox::Pid

Subscribes to:

command (std_msgs::Float64) : The joint velocity to achieve.

Publishes:

state (control_msgs::JointControllerState) : Current state of the controller, including pid error and gains.

Definition at line 74 of file joint_velocity_controller.h.

Constructor & Destructor Documentation

◆ JointVelocityController()

effort_controllers::JointVelocityController::JointVelocityController ( )

Definition at line 42 of file joint_velocity_controller.cpp.

◆ ~JointVelocityController()

effort_controllers::JointVelocityController::~JointVelocityController ( )

Definition at line 46 of file joint_velocity_controller.cpp.

Member Function Documentation

◆ getCommand()

void effort_controllers::JointVelocityController::getCommand ( double & cmd )

Get latest velocity command to the joint: revolute (angle) and prismatic (velocity).

Definition at line 122 of file joint_velocity_controller.cpp.

◆ getGains() [1/2]

void effort_controllers::JointVelocityController::getGains	(	double &	p,
		double &	i,
		double &	d,
		double &	i_max,
		double &	i_min
	)

Get the PID parameters.

Definition at line 99 of file joint_velocity_controller.cpp.

◆ getGains() [2/2]

void effort_controllers::JointVelocityController::getGains	(	double &	p,
		double &	i,
		double &	d,
		double &	i_max,
		double &	i_min,
		bool &	antiwindup
	)

Get the PID parameters.

Definition at line 94 of file joint_velocity_controller.cpp.

◆ getJointName()

std::string effort_controllers::JointVelocityController::getJointName ( )

Get the name of the joint this controller uses.

Definition at line 110 of file joint_velocity_controller.cpp.

◆ init() [1/2]

bool effort_controllers::JointVelocityController::init	(	hardware_interface::EffortJointInterface *	robot,
		const std::string &	joint_name,
		const control_toolbox::Pid &	pid
	)

Definition at line 51 of file joint_velocity_controller.cpp.

◆ init() [2/2]

bool effort_controllers::JointVelocityController::init	(	hardware_interface::EffortJointInterface *	robot,
		ros::NodeHandle &	n
	)

The init function is called to initialize the controller from a non-realtime thread with a pointer to the hardware interface, itself, instead of a pointer to a RobotHW.

Parameters

robot	The specific hardware interface used by this controller.
n	A NodeHandle in the namespace from which the controller should read its configuration, and where it should set up its ROS interface.

Returns: True if initialization was successful and the controller is ready to be started.

Definition at line 62 of file joint_velocity_controller.cpp.

◆ printDebug()

void effort_controllers::JointVelocityController::printDebug ( )

Print debug info to console.

Definition at line 105 of file joint_velocity_controller.cpp.

◆ setCommand()

void effort_controllers::JointVelocityController::setCommand ( double cmd )

Give set velocity of the joint for next update: revolute (angle) and prismatic (velocity)

Parameters

double pos Velocity command to issue

Definition at line 116 of file joint_velocity_controller.cpp.

◆ setCommandCB()

void effort_controllers::JointVelocityController::setCommandCB ( const std_msgs::Float64ConstPtr & msg )

private

Callback from /command subscriber for setpoint.

Definition at line 170 of file joint_velocity_controller.cpp.

◆ setGains()

void effort_controllers::JointVelocityController::setGains	(	const double &	p,
		const double &	i,
		const double &	d,
		const double &	i_max,
		const double &	i_min,
		const bool &	antiwindup = `false`
	)

Set the PID parameters.

Definition at line 89 of file joint_velocity_controller.cpp.

◆ starting()

void effort_controllers::JointVelocityController::starting ( const ros::Time & time )

virtual

This is called from within the realtime thread just before the first call to update.

Parameters

time	The current time

Reimplemented from controller_interface::ControllerBase.

Definition at line 127 of file joint_velocity_controller.cpp.

◆ update()

void effort_controllers::JointVelocityController::update	(	const ros::Time &	time,
		const ros::Duration &	period
	)

virtual

Issues commands to the joint. Should be called at regular intervals.

Implements controller_interface::ControllerBase.

Definition at line 133 of file joint_velocity_controller.cpp.

Member Data Documentation

◆ command_

double effort_controllers::JointVelocityController::command_

Last commanded velocity.

Definition at line 148 of file joint_velocity_controller.h.

◆ controller_state_publisher_

std::unique_ptr< realtime_tools::RealtimePublisher< control_msgs::JointControllerState> > effort_controllers::JointVelocityController::controller_state_publisher_

private

Definition at line 156 of file joint_velocity_controller.h.

◆ joint_

hardware_interface::JointHandle effort_controllers::JointVelocityController::joint_

Definition at line 147 of file joint_velocity_controller.h.

◆ loop_count_

int effort_controllers::JointVelocityController::loop_count_

private

Definition at line 151 of file joint_velocity_controller.h.

◆ pid_controller_

control_toolbox::Pid effort_controllers::JointVelocityController::pid_controller_

private

Internal PID controller.

Definition at line 152 of file joint_velocity_controller.h.

◆ sub_command_

ros::Subscriber effort_controllers::JointVelocityController::sub_command_

private

Definition at line 158 of file joint_velocity_controller.h.

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

Public Member Functions

Public Attributes

Private Member Functions

Private Attributes

Additional Inherited Members

Detailed Description

ROS interface

Constructor & Destructor Documentation

◆ JointVelocityController()

◆ ~JointVelocityController()

Member Function Documentation

◆ getCommand()

◆ getGains() [1/2]

◆ getGains() [2/2]

◆ getJointName()

◆ init() [1/2]

◆ init() [2/2]

◆ printDebug()

◆ setCommand()

◆ setCommandCB()

◆ setGains()

◆ starting()

◆ update()

Member Data Documentation

◆ command_

◆ controller_state_publisher_

◆ joint_

◆ loop_count_

◆ pid_controller_

◆ sub_command_