tip measurement

source/Core/Drivers/crc16.cpp

@@ -0,0 +1,19 @@
+
+#include "crc16.hpp"
+#define POLYNOM 0x8005
+unsigned int crc16(unsigned int crcValue, unsigned char newByte) {
+  unsigned char i;
+
+  for (i = 0; i < 8; i++) {
+
+    if (((crcValue & 0x8000) >> 8) ^ (newByte & 0x80)) {
+      crcValue = (crcValue << 1) ^ POLYNOM;
+    } else {
+      crcValue = (crcValue << 1);
+    }
+
+    newByte <<= 1;
+  }
+
+  return crcValue;
+}