mavlink_msg_raw_imu.h 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568
  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
  122. * @param system_id ID of this system
  123. * @param component_id ID of this component (e.g. 200 for IMU)
  124. * @param status MAVLink status structure
  125. * @param msg The MAVLink message to compress the data into
  126. *
  127. * @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.
  128. * @param xacc X acceleration (raw)
  129. * @param yacc Y acceleration (raw)
  130. * @param zacc Z acceleration (raw)
  131. * @param xgyro Angular speed around X axis (raw)
  132. * @param ygyro Angular speed around Y axis (raw)
  133. * @param zgyro Angular speed around Z axis (raw)
  134. * @param xmag X Magnetic field (raw)
  135. * @param ymag Y Magnetic field (raw)
  136. * @param zmag Z Magnetic field (raw)
  137. * @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)
  138. * @param temperature [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  139. * @return length of the message in bytes (excluding serial stream start sign)
  140. */
  141. static inline uint16_t mavlink_msg_raw_imu_pack_status(uint8_t system_id, uint8_t component_id, mavlink_status_t *_status, 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. #if MAVLINK_CRC_EXTRA
  177. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN, MAVLINK_MSG_ID_RAW_IMU_CRC);
  178. #else
  179. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_RAW_IMU_MIN_LEN, MAVLINK_MSG_ID_RAW_IMU_LEN);
  180. #endif
  181. }
  182. /**
  183. * @brief Pack a raw_imu message on a channel
  184. * @param system_id ID of this system
  185. * @param component_id ID of this component (e.g. 200 for IMU)
  186. * @param chan The MAVLink channel this message will be sent over
  187. * @param msg The MAVLink message to compress the data into
  188. * @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.
  189. * @param xacc X acceleration (raw)
  190. * @param yacc Y acceleration (raw)
  191. * @param zacc Z acceleration (raw)
  192. * @param xgyro Angular speed around X axis (raw)
  193. * @param ygyro Angular speed around Y axis (raw)
  194. * @param zgyro Angular speed around Z axis (raw)
  195. * @param xmag X Magnetic field (raw)
  196. * @param ymag Y Magnetic field (raw)
  197. * @param zmag Z Magnetic field (raw)
  198. * @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)
  199. * @param temperature [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  200. * @return length of the message in bytes (excluding serial stream start sign)
  201. */
  202. static inline uint16_t mavlink_msg_raw_imu_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  203. mavlink_message_t* msg,
  204. 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)
  205. {
  206. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  207. char buf[MAVLINK_MSG_ID_RAW_IMU_LEN];
  208. _mav_put_uint64_t(buf, 0, time_usec);
  209. _mav_put_int16_t(buf, 8, xacc);
  210. _mav_put_int16_t(buf, 10, yacc);
  211. _mav_put_int16_t(buf, 12, zacc);
  212. _mav_put_int16_t(buf, 14, xgyro);
  213. _mav_put_int16_t(buf, 16, ygyro);
  214. _mav_put_int16_t(buf, 18, zgyro);
  215. _mav_put_int16_t(buf, 20, xmag);
  216. _mav_put_int16_t(buf, 22, ymag);
  217. _mav_put_int16_t(buf, 24, zmag);
  218. _mav_put_uint8_t(buf, 26, id);
  219. _mav_put_int16_t(buf, 27, temperature);
  220. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_RAW_IMU_LEN);
  221. #else
  222. mavlink_raw_imu_t packet;
  223. packet.time_usec = time_usec;
  224. packet.xacc = xacc;
  225. packet.yacc = yacc;
  226. packet.zacc = zacc;
  227. packet.xgyro = xgyro;
  228. packet.ygyro = ygyro;
  229. packet.zgyro = zgyro;
  230. packet.xmag = xmag;
  231. packet.ymag = ymag;
  232. packet.zmag = zmag;
  233. packet.id = id;
  234. packet.temperature = temperature;
  235. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_RAW_IMU_LEN);
  236. #endif
  237. msg->msgid = MAVLINK_MSG_ID_RAW_IMU;
  238. 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);
  239. }
  240. /**
  241. * @brief Encode a raw_imu struct
  242. *
  243. * @param system_id ID of this system
  244. * @param component_id ID of this component (e.g. 200 for IMU)
  245. * @param msg The MAVLink message to compress the data into
  246. * @param raw_imu C-struct to read the message contents from
  247. */
  248. 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)
  249. {
  250. 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);
  251. }
  252. /**
  253. * @brief Encode a raw_imu struct on a channel
  254. *
  255. * @param system_id ID of this system
  256. * @param component_id ID of this component (e.g. 200 for IMU)
  257. * @param chan The MAVLink channel this message will be sent over
  258. * @param msg The MAVLink message to compress the data into
  259. * @param raw_imu C-struct to read the message contents from
  260. */
  261. 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)
  262. {
  263. 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);
  264. }
  265. /**
  266. * @brief Encode a raw_imu struct with provided status structure
  267. *
  268. * @param system_id ID of this system
  269. * @param component_id ID of this component (e.g. 200 for IMU)
  270. * @param status MAVLink status structure
  271. * @param msg The MAVLink message to compress the data into
  272. * @param raw_imu C-struct to read the message contents from
  273. */
  274. static inline uint16_t mavlink_msg_raw_imu_encode_status(uint8_t system_id, uint8_t component_id, mavlink_status_t* _status, mavlink_message_t* msg, const mavlink_raw_imu_t* raw_imu)
  275. {
  276. return mavlink_msg_raw_imu_pack_status(system_id, component_id, _status, 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);
  277. }
  278. /**
  279. * @brief Send a raw_imu message
  280. * @param chan MAVLink channel to send the message
  281. *
  282. * @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.
  283. * @param xacc X acceleration (raw)
  284. * @param yacc Y acceleration (raw)
  285. * @param zacc Z acceleration (raw)
  286. * @param xgyro Angular speed around X axis (raw)
  287. * @param ygyro Angular speed around Y axis (raw)
  288. * @param zgyro Angular speed around Z axis (raw)
  289. * @param xmag X Magnetic field (raw)
  290. * @param ymag Y Magnetic field (raw)
  291. * @param zmag Z Magnetic field (raw)
  292. * @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)
  293. * @param temperature [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  294. */
  295. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  296. 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)
  297. {
  298. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  299. char buf[MAVLINK_MSG_ID_RAW_IMU_LEN];
  300. _mav_put_uint64_t(buf, 0, time_usec);
  301. _mav_put_int16_t(buf, 8, xacc);
  302. _mav_put_int16_t(buf, 10, yacc);
  303. _mav_put_int16_t(buf, 12, zacc);
  304. _mav_put_int16_t(buf, 14, xgyro);
  305. _mav_put_int16_t(buf, 16, ygyro);
  306. _mav_put_int16_t(buf, 18, zgyro);
  307. _mav_put_int16_t(buf, 20, xmag);
  308. _mav_put_int16_t(buf, 22, ymag);
  309. _mav_put_int16_t(buf, 24, zmag);
  310. _mav_put_uint8_t(buf, 26, id);
  311. _mav_put_int16_t(buf, 27, temperature);
  312. _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);
  313. #else
  314. mavlink_raw_imu_t packet;
  315. packet.time_usec = time_usec;
  316. packet.xacc = xacc;
  317. packet.yacc = yacc;
  318. packet.zacc = zacc;
  319. packet.xgyro = xgyro;
  320. packet.ygyro = ygyro;
  321. packet.zgyro = zgyro;
  322. packet.xmag = xmag;
  323. packet.ymag = ymag;
  324. packet.zmag = zmag;
  325. packet.id = id;
  326. packet.temperature = temperature;
  327. _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);
  328. #endif
  329. }
  330. /**
  331. * @brief Send a raw_imu message
  332. * @param chan MAVLink channel to send the message
  333. * @param struct The MAVLink struct to serialize
  334. */
  335. static inline void mavlink_msg_raw_imu_send_struct(mavlink_channel_t chan, const mavlink_raw_imu_t* raw_imu)
  336. {
  337. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  338. 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);
  339. #else
  340. _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);
  341. #endif
  342. }
  343. #if MAVLINK_MSG_ID_RAW_IMU_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  344. /*
  345. This variant of _send() can be used to save stack space by re-using
  346. memory from the receive buffer. The caller provides a
  347. mavlink_message_t which is the size of a full mavlink message. This
  348. is usually the receive buffer for the channel, and allows a reply to an
  349. incoming message with minimum stack space usage.
  350. */
  351. 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)
  352. {
  353. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  354. char *buf = (char *)msgbuf;
  355. _mav_put_uint64_t(buf, 0, time_usec);
  356. _mav_put_int16_t(buf, 8, xacc);
  357. _mav_put_int16_t(buf, 10, yacc);
  358. _mav_put_int16_t(buf, 12, zacc);
  359. _mav_put_int16_t(buf, 14, xgyro);
  360. _mav_put_int16_t(buf, 16, ygyro);
  361. _mav_put_int16_t(buf, 18, zgyro);
  362. _mav_put_int16_t(buf, 20, xmag);
  363. _mav_put_int16_t(buf, 22, ymag);
  364. _mav_put_int16_t(buf, 24, zmag);
  365. _mav_put_uint8_t(buf, 26, id);
  366. _mav_put_int16_t(buf, 27, temperature);
  367. _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);
  368. #else
  369. mavlink_raw_imu_t *packet = (mavlink_raw_imu_t *)msgbuf;
  370. packet->time_usec = time_usec;
  371. packet->xacc = xacc;
  372. packet->yacc = yacc;
  373. packet->zacc = zacc;
  374. packet->xgyro = xgyro;
  375. packet->ygyro = ygyro;
  376. packet->zgyro = zgyro;
  377. packet->xmag = xmag;
  378. packet->ymag = ymag;
  379. packet->zmag = zmag;
  380. packet->id = id;
  381. packet->temperature = temperature;
  382. _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);
  383. #endif
  384. }
  385. #endif
  386. #endif
  387. // MESSAGE RAW_IMU UNPACKING
  388. /**
  389. * @brief Get field time_usec from raw_imu message
  390. *
  391. * @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.
  392. */
  393. static inline uint64_t mavlink_msg_raw_imu_get_time_usec(const mavlink_message_t* msg)
  394. {
  395. return _MAV_RETURN_uint64_t(msg, 0);
  396. }
  397. /**
  398. * @brief Get field xacc from raw_imu message
  399. *
  400. * @return X acceleration (raw)
  401. */
  402. static inline int16_t mavlink_msg_raw_imu_get_xacc(const mavlink_message_t* msg)
  403. {
  404. return _MAV_RETURN_int16_t(msg, 8);
  405. }
  406. /**
  407. * @brief Get field yacc from raw_imu message
  408. *
  409. * @return Y acceleration (raw)
  410. */
  411. static inline int16_t mavlink_msg_raw_imu_get_yacc(const mavlink_message_t* msg)
  412. {
  413. return _MAV_RETURN_int16_t(msg, 10);
  414. }
  415. /**
  416. * @brief Get field zacc from raw_imu message
  417. *
  418. * @return Z acceleration (raw)
  419. */
  420. static inline int16_t mavlink_msg_raw_imu_get_zacc(const mavlink_message_t* msg)
  421. {
  422. return _MAV_RETURN_int16_t(msg, 12);
  423. }
  424. /**
  425. * @brief Get field xgyro from raw_imu message
  426. *
  427. * @return Angular speed around X axis (raw)
  428. */
  429. static inline int16_t mavlink_msg_raw_imu_get_xgyro(const mavlink_message_t* msg)
  430. {
  431. return _MAV_RETURN_int16_t(msg, 14);
  432. }
  433. /**
  434. * @brief Get field ygyro from raw_imu message
  435. *
  436. * @return Angular speed around Y axis (raw)
  437. */
  438. static inline int16_t mavlink_msg_raw_imu_get_ygyro(const mavlink_message_t* msg)
  439. {
  440. return _MAV_RETURN_int16_t(msg, 16);
  441. }
  442. /**
  443. * @brief Get field zgyro from raw_imu message
  444. *
  445. * @return Angular speed around Z axis (raw)
  446. */
  447. static inline int16_t mavlink_msg_raw_imu_get_zgyro(const mavlink_message_t* msg)
  448. {
  449. return _MAV_RETURN_int16_t(msg, 18);
  450. }
  451. /**
  452. * @brief Get field xmag from raw_imu message
  453. *
  454. * @return X Magnetic field (raw)
  455. */
  456. static inline int16_t mavlink_msg_raw_imu_get_xmag(const mavlink_message_t* msg)
  457. {
  458. return _MAV_RETURN_int16_t(msg, 20);
  459. }
  460. /**
  461. * @brief Get field ymag from raw_imu message
  462. *
  463. * @return Y Magnetic field (raw)
  464. */
  465. static inline int16_t mavlink_msg_raw_imu_get_ymag(const mavlink_message_t* msg)
  466. {
  467. return _MAV_RETURN_int16_t(msg, 22);
  468. }
  469. /**
  470. * @brief Get field zmag from raw_imu message
  471. *
  472. * @return Z Magnetic field (raw)
  473. */
  474. static inline int16_t mavlink_msg_raw_imu_get_zmag(const mavlink_message_t* msg)
  475. {
  476. return _MAV_RETURN_int16_t(msg, 24);
  477. }
  478. /**
  479. * @brief Get field id from raw_imu message
  480. *
  481. * @return Id. Ids are numbered from 0 and map to IMUs numbered from 1 (e.g. IMU1 will have a message with id=0)
  482. */
  483. static inline uint8_t mavlink_msg_raw_imu_get_id(const mavlink_message_t* msg)
  484. {
  485. return _MAV_RETURN_uint8_t(msg, 26);
  486. }
  487. /**
  488. * @brief Get field temperature from raw_imu message
  489. *
  490. * @return [cdegC] Temperature, 0: IMU does not provide temperature values. If the IMU is at 0C it must send 1 (0.01C).
  491. */
  492. static inline int16_t mavlink_msg_raw_imu_get_temperature(const mavlink_message_t* msg)
  493. {
  494. return _MAV_RETURN_int16_t(msg, 27);
  495. }
  496. /**
  497. * @brief Decode a raw_imu message into a struct
  498. *
  499. * @param msg The message to decode
  500. * @param raw_imu C-struct to decode the message contents into
  501. */
  502. static inline void mavlink_msg_raw_imu_decode(const mavlink_message_t* msg, mavlink_raw_imu_t* raw_imu)
  503. {
  504. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  505. raw_imu->time_usec = mavlink_msg_raw_imu_get_time_usec(msg);
  506. raw_imu->xacc = mavlink_msg_raw_imu_get_xacc(msg);
  507. raw_imu->yacc = mavlink_msg_raw_imu_get_yacc(msg);
  508. raw_imu->zacc = mavlink_msg_raw_imu_get_zacc(msg);
  509. raw_imu->xgyro = mavlink_msg_raw_imu_get_xgyro(msg);
  510. raw_imu->ygyro = mavlink_msg_raw_imu_get_ygyro(msg);
  511. raw_imu->zgyro = mavlink_msg_raw_imu_get_zgyro(msg);
  512. raw_imu->xmag = mavlink_msg_raw_imu_get_xmag(msg);
  513. raw_imu->ymag = mavlink_msg_raw_imu_get_ymag(msg);
  514. raw_imu->zmag = mavlink_msg_raw_imu_get_zmag(msg);
  515. raw_imu->id = mavlink_msg_raw_imu_get_id(msg);
  516. raw_imu->temperature = mavlink_msg_raw_imu_get_temperature(msg);
  517. #else
  518. uint8_t len = msg->len < MAVLINK_MSG_ID_RAW_IMU_LEN? msg->len : MAVLINK_MSG_ID_RAW_IMU_LEN;
  519. memset(raw_imu, 0, MAVLINK_MSG_ID_RAW_IMU_LEN);
  520. memcpy(raw_imu, _MAV_PAYLOAD(msg), len);
  521. #endif
  522. }