lib/main/MAVLink/common/mavlink_msg_local_position_ned.h

   1 // MESSAGE LOCAL_POSITION_NED PACKING
   2
   3 #define MAVLINK_MSG_ID_LOCAL_POSITION_NED 32
   4
   5 typedef struct __mavlink_local_position_ned_t
   6 {
   7  uint32_t time_boot_ms; ///< Timestamp (milliseconds since system boot)
   8  float x; ///< X Position
   9  float y; ///< Y Position
  10  float z; ///< Z Position
  11  float vx; ///< X Speed
  12  float vy; ///< Y Speed
  13  float vz; ///< Z Speed
  14 } mavlink_local_position_ned_t;
  15
  16 #define MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN 28
  17 #define MAVLINK_MSG_ID_32_LEN 28
  18
  19 #define MAVLINK_MSG_ID_LOCAL_POSITION_NED_CRC 185
  20 #define MAVLINK_MSG_ID_32_CRC 185
  21
  22
  23
  24 #define MAVLINK_MESSAGE_INFO_LOCAL_POSITION_NED { \
  25         "LOCAL_POSITION_NED", \
  26         7, \
  27         {  { "time_boot_ms", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_local_position_ned_t, time_boot_ms) }, \
  28          { "x", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_local_position_ned_t, x) }, \
  29          { "y", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_local_position_ned_t, y) }, \
  30          { "z", NULL, MAVLINK_TYPE_FLOAT, 0, 12, offsetof(mavlink_local_position_ned_t, z) }, \
  31          { "vx", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_local_position_ned_t, vx) }, \
  32          { "vy", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_local_position_ned_t, vy) }, \
  33          { "vz", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_local_position_ned_t, vz) }, \
  34          } \
  35 }
  36
  37
  38 /**
  39  * @brief Pack a local_position_ned message
  40  * @param system_id ID of this system
  41  * @param component_id ID of this component (e.g. 200 for IMU)
  42  * @param msg The MAVLink message to compress the data into
  43  *
  44  * @param time_boot_ms Timestamp (milliseconds since system boot)
  45  * @param x X Position
  46  * @param y Y Position
  47  * @param z Z Position
  48  * @param vx X Speed
  49  * @param vy Y Speed
  50  * @param vz Z Speed
  51  * @return length of the message in bytes (excluding serial stream start sign)
  52  */
  53 static inline uint16_t mavlink_msg_local_position_ned_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  54                                                        uint32_t time_boot_ms, float x, float y, float z, float vx, float vy, float vz)
  55 {
  56 #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  57         char buf[MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN];
  58         _mav_put_uint32_t(buf, 0, time_boot_ms);
  59         _mav_put_float(buf, 4, x);
  60         _mav_put_float(buf, 8, y);
  61         _mav_put_float(buf, 12, z);
  62         _mav_put_float(buf, 16, vx);
  63         _mav_put_float(buf, 20, vy);
  64         _mav_put_float(buf, 24, vz);
  65
  66         memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
  67 #else
  68         mavlink_local_position_ned_t packet;
  69         packet.time_boot_ms = time_boot_ms;
  70         packet.x = x;
  71         packet.y = y;
  72         packet.z = z;
  73         packet.vx = vx;
  74         packet.vy = vy;
  75         packet.vz = vz;
  76
  77         memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
  78 #endif
  79
  80         msg->msgid = MAVLINK_MSG_ID_LOCAL_POSITION_NED;
  81 #if MAVLINK_CRC_EXTRA
  82     return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN, MAVLINK_MSG_ID_LOCAL_POSITION_NED_CRC);
  83 #else
  84     return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
  85 #endif
  86 }
  87
  88 /**
  89  * @brief Pack a local_position_ned message on a channel
  90  * @param system_id ID of this system
  91  * @param component_id ID of this component (e.g. 200 for IMU)
  92  * @param chan The MAVLink channel this message will be sent over
  93  * @param msg The MAVLink message to compress the data into
  94  * @param time_boot_ms Timestamp (milliseconds since system boot)
  95  * @param x X Position
  96  * @param y Y Position
  97  * @param z Z Position
  98  * @param vx X Speed
  99  * @param vy Y Speed
 100  * @param vz Z Speed
 101  * @return length of the message in bytes (excluding serial stream start sign)
 102  */
 103 static inline uint16_t mavlink_msg_local_position_ned_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
 104                                                            mavlink_message_t* msg,
 105                                                            uint32_t time_boot_ms,float x,float y,float z,float vx,float vy,float vz)
 106 {
 107 #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
 108         char buf[MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN];
 109         _mav_put_uint32_t(buf, 0, time_boot_ms);
 110         _mav_put_float(buf, 4, x);
 111         _mav_put_float(buf, 8, y);
 112         _mav_put_float(buf, 12, z);
 113         _mav_put_float(buf, 16, vx);
 114         _mav_put_float(buf, 20, vy);
 115         _mav_put_float(buf, 24, vz);
 116
 117         memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 118 #else
 119         mavlink_local_position_ned_t packet;
 120         packet.time_boot_ms = time_boot_ms;
 121         packet.x = x;
 122         packet.y = y;
 123         packet.z = z;
 124         packet.vx = vx;
 125         packet.vy = vy;
 126         packet.vz = vz;
 127
 128         memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 129 #endif
 130
 131         msg->msgid = MAVLINK_MSG_ID_LOCAL_POSITION_NED;
 132 #if MAVLINK_CRC_EXTRA
 133     return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN, MAVLINK_MSG_ID_LOCAL_POSITION_NED_CRC);
 134 #else
 135     return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 136 #endif
 137 }
 138
 139 /**
 140  * @brief Encode a local_position_ned struct
 141  *
 142  * @param system_id ID of this system
 143  * @param component_id ID of this component (e.g. 200 for IMU)
 144  * @param msg The MAVLink message to compress the data into
 145  * @param local_position_ned C-struct to read the message contents from
 146  */
 147 static inline uint16_t mavlink_msg_local_position_ned_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_local_position_ned_t* local_position_ned)
 148 {
 149         return mavlink_msg_local_position_ned_pack(system_id, component_id, msg, local_position_ned->time_boot_ms, local_position_ned->x, local_position_ned->y, local_position_ned->z, local_position_ned->vx, local_position_ned->vy, local_position_ned->vz);
 150 }
 151
 152 /**
 153  * @brief Encode a local_position_ned struct on a channel
 154  *
 155  * @param system_id ID of this system
 156  * @param component_id ID of this component (e.g. 200 for IMU)
 157  * @param chan The MAVLink channel this message will be sent over
 158  * @param msg The MAVLink message to compress the data into
 159  * @param local_position_ned C-struct to read the message contents from
 160  */
 161 static inline uint16_t mavlink_msg_local_position_ned_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_local_position_ned_t* local_position_ned)
 162 {
 163         return mavlink_msg_local_position_ned_pack_chan(system_id, component_id, chan, msg, local_position_ned->time_boot_ms, local_position_ned->x, local_position_ned->y, local_position_ned->z, local_position_ned->vx, local_position_ned->vy, local_position_ned->vz);
 164 }
 165
 166 /**
 167  * @brief Send a local_position_ned message
 168  * @param chan MAVLink channel to send the message
 169  *
 170  * @param time_boot_ms Timestamp (milliseconds since system boot)
 171  * @param x X Position
 172  * @param y Y Position
 173  * @param z Z Position
 174  * @param vx X Speed
 175  * @param vy Y Speed
 176  * @param vz Z Speed
 177  */
 178 #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
 179
 180 static inline void mavlink_msg_local_position_ned_send(mavlink_channel_t chan, uint32_t time_boot_ms, float x, float y, float z, float vx, float vy, float vz)
 181 {
 182 #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
 183         char buf[MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN];
 184         _mav_put_uint32_t(buf, 0, time_boot_ms);
 185         _mav_put_float(buf, 4, x);
 186         _mav_put_float(buf, 8, y);
 187         _mav_put_float(buf, 12, z);
 188         _mav_put_float(buf, 16, vx);
 189         _mav_put_float(buf, 20, vy);
 190         _mav_put_float(buf, 24, vz);
 191
 192 #if MAVLINK_CRC_EXTRA
 193     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, buf, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN, MAVLINK_MSG_ID_LOCAL_POSITION_NED_CRC);
 194 #else
 195     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, buf, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 196 #endif
 197 #else
 198         mavlink_local_position_ned_t packet;
 199         packet.time_boot_ms = time_boot_ms;
 200         packet.x = x;
 201         packet.y = y;
 202         packet.z = z;
 203         packet.vx = vx;
 204         packet.vy = vy;
 205         packet.vz = vz;
 206
 207 #if MAVLINK_CRC_EXTRA
 208     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, (const char *)&packet, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN, MAVLINK_MSG_ID_LOCAL_POSITION_NED_CRC);
 209 #else
 210     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, (const char *)&packet, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 211 #endif
 212 #endif
 213 }
 214
 215 #if MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN <= MAVLINK_MAX_PAYLOAD_LEN
 216 /*
 217   This varient of _send() can be used to save stack space by re-using
 218   memory from the receive buffer.  The caller provides a
 219   mavlink_message_t which is the size of a full mavlink message. This
 220   is usually the receive buffer for the channel, and allows a reply to an
 221   incoming message with minimum stack space usage.
 222  */
 223 static inline void mavlink_msg_local_position_ned_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan,  uint32_t time_boot_ms, float x, float y, float z, float vx, float vy, float vz)
 224 {
 225 #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
 226         char *buf = (char *)msgbuf;
 227         _mav_put_uint32_t(buf, 0, time_boot_ms);
 228         _mav_put_float(buf, 4, x);
 229         _mav_put_float(buf, 8, y);
 230         _mav_put_float(buf, 12, z);
 231         _mav_put_float(buf, 16, vx);
 232         _mav_put_float(buf, 20, vy);
 233         _mav_put_float(buf, 24, vz);
 234
 235 #if MAVLINK_CRC_EXTRA
 236     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, buf, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN, MAVLINK_MSG_ID_LOCAL_POSITION_NED_CRC);
 237 #else
 238     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, buf, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 239 #endif
 240 #else
 241         mavlink_local_position_ned_t *packet = (mavlink_local_position_ned_t *)msgbuf;
 242         packet->time_boot_ms = time_boot_ms;
 243         packet->x = x;
 244         packet->y = y;
 245         packet->z = z;
 246         packet->vx = vx;
 247         packet->vy = vy;
 248         packet->vz = vz;
 249
 250 #if MAVLINK_CRC_EXTRA
 251     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, (const char *)packet, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN, MAVLINK_MSG_ID_LOCAL_POSITION_NED_CRC);
 252 #else
 253     _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_LOCAL_POSITION_NED, (const char *)packet, MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 254 #endif
 255 #endif
 256 }
 257 #endif
 258
 259 #endif
 260
 261 // MESSAGE LOCAL_POSITION_NED UNPACKING
 262
 263
 264 /**
 265  * @brief Get field time_boot_ms from local_position_ned message
 266  *
 267  * @return Timestamp (milliseconds since system boot)
 268  */
 269 static inline uint32_t mavlink_msg_local_position_ned_get_time_boot_ms(const mavlink_message_t* msg)
 270 {
 271         return _MAV_RETURN_uint32_t(msg,  0);
 272 }
 273
 274 /**
 275  * @brief Get field x from local_position_ned message
 276  *
 277  * @return X Position
 278  */
 279 static inline float mavlink_msg_local_position_ned_get_x(const mavlink_message_t* msg)
 280 {
 281         return _MAV_RETURN_float(msg,  4);
 282 }
 283
 284 /**
 285  * @brief Get field y from local_position_ned message
 286  *
 287  * @return Y Position
 288  */
 289 static inline float mavlink_msg_local_position_ned_get_y(const mavlink_message_t* msg)
 290 {
 291         return _MAV_RETURN_float(msg,  8);
 292 }
 293
 294 /**
 295  * @brief Get field z from local_position_ned message
 296  *
 297  * @return Z Position
 298  */
 299 static inline float mavlink_msg_local_position_ned_get_z(const mavlink_message_t* msg)
 300 {
 301         return _MAV_RETURN_float(msg,  12);
 302 }
 303
 304 /**
 305  * @brief Get field vx from local_position_ned message
 306  *
 307  * @return X Speed
 308  */
 309 static inline float mavlink_msg_local_position_ned_get_vx(const mavlink_message_t* msg)
 310 {
 311         return _MAV_RETURN_float(msg,  16);
 312 }
 313
 314 /**
 315  * @brief Get field vy from local_position_ned message
 316  *
 317  * @return Y Speed
 318  */
 319 static inline float mavlink_msg_local_position_ned_get_vy(const mavlink_message_t* msg)
 320 {
 321         return _MAV_RETURN_float(msg,  20);
 322 }
 323
 324 /**
 325  * @brief Get field vz from local_position_ned message
 326  *
 327  * @return Z Speed
 328  */
 329 static inline float mavlink_msg_local_position_ned_get_vz(const mavlink_message_t* msg)
 330 {
 331         return _MAV_RETURN_float(msg,  24);
 332 }
 333
 334 /**
 335  * @brief Decode a local_position_ned message into a struct
 336  *
 337  * @param msg The message to decode
 338  * @param local_position_ned C-struct to decode the message contents into
 339  */
 340 static inline void mavlink_msg_local_position_ned_decode(const mavlink_message_t* msg, mavlink_local_position_ned_t* local_position_ned)
 341 {
 342 #if MAVLINK_NEED_BYTE_SWAP
 343         local_position_ned->time_boot_ms = mavlink_msg_local_position_ned_get_time_boot_ms(msg);
 344         local_position_ned->x = mavlink_msg_local_position_ned_get_x(msg);
 345         local_position_ned->y = mavlink_msg_local_position_ned_get_y(msg);
 346         local_position_ned->z = mavlink_msg_local_position_ned_get_z(msg);
 347         local_position_ned->vx = mavlink_msg_local_position_ned_get_vx(msg);
 348         local_position_ned->vy = mavlink_msg_local_position_ned_get_vy(msg);
 349         local_position_ned->vz = mavlink_msg_local_position_ned_get_vz(msg);
 350 #else
 351         memcpy(local_position_ned, _MAV_PAYLOAD(msg), MAVLINK_MSG_ID_LOCAL_POSITION_NED_LEN);
 352 #endif
 353 }