#include "Comms.h" #include "Config.h" #include #include 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"); static RF24 radio(RADIO_CE_PIN, RADIO_CSN_PIN); bool Comms::begin() { SPI.setSCK(RADIO_SCK_PIN); // alternate SCK pin (see Config.h); before RF24 starts SPI radio_present_ = radio.begin(); if (radio_present_) { // 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(); 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); radio.startListening(); loadAckPayload(); } return radio_present_; } // 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_)); } void Comms::update() { if (radio_present_) { bool got = false; while (radio.available()) { 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)); } } 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; } link_ok_ = (millis() - last_rx_ms_) < (uint32_t)(LINK_TIMEOUT_SEC * 1000); }