|
|
|
@ -1,6 +1,6 @@ |
|
|
|
|
//---------------------------------------------------------------------------
|
|
|
|
|
#include "TinyFrame.h" |
|
|
|
|
#include <string.h> |
|
|
|
|
#include <malloc.h> |
|
|
|
|
//---------------------------------------------------------------------------
|
|
|
|
|
|
|
|
|
|
// Compatibility with ESP8266 SDK
|
|
|
|
@ -14,71 +14,9 @@ |
|
|
|
|
#define TF_MAX(a, b) ((a)>(b)?(a):(b)) |
|
|
|
|
#define TF_MIN(a, b) ((a)<(b)?(a):(b)) |
|
|
|
|
|
|
|
|
|
enum TFState { |
|
|
|
|
TFState_SOF = 0, //!< Wait for SOF
|
|
|
|
|
TFState_LEN, //!< Wait for Number Of Bytes
|
|
|
|
|
TFState_HEAD_CKSUM, //!< Wait for header Checksum
|
|
|
|
|
TFState_ID, //!< Wait for ID
|
|
|
|
|
TFState_TYPE, //!< Wait for message type
|
|
|
|
|
TFState_DATA, //!< Receive payload
|
|
|
|
|
TFState_DATA_CKSUM //!< Wait for Checksum
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
typedef struct _IdListener_struct_ { |
|
|
|
|
TF_ID id; |
|
|
|
|
TF_Listener fn; |
|
|
|
|
TF_TICKS timeout; // nr of ticks remaining to disable this listener
|
|
|
|
|
TF_TICKS timeout_max; // the original timeout is stored here
|
|
|
|
|
void *userdata; |
|
|
|
|
void *userdata2; |
|
|
|
|
} IdListener; |
|
|
|
|
|
|
|
|
|
typedef struct _TypeListener_struct_ { |
|
|
|
|
TF_TYPE type; |
|
|
|
|
TF_Listener fn; |
|
|
|
|
} TypeListener; |
|
|
|
|
|
|
|
|
|
typedef struct _GenericListener_struct_ { |
|
|
|
|
TF_Listener fn; |
|
|
|
|
} GenericListener; |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Frame parser internal state |
|
|
|
|
*/ |
|
|
|
|
static struct TinyFrameStruct { |
|
|
|
|
/* Own state */ |
|
|
|
|
TF_Peer peer_bit; //!< Own peer bit (unqiue to avoid msg ID clash)
|
|
|
|
|
TF_ID next_id; //!< Next frame / frame chain ID
|
|
|
|
|
|
|
|
|
|
/* Parser state */ |
|
|
|
|
enum TFState state; |
|
|
|
|
TF_TICKS parser_timeout_ticks; |
|
|
|
|
TF_ID id; //!< Incoming packet ID
|
|
|
|
|
TF_LEN len; //!< Payload length
|
|
|
|
|
uint8_t data[TF_MAX_PAYLOAD_RX]; //!< Data byte buffer
|
|
|
|
|
TF_LEN rxi; //!< Field size byte counter
|
|
|
|
|
TF_CKSUM cksum; //!< Checksum calculated of the data stream
|
|
|
|
|
TF_CKSUM ref_cksum; //!< Reference checksum read from the message
|
|
|
|
|
TF_TYPE type; //!< Collected message type number
|
|
|
|
|
bool discard_data; //!< Set if (len > TF_MAX_PAYLOAD) to read the frame, but ignore the data.
|
|
|
|
|
|
|
|
|
|
/* --- Callbacks --- */ |
|
|
|
|
|
|
|
|
|
/* Transaction callbacks */ |
|
|
|
|
IdListener id_listeners[TF_MAX_ID_LST]; |
|
|
|
|
TypeListener type_listeners[TF_MAX_TYPE_LST]; |
|
|
|
|
GenericListener generic_listeners[TF_MAX_GEN_LST]; |
|
|
|
|
|
|
|
|
|
// Those counters are used to optimize look-up times.
|
|
|
|
|
// They point to the highest used slot number,
|
|
|
|
|
// or close to it, depending on the removal order.
|
|
|
|
|
TF_COUNT count_id_lst; |
|
|
|
|
TF_COUNT count_type_lst; |
|
|
|
|
TF_COUNT count_generic_lst; |
|
|
|
|
|
|
|
|
|
// Buffer for building frames
|
|
|
|
|
uint8_t sendbuf[TF_SENDBUF_LEN]; |
|
|
|
|
} tf; |
|
|
|
|
// TODO It would be nice to have per-instance configurable checksum types, but that would
|
|
|
|
|
// mandate configurable field sizes unless we use u32 everywhere (and possibly shorten
|
|
|
|
|
// it when encoding to the buffer). I don't really like this idea so much. -MP
|
|
|
|
|
|
|
|
|
|
//region Checksums
|
|
|
|
|
|
|
|
|
@ -98,6 +36,7 @@ static struct TinyFrameStruct { |
|
|
|
|
|
|
|
|
|
#elif TF_CKSUM_TYPE == TF_CKSUM_CRC16 |
|
|
|
|
|
|
|
|
|
// TODO try to replace with an algorithm
|
|
|
|
|
/** CRC table for the CRC-16. The poly is 0x8005 (x^16 + x^15 + x^2 + 1) */ |
|
|
|
|
static const uint16_t crc16_table[256] = { |
|
|
|
|
0x0000, 0xC0C1, 0xC181, 0x0140, 0xC301, 0x03C0, 0x0280, 0xC241, |
|
|
|
@ -145,6 +84,7 @@ static inline uint16_t crc16_byte(uint16_t cksum, const uint8_t byte) |
|
|
|
|
|
|
|
|
|
#elif TF_CKSUM_TYPE == TF_CKSUM_CRC32 |
|
|
|
|
|
|
|
|
|
// TODO try to replace with an algorithm
|
|
|
|
|
static const uint32_t crc32_table[] = { /* CRC polynomial 0xedb88320 */ |
|
|
|
|
0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419, 0x706af48f, |
|
|
|
|
0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988, |
|
|
|
@ -204,28 +144,41 @@ static inline uint32_t crc32_byte(uint32_t cksum, const uint8_t byte) |
|
|
|
|
|
|
|
|
|
//endregion
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void _TF_FN TF_Init(TF_Peer peer_bit) |
|
|
|
|
/** Init with a user-allocated buffer */ |
|
|
|
|
void _TF_FN TF_InitStatic(TinyFrame *tf, TF_Peer peer_bit) |
|
|
|
|
{ |
|
|
|
|
// Zero it out
|
|
|
|
|
memset(&tf, 0, sizeof(struct TinyFrameStruct)); |
|
|
|
|
if (tf == NULL) return; |
|
|
|
|
|
|
|
|
|
tf.peer_bit = peer_bit; |
|
|
|
|
// Zero it out, keeping user config
|
|
|
|
|
uint32_t usertag = tf->usertag; |
|
|
|
|
void * userdata = tf->userdata; |
|
|
|
|
|
|
|
|
|
memset(tf, 0, sizeof(struct TinyFrame_)); |
|
|
|
|
|
|
|
|
|
tf->usertag = usertag; |
|
|
|
|
tf->userdata = userdata; |
|
|
|
|
|
|
|
|
|
tf->peer_bit = peer_bit; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** Init with malloc */ |
|
|
|
|
TinyFrame * _TF_FN TF_Init(TF_Peer peer_bit) |
|
|
|
|
{ |
|
|
|
|
TinyFrame *tf = malloc(sizeof(TinyFrame)); |
|
|
|
|
TF_InitStatic(tf, peer_bit); |
|
|
|
|
return tf; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
//region Listeners
|
|
|
|
|
|
|
|
|
|
static void _TF_FN renew_id_listener(IdListener *lst) |
|
|
|
|
/** Reset ID listener's timeout to the original value */ |
|
|
|
|
static inline void _TF_FN renew_id_listener(struct TF_IdListener_ *lst) |
|
|
|
|
{ |
|
|
|
|
lst->timeout = lst->timeout_max; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Notify callback about ID listener demise & clean it |
|
|
|
|
* |
|
|
|
|
* @param lst - listener to clean |
|
|
|
|
*/ |
|
|
|
|
static void _TF_FN cleanup_id_listener(TF_COUNT i, IdListener *lst) |
|
|
|
|
/** Notify callback about ID listener's demise & let it free any resources in userdata */ |
|
|
|
|
static void _TF_FN cleanup_id_listener(TinyFrame *tf, TF_COUNT i, struct TF_IdListener_ *lst) |
|
|
|
|
{ |
|
|
|
|
TF_Msg msg; |
|
|
|
|
if (lst->fn == NULL) return; |
|
|
|
@ -235,48 +188,41 @@ static void _TF_FN cleanup_id_listener(TF_COUNT i, IdListener *lst) |
|
|
|
|
msg.userdata = lst->userdata; |
|
|
|
|
msg.userdata2 = lst->userdata2; |
|
|
|
|
msg.data = NULL; // this is a signal that the listener should clean up
|
|
|
|
|
lst->fn(&msg); // return value is ignored here - use TF_STAY or TF_CLOSE
|
|
|
|
|
lst->fn(tf, &msg); // return value is ignored here - use TF_STAY or TF_CLOSE
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
lst->fn = NULL; // Discard listener
|
|
|
|
|
|
|
|
|
|
if (i == tf.count_id_lst - 1) { |
|
|
|
|
tf.count_id_lst--; |
|
|
|
|
if (i == tf->count_id_lst - 1) { |
|
|
|
|
tf->count_id_lst--; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Clean up Type listener |
|
|
|
|
* |
|
|
|
|
* @param lst - listener to clean |
|
|
|
|
*/ |
|
|
|
|
static inline void _TF_FN cleanup_type_listener(TF_COUNT i, TypeListener *lst) |
|
|
|
|
/** Clean up Type listener */ |
|
|
|
|
static inline void _TF_FN cleanup_type_listener(TinyFrame *tf, TF_COUNT i, struct TF_TypeListener_ *lst) |
|
|
|
|
{ |
|
|
|
|
lst->fn = NULL; // Discard listener
|
|
|
|
|
if (i == tf.count_type_lst - 1) { |
|
|
|
|
tf.count_type_lst--; |
|
|
|
|
if (i == tf->count_type_lst - 1) { |
|
|
|
|
tf->count_type_lst--; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Clean up Generic listener |
|
|
|
|
* |
|
|
|
|
* @param lst - listener to clean |
|
|
|
|
*/ |
|
|
|
|
static inline void _TF_FN cleanup_generic_listener(TF_COUNT i, GenericListener *lst) |
|
|
|
|
/** Clean up Generic listener */ |
|
|
|
|
static inline void _TF_FN cleanup_generic_listener(TinyFrame *tf, TF_COUNT i, struct TF_GenericListener_ *lst) |
|
|
|
|
{ |
|
|
|
|
lst->fn = NULL; // Discard listener
|
|
|
|
|
if (i == tf.count_generic_lst - 1) { |
|
|
|
|
tf.count_generic_lst--; |
|
|
|
|
if (i == tf->count_generic_lst - 1) { |
|
|
|
|
tf->count_generic_lst--; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool _TF_FN TF_AddIdListener(TF_Msg *msg, TF_Listener cb, TF_TICKS timeout) |
|
|
|
|
/** Add a new ID listener. Returns 1 on success. */ |
|
|
|
|
bool _TF_FN TF_AddIdListener(TinyFrame *tf, TF_Msg *msg, TF_Listener cb, TF_TICKS timeout) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
IdListener *lst; |
|
|
|
|
struct TF_IdListener_ *lst; |
|
|
|
|
for (i = 0; i < TF_MAX_ID_LST; i++) { |
|
|
|
|
lst = &tf.id_listeners[i]; |
|
|
|
|
lst = &tf->id_listeners[i]; |
|
|
|
|
// test for empty slot
|
|
|
|
|
if (lst->fn == NULL) { |
|
|
|
|
lst->fn = cb; |
|
|
|
@ -284,8 +230,8 @@ bool _TF_FN TF_AddIdListener(TF_Msg *msg, TF_Listener cb, TF_TICKS timeout) |
|
|
|
|
lst->userdata = msg->userdata; |
|
|
|
|
lst->userdata2 = msg->userdata2; |
|
|
|
|
lst->timeout_max = lst->timeout = timeout; |
|
|
|
|
if (i >= tf.count_id_lst) { |
|
|
|
|
tf.count_id_lst = (TF_COUNT) (i + 1); |
|
|
|
|
if (i >= tf->count_id_lst) { |
|
|
|
|
tf->count_id_lst = (TF_COUNT) (i + 1); |
|
|
|
|
} |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
@ -293,18 +239,19 @@ bool _TF_FN TF_AddIdListener(TF_Msg *msg, TF_Listener cb, TF_TICKS timeout) |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool _TF_FN TF_AddTypeListener(TF_TYPE frame_type, TF_Listener cb) |
|
|
|
|
/** Add a new Type listener. Returns 1 on success. */ |
|
|
|
|
bool _TF_FN TF_AddTypeListener(TinyFrame *tf, TF_TYPE frame_type, TF_Listener cb) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
TypeListener *lst; |
|
|
|
|
struct TF_TypeListener_ *lst; |
|
|
|
|
for (i = 0; i < TF_MAX_TYPE_LST; i++) { |
|
|
|
|
lst = &tf.type_listeners[i]; |
|
|
|
|
lst = &tf->type_listeners[i]; |
|
|
|
|
// test for empty slot
|
|
|
|
|
if (lst->fn == NULL) { |
|
|
|
|
lst->fn = cb; |
|
|
|
|
lst->type = frame_type; |
|
|
|
|
if (i >= tf.count_type_lst) { |
|
|
|
|
tf.count_type_lst = (TF_COUNT) (i + 1); |
|
|
|
|
if (i >= tf->count_type_lst) { |
|
|
|
|
tf->count_type_lst = (TF_COUNT) (i + 1); |
|
|
|
|
} |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
@ -312,17 +259,18 @@ bool _TF_FN TF_AddTypeListener(TF_TYPE frame_type, TF_Listener cb) |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool _TF_FN TF_AddGenericListener(TF_Listener cb) |
|
|
|
|
/** Add a new Generic listener. Returns 1 on success. */ |
|
|
|
|
bool _TF_FN TF_AddGenericListener(TinyFrame *tf, TF_Listener cb) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
GenericListener *lst; |
|
|
|
|
struct TF_GenericListener_ *lst; |
|
|
|
|
for (i = 0; i < TF_MAX_GEN_LST; i++) { |
|
|
|
|
lst = &tf.generic_listeners[i]; |
|
|
|
|
lst = &tf->generic_listeners[i]; |
|
|
|
|
// test for empty slot
|
|
|
|
|
if (lst->fn == NULL) { |
|
|
|
|
lst->fn = cb; |
|
|
|
|
if (i >= tf.count_generic_lst) { |
|
|
|
|
tf.count_generic_lst = (TF_COUNT) (i + 1); |
|
|
|
|
if (i >= tf->count_generic_lst) { |
|
|
|
|
tf->count_generic_lst = (TF_COUNT) (i + 1); |
|
|
|
|
} |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
@ -330,45 +278,48 @@ bool _TF_FN TF_AddGenericListener(TF_Listener cb) |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool _TF_FN TF_RemoveIdListener(TF_ID frame_id) |
|
|
|
|
/** Remove a ID listener by its frame ID. Returns 1 on success. */ |
|
|
|
|
bool _TF_FN TF_RemoveIdListener(TinyFrame *tf, TF_ID frame_id) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
IdListener *lst; |
|
|
|
|
for (i = 0; i < tf.count_id_lst; i++) { |
|
|
|
|
lst = &tf.id_listeners[i]; |
|
|
|
|
struct TF_IdListener_ *lst; |
|
|
|
|
for (i = 0; i < tf->count_id_lst; i++) { |
|
|
|
|
lst = &tf->id_listeners[i]; |
|
|
|
|
// test if live & matching
|
|
|
|
|
if (lst->fn != NULL && lst->id == frame_id) { |
|
|
|
|
cleanup_id_listener(i, lst); |
|
|
|
|
cleanup_id_listener(tf, i, lst); |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool _TF_FN TF_RemoveTypeListener(TF_TYPE type) |
|
|
|
|
/** Remove a type listener by its type. Returns 1 on success. */ |
|
|
|
|
bool _TF_FN TF_RemoveTypeListener(TinyFrame *tf, TF_TYPE type) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
TypeListener *lst; |
|
|
|
|
for (i = 0; i < tf.count_type_lst; i++) { |
|
|
|
|
lst = &tf.type_listeners[i]; |
|
|
|
|
struct TF_TypeListener_ *lst; |
|
|
|
|
for (i = 0; i < tf->count_type_lst; i++) { |
|
|
|
|
lst = &tf->type_listeners[i]; |
|
|
|
|
// test if live & matching
|
|
|
|
|
if (lst->fn != NULL && lst->type == type) { |
|
|
|
|
cleanup_type_listener(i, lst); |
|
|
|
|
cleanup_type_listener(tf, i, lst); |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool _TF_FN TF_RemoveGenericListener(TF_Listener cb) |
|
|
|
|
/** Remove a generic listener by its function pointer. Returns 1 on success. */ |
|
|
|
|
bool _TF_FN TF_RemoveGenericListener(TinyFrame *tf, TF_Listener cb) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
GenericListener *lst; |
|
|
|
|
for (i = 0; i < tf.count_generic_lst; i++) { |
|
|
|
|
lst = &tf.generic_listeners[i]; |
|
|
|
|
struct TF_GenericListener_ *lst; |
|
|
|
|
for (i = 0; i < tf->count_generic_lst; i++) { |
|
|
|
|
lst = &tf->generic_listeners[i]; |
|
|
|
|
// test if live & matching
|
|
|
|
|
if (lst->fn == cb) { |
|
|
|
|
cleanup_generic_listener(i, lst); |
|
|
|
|
cleanup_generic_listener(tf, i, lst); |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
@ -376,80 +327,78 @@ bool _TF_FN TF_RemoveGenericListener(TF_Listener cb) |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** Handle a message that was just collected & verified by the parser */ |
|
|
|
|
static void _TF_FN TF_HandleReceivedMessage(void) |
|
|
|
|
static void _TF_FN TF_HandleReceivedMessage(TinyFrame *tf) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
IdListener *ilst; |
|
|
|
|
TypeListener *tlst; |
|
|
|
|
GenericListener *glst; |
|
|
|
|
struct TF_IdListener_ *ilst; |
|
|
|
|
struct TF_TypeListener_ *tlst; |
|
|
|
|
struct TF_GenericListener_ *glst; |
|
|
|
|
TF_Result res; |
|
|
|
|
|
|
|
|
|
// Prepare message object
|
|
|
|
|
TF_Msg msg; |
|
|
|
|
msg.frame_id = tf.id; |
|
|
|
|
TF_ClearMsg(&msg); |
|
|
|
|
msg.frame_id = tf->id; |
|
|
|
|
msg.is_response = false; |
|
|
|
|
msg.type = tf.type; |
|
|
|
|
msg.data = tf.data; |
|
|
|
|
msg.len = tf.len; |
|
|
|
|
msg.type = tf->type; |
|
|
|
|
msg.data = tf->data; |
|
|
|
|
msg.len = tf->len; |
|
|
|
|
|
|
|
|
|
//dumpFrameInfo(&msg);
|
|
|
|
|
|
|
|
|
|
// Any listener can consume the message (return true),
|
|
|
|
|
// or let someone else handle it.
|
|
|
|
|
// Any listener can consume the message, or let someone else handle it.
|
|
|
|
|
|
|
|
|
|
// The loop upper bounds are the highest currently used slot index
|
|
|
|
|
// (or close to it, depending on the order of listener removals)
|
|
|
|
|
// (or close to it, depending on the order of listener removals).
|
|
|
|
|
|
|
|
|
|
// ID listeners first
|
|
|
|
|
for (i = 0; i < tf.count_id_lst; i++) { |
|
|
|
|
ilst = &tf.id_listeners[i]; |
|
|
|
|
for (i = 0; i < tf->count_id_lst; i++) { |
|
|
|
|
ilst = &tf->id_listeners[i]; |
|
|
|
|
|
|
|
|
|
if (ilst->fn && ilst->id == msg.frame_id) { |
|
|
|
|
msg.userdata = ilst->userdata; // pass userdata pointer to the callback
|
|
|
|
|
msg.userdata2 = ilst->userdata2; |
|
|
|
|
res = ilst->fn(&msg); |
|
|
|
|
res = ilst->fn(tf, &msg); |
|
|
|
|
ilst->userdata = msg.userdata; // put it back (may have changed the pointer or set to NULL)
|
|
|
|
|
ilst->userdata2 = msg.userdata2; // put it back (may have changed the pointer or set to NULL)
|
|
|
|
|
|
|
|
|
|
if (res != TF_NEXT) { |
|
|
|
|
if (res == TF_CLOSE) { |
|
|
|
|
cleanup_id_listener(i, ilst); |
|
|
|
|
} |
|
|
|
|
else if (res == TF_RENEW) { |
|
|
|
|
// if it's TF_CLOSE, we assume user already cleaned up userdata
|
|
|
|
|
if (res == TF_RENEW) { |
|
|
|
|
renew_id_listener(ilst); |
|
|
|
|
} |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
// clean up for the following listeners that don't use userdata (this avoids data from
|
|
|
|
|
// an ID listener that returned TF_NEXT from leaking into Type and Generic listeners)
|
|
|
|
|
msg.userdata = NULL; |
|
|
|
|
msg.userdata2 = NULL; |
|
|
|
|
// clean up for the following listeners that don't use userdata
|
|
|
|
|
|
|
|
|
|
// Type listeners
|
|
|
|
|
for (i = 0; i < tf.count_type_lst; i++) { |
|
|
|
|
tlst = &tf.type_listeners[i]; |
|
|
|
|
for (i = 0; i < tf->count_type_lst; i++) { |
|
|
|
|
tlst = &tf->type_listeners[i]; |
|
|
|
|
|
|
|
|
|
if (tlst->fn && tlst->type == msg.type) { |
|
|
|
|
res = tlst->fn(&msg); |
|
|
|
|
res = tlst->fn(tf, &msg); |
|
|
|
|
|
|
|
|
|
if (res != TF_NEXT) { |
|
|
|
|
if (res == TF_CLOSE) { |
|
|
|
|
cleanup_type_listener(i, tlst); |
|
|
|
|
} |
|
|
|
|
// if it's TF_CLOSE, we assume user already cleaned up userdata
|
|
|
|
|
// TF_RENEW doesn't make sense here because type listeners don't expire
|
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Generic listeners
|
|
|
|
|
for (i = 0; i < tf.count_generic_lst; i++) { |
|
|
|
|
glst = &tf.generic_listeners[i]; |
|
|
|
|
for (i = 0; i < tf->count_generic_lst; i++) { |
|
|
|
|
glst = &tf->generic_listeners[i]; |
|
|
|
|
|
|
|
|
|
if (glst->fn) { |
|
|
|
|
res = glst->fn(&msg); |
|
|
|
|
res = glst->fn(tf, &msg); |
|
|
|
|
|
|
|
|
|
if (res != TF_NEXT) { |
|
|
|
|
if (res == TF_CLOSE) { |
|
|
|
|
cleanup_generic_listener(i, glst); |
|
|
|
|
} |
|
|
|
|
// if it's TF_CLOSE, we assume user already cleaned up userdata
|
|
|
|
|
// TF_RENEW doesn't make sense here because generic listeners don't expire
|
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
@ -458,173 +407,206 @@ static void _TF_FN TF_HandleReceivedMessage(void) |
|
|
|
|
|
|
|
|
|
//endregion Listeners
|
|
|
|
|
|
|
|
|
|
void _TF_FN TF_Accept(const uint8_t *buffer, size_t count) |
|
|
|
|
/** Handle a received byte buffer */ |
|
|
|
|
void _TF_FN TF_Accept(TinyFrame *tf, const uint8_t *buffer, size_t count) |
|
|
|
|
{ |
|
|
|
|
size_t i; |
|
|
|
|
for (i = 0; i < count; i++) { |
|
|
|
|
TF_AcceptChar(buffer[i]); |
|
|
|
|
TF_AcceptChar(tf, buffer[i]); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void _TF_FN TF_ResetParser(void) |
|
|
|
|
/** Reset the parser's internal state. */ |
|
|
|
|
void _TF_FN TF_ResetParser(TinyFrame *tf) |
|
|
|
|
{ |
|
|
|
|
tf.state = TFState_SOF; |
|
|
|
|
tf->state = TFState_SOF; |
|
|
|
|
// more init will be done by the parser when the first byte is received
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** SOF was received */ |
|
|
|
|
static void _TF_FN TF_ParsBeginFrame(void) { |
|
|
|
|
/** SOF was received - prepare for the frame */ |
|
|
|
|
static void _TF_FN pars_begin_frame(TinyFrame *tf) { |
|
|
|
|
// Reset state vars
|
|
|
|
|
CKSUM_RESET(tf.cksum); |
|
|
|
|
CKSUM_RESET(tf->cksum); |
|
|
|
|
#if TF_USE_SOF_BYTE |
|
|
|
|
CKSUM_ADD(tf.cksum, TF_SOF_BYTE); |
|
|
|
|
CKSUM_ADD(tf->cksum, TF_SOF_BYTE); |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
tf.discard_data = false; |
|
|
|
|
tf->discard_data = false; |
|
|
|
|
|
|
|
|
|
// Enter ID state
|
|
|
|
|
tf.state = TFState_ID; |
|
|
|
|
tf.rxi = 0; |
|
|
|
|
tf->state = TFState_ID; |
|
|
|
|
tf->rxi = 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void _TF_FN TF_AcceptChar(unsigned char c) |
|
|
|
|
/** Handle a received char - here's the main state machine */ |
|
|
|
|
void _TF_FN TF_AcceptChar(TinyFrame *tf, unsigned char c) |
|
|
|
|
{ |
|
|
|
|
// Parser timeout - clear
|
|
|
|
|
if (tf.parser_timeout_ticks >= TF_PARSER_TIMEOUT_TICKS) { |
|
|
|
|
TF_ResetParser(); |
|
|
|
|
if (tf->parser_timeout_ticks >= TF_PARSER_TIMEOUT_TICKS) { |
|
|
|
|
TF_ResetParser(tf); |
|
|
|
|
} |
|
|
|
|
tf.parser_timeout_ticks = 0; |
|
|
|
|
tf->parser_timeout_ticks = 0; |
|
|
|
|
|
|
|
|
|
// DRY snippet - collect multi-byte number from the input stream
|
|
|
|
|
// DRY snippet - collect multi-byte number from the input stream, byte by byte
|
|
|
|
|
// This is a little dirty, but makes the code easier to read. It's used like e.g. if(),
|
|
|
|
|
// the body is run only after the entire number (of data type 'type') was received
|
|
|
|
|
// and stored to 'dest'
|
|
|
|
|
#define COLLECT_NUMBER(dest, type) dest = (type)(((dest) << 8) | c); \ |
|
|
|
|
if (++tf.rxi == sizeof(type)) |
|
|
|
|
if (++tf->rxi == sizeof(type)) |
|
|
|
|
|
|
|
|
|
#if !TF_USE_SOF_BYTE |
|
|
|
|
if (tf.state == TFState_SOF) { |
|
|
|
|
if (tf->state == TFState_SOF) { |
|
|
|
|
TF_ParsBeginFrame(); |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
switch (tf.state) { |
|
|
|
|
switch (tf->state) { |
|
|
|
|
case TFState_SOF: |
|
|
|
|
if (c == TF_SOF_BYTE) { |
|
|
|
|
TF_ParsBeginFrame(); |
|
|
|
|
pars_begin_frame(tf); |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case TFState_ID: |
|
|
|
|
CKSUM_ADD(tf.cksum, c); |
|
|
|
|
COLLECT_NUMBER(tf.id, TF_ID) { |
|
|
|
|
CKSUM_ADD(tf->cksum, c); |
|
|
|
|
COLLECT_NUMBER(tf->id, TF_ID) { |
|
|
|
|
// Enter LEN state
|
|
|
|
|
tf.state = TFState_LEN; |
|
|
|
|
tf.rxi = 0; |
|
|
|
|
tf->state = TFState_LEN; |
|
|
|
|
tf->rxi = 0; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case TFState_LEN: |
|
|
|
|
CKSUM_ADD(tf.cksum, c); |
|
|
|
|
COLLECT_NUMBER(tf.len, TF_LEN) { |
|
|
|
|
CKSUM_ADD(tf->cksum, c); |
|
|
|
|
COLLECT_NUMBER(tf->len, TF_LEN) { |
|
|
|
|
// Enter TYPE state
|
|
|
|
|
tf.state = TFState_TYPE; |
|
|
|
|
tf.rxi = 0; |
|
|
|
|
tf->state = TFState_TYPE; |
|
|
|
|
tf->rxi = 0; |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case TFState_TYPE: |
|
|
|
|
CKSUM_ADD(tf.cksum, c); |
|
|
|
|
COLLECT_NUMBER(tf.type, TF_TYPE) { |
|
|
|
|
CKSUM_ADD(tf->cksum, c); |
|
|
|
|
COLLECT_NUMBER(tf->type, TF_TYPE) { |
|
|
|
|
#if TF_CKSUM_TYPE == TF_CKSUM_NONE |
|
|
|
|
tf.state = TFState_DATA; |
|
|
|
|
tf.rxi = 0; |
|
|
|
|
tf->state = TFState_DATA; |
|
|
|
|
tf->rxi = 0; |
|
|
|
|
#else |
|
|
|
|
// enter HEAD_CKSUM state
|
|
|
|
|
tf.state = TFState_HEAD_CKSUM; |
|
|
|
|
tf.rxi = 0; |
|
|
|
|
tf.ref_cksum = 0; |
|
|
|
|
tf->state = TFState_HEAD_CKSUM; |
|
|
|
|
tf->rxi = 0; |
|
|
|
|
tf->ref_cksum = 0; |
|
|
|
|
#endif |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case TFState_HEAD_CKSUM: |
|
|
|
|
COLLECT_NUMBER(tf.ref_cksum, TF_CKSUM) { |
|
|
|
|
COLLECT_NUMBER(tf->ref_cksum, TF_CKSUM) { |
|
|
|
|
// Check the header checksum against the computed value
|
|
|
|
|
CKSUM_FINALIZE(tf.cksum); |
|
|
|
|
CKSUM_FINALIZE(tf->cksum); |
|
|
|
|
|
|
|
|
|
if (tf.cksum != tf.ref_cksum) { |
|
|
|
|
TF_ResetParser(); |
|
|
|
|
if (tf->cksum != tf->ref_cksum) { |
|
|
|
|
TF_ResetParser(tf); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (tf.len == 0) { |
|
|
|
|
TF_HandleReceivedMessage(); |
|
|
|
|
TF_ResetParser(); |
|
|
|
|
if (tf->len == 0) { |
|
|
|
|
TF_HandleReceivedMessage(tf); |
|
|
|
|
TF_ResetParser(tf); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Enter DATA state
|
|
|
|
|
tf.state = TFState_DATA; |
|
|
|
|
tf.rxi = 0; |
|
|
|
|
tf->state = TFState_DATA; |
|
|
|
|
tf->rxi = 0; |
|
|
|
|
|
|
|
|
|
CKSUM_RESET(tf.cksum); // Start collecting the payload
|
|
|
|
|
CKSUM_RESET(tf->cksum); // Start collecting the payload
|
|
|
|
|
|
|
|
|
|
if (tf.len >= TF_MAX_PAYLOAD_RX) { |
|
|
|
|
if (tf->len >= TF_MAX_PAYLOAD_RX) { |
|
|
|
|
// ERROR - frame too long. Consume, but do not store.
|
|
|
|
|
tf.discard_data = true; |
|
|
|
|
tf->discard_data = true; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case TFState_DATA: |
|
|
|
|
if (tf.discard_data) { |
|
|
|
|
tf.rxi++; |
|
|
|
|
if (tf->discard_data) { |
|
|
|
|
tf->rxi++; |
|
|
|
|
} else { |
|
|
|
|
CKSUM_ADD(tf.cksum, c); |
|
|
|
|
tf.data[tf.rxi++] = c; |
|
|
|
|
CKSUM_ADD(tf->cksum, c); |
|
|
|
|
tf->data[tf->rxi++] = c; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (tf.rxi == tf.len) { |
|
|
|
|
if (tf->rxi == tf->len) { |
|
|
|
|
#if TF_CKSUM_TYPE == TF_CKSUM_NONE |
|
|
|
|
// All done
|
|
|
|
|
TF_HandleReceivedMessage(); |
|
|
|
|
TF_ResetParser(); |
|
|
|
|
#else |
|
|
|
|
// Enter DATA_CKSUM state
|
|
|
|
|
tf.state = TFState_DATA_CKSUM; |
|
|
|
|
tf.rxi = 0; |
|
|
|
|
tf.ref_cksum = 0; |
|
|
|
|
tf->state = TFState_DATA_CKSUM; |
|
|
|
|
tf->rxi = 0; |
|
|
|
|
tf->ref_cksum = 0; |
|
|
|
|
#endif |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case TFState_DATA_CKSUM: |
|
|
|
|
COLLECT_NUMBER(tf.ref_cksum, TF_CKSUM) { |
|
|
|
|
COLLECT_NUMBER(tf->ref_cksum, TF_CKSUM) { |
|
|
|
|
// Check the header checksum against the computed value
|
|
|
|
|
CKSUM_FINALIZE(tf.cksum); |
|
|
|
|
if (!tf.discard_data && tf.cksum == tf.ref_cksum) { |
|
|
|
|
TF_HandleReceivedMessage(); |
|
|
|
|
CKSUM_FINALIZE(tf->cksum); |
|
|
|
|
if (!tf->discard_data && tf->cksum == tf->ref_cksum) { |
|
|
|
|
TF_HandleReceivedMessage(tf); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
TF_ResetParser(); |
|
|
|
|
TF_ResetParser(tf); |
|
|
|
|
} |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// we get here after finishing HEAD, if no data are to be received - handle and clear
|
|
|
|
|
if (tf.len == 0 && tf.state == TFState_DATA) { |
|
|
|
|
TF_HandleReceivedMessage(); |
|
|
|
|
TF_ResetParser(); |
|
|
|
|
if (tf->len == 0 && tf->state == TFState_DATA) { |
|
|
|
|
TF_HandleReceivedMessage(tf); |
|
|
|
|
TF_ResetParser(tf); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Helper macros for the Compose functions
|
|
|
|
|
// use variables: si - signed int, b - byte, outbuf - target buffer, pos - count of bytes in buffer
|
|
|
|
|
// use variables: si - signed int, b - byte, outbuff - target buffer, pos - count of bytes in buffer
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Write a number to the output buffer. |
|
|
|
|
* |
|
|
|
|
* @param type - data type |
|
|
|
|
* @param num - number to write |
|
|
|
|
* @param xtra - extra callback run after each byte, 'b' now contains the byte. |
|
|
|
|
*/ |
|
|
|
|
#define WRITENUM_BASE(type, num, xtra) \ |
|
|
|
|
for (si = sizeof(type)-1; si>=0; si--) { \
|
|
|
|
|
b = (uint8_t)((num) >> (si*8) & 0xFF); \
|
|
|
|
|
outbuff[pos++] = b; \
|
|
|
|
|
xtra; \
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Do nothing |
|
|
|
|
*/ |
|
|
|
|
#define _NOOP() |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Write a number without adding its bytes to the checksum |
|
|
|
|
* |
|
|
|
|
* @param type - data type |
|
|
|
|
* @param num - number to write |
|
|
|
|
*/ |
|
|
|
|
#define WRITENUM(type, num) WRITENUM_BASE(type, num, _NOOP()) |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Write a number AND add its bytes to the checksum |
|
|
|
|
* |
|
|
|
|
* @param type - data type |
|
|
|
|
* @param num - number to write |
|
|
|
|
*/ |
|
|
|
|
#define WRITENUM_CKSUM(type, num) WRITENUM_BASE(type, num, CKSUM_ADD(cksum, b)) |
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
@ -632,16 +614,10 @@ void _TF_FN TF_AcceptChar(unsigned char c) |
|
|
|
|
* The frame can be sent using TF_WriteImpl(), or received by TF_Accept() |
|
|
|
|
* |
|
|
|
|
* @param outbuff - buffer to store the result in |
|
|
|
|
* @param msgid - message ID is stored here, if not NULL |
|
|
|
|
* @param type - message type |
|
|
|
|
* @param len - payload size in bytes |
|
|
|
|
* @param explicit_id - ID to use in the frame (8-bit) |
|
|
|
|
* @param use_expl_id - whether to use the previous param |
|
|
|
|
* @param msg - message written to the buffer |
|
|
|
|
* @return nr of bytes in outbuff used by the frame, 0 on failure |
|
|
|
|
*/ |
|
|
|
|
static inline size_t _TF_FN TF_ComposeHead(uint8_t *outbuff, TF_ID *id_ptr, |
|
|
|
|
TF_TYPE type, TF_LEN data_len, |
|
|
|
|
TF_ID explicit_id, bool use_expl_id) |
|
|
|
|
static inline size_t _TF_FN TF_ComposeHead(TinyFrame *tf, uint8_t *outbuff, TF_Msg *msg) |
|
|
|
|
{ |
|
|
|
|
int8_t si = 0; // signed small int
|
|
|
|
|
uint8_t b = 0; |
|
|
|
@ -654,17 +630,17 @@ static inline size_t _TF_FN TF_ComposeHead(uint8_t *outbuff, TF_ID *id_ptr, |
|
|
|
|
CKSUM_RESET(cksum); |
|
|
|
|
|
|
|
|
|
// Gen ID
|
|
|
|
|
if (use_expl_id) { |
|
|
|
|
id = explicit_id; |
|
|
|
|
if (msg->is_response) { |
|
|
|
|
id = msg->frame_id; |
|
|
|
|
} |
|
|
|
|
else { |
|
|
|
|
id = (TF_ID) (tf.next_id++ & TF_ID_MASK); |
|
|
|
|
if (tf.peer_bit) { |
|
|
|
|
id = (TF_ID) (tf->next_id++ & TF_ID_MASK); |
|
|
|
|
if (tf->peer_bit) { |
|
|
|
|
id |= TF_ID_PEERBIT; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (id_ptr != NULL) *id_ptr = id; |
|
|
|
|
msg->frame_id = id; // put the resolved ID into the message object for later use
|
|
|
|
|
|
|
|
|
|
// --- Start ---
|
|
|
|
|
CKSUM_RESET(cksum); |
|
|
|
@ -675,8 +651,8 @@ static inline size_t _TF_FN TF_ComposeHead(uint8_t *outbuff, TF_ID *id_ptr, |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
WRITENUM_CKSUM(TF_ID, id); |
|
|
|
|
WRITENUM_CKSUM(TF_LEN, data_len); |
|
|
|
|
WRITENUM_CKSUM(TF_TYPE, type); |
|
|
|
|
WRITENUM_CKSUM(TF_LEN, msg->len); |
|
|
|
|
WRITENUM_CKSUM(TF_TYPE, msg->type); |
|
|
|
|
|
|
|
|
|
#if TF_CKSUM_TYPE != TF_CKSUM_NONE |
|
|
|
|
CKSUM_FINALIZE(cksum); |
|
|
|
@ -696,7 +672,9 @@ static inline size_t _TF_FN TF_ComposeHead(uint8_t *outbuff, TF_ID *id_ptr, |
|
|
|
|
* @param cksum - checksum variable, used for all calls to TF_ComposeBody. Must be reset before first use! (CKSUM_RESET(cksum);) |
|
|
|
|
* @return nr of bytes in outbuff used |
|
|
|
|
*/ |
|
|
|
|
static size_t _TF_FN TF_ComposeBody(uint8_t *outbuff, const uint8_t *data, TF_LEN data_len, TF_CKSUM *cksum) |
|
|
|
|
static size_t _TF_FN TF_ComposeBody(uint8_t *outbuff, |
|
|
|
|
const uint8_t *data, TF_LEN data_len, |
|
|
|
|
TF_CKSUM *cksum) |
|
|
|
|
{ |
|
|
|
|
TF_LEN i = 0; |
|
|
|
|
uint8_t b = 0; |
|
|
|
@ -718,7 +696,7 @@ static size_t _TF_FN TF_ComposeBody(uint8_t *outbuff, const uint8_t *data, TF_LE |
|
|
|
|
* @param cksum - checksum variable used for the body |
|
|
|
|
* @return nr of bytes in outbuff used |
|
|
|
|
*/ |
|
|
|
|
static size_t _TF_FN TF_ComposeTail(uint8_t *outbuff, TF_CKSUM *cksum) |
|
|
|
|
static size_t _TF_FN TF_ComposeTail(uint8_t *outbuff, const TF_CKSUM *cksum) |
|
|
|
|
{ |
|
|
|
|
int8_t si = 0; // signed small int
|
|
|
|
|
uint8_t b = 0; |
|
|
|
@ -731,104 +709,106 @@ static size_t _TF_FN TF_ComposeTail(uint8_t *outbuff, TF_CKSUM *cksum) |
|
|
|
|
return pos; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// send with listener
|
|
|
|
|
static bool _TF_FN TF_SendFrame(TF_Msg *msg, TF_Listener listener, TF_TICKS timeout) |
|
|
|
|
/**
|
|
|
|
|
* Send a message |
|
|
|
|
* |
|
|
|
|
* @param tf - instance |
|
|
|
|
* @param msg - message object |
|
|
|
|
* @param listener - ID listener, or NULL |
|
|
|
|
* @param timeout - listener timeout, 0 is none |
|
|
|
|
* @return true if sent |
|
|
|
|
*/ |
|
|
|
|
static bool _TF_FN TF_SendFrame(TinyFrame *tf, TF_Msg *msg, TF_Listener listener, TF_TICKS timeout) |
|
|
|
|
{ |
|
|
|
|
size_t len = 0; |
|
|
|
|
size_t remain = 0; |
|
|
|
|
size_t sent = 0; |
|
|
|
|
TF_CKSUM cksum = 0; |
|
|
|
|
|
|
|
|
|
TF_ClaimTx(); |
|
|
|
|
TF_ClaimTx(tf); |
|
|
|
|
|
|
|
|
|
len = TF_ComposeHead(tf.sendbuf, |
|
|
|
|
&msg->frame_id, |
|
|
|
|
msg->type, |
|
|
|
|
msg->len, |
|
|
|
|
msg->frame_id, |
|
|
|
|
msg->is_response); |
|
|
|
|
|
|
|
|
|
if (listener) TF_AddIdListener(msg, listener, timeout); |
|
|
|
|
len = TF_ComposeHead(tf, tf->sendbuf, msg); |
|
|
|
|
if (listener) TF_AddIdListener(tf, msg, listener, timeout); |
|
|
|
|
|
|
|
|
|
CKSUM_RESET(cksum); |
|
|
|
|
|
|
|
|
|
remain = msg->len; |
|
|
|
|
while (remain > 0) { |
|
|
|
|
size_t chunk = TF_MIN(TF_SENDBUF_LEN - len, remain); |
|
|
|
|
len += TF_ComposeBody(tf.sendbuf+len, msg->data+sent, (TF_LEN) chunk, &cksum); |
|
|
|
|
len += TF_ComposeBody(tf->sendbuf+len, msg->data+sent, (TF_LEN) chunk, &cksum); |
|
|
|
|
remain -= chunk; |
|
|
|
|
sent += chunk; |
|
|
|
|
|
|
|
|
|
// Flush if the buffer is full and we have more to send
|
|
|
|
|
if (remain > 0 && len == TF_SENDBUF_LEN) { |
|
|
|
|
TF_WriteImpl((const uint8_t *) tf.sendbuf, len); |
|
|
|
|
TF_WriteImpl(tf, (const uint8_t *) tf->sendbuf, len); |
|
|
|
|
len = 0; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Flush if checksum wouldn't fit in the buffer
|
|
|
|
|
if (TF_SENDBUF_LEN - len < sizeof(TF_CKSUM)) { |
|
|
|
|
TF_WriteImpl((const uint8_t *) tf.sendbuf, len); |
|
|
|
|
TF_WriteImpl(tf, (const uint8_t *) tf->sendbuf, len); |
|
|
|
|
len = 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Add checksum, flush what remains to be sent
|
|
|
|
|
len += TF_ComposeTail(tf.sendbuf+len, &cksum); |
|
|
|
|
TF_WriteImpl((const uint8_t *) tf.sendbuf, len); |
|
|
|
|
len += TF_ComposeTail(tf->sendbuf+len, &cksum); |
|
|
|
|
TF_WriteImpl(tf, (const uint8_t *) tf->sendbuf, len); |
|
|
|
|
|
|
|
|
|
TF_ReleaseTx(); |
|
|
|
|
TF_ReleaseTx(tf); |
|
|
|
|
|
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// send without listener
|
|
|
|
|
bool _TF_FN TF_Send(TF_Msg *msg) |
|
|
|
|
/** send without listener */ |
|
|
|
|
bool _TF_FN TF_Send(TinyFrame *tf, TF_Msg *msg) |
|
|
|
|
{ |
|
|
|
|
return TF_SendFrame(msg, NULL, 0); |
|
|
|
|
return TF_SendFrame(tf, msg, NULL, 0); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// send without listener and struct
|
|
|
|
|
bool _TF_FN TF_SendSimple(TF_TYPE type, const uint8_t *data, TF_LEN len) |
|
|
|
|
/** send without listener and struct */ |
|
|
|
|
bool _TF_FN TF_SendSimple(TinyFrame *tf, TF_TYPE type, const uint8_t *data, TF_LEN len) |
|
|
|
|
{ |
|
|
|
|
TF_Msg msg; |
|
|
|
|
TF_ClearMsg(&msg); |
|
|
|
|
msg.type = type; |
|
|
|
|
msg.data = data; |
|
|
|
|
msg.len = len; |
|
|
|
|
return TF_Send(&msg); |
|
|
|
|
return TF_Send(tf, &msg); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// send without listener and struct
|
|
|
|
|
bool _TF_FN TF_QuerySimple(TF_TYPE type, const uint8_t *data, TF_LEN len, TF_Listener listener, TF_TICKS timeout, void *userdata) |
|
|
|
|
/** send with a listener waiting for a reply, without the struct */ |
|
|
|
|
bool _TF_FN TF_QuerySimple(TinyFrame *tf, TF_TYPE type, const uint8_t *data, TF_LEN len, TF_Listener listener, TF_TICKS timeout) |
|
|
|
|
{ |
|
|
|
|
TF_Msg msg; |
|
|
|
|
TF_ClearMsg(&msg); |
|
|
|
|
msg.type = type; |
|
|
|
|
msg.data = data; |
|
|
|
|
msg.len = len; |
|
|
|
|
msg.userdata = userdata; |
|
|
|
|
return TF_SendFrame(&msg, listener, timeout); |
|
|
|
|
return TF_SendFrame(tf, &msg, listener, timeout); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// send with listener
|
|
|
|
|
bool _TF_FN TF_Query(TF_Msg *msg, TF_Listener listener, TF_TICKS timeout) |
|
|
|
|
/** send with a listener waiting for a reply */ |
|
|
|
|
bool _TF_FN TF_Query(TinyFrame *tf, TF_Msg *msg, TF_Listener listener, TF_TICKS timeout) |
|
|
|
|
{ |
|
|
|
|
return TF_SendFrame(msg, listener, timeout); |
|
|
|
|
return TF_SendFrame(tf, msg, listener, timeout); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Like TF_Send, but with explicit frame ID
|
|
|
|
|
bool _TF_FN TF_Respond(TF_Msg *msg) |
|
|
|
|
/** Like TF_Send, but with explicit frame ID (set inside the msg object), use for responses */ |
|
|
|
|
bool _TF_FN TF_Respond(TinyFrame *tf, TF_Msg *msg) |
|
|
|
|
{ |
|
|
|
|
msg->is_response = true; |
|
|
|
|
return TF_Send(msg); |
|
|
|
|
return TF_Send(tf, msg); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool _TF_FN TF_RenewIdListener(TF_ID id) |
|
|
|
|
/** Externally renew an ID listener */ |
|
|
|
|
bool _TF_FN TF_RenewIdListener(TinyFrame *tf, TF_ID id) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i; |
|
|
|
|
IdListener *lst; |
|
|
|
|
for (i = 0; i < tf.count_id_lst; i++) { |
|
|
|
|
lst = &tf.id_listeners[i]; |
|
|
|
|
struct TF_IdListener_ *lst; |
|
|
|
|
for (i = 0; i < tf->count_id_lst; i++) { |
|
|
|
|
lst = &tf->id_listeners[i]; |
|
|
|
|
// test if live & matching
|
|
|
|
|
if (lst->fn != NULL && lst->id == id) { |
|
|
|
|
renew_id_listener(lst); |
|
|
|
@ -839,34 +819,40 @@ bool _TF_FN TF_RenewIdListener(TF_ID id) |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** Timebase hook - for timeouts */ |
|
|
|
|
void _TF_FN TF_Tick(void) |
|
|
|
|
void _TF_FN TF_Tick(TinyFrame *tf) |
|
|
|
|
{ |
|
|
|
|
TF_COUNT i = 0; |
|
|
|
|
IdListener *lst; |
|
|
|
|
struct TF_IdListener_ *lst; |
|
|
|
|
|
|
|
|
|
// increment parser timeout (timeout is handled when receiving next byte)
|
|
|
|
|
if (tf.parser_timeout_ticks < TF_PARSER_TIMEOUT_TICKS) { |
|
|
|
|
tf.parser_timeout_ticks++; |
|
|
|
|
if (tf->parser_timeout_ticks < TF_PARSER_TIMEOUT_TICKS) { |
|
|
|
|
tf->parser_timeout_ticks++; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// decrement and expire ID listeners
|
|
|
|
|
for (i = 0; i < tf.count_id_lst; i++) { |
|
|
|
|
lst = &tf.id_listeners[i]; |
|
|
|
|
for (i = 0; i < tf->count_id_lst; i++) { |
|
|
|
|
lst = &tf->id_listeners[i]; |
|
|
|
|
if (!lst->fn || lst->timeout == 0) continue; |
|
|
|
|
// count down...
|
|
|
|
|
if (--lst->timeout == 0) { |
|
|
|
|
// Listener has expired
|
|
|
|
|
cleanup_id_listener(i, lst); |
|
|
|
|
cleanup_id_listener(tf, i, lst); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void __attribute__((weak)) TF_ClaimTx(void) |
|
|
|
|
/** Default impl for claiming write mutex; can be specific to the instance */ |
|
|
|
|
void __attribute__((weak)) TF_ClaimTx(TinyFrame *tf) |
|
|
|
|
{ |
|
|
|
|
(void) tf; |
|
|
|
|
|
|
|
|
|
// do nothing
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void __attribute__((weak)) TF_ReleaseTx(void) |
|
|
|
|
/** Default impl for releasing write mutex; can be specific to the instance */ |
|
|
|
|
void __attribute__((weak)) TF_ReleaseTx(TinyFrame *tf) |
|
|
|
|
{ |
|
|
|
|
(void) tf; |
|
|
|
|
|
|
|
|
|
// do nothing
|
|
|
|
|
} |
|
|
|
|