CRC bytestuffing (needs to be tested) ...

This commit is contained in:
Bertrand Songis
2019-01-25 21:57:51 +01:00
parent 88427246d2
commit d0f87bc3e2
2 changed files with 10 additions and 10 deletions
+9 -9
View File
@@ -150,7 +150,7 @@ class StandardPxxTransport: public BitTransport, public PxxCrcMixin {
addByteWithoutCrc(byte); addByteWithoutCrc(byte);
}; };
void addRawByteWithoutCrc(uint8_t byte) void addRawByte(uint8_t byte)
{ {
for (uint8_t i = 0; i < 8; i++) { for (uint8_t i = 0; i < 8; i++) {
if (byte & 0x80) if (byte & 0x80)
@@ -198,28 +198,28 @@ class UartPxxTransport: public DataBuffer<uint8_t, 64>, public PxxCrcMixin {
addWithByteStuffing(byte); addWithByteStuffing(byte);
} }
void addRawByteWithoutCrc(uint8_t byte) void addRawByte(uint8_t byte)
{ {
addByteWithoutCrc(byte); *ptr++ = byte;
} }
void addByteWithoutCrc(uint8_t byte) void addByteWithoutCrc(uint8_t byte)
{ {
*ptr++ = byte; addWithByteStuffing(byte);
} }
void addWithByteStuffing(uint8_t byte) void addWithByteStuffing(uint8_t byte)
{ {
if (0x7E == byte) { if (0x7E == byte) {
*ptr++ = 0x7D; addRawByte(0x7D);
*ptr++ = 0x5E; addRawByte(0x5E);
} }
else if (0x7D == byte) { else if (0x7D == byte) {
*ptr++ = 0x7D; addRawByte(0x7D);
*ptr++ = 0x5D; addRawByte(0x5D);
} }
else { else {
*ptr++ = byte; addRawByte(byte);
} }
} }
+1 -1
View File
@@ -33,7 +33,7 @@ class Pxx1Pulses: public PxxPulses<PxxTransport>
void addHead() void addHead()
{ {
// send 7E, do not CRC // send 7E, do not CRC
PxxTransport::addRawByteWithoutCrc(0x7E); PxxTransport::addRawByte(0x7E);
} }
void addCrc() void addCrc()