'lf hitag writer': add Hitag2 password auth

[proxmark3-svn] / common / iso15693tools.c

diff --git a/common/iso15693tools.c b/common/iso15693tools.c
index add0ba69f8367b4d7ede2b5863014d156d3d5251..f121445862ceccf8c5d048cd41b2960840521d2f 100644 (file)
--- a/common/iso15693tools.c
+++ b/common/iso15693tools.c
@@ -11,6 +11,15 @@
 #include <stdint.h>
 #include <stdlib.h>
 //#include "iso15693tools.h"
+#ifdef ON_DEVICE
+#include "printf.h"
+#else
+#include <stdio.h>
+#endif
+
+
+#define POLY 0x8408
+
 
 // The CRC as described in ISO 15693-Part 3-Annex C
 //     v       buffer with data
@@ -48,8 +57,6 @@ int Iso15693AddCrc(uint8_t *req, int n) {
 }
 
 
-int sprintf(char *str, const char *format, ...);
-
 // returns a string representation of the UID
 // UID is transmitted and stored LSB first, displayed MSB first
 //             target    char* buffer, where to put the UID, if NULL a static buffer is returned
@@ -63,5 +70,31 @@ char* Iso15693sprintUID(char *target,uint8_t *uid) {
   return target;
 }
 
+uint16_t iclass_crc16(char *data_p, unsigned short length)
+{
+      unsigned char i;
+      unsigned int data;
+         uint16_t crc = 0xffff;
+
+      if (length == 0)
+            return (~crc);
 
+      do
+      {
+            for (i=0, data=(unsigned int)0xff & *data_p++;
+                 i < 8; 
+                 i++, data >>= 1)
+            {
+                  if ((crc & 0x0001) ^ (data & 0x0001))
+                        crc = (crc >> 1) ^ POLY;
+                  else  crc >>= 1;
+            }
+      } while (--length);
+
+      crc = ~crc;
+      data = crc;
+      crc = (crc << 8) | (data >> 8 & 0xff);
+      crc = crc ^ 0xBC3;
+      return (crc);
+}