CRC bytestuffing (needs to be tested) ...
This commit is contained in:
@@ -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);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -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()
|
||||||
|
|||||||
Reference in New Issue
Block a user