63 lines
1.7 KiB
C

#include "rtu.h"
#include <string.h>
static void clear_segment(rtu_receiver *rx)
{
rx->used = 0;
rx->active = 0;
rx->dropping = 0;
}
static void finish(rtu_receiver *rx, uint32_t tick)
{
if (!rx->dropping) {
if (rx->used < 4u) ++rx->stats.bad_length;
else {
size_t n = rx->used;
uint16_t wire = (uint16_t)(rx->bytes[n-2] | ((uint16_t)rx->bytes[n-1] << 8));
if (rtu_crc16(rx->bytes, n-2) != wire) ++rx->stats.bad_crc;
else {
++rx->stats.accepted;
if (rx->emit) rx->emit(rx->context, tick, rx->bytes, n-2);
}
}
}
clear_segment(rx);
}
void rtu_init(rtu_receiver *rx, rtu_emit_fn emit, void *context)
{
memset(rx, 0, sizeof(*rx));
rx->emit = emit;
rx->context = context;
}
void rtu_byte(rtu_receiver *rx, uint8_t byte, uint32_t tick)
{
if (rx->active) {
rtu_gap_t gap = rtu_classify_gap(rx->last_byte, tick);
if (gap == RTU_FRAME_BOUNDARY) finish(rx, tick);
else if (gap == RTU_INTER_GAP && !rx->dropping) {
++rx->stats.timing_errors;
rx->dropping = 0;
rx->used = 0;
}
}
rx->active = 1;
rx->last_byte = tick;
if (rx->dropping) return;
if (rx->used == RTU_CAPACITY) {
++rx->stats.overflows;
rx->dropping = 1;
rx->used = 0;
return;
}
rx->bytes[rx->used++] = byte;
}
void rtu_poll(rtu_receiver *rx, uint32_t tick)
{
if (rx->active && rtu_classify_gap(rx->last_byte, tick) == RTU_FRAME_BOUNDARY)
finish(rx, tick);
else if (rx->active) rx->last_byte = tick;
}
rtu_stats_t rtu_get_stats(const rtu_receiver *rx)
{
return rx->stats;
}