kopia lustrzana https://github.com/sh123/esp32_loraprs
Add support for up to 7 paths as per ax25 specification
rodzic
056d77caf8
commit
edd697ce00
|
@ -11,11 +11,10 @@ String Payload::ToText(const String &customComment)
|
|||
{
|
||||
String txt = srcCall_ + String(">") + dstCall_;
|
||||
|
||||
if (rptFirst_.length() > 0) {
|
||||
txt += String(",") + rptFirst_;
|
||||
for (int i = 0; i < rptCallsCount_; i++) {
|
||||
if (rptCalls_[i].length() > 0) {
|
||||
txt += String(",") + rptCalls_[i];
|
||||
}
|
||||
if (rptSecond_.length() > 0) {
|
||||
txt += String(",") + rptSecond_;
|
||||
}
|
||||
|
||||
txt += String(":") + body_;
|
||||
|
@ -30,31 +29,40 @@ String Payload::ToText(const String &customComment)
|
|||
bool Payload::parsePayload(byte *rxPayload, int payloadLength)
|
||||
{
|
||||
byte *rxPtr = rxPayload;
|
||||
byte *rxEnd = rxPayload + payloadLength;
|
||||
|
||||
// destination address
|
||||
dstCall_ = decodeCall(rxPtr);
|
||||
rxPtr += CallsignSize;
|
||||
if (rxPtr >= rxPayload + payloadLength) return false;
|
||||
|
||||
// source address
|
||||
srcCall_ = decodeCall(rxPtr);
|
||||
rxPtr += CallsignSize;
|
||||
if (rxPtr >= rxPayload + payloadLength) return false;
|
||||
if (rxPtr >= rxEnd) return false;
|
||||
|
||||
if ((rxPayload[2 * CallsignSize - 1] & 1) == 0) {
|
||||
rptFirst_ = decodeCall(rxPtr);
|
||||
rxPtr += CallsignSize;
|
||||
if (rxPtr >= rxPayload + payloadLength) return false;
|
||||
rptCallsCount_ = 0;
|
||||
|
||||
if ((rxPayload[3 * CallsignSize - 1] & 1) == 0) {
|
||||
rptSecond_ = decodeCall(rxPtr);
|
||||
// digipeater addresses
|
||||
for (int i = 0; i < RptMaxCount; i++) {
|
||||
if ((rxPayload[(i + 2) * CallsignSize - 1] & 1) == 0) {
|
||||
rptCalls_[i] = decodeCall(rxPtr);
|
||||
rptCallsCount_++;
|
||||
rxPtr += CallsignSize;
|
||||
if (rxPtr >= rxEnd) return false;
|
||||
}
|
||||
else {
|
||||
break;
|
||||
}
|
||||
}
|
||||
if ((rxPtr + 1) >= rxPayload + payloadLength) return false;
|
||||
|
||||
// control + protocol id
|
||||
if ((rxPtr + 2) >= rxEnd) return false;
|
||||
if (*(rxPtr++) != AX25Ctrl::UI) return false;
|
||||
if (*(rxPtr++) != AX25Pid::NoLayer3) return false;
|
||||
|
||||
while (rxPtr < rxPayload + payloadLength) {
|
||||
// information field
|
||||
while (rxPtr < rxEnd) {
|
||||
body_ += String((char)*(rxPtr++));
|
||||
}
|
||||
|
||||
|
|
|
@ -24,12 +24,13 @@ private:
|
|||
NoLayer3 = 0xf0
|
||||
};
|
||||
|
||||
const int MaxPayloadSize = 16;
|
||||
const int CallsignSize = 7;
|
||||
const int RptMaxCount = 7;
|
||||
|
||||
private:
|
||||
String srcCall_, dstCall_;
|
||||
String rptFirst_, rptSecond_;
|
||||
String rptCalls_[7];
|
||||
int rptCallsCount_;
|
||||
String body_;
|
||||
};
|
||||
|
||||
|
|
Ładowanie…
Reference in New Issue