Subversion Repositories Projects

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1702 - 1
// MESSAGE OBS_ATTITUDE PACKING
2
 
3
#define MAVLINK_MSG_ID_OBS_ATTITUDE 174
4
 
5
typedef struct __mavlink_obs_attitude_t
6
{
7
 double quat[4]; ///< Quaternion re;im
8
} mavlink_obs_attitude_t;
9
 
10
#define MAVLINK_MSG_ID_OBS_ATTITUDE_LEN 32
11
#define MAVLINK_MSG_ID_174_LEN 32
12
 
13
#define MAVLINK_MSG_OBS_ATTITUDE_FIELD_QUAT_LEN 4
14
 
15
#define MAVLINK_MESSAGE_INFO_OBS_ATTITUDE { \
16
        "OBS_ATTITUDE", \
17
        1, \
18
        {  { "quat", NULL, MAVLINK_TYPE_DOUBLE, 4, 0, offsetof(mavlink_obs_attitude_t, quat) }, \
19
         } \
20
}
21
 
22
 
23
/**
24
 * @brief Pack a obs_attitude message
25
 * @param system_id ID of this system
26
 * @param component_id ID of this component (e.g. 200 for IMU)
27
 * @param msg The MAVLink message to compress the data into
28
 *
29
 * @param quat Quaternion re;im
30
 * @return length of the message in bytes (excluding serial stream start sign)
31
 */
32
static inline uint16_t mavlink_msg_obs_attitude_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
33
                                                       const double *quat)
34
{
35
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
36
        char buf[32];
37
 
38
        _mav_put_double_array(buf, 0, quat, 4);
39
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, 32);
40
#else
41
        mavlink_obs_attitude_t packet;
42
 
43
        mav_array_memcpy(packet.quat, quat, sizeof(double)*4);
44
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, 32);
45
#endif
46
 
47
        msg->msgid = MAVLINK_MSG_ID_OBS_ATTITUDE;
48
        return mavlink_finalize_message(msg, system_id, component_id, 32, 146);
49
}
50
 
51
/**
52
 * @brief Pack a obs_attitude message on a channel
53
 * @param system_id ID of this system
54
 * @param component_id ID of this component (e.g. 200 for IMU)
55
 * @param chan The MAVLink channel this message was sent over
56
 * @param msg The MAVLink message to compress the data into
57
 * @param quat Quaternion re;im
58
 * @return length of the message in bytes (excluding serial stream start sign)
59
 */
60
static inline uint16_t mavlink_msg_obs_attitude_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
61
                                                           mavlink_message_t* msg,
62
                                                           const double *quat)
63
{
64
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
65
        char buf[32];
66
 
67
        _mav_put_double_array(buf, 0, quat, 4);
68
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, 32);
69
#else
70
        mavlink_obs_attitude_t packet;
71
 
72
        mav_array_memcpy(packet.quat, quat, sizeof(double)*4);
73
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, 32);
74
#endif
75
 
76
        msg->msgid = MAVLINK_MSG_ID_OBS_ATTITUDE;
77
        return mavlink_finalize_message_chan(msg, system_id, component_id, chan, 32, 146);
78
}
79
 
80
/**
81
 * @brief Encode a obs_attitude struct into a message
82
 *
83
 * @param system_id ID of this system
84
 * @param component_id ID of this component (e.g. 200 for IMU)
85
 * @param msg The MAVLink message to compress the data into
86
 * @param obs_attitude C-struct to read the message contents from
87
 */
88
static inline uint16_t mavlink_msg_obs_attitude_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_obs_attitude_t* obs_attitude)
89
{
90
        return mavlink_msg_obs_attitude_pack(system_id, component_id, msg, obs_attitude->quat);
91
}
92
 
93
/**
94
 * @brief Send a obs_attitude message
95
 * @param chan MAVLink channel to send the message
96
 *
97
 * @param quat Quaternion re;im
98
 */
99
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
100
 
101
static inline void mavlink_msg_obs_attitude_send(mavlink_channel_t chan, const double *quat)
102
{
103
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
104
        char buf[32];
105
 
106
        _mav_put_double_array(buf, 0, quat, 4);
107
        _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, buf, 32, 146);
108
#else
109
        mavlink_obs_attitude_t packet;
110
 
111
        mav_array_memcpy(packet.quat, quat, sizeof(double)*4);
112
        _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_OBS_ATTITUDE, (const char *)&packet, 32, 146);
113
#endif
114
}
115
 
116
#endif
117
 
118
// MESSAGE OBS_ATTITUDE UNPACKING
119
 
120
 
121
/**
122
 * @brief Get field quat from obs_attitude message
123
 *
124
 * @return Quaternion re;im
125
 */
126
static inline uint16_t mavlink_msg_obs_attitude_get_quat(const mavlink_message_t* msg, double *quat)
127
{
128
        return _MAV_RETURN_double_array(msg, quat, 4,  0);
129
}
130
 
131
/**
132
 * @brief Decode a obs_attitude message into a struct
133
 *
134
 * @param msg The message to decode
135
 * @param obs_attitude C-struct to decode the message contents into
136
 */
137
static inline void mavlink_msg_obs_attitude_decode(const mavlink_message_t* msg, mavlink_obs_attitude_t* obs_attitude)
138
{
139
#if MAVLINK_NEED_BYTE_SWAP
140
        mavlink_msg_obs_attitude_get_quat(msg, obs_attitude->quat);
141
#else
142
        memcpy(obs_attitude, _MAV_PAYLOAD(msg), 32);
143
#endif
144
}