diff --git a/applications/nfc/nfc.c b/applications/nfc/nfc.c index c57e7a74..cecd1544 100755 --- a/applications/nfc/nfc.c +++ b/applications/nfc/nfc.c @@ -159,44 +159,6 @@ void nfc_free(Nfc* nfc) { free(nfc); } -void nfc_cli_detect(Cli* cli, string_t args, void* context) { - // Check if nfc worker is not busy - if(api_hal_nfc_is_busy()) { - printf("Nfc is busy"); - return; - } - rfalNfcDevice* dev_list; - uint8_t dev_cnt = 0; - bool cmd_exit = false; - api_hal_nfc_init(); - printf("Detecting nfc...\r\nPress Ctrl+C to abort\r\n"); - while(!cmd_exit) { - cmd_exit |= cli_cmd_interrupt_received(cli); - cmd_exit |= api_hal_nfc_detect(&dev_list, &dev_cnt, 100, true); - if(dev_cnt > 0) { - printf("Found %d devices\r\n", dev_cnt); - for(uint8_t i = 0; i < dev_cnt; i++) { - printf("%d found: %s ", i, nfc_get_dev_type(dev_list[i].type)); - if(dev_list[i].type == RFAL_NFC_LISTEN_TYPE_NFCA) { - printf("type: %s, ", nfc_get_nfca_type(dev_list[i].dev.nfca.type)); - } - printf("UID length: %d, UID:", dev_list[i].nfcidLen); - for(uint8_t j = 0; j < dev_list[i].nfcidLen; j++) { - printf("%02X", dev_list[i].nfcid[j]); - } - printf("\r\n"); - } - } - osDelay(50); - } -} - -void nfc_cli_init() { - Cli* cli = furi_record_open("cli"); - cli_add_command(cli, "nfc_detect", nfc_cli_detect, NULL); - furi_record_close("cli"); -} - void nfc_start(Nfc* nfc, NfcView view_id, NfcWorkerState worker_state) { NfcWorkerState state = nfc_worker_get_state(nfc->worker); if(state == NfcWorkerStateBroken) { diff --git a/applications/nfc/nfc_cli.c b/applications/nfc/nfc_cli.c new file mode 100755 index 00000000..6b4414ea --- /dev/null +++ b/applications/nfc/nfc_cli.c @@ -0,0 +1,67 @@ +#include "nfc_cli.h" +#include "nfc_types.h" +#include +#include + +void nfc_cli_init() { + Cli* cli = furi_record_open("cli"); + cli_add_command(cli, "nfc_detect", nfc_cli_detect, NULL); + cli_add_command(cli, "nfc_emulate", nfc_cli_emulate, NULL); + furi_record_close("cli"); +} + +void nfc_cli_detect(Cli* cli, string_t args, void* context) { + // Check if nfc worker is not busy + if(api_hal_nfc_is_busy()) { + printf("Nfc is busy"); + return; + } + rfalNfcDevice* dev_list; + uint8_t dev_cnt = 0; + bool cmd_exit = false; + api_hal_nfc_init(); + api_hal_nfc_exit_sleep(); + printf("Detecting nfc...\r\nPress Ctrl+C to abort\r\n"); + while(!cmd_exit) { + cmd_exit |= cli_cmd_interrupt_received(cli); + cmd_exit |= api_hal_nfc_detect(&dev_list, &dev_cnt, 100, true); + if(dev_cnt > 0) { + printf("Found %d devices\r\n", dev_cnt); + for(uint8_t i = 0; i < dev_cnt; i++) { + printf("%d found: %s ", i + 1, nfc_get_dev_type(dev_list[i].type)); + if(dev_list[i].type == RFAL_NFC_LISTEN_TYPE_NFCA) { + printf("type: %s, ", nfc_get_nfca_type(dev_list[i].dev.nfca.type)); + } + printf("UID length: %d, UID:", dev_list[i].nfcidLen); + for(uint8_t j = 0; j < dev_list[i].nfcidLen; j++) { + printf("%02X", dev_list[i].nfcid[j]); + } + printf("\r\n"); + } + } + osDelay(50); + } + api_hal_nfc_deactivate(); +} + +void nfc_cli_emulate(Cli* cli, string_t args, void* context) { + // Check if nfc worker is not busy + if(api_hal_nfc_is_busy()) { + printf("Nfc is busy"); + return; + } + + api_hal_nfc_init(); + api_hal_nfc_exit_sleep(); + printf("Emulating NFC-A Type: T2T UID: CF72D440 SAK: 20 ATQA: 00/04\r\n"); + printf("Press Ctrl+C to abort\r\n"); + + while(!cli_cmd_interrupt_received(cli)) { + if(api_hal_nfc_listen(100)) { + printf("Reader detected\r\n"); + api_hal_nfc_deactivate(); + } + osDelay(50); + } + api_hal_nfc_deactivate(); +} diff --git a/applications/nfc/nfc_cli.h b/applications/nfc/nfc_cli.h new file mode 100644 index 00000000..fea63e4c --- /dev/null +++ b/applications/nfc/nfc_cli.h @@ -0,0 +1,9 @@ +#pragma once + +#include + +void nfc_cli_init(); + +void nfc_cli_detect(Cli* cli, string_t args, void* context); + +void nfc_cli_emulate(Cli* cli, string_t args, void* context); diff --git a/applications/nfc/nfc_views.c b/applications/nfc/nfc_views.c index 1d10c444..c3c7feee 100644 --- a/applications/nfc/nfc_views.c +++ b/applications/nfc/nfc_views.c @@ -145,9 +145,9 @@ void nfc_view_emulate_draw(Canvas* canvas, void* model) { canvas_draw_str(canvas, 0, 12, "Emulating NFC-A"); canvas_set_font(canvas, FontSecondary); canvas_draw_str(canvas, 2, 22, "Type: T2T"); - canvas_draw_str(canvas, 2, 32, "UID length: 7"); - canvas_draw_str(canvas, 2, 42, "UID: 00010203040506"); - canvas_draw_str(canvas, 2, 52, "SAK: 00 ATQA: 44/00"); + canvas_draw_str(canvas, 2, 32, "UID length: 4"); + canvas_draw_str(canvas, 2, 42, "UID: CF72D440"); + canvas_draw_str(canvas, 2, 52, "SAK: 20 ATQA: 00/04"); } void nfc_view_field_draw(Canvas* canvas, void* model) { diff --git a/applications/nfc/nfc_worker.c b/applications/nfc/nfc_worker.c index b769d31b..78825789 100644 --- a/applications/nfc/nfc_worker.c +++ b/applications/nfc/nfc_worker.c @@ -59,6 +59,7 @@ void nfc_worker_task(void* context) { NfcWorker* nfc_worker = context; api_hal_power_insomnia_enter(); + api_hal_nfc_exit_sleep(); if(nfc_worker->state == NfcWorkerStatePoll) { nfc_worker_poll(nfc_worker); @@ -71,6 +72,7 @@ void nfc_worker_task(void* context) { } else if(nfc_worker->state == NfcWorkerStateField) { nfc_worker_field(nfc_worker); } + api_hal_nfc_deactivate(); nfc_worker_change_state(nfc_worker, NfcWorkerStateReady); api_hal_power_insomnia_exit(); osThreadExit(); @@ -209,7 +211,6 @@ void nfc_worker_read_emv(NfcWorker* nfc_worker) { } osDelay(20); } - api_hal_nfc_deactivate(); } void nfc_worker_emulate_emv(NfcWorker* nfc_worker) { @@ -305,104 +306,14 @@ void nfc_worker_poll(NfcWorker* nfc_worker) { } } -void nfc_worker_state_callback(rfalNfcState st) { - (void)st; -} - -ReturnCode nfc_worker_trx( - uint8_t* txBuf, - uint16_t txBufSize, - uint8_t** rxData, - uint16_t** rcvLen, - uint32_t fwt) { - ReturnCode err; - - err = rfalNfcDataExchangeStart(txBuf, txBufSize, rxData, rcvLen, fwt); - if(err == ERR_NONE) { - do { - rfalNfcWorker(); - err = rfalNfcDataExchangeGetStatus(); - } while(err == ERR_BUSY); - } - return err; -} - -void nfc_worker_exchange(NfcWorker* nfc_worker, rfalNfcDevice* nfc_device) { - ReturnCode err = ERR_NONE; - uint8_t* rxData; - uint16_t* rcvLen; - uint8_t txBuf[100]; - uint16_t txLen; - - do { - rfalNfcWorker(); - switch(rfalNfcGetState()) { - case RFAL_NFC_STATE_ACTIVATED: - err = nfc_worker_trx(NULL, 0, &rxData, &rcvLen, 0); - break; - case RFAL_NFC_STATE_DATAEXCHANGE: - case RFAL_NFC_STATE_DATAEXCHANGE_DONE: - // Not supported - txBuf[0] = ((char)0x68); - txBuf[1] = ((char)0x00); - txLen = 2; - err = nfc_worker_trx(txBuf, txLen, &rxData, &rcvLen, RFAL_FWT_NONE); - break; - case RFAL_NFC_STATE_START_DISCOVERY: - return; - case RFAL_NFC_STATE_LISTEN_SLEEP: - default: - break; - } - } while((err == ERR_NONE) || (err == ERR_SLEEP_REQ)); -} - void nfc_worker_emulate(NfcWorker* nfc_worker) { - rfalNfcDiscoverParam params; - params.compMode = RFAL_COMPLIANCE_MODE_NFC; - params.techs2Find = RFAL_NFC_LISTEN_TECH_A; - params.totalDuration = 1000U; - params.devLimit = 1; - params.wakeupEnabled = false; - params.wakeupConfigDefault = true; - params.nfcfBR = RFAL_BR_212; - params.ap2pBR = RFAL_BR_424; - params.maxBR = RFAL_BR_KEEP; - params.GBLen = RFAL_NFCDEP_GB_MAX_LEN; - params.notifyCb = nfc_worker_state_callback; - - params.lmConfigPA.nfcidLen = RFAL_LM_NFCID_LEN_07; - params.lmConfigPA.nfcid[0] = 0x00; - params.lmConfigPA.nfcid[1] = 0x01; - params.lmConfigPA.nfcid[2] = 0x02; - params.lmConfigPA.nfcid[3] = 0x03; - params.lmConfigPA.nfcid[4] = 0x04; - params.lmConfigPA.nfcid[5] = 0x05; - params.lmConfigPA.nfcid[6] = 0x06; - params.lmConfigPA.SENS_RES[0] = 0x44; - params.lmConfigPA.SENS_RES[1] = 0x00; - params.lmConfigPA.SEL_RES = 0x00; - api_hal_nfc_exit_sleep(); - - ReturnCode ret; - ret = rfalNfcDiscover(¶ms); - if(ret != ERR_NONE) { - asm("bkpt 1"); - return; - } - - rfalNfcDevice* nfc_device; while(nfc_worker->state == NfcWorkerStateEmulate) { - rfalNfcWorker(); - if(rfalNfcIsDevActivated(rfalNfcGetState())) { - rfalNfcGetActiveDevice(&nfc_device); - nfc_worker_exchange(nfc_worker, nfc_device); + if(api_hal_nfc_listen(100)) { + FURI_LOG_I(NFC_WORKER_TAG, "Reader detected"); + api_hal_nfc_deactivate(); } - osDelay(10); + osDelay(5); } - - rfalNfcDeactivate(false); - api_hal_nfc_start_sleep(); } void nfc_worker_field(NfcWorker* nfc_worker) { diff --git a/firmware/targets/f5/api-hal/api-hal-nfc.c b/firmware/targets/f5/api-hal/api-hal-nfc.c index d7736569..6980c277 100644 --- a/firmware/targets/f5/api-hal/api-hal-nfc.c +++ b/firmware/targets/f5/api-hal/api-hal-nfc.c @@ -89,7 +89,6 @@ bool api_hal_nfc_detect(rfalNfcDevice **dev_list, uint8_t* dev_cnt, uint32_t cyc bool api_hal_nfc_listen(uint32_t timeout) { api_hal_nfc_exit_sleep(); - rfalLowPowerModeStop(); rfalNfcState state = rfalNfcGetState(); if(state == RFAL_NFC_STATE_NOTINIT) { @@ -130,6 +129,7 @@ bool api_hal_nfc_listen(uint32_t timeout) { return false; } if(state == RFAL_NFC_STATE_LISTEN_ACTIVATION) { + start = DWT->CYCCNT; continue; } taskYIELD(); diff --git a/firmware/targets/f6/api-hal/api-hal-nfc.c b/firmware/targets/f6/api-hal/api-hal-nfc.c index d7736569..6980c277 100644 --- a/firmware/targets/f6/api-hal/api-hal-nfc.c +++ b/firmware/targets/f6/api-hal/api-hal-nfc.c @@ -89,7 +89,6 @@ bool api_hal_nfc_detect(rfalNfcDevice **dev_list, uint8_t* dev_cnt, uint32_t cyc bool api_hal_nfc_listen(uint32_t timeout) { api_hal_nfc_exit_sleep(); - rfalLowPowerModeStop(); rfalNfcState state = rfalNfcGetState(); if(state == RFAL_NFC_STATE_NOTINIT) { @@ -130,6 +129,7 @@ bool api_hal_nfc_listen(uint32_t timeout) { return false; } if(state == RFAL_NFC_STATE_LISTEN_ACTIVATION) { + start = DWT->CYCCNT; continue; } taskYIELD();