From db09cb3adbe715b058a64357184e4963a8b6d78e Mon Sep 17 00:00:00 2001 From: "roel@libnfc.org" Date: Tue, 18 Sep 2012 13:52:50 +0000 Subject: [PATCH] MAJOR update, added hitag2 reader, emulation and eavesdropping, lots of new code, including FPGA tweaks --- client/Makefile | 1 + client/cmdhf14a.c | 2 +- client/cmdhf14b.c | 2 +- client/cmdhficlass.c | 2 +- client/cmdlf.c | 2 + client/cmdlfhitag.c | 203 +++++++++++++++++++++++++++++++++++ client/cmdlfhitag.h | 21 ++++ client/cmdmain.c | 38 +++++-- client/data.c | 29 ++--- client/data.h | 2 +- client/nonce2key/nonce2key.h | 3 +- 11 files changed, 277 insertions(+), 28 deletions(-) create mode 100644 client/cmdlfhitag.c create mode 100644 client/cmdlfhitag.h diff --git a/client/Makefile b/client/Makefile index ff676f4f..8ddde4bd 100644 --- a/client/Makefile +++ b/client/Makefile @@ -64,6 +64,7 @@ CMDSRCS = \ cmdlf.c \ cmdlfem4x.c \ cmdlfhid.c \ + cmdlfhitag.c \ cmdlfti.c \ cmdparser.c \ cmdmain.c diff --git a/client/cmdhf14a.c b/client/cmdhf14a.c index 4b405d2b..be7afc77 100644 --- a/client/cmdhf14a.c +++ b/client/cmdhf14a.c @@ -28,7 +28,7 @@ static int CmdHelp(const char *Cmd); int CmdHF14AList(const char *Cmd) { uint8_t got[1920]; - GetFromBigBuf(got, sizeof(got)); + GetFromBigBuf(got,sizeof(got),0); PrintAndLog("recorded activity:"); PrintAndLog(" ETU :rssi: who bytes"); diff --git a/client/cmdhf14b.c b/client/cmdhf14b.c index 79c1b8ed..68c7fa68 100644 --- a/client/cmdhf14b.c +++ b/client/cmdhf14b.c @@ -144,7 +144,7 @@ demodError: int CmdHF14BList(const char *Cmd) { uint8_t got[960]; - GetFromBigBuf(got, sizeof(got)); + GetFromBigBuf(got,sizeof(got),0); PrintAndLog("recorded activity:"); PrintAndLog(" time :rssi: who bytes"); diff --git a/client/cmdhficlass.c b/client/cmdhficlass.c index 6064b4e7..7c31dab3 100644 --- a/client/cmdhficlass.c +++ b/client/cmdhficlass.c @@ -26,7 +26,7 @@ static int CmdHelp(const char *Cmd); int CmdHFiClassList(const char *Cmd) { uint8_t got[1920]; - GetFromBigBuf(got, sizeof(got)); + GetFromBigBuf(got,sizeof(got),0); PrintAndLog("recorded activity:"); PrintAndLog(" ETU :rssi: who bytes"); diff --git a/client/cmdlf.c b/client/cmdlf.c index 6be555bb..78e1f988 100644 --- a/client/cmdlf.c +++ b/client/cmdlf.c @@ -23,6 +23,7 @@ #include "cmdlfhid.h" #include "cmdlfti.h" #include "cmdlfem4x.h" +#include "cmdlfhitag.h" static int CmdHelp(const char *Cmd); @@ -535,6 +536,7 @@ static command_t CommandTable[] = {"simbidir", CmdLFSimBidir, 0, "Simulate LF tag (with bidirectional data transmission between reader and tag)"}, {"simman", CmdLFSimManchester, 0, " [GAP] Simulate arbitrary Manchester LF tag"}, {"ti", CmdLFTI, 1, "{ TI RFIDs... }"}, + {"hitag", CmdLFHitag, 1, "{ Hitag tags and transponders... }"}, {"vchdemod", CmdVchDemod, 1, "['clone'] -- Demodulate samples for VeriChip"}, {NULL, NULL, 0, NULL} }; diff --git a/client/cmdlfhitag.c b/client/cmdlfhitag.c new file mode 100644 index 00000000..703767b0 --- /dev/null +++ b/client/cmdlfhitag.c @@ -0,0 +1,203 @@ +//----------------------------------------------------------------------------- +// Copyright (C) 2012 Roel Verdult +// +// 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. +//----------------------------------------------------------------------------- +// Low frequency Hitag support +//----------------------------------------------------------------------------- + +#include +#include +#include +#include "data.h" +#include "proxusb.h" +#include "ui.h" +#include "cmdparser.h" +#include "common.h" +#include "util.h" +#include "hitag2.h" + +static int CmdHelp(const char *Cmd); + +int CmdLFHitagList(const char *Cmd) +{ + uint8_t got[3000]; + GetFromBigBuf(got,sizeof(got),0); + + PrintAndLog("recorded activity:"); + PrintAndLog(" ETU :rssi: who bytes"); + PrintAndLog("---------+----+----+-----------"); + + int i = 0; + int prev = -1; + + for (;;) { + if(i >= 1900) { + break; + } + + bool isResponse; + int timestamp = *((uint32_t *)(got+i)); + if (timestamp & 0x80000000) { + timestamp &= 0x7fffffff; + isResponse = 1; + } else { + isResponse = 0; + } + + int metric = 0; + int parityBits = *((uint32_t *)(got+i+4)); + // 4 bytes of additional information... + // maximum of 32 additional parity bit information + // + // TODO: + // at each quarter bit period we can send power level (16 levels) + // or each half bit period in 256 levels. + + int len = got[i+8]; + + if (len > 100) { + break; + } + if (i + len >= 1900) { + break; + } + + uint8_t *frame = (got+i+9); + + // Break and stick with current result if buffer was not completely full + if (frame[0] == 0x44 && frame[1] == 0x44 && frame[3] == 0x44) { break; } + + char line[1000] = ""; + int j; + for (j = 0; j < len; j++) { + int oddparity = 0x01; + int k; + + for (k=0;k<8;k++) { + oddparity ^= (((frame[j] & 0xFF) >> k) & 0x01); + } + + //if((parityBits >> (len - j - 1)) & 0x01) { + if (isResponse && (oddparity != ((parityBits >> (len - j - 1)) & 0x01))) { + sprintf(line+(j*4), "%02x! ", frame[j]); + } + else { + sprintf(line+(j*4), "%02x ", frame[j]); + } + } + + char metricString[100]; + if (isResponse) { + sprintf(metricString, "%3d", metric); + } else { + strcpy(metricString, " "); + } + + PrintAndLog(" +%7d: %s: %s %s", + (prev < 0 ? 0 : (timestamp - prev)), + metricString, + (isResponse ? "TAG" : " "), + line); + + prev = timestamp; + i += (len + 9); + } + return 0; +} + +int CmdLFHitagSnoop(const char *Cmd) { + UsbCommand c = {CMD_SNOOP_HITAG}; + SendCommand(&c); + return 0; +} + +int CmdLFHitagSim(const char *Cmd) { + UsbCommand c = {CMD_SIMULATE_HITAG}; + char filename[256]; + FILE* pf; + bool tag_mem_supplied; + + param_getstr(Cmd,0,filename); + + if (strlen(filename) > 0) { + if ((pf = fopen(filename,"rb+")) == NULL) { + PrintAndLog("Error: Could not open file [%s]",filename); + return 1; + } + tag_mem_supplied = true; + fread(c.d.asBytes,48,1,pf); + fclose(pf); + } else { + tag_mem_supplied = false; + } + + // Does the tag comes with memory + c.arg[0] = (uint32_t)tag_mem_supplied; + + SendCommand(&c); + return 0; +} + +int CmdLFHitagReader(const char *Cmd) { +// UsbCommand c = {CMD_READER_HITAG}; + +// param_get32ex(Cmd,1,0,16); + UsbCommand c = {CMD_READER_HITAG};//, {param_get32ex(Cmd,0,0,10),param_get32ex(Cmd,1,0,16),param_get32ex(Cmd,2,0,16),param_get32ex(Cmd,3,0,16)}}; + hitag_data* htd = (hitag_data*)c.d.asBytes; + hitag_function htf = param_get32ex(Cmd,0,0,10); + + switch (htf) { + case RHT2F_PASSWORD: { + num_to_bytes(param_get32ex(Cmd,1,0,16),4,htd->pwd.password); + } break; + case RHT2F_AUTHENTICATE: { + num_to_bytes(param_get32ex(Cmd,1,0,16),4,htd->auth.NrAr); + num_to_bytes(param_get32ex(Cmd,2,0,16),4,htd->auth.NrAr+4); + } break; + case RHT2F_TEST_AUTH_ATTEMPTS: { + // No additional parameters needed + } break; + default: { + PrintAndLog("Error: unkown reader function %d",htf); + PrintAndLog("Hitag reader functions",htf); + PrintAndLog(" HitagS (0*)",htf); + PrintAndLog(" Hitag1 (1*)",htf); + PrintAndLog(" Hitag2 (2*)",htf); + PrintAndLog(" 21 (password mode)",htf); + PrintAndLog(" 22 (authentication)",htf); + PrintAndLog(" 25 (test recorded authentications)",htf); + return 1; + } break; + } + + // Copy the hitag2 function into the first argument + c.arg[0] = htf; + + SendCommand(&c); + return 0; +} + +static command_t CommandTableHitag[] = +{ + {"help", CmdHelp, 1, "This help"}, + {"list", CmdLFHitagList, 1, "List Hitag trace history"}, + {"reader", CmdLFHitagReader, 1, "Act like a Hitag Reader"}, + {"sim", CmdLFHitagSim, 1, "Simulate Hitag transponder"}, + {"snoop", CmdLFHitagSnoop, 1, "Eavesdrop Hitag communication"}, + {NULL, NULL, 0, NULL} +}; + +int CmdLFHitag(const char *Cmd) +{ + CmdsParse(CommandTableHitag, Cmd); + return 0; +} + +int CmdHelp(const char *Cmd) +{ + CmdsHelp(CommandTableHitag); + return 0; +} diff --git a/client/cmdlfhitag.h b/client/cmdlfhitag.h new file mode 100644 index 00000000..22b6bb06 --- /dev/null +++ b/client/cmdlfhitag.h @@ -0,0 +1,21 @@ +//----------------------------------------------------------------------------- +// Copyright (C) 2012 Roel Verdult +// +// 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. +//----------------------------------------------------------------------------- +// Low frequency Hitag support +//----------------------------------------------------------------------------- + +#ifndef CMDLFHITAG_H__ +#define CMDLFHITAG_H__ + +int CmdLFHitag(const char *Cmd); + +int CmdLFHitagList(const char *Cmd); +int CmdLFHitagSnoop(const char *Cmd); +int CmdLFHitagSim(const char *Cmd); +int CmdLFHitagReader(const char *Cmd); + +#endif diff --git a/client/cmdmain.c b/client/cmdmain.c index ff58e0a4..c26f2eb4 100644 --- a/client/cmdmain.c +++ b/client/cmdmain.c @@ -98,6 +98,7 @@ void UsbCommandReceived(UsbCommand *UC) // printf("%s(%x) current cmd = %x\n", __FUNCTION__, c->cmd, current_command); /* If we recognize a response, return to avoid further processing */ switch(UC->cmd) { + // First check if we are handling a debug message case CMD_DEBUG_PRINT_STRING: { char s[100]; if(UC->arg[0] > 70 || UC->arg[0] < 0) { @@ -107,11 +108,12 @@ void UsbCommandReceived(UsbCommand *UC) s[UC->arg[0]] = '\0'; PrintAndLog("#db# %s ", s); return; - } + } break; - case CMD_DEBUG_PRINT_INTEGERS: + case CMD_DEBUG_PRINT_INTEGERS: { PrintAndLog("#db# %08x, %08x, %08x \r\n", UC->arg[0], UC->arg[1], UC->arg[2]); return; + } break; case CMD_MEASURED_ANTENNA_TUNING: { int peakv, peakf; @@ -122,7 +124,6 @@ void UsbCommandReceived(UsbCommand *UC) peakf = UC->arg[2] & 0xffff; peakv = UC->arg[2] >> 16; PrintAndLog(""); - PrintAndLog(""); PrintAndLog("# LF antenna: %5.2f V @ 125.00 kHz", vLf125/1000.0); PrintAndLog("# LF antenna: %5.2f V @ 134.00 kHz", vLf134/1000.0); PrintAndLog("# LF optimal: %5.2f V @%9.2f kHz", peakv/1000.0, 12000.0/(peakf+1)); @@ -135,12 +136,32 @@ void UsbCommandReceived(UsbCommand *UC) PrintAndLog("# Your HF antenna is unusable."); else if (vHf<5000) PrintAndLog("# Your HF antenna is marginal."); - return; - } - default: - break; + } break; + + default: { + // Maybe it's a response + switch(current_command) { + case CMD_DOWNLOAD_RAW_ADC_SAMPLES_125K: { + if (UC->cmd != CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K) { + PrintAndLog("unrecognized command %08x\n", UC->cmd); + break; + } + int i; + for(i=0; i<48; i++) sample_buf[i] = UC->d.asBytes[i]; + received_command = UC->cmd; + } break; + + default: { + } break; + } + // Store the last received command + received_command = UC->cmd; + memcpy(¤t_response, UC, sizeof(UsbCommand)); + } break; } - /* Maybe it's a response: */ + received_command = UC->cmd; +/* + // Maybe it's a response: switch(current_command) { case CMD_DOWNLOAD_RAW_ADC_SAMPLES_125K: if (UC->cmd != CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K) goto unexpected_response; @@ -163,4 +184,5 @@ void UsbCommandReceived(UsbCommand *UC) memcpy(¤t_response, UC, sizeof(UsbCommand)); received_command = UC->cmd; } + */ } diff --git a/client/data.c b/client/data.c index 80374c60..eeae8cc5 100644 --- a/client/data.c +++ b/client/data.c @@ -17,19 +17,20 @@ uint8_t sample_buf[SAMPLE_BUFFER_SIZE]; -void GetFromBigBuf(uint8_t *dest, int bytes) +void GetFromBigBuf(uint8_t *dest, int bytes, int start_index) { - int n = bytes/4; - - if (n % 48 != 0) { - PrintAndLog("bad len in GetFromBigBuf"); - return; - } - - for (int i = 0; i < n; i += 12) { - UsbCommand c = {CMD_DOWNLOAD_RAW_ADC_SAMPLES_125K, {i, 0, 0}}; - SendCommand(&c); - WaitForResponse(CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K); - memcpy(dest+(i*4), sample_buf, 48); - } + start_index = ((start_index/12)*12); + int n = (((bytes/4)/48)*48) + start_index; + /* + if (n % 48 != 0) { + PrintAndLog("bad len in GetFromBigBuf"); + return; + } + */ + for (int i = start_index; i < n; i += 12) { + UsbCommand c = {CMD_DOWNLOAD_RAW_ADC_SAMPLES_125K, {i, 0, 0}}; + SendCommand(&c); + WaitForResponse(CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K); + memcpy(dest+(i*4), sample_buf, 48); + } } diff --git a/client/data.h b/client/data.h index b60ec74d..e3a4cbda 100644 --- a/client/data.h +++ b/client/data.h @@ -18,6 +18,6 @@ extern uint8_t sample_buf[SAMPLE_BUFFER_SIZE]; #define arraylen(x) (sizeof(x)/sizeof((x)[0])) -void GetFromBigBuf(uint8_t *dest, int bytes); +void GetFromBigBuf(uint8_t *dest, int bytes, int start_index); #endif diff --git a/client/nonce2key/nonce2key.h b/client/nonce2key/nonce2key.h index c195d974..0f577cf8 100644 --- a/client/nonce2key/nonce2key.h +++ b/client/nonce2key/nonce2key.h @@ -16,8 +16,7 @@ #include #include #include "crapto1.h" - -typedef unsigned char byte_t; +#include "common.h" int nonce2key(uint32_t uid, uint32_t nt, uint64_t par_info, uint64_t ks_info, uint64_t * key); -- 2.39.2