Subversion Repositories Projects

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1702 - 1 
// MESSAGE DEBUG PACKING
2 
 
3 
#define MAVLINK_MSG_ID_DEBUG 255
4 
 
5 
typedef struct __mavlink_debug_t
6 
{
7 
 uint8_t ind; ///< index of debug variable
8 
 float value; ///< DEBUG value
9 
} mavlink_debug_t;
10 
 
11 
#define MAVLINK_MSG_ID_DEBUG_LEN 5
12 
#define MAVLINK_MSG_ID_255_LEN 5
13 
 
14 
 
15 
 
16 
#define MAVLINK_MESSAGE_INFO_DEBUG { \
17 
        "DEBUG", \
18 
        2, \
19 
        {  { "ind", NULL, MAVLINK_TYPE_UINT8_T, 0, 0, offsetof(mavlink_debug_t, ind) }, \
20 
         { "value", NULL, MAVLINK_TYPE_FLOAT, 0, 1, offsetof(mavlink_debug_t, value) }, \
21 
         } \
22 
}
23 
 
24 
 
25 
/**
26 
 * @brief Pack a debug message
27 
 * @param system_id ID of this system
28 
 * @param component_id ID of this component (e.g. 200 for IMU)
29 
 * @param msg The MAVLink message to compress the data into
30 
 *
31 
 * @param ind index of debug variable
32 
 * @param value DEBUG value
33 
 * @return length of the message in bytes (excluding serial stream start sign)
34 
 */
35 
static inline uint16_t mavlink_msg_debug_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
36 
                                                       uint8_t ind, float value)
37 
{
38 
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
39 
        char buf[5];
40 
        _mav_put_uint8_t(buf, 0, ind);
41 
        _mav_put_float(buf, 1, value);
42 
 
43 
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, 5);
44 
#else
45 
        mavlink_debug_t packet;
46 
        packet.ind = ind;
47 
        packet.value = value;
48 
 
49 
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, 5);
50 
#endif
51 
 
52 
        msg->msgid = MAVLINK_MSG_ID_DEBUG;
53 
        return mavlink_finalize_message(msg, system_id, component_id, 5);
54 
}
55 
 
56 
/**
57 
 * @brief Pack a debug message on a channel
58 
 * @param system_id ID of this system
59 
 * @param component_id ID of this component (e.g. 200 for IMU)
60 
 * @param chan The MAVLink channel this message was sent over
61 
 * @param msg The MAVLink message to compress the data into
62 
 * @param ind index of debug variable
63 
 * @param value DEBUG value
64 
 * @return length of the message in bytes (excluding serial stream start sign)
65 
 */
66 
static inline uint16_t mavlink_msg_debug_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
67 
                                                           mavlink_message_t* msg,
68 
                                                           uint8_t ind,float value)
69 
{
70 
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
71 
        char buf[5];
72 
        _mav_put_uint8_t(buf, 0, ind);
73 
        _mav_put_float(buf, 1, value);
74 
 
75 
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, 5);
76 
#else
77 
        mavlink_debug_t packet;
78 
        packet.ind = ind;
79 
        packet.value = value;
80 
 
81 
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, 5);
82 
#endif
83 
 
84 
        msg->msgid = MAVLINK_MSG_ID_DEBUG;
85 
        return mavlink_finalize_message_chan(msg, system_id, component_id, chan, 5);
86 
}
87 
 
88 
/**
89 
 * @brief Encode a debug struct into a message
90 
 *
91 
 * @param system_id ID of this system
92 
 * @param component_id ID of this component (e.g. 200 for IMU)
93 
 * @param msg The MAVLink message to compress the data into
94 
 * @param debug C-struct to read the message contents from
95 
 */
96 
static inline uint16_t mavlink_msg_debug_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_debug_t* debug)
97 
{
98 
        return mavlink_msg_debug_pack(system_id, component_id, msg, debug->ind, debug->value);
99 
}
100 
 
101 
/**
102 
 * @brief Send a debug message
103 
 * @param chan MAVLink channel to send the message
104 
 *
105 
 * @param ind index of debug variable
106 
 * @param value DEBUG value
107 
 */
108 
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
109 
 
110 
static inline void mavlink_msg_debug_send(mavlink_channel_t chan, uint8_t ind, float value)
111 
{
112 
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
113 
        char buf[5];
114 
        _mav_put_uint8_t(buf, 0, ind);
115 
        _mav_put_float(buf, 1, value);
116 
 
117 
        _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_DEBUG, buf, 5);
118 
#else
119 
        mavlink_debug_t packet;
120 
        packet.ind = ind;
121 
        packet.value = value;
122 
 
123 
        _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_DEBUG, (const char *)&packet, 5);
124 
#endif
125 
}
126 
 
127 
#endif
128 
 
129 
// MESSAGE DEBUG UNPACKING
130 
 
131 
 
132 
/**
133 
 * @brief Get field ind from debug message
134 
 *
135 
 * @return index of debug variable
136 
 */
137 
static inline uint8_t mavlink_msg_debug_get_ind(const mavlink_message_t* msg)
138 
{
139 
        return _MAV_RETURN_uint8_t(msg,  0);
140 
}
141 
 
142 
/**
143 
 * @brief Get field value from debug message
144 
 *
145 
 * @return DEBUG value
146 
 */
147 
static inline float mavlink_msg_debug_get_value(const mavlink_message_t* msg)
148 
{
149 
        return _MAV_RETURN_float(msg,  1);
150 
}
151 
 
152 
/**
153 
 * @brief Decode a debug message into a struct
154 
 *
155 
 * @param msg The message to decode
156 
 * @param debug C-struct to decode the message contents into
157 
 */
158 
static inline void mavlink_msg_debug_decode(const mavlink_message_t* msg, mavlink_debug_t* debug)
159 
{
160 
#if MAVLINK_NEED_BYTE_SWAP
161 
        debug->ind = mavlink_msg_debug_get_ind(msg);
162 
        debug->value = mavlink_msg_debug_get_value(msg);
163 
#else
164 
        memcpy(debug, _MAV_PAYLOAD(msg), 5);
165 
#endif
166 
}