Add the beginnings of I2C support.

This commit is contained in:
Jonathan Naylor 2020-11-13 15:20:54 +00:00
parent c5b542f438
commit 519af80ac4
3 changed files with 100 additions and 23 deletions

View File

@ -107,6 +107,9 @@
// Use the modem as a serial repeater for Nextion displays // Use the modem as a serial repeater for Nextion displays
#define SERIAL_REPEATER #define SERIAL_REPEATER
// Use the modem as an I2C repeater for OLED displays
#define I2C_REPEATER
// To reduce CPU load, you can remove the DC blocker by commenting out the next line // To reduce CPU load, you can remove the DC blocker by commenting out the next line
#define USE_DCBLOCKER #define USE_DCBLOCKER

View File

@ -82,6 +82,7 @@ const uint8_t MMDVM_ACK = 0x70U;
const uint8_t MMDVM_NAK = 0x7FU; const uint8_t MMDVM_NAK = 0x7FU;
const uint8_t MMDVM_SERIAL_DATA = 0x80U; const uint8_t MMDVM_SERIAL_DATA = 0x80U;
const uint8_t MMDVM_I2C_DATA = 0x81U;
const uint8_t MMDVM_TRANSPARENT = 0x90U; const uint8_t MMDVM_TRANSPARENT = 0x90U;
const uint8_t MMDVM_QSO_INFO = 0x91U; const uint8_t MMDVM_QSO_INFO = 0x91U;
@ -131,9 +132,12 @@ m_buffer(),
m_ptr(0U), m_ptr(0U),
m_len(0U), m_len(0U),
m_debug(false), m_debug(false),
m_repeat(), m_serialData(),
m_lastAvail(0), m_lastSerialAvail(0),
m_lastAvailCount(0U) m_lastSerialAvailCount(0U),
m_i2CData(),
m_lastI2CAvail(0),
m_lastI2CAvailCount(0U)
{ {
} }
@ -850,6 +854,9 @@ void CSerialPort::start()
#if defined(SERIAL_REPEATER) #if defined(SERIAL_REPEATER)
beginInt(3U, 9600); beginInt(3U, 9600);
#endif #endif
#if defined(I2C_REPEATER)
beginInt(10U, 9600);
#endif
} }
void CSerialPort::process() void CSerialPort::process()
@ -904,34 +911,67 @@ void CSerialPort::process()
#if defined(SERIAL_REPEATER) #if defined(SERIAL_REPEATER)
// Write any outgoing serial data // Write any outgoing serial data
uint16_t space = m_repeat.getData(); uint16_t serialSpace = m_serialData.getData();
if (space > 0U) { if (serialSpace > 0U) {
int avail = availableForWriteInt(3U); int avail = availableForWriteInt(3U);
if (avail < space) if (avail < serialSpace)
space = avail; serialSpace = avail;
for (uint16_t i = 0U; i < space; i++) { for (uint16_t i = 0U; i < serialSpace; i++) {
uint8_t c = 0U; uint8_t c = 0U;
m_repeat.get(c); m_serialData.get(c);
writeInt(3U, &c, 1U); writeInt(3U, &c, 1U);
} }
} }
// Read any incoming serial data, and send out in batches // Read any incoming serial data, and send out in batches
int avail = availableForReadInt(3U); int serialAvail = availableForReadInt(3U);
if ((avail > 0 && avail == m_lastAvail && m_lastAvailCount >= MAX_SERIAL_COUNT) || (avail >= MAX_SERIAL_DATA)) { if ((serialAvail > 0 && serialAvail == m_lastSerialAvail && m_lastSerialAvailCount >= MAX_SERIAL_COUNT) || (serialAvail >= MAX_SERIAL_DATA)) {
uint8_t buffer[MAX_SERIAL_DATA]; uint8_t buffer[MAX_SERIAL_DATA];
for (int i = 0; i < avail && i < MAX_SERIAL_DATA; i++) { for (int i = 0; i < serialAvail && i < MAX_SERIAL_DATA; i++) {
buffer[i] = readInt(3U); buffer[i] = readInt(3U);
m_lastAvail--; m_lastSerialAvail--;
} }
writeSerialData(buffer, avail - m_lastAvail); writeSerialData(buffer, serialAvail - m_lastSerialAvail);
m_lastAvailCount = 0U; m_lastSerialAvailCount = 0U;
} else if (avail > 0U && avail == m_lastAvail) { } else if (serialAvail > 0U && serialAvail == m_lastSerialAvail) {
m_lastAvailCount++; m_lastSerialAvailCount++;
} else { } else {
m_lastAvail = avail; m_lastSerialAvail = serialAvail;
m_lastAvailCount = 0U; m_lastSerialAvailCount = 0U;
}
#endif
#if defined(I2C_REPEATER)
// Write any outgoing serial data
uint16_t i2CSpace = m_i2CData.getData();
if (i2CSpace > 0U) {
int avail = availableForWriteInt(10U);
if (avail < i2CSpace)
i2CSpace = avail;
for (uint16_t i = 0U; i < i2CSpace; i++) {
uint8_t c = 0U;
m_i2CData.get(c);
writeInt(10U, &c, 1U);
}
}
// Read any incoming serial data, and send out in batches
int i2CAvail = availableForReadInt(10U);
if ((i2CAvail > 0 && i2CAvail == m_lastI2CAvail && m_lastI2CAvailCount >= MAX_SERIAL_COUNT) || (i2CAvail >= MAX_SERIAL_DATA)) {
uint8_t buffer[MAX_SERIAL_DATA];
for (int i = 0; i < i2CAvail && i < MAX_SERIAL_DATA; i++) {
buffer[i] = readInt(10U);
m_lastI2CAvail--;
}
writeI2CData(buffer, i2CAvail - m_lastI2CAvail);
m_lastI2CAvailCount = 0U;
} else if (i2CAvail > 0U && i2CAvail == m_lastI2CAvail) {
m_lastI2CAvailCount++;
} else {
m_lastI2CAvail = i2CAvail;
m_lastI2CAvailCount = 0U;
} }
#endif #endif
} }
@ -1304,7 +1344,15 @@ void CSerialPort::processMessage(const uint8_t* buffer, uint16_t length)
#if defined(SERIAL_REPEATER) #if defined(SERIAL_REPEATER)
case MMDVM_SERIAL_DATA: { case MMDVM_SERIAL_DATA: {
for (uint8_t i = 3U; i < m_len; i++) for (uint8_t i = 3U; i < m_len; i++)
m_repeat.put(m_buffer[i]); m_serialData.put(m_buffer[i]);
}
break;
#endif
#if defined(I2C_REPEATER)
case MMDVM_I2C_DATA: {
for (uint8_t i = 3U; i < m_len; i++)
m_i2CData.put(m_buffer[i]);
} }
break; break;
#endif #endif
@ -1755,6 +1803,25 @@ void CSerialPort::writeSerialData(const uint8_t* data, uint8_t length)
} }
#endif #endif
#if defined(I2C_REPEATER)
void CSerialPort::writeI2CData(const uint8_t* data, uint8_t length)
{
uint8_t reply[255U];
reply[0U] = MMDVM_FRAME_START;
reply[1U] = 0U;
reply[2U] = MMDVM_I2C_DATA;
uint8_t count = 3U;
for (uint8_t i = 0U; i < length; i++, count++)
reply[count] = data[i];
reply[1U] = count;
writeInt(1U, reply, count);
}
#endif
void CSerialPort::writeCalData(const uint8_t* data, uint8_t length) void CSerialPort::writeCalData(const uint8_t* data, uint8_t length)
{ {
if (m_modemState != STATE_DSTARCAL) if (m_modemState != STATE_DSTARCAL)

View File

@ -83,6 +83,10 @@ public:
void writeSerialData(const uint8_t* data, uint8_t length); void writeSerialData(const uint8_t* data, uint8_t length);
#endif #endif
#if defined(I2C_REPEATER)
void writeI2CData(const uint8_t* data, uint8_t length);
#endif
void writeCalData(const uint8_t* data, uint8_t length); void writeCalData(const uint8_t* data, uint8_t length);
void writeRSSIData(const uint8_t* data, uint8_t length); void writeRSSIData(const uint8_t* data, uint8_t length);
@ -97,9 +101,12 @@ private:
uint16_t m_ptr; uint16_t m_ptr;
uint16_t m_len; uint16_t m_len;
bool m_debug; bool m_debug;
CRingBuffer<uint8_t> m_repeat; CRingBuffer<uint8_t> m_serialData;
int m_lastAvail; int m_lastSerialAvail;
uint16_t m_lastAvailCount; uint16_t m_lastSerialAvailCount;
CRingBuffer<uint8_t> m_i2CData;
int m_lastI2CAvail;
uint16_t m_lastI2CAvailCount;
void sendACK(); void sendACK();
void sendNAK(uint8_t err); void sendNAK(uint8_t err);