#include <cob_lookat_controller.h>
Definition at line 48 of file cob_lookat_controller.h.
CobLookatController::CobLookatController | ( | ) | [inline] |
Definition at line 81 of file cob_lookat_controller.h.
void CobLookatController::initialize | ( | ) |
get params
parse robot_description and set velocity limits
old stuff
parse robot_description and generate KDL chains
initialize configuration control solver
set weights for JointSpace
weight of joint 1 (R torso 1)
weight of joint 2 (R torso 2)
weight of joint 3 (R torso 3)
weight of joint 4 (P lookat 1)
weight of joint 5 (R lookat 2)
weight of joint 6 (R lookat 3)
weight of joint 7 (R lookat 4)
set weights for TaskSpace
set Lambda
initialize ROS interfaces
initialize variables and current joint values and velocities
Definition at line 39 of file cob_lookat_controller.cpp.
void CobLookatController::jointstate_cb | ( | const sensor_msgs::JointState::ConstPtr & | msg | ) |
Definition at line 260 of file cob_lookat_controller.cpp.
void CobLookatController::lookatstate_cb | ( | const sensor_msgs::JointState::ConstPtr & | msg | ) |
void CobLookatController::run | ( | ) |
Definition at line 168 of file cob_lookat_controller.cpp.
Definition at line 330 of file cob_lookat_controller.cpp.
void CobLookatController::twist_cb | ( | const geometry_msgs::Twist::ConstPtr & | msg | ) |
ToDo: Verify this transformation
Definition at line 175 of file cob_lookat_controller.cpp.
KDL::Chain CobLookatController::chain_ [private] |
Definition at line 61 of file cob_lookat_controller.h.
std::string CobLookatController::chain_base_ [private] |
Definition at line 62 of file cob_lookat_controller.h.
unsigned int CobLookatController::chain_dof_ [private] |
Definition at line 71 of file cob_lookat_controller.h.
std::vector<std::string> CobLookatController::chain_joints_ [private] |
Definition at line 68 of file cob_lookat_controller.h.
std::vector<float> CobLookatController::chain_limits_vel_ [private] |
Definition at line 74 of file cob_lookat_controller.h.
std::string CobLookatController::chain_tip_ [private] |
Definition at line 63 of file cob_lookat_controller.h.
Definition at line 57 of file cob_lookat_controller.h.
std::string CobLookatController::chain_vel_pub_topic_ [private] |
Definition at line 59 of file cob_lookat_controller.h.
Definition at line 54 of file cob_lookat_controller.h.
KDL::JntArray CobLookatController::last_q_ [private] |
Definition at line 76 of file cob_lookat_controller.h.
Definition at line 77 of file cob_lookat_controller.h.
unsigned int CobLookatController::lookat_dof_ [private] |
Definition at line 72 of file cob_lookat_controller.h.
std::vector<std::string> CobLookatController::lookat_joints_ [private] |
Definition at line 69 of file cob_lookat_controller.h.
Definition at line 58 of file cob_lookat_controller.h.
Definition at line 55 of file cob_lookat_controller.h.
ros::NodeHandle CobLookatController::nh_ [private] |
Definition at line 51 of file cob_lookat_controller.h.
Definition at line 65 of file cob_lookat_controller.h.
Definition at line 66 of file cob_lookat_controller.h.
Definition at line 52 of file cob_lookat_controller.h.
unsigned int CobLookatController::total_dof_ [private] |
Definition at line 73 of file cob_lookat_controller.h.
std::vector<std::string> CobLookatController::total_joints_ [private] |
Definition at line 70 of file cob_lookat_controller.h.
Definition at line 56 of file cob_lookat_controller.h.