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);
	}
예제 #2
0
	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);
	}
예제 #3
0
	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);
	}
예제 #4
0
	void twist_cb(const geometry_msgs::Twist::ConstPtr &req) {
		send_attitude_ang_velocity(
				req->angular.x,
				req->angular.y,
				req->angular.z);
	}