#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 "cmdhw.h"
+#include "cmdhflist.h"
#include "emv/apduinfo.h" // APDUcode description
#include "emv/emvcore.h" // decodeTVL
+#include "crypto/libpcrypto.h" // sha512hash
#include "emv/dump.h" // dump_buffer
+#include "pcsc.h"
+#define SC_UPGRADE_FILES_DIRECTORY "sc_upgrade_firmware/"
+
+static bool UseAlternativeSmartcardReader = false; // default: use PM3 RDV40 Smartcard Slot (if available)
static int CmdHelp(const char *Cmd);
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, " a : active smartcard without select (reset sc module)");
+ PrintAndLogEx(NORMAL, " s : active smartcard with select (get ATR)");
PrintAndLogEx(NORMAL, " t : executes TLV decoder if it possible");
+ PrintAndLogEx(NORMAL, " 0 : use protocol T=0");
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");
+ PrintAndLogEx(NORMAL, " sc raw s 0 d 00a404000e315041592e5359532e4444463031 - `1PAY.SYS.DDF01` PSE directory with get ATR");
+ return 0;
+}
+
+static int usage_sm_select(void) {
+ PrintAndLogEx(NORMAL, "Usage: sc select [h|<reader name>] ");
+ PrintAndLogEx(NORMAL, " h : this help");
+ PrintAndLogEx(NORMAL, " <reader name> : a card reader's name, wildcards allowed, leave empty to pick from available readers");
+ PrintAndLogEx(NORMAL, "");
+ PrintAndLogEx(NORMAL, "Examples:");
+ PrintAndLogEx(NORMAL, " sc select : list available card readers and pick");
+ PrintAndLogEx(NORMAL, " sc select Gemalto* : select a connected Gemalto card reader" );
return 0;
}
}
static int usage_sm_upgrade(void) {
- PrintAndLogEx(NORMAL, "Upgrade firmware");
+ 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 myfile");
+ PrintAndLogEx(NORMAL, " sc upgrade f SIM010.BIN");
return 0;
}
0 // b1111 RFU
};
-int GetATRDi(uint8_t *atr, size_t atrlen) {
+static 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) {
+static 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) {
+static 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;
+ uint8_t TD1 = 0, T1len = 0, TD1len = 0, TDilen = 0;
+ bool protocol_T0_present = true;
+ bool protocol_T15_present = false;
if (T0 & 0x10) {
- PrintAndLog("TA1 (Maximum clock frequency, proposed bit duration): 0x%02x", atr[2 + T1len]);
+ PrintAndLog("\t- 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]);
+ PrintAndLog("\t- 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]);
+ PrintAndLog("\t- 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);
+ PrintAndLog("\t- TD1 (First offered transmission protocol, presence of TA2..TD2) [ 0x%02x ] Protocol T%d", TD1, TD1 & 0x0f);
+ protocol_T0_present = false;
+ if ((TD1 & 0x0f) == 0) {
+ protocol_T0_present = true;
+ }
+ if ((TD1 & 0x0f) == 15) {
+ protocol_T15_present = true;
+ }
+
T1len++;
if (TD1 & 0x10) {
- PrintAndLog("TA2 (Specific protocol and parameters to be used after the ATR): 0x%02x", atr[2 + T1len + TD1len]);
+ PrintAndLog("\t- 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]);
+ PrintAndLog("\t- 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]);
+ PrintAndLog("\t- 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);
+ PrintAndLog("\t- TD2 (A supported protocol or more global parameters, presence of TA3..TD3) [ 0x%02x ] Protocol T%d", TDi, TDi & 0x0f);
+ if ((TDi & 0x0f) == 0) {
+ protocol_T0_present = true;
+ }
+ if ((TDi & 0x0f) == 15) {
+ protocol_T15_present = true;
+ }
TD1len++;
bool nextCycle = true;
while (nextCycle) {
nextCycle = false;
if (TDi & 0x10) {
- PrintAndLog("TA%d: 0x%02x", vi, atr[2 + T1len + TD1len + TDilen]);
+ PrintAndLog("\t- 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]);
+ PrintAndLog("\t- 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]);
+ PrintAndLog("\t- 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);
+ PrintAndLog("\t- TD%d [ 0x%02x ] Protocol T%d", vi, TDi, TDi & 0x0f);
TDilen++;
nextCycle = true;
}
}
+ if (!protocol_T0_present || protocol_T15_present) { // there is CRC Check Byte TCK
+ uint8_t vxor = 0;
+ for (int i = 1; i < atrlen; i++)
+ vxor ^= atr[i];
+
+ if (vxor)
+ PrintAndLogEx(WARNING, "Check sum error. Must be 0 got 0x%02X", vxor);
+ else
+ PrintAndLogEx(INFO, "Check sum OK.");
+ }
+
+ if (atr[0] != 0x3b)
+ PrintAndLogEx(WARNING, "Not a direct convention [ 0x%02x ]", atr[0]);
+
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]);
+ PrintAndLogEx(INFO, "\nHistorical bytes | len %02d | format %02x", K, atr[2 + T1len + TD1len + TDilen]);
+
if (K > 1) {
- PrintAndLog("Historical bytes:");
+ PrintAndLogEx(INFO, "\tHistorical bytes");
dump_buffer(&atr[2 + T1len + TD1len + TDilen], K, NULL, 1);
}
return 0;
}
+bool smart_getATR(smart_card_atr_t *card)
+{
+ if (UseAlternativeSmartcardReader) {
+ return pcscGetATR(card);
+ } else {
+ UsbCommand c = {CMD_SMART_ATR, {0, 0, 0}};
+ SendCommand(&c);
-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;
+ UsbCommand resp;
+ if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
+ return false;
+ }
+
+ if (resp.arg[0] & 0xff) {
+ return resp.arg[0] & 0xFF;
+ }
+
+ memcpy(card, (smart_card_atr_t *)resp.d.asBytes, sizeof(smart_card_atr_t));
+
+ return true;
}
+}
- uint8_t isok = resp.arg[0] & 0xFF;
- if (!isok) {
+static bool smart_select(bool silent) {
+
+ smart_card_atr_t card;
+ if (!smart_getATR(&card)) {
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) {
+static void smart_transmit(uint8_t *data, uint32_t data_len, uint32_t flags, uint8_t *response, int *response_len, uint32_t max_response_len)
+{
+ // PrintAndLogEx(SUCCESS, "C-TPDU>>>> %s", sprint_hex(data, data_len));
+ if (UseAlternativeSmartcardReader) {
+ *response_len = max_response_len;
+ pcscTransmit(data, data_len, flags, response, response_len);
+ } else {
+ UsbCommand c = {CMD_SMART_RAW, {flags, data_len, 0}};
+ memcpy(c.d.asBytes, data, data_len);
+ SendCommand(&c);
- int datalen = smart_wait(data);
- bool needGetData = false;
+ if (!WaitForResponseTimeout(CMD_ACK, &c, 2500)) {
+ PrintAndLogEx(WARNING, "smart card response timeout");
+ *response_len = -1;
+ return;
+ }
- if (datalen < 2 ) {
- goto out;
+ *response_len = c.arg[0];
+ if (*response_len > 0) {
+ memcpy(response, c.d.asBytes, *response_len);
+ }
}
- 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 (*response_len <= 0) {
+ PrintAndLogEx(WARNING, "smart card response failed");
+ *response_len = -2;
+ return;
}
- if ( data[datalen - 2] == 0x61 || data[datalen - 2] == 0x9F ) {
- needGetData = true;
+ if (*response_len < 2) {
+ // PrintAndLogEx(SUCCESS, "R-TPDU %02X | ", response[0]);
+ return;
}
- 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);
+ // PrintAndLogEx(SUCCESS, "R-TPDU<<<< %s", sprint_hex(response, *response_len));
+ // PrintAndLogEx(SUCCESS, "R-TPDU SW %02X%02X | %s", response[*response_len-2], response[*response_len-1], GetAPDUCodeDescription(response[*response_len-2], response[*response_len-1]));
+}
- 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);
- }
+static int CmdSmartSelect(const char *Cmd)
+{
+ const char *readername;
+
+ if (tolower(param_getchar(Cmd, 0)) == 'h') {
+ return usage_sm_select();
}
-
- if (datalen > 2) {
- datalen--;
- memmove(data, &data[1], datalen);
+
+ if (!PM3hasSmartcardSlot() && !pcscCheckForCardReaders()) {
+ PrintAndLogEx(WARNING, "No Smartcard Readers available");
+ UseAlternativeSmartcardReader = false;
+ return 1;
}
- out:
- return datalen;
+
+ int bg, en;
+ if (param_getptr(Cmd, &bg, &en, 0)) {
+ UseAlternativeSmartcardReader = pcscSelectAlternativeCardReader(NULL);
+ } else {
+ readername = Cmd + bg;
+ UseAlternativeSmartcardReader = pcscSelectAlternativeCardReader(readername);
+ }
+
+ return 0;
}
-int CmdSmartRaw(const char *Cmd) {
+
+static int CmdSmartRaw(const char *Cmd) {
int hexlen = 0;
bool active = false;
bool active_select = false;
+ bool useT0 = false;
uint8_t cmdp = 0;
bool errors = false, reply = true, decodeTLV = false, breakloop = false;
- uint8_t data[USB_CMD_DATA_SIZE] = {0x00};
+ uint8_t data[ISO7816_MAX_FRAME_SIZE] = {0x00};
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
decodeTLV = true;
cmdp++;
break;
+ case '0':
+ useT0 = true;
+ cmdp++;
+ break;
case 'd': {
switch (param_gethex_to_eol(Cmd, cmdp+1, data, sizeof(data), &hexlen)) {
case 1:
//Validations
if (errors || cmdp == 0 ) return usage_sm_raw();
- // arg0 = RFU flags
- // arg1 = length
- UsbCommand c = {CMD_SMART_RAW, {0, hexlen, 0}};
-
+ uint32_t flags = 0;
+ uint32_t protocol = 0;
if (active || active_select) {
- c.arg[0] |= SC_CONNECT;
+ flags |= SC_CONNECT;
if (active_select)
- c.arg[0] |= SC_SELECT;
+ flags |= SC_SELECT;
}
-
if (hexlen > 0) {
- c.arg[0] |= SC_RAW;
+ if (useT0)
+ protocol = SC_RAW_T0;
+ else
+ protocol = SC_RAW;
+ }
+
+ int response_len = 0;
+ uint8_t *response = NULL;
+ if (reply) {
+ response = calloc(ISO7816_MAX_FRAME_SIZE, sizeof(uint8_t));
+ if ( !response )
+ return 1;
}
-
- memcpy(c.d.asBytes, data, hexlen );
- clearCommandBuffer();
- SendCommand(&c);
+
+ smart_transmit(data, hexlen, flags|protocol, response, &response_len, ISO7816_MAX_FRAME_SIZE);
// reading response from smart card
if ( reply ) {
-
- 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);
+ if ( response_len < 0 ) {
+ free(response);
return 2;
}
- if ( buf[0] == 0x6C ) {
- data[4] = buf[1];
-
- memcpy(c.d.asBytes, data, sizeof(data) );
- clearCommandBuffer();
- SendCommand(&c);
- len = smart_response(data[1], buf);
-
+ if ( response[0] == 0x6C ) {
+ data[4] = response[1];
+ smart_transmit(data, hexlen, protocol, response, &response_len, ISO7816_MAX_FRAME_SIZE);
data[4] = 0;
}
- if (decodeTLV && len > 4)
- TLVPrintFromBuffer(buf+1, len-3);
+ if (decodeTLV && response_len > 4)
+ TLVPrintFromBuffer(response, response_len-2);
- free(buf);
+ free(response);
}
return 0;
}
-int ExchangeAPDUSC(uint8_t *datain, int datainlen, bool activateCard, bool leaveSignalON, uint8_t *dataout, int maxdataoutlen, int *dataoutlen) {
- *dataoutlen = 0;
+
+int ExchangeAPDUSC(uint8_t *APDU, int APDUlen, bool activateCard, bool leaveSignalON, uint8_t *response, int maxresponselen, int *responselen)
+{
+ uint8_t TPDU[ISO7816_MAX_FRAME_SIZE];
+
+ *responselen = 0;
if (activateCard)
smart_select(false);
- printf("* APDU SC\n");
- UsbCommand c = {CMD_SMART_RAW, {SC_RAW | SC_CONNECT, datainlen, 0}};
+ uint32_t flags = SC_RAW_T0;
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;
+ flags |= SC_SELECT | SC_CONNECT;
+ }
+
+ if (APDUlen == 4) { // Case 1
+ memcpy(TPDU, APDU, 4);
+ TPDU[4] = 0x00;
+ smart_transmit(TPDU, 5, flags, response, responselen, maxresponselen);
+ } else if (APDUlen == 5) { // Case 2 Short
+ smart_transmit(APDU, 5, flags, response, responselen, maxresponselen);
+ if (response[0] == 0x6C) { // wrong Le
+ uint16_t Le = APDU[4] ? APDU[4] : 256;
+ uint8_t La = response[1];
+ memcpy(TPDU, APDU, 5);
+ TPDU[4] = La;
+ smart_transmit(TPDU, 5, SC_RAW_T0, response, responselen, maxresponselen);
+ if (Le < La && *responselen >= 0) {
+ response[Le] = response[*responselen-2];
+ response[Le+1] = response[*responselen-1];
+ *responselen = Le + 2;
+ }
+ }
+ } else if (APDU[4] != 0 && APDUlen == 5 + APDU[4]) { // Case 3 Short
+ smart_transmit(APDU, APDUlen, flags, response, responselen, maxresponselen);
+ } else if (APDU[4] != 0 && APDUlen == 5 + APDU[4] + 1) { // Case 4 Short
+ smart_transmit(APDU, APDUlen-1, flags, response, responselen, maxresponselen);
+ if (response[0] == 0x90 && response[1] == 0x00) {
+ uint8_t Le = APDU[APDUlen-1];
+ uint8_t get_response[5] = {0x00, ISO7816_GET_RESPONSE, 0x00, 0x00, Le};
+ return ExchangeAPDUSC(get_response, 5, false, leaveSignalON, response, maxresponselen, responselen);
+ }
+ } else { // Long Cases not yet implemented
+ PrintAndLogEx(ERR, "Long APDUs not yet implemented");
+ *responselen = -3;
}
-
- // 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);
+ if (*responselen < 0 ) {
+ return 1;
+ } else {
+ return 0;
}
- *dataoutlen = len;
-
- return 0;
}
-int CmdSmartUpgrade(const char *Cmd) {
+static int CmdSmartUpgrade(const char *Cmd) {
- PrintAndLogEx(WARNING, "WARNING - Smartcard socket firmware upgrade.");
+ 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};
//Validations
if (errors || cmdp == 0 ) return usage_sm_upgrade();
- // load file
- f = fopen(filename, "rb");
+ 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, "File: %s: not found or locked.", filename);
+ 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) {
- PrintAndLogEx(WARNING, "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) {
- PrintAndLogEx(WARNING, "error, cannot allocate memory ");
+ PrintAndLogEx(FAILED, "Could not allocate memory for firmware");
+ fclose(f);
+ return 1;
+ }
+
+ size_t firmware_size = fread(dump, 1, fsize, f);
+ if (f)
+ fclose(f);
+
+ // 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;
}
- size_t bytes_read = fread(dump, 1, fsize, f);
+ char hashstring[129];
+ size_t bytes_read = fread(hashstring, 1, 128, f);
+ hashstring[128] = '\0';
+
if (f)
fclose(f);
- PrintAndLogEx(SUCCESS, "Smartcard socket firmware uploading to PM3");
+ 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);
}
free(dump);
printf("\n");
- PrintAndLogEx(SUCCESS, "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;
return 1;
}
if ( (resp.arg[0] & 0xFF ) )
- PrintAndLogEx(SUCCESS, "Smartcard socket firmware upgraded successful");
+ PrintAndLogEx(SUCCESS, "RDV4.0 Smartcard Socket Firmware upgraded successful");
else
- PrintAndLogEx(FAILED, "Smartcard socket firmware updating failed");
+ PrintAndLogEx(FAILED, "RDV4.0 Smartcard Socket Firmware Upgrade failed");
return 0;
}
-int CmdSmartInfo(const char *Cmd){
+
+static int CmdSmartInfo(const char *Cmd){
uint8_t cmdp = 0;
bool errors = false, silent = false;
//Validations
if (errors ) return usage_sm_info();
- UsbCommand c = {CMD_SMART_ATR, {0, 0, 0}};
- clearCommandBuffer();
- SendCommand(&c);
- UsbCommand resp;
- if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
+ smart_card_atr_t card;
+ if (!smart_getATR(&card)) {
if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
return 1;
}
-
- uint8_t isok = resp.arg[0] & 0xFF;
- if (!isok) {
- if (!silent) PrintAndLogEx(WARNING, "smart card select failed");
+
+ if (!card.atr_len) {
+ if (!silent) PrintAndLogEx(ERR, "can't get ATR from a smart card");
return 1;
}
- smart_card_atr_t card;
- memcpy(&card, (smart_card_atr_t *)resp.d.asBytes, sizeof(smart_card_atr_t));
-
// print header
- PrintAndLogEx(INFO, "\n--- Smartcard Information ---------");
+ PrintAndLogEx(INFO, "--- 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) );
+ PrintAndLogEx(INFO, "ISO7618-3 ATR : %s", sprint_hex(card.atr, card.atr_len));
+ PrintAndLogEx(INFO, "\nhttp://smartcard-atr.appspot.com/parse?ATR=%s", sprint_hex_inrow(card.atr, card.atr_len) );
// print ATR
PrintAndLogEx(NORMAL, "");
- PrintAndLogEx(NORMAL, "* ATR:");
+ PrintAndLogEx(INFO, "ATR");
PrintATR(card.atr, card.atr_len);
// print D/F (brom byte TA1 or defaults)
PrintAndLogEx(NORMAL, "");
- PrintAndLogEx(NORMAL, "* D/F (TA1):");
+ PrintAndLogEx(INFO, "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);
+ PrintAndLogEx(NORMAL, "\t- Di=%d", Di);
+ PrintAndLogEx(NORMAL, "\t- Fi=%d", Fi);
+ PrintAndLogEx(NORMAL, "\t- F=%.1f MHz", F);
+
+ if (Di && Fi) {
+ PrintAndLogEx(NORMAL, "\t- Cycles/ETU=%d", Fi/Di);
+ PrintAndLogEx(NORMAL, "\t- %.1f bits/sec at 4MHz", (float)4000000 / (Fi/Di));
+ PrintAndLogEx(NORMAL, "\t- %.1f bits/sec at Fmax=%.1fMHz", (F * 1000000) / (Fi/Di), F);
+ } else {
+ PrintAndLogEx(WARNING, "\t- Di or Fi is RFU.");
+ };
return 0;
}
//Validations
if (errors ) return usage_sm_reader();
- 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 1;
- }
-
- uint8_t isok = resp.arg[0] & 0xFF;
- if (!isok) {
+ smart_card_atr_t card;
+ if (!smart_getATR(&card)) {
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));
PrintAndLogEx(INFO, "ISO7816-3 ATR : %s", sprint_hex(card.atr, card.atr_len));
return 0;
}
-int CmdSmartSetClock(const char *Cmd){
+
+static int CmdSmartSetClock(const char *Cmd){
uint8_t cmdp = 0;
bool errors = false;
uint8_t clock = 0;
return 0;
}
-int CmdSmartList(const char *Cmd) {
- CmdHFList("7816");
+
+static int CmdSmartList(const char *Cmd) {
+ if (UseAlternativeSmartcardReader) {
+ CmdHFList("7816 p");
+ } else {
+ CmdHFList("7816");
+ }
return 0;
}
-int CmdSmartBruteforceSFI(const char *Cmd) {
+
+static int CmdSmartBruteforceSFI(const char *Cmd) {
char ctmp = tolower(param_getchar(Cmd, 0));
if (ctmp == 'h') return usage_sm_brute();
return 1;
}
- PrintAndLogEx(INFO, "Selecting PPSE aid");
- CmdSmartRaw("d 00a404000e325041592e5359532e444446303100");
- CmdSmartRaw("d 00a4040007a000000004101000");
+ PrintAndLogEx(INFO, "Selecting PSE aid");
+ CmdSmartRaw("s 0 t d 00a404000e325041592e5359532e4444463031");
+ CmdSmartRaw("0 t d 00a4040007a000000004101000"); // mastercard
+// CmdSmartRaw("0 t d 00a4040007a0000000031010"); // visa
PrintAndLogEx(INFO, "starting");
- UsbCommand c = {CMD_SMART_RAW, {SC_RAW, sizeof(data), 0}};
- uint8_t* buf = malloc(USB_CMD_DATA_SIZE);
- if ( !buf )
+ int response_len = 0;
+ uint8_t* response = malloc(ISO7816_MAX_FRAME_SIZE);
+ if (!response)
return 1;
for (uint8_t i=1; i < 4; i++) {
data[2] = p1;
data[3] = (i << 3) + 4;
- memcpy(c.d.asBytes, data, sizeof(data) );
- clearCommandBuffer();
- SendCommand(&c);
-
- smart_response(data[1], buf);
-
- // if 0x6C
- if ( buf[0] == 0x6C ) {
- data[4] = buf[1];
+ smart_transmit(data, sizeof(data), SC_RAW_T0, response, &response_len, ISO7816_MAX_FRAME_SIZE);
- memcpy(c.d.asBytes, data, sizeof(data) );
- clearCommandBuffer();
- SendCommand(&c);
- uint8_t len = smart_response(data[1], buf);
+ if ( response[0] == 0x6C ) {
+ data[4] = response[1];
+ smart_transmit(data, sizeof(data), SC_RAW_T0, response, &response_len, ISO7816_MAX_FRAME_SIZE);
// TLV decoder
- if (len > 4)
- TLVPrintFromBuffer(buf+1, len-3);
+ if (response_len > 4)
+ TLVPrintFromBuffer(response+1, response_len-3);
data[4] = 0;
}
- memset(buf, 0x00, USB_CMD_DATA_SIZE);
+ memset(response, 0x00, ISO7816_MAX_FRAME_SIZE);
}
}
- free(buf);
+ free(response);
return 0;
}
static command_t CommandTable[] = {
- {"help", CmdHelp, 1, "This help"},
- {"list", CmdSmartList, 0, "List ISO 7816 history"},
- {"info", CmdSmartInfo, 1, "Tag information"},
- {"reader", CmdSmartReader, 1, "Act like an IS07816 reader"},
- {"raw", CmdSmartRaw, 1, "Send raw hex data to tag"},
- {"upgrade", CmdSmartUpgrade, 1, "Upgrade firmware"},
- {"setclock", CmdSmartSetClock, 1, "Set clock speed"},
- {"brute", CmdSmartBruteforceSFI, 1, "Bruteforce SFI"},
- {NULL, NULL, 0, NULL}
+ {"help", CmdHelp, 1, "This help"},
+ {"select", CmdSmartSelect, 1, "Select the Smartcard Reader to use"},
+ {"list", CmdSmartList, 1, "List ISO 7816 history"},
+ {"info", CmdSmartInfo, 1, "Tag information"},
+ {"reader", CmdSmartReader, 1, "Act like an IS07816 reader"},
+ {"raw", CmdSmartRaw, 1, "Send raw hex data to tag"},
+ {"upgrade", CmdSmartUpgrade, 0, "Upgrade firmware"},
+ {"setclock", CmdSmartSetClock, 1, "Set clock speed"},
+ {"brute", CmdSmartBruteforceSFI, 1, "Bruteforce SFI"},
+ {NULL, NULL, 0, NULL}
};
+
int CmdSmartcard(const char *Cmd) {
clearCommandBuffer();
CmdsParse(CommandTable, Cmd);
return 0;
}
-int CmdHelp(const char *Cmd) {
+
+static int CmdHelp(const char *Cmd) {
CmdsHelp(CommandTable);
return 0;
}
projects / proxmark3-svn / blobdiff