mavlink_msg_timesync.h 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288
  1. #pragma once
  2. // MESSAGE TIMESYNC PACKING
  3. #define MAVLINK_MSG_ID_TIMESYNC 111
  4. typedef struct __mavlink_timesync_t {
  5. int64_t tc1; /*< [ns] Time sync timestamp 1. Syncing: 0. Responding: Timestamp of responding component.*/
  6. int64_t ts1; /*< [ns] Time sync timestamp 2. Timestamp of syncing component (mirrored in response).*/
  7. uint8_t target_system; /*< Target system id. Request: 0 (broadcast) or id of specific system. Response must contain system id of the requesting component.*/
  8. uint8_t target_component; /*< Target component id. Request: 0 (broadcast) or id of specific component. Response must contain component id of the requesting component.*/
  9. } mavlink_timesync_t;
  10. #define MAVLINK_MSG_ID_TIMESYNC_LEN 18
  11. #define MAVLINK_MSG_ID_TIMESYNC_MIN_LEN 16
  12. #define MAVLINK_MSG_ID_111_LEN 18
  13. #define MAVLINK_MSG_ID_111_MIN_LEN 16
  14. #define MAVLINK_MSG_ID_TIMESYNC_CRC 34
  15. #define MAVLINK_MSG_ID_111_CRC 34
  16. #if MAVLINK_COMMAND_24BIT
  17. #define MAVLINK_MESSAGE_INFO_TIMESYNC { \
  18. 111, \
  19. "TIMESYNC", \
  20. 4, \
  21. { { "tc1", NULL, MAVLINK_TYPE_INT64_T, 0, 0, offsetof(mavlink_timesync_t, tc1) }, \
  22. { "ts1", NULL, MAVLINK_TYPE_INT64_T, 0, 8, offsetof(mavlink_timesync_t, ts1) }, \
  23. { "target_system", NULL, MAVLINK_TYPE_UINT8_T, 0, 16, offsetof(mavlink_timesync_t, target_system) }, \
  24. { "target_component", NULL, MAVLINK_TYPE_UINT8_T, 0, 17, offsetof(mavlink_timesync_t, target_component) }, \
  25. } \
  26. }
  27. #else
  28. #define MAVLINK_MESSAGE_INFO_TIMESYNC { \
  29. "TIMESYNC", \
  30. 4, \
  31. { { "tc1", NULL, MAVLINK_TYPE_INT64_T, 0, 0, offsetof(mavlink_timesync_t, tc1) }, \
  32. { "ts1", NULL, MAVLINK_TYPE_INT64_T, 0, 8, offsetof(mavlink_timesync_t, ts1) }, \
  33. { "target_system", NULL, MAVLINK_TYPE_UINT8_T, 0, 16, offsetof(mavlink_timesync_t, target_system) }, \
  34. { "target_component", NULL, MAVLINK_TYPE_UINT8_T, 0, 17, offsetof(mavlink_timesync_t, target_component) }, \
  35. } \
  36. }
  37. #endif
  38. /**
  39. * @brief Pack a timesync message
  40. * @param system_id ID of this system
  41. * @param component_id ID of this component (e.g. 200 for IMU)
  42. * @param msg The MAVLink message to compress the data into
  43. *
  44. * @param tc1 [ns] Time sync timestamp 1. Syncing: 0. Responding: Timestamp of responding component.
  45. * @param ts1 [ns] Time sync timestamp 2. Timestamp of syncing component (mirrored in response).
  46. * @param target_system Target system id. Request: 0 (broadcast) or id of specific system. Response must contain system id of the requesting component.
  47. * @param target_component Target component id. Request: 0 (broadcast) or id of specific component. Response must contain component id of the requesting component.
  48. * @return length of the message in bytes (excluding serial stream start sign)
  49. */
  50. static inline uint16_t mavlink_msg_timesync_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  51. int64_t tc1, int64_t ts1, uint8_t target_system, uint8_t target_component)
  52. {
  53. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  54. char buf[MAVLINK_MSG_ID_TIMESYNC_LEN];
  55. _mav_put_int64_t(buf, 0, tc1);
  56. _mav_put_int64_t(buf, 8, ts1);
  57. _mav_put_uint8_t(buf, 16, target_system);
  58. _mav_put_uint8_t(buf, 17, target_component);
  59. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_TIMESYNC_LEN);
  60. #else
  61. mavlink_timesync_t packet;
  62. packet.tc1 = tc1;
  63. packet.ts1 = ts1;
  64. packet.target_system = target_system;
  65. packet.target_component = target_component;
  66. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_TIMESYNC_LEN);
  67. #endif
  68. msg->msgid = MAVLINK_MSG_ID_TIMESYNC;
  69. return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_TIMESYNC_MIN_LEN, MAVLINK_MSG_ID_TIMESYNC_LEN, MAVLINK_MSG_ID_TIMESYNC_CRC);
  70. }
  71. /**
  72. * @brief Pack a timesync message on a channel
  73. * @param system_id ID of this system
  74. * @param component_id ID of this component (e.g. 200 for IMU)
  75. * @param chan The MAVLink channel this message will be sent over
  76. * @param msg The MAVLink message to compress the data into
  77. * @param tc1 [ns] Time sync timestamp 1. Syncing: 0. Responding: Timestamp of responding component.
  78. * @param ts1 [ns] Time sync timestamp 2. Timestamp of syncing component (mirrored in response).
  79. * @param target_system Target system id. Request: 0 (broadcast) or id of specific system. Response must contain system id of the requesting component.
  80. * @param target_component Target component id. Request: 0 (broadcast) or id of specific component. Response must contain component id of the requesting component.
  81. * @return length of the message in bytes (excluding serial stream start sign)
  82. */
  83. static inline uint16_t mavlink_msg_timesync_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  84. mavlink_message_t* msg,
  85. int64_t tc1,int64_t ts1,uint8_t target_system,uint8_t target_component)
  86. {
  87. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  88. char buf[MAVLINK_MSG_ID_TIMESYNC_LEN];
  89. _mav_put_int64_t(buf, 0, tc1);
  90. _mav_put_int64_t(buf, 8, ts1);
  91. _mav_put_uint8_t(buf, 16, target_system);
  92. _mav_put_uint8_t(buf, 17, target_component);
  93. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_TIMESYNC_LEN);
  94. #else
  95. mavlink_timesync_t packet;
  96. packet.tc1 = tc1;
  97. packet.ts1 = ts1;
  98. packet.target_system = target_system;
  99. packet.target_component = target_component;
  100. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_TIMESYNC_LEN);
  101. #endif
  102. msg->msgid = MAVLINK_MSG_ID_TIMESYNC;
  103. return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_TIMESYNC_MIN_LEN, MAVLINK_MSG_ID_TIMESYNC_LEN, MAVLINK_MSG_ID_TIMESYNC_CRC);
  104. }
  105. /**
  106. * @brief Encode a timesync struct
  107. *
  108. * @param system_id ID of this system
  109. * @param component_id ID of this component (e.g. 200 for IMU)
  110. * @param msg The MAVLink message to compress the data into
  111. * @param timesync C-struct to read the message contents from
  112. */
  113. static inline uint16_t mavlink_msg_timesync_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_timesync_t* timesync)
  114. {
  115. return mavlink_msg_timesync_pack(system_id, component_id, msg, timesync->tc1, timesync->ts1, timesync->target_system, timesync->target_component);
  116. }
  117. /**
  118. * @brief Encode a timesync struct on a channel
  119. *
  120. * @param system_id ID of this system
  121. * @param component_id ID of this component (e.g. 200 for IMU)
  122. * @param chan The MAVLink channel this message will be sent over
  123. * @param msg The MAVLink message to compress the data into
  124. * @param timesync C-struct to read the message contents from
  125. */
  126. static inline uint16_t mavlink_msg_timesync_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_timesync_t* timesync)
  127. {
  128. return mavlink_msg_timesync_pack_chan(system_id, component_id, chan, msg, timesync->tc1, timesync->ts1, timesync->target_system, timesync->target_component);
  129. }
  130. /**
  131. * @brief Send a timesync message
  132. * @param chan MAVLink channel to send the message
  133. *
  134. * @param tc1 [ns] Time sync timestamp 1. Syncing: 0. Responding: Timestamp of responding component.
  135. * @param ts1 [ns] Time sync timestamp 2. Timestamp of syncing component (mirrored in response).
  136. * @param target_system Target system id. Request: 0 (broadcast) or id of specific system. Response must contain system id of the requesting component.
  137. * @param target_component Target component id. Request: 0 (broadcast) or id of specific component. Response must contain component id of the requesting component.
  138. */
  139. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  140. static inline void mavlink_msg_timesync_send(mavlink_channel_t chan, int64_t tc1, int64_t ts1, uint8_t target_system, uint8_t target_component)
  141. {
  142. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  143. char buf[MAVLINK_MSG_ID_TIMESYNC_LEN];
  144. _mav_put_int64_t(buf, 0, tc1);
  145. _mav_put_int64_t(buf, 8, ts1);
  146. _mav_put_uint8_t(buf, 16, target_system);
  147. _mav_put_uint8_t(buf, 17, target_component);
  148. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_TIMESYNC, buf, MAVLINK_MSG_ID_TIMESYNC_MIN_LEN, MAVLINK_MSG_ID_TIMESYNC_LEN, MAVLINK_MSG_ID_TIMESYNC_CRC);
  149. #else
  150. mavlink_timesync_t packet;
  151. packet.tc1 = tc1;
  152. packet.ts1 = ts1;
  153. packet.target_system = target_system;
  154. packet.target_component = target_component;
  155. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_TIMESYNC, (const char *)&packet, MAVLINK_MSG_ID_TIMESYNC_MIN_LEN, MAVLINK_MSG_ID_TIMESYNC_LEN, MAVLINK_MSG_ID_TIMESYNC_CRC);
  156. #endif
  157. }
  158. /**
  159. * @brief Send a timesync message
  160. * @param chan MAVLink channel to send the message
  161. * @param struct The MAVLink struct to serialize
  162. */
  163. static inline void mavlink_msg_timesync_send_struct(mavlink_channel_t chan, const mavlink_timesync_t* timesync)
  164. {
  165. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  166. mavlink_msg_timesync_send(chan, timesync->tc1, timesync->ts1, timesync->target_system, timesync->target_component);
  167. #else
  168. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_TIMESYNC, (const char *)timesync, MAVLINK_MSG_ID_TIMESYNC_MIN_LEN, MAVLINK_MSG_ID_TIMESYNC_LEN, MAVLINK_MSG_ID_TIMESYNC_CRC);
  169. #endif
  170. }
  171. #if MAVLINK_MSG_ID_TIMESYNC_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  172. /*
  173. This variant of _send() can be used to save stack space by re-using
  174. memory from the receive buffer. The caller provides a
  175. mavlink_message_t which is the size of a full mavlink message. This
  176. is usually the receive buffer for the channel, and allows a reply to an
  177. incoming message with minimum stack space usage.
  178. */
  179. static inline void mavlink_msg_timesync_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, int64_t tc1, int64_t ts1, uint8_t target_system, uint8_t target_component)
  180. {
  181. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  182. char *buf = (char *)msgbuf;
  183. _mav_put_int64_t(buf, 0, tc1);
  184. _mav_put_int64_t(buf, 8, ts1);
  185. _mav_put_uint8_t(buf, 16, target_system);
  186. _mav_put_uint8_t(buf, 17, target_component);
  187. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_TIMESYNC, buf, MAVLINK_MSG_ID_TIMESYNC_MIN_LEN, MAVLINK_MSG_ID_TIMESYNC_LEN, MAVLINK_MSG_ID_TIMESYNC_CRC);
  188. #else
  189. mavlink_timesync_t *packet = (mavlink_timesync_t *)msgbuf;
  190. packet->tc1 = tc1;
  191. packet->ts1 = ts1;
  192. packet->target_system = target_system;
  193. packet->target_component = target_component;
  194. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_TIMESYNC, (const char *)packet, MAVLINK_MSG_ID_TIMESYNC_MIN_LEN, MAVLINK_MSG_ID_TIMESYNC_LEN, MAVLINK_MSG_ID_TIMESYNC_CRC);
  195. #endif
  196. }
  197. #endif
  198. #endif
  199. // MESSAGE TIMESYNC UNPACKING
  200. /**
  201. * @brief Get field tc1 from timesync message
  202. *
  203. * @return [ns] Time sync timestamp 1. Syncing: 0. Responding: Timestamp of responding component.
  204. */
  205. static inline int64_t mavlink_msg_timesync_get_tc1(const mavlink_message_t* msg)
  206. {
  207. return _MAV_RETURN_int64_t(msg, 0);
  208. }
  209. /**
  210. * @brief Get field ts1 from timesync message
  211. *
  212. * @return [ns] Time sync timestamp 2. Timestamp of syncing component (mirrored in response).
  213. */
  214. static inline int64_t mavlink_msg_timesync_get_ts1(const mavlink_message_t* msg)
  215. {
  216. return _MAV_RETURN_int64_t(msg, 8);
  217. }
  218. /**
  219. * @brief Get field target_system from timesync message
  220. *
  221. * @return Target system id. Request: 0 (broadcast) or id of specific system. Response must contain system id of the requesting component.
  222. */
  223. static inline uint8_t mavlink_msg_timesync_get_target_system(const mavlink_message_t* msg)
  224. {
  225. return _MAV_RETURN_uint8_t(msg, 16);
  226. }
  227. /**
  228. * @brief Get field target_component from timesync message
  229. *
  230. * @return Target component id. Request: 0 (broadcast) or id of specific component. Response must contain component id of the requesting component.
  231. */
  232. static inline uint8_t mavlink_msg_timesync_get_target_component(const mavlink_message_t* msg)
  233. {
  234. return _MAV_RETURN_uint8_t(msg, 17);
  235. }
  236. /**
  237. * @brief Decode a timesync message into a struct
  238. *
  239. * @param msg The message to decode
  240. * @param timesync C-struct to decode the message contents into
  241. */
  242. static inline void mavlink_msg_timesync_decode(const mavlink_message_t* msg, mavlink_timesync_t* timesync)
  243. {
  244. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  245. timesync->tc1 = mavlink_msg_timesync_get_tc1(msg);
  246. timesync->ts1 = mavlink_msg_timesync_get_ts1(msg);
  247. timesync->target_system = mavlink_msg_timesync_get_target_system(msg);
  248. timesync->target_component = mavlink_msg_timesync_get_target_component(msg);
  249. #else
  250. uint8_t len = msg->len < MAVLINK_MSG_ID_TIMESYNC_LEN? msg->len : MAVLINK_MSG_ID_TIMESYNC_LEN;
  251. memset(timesync, 0, MAVLINK_MSG_ID_TIMESYNC_LEN);
  252. memcpy(timesync, _MAV_PAYLOAD(msg), len);
  253. #endif
  254. }