Maintains a network connection to the robot, provides the current robot state, gives access to the model library and allows to control the robot. More...

#include <robot.h>

Public Types
using	ServerVersion = uint16_t
	Version of the robot server.

Public Member Functions
	Robot (const std::string &franka_address, RealtimeConfig realtime_config=RealtimeConfig::kEnforce, size_t log_size=50)
	Establishes a connection with the robot. More...

	Robot (Robot &&other) noexcept
	Move-constructs a new Robot instance. More...

Robot &	operator= (Robot &&other) noexcept
	Move-assigns this Robot from another Robot instance. More...

	~Robot () noexcept
	Closes the connection.

void	read (std::function< bool(const RobotState &)> read_callback)
	Starts a loop for reading the current robot state. More...

RobotState	readOnce ()
	Waits for a robot state update and returns it. More...

Model	loadModel ()
	Loads the model library from the robot. More...

ServerVersion	serverVersion () const noexcept
	Returns the software version reported by the connected server. More...

Motion generation and joint-level torque commands
The following methods allow to perform motion generation and/or send joint-level torque commands without gravity and friction by providing callback functions. Only one of these methods can be active at the same time; a franka::ControlException is thrown otherwise. When a robot state is received, the callback function is used to calculate the response: the desired values for that time step. After sending back the response, the callback function will be called again with the most recently received robot state. Since the robot is controlled with a 1 kHz frequency, the callback functions have to compute their result in a short time frame in order to be accepted. Callback functions take two parameters: A franka::RobotState showing the current robot state. A franka::Duration to indicate the time since the last callback invocation. Thus, the duration is zero on the first invocation of the callback function! The following incomplete example shows the general structure of a callback function: double time = 0.0; auto control_callback = [&time](const franka::RobotState& robot_state, franka::Duration time_step) -> franka::JointPositions { time += time_step.toSec(); // Update time at the beginning of the callback. franka::JointPositions output = getJointPositions(time); if (time >= max_time) { // Return MotionFinished at the end of the trajectory. return franka::MotionFinished(output); } return output; }
void	control (std::function< Torques(const RobotState &, franka::Duration)> control_callback, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for sending joint-level torque commands. More...

void	control (std::function< Torques(const RobotState &, franka::Duration)> control_callback, std::function< JointPositions(const RobotState &, franka::Duration)> motion_generator_callback, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for sending joint-level torque commands and joint positions. More...

void	control (std::function< Torques(const RobotState &, franka::Duration)> control_callback, std::function< JointVelocities(const RobotState &, franka::Duration)> motion_generator_callback, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for sending joint-level torque commands and joint velocities. More...

void	control (std::function< Torques(const RobotState &, franka::Duration)> control_callback, std::function< CartesianPose(const RobotState &, franka::Duration)> motion_generator_callback, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for sending joint-level torque commands and Cartesian poses. More...

void	control (std::function< Torques(const RobotState &, franka::Duration)> control_callback, std::function< CartesianVelocities(const RobotState &, franka::Duration)> motion_generator_callback, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for sending joint-level torque commands and Cartesian velocities. More...

void	control (std::function< JointPositions(const RobotState &, franka::Duration)> motion_generator_callback, ControllerMode controller_mode=ControllerMode::kJointImpedance, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for a joint position motion generator with a given controller mode. More...

void	control (std::function< JointVelocities(const RobotState &, franka::Duration)> motion_generator_callback, ControllerMode controller_mode=ControllerMode::kJointImpedance, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for a joint velocity motion generator with a given controller mode. More...

void	control (std::function< CartesianPose(const RobotState &, franka::Duration)> motion_generator_callback, ControllerMode controller_mode=ControllerMode::kJointImpedance, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for a Cartesian pose motion generator with a given controller mode. More...

void	control (std::function< CartesianVelocities(const RobotState &, franka::Duration)> motion_generator_callback, ControllerMode controller_mode=ControllerMode::kJointImpedance, bool limit_rate=true, double cutoff_frequency=kDefaultCutoffFrequency)
	Starts a control loop for a Cartesian velocity motion generator with a given controller mode. More...

Commands
Commands are executed by communicating with the robot over the network. These functions should therefore not be called from within control or motion generator loops.
VirtualWallCuboid	getVirtualWall (int32_t id)
	Returns the parameters of a virtual wall. More...

void	setCollisionBehavior (const std::array< double, 7 > &lower_torque_thresholds_acceleration, const std::array< double, 7 > &upper_torque_thresholds_acceleration, const std::array< double, 7 > &lower_torque_thresholds_nominal, const std::array< double, 7 > &upper_torque_thresholds_nominal, const std::array< double, 6 > &lower_force_thresholds_acceleration, const std::array< double, 6 > &upper_force_thresholds_acceleration, const std::array< double, 6 > &lower_force_thresholds_nominal, const std::array< double, 6 > &upper_force_thresholds_nominal)
	Changes the collision behavior. More...

void	setCollisionBehavior (const std::array< double, 7 > &lower_torque_thresholds, const std::array< double, 7 > &upper_torque_thresholds, const std::array< double, 6 > &lower_force_thresholds, const std::array< double, 6 > &upper_force_thresholds)
	Changes the collision behavior. More...

void	setJointImpedance (const std::array< double, 7 > &K_theta)
	Sets the impedance for each joint in the internal controller. More...

void	setCartesianImpedance (const std::array< double, 6 > &K_x)
	Sets the Cartesian impedance for (x, y, z, roll, pitch, yaw) in the internal controller. More...

void	setGuidingMode (const std::array< bool, 6 > &guiding_mode, bool elbow)
	Locks or unlocks guiding mode movement in (x, y, z, roll, pitch, yaw). More...

void	setK (const std::array< double, 16 > &EE_T_K)
	Sets the transformation \(^{EE}T_K\) from end effector frame to stiffness frame. More...

void	setEE (const std::array< double, 16 > &NE_T_EE)
	Sets the transformation \(^{NE}T_{EE}\) from nominal end effector to end effector frame. More...

void	setLoad (double load_mass, const std::array< double, 3 > &F_x_Cload, const std::array< double, 9 > &load_inertia)
	Sets dynamic parameters of a payload. More...

void	setFilters (double joint_position_filter_frequency, double joint_velocity_filter_frequency, double cartesian_position_filter_frequency, double cartesian_velocity_filter_frequency, double controller_filter_frequency)
	Sets the cut off frequency for the given motion generator or controller. More...

void	automaticErrorRecovery ()
	Runs automatic error recovery on the robot. More...

void	stop ()
	Stops all currently running motions. More...

Detailed Description

Maintains a network connection to the robot, provides the current robot state, gives access to the model library and allows to control the robot.

Note: The members of this class are threadsafe.

Nominal end effector frame NE: The nominal end effector frame is configured outside of libfranka and cannot be changed here.

End effector frame EE: By default, the end effector frame EE is the same as the nominal end effector frame NE (i.e. the transformation between NE and EE is the identity transformation). With Robot::setEE, a custom transformation matrix can be set.

Stiffness frame K: The stiffness frame is used for Cartesian impedance control, and for measuring and applying forces. It can be set with Robot::setK.

Examples:: cartesian_impedance_control.cpp, communication_test.cpp, echo_robot_state.cpp, force_control.cpp, generate_cartesian_pose_motion.cpp, generate_cartesian_velocity_motion.cpp, generate_consecutive_motions.cpp, generate_elbow_motion.cpp, generate_joint_position_motion.cpp, generate_joint_velocity_motion.cpp, joint_impedance_control.cpp, joint_point_to_point_motion.cpp, motion_with_control.cpp, and print_joint_poses.cpp.

Constructor & Destructor Documentation

◆ Robot() [1/2]

franka::Robot::Robot	(	const std::string &	franka_address,
		RealtimeConfig	realtime_config = `RealtimeConfig::kEnforce`,
		size_t	log_size = `50`
	)

explicit

Establishes a connection with the robot.

Parameters

[in]	franka_address	IP/hostname of the robot.
[in]	realtime_config	if set to Enforce, an exception will be thrown if realtime priority cannot be set when required. Setting realtime_config to Ignore disables this behavior.
[in]	log_size	sets how many last states should be kept for logging purposes. The log is provided when a ControlException is thrown.

Exceptions

NetworkException	if the connection is unsuccessful.
IncompatibleVersionException	if this version of `libfranka` is not supported.

◆ Robot() [2/2]

franka::Robot::Robot ( Robot && other )

noexcept

Move-constructs a new Robot instance.

Parameters

[in] other Other Robot instance.

Member Function Documentation

◆ automaticErrorRecovery()

void franka::Robot::automaticErrorRecovery ( )

Runs automatic error recovery on the robot.

Automatic error recovery e.g. resets the robot after a collision occurred.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

Examples:: generate_consecutive_motions.cpp.

◆ control() [1/9]

void franka::Robot::control	(	std::function< Torques(const RobotState &, franka::Duration)>	control_callback,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for sending joint-level torque commands.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	control_callback	Callback function providing joint-level torque commands. See here for more details.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to torque control or motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if joint-level torque commands are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

Examples:: cartesian_impedance_control.cpp, communication_test.cpp, force_control.cpp, generate_cartesian_pose_motion.cpp, generate_cartesian_velocity_motion.cpp, generate_consecutive_motions.cpp, generate_elbow_motion.cpp, generate_joint_position_motion.cpp, generate_joint_velocity_motion.cpp, joint_impedance_control.cpp, joint_point_to_point_motion.cpp, and motion_with_control.cpp.

◆ control() [2/9]

void franka::Robot::control	(	std::function< Torques(const RobotState &, franka::Duration)>	control_callback,
		std::function< JointPositions(const RobotState &, franka::Duration)>	motion_generator_callback,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for sending joint-level torque commands and joint positions.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	control_callback	Callback function providing joint-level torque commands. See here for more details.
[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to torque control or motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if joint-level torque or joint position commands are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ control() [3/9]

void franka::Robot::control	(	std::function< Torques(const RobotState &, franka::Duration)>	control_callback,
		std::function< JointVelocities(const RobotState &, franka::Duration)>	motion_generator_callback,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for sending joint-level torque commands and joint velocities.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	control_callback	Callback function providing joint-level torque commands. See here for more details.
[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to torque control or motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if joint-level torque or joint velocitiy commands are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ control() [4/9]

void franka::Robot::control	(	std::function< Torques(const RobotState &, franka::Duration)>	control_callback,
		std::function< CartesianPose(const RobotState &, franka::Duration)>	motion_generator_callback,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for sending joint-level torque commands and Cartesian poses.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	control_callback	Callback function providing joint-level torque commands. See here for more details.
[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to torque control or motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if joint-level torque or Cartesian pose command elements are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ control() [5/9]

void franka::Robot::control	(	std::function< Torques(const RobotState &, franka::Duration)>	control_callback,
		std::function< CartesianVelocities(const RobotState &, franka::Duration)>	motion_generator_callback,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for sending joint-level torque commands and Cartesian velocities.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	control_callback	Callback function providing joint-level torque commands. See here for more details.
[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to torque control or motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if joint-level torque or Cartesian velocity command elements are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ control() [6/9]

void franka::Robot::control	(	std::function< JointPositions(const RobotState &, franka::Duration)>	motion_generator_callback,
		ControllerMode	controller_mode = `ControllerMode::kJointImpedance`,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for a joint position motion generator with a given controller mode.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	controller_mode	Controller to use to execute the motion.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if joint position commands are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ control() [7/9]

void franka::Robot::control	(	std::function< JointVelocities(const RobotState &, franka::Duration)>	motion_generator_callback,
		ControllerMode	controller_mode = `ControllerMode::kJointImpedance`,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for a joint velocity motion generator with a given controller mode.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	controller_mode	Controller to use to execute the motion.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if joint velocity commands are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ control() [8/9]

void franka::Robot::control	(	std::function< CartesianPose(const RobotState &, franka::Duration)>	motion_generator_callback,
		ControllerMode	controller_mode = `ControllerMode::kJointImpedance`,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for a Cartesian pose motion generator with a given controller mode.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	controller_mode	Controller to use to execute the motion.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if Cartesian pose command elements are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ control() [9/9]

void franka::Robot::control	(	std::function< CartesianVelocities(const RobotState &, franka::Duration)>	motion_generator_callback,
		ControllerMode	controller_mode = `ControllerMode::kJointImpedance`,
		bool	limit_rate = `true`,
		double	cutoff_frequency = `kDefaultCutoffFrequency`
	)

Starts a control loop for a Cartesian velocity motion generator with a given controller mode.

Sets realtime priority for the current thread. Cannot be executed while another control or motion generator loop is active.

Parameters

[in]	motion_generator_callback	Callback function for motion generation. See here for more details.
[in]	controller_mode	Controller to use to execute the motion.
[in]	limit_rate	True if rate limiting should be activated. True by default. This could distort your motion!
[in]	cutoff_frequency	Cutoff frequency for a first order low-pass filter applied on the user commanded signal. Set to franka::kMaxCutoffFrequency to disable.

Exceptions

ControlException	if an error related to motion generation occurred.
InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.
RealtimeException	if realtime priority cannot be set for the current thread.
std::invalid_argument	if Cartesian velocity command elements are NaN or infinity.

See also: Robot::Robot to change behavior if realtime priority cannot be set.

◆ getVirtualWall()

VirtualWallCuboid franka::Robot::getVirtualWall ( int32_t id )

Returns the parameters of a virtual wall.

Parameters

[in] id ID of the virtual wall.

Returns: Parameters of virtual wall.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

◆ loadModel()

Model franka::Robot::loadModel ( )

Loads the model library from the robot.

Returns: Model instance.

Exceptions

ModelException	if the model library cannot be loaded.
NetworkException	if the connection is lost, e.g. after a timeout.

Examples:: cartesian_impedance_control.cpp, force_control.cpp, joint_impedance_control.cpp, and print_joint_poses.cpp.

◆ operator=()

Robot& franka::Robot::operator= ( Robot && other )

noexcept

Move-assigns this Robot from another Robot instance.

Parameters

[in] other Other Robot instance.

Returns: Robot instance.

◆ read()

void franka::Robot::read ( std::function< bool(const RobotState &)> read_callback )

Starts a loop for reading the current robot state.

Cannot be executed while a control or motion generator loop is running.

This minimal example will print the robot state 100 times:

franka::Robot robot("robot.franka.de");
size_t count = 0;
robot.read([&count](const franka::RobotState& robot_state) {
  std::cout << robot_state << std::endl;
  return count++ < 100;
});

Parameters

[in] read_callback Callback function for robot state reading.

Exceptions

InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.

Examples:: echo_robot_state.cpp.

◆ readOnce()

RobotState franka::Robot::readOnce ( )

Waits for a robot state update and returns it.

Cannot be executed while a control or motion generator loop is running.

Returns: Current robot state.

Exceptions

InvalidOperationException	if a conflicting operation is already running.
NetworkException	if the connection is lost, e.g. after a timeout.

See also: Robot::read for a way to repeatedly receive the robot state.

Examples:: cartesian_impedance_control.cpp, force_control.cpp, and print_joint_poses.cpp.

◆ serverVersion()

ServerVersion franka::Robot::serverVersion ( ) const

noexcept

Returns the software version reported by the connected server.

Returns: Software version of the connected server.

◆ setCartesianImpedance()

void franka::Robot::setCartesianImpedance ( const std::array< double, 6 > & K_x )

Sets the Cartesian impedance for (x, y, z, roll, pitch, yaw) in the internal controller.

User-provided torques are not affected by this setting.

Parameters

[in] K_x Cartesian impedance values \(K_x=(x \in [10,3000] \frac{N}{m}, y \in [10,3000] \frac{N}{m}, z \in [10,3000] \frac{N}{m}, R \in [1,300] \frac{Nm}{rad}, P \in [1,300] \frac{Nm}{rad}, Y \in [1,300] \frac{Nm}{rad})\)

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

◆ setCollisionBehavior() [1/2]

void franka::Robot::setCollisionBehavior	(	const std::array< double, 7 > &	lower_torque_thresholds_acceleration,
		const std::array< double, 7 > &	upper_torque_thresholds_acceleration,
		const std::array< double, 7 > &	lower_torque_thresholds_nominal,
		const std::array< double, 7 > &	upper_torque_thresholds_nominal,
		const std::array< double, 6 > &	lower_force_thresholds_acceleration,
		const std::array< double, 6 > &	upper_force_thresholds_acceleration,
		const std::array< double, 6 > &	lower_force_thresholds_nominal,
		const std::array< double, 6 > &	upper_force_thresholds_nominal
	)

Changes the collision behavior.

Set separate torque and force boundaries for acceleration/deceleration and constant velocity movement phases.

Forces or torques between lower and upper threshold are shown as contacts in the RobotState. Forces or torques above the upper threshold are registered as collision and cause the robot to stop moving.

Parameters

[in]	lower_torque_thresholds_acceleration	Contact torque thresholds during acceleration/deceleration for each joint in \([Nm]\).
[in]	upper_torque_thresholds_acceleration	Collision torque thresholds during acceleration/deceleration for each joint in \([Nm]\).
[in]	lower_torque_thresholds_nominal	Contact torque thresholds for each joint in \([Nm]\).
[in]	upper_torque_thresholds_nominal	Collision torque thresholds for each joint in \([Nm]\).
[in]	lower_force_thresholds_acceleration	Contact force thresholds during acceleration/deceleration for \((x,y,z,R,P,Y)\) in \([N]\).
[in]	upper_force_thresholds_acceleration	Collision force thresholds during acceleration/deceleration for \((x,y,z,R,P,Y)\) in \([N]\).
[in]	lower_force_thresholds_nominal	Contact force thresholds for \((x,y,z,R,P,Y)\) in \([N]\).
[in]	upper_force_thresholds_nominal	Collision force thresholds for \((x,y,z,R,P,Y)\) in \([N]\).

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

See also: RobotState::cartesian_contact; RobotState::cartesian_collision; RobotState::joint_contact; RobotState::joint_collision; Robot::automaticErrorRecovery for performing a reset after a collision.

Examples:: cartesian_impedance_control.cpp, communication_test.cpp, force_control.cpp, generate_cartesian_pose_motion.cpp, generate_cartesian_velocity_motion.cpp, generate_consecutive_motions.cpp, generate_elbow_motion.cpp, generate_joint_position_motion.cpp, generate_joint_velocity_motion.cpp, joint_impedance_control.cpp, joint_point_to_point_motion.cpp, and motion_with_control.cpp.

◆ setCollisionBehavior() [2/2]

void franka::Robot::setCollisionBehavior	(	const std::array< double, 7 > &	lower_torque_thresholds,
		const std::array< double, 7 > &	upper_torque_thresholds,
		const std::array< double, 6 > &	lower_force_thresholds,
		const std::array< double, 6 > &	upper_force_thresholds
	)

Changes the collision behavior.

Set common torque and force boundaries for acceleration/deceleration and constant velocity movement phases.

Forces or torques between lower and upper threshold are shown as contacts in the RobotState. Forces or torques above the upper threshold are registered as collision and cause the robot to stop moving.

Parameters

[in]	lower_torque_thresholds	Contact torque thresholds for each joint in \([Nm]\).
[in]	upper_torque_thresholds	Collision torque thresholds for each joint in \([Nm]\).
[in]	lower_force_thresholds	Contact force thresholds for \((x,y,z,R,P,Y)\) in \([N]\).
[in]	upper_force_thresholds	Collision force thresholds for \((x,y,z,R,P,Y)\) in \([N]\).

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

See also: RobotState::cartesian_contact; RobotState::cartesian_collision; RobotState::joint_contact; RobotState::joint_collision; Robot::automaticErrorRecovery for performing a reset after a collision.

◆ setEE()

void franka::Robot::setEE ( const std::array< double, 16 > & NE_T_EE )

Sets the transformation \(^{NE}T_{EE}\) from nominal end effector to end effector frame.

The transformation matrix is represented as a vectorized 4x4 matrix in column-major format.

Parameters

[in] NE_T_EE Vectorized NE-to-EE transformation matrix \(^{NE}T_{EE}\), column-major.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

See also: RobotState::NE_T_EE for end effector pose in nominal end effector frame.; RobotState::O_T_EE for end effector pose in world base frame.; RobotState::F_T_EE for end effector pose in flange frame.; Robot for an explanation of the NE and EE frames.

◆ setFilters()

void franka::Robot::setFilters	(	double	joint_position_filter_frequency,
		double	joint_velocity_filter_frequency,
		double	cartesian_position_filter_frequency,
		double	cartesian_velocity_filter_frequency,
		double	controller_filter_frequency
	)

Sets the cut off frequency for the given motion generator or controller.

Deprecated:: Use franka::lowpassFilter() instead.

Allowed input range for all the filters is between 1.0 Hz and 1000.0 Hz. If the value is set to maximum (1000Hz) then no filtering is done.

Parameters

[in]	joint_position_filter_frequency	Frequency at which the commanded joint position is cut off.
[in]	joint_velocity_filter_frequency	Frequency at which the commanded joint velocity is cut off.
[in]	cartesian_position_filter_frequency	Frequency at which the commanded Cartesian position is cut off.
[in]	cartesian_velocity_filter_frequency	Frequency at which the commanded Cartesian velocity is cut off.
[in]	controller_filter_frequency	Frequency at which the commanded torque is cut off.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

◆ setGuidingMode()

void franka::Robot::setGuidingMode	(	const std::array< bool, 6 > &	guiding_mode,
		bool	elbow
	)

Locks or unlocks guiding mode movement in (x, y, z, roll, pitch, yaw).

If a flag is set to true, movement is unlocked.

Note: Guiding mode can be enabled by pressing the two opposing buttons near the robot's flange.

Parameters

[in]	guiding_mode	Unlocked movement in (x, y, z, R, P, Y) in guiding mode.
[in]	elbow	True if the elbow is free in guiding mode, false otherwise.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

◆ setJointImpedance()

void franka::Robot::setJointImpedance ( const std::array< double, 7 > & K_theta )

Sets the impedance for each joint in the internal controller.

User-provided torques are not affected by this setting.

Parameters

[in] K_theta Joint impedance values \(K_{\theta}\).

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

Examples:: generate_cartesian_velocity_motion.cpp.

◆ setK()

void franka::Robot::setK ( const std::array< double, 16 > & EE_T_K )

Sets the transformation \(^{EE}T_K\) from end effector frame to stiffness frame.

The transformation matrix is represented as a vectorized 4x4 matrix in column-major format.

Parameters

[in] EE_T_K Vectorized EE-to-K transformation matrix \(^{EE}T_K\), column-major.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

See also: Robot for an explanation of the stiffness frame.

◆ setLoad()

void franka::Robot::setLoad	(	double	load_mass,
		const std::array< double, 3 > &	F_x_Cload,
		const std::array< double, 9 > &	load_inertia
	)

Sets dynamic parameters of a payload.

Note: This is not for setting end effector parameters, which have to be set in the administrator's interface.

Parameters

[in]	load_mass	Mass of the load in \([kg]\).
[in]	F_x_Cload	Translation from flange to center of mass of load \(^Fx_{C_\text{load}}\) in \([m]\).
[in]	load_inertia	Inertia matrix \(I_\text{load}\) in \([kg \times m^2]\), column-major.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

◆ stop()

void franka::Robot::stop ( )

Stops all currently running motions.

If a control or motion generator loop is running in another thread, it will be preempted with a franka::ControlException.

Exceptions

CommandException	if the Control reports an error.
NetworkException	if the connection is lost, e.g. after a timeout.

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

include/franka/robot.h

Public Types

Public Member Functions

Detailed Description

Constructor & Destructor Documentation

◆ Robot() [1/2]

◆ Robot() [2/2]

Member Function Documentation

◆ automaticErrorRecovery()

◆ control() [1/9]

◆ control() [2/9]

◆ control() [3/9]

◆ control() [4/9]

◆ control() [5/9]

◆ control() [6/9]

◆ control() [7/9]

◆ control() [8/9]

◆ control() [9/9]

◆ getVirtualWall()

◆ loadModel()

◆ operator=()

◆ read()

◆ readOnce()

◆ serverVersion()

◆ setCartesianImpedance()

◆ setCollisionBehavior() [1/2]

◆ setCollisionBehavior() [2/2]

◆ setEE()

◆ setFilters()

◆ setGuidingMode()

◆ setJointImpedance()

◆ setK()

◆ setLoad()

◆ stop()