X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/proxmark3-svn/blobdiff_plain/e57fe796f529d3edd7d48f1fa51676e809531280..323e05cc20b9c6f3235e6b94046f9aa587643c87:/client/cmdlfti.c

diff --git a/client/cmdlfti.c b/client/cmdlfti.c
index 12956abd..2e5cfbba 100644
--- a/client/cmdlfti.c
+++ b/client/cmdlfti.c
@@ -17,6 +17,7 @@
 #include "graph.h"
 #include "cmdparser.h"
 #include "cmdlfti.h"
+#include "cmdmain.h"
 
 static int CmdHelp(const char *Cmd);
 
@@ -76,215 +77,222 @@ int CmdTIDemod(const char *Cmd)
     1, 1, 1, 1, 1, 1, 1,      -1, -1, -1, -1, -1, -1, -1,
     1, 1, 1, 1, 1, 1, 1, 1
   };
-  int lowLen = sizeof(LowTone)/sizeof(int);
-  int highLen = sizeof(HighTone)/sizeof(int);
-  int convLen = (highLen>lowLen)?highLen:lowLen;
-  uint16_t crc;
-  int i, j, TagType;
-  int lowSum = 0, highSum = 0;;
-  int lowTot = 0, highTot = 0;
-
-  for (i = 0; i < GraphTraceLen - convLen; i++) {
-    lowSum = 0;
-    highSum = 0;;
-
-    for (j = 0; j < lowLen; j++) {
-      lowSum += LowTone[j]*GraphBuffer[i+j];
-    }
-    for (j = 0; j < highLen; j++) {
-      highSum += HighTone[j]*GraphBuffer[i+j];
-    }
-    lowSum = abs((100*lowSum) / lowLen);
-    highSum = abs((100*highSum) / highLen);
-    lowSum = (lowSum<0)?-lowSum:lowSum;
-    highSum = (highSum<0)?-highSum:highSum;
-
-    GraphBuffer[i] = (highSum << 16) | lowSum;
-  }
-
-  for (i = 0; i < GraphTraceLen - convLen - 16; i++) {
-    lowTot = 0;
-    highTot = 0;
-    // 16 and 15 are f_s divided by f_l and f_h, rounded
-    for (j = 0; j < 16; j++) {
-      lowTot += (GraphBuffer[i+j] & 0xffff);
-    }
-    for (j = 0; j < 15; j++) {
-      highTot += (GraphBuffer[i+j] >> 16);
-    }
-    GraphBuffer[i] = lowTot - highTot;
-  }
-
-  GraphTraceLen -= (convLen + 16);
-
-  RepaintGraphWindow();
-
-  // TI tag data format is 16 prebits, 8 start bits, 64 data bits,
-  // 16 crc CCITT bits, 8 stop bits, 15 end bits
-
-  // the 16 prebits are always low
-  // the 8 start and stop bits of a tag must match
-  // the start/stop prebits of a ro tag are 01111110
-  // the start/stop prebits of a rw tag are 11111110
-  // the 15 end bits of a ro tag are all low
-  // the 15 end bits of a rw tag match bits 15-1 of the data bits
-
-  // Okay, so now we have unsliced soft decisions;
-  // find bit-sync, and then get some bits.
-  // look for 17 low bits followed by 6 highs (common pattern for ro and rw tags)
-  int max = 0, maxPos = 0;
-  for (i = 0; i < 6000; i++) {
-    int j;
-    int dec = 0;
-    // searching 17 consecutive lows
-    for (j = 0; j < 17*lowLen; j++) {
-      dec -= GraphBuffer[i+j];
-    }
-    // searching 7 consecutive highs
-    for (; j < 17*lowLen + 6*highLen; j++) {
-      dec += GraphBuffer[i+j];
-    }
-    if (dec > max) {
-      max = dec;
-      maxPos = i;
-    }
-  }
-
-  // place a marker in the buffer to visually aid location
-  // of the start of sync
-  GraphBuffer[maxPos] = 800;
-  GraphBuffer[maxPos+1] = -800;
-
-  // advance pointer to start of actual data stream (after 16 pre and 8 start bits)
-  maxPos += 17*lowLen;
-  maxPos += 6*highLen;
-
-  // place a marker in the buffer to visually aid location
-  // of the end of sync
-  GraphBuffer[maxPos] = 800;
-  GraphBuffer[maxPos+1] = -800;
-
-  PrintAndLog("actual data bits start at sample %d", maxPos);
-
-  PrintAndLog("length %d/%d", highLen, lowLen);
-
-  uint8_t bits[1+64+16+8+16];
-  bits[sizeof(bits)-1] = '\0';
-
-  uint32_t shift3 = 0x7e000000, shift2 = 0, shift1 = 0, shift0 = 0;
-
-  for (i = 0; i < arraylen(bits)-1; i++) {
-    int high = 0;
-    int low = 0;
-    int j;
-    for (j = 0; j < lowLen; j++) {
-      low -= GraphBuffer[maxPos+j];
-    }
-    for (j = 0; j < highLen; j++) {
-      high += GraphBuffer[maxPos+j];
-    }
-
-    if (high > low) {
-      bits[i] = '1';
-      maxPos += highLen;
-      // bitstream arrives lsb first so shift right
-      shift3 |= (1<<31);
-    } else {
-      bits[i] = '.';
-      maxPos += lowLen;
-    }
-
-    // 128 bit right shift register
-    shift0 = (shift0>>1) | (shift1 << 31);
-    shift1 = (shift1>>1) | (shift2 << 31);
-    shift2 = (shift2>>1) | (shift3 << 31);
-    shift3 >>= 1;
-
-    // place a marker in the buffer between bits to visually aid location
-    GraphBuffer[maxPos] = 800;
-    GraphBuffer[maxPos+1] = -800;
-  }
-  PrintAndLog("Info: raw tag bits = %s", bits);
-
-  TagType = (shift3>>8)&0xff;
-  if ( TagType != ((shift0>>16)&0xff) ) {
-    PrintAndLog("Error: start and stop bits do not match!");
-    return 0;
-  }
-  else if (TagType == 0x7e) {
-    PrintAndLog("Info: Readonly TI tag detected.");
-    return 0;
-  }
-  else if (TagType == 0xfe) {
-    PrintAndLog("Info: Rewriteable TI tag detected.");
-
-    // put 64 bit data into shift1 and shift0
-    shift0 = (shift0>>24) | (shift1 << 8);
-    shift1 = (shift1>>24) | (shift2 << 8);
-
-    // align 16 bit crc into lower half of shift2
-    shift2 = ((shift2>>24) | (shift3 << 8)) & 0x0ffff;
-
-    // align 16 bit "end bits" or "ident" into lower half of shift3
-    shift3 >>= 16;
-
-    // only 15 bits compare, last bit of ident is not valid
-    if ( (shift3^shift0)&0x7fff ) {
-      PrintAndLog("Error: Ident mismatch!");
-    }
-    // WARNING the order of the bytes in which we calc crc below needs checking
-    // i'm 99% sure the crc algorithm is correct, but it may need to eat the
-    // bytes in reverse or something
-    // calculate CRC
-    crc=0;
-    crc = update_crc16(crc, (shift0)&0xff);
-    crc = update_crc16(crc, (shift0>>8)&0xff);
-    crc = update_crc16(crc, (shift0>>16)&0xff);
-    crc = update_crc16(crc, (shift0>>24)&0xff);
-    crc = update_crc16(crc, (shift1)&0xff);
-    crc = update_crc16(crc, (shift1>>8)&0xff);
-    crc = update_crc16(crc, (shift1>>16)&0xff);
-    crc = update_crc16(crc, (shift1>>24)&0xff);
-    PrintAndLog("Info: Tag data = %08X%08X", shift1, shift0);
-    if (crc != (shift2&0xffff)) {
-      PrintAndLog("Error: CRC mismatch, calculated %04X, got ^04X", crc, shift2&0xffff);
-    } else {
-      PrintAndLog("Info: CRC %04X is good", crc);
-    }
-  }
-  else {
-    PrintAndLog("Unknown tag type.");
-    return 0;
-  }
-  return 0;
+	int lowLen = sizeof(LowTone)/sizeof(int);
+	int highLen = sizeof(HighTone)/sizeof(int);
+	int convLen = (highLen>lowLen)?highLen:lowLen;
+	uint16_t crc;
+	int i, j, TagType;
+	int lowSum = 0, highSum = 0;;
+	int lowTot = 0, highTot = 0;
+
+	for (i = 0; i < GraphTraceLen - convLen; i++) {
+		lowSum = 0;
+		highSum = 0;;
+
+		for (j = 0; j < lowLen; j++) {
+			lowSum += LowTone[j]*GraphBuffer[i+j];
+		}
+		for (j = 0; j < highLen; j++) {
+			highSum += HighTone[j]*GraphBuffer[i+j];
+		}
+		lowSum = abs((100*lowSum) / lowLen);
+		highSum = abs((100*highSum) / highLen);
+		lowSum = (lowSum<0)?-lowSum:lowSum;
+		highSum = (highSum<0)?-highSum:highSum;
+
+		GraphBuffer[i] = (highSum << 16) | lowSum;
+	}
+
+	for (i = 0; i < GraphTraceLen - convLen - 16; i++) {
+		lowTot = 0;
+		highTot = 0;
+		// 16 and 15 are f_s divided by f_l and f_h, rounded
+		for (j = 0; j < 16; j++) {
+			lowTot += (GraphBuffer[i+j] & 0xffff);
+		}
+		for (j = 0; j < 15; j++) {
+			highTot += (GraphBuffer[i+j] >> 16);
+		}
+		GraphBuffer[i] = lowTot - highTot;
+	}
+
+	GraphTraceLen -= (convLen + 16);
+
+	RepaintGraphWindow();
+
+	// TI tag data format is 16 prebits, 8 start bits, 64 data bits,
+	// 16 crc CCITT bits, 8 stop bits, 15 end bits
+
+	// the 16 prebits are always low
+	// the 8 start and stop bits of a tag must match
+	// the start/stop prebits of a ro tag are 01111110
+	// the start/stop prebits of a rw tag are 11111110
+	// the 15 end bits of a ro tag are all low
+	// the 15 end bits of a rw tag match bits 15-1 of the data bits
+
+	// Okay, so now we have unsliced soft decisions;
+	// find bit-sync, and then get some bits.
+	// look for 17 low bits followed by 6 highs (common pattern for ro and rw tags)
+	int max = 0, maxPos = 0;
+	for (i = 0; i < 6000; i++) {
+		int j;
+		int dec = 0;
+		// searching 17 consecutive lows
+		for (j = 0; j < 17*lowLen; j++) {
+			dec -= GraphBuffer[i+j];
+		}
+		// searching 7 consecutive highs
+		for (; j < 17*lowLen + 6*highLen; j++) {
+			dec += GraphBuffer[i+j];
+		}
+		if (dec > max) {
+			max = dec;
+			maxPos = i;
+		}
+	}
+
+	// place a marker in the buffer to visually aid location
+	// of the start of sync
+	GraphBuffer[maxPos] = 800;
+	GraphBuffer[maxPos+1] = -800;
+
+	// advance pointer to start of actual data stream (after 16 pre and 8 start bits)
+	maxPos += 17*lowLen;
+	maxPos += 6*highLen;
+
+	// place a marker in the buffer to visually aid location
+	// of the end of sync
+	GraphBuffer[maxPos] = 800;
+	GraphBuffer[maxPos+1] = -800;
+
+	PrintAndLog("actual data bits start at sample %d", maxPos);
+
+	PrintAndLog("length %d/%d", highLen, lowLen);
+
+	uint8_t bits[1+64+16+8+16];
+	bits[sizeof(bits)-1] = '\0';
+
+	uint32_t shift3 = 0x7e000000, shift2 = 0, shift1 = 0, shift0 = 0;
+
+	for (i = 0; i < ARRAYLEN(bits)-1; i++) {
+		int high = 0;
+		int low = 0;
+		int j;
+		for (j = 0; j < lowLen; j++) {
+			low -= GraphBuffer[maxPos+j];
+		}
+		for (j = 0; j < highLen; j++) {
+			high += GraphBuffer[maxPos+j];
+		}
+
+		if (high > low) {
+			bits[i] = '1';
+			maxPos += highLen;
+			// bitstream arrives lsb first so shift right
+			shift3 |= (1<<31);
+		} else {
+			bits[i] = '.';
+			maxPos += lowLen;
+		}
+
+		// 128 bit right shift register
+		shift0 = (shift0>>1) | (shift1 << 31);
+		shift1 = (shift1>>1) | (shift2 << 31);
+		shift2 = (shift2>>1) | (shift3 << 31);
+		shift3 >>= 1;
+
+		// place a marker in the buffer between bits to visually aid location
+		GraphBuffer[maxPos] = 800;
+		GraphBuffer[maxPos+1] = -800;
+	}
+
+	RepaintGraphWindow();
+	
+	PrintAndLog("Info: raw tag bits = %s", bits);
+
+	TagType = (shift3>>8)&0xff;
+	if ( TagType != ((shift0>>16)&0xff) ) {
+		PrintAndLog("Error: start and stop bits do not match!");
+		return 0;
+	}
+	else if (TagType == 0x7e) {
+		PrintAndLog("Info: Readonly TI tag detected.");
+		return 0;
+	}
+	else if (TagType == 0xfe) {
+		PrintAndLog("Info: Rewriteable TI tag detected.");
+
+		// put 64 bit data into shift1 and shift0
+		shift0 = (shift0>>24) | (shift1 << 8);
+		shift1 = (shift1>>24) | (shift2 << 8);
+
+		// align 16 bit crc into lower half of shift2
+		shift2 = ((shift2>>24) | (shift3 << 8)) & 0x0ffff;
+
+		// align 16 bit "end bits" or "ident" into lower half of shift3
+		shift3 >>= 16;
+
+		// only 15 bits compare, last bit of ident is not valid
+		if ( (shift3^shift0)&0x7fff ) {
+		  PrintAndLog("Error: Ident mismatch!");
+		}
+		// WARNING the order of the bytes in which we calc crc below needs checking
+		// i'm 99% sure the crc algorithm is correct, but it may need to eat the
+		// bytes in reverse or something
+		// calculate CRC
+		crc=0;
+		crc = update_crc16(crc, (shift0)&0xff);
+		crc = update_crc16(crc, (shift0>>8)&0xff);
+		crc = update_crc16(crc, (shift0>>16)&0xff);
+		crc = update_crc16(crc, (shift0>>24)&0xff);
+		crc = update_crc16(crc, (shift1)&0xff);
+		crc = update_crc16(crc, (shift1>>8)&0xff);
+		crc = update_crc16(crc, (shift1>>16)&0xff);
+		crc = update_crc16(crc, (shift1>>24)&0xff);
+		
+		//crc =  crc16_ccitt(message, sizeof(message);
+
+		char *crcStr = (crc == (shift2&0xffff) ) ? "Passed" : "Failed";
+	
+		PrintAndLog("Tag data = %08X%08X  [Crc %04X %s]", shift1, shift0, crc, crcStr );
+
+		if (crc != (shift2&0xffff))
+			PrintAndLog("Error: CRC mismatch, calculated %04X, got %04X", crc, shift2&0xffff);
+   
+	}
+	else {
+		PrintAndLog("Unknown tag type.");
+	}
+	return 0;
 }
 
 // read a TI tag and return its ID
 int CmdTIRead(const char *Cmd)
 {
-  UsbCommand c = {CMD_READ_TI_TYPE};
-  SendCommand(&c);
-  return 0;
+	UsbCommand c = {CMD_READ_TI_TYPE};
+	clearCommandBuffer();
+	SendCommand(&c);
+	return 0;
 }
 
 // write new data to a r/w TI tag
 int CmdTIWrite(const char *Cmd)
 {
-  UsbCommand c = {CMD_WRITE_TI_TYPE};
-  int res = 0;
-
-  res = sscanf(Cmd, "%012"llx" %012"llx" %012"llx"", &c.arg[0], &c.arg[1], &c.arg[2]);
-  
-  if (res == 2) c.arg[2]=0;
-  if (res < 2)
-    PrintAndLog("Please specify the data as two hex strings, optionally the CRC as a third");
-  else
-    SendCommand(&c);
-  return 0;
+	int res = 0;
+	UsbCommand c = {CMD_WRITE_TI_TYPE};
+	res = sscanf(Cmd, "%012"llx" %012"llx" %012"llx"", &c.arg[0], &c.arg[1], &c.arg[2]);
+
+	if (res == 2) c.arg[2]=0;
+	if (res < 2) {
+		PrintAndLog("Please specify the data as two hex strings, optionally the CRC as a third");
+		return 1;
+	}
+	clearCommandBuffer();
+	SendCommand(&c);
+	return 0;
 }
 
-static command_t CommandTable[] = 
-{
+static command_t CommandTable[] = {
   {"help",      CmdHelp,        1, "This help"},
   {"demod",     CmdTIDemod,     1, "Demodulate raw bits for TI-type LF tag"},
   {"read",      CmdTIRead,      0, "Read and decode a TI 134 kHz tag"},
@@ -292,14 +300,13 @@ static command_t CommandTable[] =
   {NULL, NULL, 0, NULL}
 };
 
-int CmdLFTI(const char *Cmd)
-{
-  CmdsParse(CommandTable, Cmd);
-  return 0;
+int CmdLFTI(const char *Cmd){
+	clearCommandBuffer();
+	CmdsParse(CommandTable, Cmd);
+	return 0;
 }
 
-int CmdHelp(const char *Cmd)
-{
-  CmdsHelp(CommandTable);
-  return 0;
+int CmdHelp(const char *Cmd){
+	CmdsHelp(CommandTable);
+	return 0;
 }