#include <pr2_gripper_transmission.h>

Inheritance diagram for pr2_mechanism_model::PR2GripperTransmission:

Public Member Functions
bool	initXml (TiXmlElement config, Robot robot)
	Initializes the transmission from XML data.
bool	initXml (TiXmlElement *config)
	Initializes the transmission from XML data.
	PR2GripperTransmission ()
void	propagateEffort (std::vector< pr2_mechanism_model::JointState * > &, std::vector< pr2_hardware_interface::Actuator * > &)
	Uses commanded joint efforts to fill out commanded motor currents.
void	propagateEffortBackwards (std::vector< pr2_hardware_interface::Actuator * > &, std::vector< pr2_mechanism_model::JointState * > &)
	Uses the actuator's commanded effort to fill out the torque on the joint.
void	propagatePosition (std::vector< pr2_hardware_interface::Actuator * > &, std::vector< pr2_mechanism_model::JointState * > &)
void	propagatePositionBackwards (std::vector< pr2_mechanism_model::JointState * > &, std::vector< pr2_hardware_interface::Actuator * > &)
	Uses the joint position to fill out the actuator's encoder.
virtual	~PR2GripperTransmission ()
Public Attributes
std::string	gap_joint_
double	gap_mechanical_reduction_
bool	has_simulated_passive_actuated_joint_
std::vector< std::string >	passive_joints_
double	simulated_reduction_
bool	use_simulated_actuated_joint_
Private Member Functions
void	computeGapStates (double MR, double MR_dot, double MT, double &theta, double &dtheta_dMR, double &dt_dtheta, double &dt_dMR, double &gap_size, double &gap_velocity, double &gap_effort)
	compute gap position, velocity and measured effort from actuator states
void	inverseGapStates (double gap_size, double &MR, double &dMR_dtheta, double &dtheta_dt, double &dMR_dt)
void	inverseGapStates1 (double theta, double &MR, double &dMR_dtheta, double &dtheta_dt, double &dMR_dt)
Private Attributes
double	a_
double	b_
double	gear_ratio_
double	h_
JointCalibrationSimulator	joint_calibration_simulator_
double	L0_
double	phi0_
double	r_
double	screw_reduction_
ros::Time	simulated_actuator_start_time_
int	simulated_actuator_timestamp_initialized_
double	t0_
double	theta0_

Detailed Description

Definition at line 55 of file pr2_gripper_transmission.h.

Constructor & Destructor Documentation

pr2_mechanism_model::PR2GripperTransmission::PR2GripperTransmission ( ) [inline]

Definition at line 58 of file pr2_gripper_transmission.h.

virtual pr2_mechanism_model::PR2GripperTransmission::~PR2GripperTransmission ( ) [inline, virtual]

Definition at line 59 of file pr2_gripper_transmission.h.

Member Function Documentation

void PR2GripperTransmission::computeGapStates	(	double	MR,
		double	MR_dot,
		double	MT,
		double &	theta,
		double &	dtheta_dMR,
		double &	dt_dtheta,
		double &	dt_dMR,
		double &	gap_size,
		double &	gap_velocity,
		double &	gap_effort
	)		`[private]`

compute gap position, velocity and measured effort from actuator states

given actuator states (motor revolustion, joint torques), compute gap properties.

Definition at line 672 of file pr2_gripper_transmission.cpp.

bool pr2_mechanism_model::PR2GripperTransmission::initXml	(	TiXmlElement *	config,
		Robot *	robot
	)		`[virtual]`

Initializes the transmission from XML data.

Implements pr2_mechanism_model::Transmission.

bool PR2GripperTransmission::initXml ( TiXmlElement * config ) [virtual]

Initializes the transmission from XML data.

Reimplemented from pr2_mechanism_model::Transmission.

Definition at line 381 of file pr2_gripper_transmission.cpp.

void PR2GripperTransmission::inverseGapStates	(	double	gap_size,
		double &	MR,
		double &	dMR_dtheta,
		double &	dtheta_dt,
		double &	dMR_dt
	)		`[private]`

inverse of computeGapStates() need theta as input computes MR, dMR_dtheta, dtheta_dt, dMR_dt

Definition at line 729 of file pr2_gripper_transmission.cpp.

void PR2GripperTransmission::inverseGapStates1	(	double	theta,
		double &	MR,
		double &	dMR_dtheta,
		double &	dtheta_dt,
		double &	dMR_dt
	)		`[private]`

inverse of computeGapStates() need theta as input computes MR, dMR_dtheta, dtheta_dt, dMR_dt

Definition at line 745 of file pr2_gripper_transmission.cpp.

void PR2GripperTransmission::propagateEffort	(	std::vector< pr2_mechanism_model::JointState * > &	,
		std::vector< pr2_hardware_interface::Actuator * > &
	)		`[virtual]`

Uses commanded joint efforts to fill out commanded motor currents.

Newtons

actuator commanded effort = gap_dffort / dMR_dt / (2*pi) * gap_mechanical_reduction_

Implements pr2_mechanism_model::Transmission.

Definition at line 927 of file pr2_gripper_transmission.cpp.

void PR2GripperTransmission::propagateEffortBackwards	(	std::vector< pr2_hardware_interface::Actuator * > &	,
		std::vector< pr2_mechanism_model::JointState * > &
	)		`[virtual]`

Uses the actuator's commanded effort to fill out the torque on the joint.

taken from propagatePosition()

internal theta state, gripper closed it is theta0_. same as finger joint angles + theta0_.

information on the fictitious joint: gap_joint

Implements pr2_mechanism_model::Transmission.

Definition at line 958 of file pr2_gripper_transmission.cpp.

void PR2GripperTransmission::propagatePosition	(	std::vector< pr2_hardware_interface::Actuator * > &	,
		std::vector< pr2_mechanism_model::JointState * > &
	)		`[virtual]`

assign joint position, velocity, effort from actuator state all passive joints are assigned by single actuator state through mimic?

motor revolutions = encoder value * gap_mechanical_reduction_ * RAD2MR motor revolutions = motor angle(rad) / (2*pi) = theta / (2*pi)

motor revolustions per second = motor angle rate (rad per second) / (2*pi)

old MT definition - obsolete

but we convert it to Nm*(MR/rad) motor torque = actuator_state->last_meausured_effort motor torque = I * theta_ddot MT = I * MR_ddot (my definition) = I * theta_ddot / (2*pi) = motot torque / (2*pi)

gripper motor torque: received from hardware side in newton-meters

internal theta state, gripper closed it is theta0_. same as finger joint angles + theta0_.

information on the fictitious joint: gap_joint

Implements pr2_mechanism_model::Transmission.

Definition at line 788 of file pr2_gripper_transmission.cpp.

void PR2GripperTransmission::propagatePositionBackwards	(	std::vector< pr2_mechanism_model::JointState * > &	,
		std::vector< pr2_hardware_interface::Actuator * > &
	)		`[virtual]`

Uses the joint position to fill out the actuator's encoder.

should be exact inverse of propagatePosition() call

state velocity = MR_dot * gap_mechanical_reduction_ / rad2mr = theta_dot * dMR_dtheta * gap_mechanical_reduction_ / rad2mr

motor torque = inverse of getting gap effort from motor torque = gap_effort * dt_dMR / (2*pi) * gap_mechanical_reduction_ = gap_effort / dMR_dt * RAD2MR * gap_mechanical_reduction_

Implements pr2_mechanism_model::Transmission.

Definition at line 867 of file pr2_gripper_transmission.cpp.