mavlink_msg_servo_output_raw.h 13.8 KB
Newer Older
James Goppert's avatar
James Goppert committed
1 2
// MESSAGE SERVO_OUTPUT_RAW PACKING

3
#define MAVLINK_MSG_ID_SERVO_OUTPUT_RAW 36
James Goppert's avatar
James Goppert committed
4

lm's avatar
lm committed
5
typedef struct __mavlink_servo_output_raw_t
James Goppert's avatar
James Goppert committed
6
{
7
 uint32_t time_usec; ///< Timestamp (since UNIX epoch or microseconds since system boot)
lm's avatar
lm committed
8 9 10 11 12 13 14 15
 uint16_t servo1_raw; ///< Servo output 1 value, in microseconds
 uint16_t servo2_raw; ///< Servo output 2 value, in microseconds
 uint16_t servo3_raw; ///< Servo output 3 value, in microseconds
 uint16_t servo4_raw; ///< Servo output 4 value, in microseconds
 uint16_t servo5_raw; ///< Servo output 5 value, in microseconds
 uint16_t servo6_raw; ///< Servo output 6 value, in microseconds
 uint16_t servo7_raw; ///< Servo output 7 value, in microseconds
 uint16_t servo8_raw; ///< Servo output 8 value, in microseconds
16
 uint8_t port; ///< Servo output port (set of 8 outputs = 1 port). Most MAVs will just use one, but this allows to encode more than 8 servos.
James Goppert's avatar
James Goppert committed
17 18
} mavlink_servo_output_raw_t;

19
#define MAVLINK_MSG_ID_SERVO_OUTPUT_RAW_LEN 21
20
#define MAVLINK_MSG_ID_36_LEN 21
lm's avatar
lm committed
21 22 23 24 25



#define MAVLINK_MESSAGE_INFO_SERVO_OUTPUT_RAW { \
	"SERVO_OUTPUT_RAW", \
26
	10, \
lm's avatar
lm committed
27 28 29 30 31 32 33 34 35 36
	{  { "time_usec", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_servo_output_raw_t, time_usec) }, \
         { "servo1_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 4, offsetof(mavlink_servo_output_raw_t, servo1_raw) }, \
         { "servo2_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 6, offsetof(mavlink_servo_output_raw_t, servo2_raw) }, \
         { "servo3_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 8, offsetof(mavlink_servo_output_raw_t, servo3_raw) }, \
         { "servo4_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 10, offsetof(mavlink_servo_output_raw_t, servo4_raw) }, \
         { "servo5_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 12, offsetof(mavlink_servo_output_raw_t, servo5_raw) }, \
         { "servo6_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 14, offsetof(mavlink_servo_output_raw_t, servo6_raw) }, \
         { "servo7_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 16, offsetof(mavlink_servo_output_raw_t, servo7_raw) }, \
         { "servo8_raw", NULL, MAVLINK_TYPE_UINT16_T, 0, 18, offsetof(mavlink_servo_output_raw_t, servo8_raw) }, \
         { "port", NULL, MAVLINK_TYPE_UINT8_T, 0, 20, offsetof(mavlink_servo_output_raw_t, port) }, \
lm's avatar
lm committed
37 38 39 40
         } \
}


James Goppert's avatar
James Goppert committed
41 42 43 44 45 46
/**
 * @brief Pack a servo_output_raw 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
 *
47 48
 * @param time_usec Timestamp (since UNIX epoch or microseconds since system boot)
 * @param port Servo output port (set of 8 outputs = 1 port). Most MAVs will just use one, but this allows to encode more than 8 servos.
James Goppert's avatar
James Goppert committed
49 50 51 52 53 54 55 56 57 58
 * @param servo1_raw Servo output 1 value, in microseconds
 * @param servo2_raw Servo output 2 value, in microseconds
 * @param servo3_raw Servo output 3 value, in microseconds
 * @param servo4_raw Servo output 4 value, in microseconds
 * @param servo5_raw Servo output 5 value, in microseconds
 * @param servo6_raw Servo output 6 value, in microseconds
 * @param servo7_raw Servo output 7 value, in microseconds
 * @param servo8_raw Servo output 8 value, in microseconds
 * @return length of the message in bytes (excluding serial stream start sign)
 */
lm's avatar
lm committed
59
static inline uint16_t mavlink_msg_servo_output_raw_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
60
						       uint32_t time_usec, uint8_t port, uint16_t servo1_raw, uint16_t servo2_raw, uint16_t servo3_raw, uint16_t servo4_raw, uint16_t servo5_raw, uint16_t servo6_raw, uint16_t servo7_raw, uint16_t servo8_raw)
James Goppert's avatar
James Goppert committed
61
{
LM's avatar
LM committed
62 63 64 65 66 67 68 69 70 71 72 73 74
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[21];
	_mav_put_uint32_t(buf, 0, time_usec);
	_mav_put_uint16_t(buf, 4, servo1_raw);
	_mav_put_uint16_t(buf, 6, servo2_raw);
	_mav_put_uint16_t(buf, 8, servo3_raw);
	_mav_put_uint16_t(buf, 10, servo4_raw);
	_mav_put_uint16_t(buf, 12, servo5_raw);
	_mav_put_uint16_t(buf, 14, servo6_raw);
	_mav_put_uint16_t(buf, 16, servo7_raw);
	_mav_put_uint16_t(buf, 18, servo8_raw);
	_mav_put_uint8_t(buf, 20, port);

75
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, 21);
LM's avatar
LM committed
76 77 78 79 80 81 82 83 84 85 86 87 88
#else
	mavlink_servo_output_raw_t packet;
	packet.time_usec = time_usec;
	packet.servo1_raw = servo1_raw;
	packet.servo2_raw = servo2_raw;
	packet.servo3_raw = servo3_raw;
	packet.servo4_raw = servo4_raw;
	packet.servo5_raw = servo5_raw;
	packet.servo6_raw = servo6_raw;
	packet.servo7_raw = servo7_raw;
	packet.servo8_raw = servo8_raw;
	packet.port = port;

89
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, 21);
LM's avatar
LM committed
90
#endif
James Goppert's avatar
James Goppert committed
91

LM's avatar
LM committed
92
	msg->msgid = MAVLINK_MSG_ID_SERVO_OUTPUT_RAW;
93
	return mavlink_finalize_message(msg, system_id, component_id, 21, 222);
James Goppert's avatar
James Goppert committed
94 95 96
}

/**
lm's avatar
lm committed
97
 * @brief Pack a servo_output_raw message on a channel
James Goppert's avatar
James Goppert committed
98 99 100 101
 * @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 was sent over
 * @param msg The MAVLink message to compress the data into
102 103
 * @param time_usec Timestamp (since UNIX epoch or microseconds since system boot)
 * @param port Servo output port (set of 8 outputs = 1 port). Most MAVs will just use one, but this allows to encode more than 8 servos.
James Goppert's avatar
James Goppert committed
104 105 106 107 108 109 110 111 112 113
 * @param servo1_raw Servo output 1 value, in microseconds
 * @param servo2_raw Servo output 2 value, in microseconds
 * @param servo3_raw Servo output 3 value, in microseconds
 * @param servo4_raw Servo output 4 value, in microseconds
 * @param servo5_raw Servo output 5 value, in microseconds
 * @param servo6_raw Servo output 6 value, in microseconds
 * @param servo7_raw Servo output 7 value, in microseconds
 * @param servo8_raw Servo output 8 value, in microseconds
 * @return length of the message in bytes (excluding serial stream start sign)
 */
lm's avatar
lm committed
114 115
static inline uint16_t mavlink_msg_servo_output_raw_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
							   mavlink_message_t* msg,
116
						           uint32_t time_usec,uint8_t port,uint16_t servo1_raw,uint16_t servo2_raw,uint16_t servo3_raw,uint16_t servo4_raw,uint16_t servo5_raw,uint16_t servo6_raw,uint16_t servo7_raw,uint16_t servo8_raw)
lm's avatar
lm committed
117
{
LM's avatar
LM committed
118 119 120 121 122 123 124 125 126 127 128 129 130
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[21];
	_mav_put_uint32_t(buf, 0, time_usec);
	_mav_put_uint16_t(buf, 4, servo1_raw);
	_mav_put_uint16_t(buf, 6, servo2_raw);
	_mav_put_uint16_t(buf, 8, servo3_raw);
	_mav_put_uint16_t(buf, 10, servo4_raw);
	_mav_put_uint16_t(buf, 12, servo5_raw);
	_mav_put_uint16_t(buf, 14, servo6_raw);
	_mav_put_uint16_t(buf, 16, servo7_raw);
	_mav_put_uint16_t(buf, 18, servo8_raw);
	_mav_put_uint8_t(buf, 20, port);

131
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, 21);
LM's avatar
LM committed
132 133 134 135 136 137 138 139 140 141 142 143 144
#else
	mavlink_servo_output_raw_t packet;
	packet.time_usec = time_usec;
	packet.servo1_raw = servo1_raw;
	packet.servo2_raw = servo2_raw;
	packet.servo3_raw = servo3_raw;
	packet.servo4_raw = servo4_raw;
	packet.servo5_raw = servo5_raw;
	packet.servo6_raw = servo6_raw;
	packet.servo7_raw = servo7_raw;
	packet.servo8_raw = servo8_raw;
	packet.port = port;

145
        memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, 21);
LM's avatar
LM committed
146
#endif
lm's avatar
lm committed
147

LM's avatar
LM committed
148
	msg->msgid = MAVLINK_MSG_ID_SERVO_OUTPUT_RAW;
149
	return mavlink_finalize_message_chan(msg, system_id, component_id, chan, 21, 222);
lm's avatar
lm committed
150 151
}

James Goppert's avatar
James Goppert committed
152 153 154 155 156 157 158 159 160 161
/**
 * @brief Encode a servo_output_raw struct into a 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
 * @param servo_output_raw C-struct to read the message contents from
 */
static inline uint16_t mavlink_msg_servo_output_raw_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_servo_output_raw_t* servo_output_raw)
{
162
	return mavlink_msg_servo_output_raw_pack(system_id, component_id, msg, servo_output_raw->time_usec, servo_output_raw->port, servo_output_raw->servo1_raw, servo_output_raw->servo2_raw, servo_output_raw->servo3_raw, servo_output_raw->servo4_raw, servo_output_raw->servo5_raw, servo_output_raw->servo6_raw, servo_output_raw->servo7_raw, servo_output_raw->servo8_raw);
James Goppert's avatar
James Goppert committed
163 164 165 166 167 168
}

/**
 * @brief Send a servo_output_raw message
 * @param chan MAVLink channel to send the message
 *
169 170
 * @param time_usec Timestamp (since UNIX epoch or microseconds since system boot)
 * @param port Servo output port (set of 8 outputs = 1 port). Most MAVs will just use one, but this allows to encode more than 8 servos.
James Goppert's avatar
James Goppert committed
171 172 173 174 175 176 177 178 179
 * @param servo1_raw Servo output 1 value, in microseconds
 * @param servo2_raw Servo output 2 value, in microseconds
 * @param servo3_raw Servo output 3 value, in microseconds
 * @param servo4_raw Servo output 4 value, in microseconds
 * @param servo5_raw Servo output 5 value, in microseconds
 * @param servo6_raw Servo output 6 value, in microseconds
 * @param servo7_raw Servo output 7 value, in microseconds
 * @param servo8_raw Servo output 8 value, in microseconds
 */
lm's avatar
lm committed
180 181
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS

182
static inline void mavlink_msg_servo_output_raw_send(mavlink_channel_t chan, uint32_t time_usec, uint8_t port, uint16_t servo1_raw, uint16_t servo2_raw, uint16_t servo3_raw, uint16_t servo4_raw, uint16_t servo5_raw, uint16_t servo6_raw, uint16_t servo7_raw, uint16_t servo8_raw)
lm's avatar
lm committed
183
{
LM's avatar
LM committed
184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[21];
	_mav_put_uint32_t(buf, 0, time_usec);
	_mav_put_uint16_t(buf, 4, servo1_raw);
	_mav_put_uint16_t(buf, 6, servo2_raw);
	_mav_put_uint16_t(buf, 8, servo3_raw);
	_mav_put_uint16_t(buf, 10, servo4_raw);
	_mav_put_uint16_t(buf, 12, servo5_raw);
	_mav_put_uint16_t(buf, 14, servo6_raw);
	_mav_put_uint16_t(buf, 16, servo7_raw);
	_mav_put_uint16_t(buf, 18, servo8_raw);
	_mav_put_uint8_t(buf, 20, port);

	_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_SERVO_OUTPUT_RAW, buf, 21, 222);
#else
	mavlink_servo_output_raw_t packet;
	packet.time_usec = time_usec;
	packet.servo1_raw = servo1_raw;
	packet.servo2_raw = servo2_raw;
	packet.servo3_raw = servo3_raw;
	packet.servo4_raw = servo4_raw;
	packet.servo5_raw = servo5_raw;
	packet.servo6_raw = servo6_raw;
	packet.servo7_raw = servo7_raw;
	packet.servo8_raw = servo8_raw;
	packet.port = port;

	_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_SERVO_OUTPUT_RAW, (const char *)&packet, 21, 222);
#endif
James Goppert's avatar
James Goppert committed
213 214 215
}

#endif
lm's avatar
lm committed
216

James Goppert's avatar
James Goppert committed
217 218
// MESSAGE SERVO_OUTPUT_RAW UNPACKING

lm's avatar
lm committed
219

220 221 222 223 224 225 226
/**
 * @brief Get field time_usec from servo_output_raw message
 *
 * @return Timestamp (since UNIX epoch or microseconds since system boot)
 */
static inline uint32_t mavlink_msg_servo_output_raw_get_time_usec(const mavlink_message_t* msg)
{
LM's avatar
LM committed
227
	return _MAV_RETURN_uint32_t(msg,  0);
228 229 230 231 232 233 234 235 236
}

/**
 * @brief Get field port from servo_output_raw message
 *
 * @return Servo output port (set of 8 outputs = 1 port). Most MAVs will just use one, but this allows to encode more than 8 servos.
 */
static inline uint8_t mavlink_msg_servo_output_raw_get_port(const mavlink_message_t* msg)
{
LM's avatar
LM committed
237
	return _MAV_RETURN_uint8_t(msg,  20);
238 239
}

James Goppert's avatar
James Goppert committed
240 241 242 243 244 245 246
/**
 * @brief Get field servo1_raw from servo_output_raw message
 *
 * @return Servo output 1 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo1_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
247
	return _MAV_RETURN_uint16_t(msg,  4);
James Goppert's avatar
James Goppert committed
248 249 250 251 252 253 254 255 256
}

/**
 * @brief Get field servo2_raw from servo_output_raw message
 *
 * @return Servo output 2 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo2_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
257
	return _MAV_RETURN_uint16_t(msg,  6);
James Goppert's avatar
James Goppert committed
258 259 260 261 262 263 264 265 266
}

/**
 * @brief Get field servo3_raw from servo_output_raw message
 *
 * @return Servo output 3 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo3_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
267
	return _MAV_RETURN_uint16_t(msg,  8);
James Goppert's avatar
James Goppert committed
268 269 270 271 272 273 274 275 276
}

/**
 * @brief Get field servo4_raw from servo_output_raw message
 *
 * @return Servo output 4 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo4_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
277
	return _MAV_RETURN_uint16_t(msg,  10);
James Goppert's avatar
James Goppert committed
278 279 280 281 282 283 284 285 286
}

/**
 * @brief Get field servo5_raw from servo_output_raw message
 *
 * @return Servo output 5 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo5_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
287
	return _MAV_RETURN_uint16_t(msg,  12);
James Goppert's avatar
James Goppert committed
288 289 290 291 292 293 294 295 296
}

/**
 * @brief Get field servo6_raw from servo_output_raw message
 *
 * @return Servo output 6 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo6_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
297
	return _MAV_RETURN_uint16_t(msg,  14);
James Goppert's avatar
James Goppert committed
298 299 300 301 302 303 304 305 306
}

/**
 * @brief Get field servo7_raw from servo_output_raw message
 *
 * @return Servo output 7 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo7_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
307
	return _MAV_RETURN_uint16_t(msg,  16);
James Goppert's avatar
James Goppert committed
308 309 310 311 312 313 314 315 316
}

/**
 * @brief Get field servo8_raw from servo_output_raw message
 *
 * @return Servo output 8 value, in microseconds
 */
static inline uint16_t mavlink_msg_servo_output_raw_get_servo8_raw(const mavlink_message_t* msg)
{
LM's avatar
LM committed
317
	return _MAV_RETURN_uint16_t(msg,  18);
James Goppert's avatar
James Goppert committed
318 319 320 321 322 323 324 325 326 327
}

/**
 * @brief Decode a servo_output_raw message into a struct
 *
 * @param msg The message to decode
 * @param servo_output_raw C-struct to decode the message contents into
 */
static inline void mavlink_msg_servo_output_raw_decode(const mavlink_message_t* msg, mavlink_servo_output_raw_t* servo_output_raw)
{
lm's avatar
lm committed
328
#if MAVLINK_NEED_BYTE_SWAP
329
	servo_output_raw->time_usec = mavlink_msg_servo_output_raw_get_time_usec(msg);
lm's avatar
lm committed
330 331 332 333 334 335 336 337
	servo_output_raw->servo1_raw = mavlink_msg_servo_output_raw_get_servo1_raw(msg);
	servo_output_raw->servo2_raw = mavlink_msg_servo_output_raw_get_servo2_raw(msg);
	servo_output_raw->servo3_raw = mavlink_msg_servo_output_raw_get_servo3_raw(msg);
	servo_output_raw->servo4_raw = mavlink_msg_servo_output_raw_get_servo4_raw(msg);
	servo_output_raw->servo5_raw = mavlink_msg_servo_output_raw_get_servo5_raw(msg);
	servo_output_raw->servo6_raw = mavlink_msg_servo_output_raw_get_servo6_raw(msg);
	servo_output_raw->servo7_raw = mavlink_msg_servo_output_raw_get_servo7_raw(msg);
	servo_output_raw->servo8_raw = mavlink_msg_servo_output_raw_get_servo8_raw(msg);
338
	servo_output_raw->port = mavlink_msg_servo_output_raw_get_port(msg);
lm's avatar
lm committed
339
#else
LM's avatar
LM committed
340
	memcpy(servo_output_raw, _MAV_PAYLOAD(msg), 21);
lm's avatar
lm committed
341
#endif
James Goppert's avatar
James Goppert committed
342
}