mavlink_msg_vicon_position_estimate.h 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446
  1. #pragma once
  2. // MESSAGE VICON_POSITION_ESTIMATE PACKING
  3. #define MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE 104
  4. typedef struct __mavlink_vicon_position_estimate_t {
  5. uint64_t usec; /*< [us] Timestamp (UNIX time or time since system boot)*/
  6. float x; /*< [m] Global X position*/
  7. float y; /*< [m] Global Y position*/
  8. float z; /*< [m] Global Z position*/
  9. float roll; /*< [rad] Roll angle*/
  10. float pitch; /*< [rad] Pitch angle*/
  11. float yaw; /*< [rad] Yaw angle*/
  12. float covariance[21]; /*< Row-major representation of 6x6 pose cross-covariance matrix upper right triangle (states: x, y, z, roll, pitch, yaw; first six entries are the first ROW, next five entries are the second ROW, etc.). If unknown, assign NaN value to first element in the array.*/
  13. } mavlink_vicon_position_estimate_t;
  14. #define MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN 116
  15. #define MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN 32
  16. #define MAVLINK_MSG_ID_104_LEN 116
  17. #define MAVLINK_MSG_ID_104_MIN_LEN 32
  18. #define MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC 56
  19. #define MAVLINK_MSG_ID_104_CRC 56
  20. #define MAVLINK_MSG_VICON_POSITION_ESTIMATE_FIELD_COVARIANCE_LEN 21
  21. #if MAVLINK_COMMAND_24BIT
  22. #define MAVLINK_MESSAGE_INFO_VICON_POSITION_ESTIMATE { \
  23. 104, \
  24. "VICON_POSITION_ESTIMATE", \
  25. 8, \
  26. { { "usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_vicon_position_estimate_t, usec) }, \
  27. { "x", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_vicon_position_estimate_t, x) }, \
  28. { "y", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_vicon_position_estimate_t, y) }, \
  29. { "z", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_vicon_position_estimate_t, z) }, \
  30. { "roll", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_vicon_position_estimate_t, roll) }, \
  31. { "pitch", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_vicon_position_estimate_t, pitch) }, \
  32. { "yaw", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_vicon_position_estimate_t, yaw) }, \
  33. { "covariance", NULL, MAVLINK_TYPE_FLOAT, 21, 32, offsetof(mavlink_vicon_position_estimate_t, covariance) }, \
  34. } \
  35. }
  36. #else
  37. #define MAVLINK_MESSAGE_INFO_VICON_POSITION_ESTIMATE { \
  38. "VICON_POSITION_ESTIMATE", \
  39. 8, \
  40. { { "usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_vicon_position_estimate_t, usec) }, \
  41. { "x", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_vicon_position_estimate_t, x) }, \
  42. { "y", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_vicon_position_estimate_t, y) }, \
  43. { "z", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_vicon_position_estimate_t, z) }, \
  44. { "roll", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_vicon_position_estimate_t, roll) }, \
  45. { "pitch", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_vicon_position_estimate_t, pitch) }, \
  46. { "yaw", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_vicon_position_estimate_t, yaw) }, \
  47. { "covariance", NULL, MAVLINK_TYPE_FLOAT, 21, 32, offsetof(mavlink_vicon_position_estimate_t, covariance) }, \
  48. } \
  49. }
  50. #endif
  51. /**
  52. * @brief Pack a vicon_position_estimate message
  53. * @param system_id ID of this system
  54. * @param component_id ID of this component (e.g. 200 for IMU)
  55. * @param msg The MAVLink message to compress the data into
  56. *
  57. * @param usec [us] Timestamp (UNIX time or time since system boot)
  58. * @param x [m] Global X position
  59. * @param y [m] Global Y position
  60. * @param z [m] Global Z position
  61. * @param roll [rad] Roll angle
  62. * @param pitch [rad] Pitch angle
  63. * @param yaw [rad] Yaw angle
  64. * @param covariance Row-major representation of 6x6 pose cross-covariance matrix upper right triangle (states: x, y, z, roll, pitch, yaw; first six entries are the first ROW, next five entries are the second ROW, etc.). If unknown, assign NaN value to first element in the array.
  65. * @return length of the message in bytes (excluding serial stream start sign)
  66. */
  67. static inline uint16_t mavlink_msg_vicon_position_estimate_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  68. uint64_t usec, float x, float y, float z, float roll, float pitch, float yaw, const float *covariance)
  69. {
  70. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  71. char buf[MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN];
  72. _mav_put_uint64_t(buf, 0, usec);
  73. _mav_put_float(buf, 8, x);
  74. _mav_put_float(buf, 12, y);
  75. _mav_put_float(buf, 16, z);
  76. _mav_put_float(buf, 20, roll);
  77. _mav_put_float(buf, 24, pitch);
  78. _mav_put_float(buf, 28, yaw);
  79. _mav_put_float_array(buf, 32, covariance, 21);
  80. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  81. #else
  82. mavlink_vicon_position_estimate_t packet;
  83. packet.usec = usec;
  84. packet.x = x;
  85. packet.y = y;
  86. packet.z = z;
  87. packet.roll = roll;
  88. packet.pitch = pitch;
  89. packet.yaw = yaw;
  90. mav_array_memcpy(packet.covariance, covariance, sizeof(float)*21);
  91. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  92. #endif
  93. msg->msgid = MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE;
  94. return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  95. }
  96. /**
  97. * @brief Pack a vicon_position_estimate message
  98. * @param system_id ID of this system
  99. * @param component_id ID of this component (e.g. 200 for IMU)
  100. * @param status MAVLink status structure
  101. * @param msg The MAVLink message to compress the data into
  102. *
  103. * @param usec [us] Timestamp (UNIX time or time since system boot)
  104. * @param x [m] Global X position
  105. * @param y [m] Global Y position
  106. * @param z [m] Global Z position
  107. * @param roll [rad] Roll angle
  108. * @param pitch [rad] Pitch angle
  109. * @param yaw [rad] Yaw angle
  110. * @param covariance Row-major representation of 6x6 pose cross-covariance matrix upper right triangle (states: x, y, z, roll, pitch, yaw; first six entries are the first ROW, next five entries are the second ROW, etc.). If unknown, assign NaN value to first element in the array.
  111. * @return length of the message in bytes (excluding serial stream start sign)
  112. */
  113. static inline uint16_t mavlink_msg_vicon_position_estimate_pack_status(uint8_t system_id, uint8_t component_id, mavlink_status_t *_status, mavlink_message_t* msg,
  114. uint64_t usec, float x, float y, float z, float roll, float pitch, float yaw, const float *covariance)
  115. {
  116. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  117. char buf[MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN];
  118. _mav_put_uint64_t(buf, 0, usec);
  119. _mav_put_float(buf, 8, x);
  120. _mav_put_float(buf, 12, y);
  121. _mav_put_float(buf, 16, z);
  122. _mav_put_float(buf, 20, roll);
  123. _mav_put_float(buf, 24, pitch);
  124. _mav_put_float(buf, 28, yaw);
  125. _mav_put_float_array(buf, 32, covariance, 21);
  126. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  127. #else
  128. mavlink_vicon_position_estimate_t packet;
  129. packet.usec = usec;
  130. packet.x = x;
  131. packet.y = y;
  132. packet.z = z;
  133. packet.roll = roll;
  134. packet.pitch = pitch;
  135. packet.yaw = yaw;
  136. mav_array_memcpy(packet.covariance, covariance, sizeof(float)*21);
  137. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  138. #endif
  139. msg->msgid = MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE;
  140. #if MAVLINK_CRC_EXTRA
  141. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  142. #else
  143. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  144. #endif
  145. }
  146. /**
  147. * @brief Pack a vicon_position_estimate message on a channel
  148. * @param system_id ID of this system
  149. * @param component_id ID of this component (e.g. 200 for IMU)
  150. * @param chan The MAVLink channel this message will be sent over
  151. * @param msg The MAVLink message to compress the data into
  152. * @param usec [us] Timestamp (UNIX time or time since system boot)
  153. * @param x [m] Global X position
  154. * @param y [m] Global Y position
  155. * @param z [m] Global Z position
  156. * @param roll [rad] Roll angle
  157. * @param pitch [rad] Pitch angle
  158. * @param yaw [rad] Yaw angle
  159. * @param covariance Row-major representation of 6x6 pose cross-covariance matrix upper right triangle (states: x, y, z, roll, pitch, yaw; first six entries are the first ROW, next five entries are the second ROW, etc.). If unknown, assign NaN value to first element in the array.
  160. * @return length of the message in bytes (excluding serial stream start sign)
  161. */
  162. static inline uint16_t mavlink_msg_vicon_position_estimate_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  163. mavlink_message_t* msg,
  164. uint64_t usec,float x,float y,float z,float roll,float pitch,float yaw,const float *covariance)
  165. {
  166. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  167. char buf[MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN];
  168. _mav_put_uint64_t(buf, 0, usec);
  169. _mav_put_float(buf, 8, x);
  170. _mav_put_float(buf, 12, y);
  171. _mav_put_float(buf, 16, z);
  172. _mav_put_float(buf, 20, roll);
  173. _mav_put_float(buf, 24, pitch);
  174. _mav_put_float(buf, 28, yaw);
  175. _mav_put_float_array(buf, 32, covariance, 21);
  176. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  177. #else
  178. mavlink_vicon_position_estimate_t packet;
  179. packet.usec = usec;
  180. packet.x = x;
  181. packet.y = y;
  182. packet.z = z;
  183. packet.roll = roll;
  184. packet.pitch = pitch;
  185. packet.yaw = yaw;
  186. mav_array_memcpy(packet.covariance, covariance, sizeof(float)*21);
  187. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  188. #endif
  189. msg->msgid = MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE;
  190. return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  191. }
  192. /**
  193. * @brief Encode a vicon_position_estimate struct
  194. *
  195. * @param system_id ID of this system
  196. * @param component_id ID of this component (e.g. 200 for IMU)
  197. * @param msg The MAVLink message to compress the data into
  198. * @param vicon_position_estimate C-struct to read the message contents from
  199. */
  200. static inline uint16_t mavlink_msg_vicon_position_estimate_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_vicon_position_estimate_t* vicon_position_estimate)
  201. {
  202. return mavlink_msg_vicon_position_estimate_pack(system_id, component_id, msg, vicon_position_estimate->usec, vicon_position_estimate->x, vicon_position_estimate->y, vicon_position_estimate->z, vicon_position_estimate->roll, vicon_position_estimate->pitch, vicon_position_estimate->yaw, vicon_position_estimate->covariance);
  203. }
  204. /**
  205. * @brief Encode a vicon_position_estimate struct on a channel
  206. *
  207. * @param system_id ID of this system
  208. * @param component_id ID of this component (e.g. 200 for IMU)
  209. * @param chan The MAVLink channel this message will be sent over
  210. * @param msg The MAVLink message to compress the data into
  211. * @param vicon_position_estimate C-struct to read the message contents from
  212. */
  213. static inline uint16_t mavlink_msg_vicon_position_estimate_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_vicon_position_estimate_t* vicon_position_estimate)
  214. {
  215. return mavlink_msg_vicon_position_estimate_pack_chan(system_id, component_id, chan, msg, vicon_position_estimate->usec, vicon_position_estimate->x, vicon_position_estimate->y, vicon_position_estimate->z, vicon_position_estimate->roll, vicon_position_estimate->pitch, vicon_position_estimate->yaw, vicon_position_estimate->covariance);
  216. }
  217. /**
  218. * @brief Encode a vicon_position_estimate struct with provided status structure
  219. *
  220. * @param system_id ID of this system
  221. * @param component_id ID of this component (e.g. 200 for IMU)
  222. * @param status MAVLink status structure
  223. * @param msg The MAVLink message to compress the data into
  224. * @param vicon_position_estimate C-struct to read the message contents from
  225. */
  226. static inline uint16_t mavlink_msg_vicon_position_estimate_encode_status(uint8_t system_id, uint8_t component_id, mavlink_status_t* _status, mavlink_message_t* msg, const mavlink_vicon_position_estimate_t* vicon_position_estimate)
  227. {
  228. return mavlink_msg_vicon_position_estimate_pack_status(system_id, component_id, _status, msg, vicon_position_estimate->usec, vicon_position_estimate->x, vicon_position_estimate->y, vicon_position_estimate->z, vicon_position_estimate->roll, vicon_position_estimate->pitch, vicon_position_estimate->yaw, vicon_position_estimate->covariance);
  229. }
  230. /**
  231. * @brief Send a vicon_position_estimate message
  232. * @param chan MAVLink channel to send the message
  233. *
  234. * @param usec [us] Timestamp (UNIX time or time since system boot)
  235. * @param x [m] Global X position
  236. * @param y [m] Global Y position
  237. * @param z [m] Global Z position
  238. * @param roll [rad] Roll angle
  239. * @param pitch [rad] Pitch angle
  240. * @param yaw [rad] Yaw angle
  241. * @param covariance Row-major representation of 6x6 pose cross-covariance matrix upper right triangle (states: x, y, z, roll, pitch, yaw; first six entries are the first ROW, next five entries are the second ROW, etc.). If unknown, assign NaN value to first element in the array.
  242. */
  243. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  244. static inline void mavlink_msg_vicon_position_estimate_send(mavlink_channel_t chan, uint64_t usec, float x, float y, float z, float roll, float pitch, float yaw, const float *covariance)
  245. {
  246. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  247. char buf[MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN];
  248. _mav_put_uint64_t(buf, 0, usec);
  249. _mav_put_float(buf, 8, x);
  250. _mav_put_float(buf, 12, y);
  251. _mav_put_float(buf, 16, z);
  252. _mav_put_float(buf, 20, roll);
  253. _mav_put_float(buf, 24, pitch);
  254. _mav_put_float(buf, 28, yaw);
  255. _mav_put_float_array(buf, 32, covariance, 21);
  256. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE, buf, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  257. #else
  258. mavlink_vicon_position_estimate_t packet;
  259. packet.usec = usec;
  260. packet.x = x;
  261. packet.y = y;
  262. packet.z = z;
  263. packet.roll = roll;
  264. packet.pitch = pitch;
  265. packet.yaw = yaw;
  266. mav_array_memcpy(packet.covariance, covariance, sizeof(float)*21);
  267. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE, (const char *)&packet, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  268. #endif
  269. }
  270. /**
  271. * @brief Send a vicon_position_estimate message
  272. * @param chan MAVLink channel to send the message
  273. * @param struct The MAVLink struct to serialize
  274. */
  275. static inline void mavlink_msg_vicon_position_estimate_send_struct(mavlink_channel_t chan, const mavlink_vicon_position_estimate_t* vicon_position_estimate)
  276. {
  277. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  278. mavlink_msg_vicon_position_estimate_send(chan, vicon_position_estimate->usec, vicon_position_estimate->x, vicon_position_estimate->y, vicon_position_estimate->z, vicon_position_estimate->roll, vicon_position_estimate->pitch, vicon_position_estimate->yaw, vicon_position_estimate->covariance);
  279. #else
  280. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE, (const char *)vicon_position_estimate, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  281. #endif
  282. }
  283. #if MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  284. /*
  285. This variant of _send() can be used to save stack space by re-using
  286. memory from the receive buffer. The caller provides a
  287. mavlink_message_t which is the size of a full mavlink message. This
  288. is usually the receive buffer for the channel, and allows a reply to an
  289. incoming message with minimum stack space usage.
  290. */
  291. static inline void mavlink_msg_vicon_position_estimate_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint64_t usec, float x, float y, float z, float roll, float pitch, float yaw, const float *covariance)
  292. {
  293. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  294. char *buf = (char *)msgbuf;
  295. _mav_put_uint64_t(buf, 0, usec);
  296. _mav_put_float(buf, 8, x);
  297. _mav_put_float(buf, 12, y);
  298. _mav_put_float(buf, 16, z);
  299. _mav_put_float(buf, 20, roll);
  300. _mav_put_float(buf, 24, pitch);
  301. _mav_put_float(buf, 28, yaw);
  302. _mav_put_float_array(buf, 32, covariance, 21);
  303. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE, buf, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  304. #else
  305. mavlink_vicon_position_estimate_t *packet = (mavlink_vicon_position_estimate_t *)msgbuf;
  306. packet->usec = usec;
  307. packet->x = x;
  308. packet->y = y;
  309. packet->z = z;
  310. packet->roll = roll;
  311. packet->pitch = pitch;
  312. packet->yaw = yaw;
  313. mav_array_memcpy(packet->covariance, covariance, sizeof(float)*21);
  314. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE, (const char *)packet, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_CRC);
  315. #endif
  316. }
  317. #endif
  318. #endif
  319. // MESSAGE VICON_POSITION_ESTIMATE UNPACKING
  320. /**
  321. * @brief Get field usec from vicon_position_estimate message
  322. *
  323. * @return [us] Timestamp (UNIX time or time since system boot)
  324. */
  325. static inline uint64_t mavlink_msg_vicon_position_estimate_get_usec(const mavlink_message_t* msg)
  326. {
  327. return _MAV_RETURN_uint64_t(msg, 0);
  328. }
  329. /**
  330. * @brief Get field x from vicon_position_estimate message
  331. *
  332. * @return [m] Global X position
  333. */
  334. static inline float mavlink_msg_vicon_position_estimate_get_x(const mavlink_message_t* msg)
  335. {
  336. return _MAV_RETURN_float(msg, 8);
  337. }
  338. /**
  339. * @brief Get field y from vicon_position_estimate message
  340. *
  341. * @return [m] Global Y position
  342. */
  343. static inline float mavlink_msg_vicon_position_estimate_get_y(const mavlink_message_t* msg)
  344. {
  345. return _MAV_RETURN_float(msg, 12);
  346. }
  347. /**
  348. * @brief Get field z from vicon_position_estimate message
  349. *
  350. * @return [m] Global Z position
  351. */
  352. static inline float mavlink_msg_vicon_position_estimate_get_z(const mavlink_message_t* msg)
  353. {
  354. return _MAV_RETURN_float(msg, 16);
  355. }
  356. /**
  357. * @brief Get field roll from vicon_position_estimate message
  358. *
  359. * @return [rad] Roll angle
  360. */
  361. static inline float mavlink_msg_vicon_position_estimate_get_roll(const mavlink_message_t* msg)
  362. {
  363. return _MAV_RETURN_float(msg, 20);
  364. }
  365. /**
  366. * @brief Get field pitch from vicon_position_estimate message
  367. *
  368. * @return [rad] Pitch angle
  369. */
  370. static inline float mavlink_msg_vicon_position_estimate_get_pitch(const mavlink_message_t* msg)
  371. {
  372. return _MAV_RETURN_float(msg, 24);
  373. }
  374. /**
  375. * @brief Get field yaw from vicon_position_estimate message
  376. *
  377. * @return [rad] Yaw angle
  378. */
  379. static inline float mavlink_msg_vicon_position_estimate_get_yaw(const mavlink_message_t* msg)
  380. {
  381. return _MAV_RETURN_float(msg, 28);
  382. }
  383. /**
  384. * @brief Get field covariance from vicon_position_estimate message
  385. *
  386. * @return Row-major representation of 6x6 pose cross-covariance matrix upper right triangle (states: x, y, z, roll, pitch, yaw; first six entries are the first ROW, next five entries are the second ROW, etc.). If unknown, assign NaN value to first element in the array.
  387. */
  388. static inline uint16_t mavlink_msg_vicon_position_estimate_get_covariance(const mavlink_message_t* msg, float *covariance)
  389. {
  390. return _MAV_RETURN_float_array(msg, covariance, 21, 32);
  391. }
  392. /**
  393. * @brief Decode a vicon_position_estimate message into a struct
  394. *
  395. * @param msg The message to decode
  396. * @param vicon_position_estimate C-struct to decode the message contents into
  397. */
  398. static inline void mavlink_msg_vicon_position_estimate_decode(const mavlink_message_t* msg, mavlink_vicon_position_estimate_t* vicon_position_estimate)
  399. {
  400. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  401. vicon_position_estimate->usec = mavlink_msg_vicon_position_estimate_get_usec(msg);
  402. vicon_position_estimate->x = mavlink_msg_vicon_position_estimate_get_x(msg);
  403. vicon_position_estimate->y = mavlink_msg_vicon_position_estimate_get_y(msg);
  404. vicon_position_estimate->z = mavlink_msg_vicon_position_estimate_get_z(msg);
  405. vicon_position_estimate->roll = mavlink_msg_vicon_position_estimate_get_roll(msg);
  406. vicon_position_estimate->pitch = mavlink_msg_vicon_position_estimate_get_pitch(msg);
  407. vicon_position_estimate->yaw = mavlink_msg_vicon_position_estimate_get_yaw(msg);
  408. mavlink_msg_vicon_position_estimate_get_covariance(msg, vicon_position_estimate->covariance);
  409. #else
  410. uint8_t len = msg->len < MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN? msg->len : MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN;
  411. memset(vicon_position_estimate, 0, MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_LEN);
  412. memcpy(vicon_position_estimate, _MAV_PAYLOAD(msg), len);
  413. #endif
  414. }