123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327 |
- #include "sdk_config.h"
- #if NFC_T4T_TLV_BLOCK_PARSER_ENABLED
- #include <string.h>
- #include "nfc_t4t_tlv_block.h"
- #include "app_util.h"
- #include "sdk_macros.h"
- #include "nordic_common.h"
- #define NRF_LOG_MODULE_NAME nfc_t4t_tlv_block_parser
- #if NFC_T4T_TLV_BLOCK_PARSER_LOG_ENABLED
- #define NRF_LOG_LEVEL NFC_T4T_TLV_BLOCK_PARSER_LOG_LEVEL
- #define NRF_LOG_INFO_COLOR NFC_T4T_TLV_BLOCK_PARSER_INFO_COLOR
- #include "nrf_log.h"
- NRF_LOG_MODULE_REGISTER();
- #else
- #define NRF_LOG_LEVEL 0
- #include "nrf_log.h"
- #endif
- #define TLV_TYPE_FIELD_LEN 1U
- #define TLV_LEN_SHORT_FIELD_LEN 1U
- #define TLV_LEN_LONG_FIELD_LEN 3U
- #define TLV_LEN_LONG_FORMAT_TOKEN 0xFF
- #define TLV_LEN_LONG_FORMAT_TOKEN_SIZE 1U
- #define TLV_LEN_LONG_FORMAT_MIN_VALUE 0xFF
- #define TLV_MIN_TL_FIELD_LEN (TLV_TYPE_FIELD_LEN + TLV_LEN_SHORT_FIELD_LEN)
- #define TLV_MIN_LONG_FORMAT_TL_FIELD_LEN (TLV_TYPE_FIELD_LEN + TLV_LEN_LONG_FIELD_LEN)
- #define TLV_MIN_VALUE_FIELD_SIZE 6U
- #define FILE_CONTROL_FILE_ID_FIELD_SIZE 2U
- #define FILE_CONTROL_READ_ACCESS_FIELD_SIZE 1U
- #define FILE_CONTROL_WRITE_ACCESS_FIELD_SIZE 1U
- #define FILE_CONTROL_COMMON_FIELDS_SIZE (FILE_CONTROL_FILE_ID_FIELD_SIZE \
- + FILE_CONTROL_READ_ACCESS_FIELD_SIZE \
- + FILE_CONTROL_WRITE_ACCESS_FIELD_SIZE)
- #define FILE_ID_INVALID_VALUE_0 0x0000
- #define FILE_ID_INVALID_VALUE_1 0xE102
- #define FILE_ID_INVALID_VALUE_2 0xE103
- #define FILE_ID_INVALID_VALUE_3 0x3F00
- #define FILE_ID_INVALID_VALUE_4 0x3FFF
- #define FILE_ID_INVALID_VALUE_5 0xFFFF
- #define NDEF_FILE_MAX_SIZE_FIELD_SIZE 2U
- #define NDEF_FILE_MAX_SIZE_MIN_VAL 0x0005
- #define NDEF_FILE_MAX_SIZE_MAX_VAL 0xFFFE
- #define NDEF_FILE_CONTROL_TLV_LEN (FILE_CONTROL_COMMON_FIELDS_SIZE \
- + NDEF_FILE_MAX_SIZE_FIELD_SIZE)
- #define PROPRIETARY_FILE_MAX_SIZE_FIELD_SIZE 2U
- #define PROPRIETARY_FILE_MAX_SIZE_MIN_VAL 0x0003
- #define PROPRIETARY_FILE_MAX_SIZE_MAX_VAL 0xFFFE
- #define PROPRIETARY_FILE_CONTROL_TLV_LEN (FILE_CONTROL_COMMON_FIELDS_SIZE \
- + PROPRIETARY_FILE_MAX_SIZE_FIELD_SIZE)
- #define EXTENDED_NDEF_FILE_MAX_SIZE_FIELD_SIZE 4U
- #define EXTENDED_NDEF_FILE_MAX_SIZE_MIN_VAL 0x0000FFFF
- #define EXTENDED_NDEF_FILE_MAX_SIZE_MAX_VAL 0xFFFFFFFE
- #define EXTENDED_NDEF_FILE_CONTROL_TLV_LEN (FILE_CONTROL_COMMON_FIELDS_SIZE \
- + EXTENDED_NDEF_FILE_MAX_SIZE_FIELD_SIZE)
- #define NFC_T4T_FILE_CONTROL_MAX_SIZE_FIELD_RANGE_VERIFY(VALUE, MIN, MAX) \
- if ( ( (VALUE) < (MIN) ) || ( (VALUE) > (MAX) ) ) \
- { \
- return NRF_ERROR_INVALID_DATA; \
- }
- __STATIC_INLINE ret_code_t nfc_t4t_file_control_tl_validate(nfc_t4t_tlv_block_t * p_file_control_tlv)
- {
- switch (p_file_control_tlv->type)
- {
- case NDEF_FILE_CONTROL_TLV:
- VERIFY_TRUE(p_file_control_tlv->length == NDEF_FILE_CONTROL_TLV_LEN,
- NRF_ERROR_INVALID_DATA);
- return NRF_SUCCESS;
- case PROPRIETARY_FILE_CONTROL_TLV:
- VERIFY_TRUE(p_file_control_tlv->length == PROPRIETARY_FILE_CONTROL_TLV_LEN,
- NRF_ERROR_INVALID_DATA);
- return NRF_SUCCESS;
- case EXTENDED_NDEF_FILE_CONTROL_TLV:
- VERIFY_TRUE(p_file_control_tlv->length == EXTENDED_NDEF_FILE_CONTROL_TLV_LEN,
- NRF_ERROR_INVALID_DATA);
- return NRF_SUCCESS;
- default:
- return NRF_ERROR_INVALID_DATA;
- }
- }
- static ret_code_t nfc_t4t_file_control_value_parse(nfc_t4t_tlv_block_t * p_file_control_tlv,
- uint8_t * p_value_buff)
- {
- nfc_t4t_file_control_val_t * p_control_tlv_val;
-
- p_control_tlv_val = &p_file_control_tlv->value;
- p_control_tlv_val->file_id = uint16_big_decode(p_value_buff);
- p_value_buff += FILE_CONTROL_FILE_ID_FIELD_SIZE;
- switch (p_control_tlv_val->file_id)
- {
- case FILE_ID_INVALID_VALUE_0:
- case FILE_ID_INVALID_VALUE_1:
- case FILE_ID_INVALID_VALUE_2:
- case FILE_ID_INVALID_VALUE_3:
- case FILE_ID_INVALID_VALUE_4:
- case FILE_ID_INVALID_VALUE_5:
- return NRF_ERROR_INVALID_DATA;
- default:
- break;
- }
-
- switch (p_file_control_tlv->type)
- {
- case NDEF_FILE_CONTROL_TLV:
- p_control_tlv_val->max_file_size = uint16_big_decode(p_value_buff);
- p_value_buff += NDEF_FILE_MAX_SIZE_FIELD_SIZE;
- NFC_T4T_FILE_CONTROL_MAX_SIZE_FIELD_RANGE_VERIFY(p_control_tlv_val->max_file_size,
- NDEF_FILE_MAX_SIZE_MIN_VAL,
- NDEF_FILE_MAX_SIZE_MAX_VAL);
- break;
- case PROPRIETARY_FILE_CONTROL_TLV:
- p_control_tlv_val->max_file_size = uint16_big_decode(p_value_buff);
- p_value_buff += PROPRIETARY_FILE_MAX_SIZE_FIELD_SIZE;
- NFC_T4T_FILE_CONTROL_MAX_SIZE_FIELD_RANGE_VERIFY(p_control_tlv_val->max_file_size,
- PROPRIETARY_FILE_MAX_SIZE_MIN_VAL,
- PROPRIETARY_FILE_MAX_SIZE_MAX_VAL);
- break;
- case EXTENDED_NDEF_FILE_CONTROL_TLV:
- p_control_tlv_val->max_file_size = uint32_big_decode(p_value_buff);
- p_value_buff += EXTENDED_NDEF_FILE_MAX_SIZE_FIELD_SIZE;
- NFC_T4T_FILE_CONTROL_MAX_SIZE_FIELD_RANGE_VERIFY(p_control_tlv_val->max_file_size,
- EXTENDED_NDEF_FILE_MAX_SIZE_MIN_VAL,
- EXTENDED_NDEF_FILE_MAX_SIZE_MAX_VAL);
- break;
- }
-
- p_control_tlv_val->read_access = *p_value_buff;
- p_value_buff += FILE_CONTROL_READ_ACCESS_FIELD_SIZE;
-
- p_control_tlv_val->write_access = *p_value_buff;
- return NRF_SUCCESS;
- }
- ret_code_t nfc_t4t_file_control_tlv_parse(nfc_t4t_tlv_block_t * p_file_control_tlv,
- uint8_t * p_raw_data,
- uint16_t * p_len)
- {
- ret_code_t err_code;
- uint8_t * p_offset = p_raw_data;
- if (*p_len < TLV_MIN_TL_FIELD_LEN)
- {
- return NRF_ERROR_INVALID_LENGTH;
- }
- memset(p_file_control_tlv, 0, sizeof(nfc_t4t_tlv_block_t));
-
- p_file_control_tlv->type = *p_offset;
- p_offset += TLV_TYPE_FIELD_LEN;
-
- if (*p_offset == TLV_LEN_LONG_FORMAT_TOKEN)
- {
- if (*p_len < TLV_MIN_LONG_FORMAT_TL_FIELD_LEN)
- {
- return NRF_ERROR_INVALID_LENGTH;
- }
- p_file_control_tlv->length = uint16_big_decode(p_offset + TLV_LEN_LONG_FORMAT_TOKEN_SIZE);
- p_offset += TLV_LEN_LONG_FIELD_LEN;
- if (p_file_control_tlv->length < TLV_LEN_LONG_FORMAT_MIN_VALUE)
- {
- return NRF_ERROR_INVALID_DATA;
- }
- }
- else
- {
- p_file_control_tlv->length = *p_offset;
- p_offset += TLV_LEN_SHORT_FIELD_LEN;
- }
-
- uint16_t tlv_block_len = (p_offset - p_raw_data) + p_file_control_tlv->length;
- if (*p_len < tlv_block_len)
- {
- return NRF_ERROR_INVALID_LENGTH;
- }
- *p_len = tlv_block_len;
-
- err_code = nfc_t4t_file_control_tl_validate(p_file_control_tlv);
- VERIFY_SUCCESS(err_code);
-
- err_code = nfc_t4t_file_control_value_parse(p_file_control_tlv, p_offset);
- return err_code;
- }
- void nfc_t4t_file_control_tlv_printout(uint8_t num, nfc_t4t_tlv_block_t * p_t4t_tlv_block)
- {
- NRF_LOG_INFO("%d file Control TLV", num);
- switch (p_t4t_tlv_block->type)
- {
- case NDEF_FILE_CONTROL_TLV:
- NRF_LOG_INFO("Type: NDEF File Control (0x%02x)", p_t4t_tlv_block->type);
- break;
- case PROPRIETARY_FILE_CONTROL_TLV:
- NRF_LOG_INFO("Type: Proprietary File Control (0x%02x)", p_t4t_tlv_block->type);
- break;
- case EXTENDED_NDEF_FILE_CONTROL_TLV:
- NRF_LOG_INFO("Type: Extended NDEF File Control (0x%02x)", p_t4t_tlv_block->type);
- break;
- default:
- NRF_LOG_INFO("Type: Unknown (0x%02x)", p_t4t_tlv_block->type);
- }
- NRF_LOG_INFO("Length (in bytes): %d", p_t4t_tlv_block->length);
- nfc_t4t_file_control_val_t * p_tlv_val = &p_t4t_tlv_block->value;
- NRF_LOG_INFO("File Identifier: 0x%04X ", p_tlv_val->file_id);
- NRF_LOG_INFO("Maximum file size: %d ", p_tlv_val->max_file_size);
- NRF_LOG_INFO("Read access condition: 0x%02X ", p_tlv_val->read_access);
- NRF_LOG_INFO("Write access condition: 0x%02x ", p_tlv_val->write_access);
- if (p_tlv_val->file.p_content != NULL)
- {
- NRF_LOG_INFO("NDEF file content present. Length: %d ", p_tlv_val->file.len);
- NRF_LOG_HEXDUMP_INFO(p_tlv_val->file.p_content, p_tlv_val->file.len);
- }
- else
- {
- NRF_LOG_INFO("NDEF file content is not present ");
- }
- }
- #endif
|