Git-Mirrors/RNode_Firmware_CE
1
0
Fork 0
mirror of https://github.com/liberatedsystems/RNode_Firmware_CE.git synced 2025-02-02 10:26:21 -05:00
Code Issues Actions Packages Projects Releases Wiki Activity

Revert radiolib work and fix SX127X issues #39

Browse Source
This commit is contained in:
jacob.eva 2025-01-09 21:26:58 +00:00
parent 734727ebc6
commit 46a46b4069
No known key found for this signature in database
GPG Key ID: 0B92E083BBCCAA1E
6 changed files with 120 additions and 184 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
Config.h
View File

@ -80,8 +80,6 @@
bool memory_low = false; bool memory_low = false;
uint8_t implicit_l = 0; uint8_t implicit_l = 0;
uint8_t packet_interface = 0xFF;
uint8_t op_mode = MODE_HOST; uint8_t op_mode = MODE_HOST;
uint8_t model = 0x00; uint8_t model = 0x00;
uint8_t hwrev = 0x00; uint8_t hwrev = 0x00;

26
Framing.h
View File

@ -78,31 +78,9 @@
#define CMD_INTERFACES 0x64 #define CMD_INTERFACES 0x64
#define CMD_INT0_DATA 0x00 #define CMD_DATA 0x00
#define CMD_INT1_DATA 0x10
#define CMD_INT2_DATA 0x20
#define CMD_INT3_DATA 0x70
#define CMD_INT4_DATA 0x75
#define CMD_INT5_DATA 0x90
#define CMD_INT6_DATA 0xA0
#define CMD_INT7_DATA 0xB0
#define CMD_INT8_DATA 0xC0
#define CMD_INT9_DATA 0xD0
#define CMD_INT10_DATA 0xE0
#define CMD_INT11_DATA 0xF0
#define CMD_SEL_INT0 0x1E #define CMD_SEL_INT 0x1F
#define CMD_SEL_INT1 0x1F
#define CMD_SEL_INT2 0x2F
#define CMD_SEL_INT3 0x74
#define CMD_SEL_INT4 0x7F
#define CMD_SEL_INT5 0x9F
#define CMD_SEL_INT6 0xAF
#define CMD_SEL_INT7 0xBF
#define CMD_SEL_INT8 0xCF
#define CMD_SEL_INT9 0xDF
#define CMD_SEL_INT10 0xEF
#define CMD_SEL_INT11 0xFF
#define DETECT_REQ 0x73 #define DETECT_REQ 0x73
#define DETECT_RESP 0x46 #define DETECT_RESP 0x46

97
RNode_Firmware_CE.ino
View File

@ -349,12 +349,15 @@ void lora_receive(RadioInterface* radio) {
} }
inline void kiss_write_packet(int index) { inline void kiss_write_packet(int index) {
// We need to convert the interface index to the command byte representation
uint8_t cmd_byte = getInterfaceCommandByte(index); // Print index of interface the packet came from
serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(index);
serial_write(FEND);
serial_write(FEND); serial_write(FEND);
// Add index of interface the packet came from serial_write(CMD_DATA);
serial_write(cmd_byte);
for (uint16_t i = 0; i < read_len[index]; i++) { for (uint16_t i = 0; i < read_len[index]; i++) {
#if MCU_VARIANT == MCU_NRF52 #if MCU_VARIANT == MCU_NRF52
@ -689,39 +692,27 @@ void transmit(RadioInterface* radio, uint16_t size) {
void serialCallback(uint8_t sbyte) { void serialCallback(uint8_t sbyte) {
if (IN_FRAME && sbyte == FEND && if (IN_FRAME && sbyte == FEND &&
(command == CMD_INT0_DATA command == CMD_DATA) {
|| command == CMD_INT1_DATA
|| command == CMD_INT2_DATA
|| command == CMD_INT3_DATA
|| command == CMD_INT4_DATA
|| command == CMD_INT5_DATA
|| command == CMD_INT6_DATA
|| command == CMD_INT7_DATA
|| command == CMD_INT8_DATA
|| command == CMD_INT9_DATA
|| command == CMD_INT10_DATA
|| command == CMD_INT11_DATA)) {
IN_FRAME = false; IN_FRAME = false;
if (getInterfaceIndex(command) < INTERFACE_COUNT) { if (interface < INTERFACE_COUNT) {
uint8_t index = getInterfaceIndex(command); if (!fifo16_isfull(&packet_starts[interface]) && (queued_bytes[interface] < (getQueueSize(interface)))) {
if (!fifo16_isfull(&packet_starts[index]) && (queued_bytes[index] < (getQueueSize(index)))) { uint16_t s = current_packet_start[interface];
uint16_t s = current_packet_start[index]; int32_t e = queue_cursor[interface]-1; if (e == -1) e = (getQueueSize(interface))-1;
int32_t e = queue_cursor[index]-1; if (e == -1) e = (getQueueSize(index))-1;
uint16_t l; uint16_t l;
if (s != e) { if (s != e) {
l = (s < e) ? e - s + 1: (getQueueSize(index)) - s + e + 1; l = (s < e) ? e - s + 1: (getQueueSize(interface)) - s + e + 1;
} else { } else {
l = 1; l = 1;
} }
if (l >= MIN_L) { if (l >= MIN_L) {
queue_height[index]++; queue_height[interface]++;
fifo16_push(&packet_starts[index], s); fifo16_push(&packet_starts[interface], s);
fifo16_push(&packet_lengths[index], l); fifo16_push(&packet_lengths[interface], l);
current_packet_start[index] = queue_cursor[index]; current_packet_start[interface] = queue_cursor[interface];
} }
} }
@ -735,33 +726,10 @@ void serialCallback(uint8_t sbyte) {
// Have a look at the command byte first // Have a look at the command byte first
if (frame_len == 0 && command == CMD_UNKNOWN) { if (frame_len == 0 && command == CMD_UNKNOWN) {
command = sbyte; command = sbyte;
if (command == CMD_SEL_INT0
|| command == CMD_SEL_INT1
|| command == CMD_SEL_INT2
|| command == CMD_SEL_INT3
|| command == CMD_SEL_INT4
|| command == CMD_SEL_INT5
|| command == CMD_SEL_INT6
|| command == CMD_SEL_INT7
|| command == CMD_SEL_INT8
|| command == CMD_SEL_INT9
|| command == CMD_SEL_INT10
|| command == CMD_SEL_INT11) {
interface = getInterfaceIndex(command);
}
} else if (command == CMD_INT0_DATA } else if (command == CMD_SEL_INT) {
|| command == CMD_INT1_DATA interface = sbyte;
|| command == CMD_INT2_DATA } else if (command == CMD_DATA) {
|| command == CMD_INT3_DATA
|| command == CMD_INT4_DATA
|| command == CMD_INT5_DATA
|| command == CMD_INT6_DATA
|| command == CMD_INT7_DATA
|| command == CMD_INT8_DATA
|| command == CMD_INT9_DATA
|| command == CMD_INT10_DATA
|| command == CMD_INT11_DATA) {
if (bt_state != BT_STATE_CONNECTED) cable_state = CABLE_STATE_CONNECTED; if (bt_state != BT_STATE_CONNECTED) cable_state = CABLE_STATE_CONNECTED;
if (sbyte == FESC) { if (sbyte == FESC) {
ESCAPE = true; ESCAPE = true;
@ -772,12 +740,11 @@ void serialCallback(uint8_t sbyte) {
ESCAPE = false; ESCAPE = false;
} }
if (getInterfaceIndex(command) < INTERFACE_COUNT) { if (interface < INTERFACE_COUNT) {
uint8_t index = getInterfaceIndex(command); if (queue_height[interface] < CONFIG_QUEUE_MAX_LENGTH && queued_bytes[interface] < (getQueueSize(interface))) {
if (queue_height[index] < CONFIG_QUEUE_MAX_LENGTH && queued_bytes[index] < (getQueueSize(index))) { queued_bytes[interface]++;
queued_bytes[index]++; packet_queue[interface][queue_cursor[interface]++] = sbyte;
packet_queue[index][queue_cursor[index]++] = sbyte; if (queue_cursor[interface] == (getQueueSize(interface))) queue_cursor[interface] = 0;
if (queue_cursor[index] == (getQueueSize(index))) queue_cursor[index] = 0;
} }
} }
} }
@ -962,7 +929,7 @@ void serialCallback(uint8_t sbyte) {
} else if (command == CMD_STAT_TX) { } else if (command == CMD_STAT_TX) {
kiss_indicate_stat_tx(); kiss_indicate_stat_tx();
} else if (command == CMD_STAT_RSSI) { } else if (command == CMD_STAT_RSSI) {
kiss_indicate_stat_rssi(); kiss_indicate_stat_rssi(interface_obj[interface]);
} else if (command == CMD_RADIO_LOCK) { } else if (command == CMD_RADIO_LOCK) {
selected_radio = interface_obj[interface]; selected_radio = interface_obj[interface];
update_radio_lock(selected_radio); update_radio_lock(selected_radio);
@ -1320,7 +1287,7 @@ void loop() {
#if MCU_VARIANT == MCU_ESP32 #if MCU_VARIANT == MCU_ESP32
modem_packet_t *modem_packet = NULL; modem_packet_t *modem_packet = NULL;
if(modem_packet_queue && xQueueReceive(modem_packet_queue, &modem_packet, 0) == pdTRUE && modem_packet) { if(modem_packet_queue && xQueueReceive(modem_packet_queue, &modem_packet, 0) == pdTRUE && modem_packet) {
packet_interface = modem_packet->interface; uint8_t packet_interface = modem_packet->interface;
read_len[packet_interface] = modem_packet->len; read_len[packet_interface] = modem_packet->len;
last_rssi = modem_packet->rssi; last_rssi = modem_packet->rssi;
last_snr_raw = modem_packet->snr_raw; last_snr_raw = modem_packet->snr_raw;
@ -1328,15 +1295,15 @@ void loop() {
free(modem_packet); free(modem_packet);
modem_packet = NULL; modem_packet = NULL;
kiss_indicate_stat_rssi(); kiss_indicate_stat_rssi(interface_obj[packet_interface]);
kiss_indicate_stat_snr(); kiss_indicate_stat_snr(interface_obj[packet_interface]);
kiss_write_packet(packet_interface); kiss_write_packet(packet_interface);
} }
#elif MCU_VARIANT == MCU_NRF52 #elif MCU_VARIANT == MCU_NRF52
modem_packet_t *modem_packet = NULL; modem_packet_t *modem_packet = NULL;
if(modem_packet_queue && xQueueReceive(modem_packet_queue, &modem_packet, 0) == pdTRUE && modem_packet) { if(modem_packet_queue && xQueueReceive(modem_packet_queue, &modem_packet, 0) == pdTRUE && modem_packet) {
packet_interface = modem_packet->interface; uint8_t packet_interface = modem_packet->interface;
read_len[packet_interface] = modem_packet->len; read_len[packet_interface] = modem_packet->len;
last_rssi = modem_packet->rssi; last_rssi = modem_packet->rssi;
last_snr_raw = modem_packet->snr_raw; last_snr_raw = modem_packet->snr_raw;
@ -1344,8 +1311,8 @@ void loop() {
free(modem_packet); free(modem_packet);
modem_packet = NULL; modem_packet = NULL;
kiss_indicate_stat_rssi(); kiss_indicate_stat_rssi(packet_interface);
kiss_indicate_stat_snr(); kiss_indicate_stat_snr(packet_interface);
kiss_write_packet(packet_interface); kiss_write_packet(packet_interface);
} }
#endif #endif

22
Radio.cpp
View File

@ -1094,7 +1094,7 @@ sx127x::sx127x(uint8_t index, SPIClass* spi, int ss, int sclk, int mosi, int mis
_spiSettings(8E6, MSBFIRST, SPI_MODE0), _spiSettings(8E6, MSBFIRST, SPI_MODE0),
_spiModem(spi), _spiModem(spi),
_ss(ss), _sclk(sclk), _mosi(mosi), _miso(miso), _reset(reset), _dio0(dio0), _ss(ss), _sclk(sclk), _mosi(mosi), _miso(miso), _reset(reset), _dio0(dio0),
_busy(busy), _frequency(0), _packetIndex(0), _preinit_done(false) _busy(busy), _frequency(0), _packetIndex(0), _preinit_done(false), _bw(0)
{ {
setTimeout(0); setTimeout(0);
// TODO, figure out why this has to be done. Using the index to reference the // TODO, figure out why this has to be done. Using the index to reference the
@ -1384,10 +1384,12 @@ void sx127x::setTxPower(int level, int outputPin) {
writeRegister(REG_PA_DAC_7X, 0x84); writeRegister(REG_PA_DAC_7X, 0x84);
writeRegister(REG_PA_CONFIG_7X, PA_BOOST_7X | (level - 2)); writeRegister(REG_PA_CONFIG_7X, PA_BOOST_7X | (level - 2));
_txp = level;
} }
} }
int8_t sx127x::getTxPower() { byte txp = readRegister(REG_PA_CONFIG_7X); return ((int8_t)txp) - 126; } // temporary fix for SX127X power weirdness //int8_t sx127x::getTxPower() { return readRegister(REG_PA_CONFIG_7X) - 126; }
int8_t sx127x::getTxPower() { return _txp; }
void sx127x::setFrequency(uint32_t frequency) { void sx127x::setFrequency(uint32_t frequency) {
_frequency = frequency; _frequency = frequency;
@ -1409,7 +1411,12 @@ uint32_t sx127x::getFrequency() {
uint64_t frm = (uint64_t)frf*32000000; uint64_t frm = (uint64_t)frf*32000000;
uint32_t frequency = (frm >> 19); uint32_t frequency = (frm >> 19);
// TODO, figure out why frequency from module is slightly wrong
if (_frequency != frequency) {
return _frequency;
} else {
return frequency; return frequency;
}
} }
void sx127x::setSpreadingFactor(int sf) { void sx127x::setSpreadingFactor(int sf) {
@ -1436,7 +1443,12 @@ uint8_t sx127x::getSpreadingFactor()
} }
uint32_t sx127x::getSignalBandwidth() { uint32_t sx127x::getSignalBandwidth() {
byte bw = (readRegister(REG_MODEM_CONFIG_1_7X) >> 4); uint8_t bw;
if (_radio_online) {
bw = (readRegister(REG_MODEM_CONFIG_1_7X) >> 4);
} else {
bw = _bw;
}
switch (bw) { switch (bw) {
case 0: return 7.8E3; case 0: return 7.8E3;
case 1: return 10.4E3; case 1: return 10.4E3;
@ -1447,7 +1459,8 @@ uint32_t sx127x::getSignalBandwidth() {
case 6: return 62.5E3; case 6: return 62.5E3;
case 7: return 125E3; case 7: return 125E3;
case 8: return 250E3; case 8: return 250E3;
case 9: return 500E3; } case 9: return 500E3;
}
return 0; return 0;
} }
@ -1477,6 +1490,7 @@ void sx127x::setSignalBandwidth(uint32_t sbw) {
} }
writeRegister(REG_MODEM_CONFIG_1_7X, (readRegister(REG_MODEM_CONFIG_1_7X) & 0x0f) | (bw << 4)); writeRegister(REG_MODEM_CONFIG_1_7X, (readRegister(REG_MODEM_CONFIG_1_7X) & 0x0f) | (bw << 4));
_bw = bw;
handleLowDataRate(); handleLowDataRate();
optimizeModemSensitivity(); optimizeModemSensitivity();
} }

1
Radio.hpp
View File

@ -546,6 +546,7 @@ private:
bool _preinit_done; bool _preinit_done;
uint8_t _sf; uint8_t _sf;
uint8_t _cr; uint8_t _cr;
uint8_t _bw;
}; };
class sx128x : public RadioInterface { class sx128x : public RadioInterface {

130
Utilities.h
View File

@ -653,6 +653,10 @@ void kiss_indicate_error(uint8_t error_code) {
void kiss_indicate_radiostate(RadioInterface* radio) { void kiss_indicate_radiostate(RadioInterface* radio) {
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_RADIO_STATE); serial_write(CMD_RADIO_STATE);
serial_write(radio->getRadioOnline()); serial_write(radio->getRadioOnline());
serial_write(FEND); serial_write(FEND);
@ -680,7 +684,11 @@ void kiss_indicate_stat_tx() {
//serial_write(FEND); //serial_write(FEND);
} }
void kiss_indicate_stat_rssi() { void kiss_indicate_stat_rssi(RadioInterface* radio) {
serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
uint8_t packet_rssi_val = (uint8_t)(last_rssi+rssi_offset); uint8_t packet_rssi_val = (uint8_t)(last_rssi+rssi_offset);
serial_write(FEND); serial_write(FEND);
serial_write(CMD_STAT_RSSI); serial_write(CMD_STAT_RSSI);
@ -688,7 +696,11 @@ void kiss_indicate_stat_rssi() {
serial_write(FEND); serial_write(FEND);
} }
void kiss_indicate_stat_snr() { void kiss_indicate_stat_snr(RadioInterface* radio) {
serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND); serial_write(FEND);
serial_write(CMD_STAT_SNR); serial_write(CMD_STAT_SNR);
escaped_serial_write(last_snr_raw); escaped_serial_write(last_snr_raw);
@ -697,6 +709,10 @@ void kiss_indicate_stat_snr() {
void kiss_indicate_radio_lock(RadioInterface* radio) { void kiss_indicate_radio_lock(RadioInterface* radio) {
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_RADIO_LOCK); serial_write(CMD_RADIO_LOCK);
serial_write(radio->getRadioLock()); serial_write(radio->getRadioLock());
serial_write(FEND); serial_write(FEND);
@ -704,6 +720,10 @@ void kiss_indicate_radio_lock(RadioInterface* radio) {
void kiss_indicate_spreadingfactor(RadioInterface* radio) { void kiss_indicate_spreadingfactor(RadioInterface* radio) {
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_SF); serial_write(CMD_SF);
serial_write(radio->getSpreadingFactor()); serial_write(radio->getSpreadingFactor());
serial_write(FEND); serial_write(FEND);
@ -711,6 +731,10 @@ void kiss_indicate_spreadingfactor(RadioInterface* radio) {
void kiss_indicate_codingrate(RadioInterface* radio) { void kiss_indicate_codingrate(RadioInterface* radio) {
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_CR); serial_write(CMD_CR);
serial_write(radio->getCodingRate4()); serial_write(radio->getCodingRate4());
serial_write(FEND); serial_write(FEND);
@ -726,6 +750,10 @@ void kiss_indicate_implicit_length() {
void kiss_indicate_txpower(RadioInterface* radio) { void kiss_indicate_txpower(RadioInterface* radio) {
int8_t txp = radio->getTxPower(); int8_t txp = radio->getTxPower();
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_TXPOWER); serial_write(CMD_TXPOWER);
serial_write(txp); serial_write(txp);
serial_write(FEND); serial_write(FEND);
@ -734,6 +762,10 @@ void kiss_indicate_txpower(RadioInterface* radio) {
void kiss_indicate_bandwidth(RadioInterface* radio) { void kiss_indicate_bandwidth(RadioInterface* radio) {
uint32_t bw = radio->getSignalBandwidth(); uint32_t bw = radio->getSignalBandwidth();
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_BANDWIDTH); serial_write(CMD_BANDWIDTH);
escaped_serial_write(bw>>24); escaped_serial_write(bw>>24);
escaped_serial_write(bw>>16); escaped_serial_write(bw>>16);
@ -745,6 +777,10 @@ void kiss_indicate_bandwidth(RadioInterface* radio) {
void kiss_indicate_frequency(RadioInterface* radio) { void kiss_indicate_frequency(RadioInterface* radio) {
uint32_t freq = radio->getFrequency(); uint32_t freq = radio->getFrequency();
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_FREQUENCY); serial_write(CMD_FREQUENCY);
escaped_serial_write(freq>>24); escaped_serial_write(freq>>24);
escaped_serial_write(freq>>16); escaped_serial_write(freq>>16);
@ -765,6 +801,10 @@ void kiss_indicate_interface(int index) {
void kiss_indicate_st_alock(RadioInterface* radio) { void kiss_indicate_st_alock(RadioInterface* radio) {
uint16_t at = (uint16_t)(radio->getSTALock()*100*100); uint16_t at = (uint16_t)(radio->getSTALock()*100*100);
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_ST_ALOCK); serial_write(CMD_ST_ALOCK);
escaped_serial_write(at>>8); escaped_serial_write(at>>8);
escaped_serial_write(at); escaped_serial_write(at);
@ -774,6 +814,10 @@ void kiss_indicate_st_alock(RadioInterface* radio) {
void kiss_indicate_lt_alock(RadioInterface* radio) { void kiss_indicate_lt_alock(RadioInterface* radio) {
uint16_t at = (uint16_t)(radio->getLTALock()*100*100); uint16_t at = (uint16_t)(radio->getLTALock()*100*100);
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_LT_ALOCK); serial_write(CMD_LT_ALOCK);
escaped_serial_write(at>>8); escaped_serial_write(at>>8);
escaped_serial_write(at); escaped_serial_write(at);
@ -786,6 +830,10 @@ void kiss_indicate_channel_stats(RadioInterface* radio) {
uint16_t cls = (uint16_t)(radio->getTotalChannelUtil()*100*100); uint16_t cls = (uint16_t)(radio->getTotalChannelUtil()*100*100);
uint16_t cll = (uint16_t)(radio->getLongtermChannelUtil()*100*100); uint16_t cll = (uint16_t)(radio->getLongtermChannelUtil()*100*100);
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_STAT_CHTM); serial_write(CMD_STAT_CHTM);
escaped_serial_write(ats>>8); escaped_serial_write(ats>>8);
escaped_serial_write(ats); escaped_serial_write(ats);
@ -805,6 +853,10 @@ void kiss_indicate_phy_stats(RadioInterface* radio) {
uint16_t prt = (uint16_t)((radio->getPreambleLength()+4)*radio->getSymbolTime()); uint16_t prt = (uint16_t)((radio->getPreambleLength()+4)*radio->getSymbolTime());
uint16_t cst = (uint16_t)(radio->getCSMASlotMS()); uint16_t cst = (uint16_t)(radio->getCSMASlotMS());
serial_write(FEND); serial_write(FEND);
serial_write(CMD_SEL_INT);
serial_write(radio->getIndex());
serial_write(FEND);
serial_write(FEND);
serial_write(CMD_STAT_PHYPRM); serial_write(CMD_STAT_PHYPRM);
escaped_serial_write(lst>>8); escaped_serial_write(lst>>8);
escaped_serial_write(lst); escaped_serial_write(lst);
@ -1085,80 +1137,6 @@ uint8_t getRandom(RadioInterface* radio) {
} }
} }
uint8_t getInterfaceIndex(uint8_t byte) {
switch (byte) {
case CMD_INT0_DATA:
case CMD_SEL_INT0:
return 0;
case CMD_INT1_DATA:
case CMD_SEL_INT1:
return 1;
case CMD_INT2_DATA:
case CMD_SEL_INT2:
return 2;
case CMD_INT3_DATA:
case CMD_SEL_INT3:
return 3;
case CMD_INT4_DATA:
case CMD_SEL_INT4:
return 4;
case CMD_INT5_DATA:
case CMD_SEL_INT5:
return 5;
case CMD_INT6_DATA:
case CMD_SEL_INT6:
return 6;
case CMD_INT7_DATA:
case CMD_SEL_INT7:
return 7;
case CMD_INT8_DATA:
case CMD_SEL_INT8:
return 8;
case CMD_INT9_DATA:
case CMD_SEL_INT9:
return 9;
case CMD_INT10_DATA:
case CMD_SEL_INT10:
return 10;
case CMD_INT11_DATA:
case CMD_SEL_INT11:
return 11;
default:
return 0;
}
}
uint8_t getInterfaceCommandByte(uint8_t index) {
switch (index) {
case 0:
return CMD_INT0_DATA;
case 1:
return CMD_INT1_DATA;
case 2:
return CMD_INT2_DATA;
case 3:
return CMD_INT3_DATA;
case 4:
return CMD_INT4_DATA;
case 5:
return CMD_INT5_DATA;
case 6:
return CMD_INT6_DATA;
case 7:
return CMD_INT7_DATA;
case 8:
return CMD_INT8_DATA;
case 9:
return CMD_INT9_DATA;
case 10:
return CMD_INT10_DATA;
case 11:
return CMD_INT11_DATA;
default:
return 0;
}
}
uint16_t getQueueSize(uint8_t index) { uint16_t getQueueSize(uint8_t index) {
switch (index) { switch (index) {
case 0: case 0: