#include "apps.h"\r
\r
//-----------------------------------------------------------------------------\r
-// Select, Authenticaate, Read an MIFARE tag. \r
+// Select, Authenticate, Read a MIFARE tag. \r
// read block\r
//-----------------------------------------------------------------------------\r
void MifareReadBlock(uint8_t arg0, uint8_t arg1, uint8_t arg2, uint8_t *datain)\r
pcs = &mpcs;\r
\r
// clear trace\r
- iso14a_clear_trace();\r
+ iso14a_clear_trace();\r
// iso14a_set_tracing(false);\r
\r
iso14443a_setup(FPGA_HF_ISO14443A_READER_LISTEN);\r
\r
while (true) {\r
if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Can't select card");\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Can't select card");\r
break;\r
};\r
\r
if(mifare_classic_auth(pcs, cuid, blockNo, keyType, ui64Key, AUTH_FIRST)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Auth error");\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Auth error");\r
break;\r
};\r
\r
if(mifare_classic_readblock(pcs, cuid, blockNo, dataoutbuf)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block error");\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Read block error");\r
break;\r
};\r
\r
if(mifare_classic_halt(pcs, cuid)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Halt error");\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Halt error");\r
break;\r
};\r
\r
\r
if (MF_DBGLEVEL >= 2) DbpString("READ BLOCK FINISHED");\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
-\r
-// UsbCommand ack = {CMD_ACK, {isOK, 0, 0}};\r
-// memcpy(ack.d.asBytes, dataoutbuf, 16);\r
- \r
LED_B_ON();\r
- cmd_send(CMD_ACK,isOK,0,0,dataoutbuf,16);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
+ cmd_send(CMD_ACK,isOK,0,0,dataoutbuf,16);\r
LED_B_OFF();\r
\r
-\r
- // Thats it...\r
+ // Thats it...\r
FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);\r
LEDsoff();\r
// iso14a_set_tracing(TRUE);\r
LEDsoff();\r
}\r
\r
+\r
//-----------------------------------------------------------------------------\r
-// Select, Authenticaate, Read an MIFARE tag. \r
-// read sector (data = 4 x 16 bytes = 64 bytes)\r
+// Select, Authenticate, Read a MIFARE tag. \r
+// read sector (data = 4 x 16 bytes = 64 bytes, or 16 x 16 bytes = 256 bytes)\r
//-----------------------------------------------------------------------------\r
void MifareReadSector(uint8_t arg0, uint8_t arg1, uint8_t arg2, uint8_t *datain)\r
{\r
ui64Key = bytes_to_num(datain, 6);\r
\r
// variables\r
- byte_t isOK = 0;\r
- byte_t dataoutbuf[16 * 4];\r
+ byte_t isOK;\r
+ byte_t dataoutbuf[16 * 16];\r
uint8_t uid[10];\r
uint32_t cuid;\r
struct Crypto1State mpcs = {0, 0};\r
pcs = &mpcs;\r
\r
// clear trace\r
- iso14a_clear_trace();\r
+ iso14a_clear_trace();\r
// iso14a_set_tracing(false);\r
\r
iso14443a_setup(FPGA_HF_ISO14443A_READER_LISTEN);\r
LED_B_OFF();\r
LED_C_OFF();\r
\r
- while (true) {\r
- if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
+ isOK = 1;\r
+ if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
+ isOK = 0;\r
if (MF_DBGLEVEL >= 1) Dbprintf("Can't select card");\r
- break;\r
- };\r
+ }\r
\r
- if(mifare_classic_auth(pcs, cuid, sectorNo * 4, keyType, ui64Key, AUTH_FIRST)) {\r
+ \r
+ if(isOK && mifare_classic_auth(pcs, cuid, FirstBlockOfSector(sectorNo), keyType, ui64Key, AUTH_FIRST)) {\r
+ isOK = 0;\r
if (MF_DBGLEVEL >= 1) Dbprintf("Auth error");\r
+ }\r
+ \r
+ for (uint8_t blockNo = 0; isOK && blockNo < NumBlocksPerSector(sectorNo); blockNo++) {\r
+ if(mifare_classic_readblock(pcs, cuid, FirstBlockOfSector(sectorNo) + blockNo, dataoutbuf + 16 * blockNo)) {\r
+ isOK = 0;\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Read sector %2d block %2d error", sectorNo, blockNo);\r
break;\r
- };\r
- \r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 0, dataoutbuf + 16 * 0)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 0 error");\r
- break;\r
- };\r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 1, dataoutbuf + 16 * 1)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 1 error");\r
- break;\r
- };\r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 2, dataoutbuf + 16 * 2)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 2 error");\r
- break;\r
- };\r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 3, dataoutbuf + 16 * 3)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 3 error");\r
- break;\r
- };\r
+ }\r
+ }\r
\r
- if(mifare_classic_halt(pcs, cuid)) {\r
+ if(mifare_classic_halt(pcs, cuid)) {\r
if (MF_DBGLEVEL >= 1) Dbprintf("Halt error");\r
- break;\r
- };\r
-\r
- isOK = 1;\r
- break;\r
}\r
+\r
\r
// ----------------------------- crypto1 destroy\r
crypto1_destroy(pcs);\r
\r
if (MF_DBGLEVEL >= 2) DbpString("READ SECTOR FINISHED");\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
-\r
-// UsbCommand ack = {CMD_ACK, {isOK, 0, 0}};\r
-// memcpy(ack.d.asBytes, dataoutbuf, 16 * 2);\r
- \r
LED_B_ON();\r
- cmd_send(CMD_ACK,isOK,0,0,dataoutbuf,32);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
-// SpinDelay(100);\r
- \r
-// memcpy(ack.d.asBytes, dataoutbuf + 16 * 2, 16 * 2);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
- cmd_send(CMD_ACK,isOK,0,0,dataoutbuf+32, 32);\r
+ cmd_send(CMD_ACK,isOK,0,0,dataoutbuf,16*NumBlocksPerSector(sectorNo));\r
LED_B_OFF();\r
\r
// Thats it...\r
FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);\r
LEDsoff();\r
// iso14a_set_tracing(TRUE);\r
-\r
}\r
\r
+\r
void MifareUReadCard(uint8_t arg0, uint8_t *datain)\r
{\r
// params\r
\r
if (MF_DBGLEVEL >= 2) DbpString("READ CARD FINISHED");\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
- \r
LED_B_ON();\r
cmd_send(CMD_ACK,isOK,0,0,dataoutbuf,64);\r
- //cmd_send(CMD_ACK,isOK,0,0,dataoutbuf+32, 32);\r
LED_B_OFF();\r
\r
// Thats it...\r
FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);\r
LEDsoff();\r
-// iso14a_set_tracing(TRUE);\r
\r
}\r
\r
\r
//-----------------------------------------------------------------------------\r
-// Select, Authenticaate, Read an MIFARE tag. \r
+// Select, Authenticate, Write a MIFARE tag. \r
// read block\r
//-----------------------------------------------------------------------------\r
void MifareWriteBlock(uint8_t arg0, uint8_t arg1, uint8_t arg2, uint8_t *datain)\r
\r
if (MF_DBGLEVEL >= 2) DbpString("WRITE BLOCK FINISHED");\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
-\r
-// UsbCommand ack = {CMD_ACK, {isOK, 0, 0}};\r
- \r
LED_B_ON();\r
cmd_send(CMD_ACK,isOK,0,0,0,0);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
LED_B_OFF();\r
\r
\r
\r
}\r
\r
+\r
void MifareUWriteBlock(uint8_t arg0, uint8_t *datain)\r
{\r
// params\r
\r
if (MF_DBGLEVEL >= 2) DbpString("WRITE BLOCK FINISHED");\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
-\r
LED_B_ON();\r
- cmd_send(CMD_ACK,isOK,0,0,0,0);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
+ cmd_send(CMD_ACK,isOK,0,0,0,0);\r
LED_B_OFF();\r
\r
\r
FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);\r
LEDsoff();\r
// iso14a_set_tracing(TRUE);\r
-\r
}\r
\r
+\r
void MifareUWriteBlock_Special(uint8_t arg0, uint8_t *datain)\r
{\r
- // params\r
- uint8_t blockNo = arg0;\r
- byte_t blockdata[4];\r
- \r
+ // params\r
+ uint8_t blockNo = arg0;\r
+ byte_t blockdata[4];\r
+ \r
memcpy(blockdata, datain,4);\r
\r
- // variables\r
- byte_t isOK = 0;\r
- uint8_t uid[10];\r
- uint32_t cuid;\r
-\r
- // clear trace\r
- iso14a_clear_trace();\r
- // iso14a_set_tracing(false);\r
+ // variables\r
+ byte_t isOK = 0;\r
+ uint8_t uid[10];\r
+ uint32_t cuid;\r
\r
- iso14443a_setup(FPGA_HF_ISO14443A_READER_LISTEN);\r
+ // clear trace\r
+ iso14a_clear_trace();\r
+ // iso14a_set_tracing(false);\r
\r
- LED_A_ON();\r
- LED_B_OFF();\r
- LED_C_OFF();\r
+ iso14443a_setup(FPGA_HF_ISO14443A_READER_LISTEN);\r
\r
- while (true) {\r
- if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Can't select card");\r
- break;\r
- };\r
+ LED_A_ON();\r
+ LED_B_OFF();\r
+ LED_C_OFF();\r
\r
- if(mifare_ultra_special_writeblock(cuid, blockNo, blockdata)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Write block error");\r
- break;\r
- };\r
+ while (true) {\r
+ if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Can't select card");\r
+ break;\r
+ };\r
\r
- if(mifare_ultra_halt(cuid)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Halt error");\r
- break;\r
- };\r
+ if(mifare_ultra_special_writeblock(cuid, blockNo, blockdata)) {\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Write block error");\r
+ break;\r
+ };\r
\r
- isOK = 1;\r
- break;\r
- }\r
+ if(mifare_ultra_halt(cuid)) {\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Halt error");\r
+ break;\r
+ };\r
\r
- if (MF_DBGLEVEL >= 2) DbpString("WRITE BLOCK FINISHED");\r
+ isOK = 1;\r
+ break;\r
+ }\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
+ if (MF_DBGLEVEL >= 2) DbpString("WRITE BLOCK FINISHED");\r
\r
- LED_B_ON();\r
- cmd_send(CMD_ACK,isOK,0,0,0,0);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
- LED_B_OFF();\r
+ LED_B_ON();\r
+ cmd_send(CMD_ACK,isOK,0,0,0,0);\r
+ LED_B_OFF();\r
\r
\r
- // Thats it...\r
- FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);\r
- LEDsoff();\r
+ // Thats it...\r
+ FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);\r
+ LEDsoff();\r
// iso14a_set_tracing(TRUE);\r
\r
}\r
\r
+\r
// Return 1 if the nonce is invalid else return 0\r
int valid_nonce(uint32_t Nt, uint32_t NtEnc, uint32_t Ks1, byte_t * parity) {\r
return ((oddparity((Nt >> 24) & 0xFF) == ((parity[0]) ^ oddparity((NtEnc >> 24) & 0xFF) ^ BIT(Ks1,16))) & \\r
}\r
\r
\r
-\r
//-----------------------------------------------------------------------------\r
// MIFARE nested authentication. \r
// \r
LED_B_OFF();\r
LED_C_OFF();\r
\r
-// SpinDelay(300);\r
for (i = 0; i < keyCount; i++) {\r
-// FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);\r
-// SpinDelay(100);\r
-// FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_ISO14443A | FPGA_HF_ISO14443A_READER_MOD);\r
- // prepare next select by sending a HALT. There is no need to power down the card.\r
if(mifare_classic_halt(pcs, cuid)) {\r
if (MF_DBGLEVEL >= 1) Dbprintf("ChkKeys: Halt error");\r
}\r
\r
- // SpinDelay(50);\r
- \r
if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
if (OLD_MF_DBGLEVEL >= 1) Dbprintf("ChkKeys: Can't select card");\r
break;\r
// ----------------------------- crypto1 destroy\r
crypto1_destroy(pcs);\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
-\r
LED_B_ON();\r
cmd_send(CMD_ACK,isOK,0,0,datain + i * 6,6);\r
LED_B_OFF();\r
Dbprintf("Debug level: %d", MF_DBGLEVEL);\r
}\r
\r
+\r
//-----------------------------------------------------------------------------\r
// Work with emulator memory\r
// \r
emlClearMem();\r
}\r
\r
+\r
void MifareEMemSet(uint32_t arg0, uint32_t arg1, uint32_t arg2, uint8_t *datain){\r
emlSetMem(datain, arg0, arg1); // data, block num, blocks count\r
}\r
\r
+\r
void MifareEMemGet(uint32_t arg0, uint32_t arg1, uint32_t arg2, uint8_t *datain){\r
-// UsbCommand ack = {CMD_ACK, {arg0, arg1, 0}};\r
\r
- byte_t buf[48];\r
- emlGetMem(buf, arg0, arg1); // data, block num, blocks count\r
+ byte_t buf[48];\r
+ emlGetMem(buf, arg0, arg1); // data, block num, blocks count (max 4)\r
\r
LED_B_ON();\r
- cmd_send(CMD_ACK,arg0,arg1,0,buf,48);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
+ cmd_send(CMD_ACK,arg0,arg1,0,buf,48);\r
LED_B_OFF();\r
}\r
\r
+\r
//-----------------------------------------------------------------------------\r
// Load a card into the emulator memory\r
// \r
//-----------------------------------------------------------------------------\r
void MifareECardLoad(uint32_t arg0, uint32_t arg1, uint32_t arg2, uint8_t *datain){\r
- int i;\r
- uint8_t sectorNo = 0;\r
+ uint8_t numSectors = arg0;\r
uint8_t keyType = arg1;\r
uint64_t ui64Key = 0;\r
uint32_t cuid;\r
LED_B_OFF();\r
LED_C_OFF();\r
\r
- while (true) {\r
- if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Can't select card");\r
- break;\r
- };\r
- \r
- for (i = 0; i < 16; i++) {\r
- sectorNo = i;\r
- ui64Key = emlGetKey(sectorNo, keyType);\r
- \r
- if (!i){\r
- if(mifare_classic_auth(pcs, cuid, sectorNo * 4, keyType, ui64Key, AUTH_FIRST)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Sector[%d]. Auth error", i);\r
- break;\r
- }\r
- } else {\r
- if(mifare_classic_auth(pcs, cuid, sectorNo * 4, keyType, ui64Key, AUTH_NESTED)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Sector[%d]. Auth nested error", i);\r
- break;\r
- }\r
- }\r
+ bool isOK = true;\r
+\r
+ if(!iso14443a_select_card(uid, NULL, &cuid)) {\r
+ isOK = false;\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Can't select card");\r
+ }\r
\r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 0, dataoutbuf)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 0 error");\r
+ for (uint8_t sectorNo = 0; isOK && sectorNo < numSectors; sectorNo++) {\r
+ ui64Key = emlGetKey(sectorNo, keyType);\r
+ if (sectorNo == 0){\r
+ if(isOK && mifare_classic_auth(pcs, cuid, FirstBlockOfSector(sectorNo), keyType, ui64Key, AUTH_FIRST)) {\r
+ isOK = false;\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Sector[%2d]. Auth error", sectorNo);\r
break;\r
- };\r
- emlSetMem(dataoutbuf, sectorNo * 4 + 0, 1);\r
- \r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 1, dataoutbuf)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 1 error");\r
- break;\r
- };\r
- emlSetMem(dataoutbuf, sectorNo * 4 + 1, 1);\r
-\r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 2, dataoutbuf)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 2 error");\r
+ }\r
+ } else {\r
+ if(isOK && mifare_classic_auth(pcs, cuid, FirstBlockOfSector(sectorNo), keyType, ui64Key, AUTH_NESTED)) {\r
+ isOK = false;\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Sector[%2d]. Auth nested error", sectorNo);\r
break;\r
- };\r
- emlSetMem(dataoutbuf, sectorNo * 4 + 2, 1);\r
-\r
- // get block 3 bytes 6-9\r
- if(mifare_classic_readblock(pcs, cuid, sectorNo * 4 + 3, dataoutbuf)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Read block 3 error");\r
+ }\r
+ }\r
+ \r
+ for (uint8_t blockNo = 0; isOK && blockNo < NumBlocksPerSector(sectorNo); blockNo++) {\r
+ if(isOK && mifare_classic_readblock(pcs, cuid, FirstBlockOfSector(sectorNo) + blockNo, dataoutbuf)) {\r
+ isOK = false;\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Error reading sector %2d block %2d", sectorNo, blockNo);\r
break;\r
};\r
- emlGetMem(dataoutbuf2, sectorNo * 4 + 3, 1);\r
- memcpy(&dataoutbuf2[6], &dataoutbuf[6], 4);\r
- emlSetMem(dataoutbuf2, sectorNo * 4 + 3, 1);\r
+ if (isOK) {\r
+ if (blockNo < NumBlocksPerSector(sectorNo) - 1) {\r
+ emlSetMem(dataoutbuf, FirstBlockOfSector(sectorNo) + blockNo, 1);\r
+ } else { // sector trailer, keep the keys, set only the AC\r
+ emlGetMem(dataoutbuf2, FirstBlockOfSector(sectorNo) + blockNo, 1);\r
+ memcpy(&dataoutbuf2[6], &dataoutbuf[6], 4);\r
+ emlSetMem(dataoutbuf2, FirstBlockOfSector(sectorNo) + blockNo, 1);\r
+ }\r
+ }\r
}\r
\r
- if(mifare_classic_halt(pcs, cuid)) {\r
- if (MF_DBGLEVEL >= 1) Dbprintf("Halt error");\r
- break;\r
- };\r
- \r
- break;\r
- } \r
+ }\r
+\r
+ if(mifare_classic_halt(pcs, cuid)) {\r
+ if (MF_DBGLEVEL >= 1) Dbprintf("Halt error");\r
+ };\r
\r
// ----------------------------- crypto1 destroy\r
crypto1_destroy(pcs);\r
\r
if (MF_DBGLEVEL >= 2) DbpString("EMUL FILL SECTORS FINISHED");\r
\r
- // add trace trailer\r
- memset(uid, 0x44, 4);\r
- LogTrace(uid, 4, 0, 0, TRUE);\r
}\r
\r
-//-----------------------------------------------------------------------------\r
-// MIFARE 1k emulator\r
-// \r
-//-----------------------------------------------------------------------------\r
-\r
\r
//-----------------------------------------------------------------------------\r
// Work with "magic Chinese" card (email him: ouyangweidaxian@live.cn)\r
break;\r
}\r
\r
-// UsbCommand ack = {CMD_ACK, {isOK, 0, 0}};\r
-// if (isOK) memcpy(ack.d.asBytes, uid, 4);\r
- \r
- // add trace trailer\r
- /**\r
- * Removed by Martin, the uid is overwritten with 0x44, \r
- * which can 't be intended. \r
- *\r
- * memset(uid, 0x44, 4);\r
- * LogTrace(uid, 4, 0, 0, TRUE);\r
- **/\r
- \r
-\r
LED_B_ON();\r
- cmd_send(CMD_ACK,isOK,0,0,uid,4);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
+ cmd_send(CMD_ACK,isOK,0,0,uid,4);\r
LED_B_OFF();\r
\r
if ((workFlags & 0x10) || (!isOK)) {\r
}\r
}\r
\r
+\r
void MifareCGetBlock(uint32_t arg0, uint32_t arg1, uint32_t arg2, uint8_t *datain){\r
\r
// params\r
break;\r
}\r
\r
-// UsbCommand ack = {CMD_ACK, {isOK, 0, 0}};\r
-// if (isOK) memcpy(ack.d.asBytes, data, 18);\r
- \r
- // add trace trailer\r
- /*\r
- * Removed by Martin, this piece of overwrites the 'data' variable \r
- * which is sent two lines down, and is obviously not correct. \r
- * \r
- * memset(data, 0x44, 4);\r
- * LogTrace(data, 4, 0, 0, TRUE);\r
- */\r
LED_B_ON();\r
- cmd_send(CMD_ACK,isOK,0,0,data,18);\r
-// UsbSendPacket((uint8_t *)&ack, sizeof(UsbCommand));\r
+ cmd_send(CMD_ACK,isOK,0,0,data,18);\r
LED_B_OFF();\r
\r
if ((workFlags & 0x10) || (!isOK)) {\r
PrintAndLog("Block data must include 32 HEX symbols");\r
return 1;\r
}\r
- PrintAndLog("--block no:%02x key type:%02x key:%s", blockNo, keyType, sprint_hex(key, 6));\r
+ PrintAndLog("--block no:%d, key type:%c, key:%s", blockNo, keyType?'B':'A', sprint_hex(key, 6));\r
PrintAndLog("--data: %s", sprint_hex(bldata, 16));\r
\r
UsbCommand c = {CMD_MIFARE_WRITEBL, {blockNo, keyType, 0}};\r
if (!chinese_card){\r
PrintAndLog("Access Denied");\r
}else{\r
- PrintAndLog("--specialblock no:%02x", blockNo);\r
+ PrintAndLog("--specialblock no:%d", blockNo);\r
PrintAndLog("--data: %s", sprint_hex(bldata, 4));\r
UsbCommand d = {CMD_MIFAREU_WRITEBL, {blockNo}};\r
memcpy(d.d.asBytes,bldata, 4);\r
if (!chinese_card){\r
PrintAndLog("Access Denied");\r
}else{\r
- PrintAndLog("--specialblock no:%02x", blockNo);\r
+ PrintAndLog("--specialblock no:%d", blockNo);\r
PrintAndLog("--data: %s", sprint_hex(bldata, 4));\r
UsbCommand d = {CMD_MIFAREU_WRITEBL, {blockNo}};\r
memcpy(d.d.asBytes,bldata, 4);\r
if (!chinese_card){\r
PrintAndLog("Access Denied");\r
}else{\r
- PrintAndLog("--specialblock no:%02x", blockNo);\r
+ PrintAndLog("--specialblock no:%d", blockNo);\r
PrintAndLog("--data: %s", sprint_hex(bldata, 4));\r
UsbCommand c = {CMD_MIFAREU_WRITEBL, {blockNo}};\r
memcpy(c.d.asBytes, bldata, 4);\r
}\r
break;\r
case 3:\r
- PrintAndLog("--specialblock no:%02x", blockNo);\r
+ PrintAndLog("--specialblock no:%d", blockNo);\r
PrintAndLog("--data: %s", sprint_hex(bldata, 4));\r
UsbCommand d = {CMD_MIFAREU_WRITEBL, {blockNo}};\r
memcpy(d.d.asBytes,bldata, 4);\r
}\r
break;\r
default: \r
- PrintAndLog("--block no:%02x", blockNo);\r
+ PrintAndLog("--block no:%d", blockNo);\r
PrintAndLog("--data: %s", sprint_hex(bldata, 4)); \r
UsbCommand e = {CMD_MIFAREU_WRITEBL, {blockNo}};\r
memcpy(e.d.asBytes,bldata, 4);\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfRdBl(const char *Cmd)\r
{\r
uint8_t blockNo = 0;\r
PrintAndLog("Key must include 12 HEX symbols");\r
return 1;\r
}\r
- PrintAndLog("--block no:%02x key type:%02x key:%s ", blockNo, keyType, sprint_hex(key, 6));\r
+ PrintAndLog("--block no:%d, key type:%c, key:%s ", blockNo, keyType?'B':'A', sprint_hex(key, 6));\r
\r
UsbCommand c = {CMD_MIFARE_READBL, {blockNo, keyType, 0}};\r
memcpy(c.d.asBytes, key, 6);\r
\r
UsbCommand resp;\r
if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
- uint8_t isOK = resp.arg[0] & 0xff;\r
- uint8_t * data = resp.d.asBytes;\r
+ uint8_t isOK = resp.arg[0] & 0xff;\r
+ uint8_t *data = resp.d.asBytes;\r
\r
if (isOK)\r
PrintAndLog("isOk:%02x data:%s", isOK, sprint_hex(data, 16));\r
\r
int CmdHF14AMfURdBl(const char *Cmd)\r
{\r
- uint8_t blockNo = 0;\r
+ uint8_t blockNo = 0;\r
\r
- if (strlen(Cmd)<1) {\r
- PrintAndLog("Usage: hf mf urdbl <block number>");\r
- PrintAndLog(" sample: hf mf urdbl 0");\r
- return 0;\r
- } \r
+ if (strlen(Cmd)<1) {\r
+ PrintAndLog("Usage: hf mf urdbl <block number>");\r
+ PrintAndLog(" sample: hf mf urdbl 0");\r
+ return 0;\r
+ } \r
\r
- blockNo = param_get8(Cmd, 0);\r
- PrintAndLog("--block no:%02x", blockNo);\r
+ blockNo = param_get8(Cmd, 0);\r
+ PrintAndLog("--block no:%d", blockNo);\r
\r
- UsbCommand c = {CMD_MIFAREU_READBL, {blockNo}};\r
- SendCommand(&c);\r
-\r
- UsbCommand resp;\r
- if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
- uint8_t isOK = resp.arg[0] & 0xff;\r
- uint8_t * data = resp.d.asBytes;\r
+ UsbCommand c = {CMD_MIFAREU_READBL, {blockNo}};\r
+ SendCommand(&c);\r
\r
- if (isOK)\r
- PrintAndLog("isOk:%02x data:%s", isOK, sprint_hex(data, 4));\r
- else\r
- PrintAndLog("isOk:%02x", isOK);\r
- } else {\r
- PrintAndLog("Command execute timeout");\r
- }\r
+ UsbCommand resp;\r
+ if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
+ uint8_t isOK = resp.arg[0] & 0xff;\r
+ uint8_t *data = resp.d.asBytes;\r
+\r
+ if (isOK)\r
+ PrintAndLog("isOk:%02x data:%s", isOK, sprint_hex(data, 4));\r
+ else\r
+ PrintAndLog("isOk:%02x", isOK);\r
+ } else {\r
+ PrintAndLog("Command execute timeout");\r
+ }\r
\r
- return 0;\r
+ return 0;\r
}\r
\r
+\r
int CmdHF14AMfURdCard(const char *Cmd)\r
{\r
- int i;\r
- uint8_t sectorNo = 0;\r
+ int i;\r
+ uint8_t sectorNo = 0;\r
uint8_t *lockbytes_t=NULL;\r
uint8_t lockbytes[2]={0,0};\r
bool bit[16]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};\r
\r
- uint8_t isOK = 0;\r
- uint8_t * data = NULL;\r
+ uint8_t isOK = 0;\r
+ uint8_t * data = NULL;\r
\r
- if (sectorNo > 15) {\r
- PrintAndLog("Sector number must be less than 16");\r
- return 1;\r
- }\r
- PrintAndLog("Attempting to Read Ultralight... ");\r
+ if (sectorNo > 15) {\r
+ PrintAndLog("Sector number must be less than 16");\r
+ return 1;\r
+ }\r
+ PrintAndLog("Attempting to Read Ultralight... ");\r
\r
UsbCommand c = {CMD_MIFAREU_READCARD, {sectorNo}};\r
SendCommand(&c);\r
\r
- UsbCommand resp;\r
- if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
- isOK = resp.arg[0] & 0xff;\r
- data = resp.d.asBytes;\r
-\r
- PrintAndLog("isOk:%02x", isOK);\r
- if (isOK) \r
- for (i = 0; i < 16; i++) {\r
- switch(i){\r
- case 2:\r
+ UsbCommand resp;\r
+ if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
+ isOK = resp.arg[0] & 0xff;\r
+ data = resp.d.asBytes;\r
+\r
+ PrintAndLog("isOk:%02x", isOK);\r
+ if (isOK) \r
+ for (i = 0; i < 16; i++) {\r
+ switch(i){\r
+ case 2:\r
//process lock bytes\r
lockbytes_t=data+(i*4);\r
lockbytes[0]=lockbytes_t[2];\r
}\r
//PrintAndLog("LB %02x %02x", lockbytes[0],lockbytes[1]);\r
//PrintAndLog("LB2b %02x %02x %02x %02x %02x %02x %02x %02x",bit[8],bit[9],bit[10],bit[11],bit[12],bit[13],bit[14],bit[15]); \r
- PrintAndLog("Block %02x:%s ", i,sprint_hex(data + i * 4, 4));\r
+ PrintAndLog("Block %3d:%s ", i,sprint_hex(data + i * 4, 4));\r
break;\r
- case 3: \r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[4]);\r
+ case 3: \r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[4]);\r
break;\r
- case 4:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[3]);\r
+ case 4:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[3]);\r
break;\r
- case 5:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[2]);\r
+ case 5:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[2]);\r
break;\r
- case 6:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[1]);\r
+ case 6:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[1]);\r
break;\r
- case 7:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[0]);\r
+ case 7:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[0]);\r
break;\r
- case 8:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[15]);\r
+ case 8:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[15]);\r
break;\r
- case 9:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[14]);\r
+ case 9:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[14]);\r
break;\r
- case 10:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[13]);\r
+ case 10:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[13]);\r
break;\r
- case 11:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[12]);\r
+ case 11:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[12]);\r
break;\r
- case 12:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[11]);\r
+ case 12:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[11]);\r
break;\r
- case 13:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[10]);\r
+ case 13:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[10]);\r
break;\r
- case 14:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[9]);\r
+ case 14:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[9]);\r
break;\r
- case 15:\r
- PrintAndLog("Block %02x:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[8]);\r
+ case 15:\r
+ PrintAndLog("Block %3d:%s [%d]", i,sprint_hex(data + i * 4, 4),bit[8]);\r
break;\r
- default:\r
- PrintAndLog("Block %02x:%s ", i,sprint_hex(data + i * 4, 4));\r
+ default:\r
+ PrintAndLog("Block %3d:%s ", i,sprint_hex(data + i * 4, 4));\r
break;\r
}\r
}\r
} else {\r
- PrintAndLog("Command1 execute timeout");\r
+ PrintAndLog("Command execute timeout");\r
}\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfRdSc(const char *Cmd)\r
{\r
int i;\r
uint8_t sectorNo = 0;\r
uint8_t keyType = 0;\r
uint8_t key[6] = {0, 0, 0, 0, 0, 0};\r
- \r
uint8_t isOK = 0;\r
- uint8_t * data = NULL;\r
-\r
+ uint8_t *data = NULL;\r
char cmdp = 0x00;\r
\r
if (strlen(Cmd)<3) {\r
} \r
\r
sectorNo = param_get8(Cmd, 0);\r
- if (sectorNo > 63) {\r
- PrintAndLog("Sector number must be less than 64");\r
+ if (sectorNo > 39) {\r
+ PrintAndLog("Sector number must be less than 40");\r
return 1;\r
}\r
cmdp = param_getchar(Cmd, 1);\r
- if (cmdp == 0x00) {\r
+ if (cmdp != 'a' && cmdp != 'A' && cmdp != 'b' && cmdp != 'B') {\r
PrintAndLog("Key type must be A or B");\r
return 1;\r
}\r
PrintAndLog("Key must include 12 HEX symbols");\r
return 1;\r
}\r
- PrintAndLog("--sector no:%02x key type:%02x key:%s ", sectorNo, keyType, sprint_hex(key, 6));\r
+ PrintAndLog("--sector no:%d key type:%c key:%s ", sectorNo, keyType?'B':'A', sprint_hex(key, 6));\r
\r
- UsbCommand c = {CMD_MIFARE_READSC, {sectorNo, keyType, 0}};\r
+ UsbCommand c = {CMD_MIFARE_READSC, {sectorNo, keyType, 0}};\r
memcpy(c.d.asBytes, key, 6);\r
- SendCommand(&c);\r
+ SendCommand(&c);\r
PrintAndLog(" ");\r
\r
UsbCommand resp;\r
data = resp.d.asBytes;\r
\r
PrintAndLog("isOk:%02x", isOK);\r
- if (isOK) \r
- for (i = 0; i < 2; i++) {\r
- PrintAndLog("data:%s", sprint_hex(data + i * 16, 16));\r
+ if (isOK) {\r
+ for (i = 0; i < (sectorNo<32?3:15); i++) {\r
+ PrintAndLog("data : %s", sprint_hex(data + i * 16, 16));\r
}\r
+ PrintAndLog("trailer: %s", sprint_hex(data + (sectorNo<32?3:15) * 16, 16));\r
+ }\r
} else {\r
- PrintAndLog("Command1 execute timeout");\r
+ PrintAndLog("Command execute timeout");\r
}\r
\r
- // response2\r
- PrintAndLog(" ");\r
- if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
- isOK = resp.arg[0] & 0xff;\r
- data = resp.d.asBytes;\r
+ return 0;\r
+}\r
\r
- if (isOK) \r
- for (i = 0; i < 2; i++) {\r
- PrintAndLog("data:%s", sprint_hex(data + i * 16, 16));\r
- }\r
+\r
+uint8_t FirstBlockOfSector(uint8_t sectorNo)\r
+{\r
+ if (sectorNo < 32) {\r
+ return sectorNo * 4;\r
} else {\r
- PrintAndLog("Command2 execute timeout");\r
+ return 32 * 4 + (sectorNo - 32) * 16;\r
}\r
- \r
- return 0;\r
}\r
\r
+\r
+uint8_t NumBlocksPerSector(uint8_t sectorNo)\r
+{\r
+ if (sectorNo < 32) {\r
+ return 4;\r
+ } else {\r
+ return 16;\r
+ }\r
+}\r
+\r
+\r
int CmdHF14AMfDump(const char *Cmd)\r
{\r
- int i, j;\r
+ uint8_t sectorNo, blockNo;\r
\r
uint8_t keyA[40][6];\r
uint8_t keyB[40][6];\r
uint8_t rights[40][4];\r
+ uint8_t numSectors = 16;\r
\r
FILE *fin;\r
FILE *fout;\r
\r
UsbCommand resp;\r
+\r
+ char cmdp = param_getchar(Cmd, 0);\r
+ switch (cmdp) {\r
+ case '0' : numSectors = 5; break;\r
+ case '1' : \r
+ case '\0': numSectors = 16; break;\r
+ case '2' : numSectors = 32; break;\r
+ case '4' : numSectors = 40; break;\r
+ default: numSectors = 16;\r
+ } \r
+ \r
+ if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {\r
+ PrintAndLog("Usage: hf mf dump [card memory]");\r
+ PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");\r
+ PrintAndLog("");\r
+ PrintAndLog("Samples: hf mf dump");\r
+ PrintAndLog(" hf mf dump 4");\r
+ return 0;\r
+ }\r
\r
if ((fin = fopen("dumpkeys.bin","rb")) == NULL) {\r
PrintAndLog("Could not find file dumpkeys.bin");\r
}\r
\r
// Read key file\r
- \r
- for (i=0 ; i<16 ; i++) {\r
- if (fread( keyA[i], 1, 6, fin ) == 0) {\r
- PrintAndLog("File reading error.");\r
+\r
+ for (sectorNo=0; sectorNo<numSectors; sectorNo++) {\r
+ if (fread( keyA[sectorNo], 1, 6, fin ) == 0) {\r
+ PrintAndLog("File reading error.");\r
return 2;\r
- }\r
+ }\r
}\r
- for (i=0 ; i<16 ; i++) {\r
- if (fread( keyB[i], 1, 6, fin ) == 0) {\r
- PrintAndLog("File reading error.");\r
+ \r
+ for (sectorNo=0; sectorNo<numSectors; sectorNo++) {\r
+ if (fread( keyB[sectorNo], 1, 6, fin ) == 0) {\r
+ PrintAndLog("File reading error.");\r
return 2;\r
- }\r
+ }\r
}\r
\r
// Read access rights to sectors\r
- \r
+\r
PrintAndLog("|-----------------------------------------|");\r
PrintAndLog("|------ Reading sector access bits...-----|");\r
PrintAndLog("|-----------------------------------------|");\r
\r
- for (i = 0 ; i < 16 ; i++) {\r
- UsbCommand c = {CMD_MIFARE_READBL, {4*i + 3, 0, 0}};\r
- memcpy(c.d.asBytes, keyA[i], 6);\r
+ for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {\r
+ UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 0, 0}};\r
+ memcpy(c.d.asBytes, keyA[sectorNo], 6);\r
SendCommand(&c);\r
\r
- if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
+ if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
uint8_t isOK = resp.arg[0] & 0xff;\r
uint8_t *data = resp.d.asBytes;\r
if (isOK){\r
- rights[i][0] = ((data[7] & 0x10)>>4) | ((data[8] & 0x1)<<1) | ((data[8] & 0x10)>>2);\r
- rights[i][1] = ((data[7] & 0x20)>>5) | ((data[8] & 0x2)<<0) | ((data[8] & 0x20)>>3);\r
- rights[i][2] = ((data[7] & 0x40)>>6) | ((data[8] & 0x4)>>1) | ((data[8] & 0x40)>>4);\r
- rights[i][3] = ((data[7] & 0x80)>>7) | ((data[8] & 0x8)>>2) | ((data[8] & 0x80)>>5);\r
- }\r
- else{\r
- PrintAndLog("Could not get access rights for block %d", i);\r
+ rights[sectorNo][0] = ((data[7] & 0x10)>>4) | ((data[8] & 0x1)<<1) | ((data[8] & 0x10)>>2);\r
+ rights[sectorNo][1] = ((data[7] & 0x20)>>5) | ((data[8] & 0x2)<<0) | ((data[8] & 0x20)>>3);\r
+ rights[sectorNo][2] = ((data[7] & 0x40)>>6) | ((data[8] & 0x4)>>1) | ((data[8] & 0x40)>>4);\r
+ rights[sectorNo][3] = ((data[7] & 0x80)>>7) | ((data[8] & 0x8)>>2) | ((data[8] & 0x80)>>5);\r
+ } else {\r
+ PrintAndLog("Could not get access rights for sector %2d.", sectorNo);\r
}\r
- }\r
- else {\r
+ } else {\r
PrintAndLog("Command execute timeout");\r
}\r
}\r
PrintAndLog("|-----------------------------------------|");\r
\r
\r
- for (i=0 ; i<16 ; i++) {\r
- for (j=0 ; j<4 ; j++) {\r
- bool received = false;\r
- \r
- if (j == 3){\r
- UsbCommand c = {CMD_MIFARE_READBL, {i*4 + j, 0, 0}};\r
- memcpy(c.d.asBytes, keyA[i], 6);\r
+ for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {\r
+ for (blockNo = 0; blockNo < NumBlocksPerSector(sectorNo); blockNo++) {\r
+ bool received = false;\r
+ if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer. At least the Access Conditions can always be read with key A. \r
+ UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 0, 0}};\r
+ memcpy(c.d.asBytes, keyA[sectorNo], 6);\r
SendCommand(&c);\r
- received = WaitForResponseTimeout(CMD_ACK,&resp,1500);\r
- }\r
- else{\r
- if ((rights[i][j] == 6) | (rights[i][j] == 5)) {\r
- UsbCommand c = {CMD_MIFARE_READBL, {i*4+j, 1, 0}};\r
- memcpy(c.d.asBytes, keyB[i], 6);\r
+ received = WaitForResponseTimeout(CMD_ACK,&resp,1500);\r
+ } else { // data block. Check if it can be read with key A or key B\r
+ uint8_t data_area = sectorNo<32?blockNo:blockNo/5;\r
+ if ((rights[sectorNo][data_area] == 3) || (rights[sectorNo][data_area] == 5)) { // only key B would work\r
+ UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 1, 0}};\r
+ memcpy(c.d.asBytes, keyB[sectorNo], 6);\r
SendCommand(&c);\r
- received = WaitForResponseTimeout(CMD_ACK,&resp,1500);\r
- }\r
- else if (rights[i][j] == 7) {\r
- PrintAndLog("Access rights do not allow reading of sector %d block %d",i,j);\r
- }\r
- else {\r
- UsbCommand c = {CMD_MIFARE_READBL, {i*4+j, 0, 0}};\r
- memcpy(c.d.asBytes, keyA[i], 6);\r
- SendCommand(&c);\r
- received = WaitForResponseTimeout(CMD_ACK,&resp,1500);\r
+ received = WaitForResponseTimeout(CMD_ACK,&resp,1500);\r
+ } else if (rights[sectorNo][data_area] == 7) { // no key would work\r
+ PrintAndLog("Access rights do not allow reading of sector %2d block %3d", sectorNo, blockNo);\r
+ } else { // key A would work\r
+ UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 0, 0}};\r
+ memcpy(c.d.asBytes, keyA[sectorNo], 6);\r
+ SendCommand(&c);\r
+ received = WaitForResponseTimeout(CMD_ACK,&resp,1500);\r
}\r
}\r
\r
if (received) {\r
uint8_t isOK = resp.arg[0] & 0xff;\r
uint8_t *data = resp.d.asBytes;\r
- if (j == 3) {\r
- data[0] = (keyA[i][0]);\r
- data[1] = (keyA[i][1]);\r
- data[2] = (keyA[i][2]);\r
- data[3] = (keyA[i][3]);\r
- data[4] = (keyA[i][4]);\r
- data[5] = (keyA[i][5]);\r
- data[10] = (keyB[i][0]);\r
- data[11] = (keyB[i][1]);\r
- data[12] = (keyB[i][2]);\r
- data[13] = (keyB[i][3]);\r
- data[14] = (keyB[i][4]);\r
- data[15] = (keyB[i][5]);\r
+ if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer. Fill in the keys.\r
+ data[0] = (keyA[sectorNo][0]);\r
+ data[1] = (keyA[sectorNo][1]);\r
+ data[2] = (keyA[sectorNo][2]);\r
+ data[3] = (keyA[sectorNo][3]);\r
+ data[4] = (keyA[sectorNo][4]);\r
+ data[5] = (keyA[sectorNo][5]);\r
+ data[10] = (keyB[sectorNo][0]);\r
+ data[11] = (keyB[sectorNo][1]);\r
+ data[12] = (keyB[sectorNo][2]);\r
+ data[13] = (keyB[sectorNo][3]);\r
+ data[14] = (keyB[sectorNo][4]);\r
+ data[15] = (keyB[sectorNo][5]);\r
}\r
if (isOK) {\r
fwrite ( data, 1, 16, fout );\r
- PrintAndLog("Dumped card data into 'dumpdata.bin'");\r
-\r
- }\r
- else {\r
- PrintAndLog("Could not get access rights for block %d", i);\r
+ PrintAndLog("Dumped block %2d of sector %2d into 'dumpdata.bin'");\r
+ } else {\r
+ PrintAndLog("Could not read block %2d of sector %2d", blockNo, sectorNo);\r
}\r
}\r
else {\r
PrintAndLog("Command execute timeout");\r
}\r
}\r
+\r
}\r
\r
fclose(fin);\r
fclose(fout);\r
- return 0;\r
+ return 0;\r
}\r
\r
+\r
int CmdHF14AMfRestore(const char *Cmd)\r
{\r
\r
- int i,j;\r
+ uint8_t sectorNo,blockNo;\r
uint8_t keyType = 0;\r
uint8_t key[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};\r
uint8_t bldata[16] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};\r
- uint8_t keyA[16][6];\r
- uint8_t keyB[16][6];\r
+ uint8_t keyA[40][6];\r
+ uint8_t keyB[40][6];\r
+ uint8_t numSectors;\r
\r
FILE *fdump;\r
FILE *fkeys;\r
- \r
+\r
+ char cmdp = param_getchar(Cmd, 0);\r
+ switch (cmdp) {\r
+ case '0' : numSectors = 5; break;\r
+ case '1' : \r
+ case '\0': numSectors = 16; break;\r
+ case '2' : numSectors = 32; break;\r
+ case '4' : numSectors = 40; break;\r
+ default: numSectors = 16;\r
+ } \r
+\r
+ if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {\r
+ PrintAndLog("Usage: hf mf restore [card memory]");\r
+ PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");\r
+ PrintAndLog("");\r
+ PrintAndLog("Samples: hf mf restore");\r
+ PrintAndLog(" hf mf restore 4");\r
+ return 0;\r
+ }\r
+\r
if ((fdump = fopen("dumpdata.bin","rb")) == NULL) {\r
PrintAndLog("Could not find file dumpdata.bin");\r
return 1;\r
return 1;\r
}\r
\r
- for (i=0 ; i<16 ; i++) {\r
- if (fread(keyA[i], 1, 6, fkeys) == 0) {\r
- PrintAndLog("File reading error.");\r
+ for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {\r
+ if (fread(keyA[sectorNo], 1, 6, fkeys) == 0) {\r
+ PrintAndLog("File reading error (dumpkeys.bin).");\r
return 2;\r
- }\r
+ }\r
}\r
- for (i=0 ; i<16 ; i++) {\r
- if (fread(keyB[i], 1, 6, fkeys) == 0) {\r
- PrintAndLog("File reading error.");\r
+\r
+ for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {\r
+ if (fread(keyB[sectorNo], 1, 6, fkeys) == 0) {\r
+ PrintAndLog("File reading error (dumpkeys.bin).");\r
return 2;\r
- }\r
+ }\r
}\r
\r
PrintAndLog("Restoring dumpdata.bin to card");\r
\r
- for (i=0 ; i<16 ; i++) {\r
- for( j=0 ; j<4 ; j++) {\r
- UsbCommand c = {CMD_MIFARE_WRITEBL, {i*4 + j, keyType, 0}};\r
+ for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {\r
+ for(blockNo = 0; blockNo < NumBlocksPerSector(sectorNo); blockNo++) {\r
+ UsbCommand c = {CMD_MIFARE_WRITEBL, {FirstBlockOfSector(sectorNo) + blockNo, keyType, 0}};\r
memcpy(c.d.asBytes, key, 6);\r
\r
if (fread(bldata, 1, 16, fdump) == 0) {\r
- PrintAndLog("File reading error.");\r
- return 2;\r
- }\r
+ PrintAndLog("File reading error (dumpdata.bin).");\r
+ return 2;\r
+ }\r
\r
- if (j == 3) {\r
- bldata[0] = (keyA[i][0]);\r
- bldata[1] = (keyA[i][1]);\r
- bldata[2] = (keyA[i][2]);\r
- bldata[3] = (keyA[i][3]);\r
- bldata[4] = (keyA[i][4]);\r
- bldata[5] = (keyA[i][5]);\r
- bldata[10] = (keyB[i][0]);\r
- bldata[11] = (keyB[i][1]);\r
- bldata[12] = (keyB[i][2]);\r
- bldata[13] = (keyB[i][3]);\r
- bldata[14] = (keyB[i][4]);\r
- bldata[15] = (keyB[i][5]);\r
+ if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer\r
+ bldata[0] = (keyA[sectorNo][0]);\r
+ bldata[1] = (keyA[sectorNo][1]);\r
+ bldata[2] = (keyA[sectorNo][2]);\r
+ bldata[3] = (keyA[sectorNo][3]);\r
+ bldata[4] = (keyA[sectorNo][4]);\r
+ bldata[5] = (keyA[sectorNo][5]);\r
+ bldata[10] = (keyB[sectorNo][0]);\r
+ bldata[11] = (keyB[sectorNo][1]);\r
+ bldata[12] = (keyB[sectorNo][2]);\r
+ bldata[13] = (keyB[sectorNo][3]);\r
+ bldata[14] = (keyB[sectorNo][4]);\r
+ bldata[15] = (keyB[sectorNo][5]);\r
} \r
\r
- PrintAndLog("Writing to block %2d: %s", i*4+j, sprint_hex(bldata, 16));\r
- \r
- /*\r
- PrintAndLog("Writing to block %2d: %s Confirm? [Y,N]", i*4+j, sprint_hex(bldata, 16));\r
- \r
- scanf("%c",&ch);\r
- if ((ch != 'y') && (ch != 'Y')){\r
- PrintAndLog("Aborting !");\r
- return 1;\r
- }\r
- */\r
+ PrintAndLog("Writing to block %3d: %s", FirstBlockOfSector(sectorNo) + blockNo, sprint_hex(bldata, 16));\r
\r
memcpy(c.d.asBytes + 10, bldata, 16);\r
SendCommand(&c);\r
\r
UsbCommand resp;\r
- if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
+ if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
uint8_t isOK = resp.arg[0] & 0xff;\r
PrintAndLog("isOk:%02x", isOK);\r
} else {\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfNested(const char *Cmd)\r
{\r
int i, j, res, iterations;\r
- sector * e_sector = NULL;\r
+ sector *e_sector = NULL;\r
uint8_t blockNo = 0;\r
uint8_t keyType = 0;\r
uint8_t trgBlockNo = 0;\r
uint8_t trgKeyType = 0;\r
- uint8_t blDiff = 0;\r
- int SectorsCnt = 0;\r
+ uint8_t SectorsCnt = 0;\r
uint8_t key[6] = {0, 0, 0, 0, 0, 0};\r
uint8_t keyBlock[6*6];\r
uint64_t key64 = 0;\r
- int transferToEml = 0;\r
+ bool transferToEml = false;\r
\r
- int createDumpFile = 0;\r
+ bool createDumpFile = false;\r
FILE *fkeys;\r
uint8_t standart[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};\r
uint8_t tempkey[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};\r
cmdp = param_getchar(Cmd, 0);\r
blockNo = param_get8(Cmd, 1);\r
ctmp = param_getchar(Cmd, 2);\r
- if (ctmp == 0x00) {\r
+ if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {\r
PrintAndLog("Key type must be A or B");\r
return 1;\r
}\r
cmdp = 'o';\r
trgBlockNo = param_get8(Cmd, 4);\r
ctmp = param_getchar(Cmd, 5);\r
- if (ctmp == 0x00) {\r
+ if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {\r
PrintAndLog("Target key type must be A or B");\r
return 1;\r
}\r
case '0': SectorsCnt = 05; break;\r
case '1': SectorsCnt = 16; break;\r
case '2': SectorsCnt = 32; break;\r
- case '4': SectorsCnt = 64; break;\r
+ case '4': SectorsCnt = 40; break;\r
default: SectorsCnt = 16;\r
}\r
}\r
\r
ctmp = param_getchar(Cmd, 4);\r
- if (ctmp == 't' || ctmp == 'T') transferToEml = 1;\r
- else if (ctmp == 'd' || ctmp == 'D') createDumpFile = 1;\r
+ if (ctmp == 't' || ctmp == 'T') transferToEml = true;\r
+ else if (ctmp == 'd' || ctmp == 'D') createDumpFile = true;\r
\r
ctmp = param_getchar(Cmd, 6);\r
transferToEml |= (ctmp == 't' || ctmp == 'T');\r
transferToEml |= (ctmp == 'd' || ctmp == 'D');\r
\r
- PrintAndLog("--block no:%02x key type:%02x key:%s etrans:%d", blockNo, keyType, sprint_hex(key, 6), transferToEml);\r
- if (cmdp == 'o')\r
- PrintAndLog("--target block no:%02x target key type:%02x ", trgBlockNo, trgKeyType);\r
-\r
if (cmdp == 'o') {\r
+ PrintAndLog("--target block no:%3d, target key type:%c ", trgBlockNo, trgKeyType?'B':'A');\r
if (mfnested(blockNo, keyType, key, trgBlockNo, trgKeyType, keyBlock, true)) {\r
PrintAndLog("Nested error.");\r
return 2;\r
\r
// transfer key to the emulator\r
if (transferToEml) {\r
- mfEmlGetMem(keyBlock, (trgBlockNo / 4) * 4 + 3, 1);\r
+ uint8_t sectortrailer;\r
+ if (trgBlockNo < 32*4) { // 4 block sector\r
+ sectortrailer = (trgBlockNo & 0x03) + 3;\r
+ } else { // 16 block sector\r
+ sectortrailer = (trgBlockNo & 0x0f) + 15;\r
+ }\r
+ mfEmlGetMem(keyBlock, sectortrailer, 1);\r
\r
if (!trgKeyType)\r
num_to_bytes(key64, 6, keyBlock);\r
else\r
num_to_bytes(key64, 6, &keyBlock[10]);\r
- mfEmlSetMem(keyBlock, (trgBlockNo / 4) * 4 + 3, 1); \r
+ mfEmlSetMem(keyBlock, sectortrailer, 1); \r
}\r
} else {\r
PrintAndLog("No valid key found");\r
clock_t time1;\r
time1 = clock();\r
\r
- blDiff = blockNo % 4;\r
- PrintAndLog("Block shift=%d", blDiff);\r
e_sector = calloc(SectorsCnt, sizeof(sector));\r
if (e_sector == NULL) return 1;\r
\r
- //test current key 4 sectors\r
+ //test current key and additional standard keys first\r
memcpy(keyBlock, key, 6);\r
num_to_bytes(0xffffffffffff, 6, (uint8_t*)(keyBlock + 1 * 6));\r
num_to_bytes(0x000000000000, 6, (uint8_t*)(keyBlock + 2 * 6));\r
for (j = 0; j < 2; j++) {\r
if (e_sector[i].foundKey[j]) continue;\r
\r
- res = mfCheckKeys(i * 4 + blDiff, j, 6, keyBlock, &key64);\r
+ res = mfCheckKeys(FirstBlockOfSector(i), j, 6, keyBlock, &key64);\r
\r
if (!res) {\r
e_sector[i].Key[j] = key64;\r
PrintAndLog("nested...");\r
bool calibrate = true;\r
for (i = 0; i < NESTED_SECTOR_RETRY; i++) {\r
- for (trgBlockNo = blDiff; trgBlockNo < SectorsCnt * 4; trgBlockNo = trgBlockNo + 4) {\r
+ for (uint8_t sectorNo = 0; sectorNo < SectorsCnt; sectorNo++) {\r
for (trgKeyType = 0; trgKeyType < 2; trgKeyType++) { \r
- if (e_sector[trgBlockNo / 4].foundKey[trgKeyType]) continue;\r
+ if (e_sector[sectorNo].foundKey[trgKeyType]) continue;\r
PrintAndLog("-----------------------------------------------");\r
- if(mfnested(blockNo, keyType, key, trgBlockNo, trgKeyType, keyBlock, calibrate)) {\r
+ if(mfnested(blockNo, keyType, key, FirstBlockOfSector(sectorNo), trgKeyType, keyBlock, calibrate)) {\r
PrintAndLog("Nested error.\n");\r
return 2;\r
}\r
key64 = bytes_to_num(keyBlock, 6);\r
if (key64) {\r
PrintAndLog("Found valid key:%012"llx, key64);\r
- e_sector[trgBlockNo / 4].foundKey[trgKeyType] = 1;\r
- e_sector[trgBlockNo / 4].Key[trgKeyType] = key64;\r
+ e_sector[sectorNo].foundKey[trgKeyType] = 1;\r
+ e_sector[sectorNo].Key[trgKeyType] = key64;\r
}\r
}\r
}\r
// transfer them to the emulator\r
if (transferToEml) {\r
for (i = 0; i < SectorsCnt; i++) {\r
- mfEmlGetMem(keyBlock, i * 4 + 3, 1);\r
+ mfEmlGetMem(keyBlock, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);\r
if (e_sector[i].foundKey[0])\r
num_to_bytes(e_sector[i].Key[0], 6, keyBlock);\r
if (e_sector[i].foundKey[1])\r
num_to_bytes(e_sector[i].Key[1], 6, &keyBlock[10]);\r
- mfEmlSetMem(keyBlock, i * 4 + 3, 1);\r
+ mfEmlSetMem(keyBlock, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);\r
} \r
}\r
\r
free(e_sector);\r
return 1;\r
}\r
- PrintAndLog("Printing keys to bynary file dumpkeys.bin...");\r
- for(i=0; i<16; i++) {\r
+ PrintAndLog("Printing keys to binary file dumpkeys.bin...");\r
+ for(i=0; i<SectorsCnt; i++) {\r
if (e_sector[i].foundKey[0]){\r
num_to_bytes(e_sector[i].Key[0], 6, tempkey);\r
fwrite ( tempkey, 1, 6, fkeys );\r
fwrite ( &standart, 1, 6, fkeys );\r
}\r
}\r
- for(i=0; i<16; i++) {\r
+ for(i=0; i<SectorsCnt; i++) {\r
if (e_sector[i].foundKey[1]){\r
num_to_bytes(e_sector[i].Key[1], 6, tempkey);\r
fwrite ( tempkey, 1, 6, fkeys );\r
return 0;\r
}\r
\r
-static uint32_t\r
-get_trailer_block (uint32_t uiBlock)\r
+\r
+static uint32_t get_trailer_block (uint32_t uiBlock)\r
{\r
// Test if we are in the small or big sectors\r
uint32_t trailer_block = 0;\r
}\r
return trailer_block;\r
}\r
+\r
+\r
int CmdHF14AMfChk(const char *Cmd)\r
{\r
FILE * f;\r
0x533cb6c723f6,\r
0x8fd0a4f256e9\r
};\r
- int defaultKeysSize = (sizeof(defaultKeys) / 7) - 1;\r
+ int defaultKeysSize = sizeof(defaultKeys) / sizeof(uint64_t);\r
\r
for (int defaultKeyCounter = 0; defaultKeyCounter < defaultKeysSize; defaultKeyCounter++)\r
{\r
}\r
\r
if (strlen(Cmd)<3) {\r
- PrintAndLog("Usage: hf mf chk <block number>/<*card memory> <key type (A/B/?)> [t] [<key (12 hex symbols)>] [<dic (*.dic)>]");\r
+ PrintAndLog("Usage: hf mf chk <block number>|<*card memory> <key type (A/B/?)> [t] [<key (12 hex symbols)>] [<dic (*.dic)>]");\r
PrintAndLog(" * - all sectors");\r
PrintAndLog("card memory - 0 - MINI(320 bytes), 1 - 1K, 2 - 2K, 4 - 4K, <other> - 1K");\r
// PrintAndLog("d - write keys to binary file\n");\r
}\r
keyBlock = p;\r
}\r
- PrintAndLog("chk key[%d] %02x%02x%02x%02x%02x%02x", keycnt,\r
+ PrintAndLog("chk 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
}\r
memset(keyBlock + 6 * keycnt, 0, 6);\r
num_to_bytes(strtoll(buf, NULL, 16), 6, keyBlock + 6*keycnt);\r
- PrintAndLog("chk custom key[%d] %012"llx, keycnt, bytes_to_num(keyBlock + 6*keycnt, 6));\r
+ PrintAndLog("chk custom key[%2d] %012"llx, keycnt, bytes_to_num(keyBlock + 6*keycnt, 6));\r
keycnt++;\r
memset(buf, 0, sizeof(buf));\r
}\r
}\r
\r
if (keycnt == 0) {\r
- PrintAndLog("No key specified,try default keys");\r
+ PrintAndLog("No key specified, trying default keys");\r
for (;keycnt < defaultKeysSize; keycnt++)\r
- PrintAndLog("chk default key[%d] %02x%02x%02x%02x%02x%02x", keycnt,\r
+ PrintAndLog("chk default 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
- for ( int t = !keyType ; t < 2 ; keyType==2?(t++):(t=2) ) {\r
+ for ( int t = !keyType; t < 2; keyType==2?(t++):(t=2) ) {\r
int b=blockNo;\r
- for (int i=0; i<SectorsCnt; ++i) {\r
- PrintAndLog("--SectorsCnt:%d block no:0x%02x key type:%C key count:%d ", i, b, t?'B':'A', keycnt);\r
+ for (int i = 0; i < SectorsCnt; ++i) {\r
+ PrintAndLog("--SectorsCnt:%2d, block no:%3d, key type:%C, key count:%2d ", i, b, t?'B':'A', keycnt);\r
uint32_t max_keys = keycnt>USB_CMD_DATA_SIZE/6?USB_CMD_DATA_SIZE/6:keycnt;\r
for (uint32_t c = 0; c < keycnt; c+=max_keys) {\r
uint32_t size = keycnt-c>max_keys?max_keys:keycnt-c;\r
res = mfCheckKeys(b, t, size, &keyBlock[6*c], &key64);\r
- if (res !=1) {\r
+ if (res != 1) {\r
if (!res) {\r
PrintAndLog("Found valid key:[%012"llx"]",key64);\r
if (transferToEml) {\r
free(e_sector);\r
return 1;\r
}\r
- PrintAndLog("Printing keys to bynary file dumpkeys.bin...");\r
+ PrintAndLog("Printing keys to binary file dumpkeys.bin...");\r
for(i=0; i<16; i++) {\r
if (e_sector[i].foundKey[0]){\r
num_to_bytes(e_sector[i].Key[0], 6, tempkey);\r
if (param_getchar(Cmd, pnr) == 'u') {\r
if(param_gethex(Cmd, pnr+1, uid, 8) == 0)\r
{\r
- flags |=FLAG_4B_UID_IN_DATA; // UID from packet\r
- }else if(param_gethex(Cmd,pnr+1,uid,14) == 0)\r
- {\r
+ flags |= FLAG_4B_UID_IN_DATA; // UID from packet\r
+ } else if(param_gethex(Cmd,pnr+1,uid,14) == 0) {\r
flags |= FLAG_7B_UID_IN_DATA;// UID from packet\r
- }else\r
- {\r
- PrintAndLog("UID, if specified, must include 8 or 14 HEX symbols");\r
- return 1;\r
+ } else {\r
+ PrintAndLog("UID, if specified, must include 8 or 14 HEX symbols");\r
+ return 1;\r
}\r
pnr +=2;\r
}\r
, exitAfterNReads, flags,flags);\r
\r
\r
- UsbCommand c = {CMD_SIMULATE_MIFARE_CARD, {flags, exitAfterNReads,0}};\r
- memcpy(c.d.asBytes, uid, sizeof(uid));\r
- SendCommand(&c);\r
-\r
- if(flags & FLAG_INTERACTIVE)\r
- {\r
- UsbCommand resp;\r
- PrintAndLog("Press pm3-button to abort simulation");\r
- while(! WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
- //We're waiting only 1.5 s at a time, otherwise we get the\r
- // annoying message about "Waiting for a response... "\r
- }\r
- }\r
+ UsbCommand c = {CMD_SIMULATE_MIFARE_CARD, {flags, exitAfterNReads,0}};\r
+ memcpy(c.d.asBytes, uid, sizeof(uid));\r
+ SendCommand(&c);\r
\r
- return 0;\r
+ if(flags & FLAG_INTERACTIVE)\r
+ {\r
+ UsbCommand resp;\r
+ PrintAndLog("Press pm3-button to abort simulation");\r
+ while(! WaitForResponseTimeout(CMD_ACK,&resp,1500)) {\r
+ //We're waiting only 1.5 s at a time, otherwise we get the\r
+ // annoying message about "Waiting for a response... "\r
+ }\r
+ }\r
+ \r
+ return 0;\r
}\r
\r
+\r
int CmdHF14AMfDbg(const char *Cmd)\r
{\r
int dbgMode = param_get32ex(Cmd, 0, 0, 10);\r
if (dbgMode > 4) {\r
- PrintAndLog("Max debud mode parameter is 4 \n");\r
+ PrintAndLog("Max debug mode parameter is 4 \n");\r
}\r
\r
if (strlen(Cmd) < 1 || !param_getchar(Cmd, 0) || dbgMode > 4) {\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfEGet(const char *Cmd)\r
{\r
uint8_t blockNo = 0;\r
- uint8_t data[3 * 16];\r
- int i;\r
+ uint8_t data[16];\r
\r
if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {\r
PrintAndLog("Usage: hf mf eget <block number>");\r
blockNo = param_get8(Cmd, 0);\r
\r
PrintAndLog(" ");\r
- if (!mfEmlGetMem(data, blockNo, 3)) {\r
- for (i = 0; i < 3; i++) {\r
- PrintAndLog("data[%d]:%s", blockNo + i, sprint_hex(data + i * 16, 16));\r
- }\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
return 0;\r
}\r
\r
+\r
int CmdHF14AMfEClear(const char *Cmd)\r
{\r
if (param_getchar(Cmd, 0) == 'h') {\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfESet(const char *Cmd)\r
{\r
uint8_t memBlock[16];\r
}\r
\r
// 1 - blocks count\r
- UsbCommand c = {CMD_MIFARE_EML_MEMSET, {blockNo, 1, 0}};\r
+ UsbCommand c = {CMD_MIFARE_EML_MEMSET, {blockNo, 1, 0}};\r
memcpy(c.d.asBytes, memBlock, 16);\r
- SendCommand(&c);\r
- return 0;\r
+ SendCommand(&c);\r
+ return 0;\r
}\r
\r
+\r
int CmdHF14AMfELoad(const char *Cmd)\r
{\r
FILE * f;\r
char filename[20];\r
- char * fnameptr = filename;\r
+ char *fnameptr = filename;\r
char buf[64];\r
uint8_t buf8[64];\r
int i, len, blockNum;\r
while(!feof(f)){\r
memset(buf, 0, sizeof(buf));\r
if (fgets(buf, sizeof(buf), f) == NULL) {\r
- if(blockNum == 16 * 4)\r
- {\r
+ if((blockNum == 16*4) || (blockNum == 32*4 + 8*16)) { // supports both old (1K) and new (4K) .eml files)\r
break;\r
}\r
PrintAndLog("File reading error.");\r
return 2;\r
- }\r
-\r
+ }\r
if (strlen(buf) < 32){\r
if(strlen(buf) && feof(f))\r
break;\r
PrintAndLog("File content error. Block data must include 32 HEX symbols");\r
return 2;\r
}\r
- for (i = 0; i < 32; i += 2)\r
- sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);\r
+ for (i = 0; i < 32; i += 2) {\r
+ sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);\r
// PrintAndLog("data[%02d]:%s", blockNum, sprint_hex(buf8, 16));\r
-\r
+ }\r
if (mfEmlSetMem(buf8, blockNum, 1)) {\r
- PrintAndLog("Cant set emul block: %d", blockNum);\r
+ PrintAndLog("Cant set emul block: %3d", blockNum);\r
return 3;\r
}\r
blockNum++;\r
\r
- if (blockNum >= 32 * 4 + 8 * 16) break;\r
+ if (blockNum >= 32*4 + 8*16) break;\r
}\r
fclose(f);\r
\r
- if (blockNum != 16 * 4 && blockNum != 32 * 4 + 8 * 16){\r
- PrintAndLog("File content error. There must be 64 blocks");\r
+ if ((blockNum != 16*4) && (blockNum != 32*4 + 8*16)) {\r
+ PrintAndLog("File content error. There must be 64 or 256 blocks.");\r
return 4;\r
}\r
PrintAndLog("Loaded %d blocks from file: %s", blockNum, filename);\r
- return 0;\r
+ return 0;\r
}\r
\r
+\r
int CmdHF14AMfESave(const char *Cmd)\r
{\r
FILE * f;\r
f = fopen(filename, "w+");\r
\r
// put hex\r
- for (i = 0; i < 32 * 4 + 8 * 16; i++) {\r
+ for (i = 0; i < 32*4 + 8*16; i++) {\r
if (mfEmlGetMem(buf, i, 1)) {\r
PrintAndLog("Cant get block: %d", i);\r
break;\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfECFill(const char *Cmd)\r
{\r
uint8_t keyType = 0;\r
-\r
+ uint8_t numSectors = 16;\r
+ \r
if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {\r
- PrintAndLog("Usage: hf mf ecfill <key A/B>");\r
- PrintAndLog("sample: hf mf ecfill A");\r
- PrintAndLog("Card data blocks transfers to card emulator memory.");\r
- PrintAndLog("Keys must be laid in the simulator memory. \n");\r
+ PrintAndLog("Usage: hf mf ecfill <key A/B> [card memory]");\r
+ PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");\r
+ PrintAndLog("");\r
+ PrintAndLog("samples: hf mf ecfill A");\r
+ PrintAndLog(" hf mf ecfill A 4");\r
+ PrintAndLog("Read card and transfer its data to emulator memory.");\r
+ PrintAndLog("Keys must be laid in the emulator memory. \n");\r
return 0;\r
} \r
\r
char ctmp = param_getchar(Cmd, 0);\r
- if (ctmp == 0x00) {\r
+ if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {\r
PrintAndLog("Key type must be A or B");\r
return 1;\r
}\r
if (ctmp != 'A' && ctmp != 'a') keyType = 1;\r
\r
- UsbCommand c = {CMD_MIFARE_EML_CARDLOAD, {0, keyType, 0}};\r
- SendCommand(&c);\r
- return 0;\r
+ ctmp = param_getchar(Cmd, 1);\r
+ switch (ctmp) {\r
+ case '0' : numSectors = 5; break;\r
+ case '1' : \r
+ case '\0': numSectors = 16; break;\r
+ case '2' : numSectors = 32; break;\r
+ case '4' : numSectors = 40; break;\r
+ default: numSectors = 16;\r
+ } \r
+\r
+ printf("--params: numSectors: %d, keyType:%d", numSectors, keyType);\r
+ UsbCommand c = {CMD_MIFARE_EML_CARDLOAD, {numSectors, keyType, 0}};\r
+ SendCommand(&c);\r
+ return 0;\r
}\r
\r
+\r
int CmdHF14AMfEKeyPrn(const char *Cmd)\r
{\r
- int i,b=-1;\r
+ int i;\r
uint8_t data[16];\r
uint64_t keyA, keyB;\r
\r
PrintAndLog("|sec|key A |key B |");\r
PrintAndLog("|---|----------------|----------------|");\r
for (i = 0; i < 40; i++) {\r
- b<127?(b+=4):(b+=16);\r
- if (mfEmlGetMem(data, b, 1)) {\r
- PrintAndLog("error get block %d", b);\r
+ if (mfEmlGetMem(data, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1)) {\r
+ PrintAndLog("error get block %d", FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1);\r
break;\r
}\r
keyA = bytes_to_num(data, 6);\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfCSetUID(const char *Cmd)\r
{\r
uint8_t wipeCard = 0;\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfCSetBlk(const char *Cmd)\r
{\r
uint8_t uid[8];\r
return 1;\r
}\r
\r
- PrintAndLog("--block number:%02x data:%s", blockNo, sprint_hex(memBlock, 16));\r
+ PrintAndLog("--block number:%2d data:%s", blockNo, sprint_hex(memBlock, 16));\r
\r
res = mfCSetBlock(blockNo, memBlock, uid, 0, CSETBLOCK_SINGLE_OPER);\r
if (res) {\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfCLoad(const char *Cmd)\r
{\r
FILE * f;\r
while(!feof(f)){\r
memset(buf, 0, sizeof(buf));\r
if (fgets(buf, sizeof(buf), f) == NULL) {\r
- PrintAndLog("File reading error.");\r
- return 2;\r
- }\r
+ PrintAndLog("File reading error.");\r
+ return 2;\r
+ }\r
\r
if (strlen(buf) < 32){\r
if(strlen(buf) && feof(f))\r
if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;\r
\r
if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {\r
- PrintAndLog("Cant set magic card block: %d", blockNum);\r
+ PrintAndLog("Can't set magic card block: %d", blockNum);\r
return 3;\r
}\r
blockNum++;\r
}\r
fclose(f);\r
\r
- if (blockNum != 16 * 4 && blockNum != 32 * 4 + 8 * 16){\r
+ if (blockNum != 16 * 4){\r
PrintAndLog("File content error. There must be 64 blocks");\r
return 4;\r
}\r
}\r
}\r
\r
+\r
int CmdHF14AMfCGetBlk(const char *Cmd) {\r
uint8_t memBlock[16];\r
uint8_t blockNo = 0;\r
\r
blockNo = param_get8(Cmd, 0);\r
\r
- PrintAndLog("--block number:%02x ", blockNo);\r
+ PrintAndLog("--block number:%2d ", blockNo);\r
\r
res = mfCGetBlock(blockNo, memBlock, CSETBLOCK_SINGLE_OPER);\r
if (res) {\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfCGetSc(const char *Cmd) {\r
uint8_t memBlock[16];\r
uint8_t sectorNo = 0;\r
return 1;\r
}\r
\r
- PrintAndLog("--sector number:%02x ", sectorNo);\r
+ PrintAndLog("--sector number:%d ", sectorNo);\r
\r
flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;\r
for (i = 0; i < 4; i++) {\r
\r
res = mfCGetBlock(sectorNo * 4 + i, memBlock, flags);\r
if (res) {\r
- PrintAndLog("Can't read block. %02x error=%d", sectorNo * 4 + i, res);\r
+ PrintAndLog("Can't read block. %d error=%d", sectorNo * 4 + i, res);\r
return 1;\r
}\r
\r
- PrintAndLog("block %02x data:%s", sectorNo * 4 + i, sprint_hex(memBlock, 16));\r
+ PrintAndLog("block %3d data:%s", sectorNo * 4 + i, sprint_hex(memBlock, 16));\r
}\r
return 0;\r
}\r
\r
+\r
int CmdHF14AMfCSave(const char *Cmd) {\r
\r
FILE * f;\r
}\r
}\r
\r
+\r
int CmdHF14AMfSniff(const char *Cmd){\r
// params\r
bool wantLogToFile = 0;\r
memset(buf, 0x00, 3000);\r
\r
if (param_getchar(Cmd, 0) == 'h') {\r
- PrintAndLog("It continuously get data from the field and saves it to: log, emulator, emulator file.");\r
+ PrintAndLog("It continuously gets data from the field and saves it to: log, emulator, emulator file.");\r
PrintAndLog("You can specify:");\r
PrintAndLog(" l - save encrypted sequence to logfile `uid.log`");\r
PrintAndLog(" d - decrypt sequence and put it to log file `uid.log`");\r
\r
static command_t CommandTable[] =\r
{\r
- {"help", CmdHelp, 1, "This help"},\r
- {"dbg", CmdHF14AMfDbg, 0, "Set default debug mode"},\r
+ {"help", CmdHelp, 1, "This help"},\r
+ {"dbg", CmdHF14AMfDbg, 0, "Set default debug mode"},\r
{"rdbl", CmdHF14AMfRdBl, 0, "Read MIFARE classic block"},\r
- {"urdbl", CmdHF14AMfURdBl, 0, "Read MIFARE Ultralight block"},\r
- {"urdcard", CmdHF14AMfURdCard, 0,"Read MIFARE Ultralight Card"},\r
+ {"urdbl", CmdHF14AMfURdBl, 0, "Read MIFARE Ultralight block"},\r
+ {"urdcard", CmdHF14AMfURdCard, 0,"Read MIFARE Ultralight Card"},\r
{"uwrbl", CmdHF14AMfUWrBl, 0,"Write MIFARE Ultralight block"},\r
{"rdsc", CmdHF14AMfRdSc, 0, "Read MIFARE classic sector"},\r
{"dump", CmdHF14AMfDump, 0, "Dump MIFARE classic tag to binary file"},\r
- {"restore", CmdHF14AMfRestore, 0, "Restore MIFARE classic binary file to BLANK tag"},\r
+ {"restore", CmdHF14AMfRestore, 0, "Restore MIFARE classic binary file to BLANK tag"},\r
{"wrbl", CmdHF14AMfWrBl, 0, "Write MIFARE classic block"},\r
- {"chk", CmdHF14AMfChk, 0, "Test block keys"},\r
+ {"chk", CmdHF14AMfChk, 0, "Test block keys"},\r
{"mifare", CmdHF14AMifare, 0, "Read parity error messages."},\r
{"nested", CmdHF14AMfNested, 0, "Test nested authentication"},\r
{"sniff", CmdHF14AMfSniff, 0, "Sniff card-reader communication"},\r
- {"sim", CmdHF14AMf1kSim, 0, "Simulate MIFARE card"},\r
+ {"sim", CmdHF14AMf1kSim, 0, "Simulate MIFARE card"},\r
{"eclr", CmdHF14AMfEClear, 0, "Clear simulator memory block"},\r
{"eget", CmdHF14AMfEGet, 0, "Get simulator memory block"},\r
{"eset", CmdHF14AMfESet, 0, "Set simulator memory block"},\r
{"eload", CmdHF14AMfELoad, 0, "Load from file emul dump"},\r
{"esave", CmdHF14AMfESave, 0, "Save to file emul dump"},\r
{"ecfill", CmdHF14AMfECFill, 0, "Fill simulator memory with help of keys from simulator"},\r
- {"ekeyprn", CmdHF14AMfEKeyPrn, 0, "Print keys from simulator memory"},\r
- {"csetuid", CmdHF14AMfCSetUID, 0, "Set UID for magic Chinese card"},\r
- {"csetblk", CmdHF14AMfCSetBlk, 0, "Write block into magic Chinese card"},\r
- {"cgetblk", CmdHF14AMfCGetBlk, 0, "Read block from magic Chinese card"},\r
+ {"ekeyprn", CmdHF14AMfEKeyPrn, 0, "Print keys from simulator memory"},\r
+ {"csetuid", CmdHF14AMfCSetUID, 0, "Set UID for magic Chinese card"},\r
+ {"csetblk", CmdHF14AMfCSetBlk, 0, "Write block into magic Chinese card"},\r
+ {"cgetblk", CmdHF14AMfCGetBlk, 0, "Read block from magic Chinese card"},\r
{"cgetsc", CmdHF14AMfCGetSc, 0, "Read sector from magic Chinese card"},\r
{"cload", CmdHF14AMfCLoad, 0, "Load dump into magic Chinese card"},\r
{"csave", CmdHF14AMfCSave, 0, "Save dump from magic Chinese card into file or emulator"},\r
projects / proxmark3-svn / commitdiff