mavlink_msg_raw_imu.h 10.9 KB
Newer Older
James Goppert's avatar
James Goppert committed
1 2
// MESSAGE RAW_IMU PACKING

lm's avatar
lm committed
3
#define MAVLINK_MSG_ID_RAW_IMU 27
James Goppert's avatar
James Goppert committed
4

lm's avatar
lm committed
5
typedef struct __mavlink_raw_imu_t
James Goppert's avatar
James Goppert committed
6
{
7
 uint64_t time_usec; ///< Timestamp (microseconds since UNIX epoch or microseconds since system boot)
lm's avatar
lm committed
8 9 10 11 12 13 14 15 16
 int16_t xacc; ///< X acceleration (raw)
 int16_t yacc; ///< Y acceleration (raw)
 int16_t zacc; ///< Z acceleration (raw)
 int16_t xgyro; ///< Angular speed around X axis (raw)
 int16_t ygyro; ///< Angular speed around Y axis (raw)
 int16_t zgyro; ///< Angular speed around Z axis (raw)
 int16_t xmag; ///< X Magnetic field (raw)
 int16_t ymag; ///< Y Magnetic field (raw)
 int16_t zmag; ///< Z Magnetic field (raw)
James Goppert's avatar
James Goppert committed
17 18
} mavlink_raw_imu_t;

lm's avatar
lm committed
19
#define MAVLINK_MSG_ID_RAW_IMU_LEN 26
lm's avatar
lm committed
20
#define MAVLINK_MSG_ID_27_LEN 26
lm's avatar
lm committed
21 22 23 24 25 26



#define MAVLINK_MESSAGE_INFO_RAW_IMU { \
	"RAW_IMU", \
	10, \
lm's avatar
lm committed
27 28 29 30 31 32 33 34 35 36
	{  { "time_usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_raw_imu_t, time_usec) }, \
         { "xacc", NULL, MAVLINK_TYPE_INT16_T, 0, 8, offsetof(mavlink_raw_imu_t, xacc) }, \
         { "yacc", NULL, MAVLINK_TYPE_INT16_T, 0, 10, offsetof(mavlink_raw_imu_t, yacc) }, \
         { "zacc", NULL, MAVLINK_TYPE_INT16_T, 0, 12, offsetof(mavlink_raw_imu_t, zacc) }, \
         { "xgyro", NULL, MAVLINK_TYPE_INT16_T, 0, 14, offsetof(mavlink_raw_imu_t, xgyro) }, \
         { "ygyro", NULL, MAVLINK_TYPE_INT16_T, 0, 16, offsetof(mavlink_raw_imu_t, ygyro) }, \
         { "zgyro", NULL, MAVLINK_TYPE_INT16_T, 0, 18, offsetof(mavlink_raw_imu_t, zgyro) }, \
         { "xmag", NULL, MAVLINK_TYPE_INT16_T, 0, 20, offsetof(mavlink_raw_imu_t, xmag) }, \
         { "ymag", NULL, MAVLINK_TYPE_INT16_T, 0, 22, offsetof(mavlink_raw_imu_t, ymag) }, \
         { "zmag", NULL, MAVLINK_TYPE_INT16_T, 0, 24, offsetof(mavlink_raw_imu_t, zmag) }, \
lm's avatar
lm committed
37 38 39 40
         } \
}


James Goppert's avatar
James Goppert committed
41 42 43 44 45 46
/**
 * @brief Pack a raw_imu 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
 *
47
 * @param time_usec Timestamp (microseconds since UNIX epoch or microseconds since system boot)
James Goppert's avatar
James Goppert committed
48 49 50 51 52 53 54 55 56 57 58
 * @param xacc X acceleration (raw)
 * @param yacc Y acceleration (raw)
 * @param zacc Z acceleration (raw)
 * @param xgyro Angular speed around X axis (raw)
 * @param ygyro Angular speed around Y axis (raw)
 * @param zgyro Angular speed around Z axis (raw)
 * @param xmag X Magnetic field (raw)
 * @param ymag Y Magnetic field (raw)
 * @param zmag Z Magnetic field (raw)
 * @return length of the message in bytes (excluding serial stream start sign)
 */
lm's avatar
lm committed
59
static inline uint16_t mavlink_msg_raw_imu_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
60
						       uint64_t time_usec, int16_t xacc, int16_t yacc, int16_t zacc, int16_t xgyro, int16_t ygyro, int16_t zgyro, int16_t xmag, int16_t ymag, int16_t zmag)
James Goppert's avatar
James Goppert committed
61
{
LM's avatar
LM committed
62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[26];
	_mav_put_uint64_t(buf, 0, time_usec);
	_mav_put_int16_t(buf, 8, xacc);
	_mav_put_int16_t(buf, 10, yacc);
	_mav_put_int16_t(buf, 12, zacc);
	_mav_put_int16_t(buf, 14, xgyro);
	_mav_put_int16_t(buf, 16, ygyro);
	_mav_put_int16_t(buf, 18, zgyro);
	_mav_put_int16_t(buf, 20, xmag);
	_mav_put_int16_t(buf, 22, ymag);
	_mav_put_int16_t(buf, 24, zmag);

        memcpy(_MAV_PAYLOAD(msg), buf, 26);
#else
	mavlink_raw_imu_t packet;
	packet.time_usec = time_usec;
	packet.xacc = xacc;
	packet.yacc = yacc;
	packet.zacc = zacc;
	packet.xgyro = xgyro;
	packet.ygyro = ygyro;
	packet.zgyro = zgyro;
	packet.xmag = xmag;
	packet.ymag = ymag;
	packet.zmag = zmag;

        memcpy(_MAV_PAYLOAD(msg), &packet, 26);
#endif
lm's avatar
lm committed
91

LM's avatar
LM committed
92
	msg->msgid = MAVLINK_MSG_ID_RAW_IMU;
93
	return mavlink_finalize_message(msg, system_id, component_id, 26, 144);
James Goppert's avatar
James Goppert committed
94 95 96
}

/**
lm's avatar
lm committed
97
 * @brief Pack a raw_imu message on a channel
James Goppert's avatar
James Goppert committed
98 99 100 101
 * @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 was sent over
 * @param msg The MAVLink message to compress the data into
102
 * @param time_usec Timestamp (microseconds since UNIX epoch or microseconds since system boot)
James Goppert's avatar
James Goppert committed
103 104 105 106 107 108 109 110 111 112 113
 * @param xacc X acceleration (raw)
 * @param yacc Y acceleration (raw)
 * @param zacc Z acceleration (raw)
 * @param xgyro Angular speed around X axis (raw)
 * @param ygyro Angular speed around Y axis (raw)
 * @param zgyro Angular speed around Z axis (raw)
 * @param xmag X Magnetic field (raw)
 * @param ymag Y Magnetic field (raw)
 * @param zmag Z Magnetic field (raw)
 * @return length of the message in bytes (excluding serial stream start sign)
 */
lm's avatar
lm committed
114 115
static inline uint16_t mavlink_msg_raw_imu_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
							   mavlink_message_t* msg,
116
						           uint64_t time_usec,int16_t xacc,int16_t yacc,int16_t zacc,int16_t xgyro,int16_t ygyro,int16_t zgyro,int16_t xmag,int16_t ymag,int16_t zmag)
lm's avatar
lm committed
117
{
LM's avatar
LM committed
118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[26];
	_mav_put_uint64_t(buf, 0, time_usec);
	_mav_put_int16_t(buf, 8, xacc);
	_mav_put_int16_t(buf, 10, yacc);
	_mav_put_int16_t(buf, 12, zacc);
	_mav_put_int16_t(buf, 14, xgyro);
	_mav_put_int16_t(buf, 16, ygyro);
	_mav_put_int16_t(buf, 18, zgyro);
	_mav_put_int16_t(buf, 20, xmag);
	_mav_put_int16_t(buf, 22, ymag);
	_mav_put_int16_t(buf, 24, zmag);

        memcpy(_MAV_PAYLOAD(msg), buf, 26);
#else
	mavlink_raw_imu_t packet;
	packet.time_usec = time_usec;
	packet.xacc = xacc;
	packet.yacc = yacc;
	packet.zacc = zacc;
	packet.xgyro = xgyro;
	packet.ygyro = ygyro;
	packet.zgyro = zgyro;
	packet.xmag = xmag;
	packet.ymag = ymag;
	packet.zmag = zmag;

        memcpy(_MAV_PAYLOAD(msg), &packet, 26);
#endif
lm's avatar
lm committed
147

LM's avatar
LM committed
148
	msg->msgid = MAVLINK_MSG_ID_RAW_IMU;
149
	return mavlink_finalize_message_chan(msg, system_id, component_id, chan, 26, 144);
lm's avatar
lm committed
150 151
}

James Goppert's avatar
James Goppert committed
152 153 154 155 156 157 158 159 160 161
/**
 * @brief Encode a raw_imu struct into a 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
 * @param raw_imu C-struct to read the message contents from
 */
static inline uint16_t mavlink_msg_raw_imu_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_raw_imu_t* raw_imu)
{
162
	return mavlink_msg_raw_imu_pack(system_id, component_id, msg, raw_imu->time_usec, raw_imu->xacc, raw_imu->yacc, raw_imu->zacc, raw_imu->xgyro, raw_imu->ygyro, raw_imu->zgyro, raw_imu->xmag, raw_imu->ymag, raw_imu->zmag);
James Goppert's avatar
James Goppert committed
163 164 165 166 167 168
}

/**
 * @brief Send a raw_imu message
 * @param chan MAVLink channel to send the message
 *
169
 * @param time_usec Timestamp (microseconds since UNIX epoch or microseconds since system boot)
James Goppert's avatar
James Goppert committed
170 171 172 173 174 175 176 177 178 179
 * @param xacc X acceleration (raw)
 * @param yacc Y acceleration (raw)
 * @param zacc Z acceleration (raw)
 * @param xgyro Angular speed around X axis (raw)
 * @param ygyro Angular speed around Y axis (raw)
 * @param zgyro Angular speed around Z axis (raw)
 * @param xmag X Magnetic field (raw)
 * @param ymag Y Magnetic field (raw)
 * @param zmag Z Magnetic field (raw)
 */
lm's avatar
lm committed
180 181
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS

182
static inline void mavlink_msg_raw_imu_send(mavlink_channel_t chan, uint64_t time_usec, int16_t xacc, int16_t yacc, int16_t zacc, int16_t xgyro, int16_t ygyro, int16_t zgyro, int16_t xmag, int16_t ymag, int16_t zmag)
lm's avatar
lm committed
183
{
LM's avatar
LM committed
184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[26];
	_mav_put_uint64_t(buf, 0, time_usec);
	_mav_put_int16_t(buf, 8, xacc);
	_mav_put_int16_t(buf, 10, yacc);
	_mav_put_int16_t(buf, 12, zacc);
	_mav_put_int16_t(buf, 14, xgyro);
	_mav_put_int16_t(buf, 16, ygyro);
	_mav_put_int16_t(buf, 18, zgyro);
	_mav_put_int16_t(buf, 20, xmag);
	_mav_put_int16_t(buf, 22, ymag);
	_mav_put_int16_t(buf, 24, zmag);

	_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RAW_IMU, buf, 26, 144);
#else
	mavlink_raw_imu_t packet;
	packet.time_usec = time_usec;
	packet.xacc = xacc;
	packet.yacc = yacc;
	packet.zacc = zacc;
	packet.xgyro = xgyro;
	packet.ygyro = ygyro;
	packet.zgyro = zgyro;
	packet.xmag = xmag;
	packet.ymag = ymag;
	packet.zmag = zmag;

	_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RAW_IMU, (const char *)&packet, 26, 144);
#endif
James Goppert's avatar
James Goppert committed
213 214 215
}

#endif
lm's avatar
lm committed
216

James Goppert's avatar
James Goppert committed
217 218
// MESSAGE RAW_IMU UNPACKING

lm's avatar
lm committed
219

James Goppert's avatar
James Goppert committed
220
/**
221
 * @brief Get field time_usec from raw_imu message
James Goppert's avatar
James Goppert committed
222 223 224
 *
 * @return Timestamp (microseconds since UNIX epoch or microseconds since system boot)
 */
225
static inline uint64_t mavlink_msg_raw_imu_get_time_usec(const mavlink_message_t* msg)
James Goppert's avatar
James Goppert committed
226
{
LM's avatar
LM committed
227
	return _MAV_RETURN_uint64_t(msg,  0);
James Goppert's avatar
James Goppert committed
228 229 230 231 232 233 234 235 236
}

/**
 * @brief Get field xacc from raw_imu message
 *
 * @return X acceleration (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_xacc(const mavlink_message_t* msg)
{
LM's avatar
LM committed
237
	return _MAV_RETURN_int16_t(msg,  8);
James Goppert's avatar
James Goppert committed
238 239 240 241 242 243 244 245 246
}

/**
 * @brief Get field yacc from raw_imu message
 *
 * @return Y acceleration (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_yacc(const mavlink_message_t* msg)
{
LM's avatar
LM committed
247
	return _MAV_RETURN_int16_t(msg,  10);
James Goppert's avatar
James Goppert committed
248 249 250 251 252 253 254 255 256
}

/**
 * @brief Get field zacc from raw_imu message
 *
 * @return Z acceleration (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_zacc(const mavlink_message_t* msg)
{
LM's avatar
LM committed
257
	return _MAV_RETURN_int16_t(msg,  12);
James Goppert's avatar
James Goppert committed
258 259 260 261 262 263 264 265 266
}

/**
 * @brief Get field xgyro from raw_imu message
 *
 * @return Angular speed around X axis (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_xgyro(const mavlink_message_t* msg)
{
LM's avatar
LM committed
267
	return _MAV_RETURN_int16_t(msg,  14);
James Goppert's avatar
James Goppert committed
268 269 270 271 272 273 274 275 276
}

/**
 * @brief Get field ygyro from raw_imu message
 *
 * @return Angular speed around Y axis (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_ygyro(const mavlink_message_t* msg)
{
LM's avatar
LM committed
277
	return _MAV_RETURN_int16_t(msg,  16);
James Goppert's avatar
James Goppert committed
278 279 280 281 282 283 284 285 286
}

/**
 * @brief Get field zgyro from raw_imu message
 *
 * @return Angular speed around Z axis (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_zgyro(const mavlink_message_t* msg)
{
LM's avatar
LM committed
287
	return _MAV_RETURN_int16_t(msg,  18);
James Goppert's avatar
James Goppert committed
288 289 290 291 292 293 294 295 296
}

/**
 * @brief Get field xmag from raw_imu message
 *
 * @return X Magnetic field (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_xmag(const mavlink_message_t* msg)
{
LM's avatar
LM committed
297
	return _MAV_RETURN_int16_t(msg,  20);
James Goppert's avatar
James Goppert committed
298 299 300 301 302 303 304 305 306
}

/**
 * @brief Get field ymag from raw_imu message
 *
 * @return Y Magnetic field (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_ymag(const mavlink_message_t* msg)
{
LM's avatar
LM committed
307
	return _MAV_RETURN_int16_t(msg,  22);
James Goppert's avatar
James Goppert committed
308 309 310 311 312 313 314 315 316
}

/**
 * @brief Get field zmag from raw_imu message
 *
 * @return Z Magnetic field (raw)
 */
static inline int16_t mavlink_msg_raw_imu_get_zmag(const mavlink_message_t* msg)
{
LM's avatar
LM committed
317
	return _MAV_RETURN_int16_t(msg,  24);
James Goppert's avatar
James Goppert committed
318 319 320 321 322 323 324 325 326 327
}

/**
 * @brief Decode a raw_imu message into a struct
 *
 * @param msg The message to decode
 * @param raw_imu C-struct to decode the message contents into
 */
static inline void mavlink_msg_raw_imu_decode(const mavlink_message_t* msg, mavlink_raw_imu_t* raw_imu)
{
lm's avatar
lm committed
328
#if MAVLINK_NEED_BYTE_SWAP
329
	raw_imu->time_usec = mavlink_msg_raw_imu_get_time_usec(msg);
lm's avatar
lm committed
330 331 332 333 334 335 336 337 338 339
	raw_imu->xacc = mavlink_msg_raw_imu_get_xacc(msg);
	raw_imu->yacc = mavlink_msg_raw_imu_get_yacc(msg);
	raw_imu->zacc = mavlink_msg_raw_imu_get_zacc(msg);
	raw_imu->xgyro = mavlink_msg_raw_imu_get_xgyro(msg);
	raw_imu->ygyro = mavlink_msg_raw_imu_get_ygyro(msg);
	raw_imu->zgyro = mavlink_msg_raw_imu_get_zgyro(msg);
	raw_imu->xmag = mavlink_msg_raw_imu_get_xmag(msg);
	raw_imu->ymag = mavlink_msg_raw_imu_get_ymag(msg);
	raw_imu->zmag = mavlink_msg_raw_imu_get_zmag(msg);
#else
LM's avatar
LM committed
340
	memcpy(raw_imu, _MAV_PAYLOAD(msg), 26);
lm's avatar
lm committed
341
#endif
James Goppert's avatar
James Goppert committed
342
}