C++ (Cpp) mavlink_msg_attitude_quaternion_send示例

示例#1

文件： mavlink.c 项目： enacuavlab/paparazzi

static void mavlink_send_attitude_quaternion(struct transport_tx *trans, struct link_device *dev)
{
  mavlink_msg_attitude_quaternion_send(MAVLINK_COMM_0,
                                       get_sys_time_msec(),
                                       stateGetNedToBodyQuat_f()->qi,
                                       stateGetNedToBodyQuat_f()->qx,
                                       stateGetNedToBodyQuat_f()->qy,
                                       stateGetNedToBodyQuat_f()->qz,
                                       stateGetBodyRates_f()->p,
                                       stateGetBodyRates_f()->q,
                                       stateGetBodyRates_f()->r);
  MAVLinkSendMessage();
}

示例#2

文件： mavlink.c 项目： fandelxin/paparazzi

static inline void mavlink_send_attitude_quaternion(void)
{
  mavlink_msg_attitude_quaternion_send(MAVLINK_COMM_0,
                                       get_sys_time_msec(),
                                       stateGetNedToBodyQuat_f()->qi,
                                       stateGetNedToBodyQuat_f()->qx,
                                       stateGetNedToBodyQuat_f()->qy,
                                       stateGetNedToBodyQuat_f()->qz,
                                       stateGetBodyRates_f()->p,
                                       stateGetBodyRates_f()->q,
                                       stateGetBodyRates_f()->r);
  MAVLinkSendMessage();
}

示例#3

文件： mavlink_messages.cpp 项目： jamesr27/lockwingPixhawk

	void send(const hrt_abstime t)
	{
		if (att_sub->update(t)) {
			mavlink_msg_attitude_quaternion_send(_channel,
							     att->timestamp / 1000,
							     att->q[0],
							     att->q[1],
							     att->q[2],
							     att->q[3],
							     att->rollspeed,
							     att->pitchspeed,
							     att->yawspeed);
		}
	}

示例#4

文件： mavlink_messages.cpp 项目： dimakuz26/PX4_NMEA

	void send(const hrt_abstime t)
	{
		struct vehicle_attitude_s att;

		if (att_sub->update(&att_time, &att)) {
			mavlink_msg_attitude_quaternion_send(_channel,
							     att.timestamp / 1000,
							     att.q[0],
							     att.q[1],
							     att.q[2],
							     att.q[3],
							     att.rollspeed,
							     att.pitchspeed,
							     att.yawspeed);
		}
	}