pohui_pohui/firmware
1
0
Fork 0
mirror of https://github.com/meshtastic/firmware.git synced 2025-09-01 01:15:10 +00:00
Code Issues Actions 4 Packages Projects Releases Wiki Activity

Reinstitute previous streamapi readStream

Browse Source
This commit is contained in:
Ben Meadors 2025-08-27 07:17:46 -05:00
parent 3120bb8fd7
commit 06bccef462
1 changed files with 43 additions and 37 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

80
src/mesh/StreamAPI.cpp
View File

@ -73,7 +73,7 @@ int32_t StreamAPI::handleRecStream(char *buf, uint16_t bufLen)
} }
/** /**
* Read any rx chars from the link and call handleRecStream * Read any rx chars from the link and call handleToRadio
*/ */
int32_t StreamAPI::readStream() int32_t StreamAPI::readStream()
{ {
@ -82,50 +82,56 @@ int32_t StreamAPI::readStream()
bool recentRx = Throttle::isWithinTimespanMs(lastRxMsec, 2000); bool recentRx = Throttle::isWithinTimespanMs(lastRxMsec, 2000);
return recentRx ? 5 : 250; return recentRx ? 5 : 250;
} else { } else {
char buf[1];
while (stream->available()) { // Currently we never want to block while (stream->available()) { // Currently we never want to block
buf[0] = stream->read(); int cInt = stream->read();
handleRecStream(buf, 1); if (cInt < 0)
break; // We ran out of characters (even though available said otherwise) - this can happen on rf52 adafruit
// arduino
uint8_t c = (uint8_t)cInt;
// Use the read pointer for a little state machine, first look for framing, then length bytes, then payload
size_t ptr = rxPtr;
rxPtr++; // assume we will probably advance the rxPtr
rxBuf[ptr] = c; // store all bytes (including framing)
// console->printf("rxPtr %d ptr=%d c=0x%x\n", rxPtr, ptr, c);
if (ptr == 0) { // looking for START1
if (c != START1)
rxPtr = 0; // failed to find framing
} else if (ptr == 1) { // looking for START2
if (c != START2)
rxPtr = 0; // failed to find framing
} else if (ptr >= HEADER_LEN - 1) { // we have at least read our 4 byte framing
uint32_t len = (rxBuf[2] << 8) + rxBuf[3]; // big endian 16 bit length follows framing
// console->printf("len %d\n", len);
if (ptr == HEADER_LEN - 1) {
// we _just_ finished our 4 byte header, validate length now (note: a length of zero is a valid
// protobuf also)
if (len > MAX_TO_FROM_RADIO_SIZE)
rxPtr = 0; // length is bogus, restart search for framing
}
if (rxPtr != 0) // Is packet still considered 'good'?
if (ptr + 1 >= len + HEADER_LEN) { // have we received all of the payload?
rxPtr = 0; // start over again on the next packet
// If we didn't just fail the packet and we now have the right # of bytes, parse it
handleToRadio(rxBuf + HEADER_LEN, len);
}
}
} }
// we had bytes available this time, so assume we might have them next time also // we had bytes available this time, so assume we might have them next time also
lastRxMsec = millis(); lastRxMsec = millis();
return 0; return 0;
} }
} }
/**
* Read any rx chars from the link and call handleRecStream
*/
int32_t StreamAPI::readStream(char *buf, uint16_t bufLen)
{
uint16_t index = 0;
if (bufLen < 1) {
// Nothing available this time, if the computer has talked to us recently, poll often, otherwise let CPU sleep a long time
bool recentRx = Throttle::isWithinTimespanMs(lastRxMsec, 2000);
return recentRx ? 5 : 250;
} else {
handleRecStream(buf, bufLen);
// we had bytes available this time, so assume we might have them next time also
lastRxMsec = millis();
return 0;
}
}
/**
* call getFromRadio() and deliver encapsulated packets to the Stream
*/
void StreamAPI::writeStream()
{
if (canWrite) {
uint32_t len;
do {
// Send every packet we can
len = getFromRadio(txBuf + HEADER_LEN);
emitTxBuffer(len);
} while (len);
}
}
/** /**
* Send the current txBuffer over our stream * Send the current txBuffer over our stream
*/ */