mavlink_msg_raw_imu.h 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488
  1. #pragma once
  2. // MESSAGE RAW_IMU PACKING
  3. #define MAVLINK_MSG_ID_RAW_IMU 27
  4. MAVPACKED(
  5. typedef struct __mavlink_raw_imu_t {
  6. uint64_t time_usec; /*< [us] Timestamp (UNIX Epoch time or time since system boot). The receiving end can infer timestamp format (since 1.1.1970 or since system boot) by checking for the magnitude of the number.*/
  7. int16_t xacc; /*< X acceleration (raw)*/
  8. int16_t yacc; /*< Y acceleration (raw)*/
  9. int16_t zacc; /*< Z acceleration (raw)*/
  10. int16_t xgyro; /*< Angular speed around X axis (raw)*/
  11. int16_t ygyro; /*< Angular speed around Y axis (raw)*/
  12. int16_t zgyro; /*< Angular speed around Z axis (raw)*/
  13. int16_t xmag; /*< X Magnetic field (raw)*/
  14. int16_t ymag; /*< Y Magnetic field (raw)*/
  15. int16_t zmag; /*< Z Magnetic field (raw)*/
  16. uint8_t id; /*< Id. Ids are numbered from 0 and map to IMUs numbered from 1 (e.g. IMU1 will have a message with id=0)*/
  17. int16_t temperature; /*< [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).*/
  18. }) mavlink_raw_imu_t;
  19. #define MAVLINK_MSG_ID_RAW_IMU_LEN 29
  20. #define MAVLINK_MSG_ID_RAW_IMU_MIN_LEN 26
  21. #define MAVLINK_MSG_ID_27_LEN 29
  22. #define MAVLINK_MSG_ID_27_MIN_LEN 26
  23. #define MAVLINK_MSG_ID_RAW_IMU_CRC 144
  24. #define MAVLINK_MSG_ID_27_CRC 144
  25. #if MAVLINK_COMMAND_24BIT
  26. #define MAVLINK_MESSAGE_INFO_RAW_IMU { \
  27. 27, \
  28. "RAW_IMU", \
  29. 12, \
  30. { { "time_usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_raw_imu_t, time_usec) }, \
  31. { "xacc", NULL, MAVLINK_TYPE_INT16_T, 0, 8, offsetof(mavlink_raw_imu_t, xacc) }, \
  32. { "yacc", NULL, MAVLINK_TYPE_INT16_T, 0, 10, offsetof(mavlink_raw_imu_t, yacc) }, \
  33. { "zacc", NULL, MAVLINK_TYPE_INT16_T, 0, 12, offsetof(mavlink_raw_imu_t, zacc) }, \
  34. { "xgyro", NULL, MAVLINK_TYPE_INT16_T, 0, 14, offsetof(mavlink_raw_imu_t, xgyro) }, \
  35. { "ygyro", NULL, MAVLINK_TYPE_INT16_T, 0, 16, offsetof(mavlink_raw_imu_t, ygyro) }, \
  36. { "zgyro", NULL, MAVLINK_TYPE_INT16_T, 0, 18, offsetof(mavlink_raw_imu_t, zgyro) }, \
  37. { "xmag", NULL, MAVLINK_TYPE_INT16_T, 0, 20, offsetof(mavlink_raw_imu_t, xmag) }, \
  38. { "ymag", NULL, MAVLINK_TYPE_INT16_T, 0, 22, offsetof(mavlink_raw_imu_t, ymag) }, \
  39. { "zmag", NULL, MAVLINK_TYPE_INT16_T, 0, 24, offsetof(mavlink_raw_imu_t, zmag) }, \
  40. { "id", NULL, MAVLINK_TYPE_UINT8_T, 0, 26, offsetof(mavlink_raw_imu_t, id) }, \
  41. { "temperature", NULL, MAVLINK_TYPE_INT16_T, 0, 27, offsetof(mavlink_raw_imu_t, temperature) }, \
  42. } \
  43. }
  44. #else
  45. #define MAVLINK_MESSAGE_INFO_RAW_IMU { \
  46. "RAW_IMU", \
  47. 12, \
  48. { { "time_usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_raw_imu_t, time_usec) }, \
  49. { "xacc", NULL, MAVLINK_TYPE_INT16_T, 0, 8, offsetof(mavlink_raw_imu_t, xacc) }, \
  50. { "yacc", NULL, MAVLINK_TYPE_INT16_T, 0, 10, offsetof(mavlink_raw_imu_t, yacc) }, \
  51. { "zacc", NULL, MAVLINK_TYPE_INT16_T, 0, 12, offsetof(mavlink_raw_imu_t, zacc) }, \
  52. { "xgyro", NULL, MAVLINK_TYPE_INT16_T, 0, 14, offsetof(mavlink_raw_imu_t, xgyro) }, \
  53. { "ygyro", NULL, MAVLINK_TYPE_INT16_T, 0, 16, offsetof(mavlink_raw_imu_t, ygyro) }, \
  54. { "zgyro", NULL, MAVLINK_TYPE_INT16_T, 0, 18, offsetof(mavlink_raw_imu_t, zgyro) }, \
  55. { "xmag", NULL, MAVLINK_TYPE_INT16_T, 0, 20, offsetof(mavlink_raw_imu_t, xmag) }, \
  56. { "ymag", NULL, MAVLINK_TYPE_INT16_T, 0, 22, offsetof(mavlink_raw_imu_t, ymag) }, \
  57. { "zmag", NULL, MAVLINK_TYPE_INT16_T, 0, 24, offsetof(mavlink_raw_imu_t, zmag) }, \
  58. { "id", NULL, MAVLINK_TYPE_UINT8_T, 0, 26, offsetof(mavlink_raw_imu_t, id) }, \
  59. { "temperature", NULL, MAVLINK_TYPE_INT16_T, 0, 27, offsetof(mavlink_raw_imu_t, temperature) }, \
  60. } \
  61. }
  62. #endif
  63. /**
  64. * @brief Pack a raw_imu message
  65. * @param system_id ID of this system
  66. * @param component_id ID of this component (e.g. 200 for IMU)
  67. * @param msg The MAVLink message to compress the data into
  68. *
  69. * @param time_usec [us] Timestamp (UNIX Epoch time or time since system boot). The receiving end can infer timestamp format (since 1.1.1970 or since system boot) by checking for the magnitude of the number.
  70. * @param xacc X acceleration (raw)
  71. * @param yacc Y acceleration (raw)
  72. * @param zacc Z acceleration (raw)
  73. * @param xgyro Angular speed around X axis (raw)
  74. * @param ygyro Angular speed around Y axis (raw)
  75. * @param zgyro Angular speed around Z axis (raw)
  76. * @param xmag X Magnetic field (raw)
  77. * @param ymag Y Magnetic field (raw)
  78. * @param zmag Z Magnetic field (raw)
  79. * @param id Id. Ids are numbered from 0 and map to IMUs numbered from 1 (e.g. IMU1 will have a message with id=0)
  80. * @param temperature [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  81. * @return length of the message in bytes (excluding serial stream start sign)
  82. */
  83. static inline uint16_t mavlink_msg_raw_imu_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  84. 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, uint8_t id, int16_t temperature)
  85. {
  86. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  87. char buf[MAVLINK_MSG_ID_RAW_IMU_LEN];
  88. _mav_put_uint64_t(buf, 0, time_usec);
  89. _mav_put_int16_t(buf, 8, xacc);
  90. _mav_put_int16_t(buf, 10, yacc);
  91. _mav_put_int16_t(buf, 12, zacc);
  92. _mav_put_int16_t(buf, 14, xgyro);
  93. _mav_put_int16_t(buf, 16, ygyro);
  94. _mav_put_int16_t(buf, 18, zgyro);
  95. _mav_put_int16_t(buf, 20, xmag);
  96. _mav_put_int16_t(buf, 22, ymag);
  97. _mav_put_int16_t(buf, 24, zmag);
  98. _mav_put_uint8_t(buf, 26, id);
  99. _mav_put_int16_t(buf, 27, temperature);
  100. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_RAW_IMU_LEN);
  101. #else
  102. mavlink_raw_imu_t packet;
  103. packet.time_usec = time_usec;
  104. packet.xacc = xacc;
  105. packet.yacc = yacc;
  106. packet.zacc = zacc;
  107. packet.xgyro = xgyro;
  108. packet.ygyro = ygyro;
  109. packet.zgyro = zgyro;
  110. packet.xmag = xmag;
  111. packet.ymag = ymag;
  112. packet.zmag = zmag;
  113. packet.id = id;
  114. packet.temperature = temperature;
  115. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_RAW_IMU_LEN);
  116. #endif
  117. msg->msgid = MAVLINK_MSG_ID_RAW_IMU;
  118. return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  119. }
  120. /**
  121. * @brief Pack a raw_imu message on a channel
  122. * @param system_id ID of this system
  123. * @param component_id ID of this component (e.g. 200 for IMU)
  124. * @param chan The MAVLink channel this message will be sent over
  125. * @param msg The MAVLink message to compress the data into
  126. * @param time_usec [us] Timestamp (UNIX Epoch time or time since system boot). The receiving end can infer timestamp format (since 1.1.1970 or since system boot) by checking for the magnitude of the number.
  127. * @param xacc X acceleration (raw)
  128. * @param yacc Y acceleration (raw)
  129. * @param zacc Z acceleration (raw)
  130. * @param xgyro Angular speed around X axis (raw)
  131. * @param ygyro Angular speed around Y axis (raw)
  132. * @param zgyro Angular speed around Z axis (raw)
  133. * @param xmag X Magnetic field (raw)
  134. * @param ymag Y Magnetic field (raw)
  135. * @param zmag Z Magnetic field (raw)
  136. * @param id Id. Ids are numbered from 0 and map to IMUs numbered from 1 (e.g. IMU1 will have a message with id=0)
  137. * @param temperature [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  138. * @return length of the message in bytes (excluding serial stream start sign)
  139. */
  140. static inline uint16_t mavlink_msg_raw_imu_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  141. mavlink_message_t* msg,
  142. 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,uint8_t id,int16_t temperature)
  143. {
  144. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  145. char buf[MAVLINK_MSG_ID_RAW_IMU_LEN];
  146. _mav_put_uint64_t(buf, 0, time_usec);
  147. _mav_put_int16_t(buf, 8, xacc);
  148. _mav_put_int16_t(buf, 10, yacc);
  149. _mav_put_int16_t(buf, 12, zacc);
  150. _mav_put_int16_t(buf, 14, xgyro);
  151. _mav_put_int16_t(buf, 16, ygyro);
  152. _mav_put_int16_t(buf, 18, zgyro);
  153. _mav_put_int16_t(buf, 20, xmag);
  154. _mav_put_int16_t(buf, 22, ymag);
  155. _mav_put_int16_t(buf, 24, zmag);
  156. _mav_put_uint8_t(buf, 26, id);
  157. _mav_put_int16_t(buf, 27, temperature);
  158. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_RAW_IMU_LEN);
  159. #else
  160. mavlink_raw_imu_t packet;
  161. packet.time_usec = time_usec;
  162. packet.xacc = xacc;
  163. packet.yacc = yacc;
  164. packet.zacc = zacc;
  165. packet.xgyro = xgyro;
  166. packet.ygyro = ygyro;
  167. packet.zgyro = zgyro;
  168. packet.xmag = xmag;
  169. packet.ymag = ymag;
  170. packet.zmag = zmag;
  171. packet.id = id;
  172. packet.temperature = temperature;
  173. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_RAW_IMU_LEN);
  174. #endif
  175. msg->msgid = MAVLINK_MSG_ID_RAW_IMU;
  176. return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  177. }
  178. /**
  179. * @brief Encode a raw_imu struct
  180. *
  181. * @param system_id ID of this system
  182. * @param component_id ID of this component (e.g. 200 for IMU)
  183. * @param msg The MAVLink message to compress the data into
  184. * @param raw_imu C-struct to read the message contents from
  185. */
  186. 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)
  187. {
  188. 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, raw_imu->id, raw_imu->temperature);
  189. }
  190. /**
  191. * @brief Encode a raw_imu struct on a channel
  192. *
  193. * @param system_id ID of this system
  194. * @param component_id ID of this component (e.g. 200 for IMU)
  195. * @param chan The MAVLink channel this message will be sent over
  196. * @param msg The MAVLink message to compress the data into
  197. * @param raw_imu C-struct to read the message contents from
  198. */
  199. static inline uint16_t mavlink_msg_raw_imu_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_raw_imu_t* raw_imu)
  200. {
  201. return mavlink_msg_raw_imu_pack_chan(system_id, component_id, chan, 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, raw_imu->id, raw_imu->temperature);
  202. }
  203. /**
  204. * @brief Send a raw_imu message
  205. * @param chan MAVLink channel to send the message
  206. *
  207. * @param time_usec [us] Timestamp (UNIX Epoch time or time since system boot). The receiving end can infer timestamp format (since 1.1.1970 or since system boot) by checking for the magnitude of the number.
  208. * @param xacc X acceleration (raw)
  209. * @param yacc Y acceleration (raw)
  210. * @param zacc Z acceleration (raw)
  211. * @param xgyro Angular speed around X axis (raw)
  212. * @param ygyro Angular speed around Y axis (raw)
  213. * @param zgyro Angular speed around Z axis (raw)
  214. * @param xmag X Magnetic field (raw)
  215. * @param ymag Y Magnetic field (raw)
  216. * @param zmag Z Magnetic field (raw)
  217. * @param id Id. Ids are numbered from 0 and map to IMUs numbered from 1 (e.g. IMU1 will have a message with id=0)
  218. * @param temperature [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  219. */
  220. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  221. 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, uint8_t id, int16_t temperature)
  222. {
  223. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  224. char buf[MAVLINK_MSG_ID_RAW_IMU_LEN];
  225. _mav_put_uint64_t(buf, 0, time_usec);
  226. _mav_put_int16_t(buf, 8, xacc);
  227. _mav_put_int16_t(buf, 10, yacc);
  228. _mav_put_int16_t(buf, 12, zacc);
  229. _mav_put_int16_t(buf, 14, xgyro);
  230. _mav_put_int16_t(buf, 16, ygyro);
  231. _mav_put_int16_t(buf, 18, zgyro);
  232. _mav_put_int16_t(buf, 20, xmag);
  233. _mav_put_int16_t(buf, 22, ymag);
  234. _mav_put_int16_t(buf, 24, zmag);
  235. _mav_put_uint8_t(buf, 26, id);
  236. _mav_put_int16_t(buf, 27, temperature);
  237. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RAW_IMU, buf, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  238. #else
  239. mavlink_raw_imu_t packet;
  240. packet.time_usec = time_usec;
  241. packet.xacc = xacc;
  242. packet.yacc = yacc;
  243. packet.zacc = zacc;
  244. packet.xgyro = xgyro;
  245. packet.ygyro = ygyro;
  246. packet.zgyro = zgyro;
  247. packet.xmag = xmag;
  248. packet.ymag = ymag;
  249. packet.zmag = zmag;
  250. packet.id = id;
  251. packet.temperature = temperature;
  252. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RAW_IMU, (const char *)&packet, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  253. #endif
  254. }
  255. /**
  256. * @brief Send a raw_imu message
  257. * @param chan MAVLink channel to send the message
  258. * @param struct The MAVLink struct to serialize
  259. */
  260. static inline void mavlink_msg_raw_imu_send_struct(mavlink_channel_t chan, const mavlink_raw_imu_t* raw_imu)
  261. {
  262. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  263. mavlink_msg_raw_imu_send(chan, 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, raw_imu->id, raw_imu->temperature);
  264. #else
  265. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RAW_IMU, (const char *)raw_imu, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  266. #endif
  267. }
  268. #if MAVLINK_MSG_ID_RAW_IMU_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  269. /*
  270. This variant of _send() can be used to save stack space by re-using
  271. memory from the receive buffer. The caller provides a
  272. mavlink_message_t which is the size of a full mavlink message. This
  273. is usually the receive buffer for the channel, and allows a reply to an
  274. incoming message with minimum stack space usage.
  275. */
  276. static inline void mavlink_msg_raw_imu_send_buf(mavlink_message_t *msgbuf, 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, uint8_t id, int16_t temperature)
  277. {
  278. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  279. char *buf = (char *)msgbuf;
  280. _mav_put_uint64_t(buf, 0, time_usec);
  281. _mav_put_int16_t(buf, 8, xacc);
  282. _mav_put_int16_t(buf, 10, yacc);
  283. _mav_put_int16_t(buf, 12, zacc);
  284. _mav_put_int16_t(buf, 14, xgyro);
  285. _mav_put_int16_t(buf, 16, ygyro);
  286. _mav_put_int16_t(buf, 18, zgyro);
  287. _mav_put_int16_t(buf, 20, xmag);
  288. _mav_put_int16_t(buf, 22, ymag);
  289. _mav_put_int16_t(buf, 24, zmag);
  290. _mav_put_uint8_t(buf, 26, id);
  291. _mav_put_int16_t(buf, 27, temperature);
  292. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RAW_IMU, buf, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  293. #else
  294. mavlink_raw_imu_t *packet = (mavlink_raw_imu_t *)msgbuf;
  295. packet->time_usec = time_usec;
  296. packet->xacc = xacc;
  297. packet->yacc = yacc;
  298. packet->zacc = zacc;
  299. packet->xgyro = xgyro;
  300. packet->ygyro = ygyro;
  301. packet->zgyro = zgyro;
  302. packet->xmag = xmag;
  303. packet->ymag = ymag;
  304. packet->zmag = zmag;
  305. packet->id = id;
  306. packet->temperature = temperature;
  307. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RAW_IMU, (const char *)packet, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  308. #endif
  309. }
  310. #endif
  311. #endif
  312. // MESSAGE RAW_IMU UNPACKING
  313. /**
  314. * @brief Get field time_usec from raw_imu message
  315. *
  316. * @return [us] Timestamp (UNIX Epoch time or time since system boot). The receiving end can infer timestamp format (since 1.1.1970 or since system boot) by checking for the magnitude of the number.
  317. */
  318. static inline uint64_t mavlink_msg_raw_imu_get_time_usec(const mavlink_message_t* msg)
  319. {
  320. return _MAV_RETURN_uint64_t(msg, 0);
  321. }
  322. /**
  323. * @brief Get field xacc from raw_imu message
  324. *
  325. * @return X acceleration (raw)
  326. */
  327. static inline int16_t mavlink_msg_raw_imu_get_xacc(const mavlink_message_t* msg)
  328. {
  329. return _MAV_RETURN_int16_t(msg, 8);
  330. }
  331. /**
  332. * @brief Get field yacc from raw_imu message
  333. *
  334. * @return Y acceleration (raw)
  335. */
  336. static inline int16_t mavlink_msg_raw_imu_get_yacc(const mavlink_message_t* msg)
  337. {
  338. return _MAV_RETURN_int16_t(msg, 10);
  339. }
  340. /**
  341. * @brief Get field zacc from raw_imu message
  342. *
  343. * @return Z acceleration (raw)
  344. */
  345. static inline int16_t mavlink_msg_raw_imu_get_zacc(const mavlink_message_t* msg)
  346. {
  347. return _MAV_RETURN_int16_t(msg, 12);
  348. }
  349. /**
  350. * @brief Get field xgyro from raw_imu message
  351. *
  352. * @return Angular speed around X axis (raw)
  353. */
  354. static inline int16_t mavlink_msg_raw_imu_get_xgyro(const mavlink_message_t* msg)
  355. {
  356. return _MAV_RETURN_int16_t(msg, 14);
  357. }
  358. /**
  359. * @brief Get field ygyro from raw_imu message
  360. *
  361. * @return Angular speed around Y axis (raw)
  362. */
  363. static inline int16_t mavlink_msg_raw_imu_get_ygyro(const mavlink_message_t* msg)
  364. {
  365. return _MAV_RETURN_int16_t(msg, 16);
  366. }
  367. /**
  368. * @brief Get field zgyro from raw_imu message
  369. *
  370. * @return Angular speed around Z axis (raw)
  371. */
  372. static inline int16_t mavlink_msg_raw_imu_get_zgyro(const mavlink_message_t* msg)
  373. {
  374. return _MAV_RETURN_int16_t(msg, 18);
  375. }
  376. /**
  377. * @brief Get field xmag from raw_imu message
  378. *
  379. * @return X Magnetic field (raw)
  380. */
  381. static inline int16_t mavlink_msg_raw_imu_get_xmag(const mavlink_message_t* msg)
  382. {
  383. return _MAV_RETURN_int16_t(msg, 20);
  384. }
  385. /**
  386. * @brief Get field ymag from raw_imu message
  387. *
  388. * @return Y Magnetic field (raw)
  389. */
  390. static inline int16_t mavlink_msg_raw_imu_get_ymag(const mavlink_message_t* msg)
  391. {
  392. return _MAV_RETURN_int16_t(msg, 22);
  393. }
  394. /**
  395. * @brief Get field zmag from raw_imu message
  396. *
  397. * @return Z Magnetic field (raw)
  398. */
  399. static inline int16_t mavlink_msg_raw_imu_get_zmag(const mavlink_message_t* msg)
  400. {
  401. return _MAV_RETURN_int16_t(msg, 24);
  402. }
  403. /**
  404. * @brief Get field id from raw_imu message
  405. *
  406. * @return Id. Ids are numbered from 0 and map to IMUs numbered from 1 (e.g. IMU1 will have a message with id=0)
  407. */
  408. static inline uint8_t mavlink_msg_raw_imu_get_id(const mavlink_message_t* msg)
  409. {
  410. return _MAV_RETURN_uint8_t(msg, 26);
  411. }
  412. /**
  413. * @brief Get field temperature from raw_imu message
  414. *
  415. * @return [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  416. */
  417. static inline int16_t mavlink_msg_raw_imu_get_temperature(const mavlink_message_t* msg)
  418. {
  419. return _MAV_RETURN_int16_t(msg, 27);
  420. }
  421. /**
  422. * @brief Decode a raw_imu message into a struct
  423. *
  424. * @param msg The message to decode
  425. * @param raw_imu C-struct to decode the message contents into
  426. */
  427. static inline void mavlink_msg_raw_imu_decode(const mavlink_message_t* msg, mavlink_raw_imu_t* raw_imu)
  428. {
  429. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  430. raw_imu->time_usec = mavlink_msg_raw_imu_get_time_usec(msg);
  431. raw_imu->xacc = mavlink_msg_raw_imu_get_xacc(msg);
  432. raw_imu->yacc = mavlink_msg_raw_imu_get_yacc(msg);
  433. raw_imu->zacc = mavlink_msg_raw_imu_get_zacc(msg);
  434. raw_imu->xgyro = mavlink_msg_raw_imu_get_xgyro(msg);
  435. raw_imu->ygyro = mavlink_msg_raw_imu_get_ygyro(msg);
  436. raw_imu->zgyro = mavlink_msg_raw_imu_get_zgyro(msg);
  437. raw_imu->xmag = mavlink_msg_raw_imu_get_xmag(msg);
  438. raw_imu->ymag = mavlink_msg_raw_imu_get_ymag(msg);
  439. raw_imu->zmag = mavlink_msg_raw_imu_get_zmag(msg);
  440. raw_imu->id = mavlink_msg_raw_imu_get_id(msg);
  441. raw_imu->temperature = mavlink_msg_raw_imu_get_temperature(msg);
  442. #else
  443. uint8_t len = msg->len < MAVLINK_MSG_ID_RAW_IMU_LEN? msg->len : MAVLINK_MSG_ID_RAW_IMU_LEN;
  444. memset(raw_imu, 0, MAVLINK_MSG_ID_RAW_IMU_LEN);
  445. memcpy(raw_imu, _MAV_PAYLOAD(msg), len);
  446. #endif
  447. }