X-Git-Url: http://cvs.zerfleddert.de/cgi-bin/gitweb.cgi/proxmark3-svn/blobdiff_plain/83288efc7d1b673d30edee6ce732d1de8c505da3..eba61a5647762ee184535172db1db11137688ed8:/armsrc/hitag2.c

diff --git a/armsrc/hitag2.c b/armsrc/hitag2.c
index 886e1970..15daa25e 100644
--- a/armsrc/hitag2.c
+++ b/armsrc/hitag2.c
@@ -1,17 +1,21 @@
-/*
- * Hitag2 emulation
- * 
- * Contains state and functions for an emulated Hitag2 tag. Offers an entry
- * point to handle commands, needs a callback to send response.
- * 
- * (c) 2009 Henryk Plötz <henryk@ploetzli.ch>
- */
-
-#include <proxmark3.h>
-#include <stdint.h>
+//-----------------------------------------------------------------------------
+// (c) 2009 Henryk Plötz <henryk@ploetzli.ch>
+//
+// This code is licensed to you under the terms of the GNU GPL, version 2 or,
+// at your option, any later version. See the LICENSE.txt file for the text of
+// the license.
+//-----------------------------------------------------------------------------
+// Hitag2 emulation
+//
+// Contains state and functions for an emulated Hitag2 tag. Offers an entry
+// point to handle commands, needs a callback to send response.
+//-----------------------------------------------------------------------------
 
+#include "proxmark3.h"
 #include "apps.h"
+#include "util.h"
 #include "hitag2.h"
+#include "string.h"
 
 struct hitag2_cipher_state {
 	uint64_t state;
@@ -19,7 +23,7 @@ struct hitag2_cipher_state {
 
 struct hitag2_tag {
 	uint32_t uid;
-	enum { 
+	enum {
 		TAG_STATE_RESET,          // Just powered up, awaiting GetSnr
 		TAG_STATE_ACTIVATING,     // In activation phase (password mode), sent UID, awaiting reader password
 		TAG_STATE_AUTHENTICATING, // In activation phase (crypto mode), awaiting reader authentication
@@ -74,7 +78,7 @@ int hitag2_handle_command(const char* data, const int length, hitag2_response_ca
 		data = temp;
 	}
 
-	
+
 handle_command_retry:
 	switch(tag.state) {
 	case TAG_STATE_RESET:
@@ -148,8 +152,8 @@ handle_command_retry:
 					/* transmission error */
 					DbpString("Transmission error (write) in activated state");
 				}
-			} 
-				
+			}
+
 		}
 	case TAG_STATE_WRITING:
 		if(length == 32) {
@@ -159,7 +163,7 @@ handle_command_retry:
 			done=1;
 		}
 	}
-	
+
 	if(!done && !retry) {
 		/* We didn't respond, maybe our state is faulty. Reset and try again. */
 		retry=1;
@@ -205,13 +209,13 @@ static const u32 ht2_f5c = 0x7907287B;	// 0111 1001 0000 0111 0010 1000 0111 101
 static u32 _f20 (const u64 x)
 {
 	u32					i5;
-	
+
 	i5 = ((ht2_f4a >> i4 (x, 1, 2, 4, 5)) & 1)* 1
 	   + ((ht2_f4b >> i4 (x, 7,11,13,14)) & 1)* 2
 	   + ((ht2_f4b >> i4 (x,16,20,22,25)) & 1)* 4
 	   + ((ht2_f4b >> i4 (x,27,28,30,32)) & 1)* 8
 	   + ((ht2_f4a >> i4 (x,33,42,43,45)) & 1)*16;
-	
+
 	return (ht2_f5c >> i5) & 1;
 }
 
@@ -219,7 +223,7 @@ static u64 _hitag2_init (const u64 key, const u32 serial, const u32 IV)
 {
 	u32					i;
 	u64					x = ((key & 0xFFFF) << 32) + serial;
-	
+
 	for (i = 0; i < 32; i++)
 	{
 		x >>= 1;
@@ -231,13 +235,13 @@ static u64 _hitag2_init (const u64 key, const u32 serial, const u32 IV)
 static u64 _hitag2_round (u64 *state)
 {
 	u64					x = *state;
-	
+
 	x = (x >>  1) +
 	 ((((x >>  0) ^ (x >>  2) ^ (x >>  3) ^ (x >>  6)
 	  ^ (x >>  7) ^ (x >>  8) ^ (x >> 16) ^ (x >> 22)
 	  ^ (x >> 23) ^ (x >> 26) ^ (x >> 30) ^ (x >> 41)
 	  ^ (x >> 42) ^ (x >> 43) ^ (x >> 46) ^ (x >> 47)) & 1) << 47);
-	
+
 	*state = x;
 	return _f20 (x);
 }
@@ -245,7 +249,7 @@ static u64 _hitag2_round (u64 *state)
 static u32 _hitag2_byte (u64 * x)
 {
 	u32					i, c;
-	
+
 	for (i = 0, c = 0; i < 8; i++) c += (u32) _hitag2_round (x) << (i^7);
 	return c;
 }