[FL-2369] NFC refactoring (#1095)
* nfc: clean up scenes * nfc worker: remove field on from worker * nfc worker: move full data exchange to furi hal * nfc_device: check UID length * nfc protocol: introduce mifare common API * nfc: move common data to furi hal nfc * nfc: rename emv_decoder -> emv * nfc: move emv data structure to emv lib * nfc: remove deactivate after detection * nfc: rework furi hal nfc detect * nfc: clean up CLI commands and type * nfc: remove unused includes and function * nfc: add TxRxType enum * nfc: read mifare ultralight refactoring * nfc: refactore mifare ultralight start * rfal: fix custom data exchange * nfc: refactor read bank card * nfc: refactor read emv application * nfc: refactor emv test emulation * nfc: refactor uid emulation * nfc: add limit to uid emulation logger * fix source formatting * furi_hal_nfc: fix data exchange full * nfc: fix mifare ultralight type load Co-authored-by: あく <alleteam@gmail.com>
This commit is contained in:
@@ -48,13 +48,12 @@ void furi_hal_nfc_exit_sleep() {
|
||||
rfalLowPowerModeStop();
|
||||
}
|
||||
|
||||
bool furi_hal_nfc_detect(
|
||||
rfalNfcDevice** dev_list,
|
||||
uint8_t* dev_cnt,
|
||||
uint32_t timeout,
|
||||
bool deactivate) {
|
||||
furi_assert(dev_list);
|
||||
furi_assert(dev_cnt);
|
||||
bool furi_hal_nfc_detect(FuriHalNfcDevData* nfc_data, uint32_t timeout) {
|
||||
furi_assert(nfc_data);
|
||||
|
||||
rfalNfcDevice* dev_list = NULL;
|
||||
uint8_t dev_cnt = 0;
|
||||
bool detected = false;
|
||||
|
||||
rfalLowPowerModeStop();
|
||||
rfalNfcState state = rfalNfcGetState();
|
||||
@@ -77,9 +76,13 @@ bool furi_hal_nfc_detect(
|
||||
|
||||
uint32_t start = DWT->CYCCNT;
|
||||
rfalNfcDiscover(¶ms);
|
||||
while(state != RFAL_NFC_STATE_ACTIVATED) {
|
||||
while(true) {
|
||||
rfalNfcWorker();
|
||||
state = rfalNfcGetState();
|
||||
if(state == RFAL_NFC_STATE_ACTIVATED) {
|
||||
detected = true;
|
||||
break;
|
||||
}
|
||||
FURI_LOG_T(TAG, "Current state %d", state);
|
||||
if(state == RFAL_NFC_STATE_POLL_ACTIVATION) {
|
||||
start = DWT->CYCCNT;
|
||||
@@ -91,16 +94,42 @@ bool furi_hal_nfc_detect(
|
||||
if(DWT->CYCCNT - start > timeout * clocks_in_ms) {
|
||||
rfalNfcDeactivate(true);
|
||||
FURI_LOG_T(TAG, "Timeout");
|
||||
return false;
|
||||
break;
|
||||
}
|
||||
osThreadYield();
|
||||
}
|
||||
rfalNfcGetDevicesFound(dev_list, dev_cnt);
|
||||
if(deactivate) {
|
||||
rfalNfcDeactivate(false);
|
||||
rfalLowPowerModeStart();
|
||||
rfalNfcGetDevicesFound(&dev_list, &dev_cnt);
|
||||
if(detected) {
|
||||
if(dev_list[0].type == RFAL_NFC_LISTEN_TYPE_NFCA) {
|
||||
nfc_data->type = FuriHalNfcTypeA;
|
||||
nfc_data->atqa[0] = dev_list[0].dev.nfca.sensRes.anticollisionInfo;
|
||||
nfc_data->atqa[1] = dev_list[0].dev.nfca.sensRes.platformInfo;
|
||||
nfc_data->sak = dev_list[0].dev.nfca.selRes.sak;
|
||||
uint8_t* cuid_start = dev_list[0].nfcid;
|
||||
if(dev_list[0].nfcidLen == 7) {
|
||||
cuid_start = &dev_list[0].nfcid[3];
|
||||
}
|
||||
nfc_data->cuid = (cuid_start[0] << 24) | (cuid_start[1] << 16) | (cuid_start[2] << 8) |
|
||||
(cuid_start[3]);
|
||||
} else if(dev_list[0].type == RFAL_NFC_LISTEN_TYPE_NFCB) {
|
||||
nfc_data->type = FuriHalNfcTypeB;
|
||||
} else if(dev_list[0].type == RFAL_NFC_LISTEN_TYPE_NFCF) {
|
||||
nfc_data->type = FuriHalNfcTypeF;
|
||||
} else if(dev_list[0].type == RFAL_NFC_LISTEN_TYPE_NFCV) {
|
||||
nfc_data->type = FuriHalNfcTypeV;
|
||||
}
|
||||
if(dev_list[0].rfInterface == RFAL_NFC_INTERFACE_RF) {
|
||||
nfc_data->interface = FuriHalNfcInterfaceRf;
|
||||
} else if(dev_list[0].rfInterface == RFAL_NFC_INTERFACE_ISODEP) {
|
||||
nfc_data->interface = FuriHalNfcInterfaceIsoDep;
|
||||
} else if(dev_list[0].rfInterface == RFAL_NFC_INTERFACE_NFCDEP) {
|
||||
nfc_data->interface = FuriHalNfcInterfaceNfcDep;
|
||||
}
|
||||
nfc_data->uid_len = dev_list[0].nfcidLen;
|
||||
memcpy(nfc_data->uid, dev_list[0].nfcid, nfc_data->uid_len);
|
||||
}
|
||||
return true;
|
||||
|
||||
return detected;
|
||||
}
|
||||
|
||||
bool furi_hal_nfc_activate_nfca(uint32_t timeout, uint32_t* cuid) {
|
||||
@@ -326,12 +355,6 @@ bool furi_hal_nfc_emulate_nfca(
|
||||
return true;
|
||||
}
|
||||
|
||||
bool furi_hal_nfc_get_first_frame(uint8_t** rx_buff, uint16_t** rx_len) {
|
||||
ReturnCode ret =
|
||||
rfalNfcDataExchangeStart(NULL, 0, rx_buff, rx_len, 0, RFAL_TXRX_FLAGS_DEFAULT);
|
||||
return ret == ERR_NONE;
|
||||
}
|
||||
|
||||
ReturnCode furi_hal_nfc_data_exchange(
|
||||
uint8_t* tx_buff,
|
||||
uint16_t tx_len,
|
||||
@@ -370,6 +393,22 @@ ReturnCode furi_hal_nfc_data_exchange(
|
||||
return ret;
|
||||
}
|
||||
|
||||
static uint32_t furi_hal_nfc_tx_rx_get_flag(FuriHalNfcTxRxType type) {
|
||||
uint32_t flags = 0;
|
||||
|
||||
if(type == FuriHalNfcTxRxTypeRxNoCrc) {
|
||||
flags = RFAL_TXRX_FLAGS_CRC_RX_KEEP;
|
||||
} else if(type == FuriHalNfcTxRxTypeRxKeepPar) {
|
||||
flags = RFAL_TXRX_FLAGS_CRC_TX_MANUAL | RFAL_TXRX_FLAGS_CRC_RX_KEEP |
|
||||
RFAL_TXRX_FLAGS_PAR_RX_KEEP;
|
||||
} else if(type == FuriHalNfcTxRxTypeRaw) {
|
||||
flags = RFAL_TXRX_FLAGS_CRC_TX_MANUAL | RFAL_TXRX_FLAGS_CRC_RX_KEEP |
|
||||
RFAL_TXRX_FLAGS_PAR_RX_KEEP | RFAL_TXRX_FLAGS_PAR_TX_NONE;
|
||||
}
|
||||
|
||||
return flags;
|
||||
}
|
||||
|
||||
static uint16_t furi_hal_nfc_data_and_parity_to_bitstream(
|
||||
uint8_t* data,
|
||||
uint16_t len,
|
||||
@@ -420,8 +459,8 @@ uint16_t furi_hal_nfc_bitstream_to_data_and_parity(
|
||||
return curr_byte;
|
||||
}
|
||||
|
||||
bool furi_hal_nfc_tx_rx(FuriHalNfcTxRxContext* tx_rx_ctx) {
|
||||
furi_assert(tx_rx_ctx);
|
||||
bool furi_hal_nfc_tx_rx(FuriHalNfcTxRxContext* tx_rx, uint16_t timeout_ms) {
|
||||
furi_assert(tx_rx);
|
||||
|
||||
ReturnCode ret;
|
||||
rfalNfcState state = RFAL_NFC_STATE_ACTIVATED;
|
||||
@@ -431,26 +470,18 @@ bool furi_hal_nfc_tx_rx(FuriHalNfcTxRxContext* tx_rx_ctx) {
|
||||
uint16_t* temp_rx_bits = NULL;
|
||||
|
||||
// Prepare data for FIFO if necessary
|
||||
if(tx_rx_ctx->tx_rx_type == FURI_HAL_NFC_TXRX_RAW) {
|
||||
uint32_t flags = furi_hal_nfc_tx_rx_get_flag(tx_rx->tx_rx_type);
|
||||
if(tx_rx->tx_rx_type == FuriHalNfcTxRxTypeRaw) {
|
||||
temp_tx_bits = furi_hal_nfc_data_and_parity_to_bitstream(
|
||||
tx_rx_ctx->tx_data, tx_rx_ctx->tx_bits / 8, tx_rx_ctx->tx_parity, temp_tx_buff);
|
||||
tx_rx->tx_data, tx_rx->tx_bits / 8, tx_rx->tx_parity, temp_tx_buff);
|
||||
ret = rfalNfcDataExchangeCustomStart(
|
||||
temp_tx_buff,
|
||||
temp_tx_bits,
|
||||
&temp_rx_buff,
|
||||
&temp_rx_bits,
|
||||
RFAL_FWT_NONE,
|
||||
tx_rx_ctx->tx_rx_type);
|
||||
temp_tx_buff, temp_tx_bits, &temp_rx_buff, &temp_rx_bits, RFAL_FWT_NONE, flags);
|
||||
} else {
|
||||
ret = rfalNfcDataExchangeCustomStart(
|
||||
tx_rx_ctx->tx_data,
|
||||
tx_rx_ctx->tx_bits,
|
||||
&temp_rx_buff,
|
||||
&temp_rx_bits,
|
||||
RFAL_FWT_NONE,
|
||||
tx_rx_ctx->tx_rx_type);
|
||||
tx_rx->tx_data, tx_rx->tx_bits, &temp_rx_buff, &temp_rx_bits, RFAL_FWT_NONE, flags);
|
||||
}
|
||||
if(ret != ERR_NONE) {
|
||||
FURI_LOG_E(TAG, "Failed to start data exchange");
|
||||
return false;
|
||||
}
|
||||
uint32_t start = DWT->CYCCNT;
|
||||
@@ -459,28 +490,64 @@ bool furi_hal_nfc_tx_rx(FuriHalNfcTxRxContext* tx_rx_ctx) {
|
||||
state = rfalNfcGetState();
|
||||
ret = rfalNfcDataExchangeGetStatus();
|
||||
if(ret == ERR_BUSY) {
|
||||
if(DWT->CYCCNT - start > 4 * clocks_in_ms) {
|
||||
if(DWT->CYCCNT - start > timeout_ms * clocks_in_ms) {
|
||||
FURI_LOG_D(TAG, "Timeout during data exchange");
|
||||
return false;
|
||||
}
|
||||
continue;
|
||||
} else {
|
||||
start = DWT->CYCCNT;
|
||||
}
|
||||
taskYIELD();
|
||||
osThreadYield();
|
||||
}
|
||||
|
||||
if(tx_rx_ctx->tx_rx_type == FURI_HAL_NFC_TXRX_RAW) {
|
||||
tx_rx_ctx->rx_bits =
|
||||
8 * furi_hal_nfc_bitstream_to_data_and_parity(
|
||||
temp_rx_buff, *temp_rx_bits, tx_rx_ctx->rx_data, tx_rx_ctx->rx_parity);
|
||||
if(tx_rx->tx_rx_type == FuriHalNfcTxRxTypeRaw) {
|
||||
tx_rx->rx_bits = 8 * furi_hal_nfc_bitstream_to_data_and_parity(
|
||||
temp_rx_buff, *temp_rx_bits, tx_rx->rx_data, tx_rx->rx_parity);
|
||||
} else {
|
||||
memcpy(tx_rx_ctx->rx_data, temp_rx_buff, *temp_rx_bits / 8);
|
||||
memcpy(tx_rx->rx_data, temp_rx_buff, MIN(*temp_rx_bits / 8, FURI_HAL_NFC_DATA_BUFF_SIZE));
|
||||
tx_rx->rx_bits = *temp_rx_bits;
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
void furi_hal_nfc_deactivate() {
|
||||
ReturnCode furi_hal_nfc_exchange_full(
|
||||
uint8_t* tx_buff,
|
||||
uint16_t tx_len,
|
||||
uint8_t* rx_buff,
|
||||
uint16_t rx_cap,
|
||||
uint16_t* rx_len) {
|
||||
ReturnCode err;
|
||||
uint8_t* part_buff;
|
||||
uint16_t* part_len_bits;
|
||||
uint16_t part_len_bytes;
|
||||
|
||||
err = furi_hal_nfc_data_exchange(tx_buff, tx_len, &part_buff, &part_len_bits, false);
|
||||
part_len_bytes = *part_len_bits / 8;
|
||||
if(part_len_bytes > rx_cap) {
|
||||
return ERR_OVERRUN;
|
||||
}
|
||||
memcpy(rx_buff, part_buff, part_len_bytes);
|
||||
*rx_len = part_len_bytes;
|
||||
while(err == ERR_NONE && rx_buff[0] == 0xAF) {
|
||||
err = furi_hal_nfc_data_exchange(rx_buff, 1, &part_buff, &part_len_bits, false);
|
||||
part_len_bytes = *part_len_bits / 8;
|
||||
if(part_len_bytes > rx_cap - *rx_len) {
|
||||
return ERR_OVERRUN;
|
||||
}
|
||||
if(part_len_bytes == 0) {
|
||||
return ERR_PROTO;
|
||||
}
|
||||
memcpy(rx_buff + *rx_len, part_buff + 1, part_len_bytes - 1);
|
||||
*rx_buff = *part_buff;
|
||||
*rx_len += part_len_bytes - 1;
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
void furi_hal_nfc_sleep() {
|
||||
rfalNfcDeactivate(false);
|
||||
rfalLowPowerModeStart();
|
||||
}
|
||||
|
@@ -15,32 +15,31 @@ extern "C" {
|
||||
#endif
|
||||
|
||||
#define FURI_HAL_NFC_UID_MAX_LEN 10
|
||||
#define FURI_HAL_NFC_DATA_BUFF_SIZE (64)
|
||||
#define FURI_HAL_NFC_DATA_BUFF_SIZE (256)
|
||||
#define FURI_HAL_NFC_PARITY_BUFF_SIZE (FURI_HAL_NFC_DATA_BUFF_SIZE / 8)
|
||||
|
||||
#define FURI_HAL_NFC_TXRX_DEFAULT \
|
||||
((uint32_t)RFAL_TXRX_FLAGS_CRC_TX_AUTO | (uint32_t)RFAL_TXRX_FLAGS_CRC_RX_REMV | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCIP1_OFF | (uint32_t)RFAL_TXRX_FLAGS_AGC_ON | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_REMV | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_AUTO | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCV_FLAG_AUTO)
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_REMV | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_AUTO)
|
||||
|
||||
#define FURI_HAL_NFC_TX_DEFAULT_RX_NO_CRC \
|
||||
((uint32_t)RFAL_TXRX_FLAGS_CRC_TX_AUTO | (uint32_t)RFAL_TXRX_FLAGS_CRC_RX_KEEP | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCIP1_OFF | (uint32_t)RFAL_TXRX_FLAGS_AGC_ON | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_REMV | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_AUTO | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCV_FLAG_AUTO)
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_REMV | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_AUTO)
|
||||
|
||||
#define FURI_HAL_NFC_TXRX_WITH_PAR \
|
||||
((uint32_t)RFAL_TXRX_FLAGS_CRC_TX_MANUAL | (uint32_t)RFAL_TXRX_FLAGS_CRC_RX_KEEP | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCIP1_OFF | (uint32_t)RFAL_TXRX_FLAGS_AGC_ON | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_KEEP | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_AUTO | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCV_FLAG_AUTO)
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_KEEP | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_AUTO)
|
||||
|
||||
#define FURI_HAL_NFC_TXRX_RAW \
|
||||
((uint32_t)RFAL_TXRX_FLAGS_CRC_TX_MANUAL | (uint32_t)RFAL_TXRX_FLAGS_CRC_RX_KEEP | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCIP1_OFF | (uint32_t)RFAL_TXRX_FLAGS_AGC_ON | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_KEEP | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_NONE | \
|
||||
(uint32_t)RFAL_TXRX_FLAGS_NFCV_FLAG_AUTO)
|
||||
(uint32_t)RFAL_TXRX_FLAGS_PAR_RX_KEEP | (uint32_t)RFAL_TXRX_FLAGS_PAR_TX_NONE)
|
||||
|
||||
typedef enum {
|
||||
FuriHalNfcTxRxTypeDefault,
|
||||
FuriHalNfcTxRxTypeRxNoCrc,
|
||||
FuriHalNfcTxRxTypeRxKeepPar,
|
||||
FuriHalNfcTxRxTypeRaw,
|
||||
} FuriHalNfcTxRxType;
|
||||
|
||||
typedef bool (*FuriHalNfcEmulateCallback)(
|
||||
uint8_t* buff_rx,
|
||||
@@ -50,6 +49,29 @@ typedef bool (*FuriHalNfcEmulateCallback)(
|
||||
uint32_t* flags,
|
||||
void* context);
|
||||
|
||||
typedef enum {
|
||||
FuriHalNfcTypeA,
|
||||
FuriHalNfcTypeB,
|
||||
FuriHalNfcTypeF,
|
||||
FuriHalNfcTypeV,
|
||||
} FuriHalNfcType;
|
||||
|
||||
typedef enum {
|
||||
FuriHalNfcInterfaceRf,
|
||||
FuriHalNfcInterfaceIsoDep,
|
||||
FuriHalNfcInterfaceNfcDep,
|
||||
} FuriHalNfcInterface;
|
||||
|
||||
typedef struct {
|
||||
FuriHalNfcType type;
|
||||
FuriHalNfcInterface interface;
|
||||
uint8_t uid_len;
|
||||
uint8_t uid[10];
|
||||
uint32_t cuid;
|
||||
uint8_t atqa[2];
|
||||
uint8_t sak;
|
||||
} FuriHalNfcDevData;
|
||||
|
||||
typedef struct {
|
||||
uint8_t tx_data[FURI_HAL_NFC_DATA_BUFF_SIZE];
|
||||
uint8_t tx_parity[FURI_HAL_NFC_PARITY_BUFF_SIZE];
|
||||
@@ -57,7 +79,7 @@ typedef struct {
|
||||
uint8_t rx_data[FURI_HAL_NFC_DATA_BUFF_SIZE];
|
||||
uint8_t rx_parity[FURI_HAL_NFC_PARITY_BUFF_SIZE];
|
||||
uint16_t rx_bits;
|
||||
uint32_t tx_rx_type;
|
||||
FuriHalNfcTxRxType tx_rx_type;
|
||||
} FuriHalNfcTxRxContext;
|
||||
|
||||
/** Init nfc
|
||||
@@ -95,11 +117,7 @@ void furi_hal_nfc_exit_sleep();
|
||||
*
|
||||
* @return true on success
|
||||
*/
|
||||
bool furi_hal_nfc_detect(
|
||||
rfalNfcDevice** dev_list,
|
||||
uint8_t* dev_cnt,
|
||||
uint32_t timeout,
|
||||
bool deactivate);
|
||||
bool furi_hal_nfc_detect(FuriHalNfcDevData* nfc_data, uint32_t timeout);
|
||||
|
||||
/** Activate NFC-A tag
|
||||
*
|
||||
@@ -138,15 +156,6 @@ bool furi_hal_nfc_emulate_nfca(
|
||||
void* context,
|
||||
uint32_t timeout);
|
||||
|
||||
/** Get first command from reader after activation in emulation mode
|
||||
*
|
||||
* @param rx_buff pointer to receive buffer
|
||||
* @param rx_len receive buffer length
|
||||
*
|
||||
* @return true on success
|
||||
*/
|
||||
bool furi_hal_nfc_get_first_frame(uint8_t** rx_buff, uint16_t** rx_len);
|
||||
|
||||
/** NFC data exchange
|
||||
*
|
||||
* @param tx_buff transmit buffer
|
||||
@@ -170,11 +179,28 @@ ReturnCode furi_hal_nfc_data_exchange(
|
||||
*
|
||||
* @return true on success
|
||||
*/
|
||||
bool furi_hal_nfc_tx_rx(FuriHalNfcTxRxContext* tx_rx_ctx);
|
||||
bool furi_hal_nfc_tx_rx(FuriHalNfcTxRxContext* tx_rx, uint16_t timeout_ms);
|
||||
|
||||
/** NFC data full exhange
|
||||
*
|
||||
* @param tx_buff transmit buffer
|
||||
* @param tx_len transmit buffer length
|
||||
* @param rx_buff receive buffer
|
||||
* @param rx_cap receive buffer capacity
|
||||
* @param rx_len receive buffer length
|
||||
*
|
||||
* @return ST ReturnCode
|
||||
*/
|
||||
ReturnCode furi_hal_nfc_exchange_full(
|
||||
uint8_t* tx_buff,
|
||||
uint16_t tx_len,
|
||||
uint8_t* rx_buff,
|
||||
uint16_t rx_cap,
|
||||
uint16_t* rx_len);
|
||||
|
||||
/** NFC deactivate and start sleep
|
||||
*/
|
||||
void furi_hal_nfc_deactivate();
|
||||
void furi_hal_nfc_sleep();
|
||||
|
||||
void furi_hal_nfc_stop();
|
||||
|
||||
|
Reference in New Issue
Block a user