2016-10-05 22:52:07 +00:00
# pragma once
2016-04-19 09:03:05 +00:00
// MESSAGE ESTIMATOR_STATUS PACKING
# define MAVLINK_MSG_ID_ESTIMATOR_STATUS 230
2020-09-20 10:12:24 +08:00
2016-08-02 12:16:40 +00:00
typedef struct __mavlink_estimator_status_t {
2020-09-20 10:12:24 +08:00
uint32_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 the number.*/
2018-06-03 17:07:10 +08:00
float vel_ratio ; /*< Velocity innovation test ratio*/
float pos_horiz_ratio ; /*< Horizontal position innovation test ratio*/
float pos_vert_ratio ; /*< Vertical position innovation test ratio*/
float mag_ratio ; /*< Magnetometer innovation test ratio*/
float hagl_ratio ; /*< Height above terrain innovation test ratio*/
float tas_ratio ; /*< True airspeed innovation test ratio*/
2018-08-07 10:12:17 +08:00
float pos_horiz_accuracy ; /*< [m] Horizontal position 1-STD accuracy relative to the EKF local origin*/
float pos_vert_accuracy ; /*< [m] Vertical position 1-STD accuracy relative to the EKF local origin*/
uint16_t flags ; /*< Bitmap indicating which EKF outputs are valid.*/
2020-09-20 10:12:24 +08:00
} mavlink_estimator_status_t ;
2016-04-19 09:03:05 +00:00
2020-09-20 10:12:24 +08:00
# define MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN 38
# define MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN 38
# define MAVLINK_MSG_ID_230_LEN 38
# define MAVLINK_MSG_ID_230_MIN_LEN 38
2016-04-19 09:03:05 +00:00
2020-09-20 10:12:24 +08:00
# define MAVLINK_MSG_ID_ESTIMATOR_STATUS_CRC 237
# define MAVLINK_MSG_ID_230_CRC 237
2016-04-19 09:03:05 +00:00
2016-05-16 08:33:08 +00:00
# if MAVLINK_COMMAND_24BIT
2016-04-19 09:03:05 +00:00
# define MAVLINK_MESSAGE_INFO_ESTIMATOR_STATUS { \
2016-10-10 10:40:57 +00:00
230, \
"ESTIMATOR_STATUS", \
10, \
2020-09-20 10:12:24 +08:00
{ { "time_usec", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_estimator_status_t, time_usec) }, \
{ "flags", NULL, MAVLINK_TYPE_UINT16_T, 0, 36, offsetof(mavlink_estimator_status_t, flags) }, \
{ "vel_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_estimator_status_t, vel_ratio) }, \
{ "pos_horiz_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_estimator_status_t, pos_horiz_ratio) }, \
{ "pos_vert_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_estimator_status_t, pos_vert_ratio) }, \
{ "mag_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_estimator_status_t, mag_ratio) }, \
{ "hagl_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_estimator_status_t, hagl_ratio) }, \
{ "tas_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_estimator_status_t, tas_ratio) }, \
{ "pos_horiz_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_estimator_status_t, pos_horiz_accuracy) }, \
{ "pos_vert_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_estimator_status_t, pos_vert_accuracy) }, \
2016-04-19 09:03:05 +00:00
} \
}
2016-05-16 08:33:08 +00:00
# else
# define MAVLINK_MESSAGE_INFO_ESTIMATOR_STATUS { \
2016-10-10 10:40:57 +00:00
"ESTIMATOR_STATUS", \
10, \
2020-09-20 10:12:24 +08:00
{ { "time_usec", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_estimator_status_t, time_usec) }, \
{ "flags", NULL, MAVLINK_TYPE_UINT16_T, 0, 36, offsetof(mavlink_estimator_status_t, flags) }, \
{ "vel_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_estimator_status_t, vel_ratio) }, \
{ "pos_horiz_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_estimator_status_t, pos_horiz_ratio) }, \
{ "pos_vert_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_estimator_status_t, pos_vert_ratio) }, \
{ "mag_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_estimator_status_t, mag_ratio) }, \
{ "hagl_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_estimator_status_t, hagl_ratio) }, \
{ "tas_ratio", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_estimator_status_t, tas_ratio) }, \
{ "pos_horiz_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_estimator_status_t, pos_horiz_accuracy) }, \
{ "pos_vert_accuracy", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_estimator_status_t, pos_vert_accuracy) }, \
2016-05-16 08:33:08 +00:00
} \
}
# endif
2016-04-19 09:03:05 +00:00
/**
* @brief Pack a estimator_status message
* @param system_id ID of this system
* @param component_id ID of this component (e.g. 200 for IMU)
* @param msg The MAVLink message to compress the data into
*
2018-08-07 10:12:17 +08:00
* @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 the number.
* @param flags Bitmap indicating which EKF outputs are valid.
2018-06-03 17:07:10 +08:00
* @param vel_ratio Velocity innovation test ratio
* @param pos_horiz_ratio Horizontal position innovation test ratio
* @param pos_vert_ratio Vertical position innovation test ratio
* @param mag_ratio Magnetometer innovation test ratio
* @param hagl_ratio Height above terrain innovation test ratio
* @param tas_ratio True airspeed innovation test ratio
2018-08-07 10:12:17 +08:00
* @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
* @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
2016-04-19 09:03:05 +00:00
* @return length of the message in bytes (excluding serial stream start sign)
*/
2020-09-20 10:12:24 +08:00
static inline uint16_t mavlink_msg_estimator_status_pack ( uint16_t system_id , uint8_t component_id , mavlink_message_t * msg ,
uint32_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 )
2016-04-19 09:03:05 +00:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char buf [ MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ] ;
2020-09-20 10:12:24 +08:00
_mav_put_uint32_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 4 , vel_ratio ) ;
_mav_put_float ( buf , 8 , pos_horiz_ratio ) ;
_mav_put_float ( buf , 12 , pos_vert_ratio ) ;
_mav_put_float ( buf , 16 , mag_ratio ) ;
_mav_put_float ( buf , 20 , hagl_ratio ) ;
_mav_put_float ( buf , 24 , tas_ratio ) ;
_mav_put_float ( buf , 28 , pos_horiz_accuracy ) ;
_mav_put_float ( buf , 32 , pos_vert_accuracy ) ;
_mav_put_uint16_t ( buf , 36 , flags ) ;
2016-04-19 09:03:05 +00:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , buf , MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ) ;
# else
2016-10-10 10:40:57 +00:00
mavlink_estimator_status_t packet ;
packet . time_usec = time_usec ;
packet . vel_ratio = vel_ratio ;
packet . pos_horiz_ratio = pos_horiz_ratio ;
packet . pos_vert_ratio = pos_vert_ratio ;
packet . mag_ratio = mag_ratio ;
packet . hagl_ratio = hagl_ratio ;
packet . tas_ratio = tas_ratio ;
packet . pos_horiz_accuracy = pos_horiz_accuracy ;
packet . pos_vert_accuracy = pos_vert_accuracy ;
packet . flags = flags ;
2016-04-19 09:03:05 +00:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , & packet , MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ) ;
# endif
2016-10-10 10:40:57 +00:00
msg - > msgid = MAVLINK_MSG_ID_ESTIMATOR_STATUS ;
2016-05-16 08:33:08 +00:00
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 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Pack a estimator_status message on a channel
* @param system_id ID of this system
* @param component_id ID of this component (e.g. 200 for IMU)
* @param chan The MAVLink channel this message will be sent over
* @param msg The MAVLink message to compress the data into
2018-08-07 10:12:17 +08:00
* @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 the number.
* @param flags Bitmap indicating which EKF outputs are valid.
2018-06-03 17:07:10 +08:00
* @param vel_ratio Velocity innovation test ratio
* @param pos_horiz_ratio Horizontal position innovation test ratio
* @param pos_vert_ratio Vertical position innovation test ratio
* @param mag_ratio Magnetometer innovation test ratio
* @param hagl_ratio Height above terrain innovation test ratio
* @param tas_ratio True airspeed innovation test ratio
2018-08-07 10:12:17 +08:00
* @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
* @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
2016-04-19 09:03:05 +00:00
* @return length of the message in bytes (excluding serial stream start sign)
*/
2020-09-20 10:12:24 +08:00
static inline uint16_t mavlink_msg_estimator_status_pack_chan ( uint16_t system_id , uint8_t component_id , uint8_t chan ,
2016-10-10 10:40:57 +00:00
mavlink_message_t * msg ,
2020-09-20 10:12:24 +08:00
uint32_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 )
2016-04-19 09:03:05 +00:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char buf [ MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ] ;
2020-09-20 10:12:24 +08:00
_mav_put_uint32_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 4 , vel_ratio ) ;
_mav_put_float ( buf , 8 , pos_horiz_ratio ) ;
_mav_put_float ( buf , 12 , pos_vert_ratio ) ;
_mav_put_float ( buf , 16 , mag_ratio ) ;
_mav_put_float ( buf , 20 , hagl_ratio ) ;
_mav_put_float ( buf , 24 , tas_ratio ) ;
_mav_put_float ( buf , 28 , pos_horiz_accuracy ) ;
_mav_put_float ( buf , 32 , pos_vert_accuracy ) ;
_mav_put_uint16_t ( buf , 36 , flags ) ;
2016-04-19 09:03:05 +00:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , buf , MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ) ;
# else
2016-10-10 10:40:57 +00:00
mavlink_estimator_status_t packet ;
packet . time_usec = time_usec ;
packet . vel_ratio = vel_ratio ;
packet . pos_horiz_ratio = pos_horiz_ratio ;
packet . pos_vert_ratio = pos_vert_ratio ;
packet . mag_ratio = mag_ratio ;
packet . hagl_ratio = hagl_ratio ;
packet . tas_ratio = tas_ratio ;
packet . pos_horiz_accuracy = pos_horiz_accuracy ;
packet . pos_vert_accuracy = pos_vert_accuracy ;
packet . flags = flags ;
2016-04-19 09:03:05 +00:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , & packet , MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ) ;
# endif
2016-10-10 10:40:57 +00:00
msg - > msgid = MAVLINK_MSG_ID_ESTIMATOR_STATUS ;
2016-05-16 08:33:08 +00:00
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 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Encode a estimator_status struct
*
* @param system_id ID of this system
* @param component_id ID of this component (e.g. 200 for IMU)
* @param msg The MAVLink message to compress the data into
* @param estimator_status C-struct to read the message contents from
*/
2020-09-20 10:12:24 +08:00
static inline uint16_t mavlink_msg_estimator_status_encode ( uint16_t system_id , uint8_t component_id , mavlink_message_t * msg , const mavlink_estimator_status_t * estimator_status )
2016-04-19 09:03:05 +00:00
{
2016-10-10 10:40:57 +00:00
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 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Encode a estimator_status struct on a channel
*
* @param system_id ID of this system
* @param component_id ID of this component (e.g. 200 for IMU)
* @param chan The MAVLink channel this message will be sent over
* @param msg The MAVLink message to compress the data into
* @param estimator_status C-struct to read the message contents from
*/
2020-09-20 10:12:24 +08:00
static inline uint16_t mavlink_msg_estimator_status_encode_chan ( uint16_t system_id , uint8_t component_id , uint8_t chan , mavlink_message_t * msg , const mavlink_estimator_status_t * estimator_status )
2016-04-19 09:03:05 +00:00
{
2016-10-10 10:40:57 +00:00
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 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Send a estimator_status message
* @param chan MAVLink channel to send the message
*
2018-08-07 10:12:17 +08:00
* @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 the number.
* @param flags Bitmap indicating which EKF outputs are valid.
2018-06-03 17:07:10 +08:00
* @param vel_ratio Velocity innovation test ratio
* @param pos_horiz_ratio Horizontal position innovation test ratio
* @param pos_vert_ratio Vertical position innovation test ratio
* @param mag_ratio Magnetometer innovation test ratio
* @param hagl_ratio Height above terrain innovation test ratio
* @param tas_ratio True airspeed innovation test ratio
2018-08-07 10:12:17 +08:00
* @param pos_horiz_accuracy [m] Horizontal position 1-STD accuracy relative to the EKF local origin
* @param pos_vert_accuracy [m] Vertical position 1-STD accuracy relative to the EKF local origin
2016-04-19 09:03:05 +00:00
*/
# ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
2020-09-20 10:12:24 +08:00
static inline void mavlink_msg_estimator_status_send ( mavlink_channel_t chan , uint32_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 )
2016-04-19 09:03:05 +00:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char buf [ MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ] ;
2020-09-20 10:12:24 +08:00
_mav_put_uint32_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 4 , vel_ratio ) ;
_mav_put_float ( buf , 8 , pos_horiz_ratio ) ;
_mav_put_float ( buf , 12 , pos_vert_ratio ) ;
_mav_put_float ( buf , 16 , mag_ratio ) ;
_mav_put_float ( buf , 20 , hagl_ratio ) ;
_mav_put_float ( buf , 24 , tas_ratio ) ;
_mav_put_float ( buf , 28 , pos_horiz_accuracy ) ;
_mav_put_float ( buf , 32 , pos_vert_accuracy ) ;
_mav_put_uint16_t ( buf , 36 , flags ) ;
2016-04-19 09:03:05 +00:00
2016-05-16 08:33:08 +00:00
_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 ) ;
2016-04-19 09:03:05 +00:00
# else
2016-10-10 10:40:57 +00:00
mavlink_estimator_status_t packet ;
packet . time_usec = time_usec ;
packet . vel_ratio = vel_ratio ;
packet . pos_horiz_ratio = pos_horiz_ratio ;
packet . pos_vert_ratio = pos_vert_ratio ;
packet . mag_ratio = mag_ratio ;
packet . hagl_ratio = hagl_ratio ;
packet . tas_ratio = tas_ratio ;
packet . pos_horiz_accuracy = pos_horiz_accuracy ;
packet . pos_vert_accuracy = pos_vert_accuracy ;
packet . flags = flags ;
2016-04-19 09:03:05 +00:00
2016-05-16 08:33:08 +00:00
_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 ) ;
2016-04-19 09:03:05 +00:00
# endif
2016-05-16 08:33:08 +00:00
}
/**
* @brief Send a estimator_status message
* @param chan MAVLink channel to send the message
* @param struct The MAVLink struct to serialize
*/
static inline void mavlink_msg_estimator_status_send_struct ( mavlink_channel_t chan , const mavlink_estimator_status_t * estimator_status )
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
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 ) ;
# else
_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 ) ;
2016-04-19 09:03:05 +00:00
# endif
}
# if MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN <= MAVLINK_MAX_PAYLOAD_LEN
/*
This varient of _send() can be used to save stack space by re-using
memory from the receive buffer. The caller provides a
mavlink_message_t which is the size of a full mavlink message. This
is usually the receive buffer for the channel, and allows a reply to an
incoming message with minimum stack space usage.
*/
2020-09-20 10:12:24 +08:00
static inline void mavlink_msg_estimator_status_send_buf ( mavlink_message_t * msgbuf , mavlink_channel_t chan , uint32_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 )
2016-04-19 09:03:05 +00:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char * buf = ( char * ) msgbuf ;
2020-09-20 10:12:24 +08:00
_mav_put_uint32_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 4 , vel_ratio ) ;
_mav_put_float ( buf , 8 , pos_horiz_ratio ) ;
_mav_put_float ( buf , 12 , pos_vert_ratio ) ;
_mav_put_float ( buf , 16 , mag_ratio ) ;
_mav_put_float ( buf , 20 , hagl_ratio ) ;
_mav_put_float ( buf , 24 , tas_ratio ) ;
_mav_put_float ( buf , 28 , pos_horiz_accuracy ) ;
_mav_put_float ( buf , 32 , pos_vert_accuracy ) ;
_mav_put_uint16_t ( buf , 36 , flags ) ;
2016-04-19 09:03:05 +00:00
2016-05-16 08:33:08 +00:00
_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 ) ;
2016-04-19 09:03:05 +00:00
# else
2016-10-10 10:40:57 +00:00
mavlink_estimator_status_t * packet = ( mavlink_estimator_status_t * ) msgbuf ;
packet - > time_usec = time_usec ;
packet - > vel_ratio = vel_ratio ;
packet - > pos_horiz_ratio = pos_horiz_ratio ;
packet - > pos_vert_ratio = pos_vert_ratio ;
packet - > mag_ratio = mag_ratio ;
packet - > hagl_ratio = hagl_ratio ;
packet - > tas_ratio = tas_ratio ;
packet - > pos_horiz_accuracy = pos_horiz_accuracy ;
packet - > pos_vert_accuracy = pos_vert_accuracy ;
packet - > flags = flags ;
2016-04-19 09:03:05 +00:00
2016-05-16 08:33:08 +00:00
_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 ) ;
2016-04-19 09:03:05 +00:00
# endif
}
# endif
# endif
// MESSAGE ESTIMATOR_STATUS UNPACKING
/**
* @brief Get field time_usec from estimator_status message
*
2018-08-07 10:12:17 +08:00
* @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 the number.
2016-04-19 09:03:05 +00:00
*/
2020-09-20 10:12:24 +08:00
static inline uint32_t mavlink_msg_estimator_status_get_time_usec ( const mavlink_message_t * msg )
2016-04-19 09:03:05 +00:00
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_uint32_t ( msg , 0 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field flags from estimator_status message
*
2018-08-07 10:12:17 +08:00
* @return Bitmap indicating which EKF outputs are valid.
2016-04-19 09:03:05 +00:00
*/
static inline uint16_t mavlink_msg_estimator_status_get_flags ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_uint16_t ( msg , 36 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field vel_ratio from estimator_status message
*
2018-06-03 17:07:10 +08:00
* @return Velocity innovation test ratio
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_vel_ratio ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 4 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field pos_horiz_ratio from estimator_status message
*
2018-06-03 17:07:10 +08:00
* @return Horizontal position innovation test ratio
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_pos_horiz_ratio ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 8 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field pos_vert_ratio from estimator_status message
*
2018-06-03 17:07:10 +08:00
* @return Vertical position innovation test ratio
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_pos_vert_ratio ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 12 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field mag_ratio from estimator_status message
*
2018-06-03 17:07:10 +08:00
* @return Magnetometer innovation test ratio
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_mag_ratio ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 16 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field hagl_ratio from estimator_status message
*
2018-06-03 17:07:10 +08:00
* @return Height above terrain innovation test ratio
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_hagl_ratio ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 20 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field tas_ratio from estimator_status message
*
2018-06-03 17:07:10 +08:00
* @return True airspeed innovation test ratio
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_tas_ratio ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 24 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field pos_horiz_accuracy from estimator_status message
*
2018-08-07 10:12:17 +08:00
* @return [m] Horizontal position 1-STD accuracy relative to the EKF local origin
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_pos_horiz_accuracy ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 28 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Get field pos_vert_accuracy from estimator_status message
*
2018-08-07 10:12:17 +08:00
* @return [m] Vertical position 1-STD accuracy relative to the EKF local origin
2016-04-19 09:03:05 +00:00
*/
static inline float mavlink_msg_estimator_status_get_pos_vert_accuracy ( const mavlink_message_t * msg )
{
2020-09-20 10:12:24 +08:00
return _MAV_RETURN_float ( msg , 32 ) ;
2016-04-19 09:03:05 +00:00
}
/**
* @brief Decode a estimator_status message into a struct
*
* @param msg The message to decode
* @param estimator_status C-struct to decode the message contents into
*/
static inline void mavlink_msg_estimator_status_decode ( const mavlink_message_t * msg , mavlink_estimator_status_t * estimator_status )
{
2016-05-16 08:33:08 +00:00
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
estimator_status - > time_usec = mavlink_msg_estimator_status_get_time_usec ( msg ) ;
estimator_status - > vel_ratio = mavlink_msg_estimator_status_get_vel_ratio ( msg ) ;
estimator_status - > pos_horiz_ratio = mavlink_msg_estimator_status_get_pos_horiz_ratio ( msg ) ;
estimator_status - > pos_vert_ratio = mavlink_msg_estimator_status_get_pos_vert_ratio ( msg ) ;
estimator_status - > mag_ratio = mavlink_msg_estimator_status_get_mag_ratio ( msg ) ;
estimator_status - > hagl_ratio = mavlink_msg_estimator_status_get_hagl_ratio ( msg ) ;
estimator_status - > tas_ratio = mavlink_msg_estimator_status_get_tas_ratio ( msg ) ;
estimator_status - > pos_horiz_accuracy = mavlink_msg_estimator_status_get_pos_horiz_accuracy ( msg ) ;
estimator_status - > pos_vert_accuracy = mavlink_msg_estimator_status_get_pos_vert_accuracy ( msg ) ;
estimator_status - > flags = mavlink_msg_estimator_status_get_flags ( msg ) ;
2016-04-19 09:03:05 +00:00
# else
2016-05-16 08:33:08 +00:00
uint8_t len = msg - > len < MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ? msg - > len : MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ;
memset ( estimator_status , 0 , MAVLINK_MSG_ID_ESTIMATOR_STATUS_LEN ) ;
2016-10-10 10:40:57 +00:00
memcpy ( estimator_status , _MAV_PAYLOAD ( msg ) , len ) ;
2016-04-19 09:03:05 +00:00
# endif
}