// Proxmark3 RDV40 Smartcard module commands
//-----------------------------------------------------------------------------
#include "cmdsmartcard.h"
+
+#include <ctype.h>
+
+#include "ui.h"
+#include "cmdparser.h"
+#include "proxmark3.h"
+#include "util.h"
#include "smartcard.h"
#include "comms.h"
#include "protocols.h"
+#include "cmdhf.h" // CmdHFlist
+#include "emv/apduinfo.h" // APDUcode description
+#include "emv/emvcore.h" // decodeTVL
+#include "crypto/libpcrypto.h" // sha512hash
+#include "emv/dump.h" // dump_buffer
+#define SC_UPGRADE_FILES_DIRECTORY "sc_upgrade_firmware/"
static int CmdHelp(const char *Cmd);
-int usage_sm_raw(void) {
- PrintAndLog("Usage: sc raw [h|r|c] d <0A 0B 0C ... hex>");
- PrintAndLog(" h : this help");
- PrintAndLog(" r : do not read response");
- PrintAndLog(" a : active signal field ON without select");
- PrintAndLog(" s : active signal field ON with select");
- PrintAndLog(" t : executes TLV decoder if it is possible");
- PrintAndLog(" d <bytes> : bytes to send");
- PrintAndLog("");
- PrintAndLog("Examples:");
- PrintAndLog(" sc raw d 11223344");
+static int usage_sm_raw(void) {
+ PrintAndLogEx(NORMAL, "Usage: sc raw [h|r|c] d <0A 0B 0C ... hex>");
+ PrintAndLogEx(NORMAL, " h : this help");
+ PrintAndLogEx(NORMAL, " r : do not read response");
+ PrintAndLogEx(NORMAL, " a : active smartcard without select");
+ PrintAndLogEx(NORMAL, " s : active smartcard with select");
+ PrintAndLogEx(NORMAL, " t : executes TLV decoder if it possible");
+ PrintAndLogEx(NORMAL, " d <bytes> : bytes to send");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "Examples:");
+ PrintAndLogEx(NORMAL, " sc raw d 00a404000e315041592e5359532e444446303100 - `1PAY.SYS.DDF01` PPSE directory");
+ PrintAndLogEx(NORMAL, " sc raw d 00a404000e325041592e5359532e444446303100 - `2PAY.SYS.DDF01` PPSE directory");
+ return 0;
+}
+
+static int usage_sm_reader(void) {
+ PrintAndLogEx(NORMAL, "Usage: sc reader [h|s]");
+ PrintAndLogEx(NORMAL, " h : this help");
+ PrintAndLogEx(NORMAL, " s : silent (no messages)");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "Examples:");
+ PrintAndLogEx(NORMAL, " sc reader");
return 0;
}
-int usage_sm_reader(void) {
- PrintAndLog("Usage: sc reader [h|s]");
- PrintAndLog(" h : this help");
- PrintAndLog(" s : silent (no messages)");
- PrintAndLog("");
- PrintAndLog("Examples:");
- PrintAndLog(" sc reader");
+
+static int usage_sm_info(void) {
+ PrintAndLogEx(NORMAL, "Usage: s info [h|s]");
+ PrintAndLogEx(NORMAL, " h : this help");
+ PrintAndLogEx(NORMAL, " s : silent (no messages)");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "Examples:");
+ PrintAndLogEx(NORMAL, " sc info");
return 0;
}
-int usage_sm_info(void) {
- PrintAndLog("Usage: sc info [h|s]");
- PrintAndLog(" h : this help");
- PrintAndLog(" s : silent (no messages)");
- PrintAndLog("");
- PrintAndLog("Examples:");
- PrintAndLog(" sc info");
+
+static int usage_sm_upgrade(void) {
+ PrintAndLogEx(NORMAL, "Upgrade RDV4.0 Smartcard Socket Firmware");
+ PrintAndLogEx(NORMAL, "Usage: sc upgrade f <file name>");
+ PrintAndLogEx(NORMAL, " h : this help");
+ PrintAndLogEx(NORMAL, " f <filename> : firmware file name");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "Examples:");
+ PrintAndLogEx(NORMAL, " sc upgrade f SIM010.BIN");
return 0;
}
-int usage_sm_upgrade(void) {
- PrintAndLog("Upgrade firmware");
- PrintAndLog("Usage: sc upgrade f <file name>");
- PrintAndLog(" h : this help");
- PrintAndLog(" f <filename> : firmware file name");
- PrintAndLog("");
- PrintAndLog("Examples:");
- PrintAndLog(" sc upgrade f myfile");
- PrintAndLog("");
- PrintAndLog("WARNING - Dangerous command, do wrong and you will brick the smart card socket");
+
+static int usage_sm_setclock(void) {
+ PrintAndLogEx(NORMAL, "Usage: sc setclock [h] c <clockspeed>");
+ PrintAndLogEx(NORMAL, " h : this help");
+ PrintAndLogEx(NORMAL, " c <> : clockspeed (0 = 16mhz, 1=8mhz, 2=4mhz) ");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "Examples:");
+ PrintAndLogEx(NORMAL, " sc setclock c 2");
return 0;
}
-int usage_sm_setclock(void) {
- PrintAndLog("Usage: sc setclock [h] c <clockspeed>");
- PrintAndLog(" h : this help");
- PrintAndLog(" c <> : clockspeed (0 = 16mhz, 1=8mhz, 2=4mhz) ");
- PrintAndLog("");
- PrintAndLog("Examples:");
- PrintAndLog(" sc setclock c 2");
+
+static int usage_sm_brute(void) {
+ PrintAndLogEx(NORMAL, "Tries to bruteforce SFI, ");
+ PrintAndLogEx(NORMAL, "Usage: sc brute [h]");
+ PrintAndLogEx(NORMAL, " h : this help");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "Examples:");
+ PrintAndLogEx(NORMAL, " sc brute");
+ return 0;
+}
+
+uint8_t GetATRTA1(uint8_t *atr, size_t atrlen) {
+ if (atrlen > 2) {
+ uint8_t T0 = atr[1];
+ if (T0 & 0x10)
+ return atr[2];
+ }
+
+ return 0x11; // default value is 0x11, corresponding to fmax=5 MHz, Fi=372, Di=1.
+}
+
+int DiArray[] = {
+ 0, // b0000 RFU
+ 1, // b0001
+ 2,
+ 4,
+ 8,
+ 16,
+ 32, // b0110
+ 64, // b0111. This was RFU in ISO/IEC 7816-3:1997 and former. Some card readers or drivers may erroneously reject cards using this value
+ 12,
+ 20,
+ 0, // b1010 RFU
+ 0,
+ 0, // ...
+ 0,
+ 0,
+ 0 // b1111 RFU
+};
+
+int FiArray[] = {
+ 372, // b0000 Historical note: in ISO/IEC 7816-3:1989, this was assigned to cards with internal clock
+ 372, // b0001
+ 558, // b0010
+ 744, // b0011
+ 1116, // b0100
+ 1488, // b0101
+ 1860, // b0110
+ 0, // b0111 RFU
+ 0, // b1000 RFU
+ 512, // b1001
+ 768, // b1010
+ 1024, // b1011
+ 1536, // b1100
+ 2048, // b1101
+ 0, // b1110 RFU
+ 0 // b1111 RFU
+};
+
+float FArray[] = {
+ 4, // b0000 Historical note: in ISO/IEC 7816-3:1989, this was assigned to cards with internal clock
+ 5, // b0001
+ 6, // b0010
+ 8, // b0011
+ 12, // b0100
+ 16, // b0101
+ 20, // b0110
+ 0, // b0111 RFU
+ 0, // b1000 RFU
+ 5, // b1001
+ 7.5, // b1010
+ 10, // b1011
+ 15, // b1100
+ 20, // b1101
+ 0, // b1110 RFU
+ 0 // b1111 RFU
+};
+
+int GetATRDi(uint8_t *atr, size_t atrlen) {
+ uint8_t TA1 = GetATRTA1(atr, atrlen);
+
+ return DiArray[TA1 & 0x0f]; // The 4 low-order bits of TA1 (4th MSbit to 1st LSbit) encode Di
+}
+
+int GetATRFi(uint8_t *atr, size_t atrlen) {
+ uint8_t TA1 = GetATRTA1(atr, atrlen);
+
+ return FiArray[TA1 >> 4]; // The 4 high-order bits of TA1 (8th MSbit to 5th LSbit) encode fmax and Fi
+}
+
+float GetATRF(uint8_t *atr, size_t atrlen) {
+ uint8_t TA1 = GetATRTA1(atr, atrlen);
+
+ return FArray[TA1 >> 4]; // The 4 high-order bits of TA1 (8th MSbit to 5th LSbit) encode fmax and Fi
+}
+
+static int PrintATR(uint8_t *atr, size_t atrlen) {
+ uint8_t vxor = 0;
+ for (int i = 1; i < atrlen; i++)
+ vxor ^= atr[i];
+
+ if (vxor)
+ PrintAndLogEx(WARNING, "Check summ error. Must be 0 but: 0x%02x", vxor);
+ else
+ PrintAndLogEx(INFO, "Check summ OK.");
+
+ if (atr[0] != 0x3b)
+ PrintAndLogEx(WARNING, "Not a direct convention: 0x%02x", atr[0]);
+
+ uint8_t T0 = atr[1];
+ uint8_t K = T0 & 0x0F;
+ uint8_t TD1 = 0;
+
+ uint8_t T1len = 0;
+ uint8_t TD1len = 0;
+ uint8_t TDilen = 0;
+
+ if (T0 & 0x10) {
+ PrintAndLog("TA1 (Maximum clock frequency, proposed bit duration): 0x%02x", atr[2 + T1len]);
+ T1len++;
+ }
+ if (T0 & 0x20) {
+ PrintAndLog("TB1 (Deprecated: VPP requirements): 0x%02x", atr[2 + T1len]);
+ T1len++;
+ }
+ if (T0 & 0x40) {
+ PrintAndLog("TC1 (Extra delay between bytes required by card): 0x%02x", atr[2 + T1len]);
+ T1len++;
+ }
+ if (T0 & 0x80) {
+ TD1 = atr[2 + T1len];
+ PrintAndLog("TD1 (First offered transmission protocol, presence of TA2..TD2): 0x%02x. Protocol T=%d", TD1, TD1 & 0x0f);
+ T1len++;
+
+ if (TD1 & 0x10) {
+ PrintAndLog("TA2 (Specific protocol and parameters to be used after the ATR): 0x%02x", atr[2 + T1len + TD1len]);
+ TD1len++;
+ }
+ if (TD1 & 0x20) {
+ PrintAndLog("TB2 (Deprecated: VPP precise voltage requirement): 0x%02x", atr[2 + T1len + TD1len]);
+ TD1len++;
+ }
+ if (TD1 & 0x40) {
+ PrintAndLog("TC2 (Maximum waiting time for protocol T=0): 0x%02x", atr[2 + T1len + TD1len]);
+ TD1len++;
+ }
+ if (TD1 & 0x80) {
+ uint8_t TDi = atr[2 + T1len + TD1len];
+ PrintAndLog("TD2 (A supported protocol or more global parameters, presence of TA3..TD3): 0x%02x. Protocol T=%d", TDi, TDi & 0x0f);
+ TD1len++;
+
+ bool nextCycle = true;
+ uint8_t vi = 3;
+ while (nextCycle) {
+ nextCycle = false;
+ if (TDi & 0x10) {
+ PrintAndLog("TA%d: 0x%02x", vi, atr[2 + T1len + TD1len + TDilen]);
+ TDilen++;
+ }
+ if (TDi & 0x20) {
+ PrintAndLog("TB%d: 0x%02x", vi, atr[2 + T1len + TD1len + TDilen]);
+ TDilen++;
+ }
+ if (TDi & 0x40) {
+ PrintAndLog("TC%d: 0x%02x", vi, atr[2 + T1len + TD1len + TDilen]);
+ TDilen++;
+ }
+ if (TDi & 0x80) {
+ TDi = atr[2 + T1len + TD1len + TDilen];
+ PrintAndLog("TD%d: 0x%02x. Protocol T=%d", vi, TDi, TDi & 0x0f);
+ TDilen++;
+
+ nextCycle = true;
+ vi++;
+ }
+ }
+ }
+ }
+
+ uint8_t calen = 2 + T1len + TD1len + TDilen + K;
+
+ if (atrlen != calen && atrlen != calen + 1) // may be CRC
+ PrintAndLogEx(ERR, "ATR length error. len: %d, T1len: %d, TD1len: %d, TDilen: %d, K: %d", atrlen, T1len, TD1len, TDilen, K);
+ else
+ PrintAndLogEx(INFO, "ATR length OK.");
+
+ PrintAndLog("Historical bytes len: 0x%02x", K);
+ if (K > 0)
+ PrintAndLog("The format of historical bytes: %02x", atr[2 + T1len + TD1len + TDilen]);
+ if (K > 1) {
+ PrintAndLog("Historical bytes:");
+ dump_buffer(&atr[2 + T1len + TD1len + TDilen], K, NULL, 1);
+ }
+
return 0;
}
+
+static bool smart_select(bool silent) {
+ UsbCommand c = {CMD_SMART_ATR, {0, 0, 0}};
+ clearCommandBuffer();
+ SendCommand(&c);
+ UsbCommand resp;
+ if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
+ if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
+ return false;
+ }
+
+ uint8_t isok = resp.arg[0] & 0xFF;
+ if (!isok) {
+ if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
+ return false;
+ }
+
+ if (!silent) {
+ smart_card_atr_t card;
+ memcpy(&card, (smart_card_atr_t *)resp.d.asBytes, sizeof(smart_card_atr_t));
+
+ PrintAndLogEx(INFO, "ISO7816-3 ATR : %s", sprint_hex(card.atr, card.atr_len));
+ }
+
+ return true;
+}
+
+static int smart_wait(uint8_t *data) {
+ UsbCommand resp;
+ if (!WaitForResponseTimeout(CMD_ACK, &resp, 2500)) {
+ PrintAndLogEx(WARNING, "smart card response failed");
+ return -1;
+ }
+
+ uint32_t len = resp.arg[0];
+ if ( !len ) {
+ PrintAndLogEx(WARNING, "smart card response failed");
+ return -2;
+ }
+ memcpy(data, resp.d.asBytes, len);
+ PrintAndLogEx(SUCCESS, " %d | %s", len, sprint_hex_inrow_ex(data, len, 32));
+
+ if (len >= 2) {
+ PrintAndLogEx(SUCCESS, "%02X%02X | %s", data[len - 2], data[len - 1], GetAPDUCodeDescription(data[len - 2], data[len - 1]));
+ }
+ return len;
+}
+
+static int smart_response(uint8_t apduINS, uint8_t *data) {
+
+ int datalen = smart_wait(data);
+ bool needGetData = false;
+
+ if (datalen < 2 ) {
+ goto out;
+ }
+
+ if (datalen > 2 && data[0] != apduINS) {
+ PrintAndLogEx(ERR, "Card ACK error. len=0x%x data[0]=%02x", datalen, data[0]);
+ datalen = 0;
+ goto out;
+ }
+
+ if ( data[datalen - 2] == 0x61 || data[datalen - 2] == 0x9F ) {
+ needGetData = true;
+ }
+
+ if (needGetData) {
+ int len = data[datalen - 1];
+ PrintAndLogEx(INFO, "Requesting response. len=0x%x", len);
+ uint8_t getstatus[] = {ISO7816_GETSTATUS, 0x00, 0x00, len};
+ UsbCommand cStatus = {CMD_SMART_RAW, {SC_RAW, sizeof(getstatus), 0}};
+ memcpy(cStatus.d.asBytes, getstatus, sizeof(getstatus) );
+ clearCommandBuffer();
+ SendCommand(&cStatus);
+
+ datalen = smart_wait(data);
+
+ if (datalen < 2 ) {
+ goto out;
+ }
+ if (datalen > 2 && data[0] != ISO7816_GETSTATUS) {
+ PrintAndLogEx(ERR, "GetResponse ACK error. len=0x%x data[0]=%02x", len, data[0]);
+ datalen = 0;
+ goto out;
+ }
+
+ if (datalen != len + 2 + 1) { // 2 - response, 1 - ACK
+ PrintAndLogEx(WARNING, "GetResponse wrong length. Must be: 0x%02x but: 0x%02x", len, datalen - 3);
+ }
+ }
+
+ if (datalen > 2) {
+ datalen--;
+ memmove(data, &data[1], datalen);
+ }
+ out:
+ return datalen;
+}
+
int CmdSmartRaw(const char *Cmd) {
int hexlen = 0;
case 'd': {
switch (param_gethex_to_eol(Cmd, cmdp+1, data, sizeof(data), &hexlen)) {
case 1:
- PrintAndLog("Invalid HEX value.");
+ PrintAndLogEx(WARNING, "Invalid HEX value.");
return 1;
case 2:
- PrintAndLog("Too many bytes. Max %d bytes", sizeof(data));
+ PrintAndLogEx(WARNING, "Too many bytes. Max %d bytes", sizeof(data));
return 1;
case 3:
- PrintAndLog("Hex must have an even number of digits.");
+ PrintAndLogEx(WARNING, "Hex must have even number of digits.");
return 1;
}
cmdp++;
break;
}
default:
- PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
+ PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
if (active || active_select) {
c.arg[0] |= SC_CONNECT;
- if (active)
- c.arg[0] |= SC_NO_SELECT;
- }
+ if (active_select)
+ c.arg[0] |= SC_SELECT;
+ }
if (hexlen > 0) {
c.arg[0] |= SC_RAW;
// reading response from smart card
if ( reply ) {
- UsbCommand resp;
- if (!WaitForResponseTimeout(CMD_ACK, &resp, 2500)) {
- PrintAndLog("smart card response failed");
+
+ uint8_t* buf = calloc(USB_CMD_DATA_SIZE, sizeof(uint8_t));
+ if ( !buf )
return 1;
+
+ int len = smart_response(data[1], buf);
+ if ( len < 0 ) {
+ free(buf);
+ return 2;
}
- uint32_t datalen = resp.arg[0];
- if ( !datalen ) {
- PrintAndLog("smart card response failed");
- return 1;
+ if ( buf[0] == 0x6C ) {
+ data[4] = buf[1];
+
+ memcpy(c.d.asBytes, data, sizeof(data) );
+ clearCommandBuffer();
+ SendCommand(&c);
+ len = smart_response(data[1], buf);
+
+ data[4] = 0;
}
- PrintAndLog("received %i bytes", datalen);
+ if (decodeTLV && len > 4)
+ TLVPrintFromBuffer(buf+1, len-3);
- if (!datalen)
- return 1;
+ free(buf);
+ }
+ return 0;
+}
- uint8_t *data = resp.d.asBytes;
+int ExchangeAPDUSC(uint8_t *datain, int datainlen, bool activateCard, bool leaveSignalON, uint8_t *dataout, int maxdataoutlen, int *dataoutlen) {
+ *dataoutlen = 0;
- // TLV decoder
- if (decodeTLV ) {
+ if (activateCard)
+ smart_select(false);
+ printf("* APDU SC\n");
- if (datalen >= 2) {
- PrintAndLog("%02x %02x | %s", data[datalen - 2], data[datalen - 1], GetAPDUCodeDescription(data[datalen - 2], data[datalen - 1]));
- }
- if (datalen > 4) {
- TLVPrintFromBuffer(data, datalen - 2);
- }
- } else {
- PrintAndLog("%s", sprint_hex(data, datalen));
- }
+ UsbCommand c = {CMD_SMART_RAW, {SC_RAW | SC_CONNECT, datainlen, 0}};
+ if (activateCard) {
+ c.arg[0] |= SC_SELECT;
+ }
+ memcpy(c.d.asBytes, datain, datainlen);
+ clearCommandBuffer();
+ SendCommand(&c);
+
+ int len = smart_response(datain[1], dataout);
+
+ if ( len < 0 ) {
+ return 2;
+ }
+
+
+ // retry
+ if (len > 1 && dataout[len - 2] == 0x6c && datainlen > 4) {
+ UsbCommand c2 = {CMD_SMART_RAW, {SC_RAW, datainlen, 0}};
+ memcpy(c2.d.asBytes, datain, datainlen);
+
+ int vlen = 5 + datain[4];
+ if (datainlen == vlen)
+ datainlen++;
+
+ c2.d.asBytes[vlen] = dataout[len - 1];
+
+ clearCommandBuffer();
+ SendCommand(&c2);
+
+ len = smart_response(datain[1], dataout);
}
+ *dataoutlen = len;
+
return 0;
}
+
int CmdSmartUpgrade(const char *Cmd) {
- PrintAndLog("WARNING - Smartcard socket firmware upgrade.");
- PrintAndLog("Dangerous command, do wrong and you will brick the smart card socket");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(WARNING, "WARNING - RDV4.0 Smartcard Socket Firmware upgrade.");
+ PrintAndLogEx(WARNING, "A dangerous command, do wrong and you will brick the smart card socket");
+ PrintAndLogEx(NORMAL, "");
FILE *f;
char filename[FILE_PATH_SIZE] = {0};
case 'f':
//File handling and reading
if ( param_getstr(Cmd, cmdp+1, filename, FILE_PATH_SIZE) >= FILE_PATH_SIZE ) {
- PrintAndLog("Filename too long");
+ PrintAndLogEx(FAILED, "Filename too long");
errors = true;
break;
}
+
cmdp += 2;
break;
case 'h':
return usage_sm_upgrade();
default:
- PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
+ PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
//Validations
if (errors || cmdp == 0 ) return usage_sm_upgrade();
- // load file
- f = fopen(filename, "rb");
- if ( !f ) {
- PrintAndLog("File: %s: not found or locked.", filename);
+ if (strchr(filename, '\\') || strchr(filename, '/')) {
+ PrintAndLogEx(FAILED, "Filename must not contain \\ or /. Firmware file will be found in client/sc_upgrade_firmware directory.");
+ return 1;
+ }
+
+ char sc_upgrade_file_path[strlen(get_my_executable_directory()) + strlen(SC_UPGRADE_FILES_DIRECTORY) + strlen(filename) + 1];
+ strcpy(sc_upgrade_file_path, get_my_executable_directory());
+ strcat(sc_upgrade_file_path, SC_UPGRADE_FILES_DIRECTORY);
+ strcat(sc_upgrade_file_path, filename);
+ if (strlen(sc_upgrade_file_path) >= FILE_PATH_SIZE ) {
+ PrintAndLogEx(FAILED, "Filename too long");
+ return 1;
+ }
+
+ char sha512filename[FILE_PATH_SIZE] = {'\0'};
+ char *bin_extension = filename;
+ char *dot_position = NULL;
+ while ((dot_position = strchr(bin_extension, '.')) != NULL) {
+ bin_extension = dot_position + 1;
+ }
+ if (!strcmp(bin_extension, "BIN")
+#ifdef _WIN32
+ || !strcmp(bin_extension, "bin")
+#endif
+ ) {
+ memcpy(sha512filename, filename, strlen(filename) - strlen("bin"));
+ strcat(sha512filename, "sha512.txt");
+ } else {
+ PrintAndLogEx(FAILED, "Filename extension of Firmware Upgrade File must be .BIN");
+ return 1;
+ }
+
+ PrintAndLogEx(INFO, "Checking integrity using SHA512 File %s ...", sha512filename);
+ char sc_upgrade_sha512file_path[strlen(get_my_executable_directory()) + strlen(SC_UPGRADE_FILES_DIRECTORY) + strlen(sha512filename) + 1];
+ strcpy(sc_upgrade_sha512file_path, get_my_executable_directory());
+ strcat(sc_upgrade_sha512file_path, SC_UPGRADE_FILES_DIRECTORY);
+ strcat(sc_upgrade_sha512file_path, sha512filename);
+ if (strlen(sc_upgrade_sha512file_path) >= FILE_PATH_SIZE ) {
+ PrintAndLogEx(FAILED, "Filename too long");
+ return 1;
+ }
+
+ // load firmware file
+ f = fopen(sc_upgrade_file_path, "rb");
+ if ( !f ){
+ PrintAndLogEx(FAILED, "Firmware file not found or locked.");
return 1;
}
// get filesize in order to malloc memory
fseek(f, 0, SEEK_END);
- long fsize = ftell(f);
+ size_t fsize = ftell(f);
fseek(f, 0, SEEK_SET);
- if (fsize < 0) {
- PrintAndLog("error, when getting filesize");
+ if (fsize < 0) {
+ PrintAndLogEx(FAILED, "Could not determine size of firmware file");
fclose(f);
return 1;
}
-
+
uint8_t *dump = calloc(fsize, sizeof(uint8_t));
if (!dump) {
- PrintAndLog("error, cannot allocate memory ");
+ PrintAndLogEx(FAILED, "Could not allocate memory for firmware");
fclose(f);
return 1;
}
- size_t bytes_read = fread(dump, 1, fsize, f);
+ size_t firmware_size = fread(dump, 1, fsize, f);
if (f)
fclose(f);
- PrintAndLog("Smartcard socket firmware uploading to PM3");
+ // load sha512 file
+ f = fopen(sc_upgrade_sha512file_path, "rb");
+ if ( !f ){
+ PrintAndLogEx(FAILED, "SHA-512 file not found or locked.");
+ return 1;
+ }
+
+ // get filesize in order to malloc memory
+ fseek(f, 0, SEEK_END);
+ fsize = ftell(f);
+ fseek(f, 0, SEEK_SET);
+
+ if (fsize < 0) {
+ PrintAndLogEx(FAILED, "Could not determine size of SHA-512 file");
+ fclose(f);
+ return 1;
+ }
+
+ if (fsize < 128) {
+ PrintAndLogEx(FAILED, "SHA-512 file too short");
+ fclose(f);
+ return 1;
+ }
+
+ char hashstring[129];
+ size_t bytes_read = fread(hashstring, 1, 128, f);
+ hashstring[128] = '\0';
+
+ if (f)
+ fclose(f);
+
+ uint8_t hash1[64];
+ if (bytes_read != 128 || param_gethex(hashstring, 0, hash1, 128)) {
+ PrintAndLogEx(FAILED, "Couldn't read SHA-512 file");
+ return 1;
+ }
+
+ uint8_t hash2[64];
+ if (sha512hash(dump, firmware_size, hash2)) {
+ PrintAndLogEx(FAILED, "Couldn't calculate SHA-512 of Firmware");
+ return 1;
+ }
+
+ if (memcmp(hash1, hash2, 64)) {
+ PrintAndLogEx(FAILED, "Couldn't verify integrity of Firmware file (wrong SHA-512)");
+ return 1;
+ }
+
+ PrintAndLogEx(SUCCESS, "RDV4.0 Smartcard Socket Firmware uploading to PM3");
+
//Send to device
uint32_t index = 0;
uint32_t bytes_sent = 0;
- uint32_t bytes_remaining = bytes_read;
+ uint32_t bytes_remaining = firmware_size;
while (bytes_remaining > 0){
uint32_t bytes_in_packet = MIN(USB_CMD_DATA_SIZE, bytes_remaining);
clearCommandBuffer();
SendCommand(&c);
if ( !WaitForResponseTimeout(CMD_ACK, NULL, 2000) ) {
- PrintAndLog("timeout while waiting for reply.");
+ PrintAndLogEx(WARNING, "timeout while waiting for reply.");
free(dump);
return 1;
}
}
free(dump);
printf("\n");
- PrintAndLog("Smartcard socket firmware updating, don\'t turn off your PM3!");
+ PrintAndLogEx(SUCCESS, "RDV4.0 Smartcard Socket Firmware updating, don\'t turn off your PM3!");
// trigger the firmware upgrade
- UsbCommand c = {CMD_SMART_UPGRADE, {bytes_read, 0, 0}};
+ UsbCommand c = {CMD_SMART_UPGRADE, {firmware_size, 0, 0}};
clearCommandBuffer();
SendCommand(&c);
UsbCommand resp;
if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
- PrintAndLog("timeout while waiting for reply.");
+ PrintAndLogEx(WARNING, "timeout while waiting for reply.");
return 1;
}
- if ( (resp.arg[0] && 0xFF ) )
- PrintAndLog("Smartcard socket firmware upgraded successful");
+ if ( (resp.arg[0] & 0xFF ) )
+ PrintAndLogEx(SUCCESS, "RDV4.0 Smartcard Socket Firmware upgraded successful");
else
- PrintAndLog("Smartcard socket firmware updating failed");
+ PrintAndLogEx(FAILED, "RDV4.0 Smartcard Socket Firmware Upgrade failed");
return 0;
}
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h': return usage_sm_info();
- case 's':
+ case 's':
silent = true;
break;
default:
- PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
+ PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
SendCommand(&c);
UsbCommand resp;
if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
- if (!silent) PrintAndLog("smart card select failed");
+ if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
return 1;
}
uint8_t isok = resp.arg[0] & 0xFF;
if (!isok) {
- if (!silent) PrintAndLog("smart card select failed");
+ if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
return 1;
}
memcpy(&card, (smart_card_atr_t *)resp.d.asBytes, sizeof(smart_card_atr_t));
// print header
- PrintAndLog("\n--- Smartcard Information ---------");
- PrintAndLog("-------------------------------------------------------------");
- PrintAndLog("ISO76183 ATR : %s", sprint_hex(card.atr, card.atr_len));
- PrintAndLog("look up ATR");
- PrintAndLog("http://smartcard-atr.appspot.com/parse?ATR=%s", sprint_hex_inrow(card.atr, card.atr_len) );
+ PrintAndLogEx(INFO, "\n--- Smartcard Information ---------");
+ PrintAndLogEx(INFO, "-------------------------------------------------------------");
+ PrintAndLogEx(INFO, "ISO76183 ATR : %s", sprint_hex(card.atr, card.atr_len));
+ PrintAndLogEx(INFO, "look up ATR");
+ PrintAndLogEx(INFO, "http://smartcard-atr.appspot.com/parse?ATR=%s", sprint_hex_inrow(card.atr, card.atr_len) );
+
+ // print ATR
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "* ATR:");
+ PrintATR(card.atr, card.atr_len);
+
+ // print D/F (brom byte TA1 or defaults)
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "* D/F (TA1):");
+ int Di = GetATRDi(card.atr, card.atr_len);
+ int Fi = GetATRFi(card.atr, card.atr_len);
+ float F = GetATRF(card.atr, card.atr_len);
+ if (GetATRTA1(card.atr, card.atr_len) == 0x11)
+ PrintAndLogEx(INFO, "Using default values...");
+
+ PrintAndLogEx(NORMAL, "Di=%d", Di);
+ PrintAndLogEx(NORMAL, "Fi=%d", Fi);
+ PrintAndLogEx(NORMAL, "F=%.1f MHz", F);
+ PrintAndLogEx(NORMAL, "Cycles/ETU=%d", Fi/Di);
+ PrintAndLogEx(NORMAL, "%.1f bits/sec at 4MHz", (float)4000000 / (Fi/Di));
+ PrintAndLogEx(NORMAL, "%.1f bits/sec at Fmax=%.1fMHz", (F * 1000000) / (Fi/Di), F);
+
return 0;
}
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h': return usage_sm_reader();
- case 's':
+ case 's':
silent = true;
break;
default:
- PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
+ PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
SendCommand(&c);
UsbCommand resp;
if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
- if (!silent) PrintAndLog("smart card select failed");
+ if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
return 1;
}
uint8_t isok = resp.arg[0] & 0xFF;
if (!isok) {
- if (!silent) PrintAndLog("smart card select failed");
+ if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
return 1;
}
smart_card_atr_t card;
memcpy(&card, (smart_card_atr_t *)resp.d.asBytes, sizeof(smart_card_atr_t));
- PrintAndLog("ISO7816-3 ATR : %s", sprint_hex(card.atr, card.atr_len));
+
+ PrintAndLogEx(INFO, "ISO7816-3 ATR : %s", sprint_hex(card.atr, card.atr_len));
return 0;
}
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h': return usage_sm_setclock();
- case 'c':
+ case 'c':
clock = param_get8ex(Cmd, cmdp+1, 2, 10);
if ( clock > 2)
errors = true;
-
+
cmdp += 2;
break;
default:
- PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
+ PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
SendCommand(&c);
UsbCommand resp;
if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
- PrintAndLog("smart card select failed");
+ PrintAndLogEx(WARNING, "smart card select failed");
return 1;
}
uint8_t isok = resp.arg[0] & 0xFF;
if (!isok) {
- PrintAndLog("smart card set clock failed");
+ PrintAndLogEx(WARNING, "smart card set clock failed");
return 1;
}
switch (clock) {
case 0:
- PrintAndLog("Clock changed to 16mhz giving 10800 baudrate");
+ PrintAndLogEx(SUCCESS, "Clock changed to 16mhz giving 10800 baudrate");
break;
case 1:
- PrintAndLog("Clock changed to 8mhz giving 21600 baudrate");
+ PrintAndLogEx(SUCCESS, "Clock changed to 8mhz giving 21600 baudrate");
break;
case 2:
- PrintAndLog("Clock changed to 4mhz giving 86400 baudrate");
+ PrintAndLogEx(SUCCESS, "Clock changed to 4mhz giving 86400 baudrate");
break;
default:
break;
return 0;
}
-
-// iso 7816-3
-void annotateIso7816(char *exp, size_t size, uint8_t* cmd, uint8_t cmdsize){
- // S-block
- if ( (cmd[0] & 0xC0) && (cmdsize == 3) ) {
- switch ( (cmd[0] & 0x3f) ) {
- case 0x00 : snprintf(exp, size, "S-block RESYNCH req"); break;
- case 0x20 : snprintf(exp, size, "S-block RESYNCH resp"); break;
- case 0x01 : snprintf(exp, size, "S-block IFS req"); break;
- case 0x21 : snprintf(exp, size, "S-block IFS resp"); break;
- case 0x02 : snprintf(exp, size, "S-block ABORT req"); break;
- case 0x22 : snprintf(exp, size, "S-block ABORT resp"); break;
- case 0x03 : snprintf(exp, size, "S-block WTX reqt"); break;
- case 0x23 : snprintf(exp, size, "S-block WTX resp"); break;
- default : snprintf(exp, size, "S-block"); break;
- }
- }
- // R-block (ack)
- else if ( ((cmd[0] & 0xD0) == 0x80) && ( cmdsize > 2) ) {
- if ( (cmd[0] & 0x10) == 0 )
- snprintf(exp, size, "R-block ACK");
- else
- snprintf(exp, size, "R-block NACK");
- }
- // I-block
- else {
-
- int pos = (cmd[0] == 2 || cmd[0] == 3) ? 2 : 3;
- switch ( cmd[pos] ) {
- case ISO7816_READ_BINARY :snprintf(exp, size, "READ BIN");break;
- case ISO7816_WRITE_BINARY :snprintf(exp, size, "WRITE BIN");break;
- case ISO7816_UPDATE_BINARY :snprintf(exp, size, "UPDATE BIN");break;
- case ISO7816_ERASE_BINARY :snprintf(exp, size, "ERASE BIN");break;
- case ISO7816_READ_RECORDS :snprintf(exp, size, "READ RECORDS");break;
- case ISO7816_WRITE_RECORDS :snprintf(exp, size, "WRITE RECORDS");break;
- case ISO7816_APPEND_RECORD :snprintf(exp, size, "APPEND RECORD");break;
- case ISO7816_UPDATE_RECORD :snprintf(exp, size, "UPDATE RECORD");break;
- case ISO7816_GET_DATA :snprintf(exp, size, "GET DATA");break;
- case ISO7816_PUT_DATA :snprintf(exp, size, "PUT DATA");break;
- case ISO7816_SELECT_FILE :snprintf(exp, size, "SELECT FILE");break;
- case ISO7816_VERIFY :snprintf(exp, size, "VERIFY");break;
- case ISO7816_INTERNAL_AUTHENTICATION :snprintf(exp, size, "INTERNAL AUTH");break;
- case ISO7816_EXTERNAL_AUTHENTICATION :snprintf(exp, size, "EXTERNAL AUTH");break;
- case ISO7816_GET_CHALLENGE :snprintf(exp, size, "GET CHALLENGE");break;
- case ISO7816_MANAGE_CHANNEL :snprintf(exp, size, "MANAGE CHANNEL");break;
- default :snprintf(exp, size, "?"); break;
- }
- }
+int CmdSmartList(const char *Cmd) {
+ CmdHFList("7816");
+ return 0;
}
+int CmdSmartBruteforceSFI(const char *Cmd) {
-uint16_t printScTraceLine(uint16_t tracepos, uint16_t traceLen, uint8_t *trace) {
- // sanity check
- if (tracepos + sizeof(uint32_t) + sizeof(uint16_t) + sizeof(uint16_t) > traceLen) return traceLen;
-
- bool isResponse;
- uint16_t data_len, parity_len;
- uint32_t duration, timestamp, first_timestamp, EndOfTransmissionTimestamp;
- char explanation[30] = {0};
-
- first_timestamp = *((uint32_t *)(trace));
- timestamp = *((uint32_t *)(trace + tracepos));
- tracepos += 4;
+ char ctmp = tolower(param_getchar(Cmd, 0));
+ if (ctmp == 'h') return usage_sm_brute();
- duration = *((uint16_t *)(trace + tracepos));
- tracepos += 2;
+ uint8_t data[5] = {0x00, 0xB2, 0x00, 0x00, 0x00};
- data_len = *((uint16_t *)(trace + tracepos));
- tracepos += 2;
-
- if (data_len & 0x8000) {
- data_len &= 0x7fff;
- isResponse = true;
- } else {
- isResponse = false;
- }
-
- parity_len = (data_len-1)/8 + 1;
- if (tracepos + data_len + parity_len > traceLen) {
- return traceLen;
- }
- uint8_t *frame = trace + tracepos;
- tracepos += data_len;
- //uint8_t *parityBytes = trace + tracepos;
- tracepos += parity_len;
-
- //--- Draw the data column
- char line[18][110];
-
- if (data_len == 0 ) {
- sprintf(line[0],"<empty trace - possible error>");
- return tracepos;
- }
-
- for (int j = 0; j < data_len && j/18 < 18; j++) {
- snprintf(line[j/18]+(( j % 18) * 4),110, "%02x ", frame[j]);
- }
-
- EndOfTransmissionTimestamp = timestamp + duration;
-
- annotateIso7816(explanation,sizeof(explanation),frame,data_len);
-
- int num_lines = MIN((data_len - 1)/18 + 1, 18);
- for (int j = 0; j < num_lines ; j++) {
- if (j == 0) {
- PrintAndLog(" %10u | %10u | %s |%-72s | %s| %s",
- (timestamp - first_timestamp),
- (EndOfTransmissionTimestamp - first_timestamp),
- (isResponse ? "Tag" : "Rdr"),
- line[j],
- " ",
- (j == num_lines-1) ? explanation : "");
- } else {
- PrintAndLog(" | | |%-72s | %s| %s",
- line[j],
- " ",
- (j == num_lines-1) ? explanation : "");
- }
+ PrintAndLogEx(INFO, "Selecting card");
+ if ( !smart_select(false) ) {
+ return 1;
}
- // if is last record
- if (tracepos + sizeof(uint32_t) + sizeof(uint16_t) + sizeof(uint16_t) >= traceLen) return traceLen;
+ PrintAndLogEx(INFO, "Selecting PPSE aid");
+ CmdSmartRaw("d 00a404000e325041592e5359532e444446303100");
+ CmdSmartRaw("d 00a4040007a000000004101000");
- return tracepos;
-}
+ PrintAndLogEx(INFO, "starting");
-int ScTraceList(const char *Cmd) {
- bool loadFromFile = false;
- bool saveToFile = false;
- char type[5] = {0};
- char filename[FILE_PATH_SIZE] = {0};
+ UsbCommand c = {CMD_SMART_RAW, {SC_RAW, sizeof(data), 0}};
+ uint8_t* buf = malloc(USB_CMD_DATA_SIZE);
+ if ( !buf )
+ return 1;
- // parse command line
- param_getstr(Cmd, 0, type, sizeof(type));
- param_getstr(Cmd, 1, filename, sizeof(filename));
+ for (uint8_t i=1; i < 4; i++) {
+ for (int p1=1; p1 < 5; p1++) {
- bool errors = false;
- if(type[0] == 'h') {
- errors = true;
- }
+ data[2] = p1;
+ data[3] = (i << 3) + 4;
- if(!errors) {
- if (strcmp(type, "s") == 0) {
- saveToFile = true;
- } else if (strcmp(type,"l") == 0) {
- loadFromFile = true;
- }
- }
+ memcpy(c.d.asBytes, data, sizeof(data) );
+ clearCommandBuffer();
+ SendCommand(&c);
- if ((loadFromFile || saveToFile) && strlen(filename) == 0) {
- errors = true;
- }
+ smart_response(data[1], buf);
- if (loadFromFile && saveToFile) {
- errors = true;
- }
+ // if 0x6C
+ if ( buf[0] == 0x6C ) {
+ data[4] = buf[1];
- if (errors) {
- PrintAndLog("List or save protocol data.");
- PrintAndLog("Usage: sc list [l <filename>]");
- PrintAndLog(" sc list [s <filename>]");
- PrintAndLog(" l - load data from file instead of trace buffer");
- PrintAndLog(" s - save data to file");
- PrintAndLog("");
- PrintAndLog("example: sc list");
- PrintAndLog("example: sc list save myCardTrace.trc");
- PrintAndLog("example: sc list l myCardTrace.trc");
- return 0;
- }
+ memcpy(c.d.asBytes, data, sizeof(data) );
+ clearCommandBuffer();
+ SendCommand(&c);
+ uint8_t len = smart_response(data[1], buf);
- uint8_t *trace;
- uint32_t tracepos = 0;
- uint32_t traceLen = 0;
+ // TLV decoder
+ if (len > 4)
+ TLVPrintFromBuffer(buf+1, len-3);
- if (loadFromFile) {
- #define TRACE_CHUNK_SIZE (1<<16) // 64K to start with. Will be enough for BigBuf and some room for future extensions
- FILE *tracefile = NULL;
- size_t bytes_read;
- trace = malloc(TRACE_CHUNK_SIZE);
- if (trace == NULL) {
- PrintAndLog("Cannot allocate memory for trace");
- return 2;
- }
- if ((tracefile = fopen(filename,"rb")) == NULL) {
- PrintAndLog("Could not open file %s", filename);
- free(trace);
- return 0;
- }
- while (!feof(tracefile)) {
- bytes_read = fread(trace+traceLen, 1, TRACE_CHUNK_SIZE, tracefile);
- traceLen += bytes_read;
- if (!feof(tracefile)) {
- uint8_t *p = realloc(trace, traceLen + TRACE_CHUNK_SIZE);
- if (p == NULL) {
- PrintAndLog("Cannot allocate memory for trace");
- free(trace);
- fclose(tracefile);
- return 2;
- }
- trace = p;
+ data[4] = 0;
}
- }
- fclose(tracefile);
- } else {
- trace = malloc(USB_CMD_DATA_SIZE);
- // Query for the size of the trace
- UsbCommand response;
- GetFromBigBuf(trace, USB_CMD_DATA_SIZE, 0, &response, -1, false);
- traceLen = response.arg[2];
- if (traceLen > USB_CMD_DATA_SIZE) {
- uint8_t *p = realloc(trace, traceLen);
- if (p == NULL) {
- PrintAndLog("Cannot allocate memory for trace");
- free(trace);
- return 2;
- }
- trace = p;
- GetFromBigBuf(trace, traceLen, 0, NULL, -1, false);
- }
- }
-
- if (saveToFile) {
- FILE *tracefile = NULL;
- if ((tracefile = fopen(filename,"wb")) == NULL) {
- PrintAndLog("Could not create file %s", filename);
- return 1;
- }
- fwrite(trace, 1, traceLen, tracefile);
- PrintAndLog("Recorded Activity (TraceLen = %d bytes) written to file %s", traceLen, filename);
- fclose(tracefile);
- } else {
- PrintAndLog("Recorded Activity (TraceLen = %d bytes)", traceLen);
- PrintAndLog("");
- PrintAndLog("Start = Start of Start Bit, End = End of last modulation. Src = Source of Transfer");
- PrintAndLog("");
- PrintAndLog(" Start | End | Src | Data (! denotes parity error) | CRC | Annotation |");
- PrintAndLog("------------|------------|-----|-------------------------------------------------------------------------|-----|--------------------|");
-
- while(tracepos < traceLen)
- {
- tracepos = printScTraceLine(tracepos, traceLen, trace);
+ memset(buf, 0x00, USB_CMD_DATA_SIZE);
}
}
-
- free(trace);
- return 0;
-}
-
-int CmdSmartList(const char *Cmd) {
- ScTraceList(Cmd);
+ free(buf);
return 0;
}
static command_t CommandTable[] = {
- {"help", CmdHelp, 1, "This help"},
- {"list", CmdSmartList, 0, "List ISO 7816 history"},
- {"info", CmdSmartInfo, 1, "Tag information [rdv40]"},
- {"reader", CmdSmartReader, 1, "Act like an IS07816 reader [rdv40]"},
- {"raw", CmdSmartRaw, 1, "Send raw hex data to tag [rdv40]"},
- {"upgrade", CmdSmartUpgrade, 1, "Upgrade firmware [rdv40]"},
- {"setclock",CmdSmartSetClock, 1, "Set clock speed"},
- {NULL, NULL, 0, NULL}
+ {"help", CmdHelp, 1, "This help"},
+ {"list", CmdSmartList, 0, "List ISO 7816 history"},
+ {"info", CmdSmartInfo, 0, "Tag information"},
+ {"reader", CmdSmartReader, 0, "Act like an IS07816 reader"},
+ {"raw", CmdSmartRaw, 0, "Send raw hex data to tag"},
+ {"upgrade", CmdSmartUpgrade, 0, "Upgrade firmware"},
+ {"setclock", CmdSmartSetClock, 0, "Set clock speed"},
+ {"brute", CmdSmartBruteforceSFI, 0, "Bruteforce SFI"},
+ {NULL, NULL, 0, NULL}
};
int CmdSmartcard(const char *Cmd) {
projects / proxmark3-svn / blobdiff