2026-09-28 15:36:37 +02:00
|
|
|
#include "Comms.h"
|
|
|
|
|
#include "Config.h"
|
|
|
|
|
#include <RF24.h>
|
|
|
|
|
#include <SPI.h>
|
|
|
|
|
|
2026-09-28 18:14:00 +02:00
|
|
|
static_assert(HXP_RADIO_DATA_RATE == RF24_250KBPS && HXP_RADIO_PA_LEVEL == RF24_PA_LOW,
|
|
|
|
|
"HexapodProtocol.h radio enum values out of sync with RF24.h");
|
|
|
|
|
|
2026-09-28 15:36:37 +02:00
|
|
|
static RF24 radio(RADIO_CE_PIN, RADIO_CSN_PIN);
|
|
|
|
|
|
|
|
|
|
bool Comms::begin() {
|
2026-10-01 15:53:55 +02:00
|
|
|
SPI.setSCK(RADIO_SCK_PIN); // alternate SCK pin (see Config.h); before RF24 starts SPI
|
2026-09-28 15:36:37 +02:00
|
|
|
radio_present_ = radio.begin();
|
|
|
|
|
if (radio_present_) {
|
2026-11-17 14:42:37 +01:00
|
|
|
// Telemetry rides back on the auto-ack (ack payloads), which needs dynamic
|
|
|
|
|
// payload lengths - update() drops any packet that isn't a CmdPacket.
|
|
|
|
|
radio.enableAckPayload();
|
2026-09-28 18:14:00 +02:00
|
|
|
radio.openReadingPipe(1, HXP_RADIO_ADDRESS);
|
|
|
|
|
radio.setPALevel((rf24_pa_dbm_e)HXP_RADIO_PA_LEVEL);
|
|
|
|
|
radio.setDataRate((rf24_datarate_e)HXP_RADIO_DATA_RATE);
|
|
|
|
|
radio.setChannel(HXP_RADIO_CHANNEL);
|
2026-09-28 15:36:37 +02:00
|
|
|
radio.startListening();
|
2026-11-17 14:42:37 +01:00
|
|
|
loadAckPayload();
|
2026-09-28 15:36:37 +02:00
|
|
|
}
|
|
|
|
|
return radio_present_;
|
|
|
|
|
}
|
|
|
|
|
|
2026-11-17 14:42:37 +01:00
|
|
|
// Replaces whatever ack payload is still queued with the latest telemetry, so
|
|
|
|
|
// the remote never gets stale data.
|
|
|
|
|
void Comms::loadAckPayload() {
|
|
|
|
|
radio.flush_tx();
|
|
|
|
|
radio.writeAckPayload(1, &telemetry_, sizeof(telemetry_));
|
|
|
|
|
}
|
|
|
|
|
|
2026-09-28 15:36:37 +02:00
|
|
|
void Comms::update() {
|
|
|
|
|
if (radio_present_) {
|
2026-11-17 14:42:37 +01:00
|
|
|
bool got = false;
|
2026-09-28 15:36:37 +02:00
|
|
|
while (radio.available()) {
|
2026-11-17 14:42:37 +01:00
|
|
|
uint8_t len = radio.getDynamicPayloadSize();
|
|
|
|
|
if (len == sizeof(CmdPacket)) {
|
|
|
|
|
radio.read(&packet_, sizeof(packet_));
|
|
|
|
|
last_rx_ms_ = millis();
|
|
|
|
|
rx_count_++;
|
|
|
|
|
got = true;
|
|
|
|
|
} else if (len > 0) { // 0 = corrupt length; RF24 has flushed the FIFO already
|
|
|
|
|
uint8_t junk[32]; // another protocol version: never act on it
|
|
|
|
|
radio.read(junk, len <= sizeof(junk) ? len : sizeof(junk));
|
|
|
|
|
}
|
2026-09-28 15:36:37 +02:00
|
|
|
}
|
2026-11-17 14:42:37 +01:00
|
|
|
if (got) loadAckPayload();
|
|
|
|
|
}
|
|
|
|
|
uint32_t now = millis();
|
|
|
|
|
if (now - rate_window_ms_ >= 1000) {
|
|
|
|
|
rx_per_sec_ = (uint8_t)min(rx_count_, (uint16_t)255);
|
|
|
|
|
rx_count_ = 0;
|
|
|
|
|
rate_window_ms_ = now;
|
2026-09-28 15:36:37 +02:00
|
|
|
}
|
|
|
|
|
link_ok_ = (millis() - last_rx_ms_) < (uint32_t)(LINK_TIMEOUT_SEC * 1000);
|
|
|
|
|
}
|