2016-10-05 22:52:07 +00:00
# pragma once
2014-08-10 21:01:07 +02:00
// MESSAGE LOCAL_POSITION_NED_COV PACKING
# define MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV 64
2016-08-02 12:16:40 +00:00
MAVPACKED (
typedef struct __mavlink_local_position_ned_cov_t {
2018-08-07 10:12:17 +08:00
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 the number.*/
2018-06-03 17:07:10 +08:00
float x ; /*< [m] X Position*/
float y ; /*< [m] Y Position*/
float z ; /*< [m] Z Position*/
2018-08-07 10:12:17 +08:00
float vx ; /*< [m/s] X Speed*/
float vy ; /*< [m/s] Y Speed*/
float vz ; /*< [m/s] Z Speed*/
float ax ; /*< [m/s/s] X Acceleration*/
float ay ; /*< [m/s/s] Y Acceleration*/
float az ; /*< [m/s/s] Z Acceleration*/
2018-06-03 17:07:10 +08:00
float covariance [ 45 ] ; /*< Covariance matrix upper right triangular (first nine entries are the first ROW, next eight entries are the second row, etc.)*/
uint8_t estimator_type ; /*< Class id of the estimator this estimate originated from.*/
2016-08-02 12:16:40 +00:00
} ) mavlink_local_position_ned_cov_t ;
2014-08-10 21:01:07 +02:00
2016-11-17 07:17:41 +00:00
# define MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN 225
# define MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN 225
# define MAVLINK_MSG_ID_64_LEN 225
# define MAVLINK_MSG_ID_64_MIN_LEN 225
2014-08-10 21:01:07 +02:00
2016-11-17 07:17:41 +00:00
# define MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC 191
# define MAVLINK_MSG_ID_64_CRC 191
2014-08-10 21:01:07 +02:00
2015-04-15 16:53:57 +00:00
# define MAVLINK_MSG_LOCAL_POSITION_NED_COV_FIELD_COVARIANCE_LEN 45
2014-08-10 21:01:07 +02:00
2016-05-16 08:33:08 +00:00
# if MAVLINK_COMMAND_24BIT
2014-08-10 21:01:07 +02:00
# define MAVLINK_MESSAGE_INFO_LOCAL_POSITION_NED_COV { \
2016-10-10 10:40:57 +00:00
64, \
"LOCAL_POSITION_NED_COV", \
2016-11-17 07:17:41 +00:00
12, \
{ { "time_usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_local_position_ned_cov_t, time_usec) }, \
2017-09-11 17:32:44 +08:00
{ "estimator_type", NULL, MAVLINK_TYPE_UINT8_T, 0, 224, offsetof(mavlink_local_position_ned_cov_t, estimator_type) }, \
2016-11-17 07:17:41 +00:00
{ "x", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_local_position_ned_cov_t, x) }, \
{ "y", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_local_position_ned_cov_t, y) }, \
{ "z", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_local_position_ned_cov_t, z) }, \
{ "vx", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_local_position_ned_cov_t, vx) }, \
{ "vy", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_local_position_ned_cov_t, vy) }, \
{ "vz", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_local_position_ned_cov_t, vz) }, \
{ "ax", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_local_position_ned_cov_t, ax) }, \
{ "ay", NULL, MAVLINK_TYPE_FLOAT, 0, 36, offsetof(mavlink_local_position_ned_cov_t, ay) }, \
{ "az", NULL, MAVLINK_TYPE_FLOAT, 0, 40, offsetof(mavlink_local_position_ned_cov_t, az) }, \
{ "covariance", NULL, MAVLINK_TYPE_FLOAT, 45, 44, offsetof(mavlink_local_position_ned_cov_t, covariance) }, \
2014-08-10 21:01:07 +02:00
} \
}
2016-05-16 08:33:08 +00:00
# else
# define MAVLINK_MESSAGE_INFO_LOCAL_POSITION_NED_COV { \
2016-10-10 10:40:57 +00:00
"LOCAL_POSITION_NED_COV", \
2016-11-17 07:17:41 +00:00
12, \
{ { "time_usec", NULL, MAVLINK_TYPE_UINT64_T, 0, 0, offsetof(mavlink_local_position_ned_cov_t, time_usec) }, \
2017-09-11 17:32:44 +08:00
{ "estimator_type", NULL, MAVLINK_TYPE_UINT8_T, 0, 224, offsetof(mavlink_local_position_ned_cov_t, estimator_type) }, \
2016-11-17 07:17:41 +00:00
{ "x", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_local_position_ned_cov_t, x) }, \
{ "y", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_local_position_ned_cov_t, y) }, \
{ "z", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_local_position_ned_cov_t, z) }, \
{ "vx", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_local_position_ned_cov_t, vx) }, \
{ "vy", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_local_position_ned_cov_t, vy) }, \
{ "vz", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_local_position_ned_cov_t, vz) }, \
{ "ax", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_local_position_ned_cov_t, ax) }, \
{ "ay", NULL, MAVLINK_TYPE_FLOAT, 0, 36, offsetof(mavlink_local_position_ned_cov_t, ay) }, \
{ "az", NULL, MAVLINK_TYPE_FLOAT, 0, 40, offsetof(mavlink_local_position_ned_cov_t, az) }, \
{ "covariance", NULL, MAVLINK_TYPE_FLOAT, 45, 44, offsetof(mavlink_local_position_ned_cov_t, covariance) }, \
2016-05-16 08:33:08 +00:00
} \
}
# endif
2014-08-10 21:01:07 +02:00
/**
* @brief Pack a local_position_ned_cov 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.
2018-06-03 17:07:10 +08:00
* @param estimator_type Class id of the estimator this estimate originated from.
* @param x [m] X Position
* @param y [m] Y Position
* @param z [m] Z Position
2018-08-07 10:12:17 +08:00
* @param vx [m/s] X Speed
* @param vy [m/s] Y Speed
* @param vz [m/s] Z Speed
* @param ax [m/s/s] X Acceleration
* @param ay [m/s/s] Y Acceleration
* @param az [m/s/s] Z Acceleration
2018-06-03 17:07:10 +08:00
* @param covariance Covariance matrix upper right triangular (first nine entries are the first ROW, next eight entries are the second row, etc.)
2014-08-10 21:01:07 +02:00
* @return length of the message in bytes (excluding serial stream start sign)
*/
static inline uint16_t mavlink_msg_local_position_ned_cov_pack ( uint8_t system_id , uint8_t component_id , mavlink_message_t * msg ,
2016-11-17 07:17:41 +00:00
uint64_t time_usec , uint8_t estimator_type , float x , float y , float z , float vx , float vy , float vz , float ax , float ay , float az , const float * covariance )
2014-08-10 21:01:07 +02:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char buf [ MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ] ;
2016-11-17 07:17:41 +00:00
_mav_put_uint64_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 8 , x ) ;
_mav_put_float ( buf , 12 , y ) ;
_mav_put_float ( buf , 16 , z ) ;
_mav_put_float ( buf , 20 , vx ) ;
_mav_put_float ( buf , 24 , vy ) ;
_mav_put_float ( buf , 28 , vz ) ;
_mav_put_float ( buf , 32 , ax ) ;
_mav_put_float ( buf , 36 , ay ) ;
_mav_put_float ( buf , 40 , az ) ;
_mav_put_uint8_t ( buf , 224 , estimator_type ) ;
_mav_put_float_array ( buf , 44 , covariance , 45 ) ;
2014-08-10 21:01:07 +02:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , buf , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ) ;
# else
2016-10-10 10:40:57 +00:00
mavlink_local_position_ned_cov_t packet ;
2016-11-17 07:17:41 +00:00
packet . time_usec = time_usec ;
2016-10-10 10:40:57 +00:00
packet . x = x ;
packet . y = y ;
packet . z = z ;
packet . vx = vx ;
packet . vy = vy ;
packet . vz = vz ;
packet . ax = ax ;
packet . ay = ay ;
packet . az = az ;
packet . estimator_type = estimator_type ;
mav_array_memcpy ( packet . covariance , covariance , sizeof ( float ) * 45 ) ;
2014-08-10 21:01:07 +02:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , & packet , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ) ;
# endif
2016-10-10 10:40:57 +00:00
msg - > msgid = MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV ;
2016-05-16 08:33:08 +00:00
return mavlink_finalize_message ( msg , system_id , component_id , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Pack a local_position_ned_cov 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.
2018-06-03 17:07:10 +08:00
* @param estimator_type Class id of the estimator this estimate originated from.
* @param x [m] X Position
* @param y [m] Y Position
* @param z [m] Z Position
2018-08-07 10:12:17 +08:00
* @param vx [m/s] X Speed
* @param vy [m/s] Y Speed
* @param vz [m/s] Z Speed
* @param ax [m/s/s] X Acceleration
* @param ay [m/s/s] Y Acceleration
* @param az [m/s/s] Z Acceleration
2018-06-03 17:07:10 +08:00
* @param covariance Covariance matrix upper right triangular (first nine entries are the first ROW, next eight entries are the second row, etc.)
2014-08-10 21:01:07 +02:00
* @return length of the message in bytes (excluding serial stream start sign)
*/
static inline uint16_t mavlink_msg_local_position_ned_cov_pack_chan ( uint8_t system_id , uint8_t component_id , uint8_t chan ,
2016-10-10 10:40:57 +00:00
mavlink_message_t * msg ,
2016-11-17 07:17:41 +00:00
uint64_t time_usec , uint8_t estimator_type , float x , float y , float z , float vx , float vy , float vz , float ax , float ay , float az , const float * covariance )
2014-08-10 21:01:07 +02:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char buf [ MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ] ;
2016-11-17 07:17:41 +00:00
_mav_put_uint64_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 8 , x ) ;
_mav_put_float ( buf , 12 , y ) ;
_mav_put_float ( buf , 16 , z ) ;
_mav_put_float ( buf , 20 , vx ) ;
_mav_put_float ( buf , 24 , vy ) ;
_mav_put_float ( buf , 28 , vz ) ;
_mav_put_float ( buf , 32 , ax ) ;
_mav_put_float ( buf , 36 , ay ) ;
_mav_put_float ( buf , 40 , az ) ;
_mav_put_uint8_t ( buf , 224 , estimator_type ) ;
_mav_put_float_array ( buf , 44 , covariance , 45 ) ;
2014-08-10 21:01:07 +02:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , buf , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ) ;
# else
2016-10-10 10:40:57 +00:00
mavlink_local_position_ned_cov_t packet ;
2016-11-17 07:17:41 +00:00
packet . time_usec = time_usec ;
2016-10-10 10:40:57 +00:00
packet . x = x ;
packet . y = y ;
packet . z = z ;
packet . vx = vx ;
packet . vy = vy ;
packet . vz = vz ;
packet . ax = ax ;
packet . ay = ay ;
packet . az = az ;
packet . estimator_type = estimator_type ;
mav_array_memcpy ( packet . covariance , covariance , sizeof ( float ) * 45 ) ;
2014-08-10 21:01:07 +02:00
memcpy ( _MAV_PAYLOAD_NON_CONST ( msg ) , & packet , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ) ;
# endif
2016-10-10 10:40:57 +00:00
msg - > msgid = MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV ;
2016-05-16 08:33:08 +00:00
return mavlink_finalize_message_chan ( msg , system_id , component_id , chan , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Encode a local_position_ned_cov 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 local_position_ned_cov C-struct to read the message contents from
*/
static inline uint16_t mavlink_msg_local_position_ned_cov_encode ( uint8_t system_id , uint8_t component_id , mavlink_message_t * msg , const mavlink_local_position_ned_cov_t * local_position_ned_cov )
{
2016-11-17 07:17:41 +00:00
return mavlink_msg_local_position_ned_cov_pack ( system_id , component_id , msg , local_position_ned_cov - > time_usec , local_position_ned_cov - > estimator_type , local_position_ned_cov - > x , local_position_ned_cov - > y , local_position_ned_cov - > z , local_position_ned_cov - > vx , local_position_ned_cov - > vy , local_position_ned_cov - > vz , local_position_ned_cov - > ax , local_position_ned_cov - > ay , local_position_ned_cov - > az , local_position_ned_cov - > covariance ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Encode a local_position_ned_cov 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 local_position_ned_cov C-struct to read the message contents from
*/
static inline uint16_t mavlink_msg_local_position_ned_cov_encode_chan ( uint8_t system_id , uint8_t component_id , uint8_t chan , mavlink_message_t * msg , const mavlink_local_position_ned_cov_t * local_position_ned_cov )
{
2016-11-17 07:17:41 +00:00
return mavlink_msg_local_position_ned_cov_pack_chan ( system_id , component_id , chan , msg , local_position_ned_cov - > time_usec , local_position_ned_cov - > estimator_type , local_position_ned_cov - > x , local_position_ned_cov - > y , local_position_ned_cov - > z , local_position_ned_cov - > vx , local_position_ned_cov - > vy , local_position_ned_cov - > vz , local_position_ned_cov - > ax , local_position_ned_cov - > ay , local_position_ned_cov - > az , local_position_ned_cov - > covariance ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Send a local_position_ned_cov 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.
2018-06-03 17:07:10 +08:00
* @param estimator_type Class id of the estimator this estimate originated from.
* @param x [m] X Position
* @param y [m] Y Position
* @param z [m] Z Position
2018-08-07 10:12:17 +08:00
* @param vx [m/s] X Speed
* @param vy [m/s] Y Speed
* @param vz [m/s] Z Speed
* @param ax [m/s/s] X Acceleration
* @param ay [m/s/s] Y Acceleration
* @param az [m/s/s] Z Acceleration
2018-06-03 17:07:10 +08:00
* @param covariance Covariance matrix upper right triangular (first nine entries are the first ROW, next eight entries are the second row, etc.)
2014-08-10 21:01:07 +02:00
*/
# ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
2016-11-17 07:17:41 +00:00
static inline void mavlink_msg_local_position_ned_cov_send ( mavlink_channel_t chan , uint64_t time_usec , uint8_t estimator_type , float x , float y , float z , float vx , float vy , float vz , float ax , float ay , float az , const float * covariance )
2014-08-10 21:01:07 +02:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char buf [ MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ] ;
2016-11-17 07:17:41 +00:00
_mav_put_uint64_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 8 , x ) ;
_mav_put_float ( buf , 12 , y ) ;
_mav_put_float ( buf , 16 , z ) ;
_mav_put_float ( buf , 20 , vx ) ;
_mav_put_float ( buf , 24 , vy ) ;
_mav_put_float ( buf , 28 , vz ) ;
_mav_put_float ( buf , 32 , ax ) ;
_mav_put_float ( buf , 36 , ay ) ;
_mav_put_float ( buf , 40 , az ) ;
_mav_put_uint8_t ( buf , 224 , estimator_type ) ;
_mav_put_float_array ( buf , 44 , covariance , 45 ) ;
2016-05-16 08:33:08 +00:00
_mav_finalize_message_chan_send ( chan , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV , buf , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC ) ;
2014-08-10 21:01:07 +02:00
# else
2016-10-10 10:40:57 +00:00
mavlink_local_position_ned_cov_t packet ;
2016-11-17 07:17:41 +00:00
packet . time_usec = time_usec ;
2016-10-10 10:40:57 +00:00
packet . x = x ;
packet . y = y ;
packet . z = z ;
packet . vx = vx ;
packet . vy = vy ;
packet . vz = vz ;
packet . ax = ax ;
packet . ay = ay ;
packet . az = az ;
packet . estimator_type = estimator_type ;
mav_array_memcpy ( packet . covariance , covariance , sizeof ( float ) * 45 ) ;
2016-05-16 08:33:08 +00:00
_mav_finalize_message_chan_send ( chan , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV , ( const char * ) & packet , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC ) ;
2014-08-10 21:01:07 +02:00
# endif
2016-05-16 08:33:08 +00:00
}
/**
* @brief Send a local_position_ned_cov message
* @param chan MAVLink channel to send the message
* @param struct The MAVLink struct to serialize
*/
static inline void mavlink_msg_local_position_ned_cov_send_struct ( mavlink_channel_t chan , const mavlink_local_position_ned_cov_t * local_position_ned_cov )
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-11-17 07:17:41 +00:00
mavlink_msg_local_position_ned_cov_send ( chan , local_position_ned_cov - > time_usec , local_position_ned_cov - > estimator_type , local_position_ned_cov - > x , local_position_ned_cov - > y , local_position_ned_cov - > z , local_position_ned_cov - > vx , local_position_ned_cov - > vy , local_position_ned_cov - > vz , local_position_ned_cov - > ax , local_position_ned_cov - > ay , local_position_ned_cov - > az , local_position_ned_cov - > covariance ) ;
2016-05-16 08:33:08 +00:00
# else
_mav_finalize_message_chan_send ( chan , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV , ( const char * ) local_position_ned_cov , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC ) ;
2014-08-10 21:01:07 +02:00
# endif
}
# if MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_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.
*/
2016-11-17 07:17:41 +00:00
static inline void mavlink_msg_local_position_ned_cov_send_buf ( mavlink_message_t * msgbuf , mavlink_channel_t chan , uint64_t time_usec , uint8_t estimator_type , float x , float y , float z , float vx , float vy , float vz , float ax , float ay , float az , const float * covariance )
2014-08-10 21:01:07 +02:00
{
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-10-10 10:40:57 +00:00
char * buf = ( char * ) msgbuf ;
2016-11-17 07:17:41 +00:00
_mav_put_uint64_t ( buf , 0 , time_usec ) ;
_mav_put_float ( buf , 8 , x ) ;
_mav_put_float ( buf , 12 , y ) ;
_mav_put_float ( buf , 16 , z ) ;
_mav_put_float ( buf , 20 , vx ) ;
_mav_put_float ( buf , 24 , vy ) ;
_mav_put_float ( buf , 28 , vz ) ;
_mav_put_float ( buf , 32 , ax ) ;
_mav_put_float ( buf , 36 , ay ) ;
_mav_put_float ( buf , 40 , az ) ;
_mav_put_uint8_t ( buf , 224 , estimator_type ) ;
_mav_put_float_array ( buf , 44 , covariance , 45 ) ;
2016-05-16 08:33:08 +00:00
_mav_finalize_message_chan_send ( chan , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV , buf , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC ) ;
2014-08-10 21:01:07 +02:00
# else
2016-10-10 10:40:57 +00:00
mavlink_local_position_ned_cov_t * packet = ( mavlink_local_position_ned_cov_t * ) msgbuf ;
2016-11-17 07:17:41 +00:00
packet - > time_usec = time_usec ;
2016-10-10 10:40:57 +00:00
packet - > x = x ;
packet - > y = y ;
packet - > z = z ;
packet - > vx = vx ;
packet - > vy = vy ;
packet - > vz = vz ;
packet - > ax = ax ;
packet - > ay = ay ;
packet - > az = az ;
packet - > estimator_type = estimator_type ;
mav_array_memcpy ( packet - > covariance , covariance , sizeof ( float ) * 45 ) ;
2016-05-16 08:33:08 +00:00
_mav_finalize_message_chan_send ( chan , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV , ( const char * ) packet , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_CRC ) ;
2014-08-10 21:01:07 +02:00
# endif
}
# endif
# endif
// MESSAGE LOCAL_POSITION_NED_COV UNPACKING
/**
2016-11-17 07:17:41 +00:00
* @brief Get field time_usec from local_position_ned_cov message
2014-08-10 21:01:07 +02:00
*
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.
2014-08-10 21:01:07 +02:00
*/
2016-11-17 07:17:41 +00:00
static inline uint64_t mavlink_msg_local_position_ned_cov_get_time_usec ( const mavlink_message_t * msg )
2014-08-10 21:01:07 +02:00
{
2016-10-10 10:40:57 +00:00
return _MAV_RETURN_uint64_t ( msg , 0 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Get field estimator_type from local_position_ned_cov message
*
2018-06-03 17:07:10 +08:00
* @return Class id of the estimator this estimate originated from.
2014-08-10 21:01:07 +02:00
*/
static inline uint8_t mavlink_msg_local_position_ned_cov_get_estimator_type ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_uint8_t ( msg , 224 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Get field x from local_position_ned_cov message
*
2018-06-03 17:07:10 +08:00
* @return [m] X Position
2014-08-10 21:01:07 +02:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_x ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 8 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Get field y from local_position_ned_cov message
*
2018-06-03 17:07:10 +08:00
* @return [m] Y Position
2014-08-10 21:01:07 +02:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_y ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 12 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Get field z from local_position_ned_cov message
*
2018-06-03 17:07:10 +08:00
* @return [m] Z Position
2014-08-10 21:01:07 +02:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_z ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 16 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Get field vx from local_position_ned_cov message
*
2018-08-07 10:12:17 +08:00
* @return [m/s] X Speed
2014-08-10 21:01:07 +02:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_vx ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 20 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Get field vy from local_position_ned_cov message
*
2018-08-07 10:12:17 +08:00
* @return [m/s] Y Speed
2014-08-10 21:01:07 +02:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_vy ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 24 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Get field vz from local_position_ned_cov message
*
2018-08-07 10:12:17 +08:00
* @return [m/s] Z Speed
2014-08-10 21:01:07 +02:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_vz ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 28 ) ;
2014-08-10 21:01:07 +02:00
}
2015-04-15 16:53:57 +00:00
/**
* @brief Get field ax from local_position_ned_cov message
*
2018-08-07 10:12:17 +08:00
* @return [m/s/s] X Acceleration
2015-04-15 16:53:57 +00:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_ax ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 32 ) ;
2015-04-15 16:53:57 +00:00
}
/**
* @brief Get field ay from local_position_ned_cov message
*
2018-08-07 10:12:17 +08:00
* @return [m/s/s] Y Acceleration
2015-04-15 16:53:57 +00:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_ay ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 36 ) ;
2015-04-15 16:53:57 +00:00
}
/**
* @brief Get field az from local_position_ned_cov message
*
2018-08-07 10:12:17 +08:00
* @return [m/s/s] Z Acceleration
2015-04-15 16:53:57 +00:00
*/
static inline float mavlink_msg_local_position_ned_cov_get_az ( const mavlink_message_t * msg )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float ( msg , 40 ) ;
2015-04-15 16:53:57 +00:00
}
2014-08-10 21:01:07 +02:00
/**
* @brief Get field covariance from local_position_ned_cov message
*
2018-06-03 17:07:10 +08:00
* @return Covariance matrix upper right triangular (first nine entries are the first ROW, next eight entries are the second row, etc.)
2014-08-10 21:01:07 +02:00
*/
static inline uint16_t mavlink_msg_local_position_ned_cov_get_covariance ( const mavlink_message_t * msg , float * covariance )
{
2016-11-17 07:17:41 +00:00
return _MAV_RETURN_float_array ( msg , covariance , 45 , 44 ) ;
2014-08-10 21:01:07 +02:00
}
/**
* @brief Decode a local_position_ned_cov message into a struct
*
* @param msg The message to decode
* @param local_position_ned_cov C-struct to decode the message contents into
*/
static inline void mavlink_msg_local_position_ned_cov_decode ( const mavlink_message_t * msg , mavlink_local_position_ned_cov_t * local_position_ned_cov )
{
2016-05-16 08:33:08 +00:00
# if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
2016-11-17 07:17:41 +00:00
local_position_ned_cov - > time_usec = mavlink_msg_local_position_ned_cov_get_time_usec ( msg ) ;
2016-10-10 10:40:57 +00:00
local_position_ned_cov - > x = mavlink_msg_local_position_ned_cov_get_x ( msg ) ;
local_position_ned_cov - > y = mavlink_msg_local_position_ned_cov_get_y ( msg ) ;
local_position_ned_cov - > z = mavlink_msg_local_position_ned_cov_get_z ( msg ) ;
local_position_ned_cov - > vx = mavlink_msg_local_position_ned_cov_get_vx ( msg ) ;
local_position_ned_cov - > vy = mavlink_msg_local_position_ned_cov_get_vy ( msg ) ;
local_position_ned_cov - > vz = mavlink_msg_local_position_ned_cov_get_vz ( msg ) ;
local_position_ned_cov - > ax = mavlink_msg_local_position_ned_cov_get_ax ( msg ) ;
local_position_ned_cov - > ay = mavlink_msg_local_position_ned_cov_get_ay ( msg ) ;
local_position_ned_cov - > az = mavlink_msg_local_position_ned_cov_get_az ( msg ) ;
mavlink_msg_local_position_ned_cov_get_covariance ( msg , local_position_ned_cov - > covariance ) ;
local_position_ned_cov - > estimator_type = mavlink_msg_local_position_ned_cov_get_estimator_type ( msg ) ;
2014-08-10 21:01:07 +02:00
# else
2016-05-16 08:33:08 +00:00
uint8_t len = msg - > len < MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ? msg - > len : MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ;
memset ( local_position_ned_cov , 0 , MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_LEN ) ;
2016-10-10 10:40:57 +00:00
memcpy ( local_position_ned_cov , _MAV_PAYLOAD ( msg ) , len ) ;
2014-08-10 21:01:07 +02:00
# endif
}