123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266 |
- /**
- * Copyright (c) 2016 - 2020, Nordic Semiconductor ASA
- *
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without modification,
- * are permitted provided that the following conditions are met:
- *
- * 1. Redistributions of source code must retain the above copyright notice, this
- * list of conditions and the following disclaimer.
- *
- * 2. Redistributions in binary form, except as embedded into a Nordic
- * Semiconductor ASA integrated circuit in a product or a software update for
- * such product, must reproduce the above copyright notice, this list of
- * conditions and the following disclaimer in the documentation and/or other
- * materials provided with the distribution.
- *
- * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
- * contributors may be used to endorse or promote products derived from this
- * software without specific prior written permission.
- *
- * 4. This software, with or without modification, must only be used with a
- * Nordic Semiconductor ASA integrated circuit.
- *
- * 5. Any software provided in binary form under this license must not be reverse
- * engineered, decompiled, modified and/or disassembled.
- *
- * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
- * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
- * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
- * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
- * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
- * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
- * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- */
- #include "sdk_config.h"
- #if NFC_T4T_CC_FILE_PARSER_ENABLED
- #include <string.h>
- #include "nfc_t4t_cc_file.h"
- #include "sdk_macros.h"
- #include "nordic_common.h"
- #include "app_util.h"
- #define NRF_LOG_MODULE_NAME nfc_t4t_cc_file_parser
- #if NFC_T4T_CC_FILE_PARSER_LOG_ENABLED
- #define NRF_LOG_LEVEL NFC_T4T_CC_FILE_PARSER_LOG_LEVEL
- #define NRF_LOG_INFO_COLOR NFC_T4T_CC_FILE_PARSER_INFO_COLOR
- #include "nrf_log.h"
- NRF_LOG_MODULE_REGISTER();
- #else // NFC_T4T_CC_FILE_PARSER_LOG_ENABLED
- #define NRF_LOG_LEVEL 0
- #include "nrf_log.h"
- #endif // NFC_T4T_CC_FILE_PARSER_LOG_ENABLED
- /**
- * @brief Valid value range for CCLEN field.
- */
- #define CC_LEN_MIN_VALUE 0x000F
- #define CC_LEN_MAX_VALUE 0xFFFE
- /**
- * @brief Valid major versions of Type 4 Tag specification.
- */
- #define NFC_T4T_EXTENDED_MAJOR_VER 0x03 ///< Major version number allowing first TLV block to be Extended NDEF File Control TLV
- #define NFC_T4T_REGULAR_MAJOR_VER 0x02 ///< Major version number allowing first TLV block to be NDEF File Control TLV
- /**
- * @brief Valid value range for MLe field.
- */
- #define MLE_LEN_MIN_VALUE 0x000F
- #define MLE_LEN_MAX_VALUE 0xFFFF
- /**
- * @brief Valid value range for MLc field.
- */
- #define MLC_LEN_MIN_VALUE 0x0001
- #define MLC_LEN_MAX_VALUE 0xFFFF
- /**
- * @brief Field sizes that are present in CC file.
- */
- #define CC_LEN_FIELD_SIZE 2U
- #define MAP_VER_FIELD_SIZE 1U
- #define MLE_FIELD_SIZE 2U
- #define MLC_FIELD_SIZE 2U
- /// Gets least significant nibble (a 4-bit value) from a byte.
- #define LSN_GET(val) (val & 0x0F)
- /// Gets most significant nibble (a 4-bit value) from a byte.
- #define MSN_GET(val) ((val >> 4) & 0x0F)
- /**
- * @brief Function for validating arguments used by CC file parsing procedure.
- */
- __STATIC_INLINE ret_code_t nfc_t4t_cc_args_validate(nfc_t4t_capability_container_t * p_t4t_cc_file,
- uint8_t * p_raw_data,
- uint16_t len)
- {
- if ( (p_t4t_cc_file == NULL)
- || (p_t4t_cc_file->p_tlv_block_array == NULL)
- || (p_raw_data == NULL) )
- {
- return NRF_ERROR_NULL;
- }
- if ( (len < CC_LEN_MIN_VALUE) || (len > CC_LEN_MAX_VALUE) )
- {
- return NRF_ERROR_INVALID_LENGTH;
- }
- if (p_t4t_cc_file->max_tlv_blocks == 0)
- {
- return NRF_ERROR_NO_MEM;
- }
- return NRF_SUCCESS;
- }
- /**
- * @brief Function for validating CC file descriptor content.
- */
- __STATIC_INLINE ret_code_t nfc_t4t_cc_file_validate(nfc_t4t_capability_container_t * p_t4t_cc_file)
- {
- uint16_t type = p_t4t_cc_file->p_tlv_block_array[0].type;
- if ( (p_t4t_cc_file->major_version == NFC_T4T_EXTENDED_MAJOR_VER
- && type == EXTENDED_NDEF_FILE_CONTROL_TLV) ||
- (p_t4t_cc_file->major_version == NFC_T4T_REGULAR_MAJOR_VER
- && type == NDEF_FILE_CONTROL_TLV) )
- {
- return NRF_SUCCESS;
- }
- return NRF_ERROR_INVALID_DATA;
- }
- /**
- * @brief Function for clearing all TLV blocks from CC file descriptor.
- */
- __STATIC_INLINE void nfc_t4t_cc_file_clear(nfc_t4t_capability_container_t * p_t4t_cc_file)
- {
- p_t4t_cc_file->tlv_count = 0;
- }
- /**
- * @brief Function for adding a TLV block to the CC file descriptor.
- */
- static ret_code_t nfc_t4t_tlv_block_insert(nfc_t4t_capability_container_t * p_t4t_cc_file,
- nfc_t4t_tlv_block_t * p_tlv_block)
- {
- if (p_t4t_cc_file->tlv_count == p_t4t_cc_file->max_tlv_blocks)
- {
- return NRF_ERROR_NO_MEM;
- }
- // Copy contents of the source block.
- p_t4t_cc_file->p_tlv_block_array[p_t4t_cc_file->tlv_count] = *p_tlv_block;
- p_t4t_cc_file->tlv_count++;
- return NRF_SUCCESS;
- }
- ret_code_t nfc_t4t_cc_file_parse(nfc_t4t_capability_container_t * p_t4t_cc_file,
- uint8_t * p_raw_data,
- uint16_t len)
- {
- ret_code_t err_code = nfc_t4t_cc_args_validate(p_t4t_cc_file, p_raw_data, len);
- VERIFY_SUCCESS(err_code);
- uint8_t * p_offset = p_raw_data;
- nfc_t4t_cc_file_clear(p_t4t_cc_file);
- p_t4t_cc_file->len = uint16_big_decode(p_offset);
- p_offset += CC_LEN_FIELD_SIZE;
- p_t4t_cc_file->major_version = MSN_GET(*p_offset);
- p_t4t_cc_file->minor_version = LSN_GET(*p_offset);
- p_offset += MAP_VER_FIELD_SIZE;
- p_t4t_cc_file->max_rapdu_size = uint16_big_decode(p_offset);
- p_offset += MLE_FIELD_SIZE;
- p_t4t_cc_file->max_capdu_size = uint16_big_decode(p_offset);
- p_offset += MLC_FIELD_SIZE;
- nfc_t4t_tlv_block_t new_block;
- len -= (p_offset - p_raw_data);
- while (len > 0)
- {
- uint16_t tlv_len = len;
- err_code = nfc_t4t_file_control_tlv_parse(&new_block, p_offset, &tlv_len);
- VERIFY_SUCCESS(err_code);
- p_offset += tlv_len;
- len -= tlv_len;
- err_code = nfc_t4t_tlv_block_insert(p_t4t_cc_file, &new_block);
- VERIFY_SUCCESS(err_code);
- }
- return nfc_t4t_cc_file_validate(p_t4t_cc_file);
- }
- nfc_t4t_tlv_block_t * nfc_t4t_file_content_get(nfc_t4t_capability_container_t * p_t4t_cc_file,
- uint16_t file_id)
- {
- nfc_t4t_tlv_block_t * p_tlv_array = p_t4t_cc_file->p_tlv_block_array;
- for (uint8_t i = 0; i < p_t4t_cc_file->tlv_count; i++)
- {
- nfc_t4t_file_control_val_t * p_tlv_value = &p_tlv_array[i].value;
- if (p_tlv_value->file_id == file_id)
- {
- return (p_tlv_array + i);
- }
- }
- return NULL;
- }
- ret_code_t nfc_t4t_file_content_set(nfc_t4t_capability_container_t * p_t4t_cc_file,
- nfc_t4t_file_t file,
- uint16_t file_id)
- {
- nfc_t4t_tlv_block_t * p_tlv_block;
- p_tlv_block = nfc_t4t_file_content_get(p_t4t_cc_file, file_id);
- if (p_tlv_block != NULL)
- {
- p_tlv_block->value.file = file;
- return NRF_SUCCESS;
- }
- return NRF_ERROR_NOT_FOUND;
- }
- void nfc_t4t_cc_file_printout(nfc_t4t_capability_container_t * p_t4t_cc_file)
- {
- NRF_LOG_INFO("Capability Container File content: ")
- NRF_LOG_INFO("CCLEN: %d ", p_t4t_cc_file->len);
- NRF_LOG_INFO("Mapping Version: %d.%d ",
- p_t4t_cc_file->major_version,
- p_t4t_cc_file->minor_version);
- NRF_LOG_INFO("MLe: %d ", p_t4t_cc_file->max_rapdu_size)
- NRF_LOG_INFO("MLc: %d ", p_t4t_cc_file->max_capdu_size)
- NRF_LOG_INFO("Capability Container File contains %d File Control TLV block(s).",
- p_t4t_cc_file->tlv_count);
- for (uint8_t i = 0; i < p_t4t_cc_file->tlv_count; i++)
- {
- nfc_t4t_file_control_tlv_printout(i, &p_t4t_cc_file->p_tlv_block_array[i]);
- }
- }
- #endif // NFC_T4T_CC_FILE_PARSER_ENABLED
|