Diff: Utilities/crc.cpp

Revision:

0:f77ad7f72d04

Child:

5:a8c83a2e6fa4

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Utilities/crc.cpp	Mon Nov 06 14:39:18 2017 -0600
@@ -0,0 +1,86 @@
+/*******************************************************************************
+* Copyright (C) 2017 Maxim Integrated Products, Inc., All Rights Reserved.
+*
+* Permission is hereby granted, free of charge, to any person obtaining a
+* copy of this software and associated documentation files (the "Software"),
+* to deal in the Software without restriction, including without limitation
+* the rights to use, copy, modify, merge, publish, distribute, sublicense,
+* and/or sell copies of the Software, and to permit persons to whom the
+* Software is furnished to do so, subject to the following conditions:
+*
+* The above copyright notice and this permission notice shall be included
+* in all copies or substantial portions of the Software.
+*
+* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
+* OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
+* IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
+* OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
+* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
+* OTHER DEALINGS IN THE SOFTWARE.
+*
+* Except as contained in this notice, the name of Maxim Integrated
+* Products, Inc. shall not be used except as stated in the Maxim Integrated
+* Products, Inc. Branding Policy.
+*
+* The mere transfer of this software does not imply any licenses
+* of trade secrets, proprietary technology, copyrights, patents,
+* trademarks, maskwork rights, or any other form of intellectual
+* property whatsoever. Maxim Integrated Products, Inc. retains all
+* ownership rights.
+*******************************************************************************/
+
+#include "crc.hpp"
+
+namespace MaximInterface {
+
+uint_fast8_t calculateCrc8(uint_fast8_t data, uint_fast8_t crc) {
+  // See Application Note 27
+  crc ^= data;
+  crc &= 0xff;
+  for (int i = 0; i < 8; i++) {
+    if (crc & 1) {
+      crc = (crc >> 1) ^ 0x8c;
+    } else {
+      crc = (crc >> 1);
+    }
+  }
+  return crc;
+}
+
+uint_fast8_t calculateCrc8(const uint_least8_t * data, size_t dataLen,
+                           uint_fast8_t crc) {
+  for (size_t i = 0; i < dataLen; i++) {
+    crc = calculateCrc8(data[i], crc);
+  }
+  return crc;
+}
+
+uint_fast16_t calculateCrc16(uint_fast8_t data, uint_fast16_t crc) {
+  const uint_least8_t oddparity[] = {0, 1, 1, 0, 1, 0, 0, 1,
+                                     1, 0, 0, 1, 0, 1, 1, 0};
+
+  uint_fast16_t data16 = (data ^ crc) & 0xff;
+  crc = (crc >> 8) & 0xff;
+
+  if (oddparity[data16 & 0xf] ^ oddparity[data16 >> 4]) {
+    crc ^= 0xc001;
+  }
+
+  data16 <<= 6;
+  crc ^= data16;
+  data16 <<= 1;
+  crc ^= data16;
+
+  return crc;
+}
+
+uint_fast16_t calculateCrc16(const uint_least8_t * data, size_t dataLen,
+                             uint_fast16_t crc) {
+  for (size_t i = 0; i < dataLen; i++) {
+    crc = calculateCrc16(data[i], crc);
+  }
+  return crc;
+}
+
+} // namespace MaximInterface