 c186d2b0cc
			
		
	
	
		c186d2b0cc
		
			
		
	
	
	
	
		
			
			* added support for ISO15693 (NfcV) emulation, added support for reading SLIX tags * SLIX: fixed crash situation when an invalid password was requested * ISO15693: show emulate menu when opening file * rename NfcV emulate scene to match other NfcV names * optimize allocation size for signals * ISO15693: further optimizations of allocation and free code * ISO15693: reduce latency on state machine reset * respond with block security status when option flag is set * increased maximum memory size to match standard added security status handling/load/save added SELECT/QUIET handling more fine grained allocation routines and checks fix memset sizes * added "Listen NfcV Reader" to sniff traffic from reader to card * added correct description to delete menu * also added DSFID/AFI handling and locking * increase sniff log size * scale NfcV frequency a bit, add echo mode, fix signal level at the end * use symbolic modulated/unmodulated GPIO levels * honor AFI field, decrease verbosity and removed debug code * refactor defines for less namespace pollution by using NFCV_ prefixes * correct an oversight that original cards return an generic error when addressing outside block range * use inverse modulation, increasing readable range significantly * rework and better document nfc chip initialization * nfcv code review fixes * Disable accidentally left on signal debug gpio output * Improve NFCV Read/Info GUIs. Authored by @xMasterX, committed by @nvx * Fix crash that occurs when you exit from NFCV emulation and start it again. Authored by @xMasterX, committed by @nvx * Remove delay from emulation loop. This improves compatibility when the reader is Android. * Lib: digital signal debug output pin info Co-authored-by: Tiernan Messmer <tiernan.messmer@gmail.com> Co-authored-by: MX <10697207+xMasterX@users.noreply.github.com> Co-authored-by: gornekich <n.gorbadey@gmail.com> Co-authored-by: あく <alleteam@gmail.com>
		
			
				
	
	
		
			292 lines
		
	
	
		
			8.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			292 lines
		
	
	
		
			8.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #pragma once
 | |
| 
 | |
| #include <stdint.h>
 | |
| #include <stdbool.h>
 | |
| 
 | |
| #include <lib/digital_signal/digital_signal.h>
 | |
| #include <lib/pulse_reader/pulse_reader.h>
 | |
| #include "nfc_util.h"
 | |
| #include <furi_hal_nfc.h>
 | |
| 
 | |
| #ifdef __cplusplus
 | |
| extern "C" {
 | |
| #endif
 | |
| 
 | |
| /* true: modulating releases load, false: modulating adds load resistor to field coil */
 | |
| #define NFCV_LOAD_MODULATION_POLARITY (false)
 | |
| 
 | |
| #define NFCV_FC (13560000.0f) /* MHz */
 | |
| #define NFCV_RESP_SUBC1_PULSE_32 (1.0f / (NFCV_FC / 32) / 2.0f) /*  1.1799 µs */
 | |
| #define NFCV_RESP_SUBC1_UNMOD_256 (256.0f / NFCV_FC) /* 18.8791 µs */
 | |
| #define NFCV_PULSE_DURATION_NS (128.0f * 1000000000.0f / NFCV_FC)
 | |
| 
 | |
| /* ISO/IEC 15693-3:2019(E) 10.4.12: maximum number of blocks is defined as 256 */
 | |
| #define NFCV_BLOCKS_MAX 256
 | |
| /* ISO/IEC 15693-3:2019(E) 10.4.12: maximum size of blocks is defined as 32 */
 | |
| #define NFCV_BLOCKSIZE_MAX 32
 | |
| /* the resulting memory size a card can have */
 | |
| #define NFCV_MEMSIZE_MAX (NFCV_BLOCKS_MAX * NFCV_BLOCKSIZE_MAX)
 | |
| /* ISO/IEC 15693-3:2019(E) 7.1b: standard allows up to 8192, the maxium frame length that we are expected to receive/send is less */
 | |
| #define NFCV_FRAMESIZE_MAX (1 + NFCV_MEMSIZE_MAX + NFCV_BLOCKS_MAX)
 | |
| 
 | |
| /* maximum string length for log messages */
 | |
| #define NFCV_LOG_STR_LEN 128
 | |
| /* maximum of pulses to be buffered by pulse reader */
 | |
| #define NFCV_PULSE_BUFFER 512
 | |
| 
 | |
| //#define NFCV_DIAGNOSTIC_DUMPS
 | |
| //#define NFCV_DIAGNOSTIC_DUMP_SIZE 256
 | |
| //#define NFCV_VERBOSE
 | |
| 
 | |
| /* helpers to calculate the send time based on DWT->CYCCNT */
 | |
| #define NFCV_FDT_USEC(usec) ((usec)*64)
 | |
| #define NFCV_FDT_FC(ticks) ((ticks)*6400 / 1356)
 | |
| 
 | |
| /* state machine when receiving frame bits */
 | |
| #define NFCV_FRAME_STATE_SOF1 0
 | |
| #define NFCV_FRAME_STATE_SOF2 1
 | |
| #define NFCV_FRAME_STATE_CODING_4 2
 | |
| #define NFCV_FRAME_STATE_CODING_256 3
 | |
| #define NFCV_FRAME_STATE_EOF 4
 | |
| #define NFCV_FRAME_STATE_RESET 5
 | |
| 
 | |
| /* sequences for every section of a frame */
 | |
| #define NFCV_SIG_SOF 0
 | |
| #define NFCV_SIG_BIT0 1
 | |
| #define NFCV_SIG_BIT1 2
 | |
| #define NFCV_SIG_EOF 3
 | |
| #define NFCV_SIG_LOW_SOF 4
 | |
| #define NFCV_SIG_LOW_BIT0 5
 | |
| #define NFCV_SIG_LOW_BIT1 6
 | |
| #define NFCV_SIG_LOW_EOF 7
 | |
| 
 | |
| /* various constants */
 | |
| #define NFCV_COMMAND_RETRIES 5
 | |
| #define NFCV_UID_LENGTH 8
 | |
| 
 | |
| /* ISO15693 protocol flags */
 | |
| typedef enum {
 | |
|     /* ISO15693 protocol flags when INVENTORY is NOT set */
 | |
|     NFCV_REQ_FLAG_SUB_CARRIER = (1 << 0),
 | |
|     NFCV_REQ_FLAG_DATA_RATE = (1 << 1),
 | |
|     NFCV_REQ_FLAG_INVENTORY = (1 << 2),
 | |
|     NFCV_REQ_FLAG_PROTOCOL_EXT = (1 << 3),
 | |
|     NFCV_REQ_FLAG_SELECT = (1 << 4),
 | |
|     NFCV_REQ_FLAG_ADDRESS = (1 << 5),
 | |
|     NFCV_REQ_FLAG_OPTION = (1 << 6),
 | |
|     /* ISO15693 protocol flags when INVENTORY flag is set */
 | |
|     NFCV_REQ_FLAG_AFI = (1 << 4),
 | |
|     NFCV_REQ_FLAG_NB_SLOTS = (1 << 5)
 | |
| } NfcVRequestFlags;
 | |
| 
 | |
| /* ISO15693 protocol flags */
 | |
| typedef enum {
 | |
|     NFCV_RES_FLAG_ERROR = (1 << 0),
 | |
|     NFCV_RES_FLAG_VALIDITY = (1 << 1),
 | |
|     NFCV_RES_FLAG_FINAL = (1 << 2),
 | |
|     NFCV_RES_FLAG_PROTOCOL_EXT = (1 << 3),
 | |
|     NFCV_RES_FLAG_SEC_LEN1 = (1 << 4),
 | |
|     NFCV_RES_FLAG_SEC_LEN2 = (1 << 5),
 | |
|     NFCV_RES_FLAG_WAIT_EXT = (1 << 6),
 | |
| } NfcVRsponseFlags;
 | |
| 
 | |
| /* flags for SYSINFO response */
 | |
| typedef enum {
 | |
|     NFCV_SYSINFO_FLAG_DSFID = (1 << 0),
 | |
|     NFCV_SYSINFO_FLAG_AFI = (1 << 1),
 | |
|     NFCV_SYSINFO_FLAG_MEMSIZE = (1 << 2),
 | |
|     NFCV_SYSINFO_FLAG_ICREF = (1 << 3)
 | |
| } NfcVSysinfoFlags;
 | |
| 
 | |
| /* ISO15693 command codes */
 | |
| typedef enum {
 | |
|     /* mandatory command codes */
 | |
|     NFCV_CMD_INVENTORY = 0x01,
 | |
|     NFCV_CMD_STAY_QUIET = 0x02,
 | |
|     /* optional command codes */
 | |
|     NFCV_CMD_READ_BLOCK = 0x20,
 | |
|     NFCV_CMD_WRITE_BLOCK = 0x21,
 | |
|     NFCV_CMD_LOCK_BLOCK = 0x22,
 | |
|     NFCV_CMD_READ_MULTI_BLOCK = 0x23,
 | |
|     NFCV_CMD_WRITE_MULTI_BLOCK = 0x24,
 | |
|     NFCV_CMD_SELECT = 0x25,
 | |
|     NFCV_CMD_RESET_TO_READY = 0x26,
 | |
|     NFCV_CMD_WRITE_AFI = 0x27,
 | |
|     NFCV_CMD_LOCK_AFI = 0x28,
 | |
|     NFCV_CMD_WRITE_DSFID = 0x29,
 | |
|     NFCV_CMD_LOCK_DSFID = 0x2A,
 | |
|     NFCV_CMD_GET_SYSTEM_INFO = 0x2B,
 | |
|     NFCV_CMD_READ_MULTI_SECSTATUS = 0x2C,
 | |
|     /* advanced command codes */
 | |
|     NFCV_CMD_ADVANCED = 0xA0,
 | |
|     /* flipper zero custom command codes */
 | |
|     NFCV_CMD_CUST_ECHO_MODE = 0xDE,
 | |
|     NFCV_CMD_CUST_ECHO_DATA = 0xDF
 | |
| } NfcVCommands;
 | |
| 
 | |
| /* ISO15693 Response error codes */
 | |
| typedef enum {
 | |
|     NFCV_NOERROR = 0x00,
 | |
|     NFCV_ERROR_CMD_NOT_SUP = 0x01, // Command not supported
 | |
|     NFCV_ERROR_CMD_NOT_REC = 0x02, // Command not recognized (eg. parameter error)
 | |
|     NFCV_ERROR_CMD_OPTION = 0x03, // Command option not supported
 | |
|     NFCV_ERROR_GENERIC = 0x0F, // No additional Info about this error
 | |
|     NFCV_ERROR_BLOCK_UNAVAILABLE = 0x10,
 | |
|     NFCV_ERROR_BLOCK_LOCKED_ALREADY = 0x11, // cannot lock again
 | |
|     NFCV_ERROR_BLOCK_LOCKED = 0x12, // cannot be changed
 | |
|     NFCV_ERROR_BLOCK_WRITE = 0x13, // Writing was unsuccessful
 | |
|     NFCV_ERROR_BLOCL_WRITELOCK = 0x14 // Locking was unsuccessful
 | |
| } NfcVErrorcodes;
 | |
| 
 | |
| typedef enum {
 | |
|     NfcVLockBitDsfid = 1,
 | |
|     NfcVLockBitAfi = 2,
 | |
| } NfcVLockBits;
 | |
| 
 | |
| typedef enum {
 | |
|     NfcVAuthMethodManual,
 | |
|     NfcVAuthMethodTonieBox,
 | |
| } NfcVAuthMethod;
 | |
| 
 | |
| typedef enum {
 | |
|     NfcVTypePlain = 0,
 | |
|     NfcVTypeSlix = 1,
 | |
|     NfcVTypeSlixS = 2,
 | |
|     NfcVTypeSlixL = 3,
 | |
|     NfcVTypeSlix2 = 4,
 | |
|     NfcVTypeSniff = 255,
 | |
| } NfcVSubtype;
 | |
| 
 | |
| typedef enum {
 | |
|     NfcVSendFlagsNormal = 0,
 | |
|     NfcVSendFlagsSof = 1 << 0,
 | |
|     NfcVSendFlagsCrc = 1 << 1,
 | |
|     NfcVSendFlagsEof = 1 << 2,
 | |
|     NfcVSendFlagsOneSubcarrier = 0,
 | |
|     NfcVSendFlagsTwoSubcarrier = 1 << 3,
 | |
|     NfcVSendFlagsLowRate = 0,
 | |
|     NfcVSendFlagsHighRate = 1 << 4
 | |
| } NfcVSendFlags;
 | |
| 
 | |
| typedef struct {
 | |
|     uint8_t key_read[4];
 | |
|     uint8_t key_write[4];
 | |
|     uint8_t key_privacy[4];
 | |
|     uint8_t key_destroy[4];
 | |
|     uint8_t key_eas[4];
 | |
|     uint8_t rand[2];
 | |
|     bool privacy;
 | |
| } NfcVSlixData;
 | |
| 
 | |
| typedef union {
 | |
|     NfcVSlixData slix;
 | |
| } NfcVSubtypeData;
 | |
| 
 | |
| typedef struct {
 | |
|     DigitalSignal* nfcv_resp_sof;
 | |
|     DigitalSignal* nfcv_resp_one;
 | |
|     DigitalSignal* nfcv_resp_zero;
 | |
|     DigitalSignal* nfcv_resp_eof;
 | |
| } NfcVEmuAirSignals;
 | |
| 
 | |
| typedef struct {
 | |
|     PulseReader* reader_signal;
 | |
|     DigitalSignal* nfcv_resp_pulse; /* pulse length, fc/32 */
 | |
|     DigitalSignal* nfcv_resp_half_pulse; /* half pulse length, fc/32 */
 | |
|     DigitalSignal* nfcv_resp_unmod; /* unmodulated length 256/fc */
 | |
|     NfcVEmuAirSignals signals_high;
 | |
|     NfcVEmuAirSignals signals_low;
 | |
|     DigitalSequence* nfcv_signal;
 | |
| } NfcVEmuAir;
 | |
| 
 | |
| typedef void (*NfcVEmuProtocolHandler)(
 | |
|     FuriHalNfcTxRxContext* tx_rx,
 | |
|     FuriHalNfcDevData* nfc_data,
 | |
|     void* nfcv_data);
 | |
| typedef bool (*NfcVEmuProtocolFilter)(
 | |
|     FuriHalNfcTxRxContext* tx_rx,
 | |
|     FuriHalNfcDevData* nfc_data,
 | |
|     void* nfcv_data);
 | |
| 
 | |
| /* the default ISO15693 handler context */
 | |
| typedef struct {
 | |
|     uint8_t flags; /* ISO15693-3 flags of the header as specified */
 | |
|     uint8_t command; /* ISO15693-3 command at offset 1 as specified */
 | |
|     bool selected; /* ISO15693-3 flags: selected frame */
 | |
|     bool addressed; /* ISO15693-3 flags: addressed frame */
 | |
|     bool advanced; /* ISO15693-3 command: advanced command */
 | |
|     uint8_t address_offset; /* ISO15693-3 offset of the address in frame, if addressed is set */
 | |
|     uint8_t payload_offset; /* ISO15693-3 offset of the payload in frame */
 | |
| 
 | |
|     uint8_t response_buffer[NFCV_FRAMESIZE_MAX]; /* pre-allocated response buffer */
 | |
|     NfcVSendFlags response_flags; /* flags to use when sending response */
 | |
|     uint32_t send_time; /* timestamp when to send the response */
 | |
| 
 | |
|     NfcVEmuProtocolFilter emu_protocol_filter;
 | |
| } NfcVEmuProtocolCtx;
 | |
| 
 | |
| typedef struct {
 | |
|     /* common ISO15693 fields, being specified in ISO15693-3 */
 | |
|     uint8_t dsfid;
 | |
|     uint8_t afi;
 | |
|     uint8_t ic_ref;
 | |
|     uint16_t block_num;
 | |
|     uint8_t block_size;
 | |
|     uint8_t data[NFCV_MEMSIZE_MAX];
 | |
|     uint8_t security_status[1 + NFCV_BLOCKS_MAX];
 | |
|     bool selected;
 | |
|     bool quiet;
 | |
| 
 | |
|     bool modified;
 | |
|     bool ready;
 | |
|     bool echo_mode;
 | |
| 
 | |
|     /* specfic variant infos */
 | |
|     NfcVSubtype sub_type;
 | |
|     NfcVSubtypeData sub_data;
 | |
|     NfcVAuthMethod auth_method;
 | |
| 
 | |
|     /* precalced air level data */
 | |
|     NfcVEmuAir emu_air;
 | |
| 
 | |
|     uint8_t* frame; /* [NFCV_FRAMESIZE_MAX] ISO15693-2 incoming raw data from air layer */
 | |
|     uint8_t frame_length; /* ISO15693-2 length of incoming data */
 | |
|     uint32_t eof_timestamp; /* ISO15693-2 EOF timestamp, read from DWT->CYCCNT */
 | |
| 
 | |
|     /* handler for the protocol layer as specified in ISO15693-3 */
 | |
|     NfcVEmuProtocolHandler emu_protocol_handler;
 | |
|     void* emu_protocol_ctx;
 | |
|     /* runtime data */
 | |
|     char last_command[NFCV_LOG_STR_LEN];
 | |
|     char error[NFCV_LOG_STR_LEN];
 | |
| } NfcVData;
 | |
| 
 | |
| typedef struct {
 | |
|     uint16_t blocks_to_read;
 | |
|     int16_t blocks_read;
 | |
| } NfcVReader;
 | |
| 
 | |
| ReturnCode nfcv_read_blocks(NfcVReader* reader, NfcVData* data);
 | |
| ReturnCode nfcv_read_sysinfo(FuriHalNfcDevData* nfc_data, NfcVData* data);
 | |
| ReturnCode nfcv_inventory(uint8_t* uid);
 | |
| bool nfcv_read_card(NfcVReader* reader, FuriHalNfcDevData* nfc_data, NfcVData* data);
 | |
| 
 | |
| void nfcv_emu_init(FuriHalNfcDevData* nfc_data, NfcVData* nfcv_data);
 | |
| void nfcv_emu_deinit(NfcVData* nfcv_data);
 | |
| bool nfcv_emu_loop(
 | |
|     FuriHalNfcTxRxContext* tx_rx,
 | |
|     FuriHalNfcDevData* nfc_data,
 | |
|     NfcVData* nfcv_data,
 | |
|     uint32_t timeout_ms);
 | |
| void nfcv_emu_send(
 | |
|     FuriHalNfcTxRxContext* tx_rx,
 | |
|     NfcVData* nfcv,
 | |
|     uint8_t* data,
 | |
|     uint8_t length,
 | |
|     NfcVSendFlags flags,
 | |
|     uint32_t send_time);
 | |
| 
 | |
| #ifdef __cplusplus
 | |
| }
 | |
| #endif
 |