|
|
@@ -1,7 +1,6 @@
|
|
|
#include "seader_worker_i.h"
|
|
|
|
|
|
#include <flipper_format/flipper_format.h>
|
|
|
-#include <lib/nfc/protocols/nfc_util.h>
|
|
|
#include <lib/lfrfid/tools/bit_lib.h>
|
|
|
|
|
|
#define TAG "SeaderWorker"
|
|
|
@@ -17,52 +16,11 @@
|
|
|
// TODO: const
|
|
|
uint8_t GET_RESPONSE[] = {0x00, 0xc0, 0x00, 0x00, 0xff};
|
|
|
|
|
|
-char payloadDebug[384] = {0};
|
|
|
char display[SEADER_UART_RX_BUF_SIZE * 2 + 1] = {0};
|
|
|
-char asn1_log[SEADER_UART_RX_BUF_SIZE] = {0};
|
|
|
-bool requestPacs = true;
|
|
|
|
|
|
// Forward declaration
|
|
|
void seader_send_card_detected(SeaderUartBridge* seader_uart, CardDetails_t* cardDetails);
|
|
|
|
|
|
-static void seader_worker_enable_field() {
|
|
|
- furi_hal_nfc_ll_txrx_on();
|
|
|
- furi_hal_nfc_exit_sleep();
|
|
|
- furi_hal_nfc_ll_poll();
|
|
|
-}
|
|
|
-
|
|
|
-static ReturnCode seader_worker_disable_field(ReturnCode rc) {
|
|
|
- furi_hal_nfc_ll_txrx_off();
|
|
|
- furi_hal_nfc_start_sleep();
|
|
|
- return rc;
|
|
|
-}
|
|
|
-
|
|
|
-static uint16_t seader_worker_picopass_update_ccitt(uint16_t crcSeed, uint8_t dataByte) {
|
|
|
- uint16_t crc = crcSeed;
|
|
|
- uint8_t dat = dataByte;
|
|
|
-
|
|
|
- dat ^= (uint8_t)(crc & 0xFFU);
|
|
|
- dat ^= (dat << 4);
|
|
|
-
|
|
|
- crc = (crc >> 8) ^ (((uint16_t)dat) << 8) ^ (((uint16_t)dat) << 3) ^ (((uint16_t)dat) >> 4);
|
|
|
-
|
|
|
- return crc;
|
|
|
-}
|
|
|
-
|
|
|
-static uint16_t seader_worker_picopass_calculate_ccitt(
|
|
|
- uint16_t preloadValue,
|
|
|
- const uint8_t* buf,
|
|
|
- uint16_t length) {
|
|
|
- uint16_t crc = preloadValue;
|
|
|
- uint16_t index;
|
|
|
-
|
|
|
- for(index = 0; index < length; index++) {
|
|
|
- crc = seader_worker_picopass_update_ccitt(crc, buf[index]);
|
|
|
- }
|
|
|
-
|
|
|
- return crc;
|
|
|
-}
|
|
|
-
|
|
|
/***************************** Seader Worker API *******************************/
|
|
|
|
|
|
SeaderWorker* seader_worker_alloc() {
|
|
|
@@ -71,6 +29,8 @@ SeaderWorker* seader_worker_alloc() {
|
|
|
// Worker thread attributes
|
|
|
seader_worker->thread =
|
|
|
furi_thread_alloc_ex("SeaderWorker", 8192, seader_worker_task, seader_worker);
|
|
|
+ seader_worker->messages = furi_message_queue_alloc(3, sizeof(SeaderAPDU));
|
|
|
+ seader_worker->mq_mutex = furi_mutex_alloc(FuriMutexTypeNormal);
|
|
|
|
|
|
seader_worker->callback = NULL;
|
|
|
seader_worker->context = NULL;
|
|
|
@@ -86,6 +46,8 @@ void seader_worker_free(SeaderWorker* seader_worker) {
|
|
|
furi_assert(seader_worker);
|
|
|
|
|
|
furi_thread_free(seader_worker->thread);
|
|
|
+ furi_message_queue_free(seader_worker->messages);
|
|
|
+ furi_mutex_free(seader_worker->mq_mutex);
|
|
|
|
|
|
furi_record_close(RECORD_STORAGE);
|
|
|
|
|
|
@@ -100,17 +62,15 @@ void seader_worker_start(
|
|
|
SeaderWorker* seader_worker,
|
|
|
SeaderWorkerState state,
|
|
|
SeaderUartBridge* uart,
|
|
|
- SeaderCredential* credential,
|
|
|
SeaderWorkerCallback callback,
|
|
|
void* context) {
|
|
|
furi_assert(seader_worker);
|
|
|
furi_assert(uart);
|
|
|
- furi_assert(credential);
|
|
|
|
|
|
+ seader_worker->stage = SeaderPollerEventTypeCardDetect;
|
|
|
seader_worker->callback = callback;
|
|
|
seader_worker->context = context;
|
|
|
seader_worker->uart = uart;
|
|
|
- seader_worker->credential = credential;
|
|
|
seader_worker_change_state(seader_worker, state);
|
|
|
furi_thread_start(seader_worker->thread);
|
|
|
}
|
|
|
@@ -121,7 +81,6 @@ void seader_worker_stop(SeaderWorker* seader_worker) {
|
|
|
seader_worker->state == SeaderWorkerStateReady) {
|
|
|
return;
|
|
|
}
|
|
|
- seader_worker_disable_field(ERR_NONE);
|
|
|
|
|
|
seader_worker_change_state(seader_worker, SeaderWorkerStateStop);
|
|
|
furi_thread_join(seader_worker->thread);
|
|
|
@@ -133,758 +92,39 @@ void seader_worker_change_state(SeaderWorker* seader_worker, SeaderWorkerState s
|
|
|
|
|
|
/***************************** Seader Worker Thread *******************************/
|
|
|
|
|
|
-void* calloc(size_t count, size_t size) {
|
|
|
- return malloc(count * size);
|
|
|
-}
|
|
|
-
|
|
|
-void seader_nfc_scene_field_on_enter() {
|
|
|
- furi_hal_nfc_field_on();
|
|
|
- furi_hal_nfc_exit_sleep();
|
|
|
-}
|
|
|
-
|
|
|
-void seader_nfc_scene_field_on_exit() {
|
|
|
- furi_hal_nfc_sleep();
|
|
|
- furi_hal_nfc_field_off();
|
|
|
-}
|
|
|
+bool seader_process_success_response(Seader* seader, uint8_t* apdu, size_t len) {
|
|
|
+ SeaderWorker* seader_worker = seader->worker;
|
|
|
|
|
|
-bool seader_send_apdu(
|
|
|
- SeaderUartBridge* seader_uart,
|
|
|
- uint8_t CLA,
|
|
|
- uint8_t INS,
|
|
|
- uint8_t P1,
|
|
|
- uint8_t P2,
|
|
|
- uint8_t* payload,
|
|
|
- uint8_t length) {
|
|
|
- if(APDU_HEADER_LEN + length > SEADER_UART_RX_BUF_SIZE) {
|
|
|
- FURI_LOG_E(TAG, "Cannot send message, too long: %d", APDU_HEADER_LEN + length);
|
|
|
- return false;
|
|
|
- }
|
|
|
-
|
|
|
- uint8_t* apdu = malloc(APDU_HEADER_LEN + length);
|
|
|
- apdu[0] = CLA;
|
|
|
- apdu[1] = INS;
|
|
|
- apdu[2] = P1;
|
|
|
- apdu[3] = P2;
|
|
|
- apdu[4] = length;
|
|
|
- memcpy(apdu + APDU_HEADER_LEN, payload, length);
|
|
|
-
|
|
|
- seader_ccid_XfrBlock(seader_uart, apdu, APDU_HEADER_LEN + length);
|
|
|
- free(apdu);
|
|
|
- return true;
|
|
|
-}
|
|
|
-
|
|
|
-static int seader_asn_to_string(const void* buffer, size_t size, void* app_key) {
|
|
|
- if(app_key) {
|
|
|
- char* str = (char*)app_key;
|
|
|
- size_t next = strlen(str);
|
|
|
- strncpy(str + next, buffer, size);
|
|
|
- } else {
|
|
|
- uint8_t next = strlen(asn1_log);
|
|
|
- strncpy(asn1_log + next, buffer, size);
|
|
|
- }
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_mf_df_check_card_type(uint8_t ATQA0, uint8_t ATQA1, uint8_t SAK) {
|
|
|
- return ATQA0 == 0x44 && ATQA1 == 0x03 && SAK == 0x20;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_mf_classic_check_card_type(uint8_t ATQA0, uint8_t ATQA1, uint8_t SAK) {
|
|
|
- if((ATQA0 == 0x44 || ATQA0 == 0x04) && (SAK == 0x08 || SAK == 0x88 || SAK == 0x09)) {
|
|
|
- return true;
|
|
|
- } else if((ATQA0 == 0x01) && (ATQA1 == 0x0F) && (SAK == 0x01)) {
|
|
|
- //skylanders support
|
|
|
- return true;
|
|
|
- } else if((ATQA0 == 0x42 || ATQA0 == 0x02) && (SAK == 0x18)) {
|
|
|
- return true;
|
|
|
+ if(seader_process_success_response_i(seader, apdu, len, false, NULL)) {
|
|
|
+ // no-op, message was processed
|
|
|
} else {
|
|
|
- return false;
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_read_nfc(SeaderUartBridge* seader_uart) {
|
|
|
- FuriHalNfcDevData nfc_data = {};
|
|
|
- bool rtn = false;
|
|
|
- if(furi_hal_nfc_detect(&nfc_data, 300)) {
|
|
|
- // Process first found device
|
|
|
- if(nfc_data.type == FuriHalNfcTypeA) {
|
|
|
- FURI_LOG_D(TAG, "NFC-A detected");
|
|
|
- CardDetails_t* cardDetails = 0;
|
|
|
- cardDetails = calloc(1, sizeof *cardDetails);
|
|
|
- assert(cardDetails);
|
|
|
-
|
|
|
- OCTET_STRING_fromBuf(&cardDetails->csn, (const char*)nfc_data.uid, nfc_data.uid_len);
|
|
|
- uint8_t protocolBytes[] = {0x00, FrameProtocol_nfc};
|
|
|
- OCTET_STRING_fromBuf(
|
|
|
- &cardDetails->protocol, (const char*)protocolBytes, sizeof(protocolBytes));
|
|
|
-
|
|
|
- OCTET_STRING_t sak = {.buf = &(nfc_data.sak), .size = 1};
|
|
|
- cardDetails->sak = &sak;
|
|
|
-
|
|
|
- uint8_t fake_seos_ats[] = {0x78, 0x77, 0x80, 0x02};
|
|
|
- uint8_t fake_desfire_ats[] = {0x75, 0x77, 0x81, 0x02, 0x80};
|
|
|
- if(seader_mf_df_check_card_type(nfc_data.atqa[0], nfc_data.atqa[1], nfc_data.sak)) {
|
|
|
- FURI_LOG_D(TAG, "Desfire");
|
|
|
- OCTET_STRING_t atqa = {.buf = fake_desfire_ats, .size = sizeof(fake_desfire_ats)};
|
|
|
- cardDetails->atqa = &atqa;
|
|
|
- seader_send_card_detected(seader_uart, cardDetails);
|
|
|
- rtn = true;
|
|
|
- } else if(seader_mf_classic_check_card_type(
|
|
|
- nfc_data.atqa[0], nfc_data.atqa[1], nfc_data.sak)) {
|
|
|
- FURI_LOG_D(TAG, "MFC");
|
|
|
- seader_send_card_detected(seader_uart, cardDetails);
|
|
|
- rtn = true;
|
|
|
- } else if(nfc_data.interface == FuriHalNfcInterfaceIsoDep) {
|
|
|
- FURI_LOG_D(TAG, "ISO-DEP");
|
|
|
- OCTET_STRING_t atqa = {.buf = fake_seos_ats, .size = sizeof(fake_seos_ats)};
|
|
|
- cardDetails->atqa = &atqa;
|
|
|
- seader_send_card_detected(seader_uart, cardDetails);
|
|
|
- rtn = true;
|
|
|
- }
|
|
|
- ASN_STRUCT_FREE(asn_DEF_CardDetails, cardDetails);
|
|
|
- }
|
|
|
- }
|
|
|
- return rtn;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_detect_nfc(SeaderWorker* seader_worker) {
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
-
|
|
|
- while(seader_worker->state == SeaderWorkerStateRead14a) {
|
|
|
- // Card found
|
|
|
- if(seader_read_nfc(seader_uart)) {
|
|
|
- return true;
|
|
|
- }
|
|
|
-
|
|
|
- furi_delay_ms(100);
|
|
|
- }
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-void seader_send_payload(
|
|
|
- SeaderUartBridge* seader_uart,
|
|
|
- Payload_t* payload,
|
|
|
- uint8_t to,
|
|
|
- uint8_t from,
|
|
|
- uint8_t replyTo) {
|
|
|
- uint8_t rBuffer[SEADER_UART_RX_BUF_SIZE] = {0};
|
|
|
-
|
|
|
- asn_enc_rval_t er = der_encode_to_buffer(
|
|
|
- &asn_DEF_Payload, payload, rBuffer + ASN1_PREFIX, sizeof(rBuffer) - ASN1_PREFIX);
|
|
|
-
|
|
|
-#ifdef ASN1_DEBUG
|
|
|
- if(er.encoded > -1) {
|
|
|
- memset(payloadDebug, 0, sizeof(payloadDebug));
|
|
|
- (&asn_DEF_Payload)
|
|
|
- ->op->print_struct(&asn_DEF_Payload, payload, 1, seader_asn_to_string, payloadDebug);
|
|
|
- if(strlen(payloadDebug) > 0) {
|
|
|
- FURI_LOG_D(TAG, "Sending payload[%d %d %d]: %s", to, from, replyTo, payloadDebug);
|
|
|
- }
|
|
|
- }
|
|
|
-#endif
|
|
|
- //0xa0, 0xda, 0x02, 0x63, 0x00, 0x00, 0x0a,
|
|
|
- //0x44, 0x0a, 0x44, 0x00, 0x00, 0x00, 0xa0, 0x02, 0x96, 0x00
|
|
|
- rBuffer[0] = to;
|
|
|
- rBuffer[1] = from;
|
|
|
- rBuffer[2] = replyTo;
|
|
|
-
|
|
|
- seader_send_apdu(seader_uart, 0xA0, 0xDA, 0x02, 0x63, rBuffer, 6 + er.encoded);
|
|
|
-}
|
|
|
-
|
|
|
-void seader_send_response(
|
|
|
- SeaderUartBridge* seader_uart,
|
|
|
- Response_t* response,
|
|
|
- uint8_t to,
|
|
|
- uint8_t from,
|
|
|
- uint8_t replyTo) {
|
|
|
- Payload_t* payload = 0;
|
|
|
- payload = calloc(1, sizeof *payload);
|
|
|
- assert(payload);
|
|
|
-
|
|
|
- payload->present = Payload_PR_response;
|
|
|
- payload->choice.response = *response;
|
|
|
-
|
|
|
- seader_send_payload(seader_uart, payload, to, from, replyTo);
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_Payload, payload);
|
|
|
-}
|
|
|
-
|
|
|
-void sendRequestPacs(SeaderUartBridge* seader_uart) {
|
|
|
- RequestPacs_t* requestPacs = 0;
|
|
|
- requestPacs = calloc(1, sizeof *requestPacs);
|
|
|
- assert(requestPacs);
|
|
|
-
|
|
|
- requestPacs->contentElementTag = ContentElementTag_implicitFormatPhysicalAccessBits;
|
|
|
-
|
|
|
- SamCommand_t* samCommand = 0;
|
|
|
- samCommand = calloc(1, sizeof *samCommand);
|
|
|
- assert(samCommand);
|
|
|
-
|
|
|
- samCommand->present = SamCommand_PR_requestPacs;
|
|
|
- samCommand->choice.requestPacs = *requestPacs;
|
|
|
-
|
|
|
- Payload_t* payload = 0;
|
|
|
- payload = calloc(1, sizeof *payload);
|
|
|
- assert(payload);
|
|
|
-
|
|
|
- payload->present = Payload_PR_samCommand;
|
|
|
- payload->choice.samCommand = *samCommand;
|
|
|
-
|
|
|
- seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_RequestPacs, requestPacs);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_Payload, payload);
|
|
|
-}
|
|
|
-
|
|
|
-void seader_worker_send_version(SeaderWorker* seader_worker) {
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
- SamCommand_t* samCommand = 0;
|
|
|
- samCommand = calloc(1, sizeof *samCommand);
|
|
|
- assert(samCommand);
|
|
|
-
|
|
|
- samCommand->present = SamCommand_PR_version;
|
|
|
-
|
|
|
- Payload_t* payload = 0;
|
|
|
- payload = calloc(1, sizeof *payload);
|
|
|
- assert(payload);
|
|
|
-
|
|
|
- payload->present = Payload_PR_samCommand;
|
|
|
- payload->choice.samCommand = *samCommand;
|
|
|
-
|
|
|
- seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_Payload, payload);
|
|
|
-}
|
|
|
-
|
|
|
-void seader_send_card_detected(SeaderUartBridge* seader_uart, CardDetails_t* cardDetails) {
|
|
|
- CardDetected_t* cardDetected = 0;
|
|
|
- cardDetected = calloc(1, sizeof *cardDetected);
|
|
|
- assert(cardDetected);
|
|
|
-
|
|
|
- cardDetected->detectedCardDetails = *cardDetails;
|
|
|
-
|
|
|
- SamCommand_t* samCommand = 0;
|
|
|
- samCommand = calloc(1, sizeof *samCommand);
|
|
|
- assert(samCommand);
|
|
|
-
|
|
|
- samCommand->present = SamCommand_PR_cardDetected;
|
|
|
- samCommand->choice.cardDetected = *cardDetected;
|
|
|
-
|
|
|
- Payload_t* payload = 0;
|
|
|
- payload = calloc(1, sizeof *payload);
|
|
|
- assert(payload);
|
|
|
-
|
|
|
- payload->present = Payload_PR_samCommand;
|
|
|
- payload->choice.samCommand = *samCommand;
|
|
|
-
|
|
|
- seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_CardDetected, cardDetected);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_Payload, payload);
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_unpack_pacs(
|
|
|
- SeaderWorker* seader_worker,
|
|
|
- SeaderCredential* seader_credential,
|
|
|
- uint8_t* buf,
|
|
|
- size_t size) {
|
|
|
- PAC_t* pac = 0;
|
|
|
- pac = calloc(1, sizeof *pac);
|
|
|
- assert(pac);
|
|
|
- bool rtn = false;
|
|
|
-
|
|
|
- asn_dec_rval_t rval = asn_decode(0, ATS_DER, &asn_DEF_PAC, (void**)&pac, buf, size);
|
|
|
-
|
|
|
- if(rval.code == RC_OK) {
|
|
|
- char pacDebug[384] = {0};
|
|
|
- (&asn_DEF_PAC)->op->print_struct(&asn_DEF_PAC, pac, 1, seader_asn_to_string, pacDebug);
|
|
|
- if(strlen(pacDebug) > 0) {
|
|
|
- FURI_LOG_D(TAG, "Received pac: %s", pacDebug);
|
|
|
-
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- if(seader_credential->sio[0] == 0x30) {
|
|
|
- for(uint8_t i = 0; i < sizeof(seader_credential->sio); i++) {
|
|
|
- snprintf(
|
|
|
- display + (i * 2), sizeof(display), "%02x", seader_credential->sio[i]);
|
|
|
- }
|
|
|
- FURI_LOG_D(TAG, "SIO %s", display);
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- if(pac->size <= sizeof(seader_credential->credential)) {
|
|
|
- // TODO: make credential into a 12 byte array
|
|
|
- seader_credential->bit_length = pac->size * 8 - pac->bits_unused;
|
|
|
- memcpy(&seader_credential->credential, pac->buf, pac->size);
|
|
|
- seader_credential->credential = __builtin_bswap64(seader_credential->credential);
|
|
|
- seader_credential->credential = seader_credential->credential >>
|
|
|
- (64 - seader_credential->bit_length);
|
|
|
- rtn = true;
|
|
|
- } else {
|
|
|
- // PACS too big (probably bad data)
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
|
|
|
- }
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_PAC, pac);
|
|
|
- return rtn;
|
|
|
-}
|
|
|
-
|
|
|
-// 800201298106683d052026b6820101
|
|
|
-//300F800201298106683D052026B6820101
|
|
|
-bool seader_parse_version(SeaderWorker* seader_worker, uint8_t* buf, size_t size) {
|
|
|
- SamVersion_t* version = 0;
|
|
|
- version = calloc(1, sizeof *version);
|
|
|
- assert(version);
|
|
|
-
|
|
|
- bool rtn = false;
|
|
|
- if(size > 30) {
|
|
|
- // Too large to handle now
|
|
|
- FURI_LOG_W(TAG, "Version of %d is to long to parse", size);
|
|
|
- return false;
|
|
|
- }
|
|
|
- // Add sequence prefix
|
|
|
- uint8_t seq[32] = {0x30};
|
|
|
- seq[1] = (uint8_t)size;
|
|
|
- memcpy(seq + 2, buf, size);
|
|
|
-
|
|
|
- asn_dec_rval_t rval =
|
|
|
- asn_decode(0, ATS_DER, &asn_DEF_SamVersion, (void**)&version, seq, size + 2);
|
|
|
-
|
|
|
- if(rval.code == RC_OK) {
|
|
|
- char versionDebug[128] = {0};
|
|
|
- (&asn_DEF_SamVersion)
|
|
|
- ->op->print_struct(
|
|
|
- &asn_DEF_SamVersion, version, 1, seader_asn_to_string, versionDebug);
|
|
|
- if(strlen(versionDebug) > 0) {
|
|
|
- FURI_LOG_D(TAG, "Received version: %s", versionDebug);
|
|
|
- }
|
|
|
- if(version->version.size == 2) {
|
|
|
- memcpy(seader_worker->sam_version, version->version.buf, version->version.size);
|
|
|
- }
|
|
|
-
|
|
|
- rtn = true;
|
|
|
- }
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_SamVersion, version);
|
|
|
- return rtn;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_parse_sam_response(SeaderWorker* seader_worker, SamResponse_t* samResponse) {
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
- SeaderCredential* credential = seader_worker->credential;
|
|
|
-
|
|
|
- if(samResponse->size == 0) {
|
|
|
- if(requestPacs) {
|
|
|
- // FURI_LOG_D(TAG, "samResponse %d => requesting PACS", samResponse->size);
|
|
|
- sendRequestPacs(seader_uart);
|
|
|
- requestPacs = false;
|
|
|
- } else {
|
|
|
- // FURI_LOG_D(TAG, "samResponse %d, no action", samResponse->size);
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
|
|
|
+ FURI_LOG_I(TAG, "Queue New SAM Message, %d bytes", len);
|
|
|
+ uint32_t space = furi_message_queue_get_space(seader_worker->messages);
|
|
|
+ if(space > 0) {
|
|
|
+ SeaderAPDU seaderApdu = {};
|
|
|
+ seaderApdu.len = len;
|
|
|
+ memcpy(seaderApdu.buf, apdu, len);
|
|
|
+
|
|
|
+ if(furi_mutex_acquire(seader_worker->mq_mutex, FuriWaitForever) == FuriStatusOk) {
|
|
|
+ furi_message_queue_put(seader_worker->messages, &seaderApdu, FuriWaitForever);
|
|
|
+ furi_mutex_release(seader_worker->mq_mutex);
|
|
|
}
|
|
|
}
|
|
|
- } else if(seader_parse_version(seader_worker, samResponse->buf, samResponse->size)) {
|
|
|
- // no-op
|
|
|
- } else if(seader_unpack_pacs(seader_worker, credential, samResponse->buf, samResponse->size)) {
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(SeaderWorkerEventSuccess, seader_worker->context);
|
|
|
- }
|
|
|
- } else {
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < samResponse->size; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", samResponse->buf[i]);
|
|
|
- }
|
|
|
- FURI_LOG_D(TAG, "unknown samResponse %d: %s", samResponse->size, display);
|
|
|
}
|
|
|
-
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_parse_response(SeaderWorker* seader_worker, Response_t* response) {
|
|
|
- switch(response->present) {
|
|
|
- case Response_PR_samResponse:
|
|
|
- seader_parse_sam_response(seader_worker, &response->choice.samResponse);
|
|
|
- break;
|
|
|
- default:
|
|
|
- break;
|
|
|
- };
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-void seader_send_nfc_rx(SeaderUartBridge* seader_uart, uint8_t* buffer, size_t len) {
|
|
|
- OCTET_STRING_t rxData = {.buf = buffer, .size = len};
|
|
|
- uint8_t status[] = {0x00, 0x00};
|
|
|
- RfStatus_t rfStatus = {.buf = status, .size = 2};
|
|
|
-
|
|
|
- NFCRx_t* nfcRx = 0;
|
|
|
- nfcRx = calloc(1, sizeof *nfcRx);
|
|
|
- assert(nfcRx);
|
|
|
-
|
|
|
- nfcRx->rfStatus = rfStatus;
|
|
|
- nfcRx->data = &rxData;
|
|
|
-
|
|
|
- NFCResponse_t* nfcResponse = 0;
|
|
|
- nfcResponse = calloc(1, sizeof *nfcResponse);
|
|
|
- assert(nfcResponse);
|
|
|
-
|
|
|
- nfcResponse->present = NFCResponse_PR_nfcRx;
|
|
|
- nfcResponse->choice.nfcRx = *nfcRx;
|
|
|
-
|
|
|
- Response_t* response = 0;
|
|
|
- response = calloc(1, sizeof *response);
|
|
|
- assert(response);
|
|
|
-
|
|
|
- response->present = Response_PR_nfcResponse;
|
|
|
- response->choice.nfcResponse = *nfcResponse;
|
|
|
-
|
|
|
- seader_send_response(seader_uart, response, 0x14, 0x0a, 0x0);
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_NFCRx, nfcRx);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_Response, response);
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_iso14443a_transmit(
|
|
|
- SeaderWorker* seader_worker,
|
|
|
- uint8_t* buffer,
|
|
|
- size_t len,
|
|
|
- uint16_t timeout,
|
|
|
- uint8_t format[3]) {
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
- FuriHalNfcTxRxContext tx_rx = {.tx_rx_type = FuriHalNfcTxRxTypeDefault};
|
|
|
-
|
|
|
- memcpy(&tx_rx.tx_data, buffer, len);
|
|
|
- tx_rx.tx_bits = len * 8;
|
|
|
-
|
|
|
- if(format[0] == 0x00 && format[1] == 0xC0 && format[2] == 0x00) {
|
|
|
- tx_rx.tx_rx_type = FuriHalNfcTxRxTypeRxNoCrc;
|
|
|
- tx_rx.tx_bits -= 16;
|
|
|
- } else if(
|
|
|
- (format[0] == 0x00 && format[1] == 0x00 && format[2] == 0x40) ||
|
|
|
- (format[0] == 0x00 && format[1] == 0x00 && format[2] == 0x24) ||
|
|
|
- (format[0] == 0x00 && format[1] == 0x00 && format[2] == 0x44)) {
|
|
|
- tx_rx.tx_rx_type = FuriHalNfcTxRxTypeRaw;
|
|
|
- tx_rx.tx_bits -= 8;
|
|
|
- tx_rx.tx_parity[0] = 0;
|
|
|
-
|
|
|
- // Don't forget to swap the bits of buffer[8]
|
|
|
- for(size_t i = 0; i < 8 + 1; i++) {
|
|
|
- bit_lib_reverse_bits(buffer + i, 0, 8);
|
|
|
- }
|
|
|
-
|
|
|
- // Pull out parity bits
|
|
|
- for(size_t i = 0; i < 8; i++) {
|
|
|
- bool val = bit_lib_get_bit(buffer + i + 1, i);
|
|
|
- bit_lib_set_bit(tx_rx.tx_parity, i, val);
|
|
|
- }
|
|
|
-
|
|
|
- for(size_t i = 0; i < 8; i++) {
|
|
|
- buffer[i] = (buffer[i] << i) | (buffer[i + 1] >> (8 - i));
|
|
|
- }
|
|
|
-
|
|
|
- for(size_t i = 0; i < 8; i++) {
|
|
|
- bit_lib_reverse_bits(buffer + i, 0, 8);
|
|
|
- tx_rx.tx_data[i] = buffer[i];
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- if(furi_hal_nfc_tx_rx(&tx_rx, timeout)) {
|
|
|
- furi_delay_ms(1);
|
|
|
- size_t length = tx_rx.rx_bits / 8;
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < length; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", tx_rx.rx_data[i]);
|
|
|
- }
|
|
|
- FURI_LOG_D(TAG, "NFC Response %d: %s [%02x]", length, display, tx_rx.rx_parity[0]);
|
|
|
-
|
|
|
- if(tx_rx.tx_rx_type == FuriHalNfcTxRxTypeRaw) {
|
|
|
- for(size_t i = 0; i < length; i++) {
|
|
|
- bit_lib_reverse_bits(tx_rx.rx_data + i, 0, 8);
|
|
|
- }
|
|
|
-
|
|
|
- uint8_t with_parity[FURI_HAL_NFC_DATA_BUFF_SIZE];
|
|
|
- memset(with_parity, 0, sizeof(with_parity));
|
|
|
- length = length + (length / 8) + 1;
|
|
|
-
|
|
|
- uint8_t parts = 1 + length / 9;
|
|
|
- for(size_t p = 0; p < parts; p++) {
|
|
|
- uint8_t doffset = p * 9;
|
|
|
- uint8_t soffset = p * 8;
|
|
|
-
|
|
|
- for(size_t i = 0; i < 9; i++) {
|
|
|
- with_parity[i + doffset] = tx_rx.rx_data[i + soffset] >> i;
|
|
|
- if(i > 0) {
|
|
|
- with_parity[i + doffset] |= tx_rx.rx_data[i + soffset - 1] << (9 - i);
|
|
|
- }
|
|
|
-
|
|
|
- if(i > 0) {
|
|
|
- bool val = bit_lib_get_bit(tx_rx.rx_parity, i - 1);
|
|
|
- bit_lib_set_bit(with_parity + i, i - 1, val);
|
|
|
- }
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- memcpy(tx_rx.rx_data, with_parity, length);
|
|
|
-
|
|
|
- for(size_t i = 0; i < length; i++) {
|
|
|
- bit_lib_reverse_bits(tx_rx.rx_data + i, 0, 8);
|
|
|
- }
|
|
|
-
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
-
|
|
|
- for(uint8_t i = 0; i < length; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", tx_rx.rx_data[i]);
|
|
|
- }
|
|
|
- FURI_LOG_D(
|
|
|
- TAG, "Mutated NFC Response %d: %s [%02x]", length, display, tx_rx.rx_parity[0]);
|
|
|
- }
|
|
|
-
|
|
|
- seader_send_nfc_rx(seader_uart, tx_rx.rx_data, length);
|
|
|
- } else {
|
|
|
- FURI_LOG_W(TAG, "Bad exchange");
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-uint8_t read4Block6[] = {0x06, 0x06, 0x45, 0x56};
|
|
|
-uint8_t read4Block9[] = {0x06, 0x09, 0xB2, 0xAE};
|
|
|
-uint8_t read4Block10[] = {0x06, 0x0A, 0x29, 0x9C};
|
|
|
-uint8_t read4Block13[] = {0x06, 0x0D, 0x96, 0xE8};
|
|
|
-uint8_t updateBlock2[] = {0x87, 0x02};
|
|
|
-
|
|
|
-void seader_capture_sio(
|
|
|
- uint8_t* buffer,
|
|
|
- size_t len,
|
|
|
- uint8_t* rxBuffer,
|
|
|
- SeaderCredential* credential) {
|
|
|
- if(memcmp(buffer, read4Block6, len) == 0 && rxBuffer[0] == 0x30) {
|
|
|
- memcpy(credential->sio, rxBuffer, 32);
|
|
|
- } else if(memcmp(buffer, read4Block10, len) == 0 && rxBuffer[0] == 0x30) {
|
|
|
- memcpy(credential->sio, rxBuffer, 32);
|
|
|
- } else if(memcmp(buffer, read4Block9, len) == 0) {
|
|
|
- memcpy(credential->sio + 32, rxBuffer + 8, 24);
|
|
|
- } else if(memcmp(buffer, read4Block13, len) == 0) {
|
|
|
- memcpy(credential->sio + 32, rxBuffer + 8, 24);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-FuriHalNfcReturn
|
|
|
- seader_worker_fake_epurse_update(uint8_t* buffer, uint8_t* rxBuffer, uint16_t* recvLen) {
|
|
|
- uint8_t fake_response[10];
|
|
|
- memset(fake_response, 0, sizeof(fake_response));
|
|
|
- memcpy(fake_response + 0, buffer + 6, 4);
|
|
|
- memcpy(fake_response + 4, buffer + 2, 4);
|
|
|
-
|
|
|
- uint16_t crc = seader_worker_picopass_calculate_ccitt(0xE012, fake_response, 8);
|
|
|
- memcpy(fake_response + 8, &crc, sizeof(uint16_t));
|
|
|
-
|
|
|
- memcpy(rxBuffer, fake_response, sizeof(fake_response));
|
|
|
- *recvLen = sizeof(fake_response);
|
|
|
-
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < sizeof(fake_response); i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", fake_response[i]);
|
|
|
- }
|
|
|
- FURI_LOG_I(TAG, "Fake update E-Purse response: %s", display);
|
|
|
- return FuriHalNfcReturnOk;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_iso15693_transmit(SeaderWorker* seader_worker, uint8_t* buffer, size_t len) {
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
- SeaderCredential* credential = seader_worker->credential;
|
|
|
- char display[SEADER_UART_RX_BUF_SIZE * 2 + 1] = {0};
|
|
|
- FuriHalNfcReturn ret;
|
|
|
- uint16_t recvLen = 0;
|
|
|
- uint32_t flags = RFAL_PICOPASS_TXRX_FLAGS;
|
|
|
- uint32_t fwt = furi_hal_nfc_ll_ms2fc(20);
|
|
|
-
|
|
|
- uint8_t rxBuffer[64] = {0};
|
|
|
-
|
|
|
- if(memcmp(buffer, updateBlock2, sizeof(updateBlock2)) == 0) {
|
|
|
- ret = seader_worker_fake_epurse_update(buffer, rxBuffer, &recvLen);
|
|
|
- } else {
|
|
|
- ret = furi_hal_nfc_ll_txrx(buffer, len, rxBuffer, sizeof(rxBuffer), &recvLen, flags, fwt);
|
|
|
- }
|
|
|
-
|
|
|
- if(ret == FuriHalNfcReturnOk) {
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < recvLen; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", rxBuffer[i]);
|
|
|
- }
|
|
|
- // FURI_LOG_D(TAG, "Result %d %s", recvLen, display);
|
|
|
- seader_capture_sio(buffer, len, rxBuffer, credential);
|
|
|
- seader_send_nfc_rx(seader_uart, rxBuffer, recvLen);
|
|
|
- } else if(ret == FuriHalNfcReturnCrc) {
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < recvLen; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", rxBuffer[i]);
|
|
|
- }
|
|
|
- // FURI_LOG_D(TAG, "[CRC error] Result %d %s", recvLen, display);
|
|
|
- seader_capture_sio(buffer, len, rxBuffer, credential);
|
|
|
- seader_send_nfc_rx(seader_uart, rxBuffer, recvLen);
|
|
|
-
|
|
|
- // Act as if it was OK
|
|
|
- return true;
|
|
|
- } else {
|
|
|
- FURI_LOG_E(TAG, "furi_hal_nfc_ll_txrx Error %d", ret);
|
|
|
-
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return ret == FuriHalNfcReturnOk;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_parse_nfc_command_transmit(SeaderWorker* seader_worker, NFCSend_t* nfcSend) {
|
|
|
- long timeOut = nfcSend->timeOut;
|
|
|
- Protocol_t protocol = nfcSend->protocol;
|
|
|
- FrameProtocol_t frameProtocol = protocol.buf[1];
|
|
|
-
|
|
|
-#ifdef ASN1_DEBUG
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < nfcSend->data.size; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", nfcSend->data.buf[i]);
|
|
|
- }
|
|
|
-
|
|
|
- char protocolName[8] = {0};
|
|
|
- memset(protocolName, 0, sizeof(protocolName));
|
|
|
- (&asn_DEF_FrameProtocol)
|
|
|
- ->op->print_struct(
|
|
|
- &asn_DEF_FrameProtocol, &frameProtocol, 1, seader_asn_to_string, protocolName);
|
|
|
-
|
|
|
- FURI_LOG_D(
|
|
|
- TAG,
|
|
|
- "Transmit (%ld timeout) %d bytes [%s] via %s",
|
|
|
- timeOut,
|
|
|
- nfcSend->data.size,
|
|
|
- display,
|
|
|
- protocolName);
|
|
|
-#endif
|
|
|
-
|
|
|
- if(frameProtocol == FrameProtocol_iclass) {
|
|
|
- return seader_iso15693_transmit(seader_worker, nfcSend->data.buf, nfcSend->data.size);
|
|
|
- } else if(frameProtocol == FrameProtocol_nfc) {
|
|
|
- return seader_iso14443a_transmit(
|
|
|
- seader_worker,
|
|
|
- nfcSend->data.buf,
|
|
|
- nfcSend->data.size,
|
|
|
- (uint16_t)timeOut,
|
|
|
- nfcSend->format->buf);
|
|
|
- }
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_parse_nfc_off(SeaderUartBridge* seader_uart) {
|
|
|
- FURI_LOG_D(TAG, "Set Field Off");
|
|
|
- seader_worker_disable_field(ERR_NONE);
|
|
|
- seader_nfc_scene_field_on_exit();
|
|
|
-
|
|
|
- NFCResponse_t* nfcResponse = 0;
|
|
|
- nfcResponse = calloc(1, sizeof *nfcResponse);
|
|
|
- assert(nfcResponse);
|
|
|
-
|
|
|
- nfcResponse->present = NFCResponse_PR_nfcAck;
|
|
|
-
|
|
|
- Response_t* response = 0;
|
|
|
- response = calloc(1, sizeof *response);
|
|
|
- assert(response);
|
|
|
-
|
|
|
- response->present = Response_PR_nfcResponse;
|
|
|
- response->choice.nfcResponse = *nfcResponse;
|
|
|
-
|
|
|
- seader_send_response(seader_uart, response, 0x44, 0x0a, 0);
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_Response, response);
|
|
|
- ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
|
|
|
-
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_parse_nfc_command(SeaderWorker* seader_worker, NFCCommand_t* nfcCommand) {
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
- switch(nfcCommand->present) {
|
|
|
- case NFCCommand_PR_nfcSend:
|
|
|
- seader_parse_nfc_command_transmit(seader_worker, &nfcCommand->choice.nfcSend);
|
|
|
- break;
|
|
|
- case NFCCommand_PR_nfcOff:
|
|
|
- seader_parse_nfc_off(seader_uart);
|
|
|
- break;
|
|
|
- default:
|
|
|
- FURI_LOG_W(TAG, "unparsed NFCCommand");
|
|
|
- break;
|
|
|
- };
|
|
|
-
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_worker_state_machine(SeaderWorker* seader_worker, Payload_t* payload) {
|
|
|
- switch(payload->present) {
|
|
|
- case Payload_PR_response:
|
|
|
- seader_parse_response(seader_worker, &payload->choice.response);
|
|
|
- break;
|
|
|
- case Payload_PR_nfcCommand:
|
|
|
- seader_parse_nfc_command(seader_worker, &payload->choice.nfcCommand);
|
|
|
- break;
|
|
|
- case Payload_PR_errorResponse:
|
|
|
- // TODO: screen saying this was a failure, or maybe start over?
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
|
|
|
- }
|
|
|
- break;
|
|
|
- default:
|
|
|
- FURI_LOG_W(TAG, "unhandled payload");
|
|
|
- break;
|
|
|
- };
|
|
|
-
|
|
|
- return false;
|
|
|
-}
|
|
|
-
|
|
|
-bool seader_process_success_response(SeaderWorker* seader_worker, uint8_t* apdu, size_t len) {
|
|
|
- Payload_t* payload = 0;
|
|
|
- payload = calloc(1, sizeof *payload);
|
|
|
- assert(payload);
|
|
|
-
|
|
|
- asn_dec_rval_t rval =
|
|
|
- asn_decode(0, ATS_DER, &asn_DEF_Payload, (void**)&payload, apdu + 6, len - 6);
|
|
|
- if(rval.code == RC_OK) {
|
|
|
-#ifdef ASN1_DEBUG
|
|
|
- memset(payloadDebug, 0, sizeof(payloadDebug));
|
|
|
- (&asn_DEF_Payload)
|
|
|
- ->op->print_struct(&asn_DEF_Payload, payload, 1, seader_asn_to_string, payloadDebug);
|
|
|
- if(strlen(payloadDebug) > 0) {
|
|
|
- FURI_LOG_D(TAG, "Received payload: %s", payloadDebug);
|
|
|
- }
|
|
|
-#endif
|
|
|
- seader_worker_state_machine(seader_worker, payload);
|
|
|
- }
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_Payload, payload);
|
|
|
- return (rval.code == RC_OK);
|
|
|
+ return true;
|
|
|
}
|
|
|
|
|
|
-bool seader_process_apdu(SeaderWorker* seader_worker, uint8_t* apdu, size_t len) {
|
|
|
+bool seader_process_apdu(Seader* seader, uint8_t* apdu, size_t len) {
|
|
|
+ SeaderWorker* seader_worker = seader->worker;
|
|
|
SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
if(len < 2) {
|
|
|
return false;
|
|
|
}
|
|
|
- /*
|
|
|
memset(display, 0, sizeof(display));
|
|
|
for(uint8_t i = 0; i < len; i++) {
|
|
|
snprintf(display + (i * 2), sizeof(display), "%02x", apdu[i]);
|
|
|
}
|
|
|
- FURI_LOG_I(TAG, "APDU: %s", display);
|
|
|
- */
|
|
|
+ // FURI_LOG_I(TAG, "APDU: %s", display);
|
|
|
|
|
|
uint8_t SW1 = apdu[len - 2];
|
|
|
uint8_t SW2 = apdu[len - 1];
|
|
|
@@ -900,7 +140,7 @@ bool seader_process_apdu(SeaderWorker* seader_worker, uint8_t* apdu, size_t len)
|
|
|
case 0x90:
|
|
|
if(SW2 == 0x00) {
|
|
|
if(len > 2) {
|
|
|
- return seader_process_success_response(seader_worker, apdu, len - 2);
|
|
|
+ return seader_process_success_response(seader, apdu, len - 2);
|
|
|
}
|
|
|
}
|
|
|
break;
|
|
|
@@ -909,140 +149,122 @@ bool seader_process_apdu(SeaderWorker* seader_worker, uint8_t* apdu, size_t len)
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
-ReturnCode seader_picopass_card_init(SeaderWorker* seader_worker) {
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
- SeaderCredential* credential = seader_worker->credential;
|
|
|
- rfalPicoPassIdentifyRes idRes;
|
|
|
- rfalPicoPassSelectRes selRes;
|
|
|
-
|
|
|
- ReturnCode err;
|
|
|
-
|
|
|
- err = rfalPicoPassPollerIdentify(&idRes);
|
|
|
- if(err != ERR_NONE) {
|
|
|
- FURI_LOG_E(TAG, "rfalPicoPassPollerIdentify error %d", err);
|
|
|
- return err;
|
|
|
- }
|
|
|
+void seader_worker_process_sam_message(Seader* seader, CCID_Message* message) {
|
|
|
+ // TODO: inline seader_process_apdu
|
|
|
+ seader_process_apdu(seader, message->payload, message->dwLength);
|
|
|
+}
|
|
|
|
|
|
- err = rfalPicoPassPollerSelect(idRes.CSN, &selRes);
|
|
|
- if(err != ERR_NONE) {
|
|
|
- FURI_LOG_E(TAG, "rfalPicoPassPollerSelect error %d", err);
|
|
|
- return err;
|
|
|
- }
|
|
|
+int32_t seader_worker_task(void* context) {
|
|
|
+ SeaderWorker* seader_worker = context;
|
|
|
+ SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < RFAL_PICOPASS_MAX_BLOCK_LEN; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", selRes.CSN[i]);
|
|
|
+ if(seader_worker->state == SeaderWorkerStateCheckSam) {
|
|
|
+ FURI_LOG_D(TAG, "Check for SAM");
|
|
|
+ seader_ccid_check_for_sam(seader_uart);
|
|
|
}
|
|
|
+ seader_worker_change_state(seader_worker, SeaderWorkerStateReady);
|
|
|
|
|
|
- FURI_LOG_D(TAG, "Sending card detected info: %s", display);
|
|
|
-
|
|
|
- CardDetails_t* cardDetails = 0;
|
|
|
- cardDetails = calloc(1, sizeof *cardDetails);
|
|
|
- assert(cardDetails);
|
|
|
-
|
|
|
- uint8_t protocolBytes[] = {0x00, FrameProtocol_iclass};
|
|
|
- OCTET_STRING_fromBuf(
|
|
|
- &cardDetails->protocol, (const char*)protocolBytes, sizeof(protocolBytes));
|
|
|
- OCTET_STRING_fromBuf(&cardDetails->csn, (const char*)selRes.CSN, RFAL_PICOPASS_MAX_BLOCK_LEN);
|
|
|
-
|
|
|
- memcpy(credential->diversifier, selRes.CSN, RFAL_PICOPASS_MAX_BLOCK_LEN);
|
|
|
-
|
|
|
- seader_send_card_detected(seader_uart, cardDetails);
|
|
|
-
|
|
|
- ASN_STRUCT_FREE(asn_DEF_CardDetails, cardDetails);
|
|
|
- return ERR_NONE;
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
-ReturnCode seader_picopass_card_detect() {
|
|
|
- ReturnCode err;
|
|
|
+void seader_worker_poller_conversation(Seader* seader, SeaderPollerContainer* spc) {
|
|
|
+ SeaderWorker* seader_worker = seader->worker;
|
|
|
|
|
|
- err = rfalPicoPassPollerInitialize();
|
|
|
- if(err != ERR_NONE) {
|
|
|
- FURI_LOG_E(TAG, "rfalPicoPassPollerInitialize error %d", err);
|
|
|
- return err;
|
|
|
- }
|
|
|
+ if(furi_mutex_acquire(seader_worker->mq_mutex, 0) == FuriStatusOk) {
|
|
|
+ furi_thread_set_current_priority(FuriThreadPriorityHighest);
|
|
|
+ uint32_t count = furi_message_queue_get_count(seader_worker->messages);
|
|
|
+ if(count > 0) {
|
|
|
+ FURI_LOG_D(TAG, "MessageQueue: %ld messages", count);
|
|
|
|
|
|
- err = rfalFieldOnAndStartGT();
|
|
|
- if(err != ERR_NONE) {
|
|
|
- FURI_LOG_E(TAG, "rfalFieldOnAndStartGT error %d", err);
|
|
|
- return err;
|
|
|
- }
|
|
|
+ SeaderAPDU seaderApdu = {};
|
|
|
+ FuriStatus status =
|
|
|
+ furi_message_queue_get(seader_worker->messages, &seaderApdu, FuriWaitForever);
|
|
|
+ if(status != FuriStatusOk) {
|
|
|
+ FURI_LOG_W(TAG, "furi_message_queue_get fail %d", status);
|
|
|
+ seader_worker->stage = SeaderPollerEventTypeComplete;
|
|
|
+ }
|
|
|
|
|
|
- err = rfalPicoPassPollerCheckPresence();
|
|
|
- if(err != ERR_RF_COLLISION) {
|
|
|
- if(err != ERR_TIMEOUT) {
|
|
|
- FURI_LOG_E(TAG, "rfalPicoPassPollerCheckPresence error %d", err);
|
|
|
+ if(seader_process_success_response_i(
|
|
|
+ seader, seaderApdu.buf, seaderApdu.len, true, spc)) {
|
|
|
+ // no-op
|
|
|
+ } else {
|
|
|
+ FURI_LOG_I(TAG, "Response false");
|
|
|
+ seader_worker->stage = SeaderPollerEventTypeComplete;
|
|
|
+ }
|
|
|
}
|
|
|
- return err;
|
|
|
+ furi_mutex_release(seader_worker->mq_mutex);
|
|
|
+ } else {
|
|
|
+ furi_thread_set_current_priority(FuriThreadPriorityLowest);
|
|
|
}
|
|
|
-
|
|
|
- return ERR_NONE;
|
|
|
}
|
|
|
|
|
|
-ReturnCode seader_picopass_card_read(SeaderWorker* seader_worker) {
|
|
|
- ReturnCode err = ERR_TIMEOUT;
|
|
|
+NfcCommand seader_worker_poller_callback_iso14443_4a(NfcGenericEvent event, void* context) {
|
|
|
+ furi_assert(event.protocol == NfcProtocolIso14443_4a);
|
|
|
+ NfcCommand ret = NfcCommandContinue;
|
|
|
|
|
|
- while(seader_worker->state == SeaderWorkerStateReadPicopass) {
|
|
|
- // Card found
|
|
|
- if(seader_picopass_card_detect() == ERR_NONE) {
|
|
|
- err = seader_picopass_card_init(seader_worker);
|
|
|
- if(err != ERR_NONE) {
|
|
|
- FURI_LOG_E(TAG, "picopass_card_init error %d", err);
|
|
|
- }
|
|
|
- break;
|
|
|
- }
|
|
|
+ Seader* seader = context;
|
|
|
+ SeaderWorker* seader_worker = seader->worker;
|
|
|
|
|
|
- furi_delay_ms(100);
|
|
|
- }
|
|
|
+ const Iso14443_4aPollerEvent* iso14443_4a_event = event.event_data;
|
|
|
+ SeaderPollerContainer spc = {.iso14443_4a_poller = event.instance};
|
|
|
|
|
|
- return err;
|
|
|
-}
|
|
|
+ if(iso14443_4a_event->type == Iso14443_4aPollerEventTypeReady) {
|
|
|
+ if(seader_worker->stage == SeaderPollerEventTypeCardDetect) {
|
|
|
+ nfc_device_set_data(
|
|
|
+ seader->nfc_device, NfcProtocolIso14443_4a, nfc_poller_get_data(seader->poller));
|
|
|
|
|
|
-void seader_worker_process_sam_message(SeaderWorker* seader_worker, CCID_Message* message) {
|
|
|
- if(seader_process_apdu(seader_worker, message->payload, message->dwLength)) {
|
|
|
- // no-op
|
|
|
- } else {
|
|
|
- memset(display, 0, sizeof(display));
|
|
|
- for(uint8_t i = 0; i < message->dwLength; i++) {
|
|
|
- snprintf(display + (i * 2), sizeof(display), "%02x", message->payload[i]);
|
|
|
- }
|
|
|
+ size_t uid_len;
|
|
|
+ const uint8_t* uid = nfc_device_get_uid(seader->nfc_device, &uid_len);
|
|
|
+
|
|
|
+ const Iso14443_3aData* iso14443_3a_data =
|
|
|
+ nfc_device_get_data(seader->nfc_device, NfcProtocolIso14443_3a);
|
|
|
+ uint8_t sak = iso14443_3a_get_sak(iso14443_3a_data);
|
|
|
|
|
|
- FURI_LOG_W(TAG, "Unknown block: [%ld] %s", message->dwLength, display);
|
|
|
- if(seader_worker->callback) {
|
|
|
- seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
|
|
|
+ seader_worker_card_detect(
|
|
|
+ seader, sak, (uint8_t*)iso14443_3a_data->atqa, uid, uid_len, NULL, 0);
|
|
|
+
|
|
|
+ // nfc_set_fdt_poll_fc(event.instance, SEADER_POLLER_MAX_FWT);
|
|
|
+ furi_thread_set_current_priority(FuriThreadPriorityLowest);
|
|
|
+ seader_worker->stage = SeaderPollerEventTypeConversation;
|
|
|
+ } else if(seader_worker->stage == SeaderPollerEventTypeConversation) {
|
|
|
+ seader_worker_poller_conversation(seader, &spc);
|
|
|
+ } else if(seader_worker->stage == SeaderPollerEventTypeComplete) {
|
|
|
+ ret = NfcCommandStop;
|
|
|
}
|
|
|
+ } else {
|
|
|
+ // add failure callback if failure type
|
|
|
+ FURI_LOG_D(TAG, "14a event type %x", iso14443_4a_event->type);
|
|
|
}
|
|
|
+
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
-int32_t seader_worker_task(void* context) {
|
|
|
- SeaderWorker* seader_worker = context;
|
|
|
- SeaderUartBridge* seader_uart = seader_worker->uart;
|
|
|
+NfcCommand seader_worker_poller_callback_picopass(PicopassPollerEvent event, void* context) {
|
|
|
+ furi_assert(context);
|
|
|
+ NfcCommand ret = NfcCommandContinue;
|
|
|
|
|
|
- if(seader_worker->state == SeaderWorkerStateCheckSam) {
|
|
|
- seader_ccid_check_for_sam(seader_uart);
|
|
|
- } else if(seader_worker->state == SeaderWorkerStateReadPicopass) {
|
|
|
- FURI_LOG_D(TAG, "Read Picopass");
|
|
|
- requestPacs = true;
|
|
|
- seader_credential_clear(seader_worker->credential);
|
|
|
- seader_worker->credential->type = SeaderCredentialTypePicopass;
|
|
|
- seader_worker_enable_field();
|
|
|
- if(seader_picopass_card_read(seader_worker) != ERR_NONE) {
|
|
|
- // Turn off if cancelled / no card found
|
|
|
- seader_worker_disable_field(ERR_NONE);
|
|
|
- }
|
|
|
- } else if(seader_worker->state == SeaderWorkerStateRead14a) {
|
|
|
- FURI_LOG_D(TAG, "Read 14a");
|
|
|
- requestPacs = true;
|
|
|
- seader_credential_clear(seader_worker->credential);
|
|
|
- seader_worker->credential->type = SeaderCredentialType14A;
|
|
|
- seader_nfc_scene_field_on_enter();
|
|
|
- if(!seader_detect_nfc(seader_worker)) {
|
|
|
- // Turn off if cancelled / no card found
|
|
|
- seader_nfc_scene_field_on_exit();
|
|
|
+ Seader* seader = context;
|
|
|
+ SeaderWorker* seader_worker = seader->worker;
|
|
|
+ // I know this is is passing the same thing that is on seader all the way down, but I prefer the symmetry between the 15a and iso15 stuff
|
|
|
+ PicopassPoller* instance = seader->picopass_poller;
|
|
|
+ SeaderPollerContainer spc = {.picopass_poller = instance};
|
|
|
+
|
|
|
+ if(event.type == PicopassPollerEventTypeSuccess) {
|
|
|
+ if(seader_worker->stage == SeaderPollerEventTypeCardDetect) {
|
|
|
+ uint8_t* csn = picopass_poller_get_csn(instance);
|
|
|
+ seader_worker_card_detect(seader, 0, NULL, csn, sizeof(PicopassSerialNum), NULL, 0);
|
|
|
+ furi_thread_set_current_priority(FuriThreadPriorityLowest);
|
|
|
+ seader_worker->stage = SeaderPollerEventTypeConversation;
|
|
|
+ } else if(seader_worker->stage == SeaderPollerEventTypeConversation) {
|
|
|
+ seader_worker_poller_conversation(seader, &spc);
|
|
|
+ } else if(seader_worker->stage == SeaderPollerEventTypeComplete) {
|
|
|
+ ret = NfcCommandStop;
|
|
|
}
|
|
|
+ } else if(event.type == PicopassPollerEventTypeFail) {
|
|
|
+ ret = NfcCommandStop;
|
|
|
+ } else {
|
|
|
+ FURI_LOG_D(TAG, "picopass event type %x", event.type);
|
|
|
}
|
|
|
- FURI_LOG_D(TAG, "Worker Task Complete");
|
|
|
- seader_worker_change_state(seader_worker, SeaderWorkerStateReady);
|
|
|
|
|
|
- return 0;
|
|
|
+ return ret;
|
|
|
}
|