void twist_cb(const geometry_msgs::TwistStamped::ConstPtr &req) { send_attitude_ang_velocity( req->header.stamp, req->twist.angular.x, req->twist.angular.y, req->twist.angular.z); }
void attitude_twist_cb(const geometry_msgs::TwistStamped::ConstPtr &req, const mavros_msgs::Thrust::ConstPtr &thrust_msg) { Eigen::Vector3d ang_vel; tf::vectorMsgToEigen(req->twist.angular, ang_vel); if (is_normalized(thrust_msg->thrust)) send_attitude_ang_velocity(req->header.stamp, ang_vel, thrust_msg->thrust); }
void twist_cb(const geometry_msgs::TwistStamped::ConstPtr &req) { Eigen::Vector3d ang_vel; tf::vectorMsgToEigen(req->twist.angular, ang_vel); send_attitude_ang_velocity(req->header.stamp, ang_vel); }
void twist_cb(const geometry_msgs::Twist::ConstPtr &req) { send_attitude_ang_velocity( req->angular.x, req->angular.y, req->angular.z); }