| 137 | } |
| 138 | |
| 139 | void SO3ControlNodelet::imu_callback(const sensor_msgs::Imu& imu) { |
| 140 | const Eigen::Vector3d acc(imu.linear_acceleration.x, imu.linear_acceleration.y, |
| 141 | imu.linear_acceleration.z); |
| 142 | controller_.setAcc(acc); |
| 143 | } |
| 144 | |
| 145 | void SO3ControlNodelet::onInit(void) { |
| 146 | ros::NodeHandle n(getPrivateNodeHandle()); |