diff options
| -rw-r--r-- | libraries/Bridge/Bridge.cpp | 9 |
1 files changed, 6 insertions, 3 deletions
diff --git a/libraries/Bridge/Bridge.cpp b/libraries/Bridge/Bridge.cpp index 363dcd1..bc52b7b 100644 --- a/libraries/Bridge/Bridge.cpp +++ b/libraries/Bridge/Bridge.cpp @@ -17,6 +17,7 @@ */ #include "Bridge.h" +#include <util/crc16.h> BridgeClass::BridgeClass(Stream &_stream) : index(0), stream(_stream), started(false), max_retries(0) { @@ -94,12 +95,14 @@ unsigned int BridgeClass::get(const char *key, uint8_t *value, unsigned int maxl } void BridgeClass::crcUpdate(uint8_t c) { - CRC = CRC ^ c; - CRC = (CRC >> 8) + (CRC << 8); + + CRC = _crc_ccitt_update(CRC, c); + //CRC = CRC ^ c; + //CRC = (CRC >> 8) + (CRC << 8); } void BridgeClass::crcReset() { - CRC = 0xAAAA; + CRC = 0xFFFF; } void BridgeClass::crcWrite() { |