mavlink_msg_estimator_status.h 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438
  1. #pragma once
  2. // MESSAGE ESTIMATOR_STATUS PACKING
  3. #define MAVLINK_MSG_ID_ESTIMATOR_STATUS 230
  4. typedef struct __mavlink_estimator_status_t {
  5. 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.*/
  6. float vel_ratio; /*< Velocity innovation test ratio*/
  7. float pos_horiz_ratio; /*< Horizontal position innovation test ratio*/
  8. float pos_vert_ratio; /*< Vertical position innovation test ratio*/
  9. float mag_ratio; /*< Magnetometer innovation test ratio*/
  10. float hagl_ratio; /*< Height above terrain innovation test ratio*/
  11. float tas_ratio; /*< True airspeed innovation test ratio*/
  12. float pos_horiz_accuracy; /*< [m] Horizontal position 1-STD accuracy relative to the EKF local origin*/
  13. float pos_vert_accuracy; /*< [m] Vertical position 1-STD accuracy relative to the EKF local origin*/
  14. uint16_t flags; /*< Bitmap indicating which EKF outputs are valid.*/
  15. } mavlink_estimator_status_t;
  16. #define MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN 42
  17. #define MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN 42
  18. #define MAVLINK_MSG_ID_230_LEN 42
  19. #define MAVLINK_MSG_ID_230_MIN_LEN 42
  20. #define MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC 163
  21. #define MAVLINK_MSG_ID_230_CRC 163
  22. #if MAVLINK_COMMAND_24BIT
  23. #define MAVLINK_MESSAGE_INFO_ESTIMATOR_STATUS { \
  24. 230, \
  25. "ESTIMATOR_STATUS", \
  26. 10, \
  27. { { "time_usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_estimator_status_t, time_usec) }, \
  28. { "flags", NULL, MAVLINK_TYPE_UINT16_T, 0, 40, offsetof(mavlink_estimator_status_t, flags) }, \
  29. { "vel_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_estimator_status_t, vel_ratio) }, \
  30. { "pos_horiz_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_estimator_status_t, pos_horiz_ratio) }, \
  31. { "pos_vert_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_estimator_status_t, pos_vert_ratio) }, \
  32. { "mag_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_estimator_status_t, mag_ratio) }, \
  33. { "hagl_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_estimator_status_t, hagl_ratio) }, \
  34. { "tas_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_estimator_status_t, tas_ratio) }, \
  35. { "pos_horiz_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_estimator_status_t, pos_horiz_accuracy) }, \
  36. { "pos_vert_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 36, offsetof(mavlink_estimator_status_t, pos_vert_accuracy) }, \
  37. } \
  38. }
  39. #else
  40. #define MAVLINK_MESSAGE_INFO_ESTIMATOR_STATUS { \
  41. "ESTIMATOR_STATUS", \
  42. 10, \
  43. { { "time_usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_estimator_status_t, time_usec) }, \
  44. { "flags", NULL, MAVLINK_TYPE_UINT16_T, 0, 40, offsetof(mavlink_estimator_status_t, flags) }, \
  45. { "vel_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_estimator_status_t, vel_ratio) }, \
  46. { "pos_horiz_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_estimator_status_t, pos_horiz_ratio) }, \
  47. { "pos_vert_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_estimator_status_t, pos_vert_ratio) }, \
  48. { "mag_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_estimator_status_t, mag_ratio) }, \
  49. { "hagl_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_estimator_status_t, hagl_ratio) }, \
  50. { "tas_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_estimator_status_t, tas_ratio) }, \
  51. { "pos_horiz_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_estimator_status_t, pos_horiz_accuracy) }, \
  52. { "pos_vert_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 36, offsetof(mavlink_estimator_status_t, pos_vert_accuracy) }, \
  53. } \
  54. }
  55. #endif
  56. /**
  57. * @brief Pack a estimator_status message
  58. * @param system_id ID of this system
  59. * @param component_id ID of this component (e.g. 200 for IMU)
  60. * @param msg The MAVLink message to compress the data into
  61. *
  62. * @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.
  63. * @param flags Bitmap indicating which EKF outputs are valid.
  64. * @param vel_ratio Velocity innovation test ratio
  65. * @param pos_horiz_ratio Horizontal position innovation test ratio
  66. * @param pos_vert_ratio Vertical position innovation test ratio
  67. * @param mag_ratio Magnetometer innovation test ratio
  68. * @param hagl_ratio Height above terrain innovation test ratio
  69. * @param tas_ratio True airspeed innovation test ratio
  70. * @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  71. * @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
  72. * @return length of the message in bytes (excluding serial stream start sign)
  73. */
  74. static inline uint16_t mavlink_msg_estimator_status_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  75. uint64_t time_usec, uint16_t flags, float vel_ratio, float pos_horiz_ratio, float pos_vert_ratio, float mag_ratio, float hagl_ratio, float tas_ratio, float pos_horiz_accuracy, float pos_vert_accuracy)
  76. {
  77. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  78. char buf[MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN];
  79. _mav_put_uint64_t(buf, 0, time_usec);
  80. _mav_put_float(buf, 8, vel_ratio);
  81. _mav_put_float(buf, 12, pos_horiz_ratio);
  82. _mav_put_float(buf, 16, pos_vert_ratio);
  83. _mav_put_float(buf, 20, mag_ratio);
  84. _mav_put_float(buf, 24, hagl_ratio);
  85. _mav_put_float(buf, 28, tas_ratio);
  86. _mav_put_float(buf, 32, pos_horiz_accuracy);
  87. _mav_put_float(buf, 36, pos_vert_accuracy);
  88. _mav_put_uint16_t(buf, 40, flags);
  89. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  90. #else
  91. mavlink_estimator_status_t packet;
  92. packet.time_usec = time_usec;
  93. packet.vel_ratio = vel_ratio;
  94. packet.pos_horiz_ratio = pos_horiz_ratio;
  95. packet.pos_vert_ratio = pos_vert_ratio;
  96. packet.mag_ratio = mag_ratio;
  97. packet.hagl_ratio = hagl_ratio;
  98. packet.tas_ratio = tas_ratio;
  99. packet.pos_horiz_accuracy = pos_horiz_accuracy;
  100. packet.pos_vert_accuracy = pos_vert_accuracy;
  101. packet.flags = flags;
  102. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  103. #endif
  104. msg->msgid = MAVLINK_MSG_ID_ESTIMATOR_STATUS;
  105. return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  106. }
  107. /**
  108. * @brief Pack a estimator_status message on a channel
  109. * @param system_id ID of this system
  110. * @param component_id ID of this component (e.g. 200 for IMU)
  111. * @param chan The MAVLink channel this message will be sent over
  112. * @param msg The MAVLink message to compress the data into
  113. * @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.
  114. * @param flags Bitmap indicating which EKF outputs are valid.
  115. * @param vel_ratio Velocity innovation test ratio
  116. * @param pos_horiz_ratio Horizontal position innovation test ratio
  117. * @param pos_vert_ratio Vertical position innovation test ratio
  118. * @param mag_ratio Magnetometer innovation test ratio
  119. * @param hagl_ratio Height above terrain innovation test ratio
  120. * @param tas_ratio True airspeed innovation test ratio
  121. * @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  122. * @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
  123. * @return length of the message in bytes (excluding serial stream start sign)
  124. */
  125. static inline uint16_t mavlink_msg_estimator_status_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  126. mavlink_message_t* msg,
  127. uint64_t time_usec,uint16_t flags,float vel_ratio,float pos_horiz_ratio,float pos_vert_ratio,float mag_ratio,float hagl_ratio,float tas_ratio,float pos_horiz_accuracy,float pos_vert_accuracy)
  128. {
  129. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  130. char buf[MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN];
  131. _mav_put_uint64_t(buf, 0, time_usec);
  132. _mav_put_float(buf, 8, vel_ratio);
  133. _mav_put_float(buf, 12, pos_horiz_ratio);
  134. _mav_put_float(buf, 16, pos_vert_ratio);
  135. _mav_put_float(buf, 20, mag_ratio);
  136. _mav_put_float(buf, 24, hagl_ratio);
  137. _mav_put_float(buf, 28, tas_ratio);
  138. _mav_put_float(buf, 32, pos_horiz_accuracy);
  139. _mav_put_float(buf, 36, pos_vert_accuracy);
  140. _mav_put_uint16_t(buf, 40, flags);
  141. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  142. #else
  143. mavlink_estimator_status_t packet;
  144. packet.time_usec = time_usec;
  145. packet.vel_ratio = vel_ratio;
  146. packet.pos_horiz_ratio = pos_horiz_ratio;
  147. packet.pos_vert_ratio = pos_vert_ratio;
  148. packet.mag_ratio = mag_ratio;
  149. packet.hagl_ratio = hagl_ratio;
  150. packet.tas_ratio = tas_ratio;
  151. packet.pos_horiz_accuracy = pos_horiz_accuracy;
  152. packet.pos_vert_accuracy = pos_vert_accuracy;
  153. packet.flags = flags;
  154. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  155. #endif
  156. msg->msgid = MAVLINK_MSG_ID_ESTIMATOR_STATUS;
  157. return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  158. }
  159. /**
  160. * @brief Encode a estimator_status struct
  161. *
  162. * @param system_id ID of this system
  163. * @param component_id ID of this component (e.g. 200 for IMU)
  164. * @param msg The MAVLink message to compress the data into
  165. * @param estimator_status C-struct to read the message contents from
  166. */
  167. static inline uint16_t mavlink_msg_estimator_status_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_estimator_status_t* estimator_status)
  168. {
  169. return mavlink_msg_estimator_status_pack(system_id, component_id, msg, estimator_status->time_usec, estimator_status->flags, estimator_status->vel_ratio, estimator_status->pos_horiz_ratio, estimator_status->pos_vert_ratio, estimator_status->mag_ratio, estimator_status->hagl_ratio, estimator_status->tas_ratio, estimator_status->pos_horiz_accuracy, estimator_status->pos_vert_accuracy);
  170. }
  171. /**
  172. * @brief Encode a estimator_status struct on a channel
  173. *
  174. * @param system_id ID of this system
  175. * @param component_id ID of this component (e.g. 200 for IMU)
  176. * @param chan The MAVLink channel this message will be sent over
  177. * @param msg The MAVLink message to compress the data into
  178. * @param estimator_status C-struct to read the message contents from
  179. */
  180. static inline uint16_t mavlink_msg_estimator_status_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_estimator_status_t* estimator_status)
  181. {
  182. return mavlink_msg_estimator_status_pack_chan(system_id, component_id, chan, msg, estimator_status->time_usec, estimator_status->flags, estimator_status->vel_ratio, estimator_status->pos_horiz_ratio, estimator_status->pos_vert_ratio, estimator_status->mag_ratio, estimator_status->hagl_ratio, estimator_status->tas_ratio, estimator_status->pos_horiz_accuracy, estimator_status->pos_vert_accuracy);
  183. }
  184. /**
  185. * @brief Send a estimator_status message
  186. * @param chan MAVLink channel to send the message
  187. *
  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 flags Bitmap indicating which EKF outputs are valid.
  190. * @param vel_ratio Velocity innovation test ratio
  191. * @param pos_horiz_ratio Horizontal position innovation test ratio
  192. * @param pos_vert_ratio Vertical position innovation test ratio
  193. * @param mag_ratio Magnetometer innovation test ratio
  194. * @param hagl_ratio Height above terrain innovation test ratio
  195. * @param tas_ratio True airspeed innovation test ratio
  196. * @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  197. * @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
  198. */
  199. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  200. static inline void mavlink_msg_estimator_status_send(mavlink_channel_t chan, uint64_t time_usec, uint16_t flags, float vel_ratio, float pos_horiz_ratio, float pos_vert_ratio, float mag_ratio, float hagl_ratio, float tas_ratio, float pos_horiz_accuracy, float pos_vert_accuracy)
  201. {
  202. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  203. char buf[MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN];
  204. _mav_put_uint64_t(buf, 0, time_usec);
  205. _mav_put_float(buf, 8, vel_ratio);
  206. _mav_put_float(buf, 12, pos_horiz_ratio);
  207. _mav_put_float(buf, 16, pos_vert_ratio);
  208. _mav_put_float(buf, 20, mag_ratio);
  209. _mav_put_float(buf, 24, hagl_ratio);
  210. _mav_put_float(buf, 28, tas_ratio);
  211. _mav_put_float(buf, 32, pos_horiz_accuracy);
  212. _mav_put_float(buf, 36, pos_vert_accuracy);
  213. _mav_put_uint16_t(buf, 40, flags);
  214. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_ESTIMATOR_STATUS, buf, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  215. #else
  216. mavlink_estimator_status_t packet;
  217. packet.time_usec = time_usec;
  218. packet.vel_ratio = vel_ratio;
  219. packet.pos_horiz_ratio = pos_horiz_ratio;
  220. packet.pos_vert_ratio = pos_vert_ratio;
  221. packet.mag_ratio = mag_ratio;
  222. packet.hagl_ratio = hagl_ratio;
  223. packet.tas_ratio = tas_ratio;
  224. packet.pos_horiz_accuracy = pos_horiz_accuracy;
  225. packet.pos_vert_accuracy = pos_vert_accuracy;
  226. packet.flags = flags;
  227. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_ESTIMATOR_STATUS, (const char *)&packet, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  228. #endif
  229. }
  230. /**
  231. * @brief Send a estimator_status message
  232. * @param chan MAVLink channel to send the message
  233. * @param struct The MAVLink struct to serialize
  234. */
  235. static inline void mavlink_msg_estimator_status_send_struct(mavlink_channel_t chan, const mavlink_estimator_status_t* estimator_status)
  236. {
  237. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  238. mavlink_msg_estimator_status_send(chan, estimator_status->time_usec, estimator_status->flags, estimator_status->vel_ratio, estimator_status->pos_horiz_ratio, estimator_status->pos_vert_ratio, estimator_status->mag_ratio, estimator_status->hagl_ratio, estimator_status->tas_ratio, estimator_status->pos_horiz_accuracy, estimator_status->pos_vert_accuracy);
  239. #else
  240. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_ESTIMATOR_STATUS, (const char *)estimator_status, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  241. #endif
  242. }
  243. #if MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  244. /*
  245. This variant of _send() can be used to save stack space by re-using
  246. memory from the receive buffer. The caller provides a
  247. mavlink_message_t which is the size of a full mavlink message. This
  248. is usually the receive buffer for the channel, and allows a reply to an
  249. incoming message with minimum stack space usage.
  250. */
  251. static inline void mavlink_msg_estimator_status_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint64_t time_usec, uint16_t flags, float vel_ratio, float pos_horiz_ratio, float pos_vert_ratio, float mag_ratio, float hagl_ratio, float tas_ratio, float pos_horiz_accuracy, float pos_vert_accuracy)
  252. {
  253. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  254. char *buf = (char *)msgbuf;
  255. _mav_put_uint64_t(buf, 0, time_usec);
  256. _mav_put_float(buf, 8, vel_ratio);
  257. _mav_put_float(buf, 12, pos_horiz_ratio);
  258. _mav_put_float(buf, 16, pos_vert_ratio);
  259. _mav_put_float(buf, 20, mag_ratio);
  260. _mav_put_float(buf, 24, hagl_ratio);
  261. _mav_put_float(buf, 28, tas_ratio);
  262. _mav_put_float(buf, 32, pos_horiz_accuracy);
  263. _mav_put_float(buf, 36, pos_vert_accuracy);
  264. _mav_put_uint16_t(buf, 40, flags);
  265. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_ESTIMATOR_STATUS, buf, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  266. #else
  267. mavlink_estimator_status_t *packet = (mavlink_estimator_status_t *)msgbuf;
  268. packet->time_usec = time_usec;
  269. packet->vel_ratio = vel_ratio;
  270. packet->pos_horiz_ratio = pos_horiz_ratio;
  271. packet->pos_vert_ratio = pos_vert_ratio;
  272. packet->mag_ratio = mag_ratio;
  273. packet->hagl_ratio = hagl_ratio;
  274. packet->tas_ratio = tas_ratio;
  275. packet->pos_horiz_accuracy = pos_horiz_accuracy;
  276. packet->pos_vert_accuracy = pos_vert_accuracy;
  277. packet->flags = flags;
  278. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_ESTIMATOR_STATUS, (const char *)packet, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  279. #endif
  280. }
  281. #endif
  282. #endif
  283. // MESSAGE ESTIMATOR_STATUS UNPACKING
  284. /**
  285. * @brief Get field time_usec from estimator_status message
  286. *
  287. * @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.
  288. */
  289. static inline uint64_t mavlink_msg_estimator_status_get_time_usec(const mavlink_message_t* msg)
  290. {
  291. return _MAV_RETURN_uint64_t(msg, 0);
  292. }
  293. /**
  294. * @brief Get field flags from estimator_status message
  295. *
  296. * @return Bitmap indicating which EKF outputs are valid.
  297. */
  298. static inline uint16_t mavlink_msg_estimator_status_get_flags(const mavlink_message_t* msg)
  299. {
  300. return _MAV_RETURN_uint16_t(msg, 40);
  301. }
  302. /**
  303. * @brief Get field vel_ratio from estimator_status message
  304. *
  305. * @return Velocity innovation test ratio
  306. */
  307. static inline float mavlink_msg_estimator_status_get_vel_ratio(const mavlink_message_t* msg)
  308. {
  309. return _MAV_RETURN_float(msg, 8);
  310. }
  311. /**
  312. * @brief Get field pos_horiz_ratio from estimator_status message
  313. *
  314. * @return Horizontal position innovation test ratio
  315. */
  316. static inline float mavlink_msg_estimator_status_get_pos_horiz_ratio(const mavlink_message_t* msg)
  317. {
  318. return _MAV_RETURN_float(msg, 12);
  319. }
  320. /**
  321. * @brief Get field pos_vert_ratio from estimator_status message
  322. *
  323. * @return Vertical position innovation test ratio
  324. */
  325. static inline float mavlink_msg_estimator_status_get_pos_vert_ratio(const mavlink_message_t* msg)
  326. {
  327. return _MAV_RETURN_float(msg, 16);
  328. }
  329. /**
  330. * @brief Get field mag_ratio from estimator_status message
  331. *
  332. * @return Magnetometer innovation test ratio
  333. */
  334. static inline float mavlink_msg_estimator_status_get_mag_ratio(const mavlink_message_t* msg)
  335. {
  336. return _MAV_RETURN_float(msg, 20);
  337. }
  338. /**
  339. * @brief Get field hagl_ratio from estimator_status message
  340. *
  341. * @return Height above terrain innovation test ratio
  342. */
  343. static inline float mavlink_msg_estimator_status_get_hagl_ratio(const mavlink_message_t* msg)
  344. {
  345. return _MAV_RETURN_float(msg, 24);
  346. }
  347. /**
  348. * @brief Get field tas_ratio from estimator_status message
  349. *
  350. * @return True airspeed innovation test ratio
  351. */
  352. static inline float mavlink_msg_estimator_status_get_tas_ratio(const mavlink_message_t* msg)
  353. {
  354. return _MAV_RETURN_float(msg, 28);
  355. }
  356. /**
  357. * @brief Get field pos_horiz_accuracy from estimator_status message
  358. *
  359. * @return [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  360. */
  361. static inline float mavlink_msg_estimator_status_get_pos_horiz_accuracy(const mavlink_message_t* msg)
  362. {
  363. return _MAV_RETURN_float(msg, 32);
  364. }
  365. /**
  366. * @brief Get field pos_vert_accuracy from estimator_status message
  367. *
  368. * @return [m] Vertical position 1-STD accuracy relative to the EKF local origin
  369. */
  370. static inline float mavlink_msg_estimator_status_get_pos_vert_accuracy(const mavlink_message_t* msg)
  371. {
  372. return _MAV_RETURN_float(msg, 36);
  373. }
  374. /**
  375. * @brief Decode a estimator_status message into a struct
  376. *
  377. * @param msg The message to decode
  378. * @param estimator_status C-struct to decode the message contents into
  379. */
  380. static inline void mavlink_msg_estimator_status_decode(const mavlink_message_t* msg, mavlink_estimator_status_t* estimator_status)
  381. {
  382. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  383. estimator_status->time_usec = mavlink_msg_estimator_status_get_time_usec(msg);
  384. estimator_status->vel_ratio = mavlink_msg_estimator_status_get_vel_ratio(msg);
  385. estimator_status->pos_horiz_ratio = mavlink_msg_estimator_status_get_pos_horiz_ratio(msg);
  386. estimator_status->pos_vert_ratio = mavlink_msg_estimator_status_get_pos_vert_ratio(msg);
  387. estimator_status->mag_ratio = mavlink_msg_estimator_status_get_mag_ratio(msg);
  388. estimator_status->hagl_ratio = mavlink_msg_estimator_status_get_hagl_ratio(msg);
  389. estimator_status->tas_ratio = mavlink_msg_estimator_status_get_tas_ratio(msg);
  390. estimator_status->pos_horiz_accuracy = mavlink_msg_estimator_status_get_pos_horiz_accuracy(msg);
  391. estimator_status->pos_vert_accuracy = mavlink_msg_estimator_status_get_pos_vert_accuracy(msg);
  392. estimator_status->flags = mavlink_msg_estimator_status_get_flags(msg);
  393. #else
  394. uint8_t len = msg->len < MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN? msg->len : MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN;
  395. memset(estimator_status, 0, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  396. memcpy(estimator_status, _MAV_PAYLOAD(msg), len);
  397. #endif
  398. }