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 13:56:18 +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 of 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
*
2020-09-20 13:56:18 +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 of the number.
2018-08-07 10:12:17 +08:00
* @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
2020-09-20 13:56:18 +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 of the number.
2018-08-07 10:12:17 +08:00
* @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
*
2020-09-20 13:56:18 +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 of the number.
2018-08-07 10:12:17 +08:00
* @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
*
2020-09-20 13:56:18 +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 of 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
}