ESP32

//------------------------------
// The fastMavlink library
// (c) OlliW, OlliW42, www.olliw.eu
//------------------------------

#pragma once
#ifndef FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_H
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_H


//----------------------------------------
//-- Message DEBUG_FLOAT_ARRAY
//----------------------------------------

// fields are ordered, as they appear on the wire
FASTMAVLINK_PACK(
typedef struct _fmav_debug_float_array_t {
    uint64_t time_usec;
    uint16_t array_id;
    char name[10];
    float data[58];
}) fmav_debug_float_array_t;


#define FASTMAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY  350

#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX  252
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_CRCEXTRA  232

#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FLAGS  0
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_TARGET_SYSTEM_OFS  0
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_TARGET_COMPONENT_OFS  0

#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FRAME_LEN_MAX  277

#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_NAME_NUM  10 // number of elements in array
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_NAME_LEN  10 // length of array = number of bytes
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_DATA_NUM  58 // number of elements in array
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_DATA_LEN  232 // length of array = number of bytes

#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_TIME_USEC_OFS  0
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_ARRAY_ID_OFS  8
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_NAME_OFS  10
#define FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_DATA_OFS  20


//----------------------------------------
//-- Message DEBUG_FLOAT_ARRAY pack,encode routines, for sending
//----------------------------------------

FASTMAVLINK_FUNCTION_DECORATOR uint16_t fmav_msg_debug_float_array_pack(
    fmav_message_t* _msg,
    uint8_t sysid,
    uint8_t compid,
    uint64_t time_usec, const char* name, uint16_t array_id, const float* data,
    fmav_status_t* _status)
{
    fmav_debug_float_array_t* _payload = (fmav_debug_float_array_t*)_msg->payload;

    _payload->time_usec = time_usec;
    _payload->array_id = array_id;
    memcpy(&(_payload->name), name, sizeof(char)*10);
    memcpy(&(_payload->data), data, sizeof(float)*58);

    _msg->sysid = sysid;
    _msg->compid = compid;
    _msg->msgid = FASTMAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY;
    _msg->target_sysid = 0;
    _msg->target_compid = 0;
    _msg->crc_extra = FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_CRCEXTRA;
    _msg->payload_max_len = FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX;

    return fmav_finalize_msg(_msg, _status);
}


FASTMAVLINK_FUNCTION_DECORATOR uint16_t fmav_msg_debug_float_array_encode(
    fmav_message_t* _msg,
    uint8_t sysid,
    uint8_t compid,
    const fmav_debug_float_array_t* _payload,
    fmav_status_t* _status)
{
    return fmav_msg_debug_float_array_pack(
        _msg, sysid, compid,
        _payload->time_usec, _payload->name, _payload->array_id, _payload->data,
        _status);
}


FASTMAVLINK_FUNCTION_DECORATOR uint16_t fmav_msg_debug_float_array_pack_to_frame_buf(
    uint8_t* _buf,
    uint8_t sysid,
    uint8_t compid,
    uint64_t time_usec, const char* name, uint16_t array_id, const float* data,
    fmav_status_t* _status)
{
    fmav_debug_float_array_t* _payload = (fmav_debug_float_array_t*)(&_buf[FASTMAVLINK_HEADER_V2_LEN]);

    _payload->time_usec = time_usec;
    _payload->array_id = array_id;
    memcpy(&(_payload->name), name, sizeof(char)*10);
    memcpy(&(_payload->data), data, sizeof(float)*58);

    _buf[5] = sysid;
    _buf[6] = compid;
    _buf[7] = (uint8_t)FASTMAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY;
    _buf[8] = ((uint32_t)FASTMAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY >> 8);
    _buf[9] = ((uint32_t)FASTMAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY >> 16);

    return fmav_finalize_frame_buf(
        _buf,
        FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX,
        FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_CRCEXTRA,
        _status);
}


FASTMAVLINK_FUNCTION_DECORATOR uint16_t fmav_msg_debug_float_array_encode_to_frame_buf(
    uint8_t* _buf,
    uint8_t sysid,
    uint8_t compid,
    const fmav_debug_float_array_t* _payload,
    fmav_status_t* _status)
{
    return fmav_msg_debug_float_array_pack_to_frame_buf(
        _buf, sysid, compid,
        _payload->time_usec, _payload->name, _payload->array_id, _payload->data,
        _status);
}


#ifdef FASTMAVLINK_SERIAL_WRITE_CHAR

FASTMAVLINK_FUNCTION_DECORATOR uint16_t fmav_msg_debug_float_array_pack_to_serial(
    uint8_t sysid,
    uint8_t compid,
    uint64_t time_usec, const char* name, uint16_t array_id, const float* data,
    fmav_status_t* _status)
{
    fmav_debug_float_array_t _payload;

    _payload.time_usec = time_usec;
    _payload.array_id = array_id;
    memcpy(&(_payload.name), name, sizeof(char)*10);
    memcpy(&(_payload.data), data, sizeof(float)*58);

    return fmav_finalize_serial(
        sysid,
        compid,
        (uint8_t*)&_payload,
        FASTMAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY,
        FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX,
        FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_CRCEXTRA,
        _status);
}


FASTMAVLINK_FUNCTION_DECORATOR uint16_t fmav_msg_debug_float_array_encode_to_serial(
    uint8_t sysid,
    uint8_t compid,
    const fmav_debug_float_array_t* _payload,
    fmav_status_t* _status)
{
    return fmav_finalize_serial(
        sysid,
        compid,
        (uint8_t*)_payload,
        FASTMAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY,
        FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX,
        FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_CRCEXTRA,
        _status);
}
#endif


//----------------------------------------
//-- Message DEBUG_FLOAT_ARRAY decode routines, for receiving
//----------------------------------------
// For these functions to work correctly, the msg payload must be zero-filled.
// Call the helper fmav_msg_zerofill() if needed, or set FASTMAVLINK_ALWAYS_ZEROFILL to 1
// Note that the parse functions do zero-fill the msg payload, but that message generator functions
// do not. This means that for the msg obtained from parsing the below functions can safely be used,
// but that this is not so for the msg obtained from pack/encode functions.

FASTMAVLINK_FUNCTION_DECORATOR void fmav_msg_debug_float_array_decode(fmav_debug_float_array_t* payload, const fmav_message_t* msg)
{
#if FASTMAVLINK_ALWAYS_ZEROFILL
    if (msg->len < FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX) {
        memcpy(payload, msg->payload, msg->len);
        // ensure that returned payload is zero-filled
        memset(&(((uint8_t*)payload)[msg->len]), 0, FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX - msg->len);
    } else {
        // note: msg->len can be larger than PAYLOAD_LEN_MAX if the message has unknown extensions
        memcpy(payload, msg->payload, FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX);
    }
#else
    // this requires that msg payload had been zero-filled before
    memcpy(payload, msg->payload, FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_PAYLOAD_LEN_MAX);
#endif
}


FASTMAVLINK_FUNCTION_DECORATOR uint64_t fmav_msg_debug_float_array_get_field_time_usec(const fmav_message_t* msg)
{
    uint64_t r;
    memcpy(&r, &(msg->payload[0]), sizeof(uint64_t));
    return r;
}


FASTMAVLINK_FUNCTION_DECORATOR uint16_t fmav_msg_debug_float_array_get_field_array_id(const fmav_message_t* msg)
{
    uint16_t r;
    memcpy(&r, &(msg->payload[8]), sizeof(uint16_t));
    return r;
}


FASTMAVLINK_FUNCTION_DECORATOR char* fmav_msg_debug_float_array_get_field_name_ptr(const fmav_message_t* msg)
{
    return (char*)&(msg->payload[10]);
}


FASTMAVLINK_FUNCTION_DECORATOR char fmav_msg_debug_float_array_get_field_name(uint16_t index, const fmav_message_t* msg)
{
    if (index >= FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_NAME_NUM) return 0;
    return ((char*)&(msg->payload[10]))[index];
}


FASTMAVLINK_FUNCTION_DECORATOR float* fmav_msg_debug_float_array_get_field_data_ptr(const fmav_message_t* msg)
{
    return (float*)&(msg->payload[20]);
}


FASTMAVLINK_FUNCTION_DECORATOR float fmav_msg_debug_float_array_get_field_data(uint16_t index, const fmav_message_t* msg)
{
    if (index >= FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_DATA_NUM) return 0;
    return ((float*)&(msg->payload[20]))[index];
}


//----------------------------------------
//-- Pymavlink wrappers
//----------------------------------------
#ifdef FASTMAVLINK_PYMAVLINK_ENABLED

#define MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY  350

#define mavlink_debug_float_array_t  fmav_debug_float_array_t

#define MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY_LEN  252
#define MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY_MIN_LEN  20
#define MAVLINK_MSG_ID_350_LEN  252
#define MAVLINK_MSG_ID_350_MIN_LEN  20

#define MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY_CRC  232
#define MAVLINK_MSG_ID_350_CRC  232

#define MAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_NAME_LEN 10
#define MAVLINK_MSG_DEBUG_FLOAT_ARRAY_FIELD_DATA_LEN 58


#if MAVLINK_COMM_NUM_BUFFERS > 0

FASTMAVLINK_FUNCTION_DECORATOR uint16_t mavlink_msg_debug_float_array_pack(
    uint8_t sysid,
    uint8_t compid,
    mavlink_message_t* _msg,
    uint64_t time_usec, const char* name, uint16_t array_id, const float* data)
{
    fmav_status_t* _status = mavlink_get_channel_status(MAVLINK_COMM_0);
    return fmav_msg_debug_float_array_pack(
        _msg, sysid, compid,
        time_usec, name, array_id, data,
        _status);
}


FASTMAVLINK_FUNCTION_DECORATOR uint16_t mavlink_msg_debug_float_array_encode(
    uint8_t sysid,
    uint8_t compid,
    mavlink_message_t* _msg,
    const mavlink_debug_float_array_t* _payload)
{
    return mavlink_msg_debug_float_array_pack(
        sysid,
        compid,
        _msg,
        _payload->time_usec, _payload->name, _payload->array_id, _payload->data);
}

#endif


FASTMAVLINK_FUNCTION_DECORATOR uint16_t mavlink_msg_debug_float_array_pack_txbuf(
    char* _buf,
    fmav_status_t* _status,
    uint8_t sysid,
    uint8_t compid,
    uint64_t time_usec, const char* name, uint16_t array_id, const float* data)
{
    return fmav_msg_debug_float_array_pack_to_frame_buf(
        (uint8_t*)_buf,
        sysid,
        compid,
        time_usec, name, array_id, data,
        _status);
}


FASTMAVLINK_FUNCTION_DECORATOR void mavlink_msg_debug_float_array_decode(const mavlink_message_t* msg, mavlink_debug_float_array_t* payload)
{
    fmav_msg_debug_float_array_decode(payload, msg);
}

#endif // FASTMAVLINK_PYMAVLINK_ENABLED


#endif // FASTMAVLINK_MSG_DEBUG_FLOAT_ARRAY_H