12 #define UNUSED(x) (void)(x)
39 #ifdef USE_RX_FRSKY_SPI_X
76 0x0000,0x1189,0x2312,0x329b,0x4624,0x57ad,0x6536,0x74bf,
77 0x8c48,0x9dc1,0xaf5a,0xbed3,0xca6c,0xdbe5,0xe97e,0xf8f7,
78 0x1081,0x0108,0x3393,0x221a,0x56a5,0x472c,0x75b7,0x643e,
79 0x9cc9,0x8d40,0xbfdb,0xae52,0xdaed,0xcb64,0xf9ff,0xe876,
80 0x2102,0x308b,0x0210,0x1399,0x6726,0x76af,0x4434,0x55bd,
81 0xad4a,0xbcc3,0x8e58,0x9fd1,0xeb6e,0xfae7,0xc87c,0xd9f5,
82 0x3183,0x200a,0x1291,0x0318,0x77a7,0x662e,0x54b5,0x453c,
83 0xbdcb,0xac42,0x9ed9,0x8f50,0xfbef,0xea66,0xd8fd,0xc974,
84 0x4204,0x538d,0x6116,0x709f,0x0420,0x15a9,0x2732,0x36bb,
85 0xce4c,0xdfc5,0xed5e,0xfcd7,0x8868,0x99e1,0xab7a,0xbaf3,
86 0x5285,0x430c,0x7197,0x601e,0x14a1,0x0528,0x37b3,0x263a,
87 0xdecd,0xcf44,0xfddf,0xec56,0x98e9,0x8960,0xbbfb,0xaa72,
88 0x6306,0x728f,0x4014,0x519d,0x2522,0x34ab,0x0630,0x17b9,
89 0xef4e,0xfec7,0xcc5c,0xddd5,0xa96a,0xb8e3,0x8a78,0x9bf1,
90 0x7387,0x620e,0x5095,0x411c,0x35a3,0x242a,0x16b1,0x0738,
91 0xffcf,0xee46,0xdcdd,0xcd54,0xb9eb,0xa862,0x9af9,0x8b70,
92 0x8408,0x9581,0xa71a,0xb693,0xc22c,0xd3a5,0xe13e,0xf0b7,
93 0x0840,0x19c9,0x2b52,0x3adb,0x4e64,0x5fed,0x6d76,0x7cff,
94 0x9489,0x8500,0xb79b,0xa612,0xd2ad,0xc324,0xf1bf,0xe036,
95 0x18c1,0x0948,0x3bd3,0x2a5a,0x5ee5,0x4f6c,0x7df7,0x6c7e,
96 0xa50a,0xb483,0x8618,0x9791,0xe32e,0xf2a7,0xc03c,0xd1b5,
97 0x2942,0x38cb,0x0a50,0x1bd9,0x6f66,0x7eef,0x4c74,0x5dfd,
98 0xb58b,0xa402,0x9699,0x8710,0xf3af,0xe226,0xd0bd,0xc134,
99 0x39c3,0x284a,0x1ad1,0x0b58,0x7fe7,0x6e6e,0x5cf5,0x4d7c,
100 0xc60c,0xd785,0xe51e,0xf497,0x8028,0x91a1,0xa33a,0xb2b3,
101 0x4a44,0x5bcd,0x6956,0x78df,0x0c60,0x1de9,0x2f72,0x3efb,
102 0xd68d,0xc704,0xf59f,0xe416,0x90a9,0x8120,0xb3bb,0xa232,
103 0x5ac5,0x4b4c,0x79d7,0x685e,0x1ce1,0x0d68,0x3ff3,0x2e7a,
104 0xe70e,0xf687,0xc41c,0xd595,0xa12a,0xb0a3,0x8238,0x93b1,
105 0x6b46,0x7acf,0x4854,0x59dd,0x2d62,0x3ceb,0x0e70,0x1ff9,
106 0xf78f,0xe606,0xd49d,0xc514,0xb1ab,0xa022,0x92b9,0x8330,
107 0x7bc7,0x6a4e,0x58d5,0x495c,0x3de3,0x2c6a,0x1ef1,0x0f78
110 #define TELEMETRY_OUT_BUFFER_SIZE 64
112 #define TELEMETRY_SEQUENCE_LENGTH 4
114 #define A1_CONST_X 50
130 #define SEQUENCE_MARKER_REMOTE_PART 0xf0
132 #define TELEMETRY_DATA_SIZE 5
144 #define TELEMETRY_FRAME_SIZE sizeof(telemetryData_t)
154 #if defined(USE_RX_FRSKY_SPI_TELEMETRY)
162 #if defined(USE_RX_FRSKY_SPI_TELEMETRY)
165 #if defined(USE_TELEMETRY_SMARTPORT)
182 for (
unsigned i = 0; i < len; i++) {
188 #if defined(USE_RX_FRSKY_SPI_TELEMETRY)
189 #if defined(USE_TELEMETRY_SMARTPORT)
192 static uint8_t telemetryOutReader = 0;
211 static bool evenRun =
false;
216 frame[3] = packet[3];
240 outFrameMarker-> raw = 0;
276 #if defined(USE_TELEMETRY_SMARTPORT)
308 if (packet[7] != 0) {
311 c[0] = (
uint16_t)((packet[10] << 8) & 0xF00) | packet[9];
312 c[1] = (
uint16_t)((packet[11] << 4) & 0xFF0) | (packet[10] >> 4);
313 c[2] = (
uint16_t)((packet[13] << 8) & 0xF00) | packet[12];
314 c[3] = (
uint16_t)((packet[14] << 4) & 0xFF0) | (packet[13] >> 4);
315 c[4] = (
uint16_t)((packet[16] << 8) & 0xF00) | packet[15];
316 c[5] = (
uint16_t)((packet[17] << 4) & 0xFF0) | (packet[16] >> 4);
317 c[6] = (
uint16_t)((packet[19] << 8) & 0xF00) | packet[18];
318 c[7] = (
uint16_t)((packet[20] << 4) & 0xFF0) | (packet[19] >> 4);
320 for (
unsigned i = 0; i < 8; i++) {
321 const bool channelIsShifted = c[i] & 0x800;
322 const uint16_t channelValue = c[i] & 0x7FF;
323 rcData[channelIsShifted ? i + 8 : i] = ((channelValue - 64) * 2 + 860 * 3) / 3;
342 static unsigned receiveTelemetryRetryCount = 0;
343 static bool skipChannels =
true;
345 static uint8_t remoteAckId = 0;
349 static bool frameReceived;
351 static uint8_t channelsToSkip = 1;
354 #if defined(USE_RX_FRSKY_SPI_TELEMETRY)
355 static bool telemetryReceived =
false;
371 frameReceived =
false;
372 receiveDelayUs = 5300;
395 channelsToSkip = packet[5] << 2;
405 telemetryReceived =
true;
406 skipChannels =
false;
418 if (remoteNewPacketId != remoteToAckId) {
419 while (remoteToAckId != remoteNewPacketId) {
424 receiveTelemetryRetryCount++;
434 receiveTelemetryRetryCount = 0;
437 uint8_t remoteNextAckId = remoteToAckId;
438 while (
telemetryRxBuffer[remoteToAckId].needsProcessing && remoteToAckId != remoteAckId) {
439 remoteNextAckId = remoteToAckId;
442 remoteAckId = remoteNextAckId;
446 if (receiveTelemetryRetryCount >= 5) {
447 #if defined(USE_RX_FRSKY_SPI_TELEMETRY) && defined(USE_TELEMETRY_SMARTPORT)
456 receiveTelemetryRetryCount = 0;
460 frameReceived =
true;
462 if (!frameReceived) {
469 if (telemetryReceived) {
488 #ifdef USE_RX_FRSKY_SPI_TELEMETRY
495 #if defined(USE_RX_CC2500_SPI_PA_LNA)
501 #if defined(USE_TELEMETRY_SMARTPORT)
514 receiveDelayUs = 5300;
515 frameReceived =
false;
518 #ifdef USE_RX_CC2500_SPI_PA_LNA
520 #if defined(USE_RX_CC2500_SPI_DIVERSITY)
522 cc2500switchAntennae();
529 telemetryReceived =
false;
543 #if defined(USE_RX_FRSKY_SPI_TELEMETRY) && defined(USE_TELEMETRY_SMARTPORT)
550 bool clearToSend =
false;
553 if ((now - pollingTimeMs) > 24) {
596 #if defined(USE_TELEMETRY_SMARTPORT)
void cc2500ReadFifo(uint8_t *dpbuffer, uint8_t len)
uint8_t cc2500ReadReg(uint8_t reg)
void cc2500WriteFifo(uint8_t *dpbuffer, uint8_t len)
void cc2500Strobe(uint8_t address)
void cc2500SetPower(uint8_t power)
#define CC2500_READ_BURST
void cc2500setRssiDbm(uint8_t value)
uint16_t cc2500getRssiDbm(void)
#define adcGetChannel(channel)
#define featureIsEnabled(mask)
#define delayMicroseconds(us)
#define getLegacyBatteryVoltage()
static timeDelta_t cmpTimeUs(timeUs_t a, timeUs_t b)
void nextChannel(uint8_t skip)
void initialiseData(bool inBindState)
static uint8_t protocolState
static rx_spi_protocol_e spiProtocol
#define DEBUG_DATA_MISSING_PACKETS
#define DEBUG_DATA_BAD_FRAME
void frSkyXInit(const rx_spi_protocol_e spiProtocol)
const uint16_t crcTable[]
#define TELEMETRY_SEQUENCE_LENGTH
struct telemetryBuffer_s telemetryBuffer_t
#define SEQUENCE_MARKER_REMOTE_PART
#define TELEMETRY_FRAME_SIZE
static void frSkyXTelemetrySendByte(uint8_t c)
static uint16_t telemetryDelayUs
static bool telemetryEnabled
static telemetrySequenceMarker_t responseToSend
telemetrySequenceMarkerData_t data
static telemetryData_t telemetryTxBuffer[TELEMETRY_SEQUENCE_LENGTH]
static telemetryBuffer_t telemetryRxBuffer[TELEMETRY_SEQUENCE_LENGTH]
struct telemetrySequenceMarkerData_s telemetrySequenceMarkerData_t
unsigned int retransmissionRequested
unsigned int ackSequenceId
static uint16_t calculateCrc(const uint8_t *data, uint8_t len)
struct telemetryPayload_s telemetryPayload_t
static uint8_t remoteToProcessIndex
static uint8_t packetLength
telemetrySequenceMarker_t sequence
struct telemetryData_s telemetryData_t
rx_spi_received_e frSkyXHandlePacket(uint8_t *const packet, uint8_t *const protocolState)
static void buildTelemetryFrame(uint8_t *packet)
static uint8_t telemetryOutBuffer[TELEMETRY_OUT_BUFFER_SIZE]
static uint8_t appendSmartPortData(uint8_t *buf)
rx_spi_received_e frSkyXProcessFrame(uint8_t *const packet)
#define TELEMETRY_DATA_SIZE
unsigned int packetSequenceId
bool isValidPacket(const uint8_t *packet)
unsigned int initResponse
static uint8_t telemetryOutWriter
static void frSkyXTelemetryWriteFrame(const smartPortPayload_t *payload)
#define TELEMETRY_OUT_BUFFER_SIZE
void frSkyXSetRcData(uint16_t *rcData, const uint8_t *packet)
static bool frSkyXCheckQueueEmpty(void)
static uint8_t remoteToProcessId
uint8_t data[TELEMETRY_DATA_SIZE]
union telemetrySequenceMarker_s telemetrySequenceMarker_t
void setRssiDirect(uint16_t newRssi, rssiSource_e source)
int16_t rcData[MAX_SUPPORTED_RC_CHANNEL_COUNT]
@ RSSI_SOURCE_RX_PROTOCOL
@ RX_SPI_ROCESSING_REQUIRED
void rxSpiLedToggle(void)
bool rxSpiCheckBindRequested(bool reset)
const rxCc2500SpiConfig_t * rxCc2500SpiConfig(void)
@ FRSKY_SPI_A1_SOURCE_CONST
@ FRSKY_SPI_A1_SOURCE_VBAT
@ FRSKY_SPI_A1_SOURCE_EXTADC
bool initSmartPortTelemetryExternal(smartPortWriteFrameFn *smartPortWriteFrameExternal)
smartPortPayload_t * smartPortDataReceive(uint16_t c, bool *clearToSend, smartPortCheckQueueEmptyFn *checkQueueEmpty, bool useChecksum)
void processSmartPortTelemetry(smartPortPayload_t *payload, volatile bool *clearToSend, const timeUs_t *requestTimeout)
struct smartPortPayload_s smartPortPayload_t
unsigned short uint16_t
Typedef defining 16 bit unsigned short type.
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.