10 #ifdef NATIVE_BIG_ENDIAN 11 # define MAVLINK_NEED_BYTE_SWAP (MAVLINK_ENDIAN == MAVLINK_LITTLE_ENDIAN) 13 # define MAVLINK_NEED_BYTE_SWAP (MAVLINK_ENDIAN != MAVLINK_LITTLE_ENDIAN) 16 #ifndef MAVLINK_STACK_BUFFER 17 #define MAVLINK_STACK_BUFFER 0 20 #ifndef MAVLINK_AVOID_GCC_STACK_BUG 21 # define MAVLINK_AVOID_GCC_STACK_BUG defined(__GNUC__) 24 #ifndef MAVLINK_ASSERT 25 #define MAVLINK_ASSERT(x) 28 #ifndef MAVLINK_START_UART_SEND 29 #define MAVLINK_START_UART_SEND(chan, length) 32 #ifndef MAVLINK_END_UART_SEND 33 #define MAVLINK_END_UART_SEND(chan, length) 37 #ifdef MAVLINK_SEPARATE_HELPERS 39 #define MAVLINK_HELPER 42 #ifndef MAVLINK_GET_CHANNEL_STATUS 47 uint8_t chan, uint8_t min_length, uint8_t length, uint8_t crc_extra);
49 uint8_t min_length, uint8_t length, uint8_t crc_extra);
50 #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS 52 uint8_t min_length, uint8_t length, uint8_t crc_extra);
65 uint8_t* r_bit_index, uint8_t* buffer);
67 #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS 74 #define MAVLINK_HELPER static inline 77 #endif // MAVLINK_SEPARATE_HELPERS 92 #if MAVLINK_NEED_BYTE_SWAP 116 #elif !MAVLINK_ALIGNED_FIELDS 117 static inline void byte_copy_2(
char *dst,
const char *src)
122 static inline void byte_copy_4(
char *dst,
const char *src)
129 static inline void byte_copy_8(
char *dst,
const char *src)
135 #define _mav_put_uint8_t(buf, wire_offset, b) buf[wire_offset] = (uint8_t)b 136 #define _mav_put_int8_t(buf, wire_offset, b) buf[wire_offset] = (int8_t)b 137 #define _mav_put_char(buf, wire_offset, b) buf[wire_offset] = b 139 #if MAVLINK_NEED_BYTE_SWAP 140 #define _mav_put_uint16_t(buf, wire_offset, b) byte_swap_2(&buf[wire_offset], (const char *)&b) 141 #define _mav_put_int16_t(buf, wire_offset, b) byte_swap_2(&buf[wire_offset], (const char *)&b) 142 #define _mav_put_uint32_t(buf, wire_offset, b) byte_swap_4(&buf[wire_offset], (const char *)&b) 143 #define _mav_put_int32_t(buf, wire_offset, b) byte_swap_4(&buf[wire_offset], (const char *)&b) 144 #define _mav_put_uint64_t(buf, wire_offset, b) byte_swap_8(&buf[wire_offset], (const char *)&b) 145 #define _mav_put_int64_t(buf, wire_offset, b) byte_swap_8(&buf[wire_offset], (const char *)&b) 146 #define _mav_put_float(buf, wire_offset, b) byte_swap_4(&buf[wire_offset], (const char *)&b) 147 #define _mav_put_double(buf, wire_offset, b) byte_swap_8(&buf[wire_offset], (const char *)&b) 148 #elif !MAVLINK_ALIGNED_FIELDS 149 #define _mav_put_uint16_t(buf, wire_offset, b) byte_copy_2(&buf[wire_offset], (const char *)&b) 150 #define _mav_put_int16_t(buf, wire_offset, b) byte_copy_2(&buf[wire_offset], (const char *)&b) 151 #define _mav_put_uint32_t(buf, wire_offset, b) byte_copy_4(&buf[wire_offset], (const char *)&b) 152 #define _mav_put_int32_t(buf, wire_offset, b) byte_copy_4(&buf[wire_offset], (const char *)&b) 153 #define _mav_put_uint64_t(buf, wire_offset, b) byte_copy_8(&buf[wire_offset], (const char *)&b) 154 #define _mav_put_int64_t(buf, wire_offset, b) byte_copy_8(&buf[wire_offset], (const char *)&b) 155 #define _mav_put_float(buf, wire_offset, b) byte_copy_4(&buf[wire_offset], (const char *)&b) 156 #define _mav_put_double(buf, wire_offset, b) byte_copy_8(&buf[wire_offset], (const char *)&b) 158 #define _mav_put_uint16_t(buf, wire_offset, b) *(uint16_t *)&buf[wire_offset] = b 159 #define _mav_put_int16_t(buf, wire_offset, b) *(int16_t *)&buf[wire_offset] = b 160 #define _mav_put_uint32_t(buf, wire_offset, b) *(uint32_t *)&buf[wire_offset] = b 161 #define _mav_put_int32_t(buf, wire_offset, b) *(int32_t *)&buf[wire_offset] = b 162 #define _mav_put_uint64_t(buf, wire_offset, b) *(uint64_t *)&buf[wire_offset] = b 163 #define _mav_put_int64_t(buf, wire_offset, b) *(int64_t *)&buf[wire_offset] = b 164 #define _mav_put_float(buf, wire_offset, b) *(float *)&buf[wire_offset] = b 165 #define _mav_put_double(buf, wire_offset, b) *(double *)&buf[wire_offset] = b 176 memcpy(dest, src, n);
207 #if MAVLINK_NEED_BYTE_SWAP 208 #define _MAV_PUT_ARRAY(TYPE, V) \ 209 static inline void _mav_put_ ## TYPE ##_array(char *buf, uint8_t wire_offset, const TYPE *b, uint8_t array_length) \ 212 memset(&buf[wire_offset], 0, array_length*sizeof(TYPE)); \ 215 for (i=0; i<array_length; i++) { \ 216 _mav_put_## TYPE (buf, wire_offset+(i*sizeof(TYPE)), b[i]); \ 221 #define _MAV_PUT_ARRAY(TYPE, V) \ 222 static inline void _mav_put_ ## TYPE ##_array(char *buf, uint8_t wire_offset, const TYPE *b, uint8_t array_length) \ 224 mav_array_memcpy(&buf[wire_offset], b, array_length*sizeof(TYPE)); \ 237 #define _MAV_RETURN_char(msg, wire_offset) (char)_MAV_PAYLOAD(msg)[wire_offset] 238 #define _MAV_RETURN_int8_t(msg, wire_offset) (int8_t)_MAV_PAYLOAD(msg)[wire_offset] 239 #define _MAV_RETURN_uint8_t(msg, wire_offset) (uint8_t)_MAV_PAYLOAD(msg)[wire_offset] 241 #if MAVLINK_NEED_BYTE_SWAP 242 #define _MAV_MSG_RETURN_TYPE(TYPE, SIZE) \ 243 static inline TYPE _MAV_RETURN_## TYPE(const mavlink_message_t *msg, uint8_t ofs) \ 244 { TYPE r; byte_swap_## SIZE((char*)&r, &_MAV_PAYLOAD(msg)[ofs]); return r; } 255 #elif !MAVLINK_ALIGNED_FIELDS 256 #define _MAV_MSG_RETURN_TYPE(TYPE, SIZE) \ 257 static inline TYPE _MAV_RETURN_## TYPE(const mavlink_message_t *msg, uint8_t ofs) \ 258 { TYPE r; byte_copy_## SIZE((char*)&r, &_MAV_PAYLOAD(msg)[ofs]); return r; } 268 #else // nicely aligned, no swap 269 #define _MAV_MSG_RETURN_TYPE(TYPE) \ 270 static inline TYPE _MAV_RETURN_## TYPE(const mavlink_message_t *msg, uint8_t ofs) \ 271 { return *(const TYPE *)(&_MAV_PAYLOAD(msg)[ofs]);} 281 #endif // MAVLINK_NEED_BYTE_SWAP 284 uint8_t array_length, uint8_t wire_offset)
286 memcpy(value, &
_MAV_PAYLOAD(msg)[wire_offset], array_length);
291 uint8_t array_length, uint8_t wire_offset)
293 memcpy(value, &
_MAV_PAYLOAD(msg)[wire_offset], array_length);
298 uint8_t array_length, uint8_t wire_offset)
300 memcpy(value, &
_MAV_PAYLOAD(msg)[wire_offset], array_length);
304 #if MAVLINK_NEED_BYTE_SWAP 305 #define _MAV_RETURN_ARRAY(TYPE, V) \ 306 static inline uint16_t _MAV_RETURN_## TYPE ##_array(const mavlink_message_t *msg, TYPE *value, \ 307 uint8_t array_length, uint8_t wire_offset) \ 310 for (i=0; i<array_length; i++) { \ 311 value[i] = _MAV_RETURN_## TYPE (msg, wire_offset+(i*sizeof(value[0]))); \ 313 return array_length*sizeof(value[0]); \ 316 #define _MAV_RETURN_ARRAY(TYPE, V) \ 317 static inline uint16_t _MAV_RETURN_## TYPE ##_array(const mavlink_message_t *msg, TYPE *value, \ 318 uint8_t array_length, uint8_t wire_offset) \ 320 memcpy(value, &_MAV_PAYLOAD(msg)[wire_offset], array_length*sizeof(TYPE)); \ 321 return array_length*sizeof(TYPE); \ uint8_t magic
sent at end of packet
MAVLINK_HELPER void mavlink_start_checksum(mavlink_message_t *msg)
#define MAVLINK_STX_MAVLINK1
MAVLINK_HELPER uint8_t mavlink_frame_char(uint8_t chan, uint8_t c, mavlink_message_t *r_message, mavlink_status_t *r_mavlink_status)
#define MAVLINK_IFLAG_SIGNED
#define _MAV_PUT_ARRAY(TYPE, V)
static void _mav_put_int8_t_array(char *buf, uint8_t wire_offset, const int8_t *b, uint8_t array_length)
#define _MAV_MSG_RETURN_TYPE(TYPE, SIZE)
static uint16_t _MAV_RETURN_char_array(const mavlink_message_t *msg, char *value, uint8_t array_length, uint8_t wire_offset)
#define MAVLINK_NUM_NON_PAYLOAD_BYTES
#define MAVLINK_CORE_HEADER_MAVLINK1_LEN
Length of MAVLink1 core header (of the comm. layer)
MAVLINK_HELPER uint8_t put_bitfield_n_by_index(int32_t b, uint8_t bits, uint8_t packet_index, uint8_t bit_index, uint8_t *r_bit_index, uint8_t *buffer)
Put a bitfield of length 1-32 bit into the buffer.
MAVLINK_HELPER uint8_t mavlink_frame_char_buffer(mavlink_message_t *rxmsg, mavlink_status_t *status, uint8_t c, mavlink_message_t *r_message, mavlink_status_t *r_mavlink_status)
MAVLINK_HELPER void mavlink_update_checksum(mavlink_message_t *msg, uint8_t c)
static void _mav_put_char_array(char *buf, uint8_t wire_offset, const char *b, uint8_t array_length)
MAVLINK_HELPER uint16_t mavlink_finalize_message_chan(mavlink_message_t *msg, uint8_t system_id, uint8_t component_id, uint8_t chan, uint8_t length)
Finalize a MAVLink message with channel assignment.
static uint16_t mavlink_msg_get_send_buffer_length(const mavlink_message_t *msg)
Get the required buffer size for this message.
MAVLINK_HELPER mavlink_status_t * mavlink_get_channel_status(uint8_t chan)
static void _mav_put_uint8_t_array(char *buf, uint8_t wire_offset, const uint8_t *b, uint8_t array_length)
static void byte_swap_4(char *dst, const char *src)
MAVLINK_HELPER void _mav_finalize_message_chan_send(mavlink_channel_t chan, uint8_t msgid, const char *packet, uint8_t length)
#define _MAV_PAYLOAD(msg)
static void mav_array_memcpy(void *dest, const void *src, size_t n)
static uint16_t _MAV_RETURN_int8_t_array(const mavlink_message_t *msg, int8_t *value, uint8_t array_length, uint8_t wire_offset)
uint8_t len
Length of payload.
MAVLINK_HELPER void mavlink_reset_channel_status(uint8_t chan)
Reset the status of a channel.
MAVLINK_HELPER uint16_t mavlink_finalize_message(mavlink_message_t *msg, uint8_t system_id, uint8_t component_id, uint8_t length)
Finalize a MAVLink message with MAVLINK_COMM_0 as default channel.
#define _MAV_RETURN_ARRAY(TYPE, V)
MAVLINK_HELPER const mavlink_msg_entry_t * mavlink_get_msg_entry(uint32_t msgid)
static void byte_swap_8(char *dst, const char *src)
MAVLINK_HELPER uint8_t mavlink_parse_char(uint8_t chan, uint8_t c, mavlink_message_t *r_message, mavlink_status_t *r_mavlink_status)
MAVLINK_HELPER uint16_t mavlink_msg_to_send_buffer(uint8_t *buffer, const mavlink_message_t *msg)
Pack a message to send it over a serial byte stream.
static uint16_t _MAV_RETURN_uint8_t_array(const mavlink_message_t *msg, uint8_t *value, uint8_t array_length, uint8_t wire_offset)
static void byte_swap_2(char *dst, const char *src)
#define MAVLINK_SIGNATURE_BLOCK_LEN