This commit is contained in:
PX4BuildBot
2015-04-06 23:38:57 +00:00
parent b982d9aa1c
commit d853aab575
14 changed files with 236 additions and 311 deletions
+39 -111
View File
@@ -1,38 +1,32 @@
// MESSAGE GIMBAL_CONTROL PACKING
#define MAVLINK_MSG_ID_GIMBAL_CONTROL 185
#define MAVLINK_MSG_ID_GIMBAL_CONTROL 201
typedef struct __mavlink_gimbal_control_t
{
float demanded_rate_x; ///< Demanded angular rate X, radians/s
float demanded_rate_y; ///< Demanded angular rate Y, radians/s
float demanded_rate_z; ///< Demanded angular rate Z, radians/s
float gyro_bias_x; ///< Gyro bias X, radians/s
float gyro_bias_y; ///< Gyro bias Y, radians/s
float gyro_bias_z; ///< Gyro bias Z, radians/s
float demanded_rate_x; ///< Demanded angular rate X (rad/s)
float demanded_rate_y; ///< Demanded angular rate Y (rad/s)
float demanded_rate_z; ///< Demanded angular rate Z (rad/s)
uint8_t target_system; ///< System ID
uint8_t target_component; ///< Component ID
} mavlink_gimbal_control_t;
#define MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN 26
#define MAVLINK_MSG_ID_185_LEN 26
#define MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN 14
#define MAVLINK_MSG_ID_201_LEN 14
#define MAVLINK_MSG_ID_GIMBAL_CONTROL_CRC 239
#define MAVLINK_MSG_ID_185_CRC 239
#define MAVLINK_MSG_ID_GIMBAL_CONTROL_CRC 205
#define MAVLINK_MSG_ID_201_CRC 205
#define MAVLINK_MESSAGE_INFO_GIMBAL_CONTROL { \
"GIMBAL_CONTROL", \
8, \
5, \
{ { "demanded_rate_x", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_gimbal_control_t, demanded_rate_x) }, \
{ "demanded_rate_y", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_gimbal_control_t, demanded_rate_y) }, \
{ "demanded_rate_z", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_gimbal_control_t, demanded_rate_z) }, \
{ "gyro_bias_x", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_gimbal_control_t, gyro_bias_x) }, \
{ "gyro_bias_y", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_gimbal_control_t, gyro_bias_y) }, \
{ "gyro_bias_z", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_gimbal_control_t, gyro_bias_z) }, \
{ "target_system", NULL, MAVLINK_TYPE_UINT8_T, 0, 24, offsetof(mavlink_gimbal_control_t, target_system) }, \
{ "target_component", NULL, MAVLINK_TYPE_UINT8_T, 0, 25, offsetof(mavlink_gimbal_control_t, target_component) }, \
{ "target_system", NULL, MAVLINK_TYPE_UINT8_T, 0, 12, offsetof(mavlink_gimbal_control_t, target_system) }, \
{ "target_component", NULL, MAVLINK_TYPE_UINT8_T, 0, 13, offsetof(mavlink_gimbal_control_t, target_component) }, \
} \
}
@@ -45,27 +39,21 @@ typedef struct __mavlink_gimbal_control_t
*
* @param target_system System ID
* @param target_component Component ID
* @param demanded_rate_x Demanded angular rate X, radians/s
* @param demanded_rate_y Demanded angular rate Y, radians/s
* @param demanded_rate_z Demanded angular rate Z, radians/s
* @param gyro_bias_x Gyro bias X, radians/s
* @param gyro_bias_y Gyro bias Y, radians/s
* @param gyro_bias_z Gyro bias Z, radians/s
* @param demanded_rate_x Demanded angular rate X (rad/s)
* @param demanded_rate_y Demanded angular rate Y (rad/s)
* @param demanded_rate_z Demanded angular rate Z (rad/s)
* @return length of the message in bytes (excluding serial stream start sign)
*/
static inline uint16_t mavlink_msg_gimbal_control_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
uint8_t target_system, uint8_t target_component, float demanded_rate_x, float demanded_rate_y, float demanded_rate_z, float gyro_bias_x, float gyro_bias_y, float gyro_bias_z)
uint8_t target_system, uint8_t target_component, float demanded_rate_x, float demanded_rate_y, float demanded_rate_z)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
char buf[MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN];
_mav_put_float(buf, 0, demanded_rate_x);
_mav_put_float(buf, 4, demanded_rate_y);
_mav_put_float(buf, 8, demanded_rate_z);
_mav_put_float(buf, 12, gyro_bias_x);
_mav_put_float(buf, 16, gyro_bias_y);
_mav_put_float(buf, 20, gyro_bias_z);
_mav_put_uint8_t(buf, 24, target_system);
_mav_put_uint8_t(buf, 25, target_component);
_mav_put_uint8_t(buf, 12, target_system);
_mav_put_uint8_t(buf, 13, target_component);
memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN);
#else
@@ -73,9 +61,6 @@ static inline uint16_t mavlink_msg_gimbal_control_pack(uint8_t system_id, uint8_
packet.demanded_rate_x = demanded_rate_x;
packet.demanded_rate_y = demanded_rate_y;
packet.demanded_rate_z = demanded_rate_z;
packet.gyro_bias_x = gyro_bias_x;
packet.gyro_bias_y = gyro_bias_y;
packet.gyro_bias_z = gyro_bias_z;
packet.target_system = target_system;
packet.target_component = target_component;
@@ -98,28 +83,22 @@ static inline uint16_t mavlink_msg_gimbal_control_pack(uint8_t system_id, uint8_
* @param msg The MAVLink message to compress the data into
* @param target_system System ID
* @param target_component Component ID
* @param demanded_rate_x Demanded angular rate X, radians/s
* @param demanded_rate_y Demanded angular rate Y, radians/s
* @param demanded_rate_z Demanded angular rate Z, radians/s
* @param gyro_bias_x Gyro bias X, radians/s
* @param gyro_bias_y Gyro bias Y, radians/s
* @param gyro_bias_z Gyro bias Z, radians/s
* @param demanded_rate_x Demanded angular rate X (rad/s)
* @param demanded_rate_y Demanded angular rate Y (rad/s)
* @param demanded_rate_z Demanded angular rate Z (rad/s)
* @return length of the message in bytes (excluding serial stream start sign)
*/
static inline uint16_t mavlink_msg_gimbal_control_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
mavlink_message_t* msg,
uint8_t target_system,uint8_t target_component,float demanded_rate_x,float demanded_rate_y,float demanded_rate_z,float gyro_bias_x,float gyro_bias_y,float gyro_bias_z)
uint8_t target_system,uint8_t target_component,float demanded_rate_x,float demanded_rate_y,float demanded_rate_z)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
char buf[MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN];
_mav_put_float(buf, 0, demanded_rate_x);
_mav_put_float(buf, 4, demanded_rate_y);
_mav_put_float(buf, 8, demanded_rate_z);
_mav_put_float(buf, 12, gyro_bias_x);
_mav_put_float(buf, 16, gyro_bias_y);
_mav_put_float(buf, 20, gyro_bias_z);
_mav_put_uint8_t(buf, 24, target_system);
_mav_put_uint8_t(buf, 25, target_component);
_mav_put_uint8_t(buf, 12, target_system);
_mav_put_uint8_t(buf, 13, target_component);
memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN);
#else
@@ -127,9 +106,6 @@ static inline uint16_t mavlink_msg_gimbal_control_pack_chan(uint8_t system_id, u
packet.demanded_rate_x = demanded_rate_x;
packet.demanded_rate_y = demanded_rate_y;
packet.demanded_rate_z = demanded_rate_z;
packet.gyro_bias_x = gyro_bias_x;
packet.gyro_bias_y = gyro_bias_y;
packet.gyro_bias_z = gyro_bias_z;
packet.target_system = target_system;
packet.target_component = target_component;
@@ -154,7 +130,7 @@ static inline uint16_t mavlink_msg_gimbal_control_pack_chan(uint8_t system_id, u
*/
static inline uint16_t mavlink_msg_gimbal_control_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_gimbal_control_t* gimbal_control)
{
return mavlink_msg_gimbal_control_pack(system_id, component_id, msg, gimbal_control->target_system, gimbal_control->target_component, gimbal_control->demanded_rate_x, gimbal_control->demanded_rate_y, gimbal_control->demanded_rate_z, gimbal_control->gyro_bias_x, gimbal_control->gyro_bias_y, gimbal_control->gyro_bias_z);
return mavlink_msg_gimbal_control_pack(system_id, component_id, msg, gimbal_control->target_system, gimbal_control->target_component, gimbal_control->demanded_rate_x, gimbal_control->demanded_rate_y, gimbal_control->demanded_rate_z);
}
/**
@@ -168,7 +144,7 @@ static inline uint16_t mavlink_msg_gimbal_control_encode(uint8_t system_id, uint
*/
static inline uint16_t mavlink_msg_gimbal_control_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_gimbal_control_t* gimbal_control)
{
return mavlink_msg_gimbal_control_pack_chan(system_id, component_id, chan, msg, gimbal_control->target_system, gimbal_control->target_component, gimbal_control->demanded_rate_x, gimbal_control->demanded_rate_y, gimbal_control->demanded_rate_z, gimbal_control->gyro_bias_x, gimbal_control->gyro_bias_y, gimbal_control->gyro_bias_z);
return mavlink_msg_gimbal_control_pack_chan(system_id, component_id, chan, msg, gimbal_control->target_system, gimbal_control->target_component, gimbal_control->demanded_rate_x, gimbal_control->demanded_rate_y, gimbal_control->demanded_rate_z);
}
/**
@@ -177,27 +153,21 @@ static inline uint16_t mavlink_msg_gimbal_control_encode_chan(uint8_t system_id,
*
* @param target_system System ID
* @param target_component Component ID
* @param demanded_rate_x Demanded angular rate X, radians/s
* @param demanded_rate_y Demanded angular rate Y, radians/s
* @param demanded_rate_z Demanded angular rate Z, radians/s
* @param gyro_bias_x Gyro bias X, radians/s
* @param gyro_bias_y Gyro bias Y, radians/s
* @param gyro_bias_z Gyro bias Z, radians/s
* @param demanded_rate_x Demanded angular rate X (rad/s)
* @param demanded_rate_y Demanded angular rate Y (rad/s)
* @param demanded_rate_z Demanded angular rate Z (rad/s)
*/
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
static inline void mavlink_msg_gimbal_control_send(mavlink_channel_t chan, uint8_t target_system, uint8_t target_component, float demanded_rate_x, float demanded_rate_y, float demanded_rate_z, float gyro_bias_x, float gyro_bias_y, float gyro_bias_z)
static inline void mavlink_msg_gimbal_control_send(mavlink_channel_t chan, uint8_t target_system, uint8_t target_component, float demanded_rate_x, float demanded_rate_y, float demanded_rate_z)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
char buf[MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN];
_mav_put_float(buf, 0, demanded_rate_x);
_mav_put_float(buf, 4, demanded_rate_y);
_mav_put_float(buf, 8, demanded_rate_z);
_mav_put_float(buf, 12, gyro_bias_x);
_mav_put_float(buf, 16, gyro_bias_y);
_mav_put_float(buf, 20, gyro_bias_z);
_mav_put_uint8_t(buf, 24, target_system);
_mav_put_uint8_t(buf, 25, target_component);
_mav_put_uint8_t(buf, 12, target_system);
_mav_put_uint8_t(buf, 13, target_component);
#if MAVLINK_CRC_EXTRA
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_GIMBAL_CONTROL, buf, MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN, MAVLINK_MSG_ID_GIMBAL_CONTROL_CRC);
@@ -209,9 +179,6 @@ static inline void mavlink_msg_gimbal_control_send(mavlink_channel_t chan, uint8
packet.demanded_rate_x = demanded_rate_x;
packet.demanded_rate_y = demanded_rate_y;
packet.demanded_rate_z = demanded_rate_z;
packet.gyro_bias_x = gyro_bias_x;
packet.gyro_bias_y = gyro_bias_y;
packet.gyro_bias_z = gyro_bias_z;
packet.target_system = target_system;
packet.target_component = target_component;
@@ -231,18 +198,15 @@ static inline void mavlink_msg_gimbal_control_send(mavlink_channel_t chan, uint8
is usually the receive buffer for the channel, and allows a reply to an
incoming message with minimum stack space usage.
*/
static inline void mavlink_msg_gimbal_control_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint8_t target_system, uint8_t target_component, float demanded_rate_x, float demanded_rate_y, float demanded_rate_z, float gyro_bias_x, float gyro_bias_y, float gyro_bias_z)
static inline void mavlink_msg_gimbal_control_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint8_t target_system, uint8_t target_component, float demanded_rate_x, float demanded_rate_y, float demanded_rate_z)
{
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
char *buf = (char *)msgbuf;
_mav_put_float(buf, 0, demanded_rate_x);
_mav_put_float(buf, 4, demanded_rate_y);
_mav_put_float(buf, 8, demanded_rate_z);
_mav_put_float(buf, 12, gyro_bias_x);
_mav_put_float(buf, 16, gyro_bias_y);
_mav_put_float(buf, 20, gyro_bias_z);
_mav_put_uint8_t(buf, 24, target_system);
_mav_put_uint8_t(buf, 25, target_component);
_mav_put_uint8_t(buf, 12, target_system);
_mav_put_uint8_t(buf, 13, target_component);
#if MAVLINK_CRC_EXTRA
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_GIMBAL_CONTROL, buf, MAVLINK_MSG_ID_GIMBAL_CONTROL_LEN, MAVLINK_MSG_ID_GIMBAL_CONTROL_CRC);
@@ -254,9 +218,6 @@ static inline void mavlink_msg_gimbal_control_send_buf(mavlink_message_t *msgbuf
packet->demanded_rate_x = demanded_rate_x;
packet->demanded_rate_y = demanded_rate_y;
packet->demanded_rate_z = demanded_rate_z;
packet->gyro_bias_x = gyro_bias_x;
packet->gyro_bias_y = gyro_bias_y;
packet->gyro_bias_z = gyro_bias_z;
packet->target_system = target_system;
packet->target_component = target_component;
@@ -281,7 +242,7 @@ static inline void mavlink_msg_gimbal_control_send_buf(mavlink_message_t *msgbuf
*/
static inline uint8_t mavlink_msg_gimbal_control_get_target_system(const mavlink_message_t* msg)
{
return _MAV_RETURN_uint8_t(msg, 24);
return _MAV_RETURN_uint8_t(msg, 12);
}
/**
@@ -291,13 +252,13 @@ static inline uint8_t mavlink_msg_gimbal_control_get_target_system(const mavlink
*/
static inline uint8_t mavlink_msg_gimbal_control_get_target_component(const mavlink_message_t* msg)
{
return _MAV_RETURN_uint8_t(msg, 25);
return _MAV_RETURN_uint8_t(msg, 13);
}
/**
* @brief Get field demanded_rate_x from gimbal_control message
*
* @return Demanded angular rate X, radians/s
* @return Demanded angular rate X (rad/s)
*/
static inline float mavlink_msg_gimbal_control_get_demanded_rate_x(const mavlink_message_t* msg)
{
@@ -307,7 +268,7 @@ static inline float mavlink_msg_gimbal_control_get_demanded_rate_x(const mavlink
/**
* @brief Get field demanded_rate_y from gimbal_control message
*
* @return Demanded angular rate Y, radians/s
* @return Demanded angular rate Y (rad/s)
*/
static inline float mavlink_msg_gimbal_control_get_demanded_rate_y(const mavlink_message_t* msg)
{
@@ -317,43 +278,13 @@ static inline float mavlink_msg_gimbal_control_get_demanded_rate_y(const mavlink
/**
* @brief Get field demanded_rate_z from gimbal_control message
*
* @return Demanded angular rate Z, radians/s
* @return Demanded angular rate Z (rad/s)
*/
static inline float mavlink_msg_gimbal_control_get_demanded_rate_z(const mavlink_message_t* msg)
{
return _MAV_RETURN_float(msg, 8);
}
/**
* @brief Get field gyro_bias_x from gimbal_control message
*
* @return Gyro bias X, radians/s
*/
static inline float mavlink_msg_gimbal_control_get_gyro_bias_x(const mavlink_message_t* msg)
{
return _MAV_RETURN_float(msg, 12);
}
/**
* @brief Get field gyro_bias_y from gimbal_control message
*
* @return Gyro bias Y, radians/s
*/
static inline float mavlink_msg_gimbal_control_get_gyro_bias_y(const mavlink_message_t* msg)
{
return _MAV_RETURN_float(msg, 16);
}
/**
* @brief Get field gyro_bias_z from gimbal_control message
*
* @return Gyro bias Z, radians/s
*/
static inline float mavlink_msg_gimbal_control_get_gyro_bias_z(const mavlink_message_t* msg)
{
return _MAV_RETURN_float(msg, 20);
}
/**
* @brief Decode a gimbal_control message into a struct
*
@@ -366,9 +297,6 @@ static inline void mavlink_msg_gimbal_control_decode(const mavlink_message_t* ms
gimbal_control->demanded_rate_x = mavlink_msg_gimbal_control_get_demanded_rate_x(msg);
gimbal_control->demanded_rate_y = mavlink_msg_gimbal_control_get_demanded_rate_y(msg);
gimbal_control->demanded_rate_z = mavlink_msg_gimbal_control_get_demanded_rate_z(msg);
gimbal_control->gyro_bias_x = mavlink_msg_gimbal_control_get_gyro_bias_x(msg);
gimbal_control->gyro_bias_y = mavlink_msg_gimbal_control_get_gyro_bias_y(msg);
gimbal_control->gyro_bias_z = mavlink_msg_gimbal_control_get_gyro_bias_z(msg);
gimbal_control->target_system = mavlink_msg_gimbal_control_get_target_system(msg);
gimbal_control->target_component = mavlink_msg_gimbal_control_get_target_component(msg);
#else