]> cvs.zerfleddert.de Git - proxmark3-svn/blobdiff - client/cmdhfmfp.c
FIDO U2F NFC authenticators (#697)
[proxmark3-svn] / client / cmdhfmfp.c
index 34abbed0db432d2d66a18c0b93539c8371f7b63f..1ff24eb18f1815234e70f3d89f1ef4b1a7ef332f 100644 (file)
@@ -1,5 +1,6 @@
 //-----------------------------------------------------------------------------
 // Copyright (C) 2018 Merlok
+// Copyright (C) 2018 drHatson
 //
 // 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
 #include "ui.h"
 #include "cmdhf14a.h"
 #include "mifare.h"
+#include "mifare4.h"
+#include "cliparser/cliparser.h"
+#include "polarssl/libpcrypto.h"
+
+static const uint8_t DefaultKey[16] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
+
+typedef struct {
+       uint8_t Code;
+       const char *Description;
+} PlusErrorsElm;
+
+static const PlusErrorsElm PlusErrors[] = {
+       {0xFF, ""},
+       {0x00, "Transfer cannot be granted within the current authentication."},
+       {0x06, "Access Conditions not fulfilled. Block does not exist, block is not a value block."},
+       {0x07, "Too many read or write commands in the session or in the transaction."},
+       {0x08, "Invalid MAC in command or response"},
+       {0x09, "Block Number is not valid"},
+       {0x0a, "Invalid block number, not existing block number"},
+       {0x0b, "The current command code not available at the current card state."},
+       {0x0c, "Length error"},
+       {0x0f, "General Manipulation Error. Failure in the operation of the PICC (cannot write to the data block), etc."},
+       {0x90, "OK"},
+};
+int PlusErrorsLen = sizeof(PlusErrors) / sizeof(PlusErrorsElm);
+
+const char * GetErrorDescription(uint8_t errorCode) {
+       for(int i = 0; i < PlusErrorsLen; i++)
+               if (errorCode == PlusErrors[i].Code)
+                       return PlusErrors[i].Description;
+               
+       return PlusErrors[0].Description;
+}
 
 static int CmdHelp(const char *Cmd);
 
+static bool VerboseMode = false;
+void SetVerboseMode(bool verbose) {
+       VerboseMode = verbose;
+}
+
+int intExchangeRAW14aPlus(uint8_t *datain, int datainlen, bool activateField, bool leaveSignalON, uint8_t *dataout, int maxdataoutlen, int *dataoutlen) {
+       if(VerboseMode)
+               PrintAndLog(">>> %s", sprint_hex(datain, datainlen));
+       
+       int res = ExchangeRAW14a(datain, datainlen, activateField, leaveSignalON, dataout, maxdataoutlen, dataoutlen);
+
+       if(VerboseMode)
+               PrintAndLog("<<< %s", sprint_hex(dataout, *dataoutlen));
+       
+       return res;
+}
+
+int MFPWritePerso(uint8_t *keyNum, uint8_t *key, bool activateField, bool leaveSignalON, uint8_t *dataout, int maxdataoutlen, int *dataoutlen) {
+       uint8_t rcmd[3 + 16] = {0xa8, keyNum[1], keyNum[0], 0x00};
+       memmove(&rcmd[3], key, 16);
+       
+       return intExchangeRAW14aPlus(rcmd, sizeof(rcmd), activateField, leaveSignalON, dataout, maxdataoutlen, dataoutlen);
+}
+
+int MFPCommitPerso(bool activateField, bool leaveSignalON, uint8_t *dataout, int maxdataoutlen, int *dataoutlen) {
+       uint8_t rcmd[1] = {0xaa};
+       
+       return intExchangeRAW14aPlus(rcmd, sizeof(rcmd), activateField, leaveSignalON, dataout, maxdataoutlen, dataoutlen);
+}
+
+int MFPReadBlock(mf4Session *session, bool plain, uint8_t blockNum, uint8_t blockCount, bool activateField, bool leaveSignalON, uint8_t *dataout, int maxdataoutlen, int *dataoutlen, uint8_t *mac) {
+       uint8_t rcmd[4 + 8] = {(plain?(0x37):(0x33)), blockNum, 0x00, blockCount}; 
+       if (!plain && session)
+               CalculateMAC(session, mtypReadCmd, blockNum, blockCount, rcmd, 4, &rcmd[4], VerboseMode);
+       
+       int res = intExchangeRAW14aPlus(rcmd, plain?4:sizeof(rcmd), activateField, leaveSignalON, dataout, maxdataoutlen, dataoutlen);
+       if(res)
+               return res;
+
+       if (session) 
+               session->R_Ctr++;
+       
+       if(session && mac && *dataoutlen > 11)
+               CalculateMAC(session, mtypReadResp, blockNum, blockCount, dataout, *dataoutlen - 8 - 2, mac, VerboseMode);
+       
+       return 0;
+}
+
+int MFPWriteBlock(mf4Session *session, uint8_t blockNum, uint8_t *data, bool activateField, bool leaveSignalON, uint8_t *dataout, int maxdataoutlen, int *dataoutlen, uint8_t *mac) {
+       uint8_t rcmd[1 + 2 + 16 + 8] = {0xA3, blockNum, 0x00};
+       memmove(&rcmd[3], data, 16);
+       if (session)
+               CalculateMAC(session, mtypWriteCmd, blockNum, 1, rcmd, 19, &rcmd[19], VerboseMode);
+       
+       int res = intExchangeRAW14aPlus(rcmd, sizeof(rcmd), activateField, leaveSignalON, dataout, maxdataoutlen, dataoutlen);
+       if(res)
+               return res;
+
+       if (session) 
+               session->W_Ctr++;
+
+       if(session && mac && *dataoutlen > 3)
+               CalculateMAC(session, mtypWriteResp, blockNum, 1, dataout, *dataoutlen, mac, VerboseMode);
+       
+       return 0;
+}
+
 int CmdHFMFPInfo(const char *cmd) {
        
        if (cmd && strlen(cmd) > 0)
@@ -103,10 +204,546 @@ int CmdHFMFPInfo(const char *cmd) {
        return 0;
 }
 
+int CmdHFMFPWritePerso(const char *cmd) {
+       uint8_t keyNum[64] = {0};
+       int keyNumLen = 0;
+       uint8_t key[64] = {0};
+       int keyLen = 0;
+
+       CLIParserInit("hf mfp wrp", 
+               "Executes Write Perso command. Can be used in SL0 mode only.", 
+               "Usage:\n\thf mfp wrp 4000 000102030405060708090a0b0c0d0e0f -> write key (00..0f) to key number 4000 \n"
+                       "\thf mfp wrp 4000 -> write default key(0xff..0xff) to key number 4000");
+
+       void* argtable[] = {
+               arg_param_begin,
+               arg_lit0("vV",  "verbose", "show internal data."),
+               arg_str1(NULL,  NULL,      "<HEX key number (2b)>", NULL),
+               arg_strx0(NULL,  NULL,     "<HEX key (16b)>", NULL),
+               arg_param_end
+       };
+       CLIExecWithReturn(cmd, argtable, true);
+       
+       bool verbose = arg_get_lit(1);
+       CLIGetHexWithReturn(2, keyNum, &keyNumLen);
+       CLIGetHexWithReturn(3, key, &keyLen);
+       CLIParserFree();
+       
+       SetVerboseMode(verbose);
+       
+       if (!keyLen) {
+               memmove(key, DefaultKey, 16);
+               keyLen = 16;
+       }
+       
+       if (keyNumLen != 2) {
+               PrintAndLog("Key number length must be 2 bytes instead of: %d", keyNumLen);
+               return 1;
+       }
+       if (keyLen != 16) {
+               PrintAndLog("Key length must be 16 bytes instead of: %d", keyLen);
+               return 1;
+       }
+
+       uint8_t data[250] = {0};
+       int datalen = 0;
+
+       int res = MFPWritePerso(keyNum, key, true, false, data, sizeof(data), &datalen);
+       if (res) {
+               PrintAndLog("Exchange error: %d", res);
+               return res;
+       }
+       
+       if (datalen != 3) {
+               PrintAndLog("Command must return 3 bytes instead of: %d", datalen);
+               return 1;
+       }
+
+       if (data[0] != 0x90) {
+               PrintAndLog("Command error: %02x %s", data[0], GetErrorDescription(data[0]));
+               return 1;
+       }
+       PrintAndLog("Write OK.");
+       
+       return 0;
+}
+
+uint16_t CardAddresses[] = {0x9000, 0x9001, 0x9002, 0x9003, 0x9004, 0xA000, 0xA001, 0xA080, 0xA081, 0xC000, 0xC001};
+
+int CmdHFMFPInitPerso(const char *cmd) {
+       int res;
+       uint8_t key[256] = {0};
+       int keyLen = 0;
+       uint8_t keyNum[2] = {0};
+       uint8_t data[250] = {0};
+       int datalen = 0;
+
+       CLIParserInit("hf mfp initp", 
+               "Executes Write Perso command for all card's keys. Can be used in SL0 mode only.", 
+               "Usage:\n\thf mfp initp 000102030405060708090a0b0c0d0e0f -> fill all the keys with key (00..0f)\n"
+                       "\thf mfp initp -vv -> fill all the keys with default key(0xff..0xff) and show all the data exchange");
+
+       void* argtable[] = {
+               arg_param_begin,
+               arg_litn("vV",  "verbose", 0, 2, "show internal data."),
+               arg_strx0(NULL,  NULL,      "<HEX key (16b)>", NULL),
+               arg_param_end
+       };
+       CLIExecWithReturn(cmd, argtable, true);
+       
+       bool verbose = arg_get_lit(1);
+       bool verbose2 = arg_get_lit(1) > 1;
+       CLIGetHexWithReturn(2, key, &keyLen);
+       CLIParserFree();
+
+       if (keyLen && keyLen != 16) {
+               PrintAndLog("Key length must be 16 bytes instead of: %d", keyLen);
+               return 1;
+       }
+       
+       if (!keyLen)
+               memmove(key, DefaultKey, 16);
+
+       SetVerboseMode(verbose2);
+       for (uint16_t sn = 0x4000; sn < 0x4050; sn++) {
+               keyNum[0] = sn >> 8;
+               keyNum[1] = sn & 0xff;
+               res = MFPWritePerso(keyNum, key, (sn == 0x4000), true, data, sizeof(data), &datalen);
+               if (!res && (datalen == 3) && data[0] == 0x09) {
+                       PrintAndLog("2k card detected.");
+                       break;
+               }
+               if (res || (datalen != 3) || data[0] != 0x90) {
+                       PrintAndLog("Write error on address %04x", sn);
+                       break;
+               }
+       }
+       
+       SetVerboseMode(verbose);
+       for (int i = 0; i < sizeof(CardAddresses) / 2; i++) {
+               keyNum[0] = CardAddresses[i] >> 8;
+               keyNum[1] = CardAddresses[i] & 0xff;
+               res = MFPWritePerso(keyNum, key, false, true, data, sizeof(data), &datalen);
+               if (!res && (datalen == 3) && data[0] == 0x09) {
+                       PrintAndLog("Skipped[%04x]...", CardAddresses[i]);
+               } else {
+                       if (res || (datalen != 3) || data[0] != 0x90) {
+                               PrintAndLog("Write error on address %04x", CardAddresses[i]);
+                               break;
+                       }
+               }
+       }
+       
+       DropField();
+       
+       if (res)
+               return res;
+       
+       PrintAndLog("Done.");
+       
+       return 0;
+}
+
+int CmdHFMFPCommitPerso(const char *cmd) {
+       CLIParserInit("hf mfp commitp", 
+               "Executes Commit Perso command. Can be used in SL0 mode only.", 
+               "Usage:\n\thf mfp commitp ->  \n");
+
+       void* argtable[] = {
+               arg_param_begin,
+               arg_lit0("vV",  "verbose", "show internal data."),
+               arg_int0(NULL,  NULL,      "SL mode", NULL),
+               arg_param_end
+       };
+       CLIExecWithReturn(cmd, argtable, true);
+       
+       bool verbose = arg_get_lit(1);
+       CLIParserFree();
+       
+       SetVerboseMode(verbose);
+       
+       uint8_t data[250] = {0};
+       int datalen = 0;
+
+       int res = MFPCommitPerso(true, false, data, sizeof(data), &datalen);
+       if (res) {
+               PrintAndLog("Exchange error: %d", res);
+               return res;
+       }
+       
+       if (datalen != 3) {
+               PrintAndLog("Command must return 3 bytes instead of: %d", datalen);
+               return 1;
+       }
+
+       if (data[0] != 0x90) {
+               PrintAndLog("Command error: %02x %s", data[0], GetErrorDescription(data[0]));
+               return 1;
+       }
+       PrintAndLog("Switch level OK.");
+
+       return 0;
+}
+
+int CmdHFMFPAuth(const char *cmd) {
+       uint8_t keyn[250] = {0};
+       int keynlen = 0;
+       uint8_t key[250] = {0};
+       int keylen = 0;
+       
+       CLIParserInit("hf mfp auth", 
+               "Executes AES authentication command for Mifare Plus card", 
+               "Usage:\n\thf mfp auth 4000 000102030405060708090a0b0c0d0e0f -> executes authentication\n"
+                       "\thf mfp auth 9003 FFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFF -v -> executes authentication and shows all the system data\n");
+
+       void* argtable[] = {
+               arg_param_begin,
+               arg_lit0("vV",  "verbose", "show internal data."),
+               arg_str1(NULL,  NULL,     "<Key Num (HEX 2 bytes)>", NULL),
+               arg_str1(NULL,  NULL,     "<Key Value (HEX 16 bytes)>", NULL),
+               arg_param_end
+       };
+       CLIExecWithReturn(cmd, argtable, true);
+       
+       bool verbose = arg_get_lit(1);
+       CLIGetHexWithReturn(2, keyn, &keynlen);
+       CLIGetHexWithReturn(3, key, &keylen);
+       CLIParserFree();
+       
+       if (keynlen != 2) {
+               PrintAndLog("ERROR: <Key Num> must be 2 bytes long instead of: %d", keynlen);
+               return 1;
+       }
+       
+       if (keylen != 16) {
+               PrintAndLog("ERROR: <Key Value> must be 16 bytes long instead of: %d", keylen);
+               return 1;
+       }
+
+       return MifareAuth4(NULL, keyn, key, true, false, verbose);
+}
+
+int CmdHFMFPRdbl(const char *cmd) {
+       uint8_t keyn[2] = {0};
+       uint8_t key[250] = {0};
+       int keylen = 0;
+       
+       CLIParserInit("hf mfp rdbl", 
+               "Reads several blocks from Mifare Plus card.", 
+               "Usage:\n\thf mfp rdbl 0 000102030405060708090a0b0c0d0e0f -> executes authentication and read block 0 data\n"
+                       "\thf mfp rdbl 1 -v -> executes authentication and shows sector 1 data with default key 0xFF..0xFF and some additional data\n");
+
+       void* argtable[] = {
+               arg_param_begin,
+               arg_lit0("vV",  "verbose", "show internal data."),
+               arg_int0("nN",  "count",   "blocks count (by default 1).", NULL),
+               arg_lit0("bB",  "keyb",    "use key B (by default keyA)."),
+               arg_lit0("pP",  "plain",   "plain communication mode between reader and card."),
+               arg_int1(NULL,  NULL,      "<Block Num (0..255)>", NULL),
+               arg_str0(NULL,  NULL,      "<Key Value (HEX 16 bytes)>", NULL),
+               arg_param_end
+       };
+       CLIExecWithReturn(cmd, argtable, false);
+       
+       bool verbose = arg_get_lit(1);
+       int blocksCount = arg_get_int_def(2, 1);
+       bool keyB = arg_get_lit(3);
+       int plain = arg_get_lit(4);
+       uint32_t blockn = arg_get_int(5);
+       CLIGetHexWithReturn(6, key, &keylen);
+       CLIParserFree();
+       
+       SetVerboseMode(verbose);
+
+       if (!keylen) {
+               memmove(key, DefaultKey, 16);
+               keylen = 16;
+       }
+       
+       if (blockn > 255) {
+               PrintAndLog("ERROR: <Block Num> must be in range [0..255] instead of: %d", blockn);
+               return 1;
+       }
+       
+       if (keylen != 16) {
+               PrintAndLog("ERROR: <Key Value> must be 16 bytes long instead of: %d", keylen);
+               return 1;
+       }
+
+       // 3 blocks - wo iso14443-4 chaining
+       if (blocksCount > 3) {
+               PrintAndLog("ERROR: blocks count must be less than 3 instead of: %d", blocksCount);
+               return 1;
+       }
+       
+       if (blocksCount > 1 && mfIsSectorTrailer(blockn)) {
+               PrintAndLog("WARNING: trailer!");
+       }
+       
+       uint8_t sectorNum = mfSectorNum(blockn & 0xff);
+       uint16_t uKeyNum = 0x4000 + sectorNum * 2 + (keyB ? 1 : 0);
+       keyn[0] = uKeyNum >> 8;
+       keyn[1] = uKeyNum & 0xff;
+       if (verbose)
+               PrintAndLog("--block:%d sector[%d]:%02x key:%04x", blockn, mfNumBlocksPerSector(sectorNum), sectorNum, uKeyNum);
+       
+       mf4Session session;
+       int res = MifareAuth4(&session, keyn, key, true, true, verbose);
+       if (res) {
+               PrintAndLog("Authentication error: %d", res);
+               return res;
+       }
+       
+       uint8_t data[250] = {0};
+       int datalen = 0;
+       uint8_t mac[8] = {0};
+       res = MFPReadBlock(&session, plain, blockn & 0xff, blocksCount, false, false, data, sizeof(data), &datalen, mac);
+       if (res) {
+               PrintAndLog("Read error: %d", res);
+               return res;
+       }
+       
+       if (datalen && data[0] != 0x90) {
+               PrintAndLog("Card read error: %02x %s", data[0], GetErrorDescription(data[0]));
+               return 6;
+       }
+       
+       if (datalen != 1 + blocksCount * 16 + 8 + 2) {
+               PrintAndLog("Error return length:%d", datalen);
+               return 5;
+       }
+
+       int indx = blockn;
+       for(int i = 0; i < blocksCount; i++)  {
+               PrintAndLog("data[%03d]: %s", indx, sprint_hex(&data[1 + i * 16], 16));
+               indx++;
+               if (mfIsSectorTrailer(indx) && i != blocksCount - 1){
+                       PrintAndLog("data[%03d]: ------------------- trailer -------------------", indx);
+                       indx++;
+               }
+       }
+
+       if (memcmp(&data[blocksCount * 16 + 1], mac, 8)) {
+               PrintAndLog("WARNING: mac not equal...");
+               PrintAndLog("MAC   card: %s", sprint_hex(&data[blocksCount * 16 + 1], 8));
+               PrintAndLog("MAC reader: %s", sprint_hex(mac, 8));
+       } else {        
+               if(verbose)
+                       PrintAndLog("MAC: %s", sprint_hex(&data[blocksCount * 16 + 1], 8));
+       }
+       
+       return 0;
+}
+
+int CmdHFMFPRdsc(const char *cmd) {
+       uint8_t keyn[2] = {0};
+       uint8_t key[250] = {0};
+       int keylen = 0;
+       
+       CLIParserInit("hf mfp rdsc", 
+               "Reads one sector from Mifare Plus card.", 
+               "Usage:\n\thf mfp rdsc 0 000102030405060708090a0b0c0d0e0f -> executes authentication and read sector 0 data\n"
+                       "\thf mfp rdsc 1 -v -> executes authentication and shows sector 1 data with default key 0xFF..0xFF and some additional data\n");
+
+       void* argtable[] = {
+               arg_param_begin,
+               arg_lit0("vV",  "verbose", "show internal data."),
+               arg_lit0("bB",  "keyb",    "use key B (by default keyA)."),
+               arg_lit0("pP",  "plain",   "plain communication mode between reader and card."),
+               arg_int1(NULL,  NULL,      "<Sector Num (0..255)>", NULL),
+               arg_str0(NULL,  NULL,      "<Key Value (HEX 16 bytes)>", NULL),
+               arg_param_end
+       };
+       CLIExecWithReturn(cmd, argtable, false);
+       
+       bool verbose = arg_get_lit(1);
+       bool keyB = arg_get_lit(2);
+       bool plain = arg_get_lit(3);
+       uint32_t sectorNum = arg_get_int(4);
+       CLIGetHexWithReturn(5, key, &keylen);
+       CLIParserFree();
+       
+       SetVerboseMode(verbose);
+
+       if (!keylen) {
+               memmove(key, DefaultKey, 16);
+               keylen = 16;
+       }
+       
+       if (sectorNum > 39) {
+               PrintAndLog("ERROR: <Sector Num> must be in range [0..39] instead of: %d", sectorNum);
+               return 1;
+       }
+       
+       if (keylen != 16) {
+               PrintAndLog("ERROR: <Key Value> must be 16 bytes long instead of: %d", keylen);
+               return 1;
+       }
+       
+       uint16_t uKeyNum = 0x4000 + sectorNum * 2 + (keyB ? 1 : 0);
+       keyn[0] = uKeyNum >> 8;
+       keyn[1] = uKeyNum & 0xff;
+       if (verbose)
+               PrintAndLog("--sector[%d]:%02x key:%04x", mfNumBlocksPerSector(sectorNum), sectorNum, uKeyNum);
+       
+       mf4Session session;
+       int res = MifareAuth4(&session, keyn, key, true, true, verbose);
+       if (res) {
+               PrintAndLog("Authentication error: %d", res);
+               return res;
+       }
+       
+       uint8_t data[250] = {0};
+       int datalen = 0;
+       uint8_t mac[8] = {0};
+       for(int n = mfFirstBlockOfSector(sectorNum); n < mfFirstBlockOfSector(sectorNum) + mfNumBlocksPerSector(sectorNum); n++) {
+               res = MFPReadBlock(&session, plain, n & 0xff, 1, false, true, data, sizeof(data), &datalen, mac);
+               if (res) {
+                       PrintAndLog("Read error: %d", res);
+                       DropField();
+                       return res;
+               }
+               
+               if (datalen && data[0] != 0x90) {
+                       PrintAndLog("Card read error: %02x %s", data[0], GetErrorDescription(data[0]));
+                       DropField();
+                       return 6;
+               }
+               if (datalen != 1 + 16 + 8 + 2) {
+                       PrintAndLog("Error return length:%d", datalen);
+                       DropField();
+                       return 5;
+               }
+
+               PrintAndLog("data[%03d]: %s", n, sprint_hex(&data[1], 16));
+                       
+               if (memcmp(&data[1 + 16], mac, 8)) {
+                       PrintAndLog("WARNING: mac on block %d not equal...", n);
+                       PrintAndLog("MAC   card: %s", sprint_hex(&data[1 + 16], 8));
+                       PrintAndLog("MAC reader: %s", sprint_hex(mac, 8));
+               } else {        
+                       if(verbose)
+                               PrintAndLog("MAC: %s", sprint_hex(&data[1 + 16], 8));
+               }
+       }
+       DropField();
+       
+       return 0;
+}
+
+int CmdHFMFPWrbl(const char *cmd) {
+       uint8_t keyn[2] = {0};
+       uint8_t key[250] = {0};
+       int keylen = 0;
+       uint8_t datain[250] = {0};
+       int datainlen = 0;
+       
+       CLIParserInit("hf mfp wrbl", 
+               "Writes one block to Mifare Plus card.", 
+               "Usage:\n\thf mfp wrbl 1 ff0000000000000000000000000000ff 000102030405060708090a0b0c0d0e0f -> writes block 1 data\n"
+                       "\thf mfp wrbl 2 ff0000000000000000000000000000ff -v -> writes block 2 data with default key 0xFF..0xFF and some additional data\n");
+
+       void* argtable[] = {
+               arg_param_begin,
+               arg_lit0("vV",  "verbose", "show internal data."),
+               arg_lit0("bB",  "keyb",    "use key B (by default keyA)."),
+               arg_int1(NULL,  NULL,      "<Block Num (0..255)>", NULL),
+               arg_str1(NULL,  NULL,      "<Data (HEX 16 bytes)>", NULL),
+               arg_str0(NULL,  NULL,      "<Key (HEX 16 bytes)>", NULL),
+               arg_param_end
+       };
+       CLIExecWithReturn(cmd, argtable, false);
+       
+       bool verbose = arg_get_lit(1);
+       bool keyB = arg_get_lit(2);
+       uint32_t blockNum = arg_get_int(3);
+       CLIGetHexWithReturn(4, datain, &datainlen);
+       CLIGetHexWithReturn(5, key, &keylen);
+       CLIParserFree();
+       
+       SetVerboseMode(verbose);
+
+       if (!keylen) {
+               memmove(key, DefaultKey, 16);
+               keylen = 16;
+       }
+       
+       if (blockNum > 39) {
+               PrintAndLog("ERROR: <Block Num> must be in range [0..255] instead of: %d", blockNum);
+               return 1;
+       }
+       
+       if (keylen != 16) {
+               PrintAndLog("ERROR: <Key> must be 16 bytes long instead of: %d", keylen);
+               return 1;
+       }
+
+       if (datainlen != 16) {
+               PrintAndLog("ERROR: <Data> must be 16 bytes long instead of: %d", datainlen);
+               return 1;
+       }
+       
+       uint8_t sectorNum = mfSectorNum(blockNum & 0xff);
+       uint16_t uKeyNum = 0x4000 + sectorNum * 2 + (keyB ? 1 : 0);
+       keyn[0] = uKeyNum >> 8;
+       keyn[1] = uKeyNum & 0xff;
+       if (verbose)
+               PrintAndLog("--block:%d sector[%d]:%02x key:%04x", blockNum & 0xff, mfNumBlocksPerSector(sectorNum), sectorNum, uKeyNum);
+       
+       mf4Session session;
+       int res = MifareAuth4(&session, keyn, key, true, true, verbose);
+       if (res) {
+               PrintAndLog("Authentication error: %d", res);
+               return res;
+       }
+
+       uint8_t data[250] = {0};
+       int datalen = 0;
+       uint8_t mac[8] = {0};
+       res = MFPWriteBlock(&session, blockNum & 0xff, datain, false, false, data, sizeof(data), &datalen, mac);
+       if (res) {
+               PrintAndLog("Write error: %d", res);
+               DropField();
+               return res;
+       }
+       
+       if (datalen != 3 && (datalen != 3 + 8)) {
+               PrintAndLog("Error return length:%d", datalen);
+               DropField();
+               return 5;
+       }
+       
+       if (datalen && data[0] != 0x90) {
+               PrintAndLog("Card write error: %02x %s", data[0], GetErrorDescription(data[0]));
+               DropField();
+               return 6;
+       }
+       
+       if (memcmp(&data[1], mac, 8)) {
+               PrintAndLog("WARNING: mac not equal...");
+               PrintAndLog("MAC   card: %s", sprint_hex(&data[1], 8));
+               PrintAndLog("MAC reader: %s", sprint_hex(mac, 8));
+       } else {        
+               if(verbose)
+                       PrintAndLog("MAC: %s", sprint_hex(&data[1], 8));
+       }
+       
+       DropField();
+       PrintAndLog("Write OK.");       
+       return 0;
+}
+
 static command_t CommandTable[] =
 {
   {"help",             CmdHelp,                                        1, "This help"},
   {"info",            CmdHFMFPInfo,                    0, "Info about Mifare Plus tag"},
+  {"wrp",                     CmdHFMFPWritePerso,              0, "Write Perso command"},
+  {"initp",           CmdHFMFPInitPerso,               0, "Fills all the card's keys"},
+  {"commitp",                 CmdHFMFPCommitPerso,             0, "Move card to SL1 or SL3 mode"},
+  {"auth",            CmdHFMFPAuth,                    0, "Authentication"},
+  {"rdbl",            CmdHFMFPRdbl,                    0, "Read blocks"},
+  {"rdsc",            CmdHFMFPRdsc,                    0, "Read sectors"},
+  {"wrbl",            CmdHFMFPWrbl,                    0, "Write blocks"},
   {NULL,               NULL,                                   0, NULL}
 };
 
Impressum, Datenschutz