438 lines
14 KiB
C
438 lines
14 KiB
C
#include "repeater.h"
|
|
#include "sx126x.h"
|
|
#include "wmbus.h"
|
|
#include "board.h"
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <inttypes.h>
|
|
#include "freertos/FreeRTOS.h"
|
|
#include "freertos/task.h"
|
|
#include "esp_timer.h"
|
|
#include "esp_task_wdt.h"
|
|
#include "esp_system.h"
|
|
|
|
#define RX_PAYLOAD_LEN 255 // fixed radio capture length; truncated in software
|
|
#define US_PER_BYTE 80 // 100 kbps -> 80 us per byte
|
|
#define DUP_WINDOW_US 2500000LL
|
|
#define DUP_RING 8
|
|
|
|
repeater_cfg_t g_cfg = {
|
|
.repeat_delay_ms = 50,
|
|
.tx_power_dbm = -9,
|
|
.repeat_enabled = true,
|
|
.verbose = false,
|
|
.whitelist = {0},
|
|
.whitelist_len = 0,
|
|
};
|
|
repeater_stats_t g_stats;
|
|
|
|
static TaskHandle_t s_task;
|
|
static volatile int64_t s_irq_ts;
|
|
static volatile bool s_want_radio_reset;
|
|
static volatile bool s_want_test_tx;
|
|
static uint8_t s_test_access_nr;
|
|
static uint32_t s_seq;
|
|
|
|
static struct { uint32_t hash; int64_t ts; } s_dup[DUP_RING];
|
|
static int s_dup_idx;
|
|
|
|
// ------------------------------------------------------------------ logging
|
|
|
|
static void print_hex(const uint8_t *d, int n)
|
|
{
|
|
for (int i = 0; i < n; i++) printf("%02X", d[i]);
|
|
}
|
|
|
|
#define LOGJ(fmt, ...) do { \
|
|
printf("{\"seq\":%" PRIu32 "," fmt "}\n", s_seq++, ##__VA_ARGS__); \
|
|
fflush(stdout); \
|
|
} while (0)
|
|
|
|
// ------------------------------------------------------------------ radio
|
|
|
|
static void irq_cb(int64_t ts)
|
|
{
|
|
s_irq_ts = ts;
|
|
BaseType_t hp = pdFALSE;
|
|
if (s_task) vTaskNotifyGiveFromISR(s_task, &hp);
|
|
portYIELD_FROM_ISR(hp);
|
|
}
|
|
|
|
static bool radio_full_init(void)
|
|
{
|
|
sx126x_diag_t diag;
|
|
bool ok = sx126x_init(&diag);
|
|
bool cfg_ok = ok && sx126x_config_wmbus_c1(868950000u, RX_PAYLOAD_LEN)
|
|
&& sx126x_set_tx_power(g_cfg.tx_power_dbm);
|
|
LOGJ("\"event\":\"radio_init\",\"spi\":%s,\"reset\":%s,\"busy_low\":%s,"
|
|
"\"tcxo\":%s,\"device_errors\":%u,\"chip_mode\":%u,"
|
|
"\"fem_power\":true,\"fem_mode\":\"rx\",\"frequency_hz\":868950000,"
|
|
"\"configured_tx_dbm\":%d,\"result\":\"%s\"",
|
|
diag.spi_ok ? "true" : "false",
|
|
diag.reset_ok ? "true" : "false",
|
|
diag.busy_ok ? "true" : "false",
|
|
diag.tcxo_ok ? "true" : "false",
|
|
diag.device_errors, diag.chip_mode,
|
|
(int)g_cfg.tx_power_dbm,
|
|
cfg_ok ? "ok" : "fail");
|
|
return cfg_ok;
|
|
}
|
|
|
|
// Recovery ladder: 1 clear/restart RX, 2 radio reinit, 3 FEM+radio reinit,
|
|
// 4 reboot. Returns true if RX was restored.
|
|
static bool recover(const char *reason, int level)
|
|
{
|
|
g_stats.recoveries++;
|
|
bool ok = false;
|
|
switch (level) {
|
|
case 1:
|
|
sx126x_clear_irq(SX126X_IRQ_ALL);
|
|
sx126x_standby();
|
|
sx126x_restore_rx_payload_len();
|
|
ok = sx126x_set_rx();
|
|
break;
|
|
case 2:
|
|
g_stats.radio_reinit++;
|
|
ok = radio_full_init() && sx126x_set_rx();
|
|
break;
|
|
case 3:
|
|
g_stats.fem_reinit++;
|
|
fem_power(false);
|
|
vTaskDelay(pdMS_TO_TICKS(20));
|
|
ok = radio_full_init() && sx126x_set_rx();
|
|
break;
|
|
default:
|
|
LOGJ("\"event\":\"radio_recovery\",\"reason\":\"%s\",\"level\":%d,"
|
|
"\"result\":\"mcu_reset\"", reason, level);
|
|
fflush(stdout);
|
|
vTaskDelay(pdMS_TO_TICKS(100));
|
|
esp_restart();
|
|
}
|
|
LOGJ("\"event\":\"radio_recovery\",\"reason\":\"%s\",\"level\":%d,"
|
|
"\"result\":\"%s\"", reason, level, ok ? "rx_restored" : "failed");
|
|
return ok;
|
|
}
|
|
|
|
static void recover_ladder(const char *reason)
|
|
{
|
|
for (int level = 1; level <= 4; level++) {
|
|
if (recover(reason, level)) return;
|
|
}
|
|
}
|
|
|
|
// ------------------------------------------------------------------ helpers
|
|
|
|
static bool is_dup(uint32_t hash, int64_t now)
|
|
{
|
|
for (int i = 0; i < DUP_RING; i++) {
|
|
if (s_dup[i].hash == hash && now - s_dup[i].ts < DUP_WINDOW_US) return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
static void remember_dup(uint32_t hash, int64_t now)
|
|
{
|
|
s_dup[s_dup_idx].hash = hash;
|
|
s_dup[s_dup_idx].ts = now;
|
|
s_dup_idx = (s_dup_idx + 1) % DUP_RING;
|
|
}
|
|
|
|
static bool whitelist_pass(const uint8_t *frame)
|
|
{
|
|
if (g_cfg.whitelist_len == 0) return true;
|
|
// A-field ID: frame bytes 4..7 (after L, C, M) little endian
|
|
uint32_t id = (uint32_t)frame[4] | ((uint32_t)frame[5] << 8) |
|
|
((uint32_t)frame[6] << 16) | ((uint32_t)frame[7] << 24);
|
|
for (int i = 0; i < g_cfg.whitelist_len; i++) {
|
|
if (g_cfg.whitelist[i] == id) return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
// Wait for DIO1 with timeout; returns IRQ mask (0 on timeout).
|
|
static uint16_t wait_irq(uint32_t timeout_ms)
|
|
{
|
|
if (ulTaskNotifyTake(pdTRUE, pdMS_TO_TICKS(timeout_ms)) == 0) return 0;
|
|
uint16_t irq = sx126x_get_irq();
|
|
sx126x_clear_irq(irq);
|
|
return irq;
|
|
}
|
|
|
|
static void precise_delay_until(int64_t target_us)
|
|
{
|
|
int64_t now = esp_timer_get_time();
|
|
int64_t remaining = target_us - now;
|
|
if (remaining > 2000) vTaskDelay(pdMS_TO_TICKS((remaining - 1000) / 1000));
|
|
while (esp_timer_get_time() < target_us) { /* spin <=~1ms */ }
|
|
}
|
|
|
|
// ------------------------------------------------------------------ TX
|
|
|
|
// Transmit mode bytes + frame. Returns result string for logging.
|
|
static const char *do_tx(const uint8_t *payload, int payload_len,
|
|
int64_t *tx_start_us, int64_t *tx_done_us)
|
|
{
|
|
g_stats.tx_attempts++;
|
|
*tx_start_us = esp_timer_get_time();
|
|
if (!sx126x_start_tx(payload, (uint8_t)payload_len)) {
|
|
g_stats.tx_failures++;
|
|
return "start_failed";
|
|
}
|
|
// airtime: 48 bit preamble + 16 bit sync + payload -> ~80us/byte + 640
|
|
uint32_t airtime_ms = (payload_len * US_PER_BYTE + 640) / 1000;
|
|
uint16_t irq = wait_irq(airtime_ms + 200);
|
|
*tx_done_us = s_irq_ts;
|
|
fem_set_tx(false);
|
|
if (irq & SX126X_IRQ_TX_DONE) {
|
|
g_stats.tx_success++;
|
|
return "ok";
|
|
}
|
|
if (irq & SX126X_IRQ_TIMEOUT) {
|
|
g_stats.tx_timeout++;
|
|
return "radio_timeout";
|
|
}
|
|
g_stats.tx_timeout++;
|
|
return "irq_timeout";
|
|
}
|
|
|
|
static void log_tx(const char *result, uint32_t hash, int len,
|
|
int64_t rx_ts, int64_t tx_start, int64_t tx_done)
|
|
{
|
|
LOGJ("\"event\":\"wmbus_tx\",\"timestamp_us\":%lld,"
|
|
"\"source_rx_timestamp_us\":%lld,\"delay_us\":%lld,"
|
|
"\"length\":%d,\"hash\":\"%08" PRIx32 "\","
|
|
"\"configured_tx_dbm\":%d,\"airtime_us\":%lld,\"result\":\"%s\"",
|
|
(long long)tx_start, (long long)rx_ts,
|
|
(long long)(tx_start - rx_ts), len, hash,
|
|
(int)g_cfg.tx_power_dbm,
|
|
(long long)(tx_done > tx_start ? tx_done - tx_start : 0), result);
|
|
}
|
|
|
|
static void run_test_tx(void)
|
|
{
|
|
uint8_t frame[64];
|
|
int n = wmbus_build_test_frame(frame, sizeof(frame) - 2, s_test_access_nr++);
|
|
if (n < 0) return;
|
|
uint8_t payload[66];
|
|
payload[0] = WMBUS_MODE_BYTE_A_HI;
|
|
payload[1] = WMBUS_MODE_BYTE_A_LO;
|
|
memcpy(payload + 2, frame, n);
|
|
uint32_t hash = wmbus_hash(frame, n);
|
|
|
|
int64_t t0, t1;
|
|
const char *res = do_tx(payload, n + 2, &t0, &t1);
|
|
log_tx(res, hash, n, t0, t0, t1);
|
|
printf("{\"seq\":%" PRIu32 ",\"event\":\"test_tx_frame\",\"raw\":\"", s_seq++);
|
|
print_hex(frame, n);
|
|
printf("\"}\n");
|
|
fflush(stdout);
|
|
|
|
sx126x_restore_rx_payload_len();
|
|
if (!sx126x_set_rx()) recover_ladder("test_tx_rx_restore");
|
|
}
|
|
|
|
// ------------------------------------------------------------------ RX path
|
|
|
|
static void handle_rx(int64_t rxdone_ts)
|
|
{
|
|
static uint8_t buf[RX_PAYLOAD_LEN];
|
|
int8_t rssi = 0;
|
|
int n = sx126x_read_rx(buf, sizeof(buf), &rssi);
|
|
if (n < 3) {
|
|
recover_ladder("rx_read_failed");
|
|
return;
|
|
}
|
|
g_stats.rx_candidates++;
|
|
g_stats.rx_bytes += n;
|
|
|
|
wmbus_frame_fmt_t fmt = wmbus_frame_format(buf[0], buf[1]);
|
|
if (fmt == WMBUS_FRAME_UNKNOWN) {
|
|
g_stats.rx_not_c1++;
|
|
if (g_cfg.verbose) {
|
|
LOGJ("\"event\":\"wmbus_rx_drop\",\"reason\":\"not_c1\","
|
|
"\"mode_bytes\":\"%02X%02X\",\"rssi_dbm\":%d", buf[0], buf[1], rssi);
|
|
}
|
|
return;
|
|
}
|
|
|
|
int total = wmbus_frame_total_len(fmt, buf[2]);
|
|
if (total < 0 || total + 2 > n) {
|
|
g_stats.rx_len_invalid++;
|
|
if (g_cfg.verbose) {
|
|
LOGJ("\"event\":\"wmbus_rx_drop\",\"reason\":\"bad_length\","
|
|
"\"lfield\":%u,\"rssi_dbm\":%d", buf[2], rssi);
|
|
}
|
|
return;
|
|
}
|
|
|
|
const uint8_t *frame = buf + 2;
|
|
bool crc_ok = wmbus_check_crc(fmt, frame, total);
|
|
if (crc_ok) g_stats.rx_valid++; else g_stats.rx_crc_fail++;
|
|
|
|
uint32_t hash = wmbus_hash(frame, total);
|
|
// RxDone fires after the fixed 255-byte capture; the frame actually
|
|
// ended earlier. Reconstruct the real end-of-frame time.
|
|
int64_t frame_end_ts = rxdone_ts - (int64_t)(RX_PAYLOAD_LEN - (total + 2)) * US_PER_BYTE;
|
|
|
|
printf("{\"seq\":%" PRIu32 ",\"event\":\"wmbus_rx\",\"timestamp_us\":%lld,"
|
|
"\"rxdone_us\":%lld,\"frequency_hz\":868950000,\"format\":\"%c\","
|
|
"\"length\":%d,\"rssi_dbm\":%d,\"crc_ok\":%s,"
|
|
"\"hash\":\"%08" PRIx32 "\",\"raw\":\"",
|
|
s_seq++, (long long)frame_end_ts, (long long)rxdone_ts,
|
|
fmt == WMBUS_FRAME_A ? 'A' : 'B', total, rssi,
|
|
crc_ok ? "true" : "false", hash);
|
|
print_hex(frame, total);
|
|
printf("\"}\n");
|
|
fflush(stdout);
|
|
|
|
if (!g_cfg.repeat_enabled || !crc_ok) return;
|
|
if (!whitelist_pass(frame)) {
|
|
g_stats.tx_suppressed_whitelist++;
|
|
return;
|
|
}
|
|
int64_t now = esp_timer_get_time();
|
|
if (is_dup(hash, now)) {
|
|
g_stats.tx_suppressed_dup++;
|
|
if (g_cfg.verbose) {
|
|
LOGJ("\"event\":\"tx_suppressed\",\"reason\":\"dup\",\"hash\":\"%08" PRIx32 "\"", hash);
|
|
}
|
|
return;
|
|
}
|
|
|
|
// ---- repeat ----
|
|
static uint8_t txbuf[RX_PAYLOAD_LEN + 2];
|
|
txbuf[0] = buf[0];
|
|
txbuf[1] = buf[1];
|
|
memcpy(txbuf + 2, frame, total);
|
|
|
|
precise_delay_until(frame_end_ts + (int64_t)g_cfg.repeat_delay_ms * 1000);
|
|
|
|
int64_t t0, t1;
|
|
const char *res = do_tx(txbuf, total + 2, &t0, &t1);
|
|
remember_dup(hash, esp_timer_get_time());
|
|
log_tx(res, hash, total, frame_end_ts, t0, t1);
|
|
|
|
// Always return to RX
|
|
sx126x_restore_rx_payload_len();
|
|
if (!sx126x_set_rx()) {
|
|
recover_ladder("post_tx_rx_restore");
|
|
} else {
|
|
int64_t rx_ready = esp_timer_get_time();
|
|
if (g_cfg.verbose) {
|
|
LOGJ("\"event\":\"rx_ready\",\"timestamp_us\":%lld,"
|
|
"\"deaf_time_us\":%lld",
|
|
(long long)rx_ready, (long long)(rx_ready - frame_end_ts));
|
|
}
|
|
}
|
|
}
|
|
|
|
// ------------------------------------------------------------------ task
|
|
|
|
static void repeater_task(void *arg)
|
|
{
|
|
(void)arg;
|
|
s_task = xTaskGetCurrentTaskHandle();
|
|
esp_task_wdt_add(NULL);
|
|
|
|
if (!radio_full_init()) {
|
|
// keep retrying with full ladder rather than dying
|
|
recover_ladder("boot_init_failed");
|
|
}
|
|
if (!sx126x_set_rx()) recover_ladder("boot_rx_failed");
|
|
|
|
int64_t last_heartbeat = 0;
|
|
for (;;) {
|
|
esp_task_wdt_reset();
|
|
|
|
if (s_want_radio_reset) {
|
|
s_want_radio_reset = false;
|
|
g_stats.radio_reinit++;
|
|
if (!radio_full_init() || !sx126x_set_rx()) recover_ladder("manual_reset");
|
|
}
|
|
if (s_want_test_tx) {
|
|
s_want_test_tx = false;
|
|
run_test_tx();
|
|
}
|
|
|
|
if (ulTaskNotifyTake(pdTRUE, pdMS_TO_TICKS(1000)) > 0) {
|
|
uint16_t irq = sx126x_get_irq();
|
|
sx126x_clear_irq(irq);
|
|
if (irq & SX126X_IRQ_RX_DONE) handle_rx(s_irq_ts);
|
|
// TIMEOUT in RX continuous should not happen; TX_DONE is consumed
|
|
// by do_tx's wait_irq. Anything unexpected: just note it.
|
|
if (g_cfg.verbose && (irq & ~(SX126X_IRQ_RX_DONE))) {
|
|
LOGJ("\"event\":\"irq_other\",\"mask\":%u", irq);
|
|
}
|
|
}
|
|
|
|
int64_t now = esp_timer_get_time();
|
|
if (now - last_heartbeat > 10000000LL) {
|
|
last_heartbeat = now;
|
|
// consistency probe: chip should be in RX (0x5)
|
|
uint8_t st = sx126x_get_status();
|
|
uint8_t mode = (st >> 4) & 0x7;
|
|
LOGJ("\"event\":\"heartbeat\",\"uptime_us\":%lld,\"chip_mode\":%u,"
|
|
"\"rssi_dbm\":%d", (long long)now, mode, sx126x_get_rssi_inst());
|
|
if (mode != 0x5) {
|
|
recover_ladder("not_in_rx");
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void repeater_start(void)
|
|
{
|
|
xTaskCreatePinnedToCore(repeater_task, "repeater", 8192, NULL, 10, NULL, 1);
|
|
}
|
|
|
|
void repeater_request_radio_reset(void) { s_want_radio_reset = true; }
|
|
void repeater_request_test_tx(void) { s_want_test_tx = true; }
|
|
|
|
// ------------------------------------------------------------------ status
|
|
|
|
void repeater_print_status(void)
|
|
{
|
|
LOGJ("\"event\":\"status\",\"uptime_us\":%lld,"
|
|
"\"repeat_delay_ms\":%" PRIu32 ",\"configured_tx_dbm\":%d,"
|
|
"\"repeat_enabled\":%s,\"verbose\":%s,\"whitelist_len\":%d,"
|
|
"\"reset_reason\":%d",
|
|
(long long)esp_timer_get_time(),
|
|
g_cfg.repeat_delay_ms, (int)g_cfg.tx_power_dbm,
|
|
g_cfg.repeat_enabled ? "true" : "false",
|
|
g_cfg.verbose ? "true" : "false",
|
|
g_cfg.whitelist_len,
|
|
(int)esp_reset_reason());
|
|
}
|
|
|
|
void repeater_print_stats(void)
|
|
{
|
|
LOGJ("\"event\":\"stats\",\"uptime_us\":%lld,"
|
|
"\"rx_candidates\":%" PRIu32 ",\"rx_valid\":%" PRIu32 ","
|
|
"\"rx_crc_fail\":%" PRIu32 ",\"rx_not_c1\":%" PRIu32 ","
|
|
"\"rx_len_invalid\":%" PRIu32 ",\"rx_bytes\":%" PRIu32 ","
|
|
"\"tx_attempts\":%" PRIu32 ",\"tx_success\":%" PRIu32 ","
|
|
"\"tx_timeout\":%" PRIu32 ",\"tx_failures\":%" PRIu32 ","
|
|
"\"tx_suppressed_dup\":%" PRIu32 ",\"tx_suppressed_whitelist\":%" PRIu32 ","
|
|
"\"radio_reinit\":%" PRIu32 ",\"fem_reinit\":%" PRIu32 ","
|
|
"\"recoveries\":%" PRIu32,
|
|
(long long)esp_timer_get_time(),
|
|
g_stats.rx_candidates, g_stats.rx_valid, g_stats.rx_crc_fail,
|
|
g_stats.rx_not_c1, g_stats.rx_len_invalid, g_stats.rx_bytes,
|
|
g_stats.tx_attempts, g_stats.tx_success, g_stats.tx_timeout,
|
|
g_stats.tx_failures, g_stats.tx_suppressed_dup,
|
|
g_stats.tx_suppressed_whitelist, g_stats.radio_reinit,
|
|
g_stats.fem_reinit, g_stats.recoveries);
|
|
}
|
|
|
|
void repeater_print_radio_status(void)
|
|
{
|
|
uint8_t st = sx126x_get_status();
|
|
LOGJ("\"event\":\"radio_status\",\"status_byte\":%u,\"chip_mode\":%u,"
|
|
"\"cmd_status\":%u,\"device_errors\":%u,\"rssi_dbm\":%d,"
|
|
"\"busy\":%s",
|
|
st, (st >> 4) & 0x7, (st >> 1) & 0x7,
|
|
sx126x_get_device_errors(), sx126x_get_rssi_inst(),
|
|
"false");
|
|
}
|