#include <cartesian_trajectory_controller.h>
Public Member Functions | |
CartesianTrajectoryController () | |
bool | checkMoving (simple_Jtranspose_controller::CheckMoving::Request &req, simple_Jtranspose_controller::CheckMoving::Response &res) |
bool | init (pr2_mechanism_model::RobotState *robot_state, ros::NodeHandle &n) |
bool | moveTo (const geometry_msgs::PoseStamped &pose, const geometry_msgs::Twist &tolerance=geometry_msgs::Twist(), double duration=0) |
void | starting () |
void | update () |
~CartesianTrajectoryController () | |
Private Member Functions | |
void | command (const tf::MessageFilter< geometry_msgs::PoseStamped >::MConstPtr &pose_msg) |
KDL::Frame | getPose () |
bool | moveTo (simple_Jtranspose_controller::MoveToPose::Request &req, simple_Jtranspose_controller::MoveToPose::Response &resp) |
bool | preempt (std_srvs::Empty::Request &req, std_srvs::Empty::Response &resp) |
void | TransformToFrame (const tf::Transform &trans, KDL::Frame &frame) |
Private Attributes | |
pr2_mechanism_model::Chain | chain_ |
ros::ServiceServer | check_moving_srv_ |
std::string | controller_name_ |
bool | exceed_tolerance_ |
bool | is_moving_ |
KDL::JntArray | jnt_pos_ |
boost::scoped_ptr < KDL::ChainFkSolverPos > | jnt_to_pose_solver_ |
KDL::Chain | kdl_chain_ |
ros::Time | last_time_ |
double | max_duration_ |
std::vector < KDL::VelocityProfile_Trap > | motion_profile_ |
ros::ServiceServer | move_to_srv_ |
ros::NodeHandle | node_ |
KDL::Frame | pose_begin_ |
CartesianPoseController * | pose_controller_ |
KDL::Frame | pose_current_ |
KDL::Frame | pose_end_ |
ros::ServiceServer | preempt_srv_ |
bool | request_preempt_ |
pr2_mechanism_model::RobotState * | robot_state_ |
std::string | root_name_ |
tf::TransformListener | tf_ |
double | time_passed_ |
ros::Time | time_started_ |
KDL::Twist | tolerance_ |
KDL::Twist | twist_current_ |
Definition at line 55 of file cartesian_trajectory_controller.h.
Definition at line 52 of file cartesian_trajectory_controller.cpp.
Definition at line 57 of file cartesian_trajectory_controller.cpp.
bool controller::CartesianTrajectoryController::checkMoving | ( | simple_Jtranspose_controller::CheckMoving::Request & | req, |
simple_Jtranspose_controller::CheckMoving::Response & | res | ||
) |
Definition at line 132 of file cartesian_trajectory_controller.cpp.
void controller::CartesianTrajectoryController::command | ( | const tf::MessageFilter< geometry_msgs::PoseStamped >::MConstPtr & | pose_msg | ) | [private] |
Frame controller::CartesianTrajectoryController::getPose | ( | void | ) | [private] |
Definition at line 302 of file cartesian_trajectory_controller.cpp.
bool controller::CartesianTrajectoryController::init | ( | pr2_mechanism_model::RobotState * | robot_state, |
ros::NodeHandle & | n | ||
) | [virtual] |
Implements pr2_controller_interface::Controller.
Definition at line 61 of file cartesian_trajectory_controller.cpp.
bool controller::CartesianTrajectoryController::moveTo | ( | const geometry_msgs::PoseStamped & | pose, |
const geometry_msgs::Twist & | tolerance = geometry_msgs::Twist() , |
||
double | duration = 0 |
||
) |
Definition at line 141 of file cartesian_trajectory_controller.cpp.
bool controller::CartesianTrajectoryController::moveTo | ( | simple_Jtranspose_controller::MoveToPose::Request & | req, |
simple_Jtranspose_controller::MoveToPose::Response & | resp | ||
) | [private] |
Definition at line 315 of file cartesian_trajectory_controller.cpp.
bool controller::CartesianTrajectoryController::preempt | ( | std_srvs::Empty::Request & | req, |
std_srvs::Empty::Response & | resp | ||
) | [private] |
Definition at line 362 of file cartesian_trajectory_controller.cpp.
void controller::CartesianTrajectoryController::starting | ( | ) | [virtual] |
Reimplemented from pr2_controller_interface::Controller.
Definition at line 224 of file cartesian_trajectory_controller.cpp.
void controller::CartesianTrajectoryController::TransformToFrame | ( | const tf::Transform & | trans, |
KDL::Frame & | frame | ||
) | [private] |
Definition at line 381 of file cartesian_trajectory_controller.cpp.
void controller::CartesianTrajectoryController::update | ( | void | ) | [virtual] |
Implements pr2_controller_interface::Controller.
Definition at line 241 of file cartesian_trajectory_controller.cpp.
Definition at line 93 of file cartesian_trajectory_controller.h.
Definition at line 81 of file cartesian_trajectory_controller.h.
std::string controller::CartesianTrajectoryController::controller_name_ [private] |
Definition at line 83 of file cartesian_trajectory_controller.h.
Definition at line 86 of file cartesian_trajectory_controller.h.
Definition at line 86 of file cartesian_trajectory_controller.h.
KDL::JntArray controller::CartesianTrajectoryController::jnt_pos_ [private] |
Definition at line 98 of file cartesian_trajectory_controller.h.
boost::scoped_ptr<KDL::ChainFkSolverPos> controller::CartesianTrajectoryController::jnt_to_pose_solver_ [private] |
Definition at line 97 of file cartesian_trajectory_controller.h.
KDL::Chain controller::CartesianTrajectoryController::kdl_chain_ [private] |
Definition at line 96 of file cartesian_trajectory_controller.h.
Definition at line 84 of file cartesian_trajectory_controller.h.
double controller::CartesianTrajectoryController::max_duration_ [private] |
Definition at line 85 of file cartesian_trajectory_controller.h.
std::vector<KDL::VelocityProfile_Trap> controller::CartesianTrajectoryController::motion_profile_ [private] |
Definition at line 101 of file cartesian_trajectory_controller.h.
Definition at line 81 of file cartesian_trajectory_controller.h.
Definition at line 80 of file cartesian_trajectory_controller.h.
KDL::Frame controller::CartesianTrajectoryController::pose_begin_ [private] |
Definition at line 88 of file cartesian_trajectory_controller.h.
Definition at line 104 of file cartesian_trajectory_controller.h.
KDL::Frame controller::CartesianTrajectoryController::pose_current_ [private] |
Definition at line 88 of file cartesian_trajectory_controller.h.
KDL::Frame controller::CartesianTrajectoryController::pose_end_ [private] |
Definition at line 88 of file cartesian_trajectory_controller.h.
Definition at line 81 of file cartesian_trajectory_controller.h.
Definition at line 86 of file cartesian_trajectory_controller.h.
Definition at line 92 of file cartesian_trajectory_controller.h.
std::string controller::CartesianTrajectoryController::root_name_ [private] |
Definition at line 110 of file cartesian_trajectory_controller.h.
Definition at line 106 of file cartesian_trajectory_controller.h.
double controller::CartesianTrajectoryController::time_passed_ [private] |
Definition at line 85 of file cartesian_trajectory_controller.h.
Definition at line 84 of file cartesian_trajectory_controller.h.
KDL::Twist controller::CartesianTrajectoryController::tolerance_ [private] |
Definition at line 89 of file cartesian_trajectory_controller.h.
KDL::Twist controller::CartesianTrajectoryController::twist_current_ [private] |
Definition at line 89 of file cartesian_trajectory_controller.h.