mavlink_msg_estimator_status.h 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512
  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
  109. * @param system_id ID of this system
  110. * @param component_id ID of this component (e.g. 200 for IMU)
  111. * @param status MAVLink status structure
  112. * @param msg The MAVLink message to compress the data into
  113. *
  114. * @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.
  115. * @param flags Bitmap indicating which EKF outputs are valid.
  116. * @param vel_ratio Velocity innovation test ratio
  117. * @param pos_horiz_ratio Horizontal position innovation test ratio
  118. * @param pos_vert_ratio Vertical position innovation test ratio
  119. * @param mag_ratio Magnetometer innovation test ratio
  120. * @param hagl_ratio Height above terrain innovation test ratio
  121. * @param tas_ratio True airspeed innovation test ratio
  122. * @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  123. * @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
  124. * @return length of the message in bytes (excluding serial stream start sign)
  125. */
  126. static inline uint16_t mavlink_msg_estimator_status_pack_status(uint8_t system_id, uint8_t component_id, mavlink_status_t *_status, 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. #if MAVLINK_CRC_EXTRA
  158. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC);
  159. #else
  160. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  161. #endif
  162. }
  163. /**
  164. * @brief Pack a estimator_status message on a channel
  165. * @param system_id ID of this system
  166. * @param component_id ID of this component (e.g. 200 for IMU)
  167. * @param chan The MAVLink channel this message will be sent over
  168. * @param msg The MAVLink message to compress the data into
  169. * @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.
  170. * @param flags Bitmap indicating which EKF outputs are valid.
  171. * @param vel_ratio Velocity innovation test ratio
  172. * @param pos_horiz_ratio Horizontal position innovation test ratio
  173. * @param pos_vert_ratio Vertical position innovation test ratio
  174. * @param mag_ratio Magnetometer innovation test ratio
  175. * @param hagl_ratio Height above terrain innovation test ratio
  176. * @param tas_ratio True airspeed innovation test ratio
  177. * @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  178. * @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
  179. * @return length of the message in bytes (excluding serial stream start sign)
  180. */
  181. static inline uint16_t mavlink_msg_estimator_status_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  182. mavlink_message_t* msg,
  183. 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)
  184. {
  185. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  186. char buf[MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN];
  187. _mav_put_uint64_t(buf, 0, time_usec);
  188. _mav_put_float(buf, 8, vel_ratio);
  189. _mav_put_float(buf, 12, pos_horiz_ratio);
  190. _mav_put_float(buf, 16, pos_vert_ratio);
  191. _mav_put_float(buf, 20, mag_ratio);
  192. _mav_put_float(buf, 24, hagl_ratio);
  193. _mav_put_float(buf, 28, tas_ratio);
  194. _mav_put_float(buf, 32, pos_horiz_accuracy);
  195. _mav_put_float(buf, 36, pos_vert_accuracy);
  196. _mav_put_uint16_t(buf, 40, flags);
  197. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  198. #else
  199. mavlink_estimator_status_t packet;
  200. packet.time_usec = time_usec;
  201. packet.vel_ratio = vel_ratio;
  202. packet.pos_horiz_ratio = pos_horiz_ratio;
  203. packet.pos_vert_ratio = pos_vert_ratio;
  204. packet.mag_ratio = mag_ratio;
  205. packet.hagl_ratio = hagl_ratio;
  206. packet.tas_ratio = tas_ratio;
  207. packet.pos_horiz_accuracy = pos_horiz_accuracy;
  208. packet.pos_vert_accuracy = pos_vert_accuracy;
  209. packet.flags = flags;
  210. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  211. #endif
  212. msg->msgid = MAVLINK_MSG_ID_ESTIMATOR_STATUS;
  213. 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);
  214. }
  215. /**
  216. * @brief Encode a estimator_status struct
  217. *
  218. * @param system_id ID of this system
  219. * @param component_id ID of this component (e.g. 200 for IMU)
  220. * @param msg The MAVLink message to compress the data into
  221. * @param estimator_status C-struct to read the message contents from
  222. */
  223. 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)
  224. {
  225. 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);
  226. }
  227. /**
  228. * @brief Encode a estimator_status struct on a channel
  229. *
  230. * @param system_id ID of this system
  231. * @param component_id ID of this component (e.g. 200 for IMU)
  232. * @param chan The MAVLink channel this message will be sent over
  233. * @param msg The MAVLink message to compress the data into
  234. * @param estimator_status C-struct to read the message contents from
  235. */
  236. 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)
  237. {
  238. 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);
  239. }
  240. /**
  241. * @brief Encode a estimator_status struct with provided status structure
  242. *
  243. * @param system_id ID of this system
  244. * @param component_id ID of this component (e.g. 200 for IMU)
  245. * @param status MAVLink status structure
  246. * @param msg The MAVLink message to compress the data into
  247. * @param estimator_status C-struct to read the message contents from
  248. */
  249. static inline uint16_t mavlink_msg_estimator_status_encode_status(uint8_t system_id, uint8_t component_id, mavlink_status_t* _status, mavlink_message_t* msg, const mavlink_estimator_status_t* estimator_status)
  250. {
  251. return mavlink_msg_estimator_status_pack_status(system_id, component_id, _status, 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);
  252. }
  253. /**
  254. * @brief Send a estimator_status message
  255. * @param chan MAVLink channel to send the message
  256. *
  257. * @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.
  258. * @param flags Bitmap indicating which EKF outputs are valid.
  259. * @param vel_ratio Velocity innovation test ratio
  260. * @param pos_horiz_ratio Horizontal position innovation test ratio
  261. * @param pos_vert_ratio Vertical position innovation test ratio
  262. * @param mag_ratio Magnetometer innovation test ratio
  263. * @param hagl_ratio Height above terrain innovation test ratio
  264. * @param tas_ratio True airspeed innovation test ratio
  265. * @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  266. * @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
  267. */
  268. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  269. 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)
  270. {
  271. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  272. char buf[MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN];
  273. _mav_put_uint64_t(buf, 0, time_usec);
  274. _mav_put_float(buf, 8, vel_ratio);
  275. _mav_put_float(buf, 12, pos_horiz_ratio);
  276. _mav_put_float(buf, 16, pos_vert_ratio);
  277. _mav_put_float(buf, 20, mag_ratio);
  278. _mav_put_float(buf, 24, hagl_ratio);
  279. _mav_put_float(buf, 28, tas_ratio);
  280. _mav_put_float(buf, 32, pos_horiz_accuracy);
  281. _mav_put_float(buf, 36, pos_vert_accuracy);
  282. _mav_put_uint16_t(buf, 40, flags);
  283. _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);
  284. #else
  285. mavlink_estimator_status_t packet;
  286. packet.time_usec = time_usec;
  287. packet.vel_ratio = vel_ratio;
  288. packet.pos_horiz_ratio = pos_horiz_ratio;
  289. packet.pos_vert_ratio = pos_vert_ratio;
  290. packet.mag_ratio = mag_ratio;
  291. packet.hagl_ratio = hagl_ratio;
  292. packet.tas_ratio = tas_ratio;
  293. packet.pos_horiz_accuracy = pos_horiz_accuracy;
  294. packet.pos_vert_accuracy = pos_vert_accuracy;
  295. packet.flags = flags;
  296. _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);
  297. #endif
  298. }
  299. /**
  300. * @brief Send a estimator_status message
  301. * @param chan MAVLink channel to send the message
  302. * @param struct The MAVLink struct to serialize
  303. */
  304. static inline void mavlink_msg_estimator_status_send_struct(mavlink_channel_t chan, const mavlink_estimator_status_t* estimator_status)
  305. {
  306. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  307. 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);
  308. #else
  309. _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);
  310. #endif
  311. }
  312. #if MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  313. /*
  314. This variant of _send() can be used to save stack space by re-using
  315. memory from the receive buffer. The caller provides a
  316. mavlink_message_t which is the size of a full mavlink message. This
  317. is usually the receive buffer for the channel, and allows a reply to an
  318. incoming message with minimum stack space usage.
  319. */
  320. 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)
  321. {
  322. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  323. char *buf = (char *)msgbuf;
  324. _mav_put_uint64_t(buf, 0, time_usec);
  325. _mav_put_float(buf, 8, vel_ratio);
  326. _mav_put_float(buf, 12, pos_horiz_ratio);
  327. _mav_put_float(buf, 16, pos_vert_ratio);
  328. _mav_put_float(buf, 20, mag_ratio);
  329. _mav_put_float(buf, 24, hagl_ratio);
  330. _mav_put_float(buf, 28, tas_ratio);
  331. _mav_put_float(buf, 32, pos_horiz_accuracy);
  332. _mav_put_float(buf, 36, pos_vert_accuracy);
  333. _mav_put_uint16_t(buf, 40, flags);
  334. _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);
  335. #else
  336. mavlink_estimator_status_t *packet = (mavlink_estimator_status_t *)msgbuf;
  337. packet->time_usec = time_usec;
  338. packet->vel_ratio = vel_ratio;
  339. packet->pos_horiz_ratio = pos_horiz_ratio;
  340. packet->pos_vert_ratio = pos_vert_ratio;
  341. packet->mag_ratio = mag_ratio;
  342. packet->hagl_ratio = hagl_ratio;
  343. packet->tas_ratio = tas_ratio;
  344. packet->pos_horiz_accuracy = pos_horiz_accuracy;
  345. packet->pos_vert_accuracy = pos_vert_accuracy;
  346. packet->flags = flags;
  347. _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);
  348. #endif
  349. }
  350. #endif
  351. #endif
  352. // MESSAGE ESTIMATOR_STATUS UNPACKING
  353. /**
  354. * @brief Get field time_usec from estimator_status message
  355. *
  356. * @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.
  357. */
  358. static inline uint64_t mavlink_msg_estimator_status_get_time_usec(const mavlink_message_t* msg)
  359. {
  360. return _MAV_RETURN_uint64_t(msg, 0);
  361. }
  362. /**
  363. * @brief Get field flags from estimator_status message
  364. *
  365. * @return Bitmap indicating which EKF outputs are valid.
  366. */
  367. static inline uint16_t mavlink_msg_estimator_status_get_flags(const mavlink_message_t* msg)
  368. {
  369. return _MAV_RETURN_uint16_t(msg, 40);
  370. }
  371. /**
  372. * @brief Get field vel_ratio from estimator_status message
  373. *
  374. * @return Velocity innovation test ratio
  375. */
  376. static inline float mavlink_msg_estimator_status_get_vel_ratio(const mavlink_message_t* msg)
  377. {
  378. return _MAV_RETURN_float(msg, 8);
  379. }
  380. /**
  381. * @brief Get field pos_horiz_ratio from estimator_status message
  382. *
  383. * @return Horizontal position innovation test ratio
  384. */
  385. static inline float mavlink_msg_estimator_status_get_pos_horiz_ratio(const mavlink_message_t* msg)
  386. {
  387. return _MAV_RETURN_float(msg, 12);
  388. }
  389. /**
  390. * @brief Get field pos_vert_ratio from estimator_status message
  391. *
  392. * @return Vertical position innovation test ratio
  393. */
  394. static inline float mavlink_msg_estimator_status_get_pos_vert_ratio(const mavlink_message_t* msg)
  395. {
  396. return _MAV_RETURN_float(msg, 16);
  397. }
  398. /**
  399. * @brief Get field mag_ratio from estimator_status message
  400. *
  401. * @return Magnetometer innovation test ratio
  402. */
  403. static inline float mavlink_msg_estimator_status_get_mag_ratio(const mavlink_message_t* msg)
  404. {
  405. return _MAV_RETURN_float(msg, 20);
  406. }
  407. /**
  408. * @brief Get field hagl_ratio from estimator_status message
  409. *
  410. * @return Height above terrain innovation test ratio
  411. */
  412. static inline float mavlink_msg_estimator_status_get_hagl_ratio(const mavlink_message_t* msg)
  413. {
  414. return _MAV_RETURN_float(msg, 24);
  415. }
  416. /**
  417. * @brief Get field tas_ratio from estimator_status message
  418. *
  419. * @return True airspeed innovation test ratio
  420. */
  421. static inline float mavlink_msg_estimator_status_get_tas_ratio(const mavlink_message_t* msg)
  422. {
  423. return _MAV_RETURN_float(msg, 28);
  424. }
  425. /**
  426. * @brief Get field pos_horiz_accuracy from estimator_status message
  427. *
  428. * @return [m] Horizontal position 1-STD accuracy relative to the EKF local origin
  429. */
  430. static inline float mavlink_msg_estimator_status_get_pos_horiz_accuracy(const mavlink_message_t* msg)
  431. {
  432. return _MAV_RETURN_float(msg, 32);
  433. }
  434. /**
  435. * @brief Get field pos_vert_accuracy from estimator_status message
  436. *
  437. * @return [m] Vertical position 1-STD accuracy relative to the EKF local origin
  438. */
  439. static inline float mavlink_msg_estimator_status_get_pos_vert_accuracy(const mavlink_message_t* msg)
  440. {
  441. return _MAV_RETURN_float(msg, 36);
  442. }
  443. /**
  444. * @brief Decode a estimator_status message into a struct
  445. *
  446. * @param msg The message to decode
  447. * @param estimator_status C-struct to decode the message contents into
  448. */
  449. static inline void mavlink_msg_estimator_status_decode(const mavlink_message_t* msg, mavlink_estimator_status_t* estimator_status)
  450. {
  451. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  452. estimator_status->time_usec = mavlink_msg_estimator_status_get_time_usec(msg);
  453. estimator_status->vel_ratio = mavlink_msg_estimator_status_get_vel_ratio(msg);
  454. estimator_status->pos_horiz_ratio = mavlink_msg_estimator_status_get_pos_horiz_ratio(msg);
  455. estimator_status->pos_vert_ratio = mavlink_msg_estimator_status_get_pos_vert_ratio(msg);
  456. estimator_status->mag_ratio = mavlink_msg_estimator_status_get_mag_ratio(msg);
  457. estimator_status->hagl_ratio = mavlink_msg_estimator_status_get_hagl_ratio(msg);
  458. estimator_status->tas_ratio = mavlink_msg_estimator_status_get_tas_ratio(msg);
  459. estimator_status->pos_horiz_accuracy = mavlink_msg_estimator_status_get_pos_horiz_accuracy(msg);
  460. estimator_status->pos_vert_accuracy = mavlink_msg_estimator_status_get_pos_vert_accuracy(msg);
  461. estimator_status->flags = mavlink_msg_estimator_status_get_flags(msg);
  462. #else
  463. uint8_t len = msg->len < MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN? msg->len : MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN;
  464. memset(estimator_status, 0, MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN);
  465. memcpy(estimator_status, _MAV_PAYLOAD(msg), len);
  466. #endif
  467. }