63 lines
1.7 KiB
C
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;
|
|
}
|