Revision f10ec142 examples/meka/src/mekajointinterface.cpp
| examples/meka/src/mekajointinterface.cpp | ||
|---|---|---|
| 130 | 130 |
|
| 131 | 131 |
trajectory_msgs::JointTrajectoryPoint p; |
| 132 | 132 |
p.positions.push_back(joint_target[ID_NECK_TILT] * M_PI / 180.0); |
| 133 |
p.positions.push_back(joint_target[ID_NECK_PAN] * M_PI / 180.0); |
|
| 133 |
//pan joint is inverted! |
|
| 134 |
p.positions.push_back(-joint_target[ID_NECK_PAN] * M_PI / 180.0); |
|
| 134 | 135 |
//printf("targets pan=%4.1f tilt=%4.1f (eye p %4.1f t %4.2f)\n",joint_target[ID_NECK_TILT],joint_target[ID_NECK_PAN],joint_target[ID_EYES_LEFT_LR],joint_target[ID_EYES_BOTH_UD]);
|
| 135 | 136 |
|
| 136 | 137 |
p.time_from_start = ros::Duration(1.2 * 1.0 / humotion::server::Server::MOTION_UPDATERATE); |
| ... | ... | |
| 209 | 210 |
} |
| 210 | 211 |
|
| 211 | 212 |
void MekaJointInterface::init_joints(){
|
| 212 |
store_min_max(ID_NECK_TILT, -18, 1);
|
|
| 213 |
store_min_max(ID_NECK_PAN, -56, 56);
|
|
| 213 |
store_min_max(ID_NECK_TILT, -37, 1);
|
|
| 214 |
store_min_max(ID_NECK_PAN, -70, 70);
|
|
| 214 | 215 |
|
| 215 | 216 |
store_min_max(ID_NECK_ROLL, -1, 1); |
| 216 | 217 |
store_min_max(ID_EYES_BOTH_UD, -1, 1); |
Also available in: Unified diff