CRC fix

2019-02-05 18:29:58 +01:00
parent 60384782a5
commit 480eb90001
1 changed files with 5 additions and 2 deletions
@@ -54,12 +54,15 @@ class PxxCrcMixin {
  protected:
    void initCrc()
    {
-      crc = 0;
+      // TODO add a Pxx2CrcMixin  ...
+      crc = 0xFFFF;
    }

    void addToCrc(uint8_t byte)
    {
-      crc = (crc << 8) ^ (CRCTable[((crc >> 8) ^ byte) & 0xFF]);
+      // TODO add a Pxx2CrcMixin  ...
+      // crc = (crc << 8) ^ (CRCTable[((crc >> 8) ^ byte) & 0xFF]);
+      crc -= byte;
    }

    uint16_t crc;