NFC refactoring (#3050)
"A long time ago in a galaxy far, far away...." we started NFC subsystem refactoring. Starring: - @gornekich - NFC refactoring project lead, architect, senior developer - @gsurkov - architect, senior developer - @RebornedBrain - senior developer Supporting roles: - @skotopes, @DrZlo13, @hedger - general architecture advisors, code review - @Astrrra, @doomwastaken, @Hellitron, @ImagineVagon333 - quality assurance Special thanks: @bettse, @pcunning, @nxv, @noproto, @AloneLiberty and everyone else who has been helping us all this time and contributing valuable knowledges, ideas and source code.
This commit is contained in:
gornekich
@@ -0,0 +1,139 @@
|
||||
#include "iso14443_3a_signal.h"
|
||||
|
||||
#include <digital_signal/digital_sequence.h>
|
||||
|
||||
#define BITS_IN_BYTE (8)
|
||||
|
||||
#define ISO14443_3A_SIGNAL_BIT_MAX_EDGES (10)
|
||||
#define ISO14443_3A_SIGNAL_MAX_EDGES (1350)
|
||||
|
||||
#define ISO14443_3A_SIGNAL_SEQUENCE_SIZE \
|
||||
(ISO14443_3A_SIGNAL_MAX_EDGES / (ISO14443_3A_SIGNAL_BIT_MAX_EDGES - 2))
|
||||
|
||||
#define ISO14443_3A_SIGNAL_F_SIG (13560000.0)
|
||||
#define ISO14443_3A_SIGNAL_T_SIG 7374 //73.746ns*100
|
||||
#define ISO14443_3A_SIGNAL_T_SIG_X8 58992 //T_SIG*8
|
||||
#define ISO14443_3A_SIGNAL_T_SIG_X8_X8 471936 //T_SIG*8*8
|
||||
#define ISO14443_3A_SIGNAL_T_SIG_X8_X9 530928 //T_SIG*8*9
|
||||
|
||||
typedef enum {
|
||||
Iso14443_3aSignalIndexZero,
|
||||
Iso14443_3aSignalIndexOne,
|
||||
Iso14443_3aSignalIndexCount,
|
||||
} Iso14443_3aSignalIndex;
|
||||
|
||||
typedef DigitalSignal* Iso14443_3aSignalBank[Iso14443_3aSignalIndexCount];
|
||||
|
||||
struct Iso14443_3aSignal {
|
||||
DigitalSequence* tx_sequence;
|
||||
Iso14443_3aSignalBank signals;
|
||||
};
|
||||
|
||||
static void iso14443_3a_signal_add_byte(Iso14443_3aSignal* instance, uint8_t byte, bool parity) {
|
||||
for(size_t i = 0; i < BITS_IN_BYTE; i++) {
|
||||
digital_sequence_add_signal(
|
||||
instance->tx_sequence,
|
||||
FURI_BIT(byte, i) ? Iso14443_3aSignalIndexOne : Iso14443_3aSignalIndexZero);
|
||||
}
|
||||
digital_sequence_add_signal(
|
||||
instance->tx_sequence, parity ? Iso14443_3aSignalIndexOne : Iso14443_3aSignalIndexZero);
|
||||
}
|
||||
|
||||
static void iso14443_3a_signal_encode(
|
||||
Iso14443_3aSignal* instance,
|
||||
const uint8_t* tx_data,
|
||||
const uint8_t* tx_parity,
|
||||
size_t tx_bits) {
|
||||
furi_assert(instance);
|
||||
furi_assert(tx_data);
|
||||
furi_assert(tx_parity);
|
||||
|
||||
// Start of frame
|
||||
digital_sequence_add_signal(instance->tx_sequence, Iso14443_3aSignalIndexOne);
|
||||
|
||||
if(tx_bits < BITS_IN_BYTE) {
|
||||
for(size_t i = 0; i < tx_bits; i++) {
|
||||
digital_sequence_add_signal(
|
||||
instance->tx_sequence,
|
||||
FURI_BIT(tx_data[0], i) ? Iso14443_3aSignalIndexOne : Iso14443_3aSignalIndexZero);
|
||||
}
|
||||
} else {
|
||||
for(size_t i = 0; i < tx_bits / BITS_IN_BYTE; i++) {
|
||||
bool parity = FURI_BIT(tx_parity[i / BITS_IN_BYTE], i % BITS_IN_BYTE);
|
||||
iso14443_3a_signal_add_byte(instance, tx_data[i], parity);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static inline void iso14443_3a_signal_set_bit(DigitalSignal* signal, bool bit) {
|
||||
digital_signal_set_start_level(signal, bit);
|
||||
|
||||
if(bit) {
|
||||
for(uint32_t i = 0; i < 7; ++i) {
|
||||
digital_signal_add_period(signal, ISO14443_3A_SIGNAL_T_SIG_X8);
|
||||
}
|
||||
digital_signal_add_period(signal, ISO14443_3A_SIGNAL_T_SIG_X8_X9);
|
||||
} else {
|
||||
digital_signal_add_period(signal, ISO14443_3A_SIGNAL_T_SIG_X8_X8);
|
||||
for(uint32_t i = 0; i < 8; ++i) {
|
||||
digital_signal_add_period(signal, ISO14443_3A_SIGNAL_T_SIG_X8);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static inline void iso14443_3a_signal_bank_fill(Iso14443_3aSignalBank bank) {
|
||||
for(uint32_t i = 0; i < Iso14443_3aSignalIndexCount; ++i) {
|
||||
bank[i] = digital_signal_alloc(ISO14443_3A_SIGNAL_BIT_MAX_EDGES);
|
||||
iso14443_3a_signal_set_bit(bank[i], i % Iso14443_3aSignalIndexCount != 0);
|
||||
}
|
||||
}
|
||||
|
||||
static inline void iso14443_3a_signal_bank_clear(Iso14443_3aSignalBank bank) {
|
||||
for(uint32_t i = 0; i < Iso14443_3aSignalIndexCount; ++i) {
|
||||
digital_signal_free(bank[i]);
|
||||
}
|
||||
}
|
||||
|
||||
static inline void
|
||||
iso14443_3a_signal_bank_register(Iso14443_3aSignalBank bank, DigitalSequence* sequence) {
|
||||
for(uint32_t i = 0; i < Iso14443_3aSignalIndexCount; ++i) {
|
||||
digital_sequence_register_signal(sequence, i, bank[i]);
|
||||
}
|
||||
}
|
||||
|
||||
Iso14443_3aSignal* iso14443_3a_signal_alloc(const GpioPin* pin) {
|
||||
furi_assert(pin);
|
||||
|
||||
Iso14443_3aSignal* instance = malloc(sizeof(Iso14443_3aSignal));
|
||||
instance->tx_sequence = digital_sequence_alloc(ISO14443_3A_SIGNAL_SEQUENCE_SIZE, pin);
|
||||
|
||||
iso14443_3a_signal_bank_fill(instance->signals);
|
||||
iso14443_3a_signal_bank_register(instance->signals, instance->tx_sequence);
|
||||
|
||||
return instance;
|
||||
}
|
||||
|
||||
void iso14443_3a_signal_free(Iso14443_3aSignal* instance) {
|
||||
furi_assert(instance);
|
||||
furi_assert(instance->tx_sequence);
|
||||
|
||||
iso14443_3a_signal_bank_clear(instance->signals);
|
||||
digital_sequence_free(instance->tx_sequence);
|
||||
free(instance);
|
||||
}
|
||||
|
||||
void iso14443_3a_signal_tx(
|
||||
Iso14443_3aSignal* instance,
|
||||
const uint8_t* tx_data,
|
||||
const uint8_t* tx_parity,
|
||||
size_t tx_bits) {
|
||||
furi_assert(instance);
|
||||
furi_assert(tx_data);
|
||||
furi_assert(tx_parity);
|
||||
|
||||
FURI_CRITICAL_ENTER();
|
||||
digital_sequence_clear(instance->tx_sequence);
|
||||
iso14443_3a_signal_encode(instance, tx_data, tx_parity, tx_bits);
|
||||
digital_sequence_transmit(instance->tx_sequence);
|
||||
FURI_CRITICAL_EXIT();
|
||||
}
|
||||
@@ -0,0 +1,51 @@
|
||||
/**
|
||||
* @file iso14443_3a_signal.h
|
||||
* @brief DigitalSequence preset for generating ISO14443-3A compliant signals.
|
||||
*/
|
||||
#pragma once
|
||||
|
||||
#include <furi_hal_resources.h>
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
typedef struct Iso14443_3aSignal Iso14443_3aSignal;
|
||||
|
||||
/**
|
||||
* @brief Allocate an Iso14443_3aSignal instance with a set GPIO pin.
|
||||
*
|
||||
* @param[in] pin GPIO pin to use during transmission.
|
||||
* @returns pointer to the allocated instance.
|
||||
*/
|
||||
Iso14443_3aSignal* iso14443_3a_signal_alloc(const GpioPin* pin);
|
||||
|
||||
/**
|
||||
* @brief Delete an Iso14443_3aSignal instance.
|
||||
*
|
||||
* @param[in,out] instance pointer to the instance to be deleted.
|
||||
*/
|
||||
void iso14443_3a_signal_free(Iso14443_3aSignal* instance);
|
||||
|
||||
/**
|
||||
* @brief Transmit arbitrary bytes using an Iso14443_3aSignal instance.
|
||||
*
|
||||
* This function will block until the transmisson has been completed.
|
||||
*
|
||||
* @param[in] instance pointer to the instance used in transmission.
|
||||
* @param[in] tx_data pointer to the data to be transmitted.
|
||||
* @param[in] tx_parity pointer to the bit-packed parity array.
|
||||
* @param[in] tx_bits size of the data to be transmitted in bits.
|
||||
*/
|
||||
void iso14443_3a_signal_tx(
|
||||
Iso14443_3aSignal* instance,
|
||||
const uint8_t* tx_data,
|
||||
const uint8_t* tx_parity,
|
||||
size_t tx_bits);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
@@ -0,0 +1,204 @@
|
||||
#include "iso15693_signal.h"
|
||||
|
||||
#include <digital_signal/digital_sequence.h>
|
||||
|
||||
#define BITS_IN_BYTE (8U)
|
||||
|
||||
#define ISO15693_SIGNAL_COEFF_HI (1U)
|
||||
#define ISO15693_SIGNAL_COEFF_LO (4U)
|
||||
|
||||
#define ISO15693_SIGNAL_ZERO_EDGES (16U)
|
||||
#define ISO15693_SIGNAL_ONE_EDGES (ISO15693_SIGNAL_ZERO_EDGES + 1U)
|
||||
#define ISO15693_SIGNAL_EOF_EDGES (64U)
|
||||
#define ISO15693_SIGNAL_SOF_EDGES (ISO15693_SIGNAL_EOF_EDGES + 1U)
|
||||
#define ISO15693_SIGNAL_EDGES (1350U)
|
||||
|
||||
#define ISO15693_SIGNAL_FC (13.56e6)
|
||||
#define ISO15693_SIGNAL_FC_16 (16.0e11 / ISO15693_SIGNAL_FC)
|
||||
#define ISO15693_SIGNAL_FC_256 (256.0e11 / ISO15693_SIGNAL_FC)
|
||||
#define ISO15693_SIGNAL_FC_768 (768.0e11 / ISO15693_SIGNAL_FC)
|
||||
|
||||
typedef enum {
|
||||
Iso15693SignalIndexSof,
|
||||
Iso15693SignalIndexEof,
|
||||
Iso15693SignalIndexOne,
|
||||
Iso15693SignalIndexZero,
|
||||
Iso15693SignalIndexNum,
|
||||
} Iso15693SignalIndex;
|
||||
|
||||
typedef DigitalSignal* Iso15693SignalBank[Iso15693SignalIndexNum];
|
||||
|
||||
struct Iso15693Signal {
|
||||
DigitalSequence* tx_sequence;
|
||||
Iso15693SignalBank banks[Iso15693SignalDataRateNum];
|
||||
};
|
||||
|
||||
// Add an unmodulated signal for the length of Fc / 256 * k (where k = 1 or 4)
|
||||
static void iso15693_add_silence(DigitalSignal* signal, Iso15693SignalDataRate data_rate) {
|
||||
const uint32_t k = data_rate == Iso15693SignalDataRateHi ? ISO15693_SIGNAL_COEFF_HI :
|
||||
ISO15693_SIGNAL_COEFF_LO;
|
||||
digital_signal_add_period_with_level(signal, ISO15693_SIGNAL_FC_256 * k, false);
|
||||
}
|
||||
|
||||
// Add 8 * k subcarrier pulses of Fc / 16 (where k = 1 or 4)
|
||||
static void iso15693_add_subcarrier(DigitalSignal* signal, Iso15693SignalDataRate data_rate) {
|
||||
const uint32_t k = data_rate == Iso15693SignalDataRateHi ? ISO15693_SIGNAL_COEFF_HI :
|
||||
ISO15693_SIGNAL_COEFF_LO;
|
||||
for(uint32_t i = 0; i < ISO15693_SIGNAL_ZERO_EDGES * k; ++i) {
|
||||
digital_signal_add_period_with_level(signal, ISO15693_SIGNAL_FC_16, !(i % 2));
|
||||
}
|
||||
}
|
||||
|
||||
static void iso15693_add_bit(DigitalSignal* signal, Iso15693SignalDataRate data_rate, bool bit) {
|
||||
if(bit) {
|
||||
iso15693_add_silence(signal, data_rate);
|
||||
iso15693_add_subcarrier(signal, data_rate);
|
||||
} else {
|
||||
iso15693_add_subcarrier(signal, data_rate);
|
||||
iso15693_add_silence(signal, data_rate);
|
||||
}
|
||||
}
|
||||
|
||||
static inline void iso15693_add_sof(DigitalSignal* signal, Iso15693SignalDataRate data_rate) {
|
||||
// Not adding silence since it only increases response time
|
||||
|
||||
for(uint32_t i = 0; i < ISO15693_SIGNAL_FC_768 / ISO15693_SIGNAL_FC_256; ++i) {
|
||||
iso15693_add_subcarrier(signal, data_rate);
|
||||
}
|
||||
|
||||
iso15693_add_bit(signal, data_rate, true);
|
||||
}
|
||||
|
||||
static inline void iso15693_add_eof(DigitalSignal* signal, Iso15693SignalDataRate data_rate) {
|
||||
iso15693_add_bit(signal, data_rate, false);
|
||||
|
||||
for(uint32_t i = 0; i < ISO15693_SIGNAL_FC_768 / ISO15693_SIGNAL_FC_256; ++i) {
|
||||
iso15693_add_subcarrier(signal, data_rate);
|
||||
}
|
||||
|
||||
// Not adding silence since it does nothing here
|
||||
}
|
||||
|
||||
static inline uint32_t
|
||||
iso15693_get_sequence_index(Iso15693SignalIndex index, Iso15693SignalDataRate data_rate) {
|
||||
return index + data_rate * Iso15693SignalIndexNum;
|
||||
}
|
||||
|
||||
static inline void
|
||||
iso15693_add_byte(Iso15693Signal* instance, Iso15693SignalDataRate data_rate, uint8_t byte) {
|
||||
for(size_t i = 0; i < BITS_IN_BYTE; i++) {
|
||||
const uint8_t bit = byte & (1U << i);
|
||||
digital_sequence_add_signal(
|
||||
instance->tx_sequence,
|
||||
iso15693_get_sequence_index(
|
||||
bit ? Iso15693SignalIndexOne : Iso15693SignalIndexZero, data_rate));
|
||||
}
|
||||
}
|
||||
|
||||
static inline void iso15693_signal_encode(
|
||||
Iso15693Signal* instance,
|
||||
Iso15693SignalDataRate data_rate,
|
||||
const uint8_t* tx_data,
|
||||
size_t tx_data_size) {
|
||||
digital_sequence_add_signal(
|
||||
instance->tx_sequence, iso15693_get_sequence_index(Iso15693SignalIndexSof, data_rate));
|
||||
|
||||
for(size_t i = 0; i < tx_data_size; i++) {
|
||||
iso15693_add_byte(instance, data_rate, tx_data[i]);
|
||||
}
|
||||
|
||||
digital_sequence_add_signal(
|
||||
instance->tx_sequence, iso15693_get_sequence_index(Iso15693SignalIndexEof, data_rate));
|
||||
}
|
||||
|
||||
static void iso15693_signal_bank_fill(Iso15693Signal* instance, Iso15693SignalDataRate data_rate) {
|
||||
const uint32_t k = data_rate == Iso15693SignalDataRateHi ? ISO15693_SIGNAL_COEFF_HI :
|
||||
ISO15693_SIGNAL_COEFF_LO;
|
||||
DigitalSignal** bank = instance->banks[data_rate];
|
||||
|
||||
bank[Iso15693SignalIndexSof] = digital_signal_alloc(ISO15693_SIGNAL_SOF_EDGES * k);
|
||||
bank[Iso15693SignalIndexEof] = digital_signal_alloc(ISO15693_SIGNAL_EOF_EDGES * k);
|
||||
bank[Iso15693SignalIndexOne] = digital_signal_alloc(ISO15693_SIGNAL_ONE_EDGES * k);
|
||||
bank[Iso15693SignalIndexZero] = digital_signal_alloc(ISO15693_SIGNAL_ZERO_EDGES * k);
|
||||
|
||||
iso15693_add_sof(bank[Iso15693SignalIndexSof], data_rate);
|
||||
iso15693_add_eof(bank[Iso15693SignalIndexEof], data_rate);
|
||||
iso15693_add_bit(bank[Iso15693SignalIndexOne], data_rate, true);
|
||||
iso15693_add_bit(bank[Iso15693SignalIndexZero], data_rate, false);
|
||||
}
|
||||
|
||||
static void
|
||||
iso15693_signal_bank_clear(Iso15693Signal* instance, Iso15693SignalDataRate data_rate) {
|
||||
DigitalSignal** bank = instance->banks[data_rate];
|
||||
|
||||
for(uint32_t i = 0; i < Iso15693SignalIndexNum; ++i) {
|
||||
digital_signal_free(bank[i]);
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
iso15693_signal_bank_register(Iso15693Signal* instance, Iso15693SignalDataRate data_rate) {
|
||||
for(uint32_t i = 0; i < Iso15693SignalIndexNum; ++i) {
|
||||
digital_sequence_register_signal(
|
||||
instance->tx_sequence,
|
||||
iso15693_get_sequence_index(i, data_rate),
|
||||
instance->banks[data_rate][i]);
|
||||
}
|
||||
}
|
||||
|
||||
Iso15693Signal* iso15693_signal_alloc(const GpioPin* pin) {
|
||||
furi_assert(pin);
|
||||
|
||||
Iso15693Signal* instance = malloc(sizeof(Iso15693Signal));
|
||||
|
||||
instance->tx_sequence = digital_sequence_alloc(BITS_IN_BYTE * 255 + 2, pin);
|
||||
|
||||
for(uint32_t i = 0; i < Iso15693SignalDataRateNum; ++i) {
|
||||
iso15693_signal_bank_fill(instance, i);
|
||||
iso15693_signal_bank_register(instance, i);
|
||||
}
|
||||
|
||||
return instance;
|
||||
}
|
||||
|
||||
void iso15693_signal_free(Iso15693Signal* instance) {
|
||||
furi_assert(instance);
|
||||
|
||||
digital_sequence_free(instance->tx_sequence);
|
||||
|
||||
for(uint32_t i = 0; i < Iso15693SignalDataRateNum; ++i) {
|
||||
iso15693_signal_bank_clear(instance, i);
|
||||
}
|
||||
|
||||
free(instance);
|
||||
}
|
||||
|
||||
void iso15693_signal_tx(
|
||||
Iso15693Signal* instance,
|
||||
Iso15693SignalDataRate data_rate,
|
||||
const uint8_t* tx_data,
|
||||
size_t tx_data_size) {
|
||||
furi_assert(instance);
|
||||
furi_assert(data_rate < Iso15693SignalDataRateNum);
|
||||
furi_assert(tx_data);
|
||||
|
||||
FURI_CRITICAL_ENTER();
|
||||
digital_sequence_clear(instance->tx_sequence);
|
||||
iso15693_signal_encode(instance, data_rate, tx_data, tx_data_size);
|
||||
digital_sequence_transmit(instance->tx_sequence);
|
||||
|
||||
FURI_CRITICAL_EXIT();
|
||||
}
|
||||
|
||||
void iso15693_signal_tx_sof(Iso15693Signal* instance, Iso15693SignalDataRate data_rate) {
|
||||
furi_assert(instance);
|
||||
furi_assert(data_rate < Iso15693SignalDataRateNum);
|
||||
|
||||
FURI_CRITICAL_ENTER();
|
||||
digital_sequence_clear(instance->tx_sequence);
|
||||
digital_sequence_add_signal(
|
||||
instance->tx_sequence, iso15693_get_sequence_index(Iso15693SignalIndexSof, data_rate));
|
||||
digital_sequence_transmit(instance->tx_sequence);
|
||||
|
||||
FURI_CRITICAL_EXIT();
|
||||
}
|
||||
@@ -0,0 +1,73 @@
|
||||
/**
|
||||
* @file iso15693_signal.h
|
||||
* @brief DigitalSequence preset for generating ISO15693-compliant signals.
|
||||
*
|
||||
*/
|
||||
#pragma once
|
||||
|
||||
#include <furi_hal_resources.h>
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
typedef struct Iso15693Signal Iso15693Signal;
|
||||
|
||||
/**
|
||||
* @brief Supported data rates.
|
||||
*/
|
||||
typedef enum {
|
||||
Iso15693SignalDataRateHi, /**< High data rate. */
|
||||
Iso15693SignalDataRateLo, /**< Low data rate. */
|
||||
Iso15693SignalDataRateNum, /**< Data rate mode count. Internal use. */
|
||||
} Iso15693SignalDataRate;
|
||||
|
||||
/**
|
||||
* @brief Allocate an Iso15693Signal instance with a set GPIO pin.
|
||||
*
|
||||
* @param[in] pin GPIO pin to use during transmission.
|
||||
* @returns pointer to the allocated instance.
|
||||
*/
|
||||
Iso15693Signal* iso15693_signal_alloc(const GpioPin* pin);
|
||||
|
||||
/**
|
||||
* @brief Delete an Iso15693Signal instance.
|
||||
*
|
||||
* @param[in,out] instance pointer to the instance to be deleted.
|
||||
*/
|
||||
void iso15693_signal_free(Iso15693Signal* instance);
|
||||
|
||||
/**
|
||||
* @brief Transmit arbitrary bytes using an Iso15693Signal instance.
|
||||
* @see Iso15693SignalDataRate
|
||||
*
|
||||
* This function will block until the transmisson has been completed.
|
||||
*
|
||||
* @param[in] instance pointer to the instance used in transmission.
|
||||
* @param[in] data_rate data rate to transmit at.
|
||||
* @param[in] tx_data pointer to the data to be transmitted.
|
||||
* @param[in] tx_data_size size of the data to be transmitted in bytes.
|
||||
*/
|
||||
void iso15693_signal_tx(
|
||||
Iso15693Signal* instance,
|
||||
Iso15693SignalDataRate data_rate,
|
||||
const uint8_t* tx_data,
|
||||
size_t tx_data_size);
|
||||
|
||||
/**
|
||||
* @brief Transmit Start of Frame using an Iso15693Signal instance.
|
||||
* @see Iso15693SignalDataRate
|
||||
*
|
||||
* This function will block until the transmisson has been completed.
|
||||
*
|
||||
* @param[in] instance pointer to the instance used in transmission.
|
||||
* @param[in] data_rate data rate to transmit at.
|
||||
*/
|
||||
void iso15693_signal_tx_sof(Iso15693Signal* instance, Iso15693SignalDataRate data_rate);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
Reference in New Issue
Block a user