+ 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
+int CmdHF14AMfKeyBrute(const char *Cmd) {\r
+\r
+ uint8_t blockNo = 0, keytype = 0;\r
+ uint8_t key[6] = {0, 0, 0, 0, 0, 0};\r
+ uint64_t foundkey = 0;\r
+ \r
+ char cmdp = param_getchar(Cmd, 0); \r
+ if ( cmdp == 'H' || cmdp == 'h') return usage_hf14_keybrute();\r
+ \r
+ // block number\r
+ blockNo = param_get8(Cmd, 0); \r
+ \r
+ // keytype\r
+ cmdp = param_getchar(Cmd, 1);\r
+ if (cmdp == 'B' || cmdp == 'b') keytype = 1;\r
+ \r
+ // key\r
+ if (param_gethex(Cmd, 2, key, 12)) return usage_hf14_keybrute();\r
+ \r
+ clock_t t1 = clock();\r
+ time_t start, end;\r
+ time(&start);\r
+ \r
+ if (mfKeyBrute( blockNo, keytype, key, &foundkey))\r
+ PrintAndLog("Found valid key: %012"llx" \n", foundkey);\r
+ else\r
+ PrintAndLog("Key not found");\r
+ \r
+ t1 = clock() - t1;\r
+ time(&end);\r
+ unsigned long elapsed_time = difftime(end, start); \r
+ if ( t1 > 0 )\r
+ PrintAndLog("\nTime in keybrute: %.0f ticks %u seconds\n", (float)t1, elapsed_time);\r
+ \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
+}\r
+\r
+// EMULATOR COMMANDS\r
+int CmdHF14AMfEGet(const char *Cmd)\r
+{\r
+ uint8_t blockNo = 0;\r
+ uint8_t data[16] = {0x00};\r
+\r
+ if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {\r
+ PrintAndLog("Usage: hf mf eget <block number>");\r
+ PrintAndLog(" sample: hf mf eget 0 ");\r
+ return 0;\r
+ } \r
+ \r
+ blockNo = param_get8(Cmd, 0);\r
+\r
+ PrintAndLog("");\r
+ if (!mfEmlGetMem(data, blockNo, 1)) {\r
+ PrintAndLog("data[%3d]:%s", blockNo, sprint_hex(data, 16));\r
+ } else {\r
+ PrintAndLog("Command execute timeout");\r
+ }\r
+\r