+ if (strlen(Cmd)<3) return usage_hf14_chk();\r
+\r
+ FILE * f;\r
+ char filename[FILE_PATH_SIZE]={0};\r
+ char buf[13];\r
+ uint8_t *keyBlock = NULL, *p;\r
+ uint8_t stKeyBlock = 20;\r
+ \r
+ sector *e_sector = NULL;\r
+ \r
+ int i, res;\r
+ int keycnt = 0;\r
+ char ctmp = 0x00;\r
+ uint8_t blockNo = 0;\r
+ uint8_t SectorsCnt = 1;\r
+ uint8_t keyType = 0;\r
+ uint64_t key64 = 0;\r
+ \r
+ uint8_t tempkey[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};\r
+ \r
+ int transferToEml = 0;\r
+ int createDumpFile = 0;\r
+\r
+ keyBlock = calloc(stKeyBlock, 6);\r
+ if (keyBlock == NULL) return 1;\r
+\r
+ uint64_t defaultKeys[] = {\r
+ 0xffffffffffff, // Default key (first key used by program if no user defined key)\r
+ 0x000000000000, // Blank key\r
+ 0xa0a1a2a3a4a5, // NFCForum MAD key\r
+ 0xb0b1b2b3b4b5,\r
+ 0xaabbccddeeff,\r
+ 0x4d3a99c351dd,\r
+ 0x1a982c7e459a,\r
+ 0xd3f7d3f7d3f7,\r
+ 0x714c5c886e97,\r
+ 0x587ee5f9350f,\r
+ 0xa0478cc39091,\r
+ 0x533cb6c723f6,\r
+ 0x8fd0a4f256e9\r
+ };\r
+ int defaultKeysSize = sizeof(defaultKeys) / sizeof(uint64_t);\r
+\r
+ for (int defaultKeyCounter = 0; defaultKeyCounter < defaultKeysSize; defaultKeyCounter++)\r
+ num_to_bytes(defaultKeys[defaultKeyCounter], 6, (uint8_t*)(keyBlock + defaultKeyCounter * 6));\r
+\r
+ \r
+ if (param_getchar(Cmd, 0)=='*') {\r
+ blockNo = 3;\r
+ switch(param_getchar(Cmd+1, 0)) {\r
+ case '0': SectorsCnt = 5; break;\r
+ case '1': SectorsCnt = 16; break;\r
+ case '2': SectorsCnt = 32; break;\r
+ case '4': SectorsCnt = 40; break;\r
+ default: SectorsCnt = 16;\r
+ }\r
+ } else {\r
+ blockNo = param_get8(Cmd, 0);\r
+ }\r
+ \r
+ ctmp = param_getchar(Cmd, 1);\r
+ switch (ctmp) { \r
+ case 'a': case 'A':\r
+ keyType = !0;\r
+ break;\r
+ case 'b': case 'B':\r
+ keyType = !1;\r
+ break;\r
+ case '?':\r
+ keyType = 2;\r
+ break;\r
+ default:\r
+ PrintAndLog("Key type must be A , B or ?");\r
+ free(keyBlock);\r
+ return 1;\r
+ };\r
+ \r
+ ctmp = param_getchar(Cmd, 2);\r
+ if (ctmp == 't' || ctmp == 'T') transferToEml = 1;\r
+ else if (ctmp == 'd' || ctmp == 'D') createDumpFile = 1;\r
+ \r
+ for (i = transferToEml || createDumpFile; param_getchar(Cmd, 2 + i); i++) {\r
+ if (!param_gethex(Cmd, 2 + i, keyBlock + 6 * keycnt, 12)) {\r
+ if ( stKeyBlock - keycnt < 2) {\r
+ p = realloc(keyBlock, 6*(stKeyBlock+=10));\r
+ if (!p) {\r
+ PrintAndLog("Cannot allocate memory for Keys");\r
+ free(keyBlock);\r
+ return 2;\r
+ }\r
+ keyBlock = p;\r
+ }\r
+ PrintAndLog("key[%2d] %02x%02x%02x%02x%02x%02x", keycnt,\r
+ (keyBlock + 6*keycnt)[0],(keyBlock + 6*keycnt)[1], (keyBlock + 6*keycnt)[2],\r
+ (keyBlock + 6*keycnt)[3], (keyBlock + 6*keycnt)[4], (keyBlock + 6*keycnt)[5], 6);\r
+ keycnt++;\r
+ } else {\r
+ // May be a dic file\r
+ if ( param_getstr(Cmd, 2 + i,filename) >= FILE_PATH_SIZE ) {\r
+ PrintAndLog("File name too long");\r
+ free(keyBlock);\r
+ return 2;\r
+ }\r
+ \r
+ if ( (f = fopen( filename , "r")) ) {\r
+ while( fgets(buf, sizeof(buf), f) ){\r
+ if (strlen(buf) < 12 || buf[11] == '\n')\r
+ continue;\r
+ \r
+ while (fgetc(f) != '\n' && !feof(f)) ; //goto next line\r
+ \r
+ if( buf[0]=='#' ) continue; //The line start with # is comment, skip\r
+\r
+ if (!isxdigit(buf[0])){\r
+ PrintAndLog("File content error. '%s' must include 12 HEX symbols",buf);\r
+ continue;\r
+ }\r
+ \r
+ buf[12] = 0;\r
+\r
+ if ( stKeyBlock - keycnt < 2) {\r
+ p = realloc(keyBlock, 6*(stKeyBlock+=10));\r
+ if (!p) {\r
+ PrintAndLog("Cannot allocate memory for defKeys");\r
+ free(keyBlock);\r
+ fclose(f);\r
+ return 2;\r
+ }\r
+ keyBlock = p;\r
+ }\r
+ memset(keyBlock + 6 * keycnt, 0, 6);\r
+ num_to_bytes(strtoll(buf, NULL, 16), 6, keyBlock + 6*keycnt);\r
+ PrintAndLog("check key[%2d] %012"llx, keycnt, bytes_to_num(keyBlock + 6*keycnt, 6));\r
+ keycnt++;\r
+ memset(buf, 0, sizeof(buf));\r
+ }\r
+ fclose(f);\r
+ } else {\r
+ PrintAndLog("File: %s: not found or locked.", filename);\r
+ free(keyBlock);\r
+ return 1;\r
+ \r
+ }\r
+ }\r
+ }\r
+ \r
+ if (keycnt == 0) {\r
+ PrintAndLog("No key specified, trying default keys");\r
+ for (;keycnt < defaultKeysSize; keycnt++)\r
+ PrintAndLog("key[%2d] %02x%02x%02x%02x%02x%02x", keycnt,\r
+ (keyBlock + 6*keycnt)[0],(keyBlock + 6*keycnt)[1], (keyBlock + 6*keycnt)[2],\r
+ (keyBlock + 6*keycnt)[3], (keyBlock + 6*keycnt)[4], (keyBlock + 6*keycnt)[5], 6);\r
+ }\r
+ \r
+ // initialize storage for found keys\r
+ e_sector = calloc(SectorsCnt, sizeof(sector));\r
+ if (e_sector == NULL) {\r
+ free(keyBlock);\r
+ return 1;\r
+ }\r
+\r
+ // empty e_sector\r
+ for(int i = 0; i < SectorsCnt; ++i){\r
+ e_sector[i].Key[0] = 0xffffffffffff;\r
+ e_sector[i].Key[1] = 0xffffffffffff;\r
+ e_sector[i].foundKey[0] = FALSE;\r
+ e_sector[i].foundKey[1] = FALSE;\r
+ }\r
+ \r
+ \r
+ uint8_t trgKeyType = 0;\r
+ uint32_t max_keys = keycnt > (USB_CMD_DATA_SIZE/6) ? (USB_CMD_DATA_SIZE/6) : keycnt;\r
+ \r
+ // time\r
+ clock_t t1 = clock();\r
+ time_t start, end;\r
+ time(&start);\r
+ \r
+ // check keys.\r
+ for (trgKeyType = !keyType; trgKeyType < 2; (keyType==2) ? (++trgKeyType) : (trgKeyType=2) ) {\r
+\r
+ int b = blockNo;\r
+ for (int i = 0; i < SectorsCnt; ++i) {\r
+ \r
+ // skip already found keys.\r
+ if (e_sector[i].foundKey[trgKeyType]) continue;\r
+ \r
+ for (uint32_t c = 0; c < keycnt; c += max_keys) {\r
+ \r
+ uint32_t size = keycnt-c > max_keys ? max_keys : keycnt-c;\r
+ \r
+ res = mfCheckKeys(b, trgKeyType, true, size, &keyBlock[6*c], &key64);\r
+ if (!res) {\r
+ e_sector[i].Key[trgKeyType] = key64;\r
+ e_sector[i].foundKey[trgKeyType] = TRUE;\r
+ break;\r
+ }\r
+ printf(".");\r
+ fflush(stdout);\r
+ }\r
+ b < 127 ? ( b +=4 ) : ( b += 16 ); \r
+ }\r
+ }\r
+ t1 = clock() - t1;\r
+ time(&end);\r
+ unsigned long elapsed_time = difftime(end, start); \r
+ if ( t1 > 0 )\r
+ PrintAndLog("\nTime in checkkeys: %.0f ticks %u seconds\n", (float)t1, elapsed_time);\r
+\r
+ \r
+ // 20160116 If Sector A is found, but not Sector B, try just reading it of the tag?\r
+ if ( keyType != 1 ) {\r
+ PrintAndLog("testing to read key B...");\r
+ for (i = 0; i < SectorsCnt; i++) {\r
+ // KEY A but not KEY B\r
+ if ( e_sector[i].foundKey[0] && !e_sector[i].foundKey[1] ) {\r
+ \r
+ uint8_t sectrail = (FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1);\r
+ \r
+ PrintAndLog("Reading block %d", sectrail);\r
+ \r
+ UsbCommand c = {CMD_MIFARE_READBL, {sectrail, 0, 0}};\r
+ num_to_bytes(e_sector[i].Key[0], 6, c.d.asBytes); // KEY A\r
+ clearCommandBuffer();\r
+ SendCommand(&c);\r
+\r
+ UsbCommand resp;\r
+ if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500)) continue;\r
+ \r
+ uint8_t isOK = resp.arg[0] & 0xff;\r
+ if (!isOK) continue;\r
+\r
+ uint8_t *data = resp.d.asBytes;\r
+ key64 = bytes_to_num(data+10, 6);\r
+ if (key64) {\r
+ PrintAndLog("Data:%s", sprint_hex(data+10, 6));\r
+ e_sector[i].foundKey[1] = 1;\r
+ e_sector[i].Key[1] = key64;\r
+ }\r
+ }\r
+ }\r
+ }\r
+\r
+\r
+ //print them\r
+ printKeyTable( SectorsCnt, e_sector );\r
+ \r
+ if (transferToEml) {\r
+ uint8_t block[16] = {0x00};\r
+ for (uint8_t i = 0; i < SectorsCnt; ++i ) {\r
+ mfEmlGetMem(block, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);\r
+ if (e_sector[i].foundKey[0])\r
+ num_to_bytes(e_sector[i].Key[0], 6, block);\r
+ if (e_sector[i].foundKey[1])\r
+ num_to_bytes(e_sector[i].Key[1], 6, block+10);\r
+ mfEmlSetMem(block, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);\r
+ }\r
+ PrintAndLog("Found keys have been transferred to the emulator memory");\r
+ }\r
+ \r
+ if (createDumpFile) {\r
+ FILE *fkeys = fopen("dumpkeys.bin","wb");\r
+ if (fkeys == NULL) { \r
+ PrintAndLog("Could not create file dumpkeys.bin");\r
+ free(keyBlock);\r
+ free(e_sector);\r
+ return 1;\r
+ }\r
+ PrintAndLog("Printing keys to binary file dumpkeys.bin...");\r
+ \r
+ for( i=0; i<SectorsCnt; i++) {\r
+ num_to_bytes(e_sector[i].Key[0], 6, tempkey);\r
+ fwrite ( tempkey, 1, 6, fkeys );\r
+ }\r
+ for(i=0; i<SectorsCnt; i++) {\r
+ num_to_bytes(e_sector[i].Key[1], 6, tempkey);\r
+ fwrite ( tempkey, 1, 6, fkeys );\r
+ }\r
+ fclose(fkeys);\r
+ PrintAndLog("Found keys have been dumped to file dumpkeys.bin. 0xffffffffffff has been inserted for unknown keys."); \r
+ }\r
+ \r
+ free(keyBlock);\r
+ free(e_sector);\r
+ PrintAndLog("");\r
+ return 0;\r
+}\r
+\r
+int CmdHF14AMf1kSim(const char *Cmd) {\r
+ uint8_t uid[10] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0};\r
+ uint8_t exitAfterNReads = 0;\r
+ uint8_t flags = (FLAG_UID_IN_EMUL | FLAG_4B_UID_IN_DATA);\r
+ int uidlen = 0;\r
+ uint8_t pnr = 0;\r
+ uint8_t cmdp = param_getchar(Cmd, 0);\r
+\r
+ if (cmdp == 'h' || cmdp == 'H') return usage_hf14_mf1ksim();\r
+\r
+ cmdp = param_getchar(Cmd, pnr);\r
+ if (cmdp == 'u' || cmdp == 'U') {\r
+ param_gethex_ex(Cmd, pnr+1, uid, &uidlen);\r
+ switch(uidlen){\r
+ case 20: flags = FLAG_10B_UID_IN_DATA; break;\r
+ case 14: flags = FLAG_7B_UID_IN_DATA; break;\r
+ case 8: flags = FLAG_4B_UID_IN_DATA; break;\r
+ default: return usage_hf14_mf1ksim();\r
+ }\r
+ pnr +=2;\r
+ }\r
+\r
+ cmdp = param_getchar(Cmd, pnr); \r
+ if (cmdp == 'n' || cmdp == 'N') {\r
+ exitAfterNReads = param_get8(Cmd, pnr+1);\r
+ pnr += 2;\r
+ }\r
+\r
+ cmdp = param_getchar(Cmd, pnr); \r
+ if (cmdp == 'i' || cmdp == 'I' ) {\r
+ flags |= FLAG_INTERACTIVE;\r
+ pnr++;\r
+ }\r
+\r
+ cmdp = param_getchar(Cmd, pnr); \r
+ if (cmdp == 'x' || cmdp == 'X') {\r
+ flags |= FLAG_NR_AR_ATTACK;\r
+ }\r
+ \r
+ PrintAndLog(" uid:%s, numreads:%d, flags:%d (0x%02x) "\r
+ , (uidlen == 0 ) ? "N/A" : sprint_hex(uid, uidlen>>1)\r
+ , exitAfterNReads\r
+ , flags\r
+ , flags);\r
+\r
+ UsbCommand c = {CMD_SIMULATE_MIFARE_CARD, {flags, exitAfterNReads, 0}};\r
+ memcpy(c.d.asBytes, uid, sizeof(uid));\r
+ clearCommandBuffer();\r
+ SendCommand(&c);\r
+\r
+ if(flags & FLAG_INTERACTIVE) { \r
+ uint8_t data[32];\r
+ uint64_t key;\r
+ UsbCommand resp; \r
+ PrintAndLog("Press pm3-button or send another cmd to abort simulation");\r
+ while( !ukbhit() ){\r
+ if (!WaitForResponseTimeout(CMD_ACK, &resp, 1500) ) continue;\r
+\r
+ if ( !(flags & FLAG_NR_AR_ATTACK) ) break;\r
+ if ( (resp.arg[0] & 0xffff) != CMD_SIMULATE_MIFARE_CARD ) break;\r
+\r
+ memset(data, 0x00, sizeof(data)); \r
+ int len = (resp.arg[1] > sizeof(data)) ? sizeof(data) : resp.arg[1];\r
+\r
+ memcpy(data, resp.d.asBytes, len); \r
+ key = 0;\r
+ bool found = tryMfk32(data, &key);\r
+ found ^= tryMfk32_moebius(data, &key);\r
+ if ( found ) break;\r
+ }\r
+ }\r
+ return 0;\r
+}\r
+\r
+int CmdHF14AMfSniff(const char *Cmd){\r
+ bool wantLogToFile = FALSE;\r
+ bool wantDecrypt = FALSE;\r
+ //bool wantSaveToEml = FALSE; TODO\r
+ bool wantSaveToEmlFile = FALSE;\r
+\r
+ //var \r
+ int tmpchar;\r
+ int res = 0;\r
+ int len = 0;\r
+ int blockLen = 0;\r
+ int pckNum = 0;\r
+ int num = 0;\r
+ uint8_t uid[10];\r
+ uint8_t uid_len = 0;\r
+ uint8_t atqa[2] = {0x00, 0x00};\r
+ uint8_t sak = 0;\r
+ bool isTag = FALSE;\r
+ uint8_t *buf = NULL;\r
+ uint16_t bufsize = 0;\r
+ uint8_t *bufPtr = NULL;\r
+ uint16_t traceLen = 0;\r
+ \r
+ memset(uid, 0x00, sizeof(uid));\r
+ \r
+ char ctmp = param_getchar(Cmd, 0);\r
+ if ( ctmp == 'h' || ctmp == 'H' ) return usage_hf14_sniff();\r
+ \r
+ for (int i = 0; i < 4; i++) {\r
+ ctmp = param_getchar(Cmd, i);\r
+ if (ctmp == 'l' || ctmp == 'L') wantLogToFile = true;\r
+ if (ctmp == 'd' || ctmp == 'D') wantDecrypt = true;\r
+ //if (ctmp == 'e' || ctmp == 'E') wantSaveToEml = true; TODO\r
+ if (ctmp == 'f' || ctmp == 'F') wantSaveToEmlFile = true;\r
+ }\r
+ \r
+ printf("-------------------------------------------------------------------------\n");\r
+ printf("Executing mifare sniffing command. \n");\r
+ printf("Press the key on the proxmark3 device to abort both proxmark3 and client.\n");\r
+ printf("Press the key on pc keyboard to abort the client.\n");\r
+ printf("-------------------------------------------------------------------------\n");\r
+\r
+ UsbCommand c = {CMD_MIFARE_SNIFFER, {0, 0, 0}};\r
+ clearCommandBuffer();\r
+ SendCommand(&c);\r
+\r
+ // wait cycle\r
+ while (true) {\r
+ printf(".");\r
+ fflush(stdout);\r
+ if (ukbhit()) {\r
+ tmpchar = getchar();\r
+ (void)tmpchar;\r
+ printf("\naborted via keyboard!\n");\r
+ break;\r
+ }\r
+ \r
+ UsbCommand resp;\r
+ if (WaitForResponseTimeout(CMD_ACK, &resp, 2000)) {\r
+ res = resp.arg[0] & 0xff;\r
+ traceLen = resp.arg[1];\r
+ len = resp.arg[2];\r
+\r
+ // we are done?\r
+ if (res == 0) {\r
+ free(buf);\r
+ return 0;\r
+ }\r
+\r
+ if (res == 1) { // there is (more) data to be transferred\r
+ if (pckNum == 0) { // first packet, (re)allocate necessary buffer\r
+ if (traceLen > bufsize) {\r
+ uint8_t *p;\r
+ if (buf == NULL) // not yet allocated\r
+ p = malloc(traceLen);\r
+ else // need more memory\r
+ p = realloc(buf, traceLen);\r
+ \r
+ if (p == NULL) {\r
+ PrintAndLog("Cannot allocate memory for trace");\r
+ free(buf);\r
+ return 2;\r
+ }\r
+ buf = p;\r
+ }\r
+ bufPtr = buf;\r
+ bufsize = traceLen;\r
+ memset(buf, 0x00, traceLen);\r
+ }\r
+ if (bufPtr == NULL) {\r
+ PrintAndLog("Cannot allocate memory for trace");\r
+ free(buf);\r
+ return 2;\r
+ }\r
+ // what happens if LEN is bigger then TRACELEN --iceman\r
+ memcpy(bufPtr, resp.d.asBytes, len);\r
+ bufPtr += len;\r
+ pckNum++;\r
+ }\r
+\r
+ if (res == 2) { // received all data, start displaying\r
+ blockLen = bufPtr - buf;\r
+ bufPtr = buf;\r
+ printf(">\n");\r
+ PrintAndLog("received trace len: %d packages: %d", blockLen, pckNum);\r
+ while (bufPtr - buf < blockLen) {\r
+ bufPtr += 6; // skip (void) timing information\r
+ len = *((uint16_t *)bufPtr);\r
+ if(len & 0x8000) {\r
+ isTag = true;\r
+ len &= 0x7fff;\r
+ } else {\r
+ isTag = false;\r
+ }\r
+ bufPtr += 2;\r
+ if ((len == 17) && (bufPtr[0] == 0xff) && (bufPtr[1] == 0xff) && (bufPtr[15] == 0xff) && (bufPtr[16] == 0xff)) {\r
+ memcpy(uid, bufPtr + 2, 10);\r
+ memcpy(atqa, bufPtr + 2 + 10, 2);\r
+ switch (atqa[0] & 0xC0) {\r
+ case 0x80: uid_len = 10; break;\r
+ case 0x40: uid_len = 7; break;\r
+ default: uid_len = 4; break;\r
+ }\r
+ sak = bufPtr[14];\r
+ PrintAndLog("tag select uid| %s atqa:0x%02x%02x sak:0x%02x", \r
+ sprint_hex(uid, uid_len),\r
+ atqa[1], \r
+ atqa[0], \r
+ sak);\r
+ if (wantLogToFile || wantDecrypt) {\r
+ FillFileNameByUID(logHexFileName, uid, ".log", uid_len);\r
+ AddLogCurrentDT(logHexFileName);\r
+ } \r
+ if (wantDecrypt)\r
+ mfTraceInit(uid, uid_len, atqa, sak, wantSaveToEmlFile);\r
+ } else {\r
+ PrintAndLog("%03d| %s |%s", num, isTag ? "TAG" : "RDR", sprint_hex(bufPtr, len));\r
+ if (wantLogToFile) \r
+ AddLogHex(logHexFileName, isTag ? "TAG| ":"RDR| ", bufPtr, len);\r
+ if (wantDecrypt) \r
+ mfTraceDecode(bufPtr, len, wantSaveToEmlFile);\r
+ num++; \r
+ }\r
+ bufPtr += len;\r
+ bufPtr += ((len-1)/8+1); // ignore parity\r
+ }\r
+ pckNum = 0;\r
+ }\r
+ } // resp not NULL\r
+ } // while (true)\r
+\r
+ free(buf);\r
+ return 0;\r
+}\r
+\r
+int CmdHF14AMfDbg(const char *Cmd) {\r
+\r
+ char ctmp = param_getchar(Cmd, 0);\r
+ if (strlen(Cmd) < 1 || ctmp == 'h'|| ctmp == 'H') return usage_hf14_dbg();\r
+ \r
+ uint8_t dbgMode = param_get8ex(Cmd, 0, 0, 10);\r
+ if (dbgMode > 4) return usage_hf14_dbg();\r
+\r
+ UsbCommand c = {CMD_MIFARE_SET_DBGMODE, {dbgMode, 0, 0}};\r
+ SendCommand(&c);\r
+ return 0;\r
+}\r
+\r
+void printKeyTable( uint8_t sectorscnt, sector *e_sector ){\r
+ PrintAndLog("|---|----------------|---|----------------|---|");\r
+ PrintAndLog("|sec|key A |res|key B |res|");\r
+ PrintAndLog("|---|----------------|---|----------------|---|");\r
+ for (uint8_t i = 0; i < sectorscnt; ++i) {\r
+ PrintAndLog("|%03d| %012"llx" | %d | %012"llx" | %d |", i,\r
+ e_sector[i].Key[0], e_sector[i].foundKey[0], \r
+ e_sector[i].Key[1], e_sector[i].foundKey[1]\r
+ );\r
+ }\r
+ PrintAndLog("|---|----------------|---|----------------|---|");\r
projects / proxmark3-svn / blobdiff