diff options
author | gornekich <n.gorbadey@gmail.com> | 2021-05-26 02:54:44 +0300 |
---|---|---|
committer | GitHub <noreply@github.com> | 2021-05-26 02:54:44 +0300 |
commit | e620b310b7cd4d0de5b9b795356c95dae5381bd9 (patch) | |
tree | e90df8c9b86162c8abe8bf47491045695c75d31b /applications/nfc/nfc_worker.c | |
parent | d92bb18ccafa8d3ac8be35c2ab2b162ae4e85814 (diff) |
[FL-1039] Emv emulation (#491)
* nfc: add emulate emv to submenu
* api-hal-nfc: add emv emulation
Diffstat (limited to 'applications/nfc/nfc_worker.c')
-rw-r--r--[-rwxr-xr-x] | applications/nfc/nfc_worker.c | 72 |
1 files changed, 62 insertions, 10 deletions
diff --git a/applications/nfc/nfc_worker.c b/applications/nfc/nfc_worker.c index 074974b9..b769d31b 100755..100644 --- a/applications/nfc/nfc_worker.c +++ b/applications/nfc/nfc_worker.c @@ -64,6 +64,8 @@ void nfc_worker_task(void* context) { nfc_worker_poll(nfc_worker); } else if(nfc_worker->state == NfcWorkerStateReadEMV) { nfc_worker_read_emv(nfc_worker); + } else if(nfc_worker->state == NfcWorkerStateEmulateEMV) { + nfc_worker_emulate_emv(nfc_worker); } else if(nfc_worker->state == NfcWorkerStateEmulate) { nfc_worker_emulate(nfc_worker); } else if(nfc_worker->state == NfcWorkerStateField) { @@ -77,7 +79,6 @@ void nfc_worker_task(void* context) { void nfc_worker_read_emv(NfcWorker* nfc_worker) { ReturnCode err; rfalNfcDevice* dev_list; - rfalNfcDevice* dev_active; EmvApplication emv_app = {}; uint8_t dev_cnt = 0; uint8_t tx_buff[255] = {}; @@ -94,11 +95,9 @@ void nfc_worker_read_emv(NfcWorker* nfc_worker) { if(api_hal_nfc_detect(&dev_list, &dev_cnt, 100, false)) { // Card was found. Check that it supports EMV if(dev_list[0].rfInterface == RFAL_NFC_INTERFACE_ISODEP) { - dev_active = &dev_list[0]; FURI_LOG_I(NFC_WORKER_TAG, "Send select PPSE command"); tx_len = emv_prepare_select_ppse(tx_buff); - err = api_hal_nfc_data_exchange( - dev_active, tx_buff, tx_len, &rx_buff, &rx_len, false); + err = api_hal_nfc_data_exchange(tx_buff, tx_len, &rx_buff, &rx_len, false); if(err != ERR_NONE) { FURI_LOG_E(NFC_WORKER_TAG, "Error during selection PPSE request: %d", err); message.type = NfcMessageTypeEMVNotFound; @@ -117,8 +116,7 @@ void nfc_worker_read_emv(NfcWorker* nfc_worker) { } FURI_LOG_I(NFC_WORKER_TAG, "Starting application ..."); tx_len = emv_prepare_select_app(tx_buff, &emv_app); - err = api_hal_nfc_data_exchange( - dev_active, tx_buff, tx_len, &rx_buff, &rx_len, false); + err = api_hal_nfc_data_exchange(tx_buff, tx_len, &rx_buff, &rx_len, false); if(err != ERR_NONE) { FURI_LOG_E( NFC_WORKER_TAG, "Error during application selection request: %d", err); @@ -140,8 +138,7 @@ void nfc_worker_read_emv(NfcWorker* nfc_worker) { } FURI_LOG_I(NFC_WORKER_TAG, "Starting Get Processing Options command ..."); tx_len = emv_prepare_get_proc_opt(tx_buff, &emv_app); - err = api_hal_nfc_data_exchange( - dev_active, tx_buff, tx_len, &rx_buff, &rx_len, false); + err = api_hal_nfc_data_exchange(tx_buff, tx_len, &rx_buff, &rx_len, false); if(err != ERR_NONE) { FURI_LOG_E( NFC_WORKER_TAG, "Error during Get Processing Options command: %d", err); @@ -171,7 +168,7 @@ void nfc_worker_read_emv(NfcWorker* nfc_worker) { for(uint8_t record = record_start; record <= record_end; ++record) { tx_len = emv_prepare_read_sfi_record(tx_buff, sfi, record); err = api_hal_nfc_data_exchange( - dev_active, tx_buff, tx_len, &rx_buff, &rx_len, false); + tx_buff, tx_len, &rx_buff, &rx_len, false); if(err != ERR_NONE) { FURI_LOG_E( NFC_WORKER_TAG, @@ -215,6 +212,61 @@ void nfc_worker_read_emv(NfcWorker* nfc_worker) { api_hal_nfc_deactivate(); } +void nfc_worker_emulate_emv(NfcWorker* nfc_worker) { + ReturnCode err; + uint8_t tx_buff[255] = {}; + uint16_t tx_len = 0; + uint8_t* rx_buff; + uint16_t* rx_len; + + while(nfc_worker->state == NfcWorkerStateEmulateEMV) { + if(api_hal_nfc_listen(1000)) { + FURI_LOG_I(NFC_WORKER_TAG, "POS terminal detected"); + // Read data from POS terminal + err = api_hal_nfc_data_exchange(NULL, 0, &rx_buff, &rx_len, false); + if(err == ERR_NONE) { + FURI_LOG_I(NFC_WORKER_TAG, "Received Select PPSE"); + } else { + FURI_LOG_E(NFC_WORKER_TAG, "Error in 1st data exchange: select PPSE"); + api_hal_nfc_deactivate(); + continue; + } + FURI_LOG_I(NFC_WORKER_TAG, "Transive SELECT PPSE ANS"); + tx_len = emv_select_ppse_ans(tx_buff); + err = api_hal_nfc_data_exchange(tx_buff, tx_len, &rx_buff, &rx_len, false); + if(err == ERR_NONE) { + FURI_LOG_I(NFC_WORKER_TAG, "Received Select APP"); + } else { + FURI_LOG_E(NFC_WORKER_TAG, "Error in 2nd data exchange: select APP"); + api_hal_nfc_deactivate(); + continue; + } + + FURI_LOG_I(NFC_WORKER_TAG, "Transive SELECT APP ANS"); + tx_len = emv_select_app_ans(tx_buff); + err = api_hal_nfc_data_exchange(tx_buff, tx_len, &rx_buff, &rx_len, false); + if(err == ERR_NONE) { + FURI_LOG_I(NFC_WORKER_TAG, "Received PDOL"); + } else { + FURI_LOG_E(NFC_WORKER_TAG, "Error in 3rd data exchange: receive PDOL"); + api_hal_nfc_deactivate(); + continue; + } + + FURI_LOG_I(NFC_WORKER_TAG, "Transive PDOL ANS"); + tx_len = emv_get_proc_opt_ans(tx_buff); + err = api_hal_nfc_data_exchange(tx_buff, tx_len, &rx_buff, &rx_len, false); + if(err == ERR_NONE) { + FURI_LOG_I(NFC_WORKER_TAG, "Received PDOL"); + } + api_hal_nfc_deactivate(); + } else { + FURI_LOG_W(NFC_WORKER_TAG, "Can't find reader"); + } + osDelay(20); + } +} + void nfc_worker_poll(NfcWorker* nfc_worker) { rfalNfcDevice* dev_list; uint8_t dev_cnt; @@ -249,7 +301,7 @@ void nfc_worker_poll(NfcWorker* nfc_worker) { furi_check( osMessageQueuePut(nfc_worker->message_queue, &message, 0, osWaitForever) == osOK); } - osDelay(20); + osDelay(5); } } |