tdf.h

Go to the documentation of this file.

 
#ifndef INFUSE_SDK_INCLUDE_INFUSE_TDF_TDF_H_
#define INFUSE_SDK_INCLUDE_INFUSE_TDF_TDF_H_
 
#include <stdint.h>
 
#include <zephyr/net_buf.h>
 
#ifdef __cplusplus
extern "C" {
#endif


struct tdf_buffer_state {
        uint64_t time;
        struct net_buf_simple buf;
};

enum tdf_data_format {
        TDF_DATA_FORMAT_SINGLE,
        TDF_DATA_FORMAT_TIME_ARRAY,
        TDF_DATA_FORMAT_IDX_ARRAY,
        TDF_DATA_FORMAT_DIFF_ARRAY_16_8,
        TDF_DATA_FORMAT_DIFF_ARRAY_32_8,
        TDF_DATA_FORMAT_DIFF_ARRAY_32_16,
        TDF_DATA_FORMAT_INVALID,
        TDF_DATA_FORMAT_DIFF_PRECOMPUTED = 0x80,
} __packed;

struct tdf_parsed {
        uint64_t time;
        uint16_t tdf_id;
        uint8_t tdf_len;
        enum tdf_data_format data_type;
        union {
                uint8_t tdf_num;
                struct {
                        uint8_t num;
                } diff_info;
        };
        union {
                uint32_t period;
                uint16_t base_idx;
        };
        void *data;
};

enum tdf_flags {
        TDF_TIMESTAMP_NONE = 0x0000,
        TDF_TIMESTAMP_ABSOLUTE = 0x4000,
        TDF_TIMESTAMP_RELATIVE = 0x8000,
        TDF_TIMESTAMP_EXTENDED_RELATIVE = 0xC000,
        TDF_ARRAY_NONE = 0x0000,
        TDF_ARRAY_TIME = 0x1000,
        TDF_ARRAY_DIFF = 0x2000,
        TDF_ARRAY_IDX = 0x3000,
        TDF_FLAGS_MASK = 0xF000,
        TDF_TIMESTAMP_MASK = 0xC000,
        TDF_ARRAY_MASK = 0x3000,
        TDF_ID_MASK = 0x0FFF,
};

#define TDF_TYPE(tdf_id) _##tdf_id##_TYPE

#define TDF_ADD(state, tdf_id, tdf_num, base_time, period, data)                                   \
        tdf_add(state, tdf_id, sizeof(TDF_TYPE(tdf_id)), tdf_num, base_time, period, data);        \
        do {                                                                                       \
                __maybe_unused const TDF_TYPE(tdf_id) *_data = data;                               \
        } while (0)

static inline void tdf_buffer_state_reset(struct tdf_buffer_state *state)
{
        net_buf_simple_reset(&state->buf);
        state->time = 0;
}

int tdf_add_core(struct tdf_buffer_state *state, uint16_t tdf_id, uint8_t tdf_len, uint8_t tdf_num,
                 uint64_t time, uint32_t idx_period, const void *data, enum tdf_data_format format);

static inline int tdf_add(struct tdf_buffer_state *state, uint16_t tdf_id, uint8_t tdf_len,
                          uint8_t tdf_num, uint64_t time, uint32_t period, const void *data)
{
        enum tdf_data_format format =
                tdf_num > 1 ? TDF_DATA_FORMAT_TIME_ARRAY : TDF_DATA_FORMAT_SINGLE;
 
        return tdf_add_core(state, tdf_id, tdf_len, tdf_num, time, period, data, format);
}

static inline void tdf_parse_start(struct tdf_buffer_state *state, const void *data, size_t size)
{
        /* While net_buf_simple as a generic object can modify the provided data pointer,
         * the tdf_parse functions only use read-only functions (net_buf_simple_pull_*).
         */
        net_buf_simple_init_with_data(&state->buf, (void *)data, size);
        state->time = 0;
}

int tdf_parse(struct tdf_buffer_state *state, struct tdf_parsed *parsed);

static inline int tdf_parse_find_in_buf(const void *data, size_t size, uint16_t tdf_id,
                                        struct tdf_parsed *parsed)
{
        struct tdf_buffer_state state;
 
        tdf_parse_start(&state, data, size);
        while (tdf_parse(&state, parsed) == 0) {
                if (parsed->tdf_id == tdf_id) {
                        return 0;
                }
        }
        return -ENOMEM;
}

int tdf_parse_diff_reconstruct(const struct tdf_parsed *parsed, void *output, uint8_t idx);

 
#ifdef __cplusplus
}
#endif
 
#endif /* INFUSE_SDK_INCLUDE_INFUSE_TDF_TDF_H_ */