|
|
@@ -63,23 +63,44 @@ void seader_ccid_GetSlotStatus(SeaderUartBridge* seader_uart, uint8_t slot) {
|
|
|
void seader_ccid_SetParameters(Seader* seader, uint8_t slot, uint8_t* atr, size_t atr_len) {
|
|
|
SeaderWorker* seader_worker = seader->worker;
|
|
|
SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
- UNUSED(slot);
|
|
|
- UNUSED(atr);
|
|
|
UNUSED(atr_len);
|
|
|
- uint8_t T1 = 1;
|
|
|
+ FURI_LOG_D(TAG, "seader_ccid_SetParameters(%d)", slot);
|
|
|
+
|
|
|
+ uint8_t payloadLen = 0;
|
|
|
+ if(seader_uart->T == 0) {
|
|
|
+ payloadLen = 5;
|
|
|
+ } else if(atr[4] == 0xB1 && seader_uart->T == 1) {
|
|
|
+ payloadLen = 7;
|
|
|
+ }
|
|
|
memset(seader_uart->tx_buf, 0, SEADER_UART_RX_BUF_SIZE);
|
|
|
seader_uart->tx_buf[0] = SYNC;
|
|
|
seader_uart->tx_buf[1] = CTRL;
|
|
|
seader_uart->tx_buf[2 + 0] = CCID_MESSAGE_TYPE_PC_to_RDR_SetParameters;
|
|
|
- seader_uart->tx_buf[2 + 1] = 0;
|
|
|
- seader_uart->tx_buf[2 + 5] = sam_slot;
|
|
|
- seader_uart->tx_buf[2 + 6] = getSequence(sam_slot);
|
|
|
- seader_uart->tx_buf[2 + 7] = T1;
|
|
|
+ seader_uart->tx_buf[2 + 1] = payloadLen;
|
|
|
+ seader_uart->tx_buf[2 + 5] = slot;
|
|
|
+ seader_uart->tx_buf[2 + 6] = getSequence(slot);
|
|
|
+ seader_uart->tx_buf[2 + 7] = seader_uart->T;
|
|
|
seader_uart->tx_buf[2 + 8] = 0;
|
|
|
seader_uart->tx_buf[2 + 9] = 0;
|
|
|
|
|
|
- seader_uart->tx_len = seader_add_lrc(seader_uart->tx_buf, 2 + 10);
|
|
|
+ if(seader_uart->T == 0) {
|
|
|
+ // I'm leaving this here for completeness, but it was actually causing ICC_MUTE on the first apdu.
|
|
|
+ seader_uart->tx_buf[2 + 10] = 0x96; //atr[2]; //bmFindexDindex
|
|
|
+ seader_uart->tx_buf[2 + 11] = 0x00; //bmTCCKST1
|
|
|
+ seader_uart->tx_buf[2 + 12] = 0x00; //bGuardTimeT0
|
|
|
+ seader_uart->tx_buf[2 + 13] = 0x0a; //bWaitingIntegerT0
|
|
|
+ seader_uart->tx_buf[2 + 14] = 0x00; //bClockStop
|
|
|
+ } else if(seader_uart->T == 1) {
|
|
|
+ seader_uart->tx_buf[2 + 10] = atr[2]; //bmFindexDindex
|
|
|
+ seader_uart->tx_buf[2 + 11] = 0x10; //bmTCCKST1
|
|
|
+ seader_uart->tx_buf[2 + 12] = 0xfe; //bGuardTimeT1
|
|
|
+ seader_uart->tx_buf[2 + 13] = atr[6]; //bWaitingIntegerT1
|
|
|
+ seader_uart->tx_buf[2 + 14] = atr[8]; //bClockStop
|
|
|
+ seader_uart->tx_buf[2 + 15] = atr[5]; //bIFSC
|
|
|
+ seader_uart->tx_buf[2 + 16] = 0x00; //bNadValue
|
|
|
+ }
|
|
|
|
|
|
+ seader_uart->tx_len = seader_add_lrc(seader_uart->tx_buf, 2 + 10 + payloadLen);
|
|
|
furi_thread_flags_set(furi_thread_get_id(seader_uart->tx_thread), WorkerEvtSamRx);
|
|
|
}
|
|
|
|
|
|
@@ -121,14 +142,17 @@ void seader_ccid_XfrBlockToSlot(
|
|
|
seader_uart->tx_buf[2 + 8] = 0;
|
|
|
seader_uart->tx_buf[2 + 9] = 0;
|
|
|
|
|
|
- memcpy(seader_uart->tx_buf + 2 + 10, data, len);
|
|
|
- seader_uart->tx_len = seader_add_lrc(seader_uart->tx_buf, 2 + 10 + len);
|
|
|
+ uint8_t header_len = 2 + 10;
|
|
|
+ memcpy(seader_uart->tx_buf + header_len, data, len);
|
|
|
+ seader_uart->tx_len = header_len + len;
|
|
|
+ seader_uart->tx_len = seader_add_lrc(seader_uart->tx_buf, seader_uart->tx_len);
|
|
|
|
|
|
- char display[SEADER_UART_RX_BUF_SIZE * 2 + 1] = {0};
|
|
|
+ char* display = malloc(seader_uart->tx_len * 2 + 1);
|
|
|
for(uint8_t i = 0; i < seader_uart->tx_len; i++) {
|
|
|
snprintf(display + (i * 2), sizeof(display), "%02x", seader_uart->tx_buf[i]);
|
|
|
}
|
|
|
- FURI_LOG_D(TAG, "seader_ccid_XfrBlock %d bytes: %s", seader_uart->tx_len, display);
|
|
|
+ FURI_LOG_D(TAG, "seader_ccid_XfrBlockToSlot(%d) %d: %s", slot, seader_uart->tx_len, display);
|
|
|
+ free(display);
|
|
|
|
|
|
furi_thread_flags_set(furi_thread_get_id(seader_uart->tx_thread), WorkerEvtSamRx);
|
|
|
}
|
|
|
@@ -139,11 +163,12 @@ size_t seader_ccid_process(Seader* seader, uint8_t* cmd, size_t cmd_len) {
|
|
|
CCID_Message message;
|
|
|
message.consumed = 0;
|
|
|
|
|
|
- char display[SEADER_UART_RX_BUF_SIZE * 2 + 1] = {0};
|
|
|
+ char* display = malloc(cmd_len * 2 + 1);
|
|
|
for(uint8_t i = 0; i < cmd_len; i++) {
|
|
|
snprintf(display + (i * 2), sizeof(display), "%02x", cmd[i]);
|
|
|
}
|
|
|
FURI_LOG_D(TAG, "seader_ccid_process %d: %s", cmd_len, display);
|
|
|
+ free(display);
|
|
|
|
|
|
if(cmd_len == 2) {
|
|
|
if(cmd[0] == CCID_MESSAGE_TYPE_RDR_to_PC_NotifySlotChange) {
|
|
|
@@ -230,11 +255,6 @@ size_t seader_ccid_process(Seader* seader, uint8_t* cmd, size_t cmd_len) {
|
|
|
message.bError = ccid[8];
|
|
|
message.payload = ccid + 10;
|
|
|
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < message.dwLength; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", message.payload[i]);
|
|
|
- }
|
|
|
-
|
|
|
if(cmd_len < 2 + 10 + message.dwLength + 1) {
|
|
|
// Incomplete
|
|
|
return message.consumed;
|
|
|
@@ -251,27 +271,6 @@ size_t seader_ccid_process(Seader* seader, uint8_t* cmd, size_t cmd_len) {
|
|
|
return message.consumed;
|
|
|
}
|
|
|
|
|
|
- /*
|
|
|
- if(message.dwLength == 0) {
|
|
|
- FURI_LOG_D(
|
|
|
- TAG,
|
|
|
- "CCID [%d|%d] type: %02x, status: %02x, error: %02x",
|
|
|
- message.bSlot,
|
|
|
- message.bSeq,
|
|
|
- message.bMessageType,
|
|
|
- message.bStatus,
|
|
|
- message.bError);
|
|
|
- } else {
|
|
|
- FURI_LOG_D(
|
|
|
- TAG,
|
|
|
- "CCID [%d|%d] %ld: %s",
|
|
|
- message.bSlot,
|
|
|
- message.bSeq,
|
|
|
- message.dwLength,
|
|
|
- display);
|
|
|
- }
|
|
|
- */
|
|
|
-
|
|
|
//0306 81 00000000 0000 0200 01 87
|
|
|
//0306 81 00000000 0000 0100 01 84
|
|
|
if(message.bMessageType == CCID_MESSAGE_TYPE_RDR_to_PC_SlotStatus) {
|
|
|
@@ -319,10 +318,25 @@ size_t seader_ccid_process(Seader* seader, uint8_t* cmd, size_t cmd_len) {
|
|
|
return message.consumed;
|
|
|
}
|
|
|
|
|
|
- if(message.bMessageType == CCID_MESSAGE_TYPE_RDR_to_PC_DataBlock) {
|
|
|
+ if(message.bMessageType == CCID_MESSAGE_TYPE_RDR_to_PC_Parameters) {
|
|
|
+ FURI_LOG_D(TAG, "Got Parameters");
|
|
|
+ if(seader_uart->T == 1) {
|
|
|
+ seader_t_1_set_IFSD(seader);
|
|
|
+ } else {
|
|
|
+ seader_worker_send_version(seader);
|
|
|
+ if(seader_worker->callback) {
|
|
|
+ seader_worker->callback(SeaderWorkerEventSamPresent, seader_worker->context);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ } else if(message.bMessageType == CCID_MESSAGE_TYPE_RDR_to_PC_DataBlock) {
|
|
|
if(hasSAM) {
|
|
|
if(message.bSlot == sam_slot) {
|
|
|
- seader_worker_process_sam_message(seader, message.payload, message.dwLength);
|
|
|
+ if(seader_uart->T == 0) {
|
|
|
+ seader_worker_process_sam_message(
|
|
|
+ seader, message.payload, message.dwLength);
|
|
|
+ } else if(seader_uart->T == 1) {
|
|
|
+ seader_recv_t1(seader, &message);
|
|
|
+ }
|
|
|
} else {
|
|
|
FURI_LOG_D(TAG, "Discarding message on non-sam slot");
|
|
|
}
|
|
|
@@ -331,20 +345,18 @@ size_t seader_ccid_process(Seader* seader, uint8_t* cmd, size_t cmd_len) {
|
|
|
FURI_LOG_I(TAG, "SAM ATR!");
|
|
|
hasSAM = true;
|
|
|
sam_slot = message.bSlot;
|
|
|
- seader_worker_send_version(seader);
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(
|
|
|
- SeaderWorkerEventSamPresent, seader_worker->context);
|
|
|
+ if(seader_uart->T == 0) {
|
|
|
+ seader_ccid_GetParameters(seader_uart);
|
|
|
+ } else if(seader_uart->T == 1) {
|
|
|
+ seader_ccid_SetParameters(
|
|
|
+ seader, sam_slot, message.payload, message.dwLength);
|
|
|
}
|
|
|
} else if(memcmp(SAM_ATR2, message.payload, sizeof(SAM_ATR2)) == 0) {
|
|
|
FURI_LOG_I(TAG, "SAM ATR2!");
|
|
|
hasSAM = true;
|
|
|
sam_slot = message.bSlot;
|
|
|
- seader_worker_send_version(seader);
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(
|
|
|
- SeaderWorkerEventSamPresent, seader_worker->context);
|
|
|
- }
|
|
|
+ // I don't have an ATR2 to test with
|
|
|
+ seader_ccid_GetParameters(seader_uart);
|
|
|
} else {
|
|
|
FURI_LOG_W(TAG, "Unknown ATR");
|
|
|
if(seader_worker->callback) {
|
|
|
@@ -353,7 +365,7 @@ size_t seader_ccid_process(Seader* seader, uint8_t* cmd, size_t cmd_len) {
|
|
|
}
|
|
|
}
|
|
|
} else {
|
|
|
- FURI_LOG_W(TAG, "Unhandled CCID message type %d", message.bMessageType);
|
|
|
+ FURI_LOG_W(TAG, "Unhandled CCID message type %02x", message.bMessageType);
|
|
|
}
|
|
|
}
|
|
|
|