mavlink_msg_obs_attitude.h 7.46 KB
Newer Older
1 2 3 4 5 6
// MESSAGE OBS_ATTITUDE PACKING

#define MAVLINK_MSG_ID_OBS_ATTITUDE 174

typedef struct __mavlink_obs_attitude_t
{
Lorenz Meier's avatar
Lorenz Meier committed
7 8 9
 double quat[4]; ///< 
                
            
10 11 12 13 14
} mavlink_obs_attitude_t;

#define MAVLINK_MSG_ID_OBS_ATTITUDE_LEN 32
#define MAVLINK_MSG_ID_174_LEN 32

Lorenz Meier's avatar
Lorenz Meier committed
15 16 17
#define MAVLINK_MSG_ID_OBS_ATTITUDE_CRC 146
#define MAVLINK_MSG_ID_174_CRC 146

18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33
#define MAVLINK_MSG_OBS_ATTITUDE_FIELD_QUAT_LEN 4

#define MAVLINK_MESSAGE_INFO_OBS_ATTITUDE { \
	"OBS_ATTITUDE", \
	1, \
	{  { "quat", NULL, MAVLINK_TYPE_DOUBLE, 4, 0, offsetof(mavlink_obs_attitude_t, quat) }, \
         } \
}


/**
 * @brief Pack a obs_attitude message
 * @param system_id ID of this system
 * @param component_id ID of this component (e.g. 200 for IMU)
 * @param msg The MAVLink message to compress the data into
 *
Lorenz Meier's avatar
Lorenz Meier committed
34 35 36
 * @param quat 
                
            
37 38 39 40 41 42
 * @return length of the message in bytes (excluding serial stream start sign)
 */
static inline uint16_t mavlink_msg_obs_attitude_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
						       const double *quat)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
Lorenz Meier's avatar
Lorenz Meier committed
43
	char buf[MAVLINK_MSG_ID_OBS_ATTITUDE_LEN];
44 45

	_mav_put_double_array(buf, 0, quat, 4);
Lorenz Meier's avatar
Lorenz Meier committed
46
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
47 48 49 50
#else
	mavlink_obs_attitude_t packet;

	mav_array_memcpy(packet.quat, quat, sizeof(double)*4);
Lorenz Meier's avatar
Lorenz Meier committed
51
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
52 53 54
#endif

	msg->msgid = MAVLINK_MSG_ID_OBS_ATTITUDE;
Lorenz Meier's avatar
Lorenz Meier committed
55 56 57 58 59
#if MAVLINK_CRC_EXTRA
    return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN, MAVLINK_MSG_ID_OBS_ATTITUDE_CRC);
#else
    return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
#endif
60 61 62 63 64 65
}

/**
 * @brief Pack a obs_attitude message on a channel
 * @param system_id ID of this system
 * @param component_id ID of this component (e.g. 200 for IMU)
Lorenz Meier's avatar
Lorenz Meier committed
66
 * @param chan The MAVLink channel this message will be sent over
67
 * @param msg The MAVLink message to compress the data into
Lorenz Meier's avatar
Lorenz Meier committed
68 69 70
 * @param quat 
                
            
71 72 73 74 75 76 77
 * @return length of the message in bytes (excluding serial stream start sign)
 */
static inline uint16_t mavlink_msg_obs_attitude_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
							   mavlink_message_t* msg,
						           const double *quat)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
Lorenz Meier's avatar
Lorenz Meier committed
78
	char buf[MAVLINK_MSG_ID_OBS_ATTITUDE_LEN];
79 80

	_mav_put_double_array(buf, 0, quat, 4);
Lorenz Meier's avatar
Lorenz Meier committed
81
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
82 83 84 85
#else
	mavlink_obs_attitude_t packet;

	mav_array_memcpy(packet.quat, quat, sizeof(double)*4);
Lorenz Meier's avatar
Lorenz Meier committed
86
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
87 88 89
#endif

	msg->msgid = MAVLINK_MSG_ID_OBS_ATTITUDE;
Lorenz Meier's avatar
Lorenz Meier committed
90 91 92 93 94
#if MAVLINK_CRC_EXTRA
    return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN, MAVLINK_MSG_ID_OBS_ATTITUDE_CRC);
#else
    return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
#endif
95 96 97
}

/**
Lorenz Meier's avatar
Lorenz Meier committed
98
 * @brief Encode a obs_attitude struct
99 100 101 102 103 104 105 106 107 108 109
 *
 * @param system_id ID of this system
 * @param component_id ID of this component (e.g. 200 for IMU)
 * @param msg The MAVLink message to compress the data into
 * @param obs_attitude C-struct to read the message contents from
 */
static inline uint16_t mavlink_msg_obs_attitude_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_obs_attitude_t* obs_attitude)
{
	return mavlink_msg_obs_attitude_pack(system_id, component_id, msg, obs_attitude->quat);
}

Lorenz Meier's avatar
Lorenz Meier committed
110 111 112 113 114 115 116 117 118 119 120 121 122 123
/**
 * @brief Encode a obs_attitude struct on a channel
 *
 * @param system_id ID of this system
 * @param component_id ID of this component (e.g. 200 for IMU)
 * @param chan The MAVLink channel this message will be sent over
 * @param msg The MAVLink message to compress the data into
 * @param obs_attitude C-struct to read the message contents from
 */
static inline uint16_t mavlink_msg_obs_attitude_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_obs_attitude_t* obs_attitude)
{
	return mavlink_msg_obs_attitude_pack_chan(system_id, component_id, chan, msg, obs_attitude->quat);
}

124 125 126 127
/**
 * @brief Send a obs_attitude message
 * @param chan MAVLink channel to send the message
 *
Lorenz Meier's avatar
Lorenz Meier committed
128 129 130
 * @param quat 
                
            
131 132 133 134 135 136
 */
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS

static inline void mavlink_msg_obs_attitude_send(mavlink_channel_t chan, const double *quat)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
Lorenz Meier's avatar
Lorenz Meier committed
137
	char buf[MAVLINK_MSG_ID_OBS_ATTITUDE_LEN];
138 139

	_mav_put_double_array(buf, 0, quat, 4);
Lorenz Meier's avatar
Lorenz Meier committed
140 141 142 143 144
#if MAVLINK_CRC_EXTRA
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, buf, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN, MAVLINK_MSG_ID_OBS_ATTITUDE_CRC);
#else
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, buf, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
#endif
145 146 147 148
#else
	mavlink_obs_attitude_t packet;

	mav_array_memcpy(packet.quat, quat, sizeof(double)*4);
Lorenz Meier's avatar
Lorenz Meier committed
149 150 151 152 153
#if MAVLINK_CRC_EXTRA
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, (const char *)&packet, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN, MAVLINK_MSG_ID_OBS_ATTITUDE_CRC);
#else
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, (const char *)&packet, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
#endif
154 155 156
#endif
}

157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188
#if MAVLINK_MSG_ID_OBS_ATTITUDE_LEN <= MAVLINK_MAX_PAYLOAD_LEN
/*
  This varient of _send() can be used to save stack space by re-using
  memory from the receive buffer.  The caller provides a
  mavlink_message_t which is the size of a full mavlink message. This
  is usually the receive buffer for the channel, and allows a reply to an
  incoming message with minimum stack space usage.
 */
static inline void mavlink_msg_obs_attitude_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan,  const double *quat)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char *buf = (char *)msgbuf;

	_mav_put_double_array(buf, 0, quat, 4);
#if MAVLINK_CRC_EXTRA
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, buf, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN, MAVLINK_MSG_ID_OBS_ATTITUDE_CRC);
#else
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, buf, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
#endif
#else
	mavlink_obs_attitude_t *packet = (mavlink_obs_attitude_t *)msgbuf;

	mav_array_memcpy(packet->quat, quat, sizeof(double)*4);
#if MAVLINK_CRC_EXTRA
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, (const char *)packet, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN, MAVLINK_MSG_ID_OBS_ATTITUDE_CRC);
#else
    _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, (const char *)packet, MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
#endif
#endif
}
#endif

189 190 191 192 193 194 195 196
#endif

// MESSAGE OBS_ATTITUDE UNPACKING


/**
 * @brief Get field quat from obs_attitude message
 *
Lorenz Meier's avatar
Lorenz Meier committed
197 198 199
 * @return 
                
            
200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216
 */
static inline uint16_t mavlink_msg_obs_attitude_get_quat(const mavlink_message_t* msg, double *quat)
{
	return _MAV_RETURN_double_array(msg, quat, 4,  0);
}

/**
 * @brief Decode a obs_attitude message into a struct
 *
 * @param msg The message to decode
 * @param obs_attitude C-struct to decode the message contents into
 */
static inline void mavlink_msg_obs_attitude_decode(const mavlink_message_t* msg, mavlink_obs_attitude_t* obs_attitude)
{
#if MAVLINK_NEED_BYTE_SWAP
	mavlink_msg_obs_attitude_get_quat(msg, obs_attitude->quat);
#else
Lorenz Meier's avatar
Lorenz Meier committed
217
	memcpy(obs_attitude, _MAV_PAYLOAD(msg), MAVLINK_MSG_ID_OBS_ATTITUDE_LEN);
218 219
#endif
}