mavlink_msg_slugs_navigation.h 10.9 KB
Newer Older
James Goppert's avatar
James Goppert committed
1 2 3 4
// MESSAGE SLUGS_NAVIGATION PACKING

#define MAVLINK_MSG_ID_SLUGS_NAVIGATION 176

lm's avatar
lm committed
5
typedef struct __mavlink_slugs_navigation_t
James Goppert's avatar
James Goppert committed
6
{
lm's avatar
lm committed
7 8 9 10 11 12 13 14 15
 float u_m; ///< Measured Airspeed prior to the Nav Filter
 float phi_c; ///< Commanded Roll
 float theta_c; ///< Commanded Pitch
 float psiDot_c; ///< Commanded Turn rate
 float ay_body; ///< Y component of the body acceleration
 float totalDist; ///< Total Distance to Run on this leg of Navigation
 float dist2Go; ///< Remaining distance to Run on this leg of Navigation
 uint8_t fromWP; ///< Origin WP
 uint8_t toWP; ///< Destination WP
James Goppert's avatar
James Goppert committed
16 17
} mavlink_slugs_navigation_t;

lm's avatar
lm committed
18 19 20 21 22 23 24 25
#define MAVLINK_MSG_ID_SLUGS_NAVIGATION_LEN 30
#define MAVLINK_MSG_ID_176_LEN 30



#define MAVLINK_MESSAGE_INFO_SLUGS_NAVIGATION { \
	"SLUGS_NAVIGATION", \
	9, \
lm's avatar
lm committed
26 27 28 29 30 31 32 33 34
	{  { "u_m", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_slugs_navigation_t, u_m) }, \
         { "phi_c", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_slugs_navigation_t, phi_c) }, \
         { "theta_c", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_slugs_navigation_t, theta_c) }, \
         { "psiDot_c", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_slugs_navigation_t, psiDot_c) }, \
         { "ay_body", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_slugs_navigation_t, ay_body) }, \
         { "totalDist", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_slugs_navigation_t, totalDist) }, \
         { "dist2Go", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_slugs_navigation_t, dist2Go) }, \
         { "fromWP", NULL, MAVLINK_TYPE_UINT8_T, 0, 28, offsetof(mavlink_slugs_navigation_t, fromWP) }, \
         { "toWP", NULL, MAVLINK_TYPE_UINT8_T, 0, 29, offsetof(mavlink_slugs_navigation_t, toWP) }, \
lm's avatar
lm committed
35 36 37 38
         } \
}


James Goppert's avatar
James Goppert committed
39
/**
James Goppert's avatar
James Goppert committed
40 41 42 43
 * @brief Pack a slugs_navigation 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
James Goppert's avatar
James Goppert committed
44 45 46 47 48 49 50 51 52 53 54 55
 *
 * @param u_m Measured Airspeed prior to the Nav Filter
 * @param phi_c Commanded Roll
 * @param theta_c Commanded Pitch
 * @param psiDot_c Commanded Turn rate
 * @param ay_body Y component of the body acceleration
 * @param totalDist Total Distance to Run on this leg of Navigation
 * @param dist2Go Remaining distance to Run on this leg of Navigation
 * @param fromWP Origin WP
 * @param toWP Destination WP
 * @return length of the message in bytes (excluding serial stream start sign)
 */
lm's avatar
lm committed
56 57
static inline uint16_t mavlink_msg_slugs_navigation_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
						       float u_m, float phi_c, float theta_c, float psiDot_c, float ay_body, float totalDist, float dist2Go, uint8_t fromWP, uint8_t toWP)
James Goppert's avatar
James Goppert committed
58
{
LM's avatar
LM committed
59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[30];
	_mav_put_float(buf, 0, u_m);
	_mav_put_float(buf, 4, phi_c);
	_mav_put_float(buf, 8, theta_c);
	_mav_put_float(buf, 12, psiDot_c);
	_mav_put_float(buf, 16, ay_body);
	_mav_put_float(buf, 20, totalDist);
	_mav_put_float(buf, 24, dist2Go);
	_mav_put_uint8_t(buf, 28, fromWP);
	_mav_put_uint8_t(buf, 29, toWP);

        memcpy(_MAV_PAYLOAD(msg), buf, 30);
#else
	mavlink_slugs_navigation_t packet;
	packet.u_m = u_m;
	packet.phi_c = phi_c;
	packet.theta_c = theta_c;
	packet.psiDot_c = psiDot_c;
	packet.ay_body = ay_body;
	packet.totalDist = totalDist;
	packet.dist2Go = dist2Go;
	packet.fromWP = fromWP;
	packet.toWP = toWP;
James Goppert's avatar
James Goppert committed
83

LM's avatar
LM committed
84 85
        memcpy(_MAV_PAYLOAD(msg), &packet, 30);
#endif
lm's avatar
lm committed
86

LM's avatar
LM committed
87
	msg->msgid = MAVLINK_MSG_ID_SLUGS_NAVIGATION;
lm's avatar
lm committed
88
	return mavlink_finalize_message(msg, system_id, component_id, 30, 120);
James Goppert's avatar
James Goppert committed
89 90
}

James Goppert's avatar
James Goppert committed
91
/**
lm's avatar
lm committed
92
 * @brief Pack a slugs_navigation message on a channel
James Goppert's avatar
James Goppert committed
93 94 95 96 97 98 99 100 101 102 103 104 105 106 107
 * @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
 * @param u_m Measured Airspeed prior to the Nav Filter
 * @param phi_c Commanded Roll
 * @param theta_c Commanded Pitch
 * @param psiDot_c Commanded Turn rate
 * @param ay_body Y component of the body acceleration
 * @param totalDist Total Distance to Run on this leg of Navigation
 * @param dist2Go Remaining distance to Run on this leg of Navigation
 * @param fromWP Origin WP
 * @param toWP Destination WP
 * @return length of the message in bytes (excluding serial stream start sign)
 */
lm's avatar
lm committed
108 109 110
static inline uint16_t mavlink_msg_slugs_navigation_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
							   mavlink_message_t* msg,
						           float u_m,float phi_c,float theta_c,float psiDot_c,float ay_body,float totalDist,float dist2Go,uint8_t fromWP,uint8_t toWP)
James Goppert's avatar
James Goppert committed
111
{
LM's avatar
LM committed
112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[30];
	_mav_put_float(buf, 0, u_m);
	_mav_put_float(buf, 4, phi_c);
	_mav_put_float(buf, 8, theta_c);
	_mav_put_float(buf, 12, psiDot_c);
	_mav_put_float(buf, 16, ay_body);
	_mav_put_float(buf, 20, totalDist);
	_mav_put_float(buf, 24, dist2Go);
	_mav_put_uint8_t(buf, 28, fromWP);
	_mav_put_uint8_t(buf, 29, toWP);

        memcpy(_MAV_PAYLOAD(msg), buf, 30);
#else
	mavlink_slugs_navigation_t packet;
	packet.u_m = u_m;
	packet.phi_c = phi_c;
	packet.theta_c = theta_c;
	packet.psiDot_c = psiDot_c;
	packet.ay_body = ay_body;
	packet.totalDist = totalDist;
	packet.dist2Go = dist2Go;
	packet.fromWP = fromWP;
	packet.toWP = toWP;
James Goppert's avatar
James Goppert committed
136

LM's avatar
LM committed
137 138
        memcpy(_MAV_PAYLOAD(msg), &packet, 30);
#endif
lm's avatar
lm committed
139

LM's avatar
LM committed
140
	msg->msgid = MAVLINK_MSG_ID_SLUGS_NAVIGATION;
lm's avatar
lm committed
141
	return mavlink_finalize_message_chan(msg, system_id, component_id, chan, 30, 120);
James Goppert's avatar
James Goppert committed
142 143 144 145 146 147 148 149 150 151
}

/**
 * @brief Encode a slugs_navigation 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 slugs_navigation C-struct to read the message contents from
 */
James Goppert's avatar
James Goppert committed
152 153 154 155 156
static inline uint16_t mavlink_msg_slugs_navigation_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_slugs_navigation_t* slugs_navigation)
{
	return mavlink_msg_slugs_navigation_pack(system_id, component_id, msg, slugs_navigation->u_m, slugs_navigation->phi_c, slugs_navigation->theta_c, slugs_navigation->psiDot_c, slugs_navigation->ay_body, slugs_navigation->totalDist, slugs_navigation->dist2Go, slugs_navigation->fromWP, slugs_navigation->toWP);
}

James Goppert's avatar
James Goppert committed
157 158 159 160 161 162 163 164 165 166 167 168 169 170
/**
 * @brief Send a slugs_navigation message
 * @param chan MAVLink channel to send the message
 *
 * @param u_m Measured Airspeed prior to the Nav Filter
 * @param phi_c Commanded Roll
 * @param theta_c Commanded Pitch
 * @param psiDot_c Commanded Turn rate
 * @param ay_body Y component of the body acceleration
 * @param totalDist Total Distance to Run on this leg of Navigation
 * @param dist2Go Remaining distance to Run on this leg of Navigation
 * @param fromWP Origin WP
 * @param toWP Destination WP
 */
lm's avatar
lm committed
171 172
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS

lm's avatar
lm committed
173 174
static inline void mavlink_msg_slugs_navigation_send(mavlink_channel_t chan, float u_m, float phi_c, float theta_c, float psiDot_c, float ay_body, float totalDist, float dist2Go, uint8_t fromWP, uint8_t toWP)
{
LM's avatar
LM committed
175 176 177 178 179 180 181 182 183 184 185
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
	char buf[30];
	_mav_put_float(buf, 0, u_m);
	_mav_put_float(buf, 4, phi_c);
	_mav_put_float(buf, 8, theta_c);
	_mav_put_float(buf, 12, psiDot_c);
	_mav_put_float(buf, 16, ay_body);
	_mav_put_float(buf, 20, totalDist);
	_mav_put_float(buf, 24, dist2Go);
	_mav_put_uint8_t(buf, 28, fromWP);
	_mav_put_uint8_t(buf, 29, toWP);
LM's avatar
LM committed
186

LM's avatar
LM committed
187 188 189 190 191 192 193 194 195 196 197 198 199 200 201
	_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_SLUGS_NAVIGATION, buf, 30, 120);
#else
	mavlink_slugs_navigation_t packet;
	packet.u_m = u_m;
	packet.phi_c = phi_c;
	packet.theta_c = theta_c;
	packet.psiDot_c = psiDot_c;
	packet.ay_body = ay_body;
	packet.totalDist = totalDist;
	packet.dist2Go = dist2Go;
	packet.fromWP = fromWP;
	packet.toWP = toWP;

	_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_SLUGS_NAVIGATION, (const char *)&packet, 30, 120);
#endif
James Goppert's avatar
James Goppert committed
202 203 204
}

#endif
lm's avatar
lm committed
205

James Goppert's avatar
James Goppert committed
206 207
// MESSAGE SLUGS_NAVIGATION UNPACKING

lm's avatar
lm committed
208

James Goppert's avatar
James Goppert committed
209 210 211 212 213 214 215
/**
 * @brief Get field u_m from slugs_navigation message
 *
 * @return Measured Airspeed prior to the Nav Filter
 */
static inline float mavlink_msg_slugs_navigation_get_u_m(const mavlink_message_t* msg)
{
LM's avatar
LM committed
216
	return _MAV_RETURN_float(msg,  0);
James Goppert's avatar
James Goppert committed
217 218 219 220 221 222 223 224 225
}

/**
 * @brief Get field phi_c from slugs_navigation message
 *
 * @return Commanded Roll
 */
static inline float mavlink_msg_slugs_navigation_get_phi_c(const mavlink_message_t* msg)
{
LM's avatar
LM committed
226
	return _MAV_RETURN_float(msg,  4);
James Goppert's avatar
James Goppert committed
227 228 229 230 231 232 233 234 235
}

/**
 * @brief Get field theta_c from slugs_navigation message
 *
 * @return Commanded Pitch
 */
static inline float mavlink_msg_slugs_navigation_get_theta_c(const mavlink_message_t* msg)
{
LM's avatar
LM committed
236
	return _MAV_RETURN_float(msg,  8);
James Goppert's avatar
James Goppert committed
237 238 239 240 241 242 243 244 245
}

/**
 * @brief Get field psiDot_c from slugs_navigation message
 *
 * @return Commanded Turn rate
 */
static inline float mavlink_msg_slugs_navigation_get_psiDot_c(const mavlink_message_t* msg)
{
LM's avatar
LM committed
246
	return _MAV_RETURN_float(msg,  12);
James Goppert's avatar
James Goppert committed
247 248 249 250 251 252 253 254 255
}

/**
 * @brief Get field ay_body from slugs_navigation message
 *
 * @return Y component of the body acceleration
 */
static inline float mavlink_msg_slugs_navigation_get_ay_body(const mavlink_message_t* msg)
{
LM's avatar
LM committed
256
	return _MAV_RETURN_float(msg,  16);
James Goppert's avatar
James Goppert committed
257 258 259 260 261 262 263 264 265
}

/**
 * @brief Get field totalDist from slugs_navigation message
 *
 * @return Total Distance to Run on this leg of Navigation
 */
static inline float mavlink_msg_slugs_navigation_get_totalDist(const mavlink_message_t* msg)
{
LM's avatar
LM committed
266
	return _MAV_RETURN_float(msg,  20);
James Goppert's avatar
James Goppert committed
267 268 269 270 271 272 273 274 275
}

/**
 * @brief Get field dist2Go from slugs_navigation message
 *
 * @return Remaining distance to Run on this leg of Navigation
 */
static inline float mavlink_msg_slugs_navigation_get_dist2Go(const mavlink_message_t* msg)
{
LM's avatar
LM committed
276
	return _MAV_RETURN_float(msg,  24);
James Goppert's avatar
James Goppert committed
277 278 279 280 281 282 283 284 285
}

/**
 * @brief Get field fromWP from slugs_navigation message
 *
 * @return Origin WP
 */
static inline uint8_t mavlink_msg_slugs_navigation_get_fromWP(const mavlink_message_t* msg)
{
LM's avatar
LM committed
286
	return _MAV_RETURN_uint8_t(msg,  28);
James Goppert's avatar
James Goppert committed
287 288 289 290 291 292 293 294 295
}

/**
 * @brief Get field toWP from slugs_navigation message
 *
 * @return Destination WP
 */
static inline uint8_t mavlink_msg_slugs_navigation_get_toWP(const mavlink_message_t* msg)
{
LM's avatar
LM committed
296
	return _MAV_RETURN_uint8_t(msg,  29);
James Goppert's avatar
James Goppert committed
297 298
}

James Goppert's avatar
James Goppert committed
299 300 301 302 303 304
/**
 * @brief Decode a slugs_navigation message into a struct
 *
 * @param msg The message to decode
 * @param slugs_navigation C-struct to decode the message contents into
 */
James Goppert's avatar
James Goppert committed
305 306
static inline void mavlink_msg_slugs_navigation_decode(const mavlink_message_t* msg, mavlink_slugs_navigation_t* slugs_navigation)
{
lm's avatar
lm committed
307 308 309 310 311 312 313 314 315 316 317
#if MAVLINK_NEED_BYTE_SWAP
	slugs_navigation->u_m = mavlink_msg_slugs_navigation_get_u_m(msg);
	slugs_navigation->phi_c = mavlink_msg_slugs_navigation_get_phi_c(msg);
	slugs_navigation->theta_c = mavlink_msg_slugs_navigation_get_theta_c(msg);
	slugs_navigation->psiDot_c = mavlink_msg_slugs_navigation_get_psiDot_c(msg);
	slugs_navigation->ay_body = mavlink_msg_slugs_navigation_get_ay_body(msg);
	slugs_navigation->totalDist = mavlink_msg_slugs_navigation_get_totalDist(msg);
	slugs_navigation->dist2Go = mavlink_msg_slugs_navigation_get_dist2Go(msg);
	slugs_navigation->fromWP = mavlink_msg_slugs_navigation_get_fromWP(msg);
	slugs_navigation->toWP = mavlink_msg_slugs_navigation_get_toWP(msg);
#else
LM's avatar
LM committed
318
	memcpy(slugs_navigation, _MAV_PAYLOAD(msg), 30);
lm's avatar
lm committed
319
#endif
James Goppert's avatar
James Goppert committed
320
}