mavlink_msg_debug.h 9.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263
  1. #pragma once
  2. // MESSAGE DEBUG PACKING
  3. #define MAVLINK_MSG_ID_DEBUG 254
  4. typedef struct __mavlink_debug_t {
  5. uint32_t time_boot_ms; /*< [ms] Timestamp (time since system boot).*/
  6. float value; /*< DEBUG value*/
  7. uint8_t ind; /*< index of debug variable*/
  8. } mavlink_debug_t;
  9. #define MAVLINK_MSG_ID_DEBUG_LEN 9
  10. #define MAVLINK_MSG_ID_DEBUG_MIN_LEN 9
  11. #define MAVLINK_MSG_ID_254_LEN 9
  12. #define MAVLINK_MSG_ID_254_MIN_LEN 9
  13. #define MAVLINK_MSG_ID_DEBUG_CRC 46
  14. #define MAVLINK_MSG_ID_254_CRC 46
  15. #if MAVLINK_COMMAND_24BIT
  16. #define MAVLINK_MESSAGE_INFO_DEBUG { \
  17. 254, \
  18. "DEBUG", \
  19. 3, \
  20. { { "time_boot_ms", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_debug_t, time_boot_ms) }, \
  21. { "ind", NULL, MAVLINK_TYPE_UINT8_T, 0, 8, offsetof(mavlink_debug_t, ind) }, \
  22. { "value", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_debug_t, value) }, \
  23. } \
  24. }
  25. #else
  26. #define MAVLINK_MESSAGE_INFO_DEBUG { \
  27. "DEBUG", \
  28. 3, \
  29. { { "time_boot_ms", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_debug_t, time_boot_ms) }, \
  30. { "ind", NULL, MAVLINK_TYPE_UINT8_T, 0, 8, offsetof(mavlink_debug_t, ind) }, \
  31. { "value", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_debug_t, value) }, \
  32. } \
  33. }
  34. #endif
  35. /**
  36. * @brief Pack a debug message
  37. * @param system_id ID of this system
  38. * @param component_id ID of this component (e.g. 200 for IMU)
  39. * @param msg The MAVLink message to compress the data into
  40. *
  41. * @param time_boot_ms [ms] Timestamp (time since system boot).
  42. * @param ind index of debug variable
  43. * @param value DEBUG value
  44. * @return length of the message in bytes (excluding serial stream start sign)
  45. */
  46. static inline uint16_t mavlink_msg_debug_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  47. uint32_t time_boot_ms, uint8_t ind, float value)
  48. {
  49. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  50. char buf[MAVLINK_MSG_ID_DEBUG_LEN];
  51. _mav_put_uint32_t(buf, 0, time_boot_ms);
  52. _mav_put_float(buf, 4, value);
  53. _mav_put_uint8_t(buf, 8, ind);
  54. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_DEBUG_LEN);
  55. #else
  56. mavlink_debug_t packet;
  57. packet.time_boot_ms = time_boot_ms;
  58. packet.value = value;
  59. packet.ind = ind;
  60. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_DEBUG_LEN);
  61. #endif
  62. msg->msgid = MAVLINK_MSG_ID_DEBUG;
  63. return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_DEBUG_MIN_LEN, MAVLINK_MSG_ID_DEBUG_LEN, MAVLINK_MSG_ID_DEBUG_CRC);
  64. }
  65. /**
  66. * @brief Pack a debug message on a channel
  67. * @param system_id ID of this system
  68. * @param component_id ID of this component (e.g. 200 for IMU)
  69. * @param chan The MAVLink channel this message will be sent over
  70. * @param msg The MAVLink message to compress the data into
  71. * @param time_boot_ms [ms] Timestamp (time since system boot).
  72. * @param ind index of debug variable
  73. * @param value DEBUG value
  74. * @return length of the message in bytes (excluding serial stream start sign)
  75. */
  76. static inline uint16_t mavlink_msg_debug_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  77. mavlink_message_t* msg,
  78. uint32_t time_boot_ms,uint8_t ind,float value)
  79. {
  80. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  81. char buf[MAVLINK_MSG_ID_DEBUG_LEN];
  82. _mav_put_uint32_t(buf, 0, time_boot_ms);
  83. _mav_put_float(buf, 4, value);
  84. _mav_put_uint8_t(buf, 8, ind);
  85. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_DEBUG_LEN);
  86. #else
  87. mavlink_debug_t packet;
  88. packet.time_boot_ms = time_boot_ms;
  89. packet.value = value;
  90. packet.ind = ind;
  91. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_DEBUG_LEN);
  92. #endif
  93. msg->msgid = MAVLINK_MSG_ID_DEBUG;
  94. return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_DEBUG_MIN_LEN, MAVLINK_MSG_ID_DEBUG_LEN, MAVLINK_MSG_ID_DEBUG_CRC);
  95. }
  96. /**
  97. * @brief Encode a debug struct
  98. *
  99. * @param system_id ID of this system
  100. * @param component_id ID of this component (e.g. 200 for IMU)
  101. * @param msg The MAVLink message to compress the data into
  102. * @param debug C-struct to read the message contents from
  103. */
  104. static inline uint16_t mavlink_msg_debug_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_debug_t* debug)
  105. {
  106. return mavlink_msg_debug_pack(system_id, component_id, msg, debug->time_boot_ms, debug->ind, debug->value);
  107. }
  108. /**
  109. * @brief Encode a debug struct on a channel
  110. *
  111. * @param system_id ID of this system
  112. * @param component_id ID of this component (e.g. 200 for IMU)
  113. * @param chan The MAVLink channel this message will be sent over
  114. * @param msg The MAVLink message to compress the data into
  115. * @param debug C-struct to read the message contents from
  116. */
  117. static inline uint16_t mavlink_msg_debug_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_debug_t* debug)
  118. {
  119. return mavlink_msg_debug_pack_chan(system_id, component_id, chan, msg, debug->time_boot_ms, debug->ind, debug->value);
  120. }
  121. /**
  122. * @brief Send a debug message
  123. * @param chan MAVLink channel to send the message
  124. *
  125. * @param time_boot_ms [ms] Timestamp (time since system boot).
  126. * @param ind index of debug variable
  127. * @param value DEBUG value
  128. */
  129. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  130. static inline void mavlink_msg_debug_send(mavlink_channel_t chan, uint32_t time_boot_ms, uint8_t ind, float value)
  131. {
  132. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  133. char buf[MAVLINK_MSG_ID_DEBUG_LEN];
  134. _mav_put_uint32_t(buf, 0, time_boot_ms);
  135. _mav_put_float(buf, 4, value);
  136. _mav_put_uint8_t(buf, 8, ind);
  137. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_DEBUG, buf, MAVLINK_MSG_ID_DEBUG_MIN_LEN, MAVLINK_MSG_ID_DEBUG_LEN, MAVLINK_MSG_ID_DEBUG_CRC);
  138. #else
  139. mavlink_debug_t packet;
  140. packet.time_boot_ms = time_boot_ms;
  141. packet.value = value;
  142. packet.ind = ind;
  143. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_DEBUG, (const char *)&packet, MAVLINK_MSG_ID_DEBUG_MIN_LEN, MAVLINK_MSG_ID_DEBUG_LEN, MAVLINK_MSG_ID_DEBUG_CRC);
  144. #endif
  145. }
  146. /**
  147. * @brief Send a debug message
  148. * @param chan MAVLink channel to send the message
  149. * @param struct The MAVLink struct to serialize
  150. */
  151. static inline void mavlink_msg_debug_send_struct(mavlink_channel_t chan, const mavlink_debug_t* debug)
  152. {
  153. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  154. mavlink_msg_debug_send(chan, debug->time_boot_ms, debug->ind, debug->value);
  155. #else
  156. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_DEBUG, (const char *)debug, MAVLINK_MSG_ID_DEBUG_MIN_LEN, MAVLINK_MSG_ID_DEBUG_LEN, MAVLINK_MSG_ID_DEBUG_CRC);
  157. #endif
  158. }
  159. #if MAVLINK_MSG_ID_DEBUG_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  160. /*
  161. This variant of _send() can be used to save stack space by re-using
  162. memory from the receive buffer. The caller provides a
  163. mavlink_message_t which is the size of a full mavlink message. This
  164. is usually the receive buffer for the channel, and allows a reply to an
  165. incoming message with minimum stack space usage.
  166. */
  167. static inline void mavlink_msg_debug_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint32_t time_boot_ms, uint8_t ind, float value)
  168. {
  169. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  170. char *buf = (char *)msgbuf;
  171. _mav_put_uint32_t(buf, 0, time_boot_ms);
  172. _mav_put_float(buf, 4, value);
  173. _mav_put_uint8_t(buf, 8, ind);
  174. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_DEBUG, buf, MAVLINK_MSG_ID_DEBUG_MIN_LEN, MAVLINK_MSG_ID_DEBUG_LEN, MAVLINK_MSG_ID_DEBUG_CRC);
  175. #else
  176. mavlink_debug_t *packet = (mavlink_debug_t *)msgbuf;
  177. packet->time_boot_ms = time_boot_ms;
  178. packet->value = value;
  179. packet->ind = ind;
  180. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_DEBUG, (const char *)packet, MAVLINK_MSG_ID_DEBUG_MIN_LEN, MAVLINK_MSG_ID_DEBUG_LEN, MAVLINK_MSG_ID_DEBUG_CRC);
  181. #endif
  182. }
  183. #endif
  184. #endif
  185. // MESSAGE DEBUG UNPACKING
  186. /**
  187. * @brief Get field time_boot_ms from debug message
  188. *
  189. * @return [ms] Timestamp (time since system boot).
  190. */
  191. static inline uint32_t mavlink_msg_debug_get_time_boot_ms(const mavlink_message_t* msg)
  192. {
  193. return _MAV_RETURN_uint32_t(msg, 0);
  194. }
  195. /**
  196. * @brief Get field ind from debug message
  197. *
  198. * @return index of debug variable
  199. */
  200. static inline uint8_t mavlink_msg_debug_get_ind(const mavlink_message_t* msg)
  201. {
  202. return _MAV_RETURN_uint8_t(msg, 8);
  203. }
  204. /**
  205. * @brief Get field value from debug message
  206. *
  207. * @return DEBUG value
  208. */
  209. static inline float mavlink_msg_debug_get_value(const mavlink_message_t* msg)
  210. {
  211. return _MAV_RETURN_float(msg, 4);
  212. }
  213. /**
  214. * @brief Decode a debug message into a struct
  215. *
  216. * @param msg The message to decode
  217. * @param debug C-struct to decode the message contents into
  218. */
  219. static inline void mavlink_msg_debug_decode(const mavlink_message_t* msg, mavlink_debug_t* debug)
  220. {
  221. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  222. debug->time_boot_ms = mavlink_msg_debug_get_time_boot_ms(msg);
  223. debug->value = mavlink_msg_debug_get_value(msg);
  224. debug->ind = mavlink_msg_debug_get_ind(msg);
  225. #else
  226. uint8_t len = msg->len < MAVLINK_MSG_ID_DEBUG_LEN? msg->len : MAVLINK_MSG_ID_DEBUG_LEN;
  227. memset(debug, 0, MAVLINK_MSG_ID_DEBUG_LEN);
  228. memcpy(debug, _MAV_PAYLOAD(msg), len);
  229. #endif
  230. }