Public Member Functions | |
void | commandPose (const geometry_msgs::PoseStamped::ConstPtr &command) |
void | commandPosture (const std_msgs::Float64MultiArray::ConstPtr &msg) |
bool | init (pr2_mechanism_model::RobotState *robot, ros::NodeHandle &n) |
JTTeleopController () | |
void | setGains (const std_msgs::Float64MultiArray::ConstPtr &msg) |
void | starting () |
void | update () |
~JTTeleopController () | |
Public Attributes | |
pr2_mechanism_model::Chain | chain_ |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW | |
double | jacobian_inverse_damping_ |
JointVec | joint_dd_ff_ |
double | joint_vel_filter_ |
double | k_posture_ |
Eigen::Matrix< double, 6, 1 > | Kd |
boost::scoped_ptr< Kin< Joints > > | kin_ |
Eigen::Matrix< double, 6, 1 > | Kp |
double | last_compliance_ |
double | last_Df_ |
double | last_Dx_ |
Eigen::eigen2_Transform3d | last_pose_ |
double | last_stiffness_ |
ros::Time | last_time_ |
CartVec | last_wrench_ |
int | loop_count_ |
ros::NodeHandle | node_ |
double | pose_command_filter_ |
rosrt::Publisher< StateMsg > | pub_state_ |
rosrt::Publisher < std_msgs::Float64MultiArray > | pub_tau_ |
rosrt::Publisher < geometry_msgs::Twist > | pub_wrench_ |
rosrt::Publisher < geometry_msgs::PoseStamped > | pub_x_ |
rosrt::Publisher < geometry_msgs::PoseStamped > | pub_x_desi_ |
rosrt::Publisher < geometry_msgs::Twist > | pub_x_err_ |
rosrt::Publisher < geometry_msgs::Twist > | pub_xd_ |
rosrt::Publisher < geometry_msgs::Twist > | pub_xd_desi_ |
JointVec | q_posture_ |
JointVec | qdot_filtered_ |
double | res_force_ |
double | res_orientation_ |
double | res_position_ |
double | res_torque_ |
pr2_mechanism_model::RobotState * | robot_state_ |
std::string | root_name_ |
JointVec | saturation_ |
ros::Subscriber | sub_gains_ |
ros::Subscriber | sub_pose_ |
ros::Subscriber | sub_posture_ |
tf::TransformListener | tf_ |
std::string | tip_name_ |
bool | use_posture_ |
double | vel_saturation_rot_ |
double | vel_saturation_trans_ |
CartVec | wrench_desi_ |
Eigen::eigen2_Transform3d | x_desi_ |
Eigen::eigen2_Transform3d | x_desi_filtered_ |
Private Types | |
enum | { Joints = 7 } |
typedef Eigen::Matrix< double, 6, 1 > | CartVec |
typedef Eigen::Matrix< double, 6, Joints > | Jacobian |
typedef Eigen::Matrix< double, Joints, 1 > | JointVec |
typedef teleop_controllers::JTTeleopControllerState | StateMsg |
Definition at line 101 of file jt_teleop_controller.cpp.
typedef Eigen::Matrix<double, 6, 1> pr2_teleop::JTTeleopController::CartVec [private] |
Definition at line 110 of file jt_teleop_controller.cpp.
typedef Eigen::Matrix<double, 6, Joints> pr2_teleop::JTTeleopController::Jacobian [private] |
Definition at line 111 of file jt_teleop_controller.cpp.
typedef Eigen::Matrix<double, Joints, 1> pr2_teleop::JTTeleopController::JointVec [private] |
Definition at line 109 of file jt_teleop_controller.cpp.
typedef teleop_controllers::JTTeleopControllerState pr2_teleop::JTTeleopController::StateMsg [private] |
Definition at line 112 of file jt_teleop_controller.cpp.
anonymous enum [private] |
Definition at line 108 of file jt_teleop_controller.cpp.
pr2_teleop::JTTeleopController::JTTeleopController | ( | ) |
Definition at line 215 of file jt_teleop_controller.cpp.
pr2_teleop::JTTeleopController::~JTTeleopController | ( | ) |
Definition at line 219 of file jt_teleop_controller.cpp.
void pr2_teleop::JTTeleopController::commandPose | ( | const geometry_msgs::PoseStamped::ConstPtr & | command | ) | [inline] |
Definition at line 197 of file jt_teleop_controller.cpp.
void pr2_teleop::JTTeleopController::commandPosture | ( | const std_msgs::Float64MultiArray::ConstPtr & | msg | ) | [inline] |
Definition at line 179 of file jt_teleop_controller.cpp.
bool pr2_teleop::JTTeleopController::init | ( | pr2_mechanism_model::RobotState * | robot, | |
ros::NodeHandle & | n | |||
) |
Definition at line 227 of file jt_teleop_controller.cpp.
void pr2_teleop::JTTeleopController::setGains | ( | const std_msgs::Float64MultiArray::ConstPtr & | msg | ) | [inline] |
Definition at line 166 of file jt_teleop_controller.cpp.
void pr2_teleop::JTTeleopController::starting | ( | ) |
Definition at line 354 of file jt_teleop_controller.cpp.
void pr2_teleop::JTTeleopController::update | ( | ) |
Definition at line 385 of file jt_teleop_controller.cpp.
pr2_mechanism_model::Chain pr2_teleop::JTTeleopController::chain_ |
Definition at line 141 of file jt_teleop_controller.cpp.
Definition at line 106 of file jt_teleop_controller.cpp.
Definition at line 149 of file jt_teleop_controller.cpp.
Definition at line 147 of file jt_teleop_controller.cpp.
Definition at line 148 of file jt_teleop_controller.cpp.
Definition at line 151 of file jt_teleop_controller.cpp.
Eigen::Matrix<double,6,1> pr2_teleop::JTTeleopController::Kd |
Definition at line 143 of file jt_teleop_controller.cpp.
boost::scoped_ptr<Kin<Joints> > pr2_teleop::JTTeleopController::kin_ |
Definition at line 142 of file jt_teleop_controller.cpp.
Eigen::Matrix<double,6,1> pr2_teleop::JTTeleopController::Kp |
Definition at line 143 of file jt_teleop_controller.cpp.
Definition at line 160 of file jt_teleop_controller.cpp.
Definition at line 161 of file jt_teleop_controller.cpp.
Definition at line 161 of file jt_teleop_controller.cpp.
Eigen::eigen2_Transform3d pr2_teleop::JTTeleopController::last_pose_ |
Definition at line 158 of file jt_teleop_controller.cpp.
Definition at line 160 of file jt_teleop_controller.cpp.
Definition at line 137 of file jt_teleop_controller.cpp.
Definition at line 159 of file jt_teleop_controller.cpp.
Definition at line 138 of file jt_teleop_controller.cpp.
ros::NodeHandle pr2_teleop::JTTeleopController::node_ |
Definition at line 124 of file jt_teleop_controller.cpp.
Definition at line 144 of file jt_teleop_controller.cpp.
rosrt::Publisher<StateMsg> pr2_teleop::JTTeleopController::pub_state_ |
Definition at line 130 of file jt_teleop_controller.cpp.
rosrt::Publisher<std_msgs::Float64MultiArray> pr2_teleop::JTTeleopController::pub_tau_ |
Definition at line 134 of file jt_teleop_controller.cpp.
rosrt::Publisher<geometry_msgs::Twist> pr2_teleop::JTTeleopController::pub_wrench_ |
Definition at line 133 of file jt_teleop_controller.cpp.
rosrt::Publisher<geometry_msgs::PoseStamped> pr2_teleop::JTTeleopController::pub_x_ |
Definition at line 131 of file jt_teleop_controller.cpp.
rosrt::Publisher<geometry_msgs::PoseStamped> pr2_teleop::JTTeleopController::pub_x_desi_ |
Definition at line 131 of file jt_teleop_controller.cpp.
rosrt::Publisher<geometry_msgs::Twist> pr2_teleop::JTTeleopController::pub_x_err_ |
Definition at line 133 of file jt_teleop_controller.cpp.
rosrt::Publisher<geometry_msgs::Twist> pr2_teleop::JTTeleopController::pub_xd_ |
Definition at line 132 of file jt_teleop_controller.cpp.
rosrt::Publisher<geometry_msgs::Twist> pr2_teleop::JTTeleopController::pub_xd_desi_ |
Definition at line 132 of file jt_teleop_controller.cpp.
Definition at line 150 of file jt_teleop_controller.cpp.
Definition at line 164 of file jt_teleop_controller.cpp.
Definition at line 155 of file jt_teleop_controller.cpp.
Definition at line 156 of file jt_teleop_controller.cpp.
Definition at line 155 of file jt_teleop_controller.cpp.
Definition at line 156 of file jt_teleop_controller.cpp.
pr2_mechanism_model::RobotState* pr2_teleop::JTTeleopController::robot_state_ |
Definition at line 139 of file jt_teleop_controller.cpp.
std::string pr2_teleop::JTTeleopController::root_name_ |
Definition at line 136 of file jt_teleop_controller.cpp.
Definition at line 146 of file jt_teleop_controller.cpp.
ros::Subscriber pr2_teleop::JTTeleopController::sub_gains_ |
Definition at line 125 of file jt_teleop_controller.cpp.
ros::Subscriber pr2_teleop::JTTeleopController::sub_pose_ |
Definition at line 127 of file jt_teleop_controller.cpp.
ros::Subscriber pr2_teleop::JTTeleopController::sub_posture_ |
Definition at line 126 of file jt_teleop_controller.cpp.
tf::TransformListener pr2_teleop::JTTeleopController::tf_ |
Definition at line 128 of file jt_teleop_controller.cpp.
std::string pr2_teleop::JTTeleopController::tip_name_ |
Definition at line 136 of file jt_teleop_controller.cpp.
Definition at line 152 of file jt_teleop_controller.cpp.
Definition at line 145 of file jt_teleop_controller.cpp.
Definition at line 145 of file jt_teleop_controller.cpp.
Definition at line 122 of file jt_teleop_controller.cpp.
Eigen::eigen2_Transform3d pr2_teleop::JTTeleopController::x_desi_ |
Definition at line 121 of file jt_teleop_controller.cpp.
Eigen::eigen2_Transform3d pr2_teleop::JTTeleopController::x_desi_filtered_ |
Definition at line 121 of file jt_teleop_controller.cpp.