 389ff92cc1
			
		
	
	
		389ff92cc1
		
			
		
	
	
	
	
		
			
			* Makefile, Scripts: new linter * About: remove ID from IC * Firmware: remove double define for DIVC/DIVR * Scripts: check folder names too. Docker: replace syntax check with make lint. * Reformat Sources and Migrate to new file naming convention * Docker: symlink clang-format-12 to clang-format * Add coding style guide
		
			
				
	
	
		
			3033 lines
		
	
	
		
			122 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			3033 lines
		
	
	
		
			122 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| 
 | |
| /******************************************************************************
 | |
|   * \attention
 | |
|   *
 | |
|   * <h2><center>© COPYRIGHT 2020 STMicroelectronics</center></h2>
 | |
|   *
 | |
|   * Licensed under ST MYLIBERTY SOFTWARE LICENSE AGREEMENT (the "License");
 | |
|   * You may not use this file except in compliance with the License.
 | |
|   * You may obtain a copy of the License at:
 | |
|   *
 | |
|   *        www.st.com/myliberty
 | |
|   *
 | |
|   * Unless required by applicable law or agreed to in writing, software 
 | |
|   * distributed under the License is distributed on an "AS IS" BASIS, 
 | |
|   * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied,
 | |
|   * AND SPECIFICALLY DISCLAIMING THE IMPLIED WARRANTIES OF MERCHANTABILITY,
 | |
|   * FITNESS FOR A PARTICULAR PURPOSE, AND NON-INFRINGEMENT.
 | |
|   * See the License for the specific language governing permissions and
 | |
|   * limitations under the License.
 | |
|   *
 | |
| ******************************************************************************/
 | |
| 
 | |
| /*
 | |
|  *      PROJECT:   NFCC firmware
 | |
|  *      LANGUAGE:  ISO C99
 | |
|  */
 | |
| 
 | |
| /*! \file rfal_isoDep.c
 | |
|  *
 | |
|  *  \author Gustavo Patricio
 | |
|  *
 | |
|  *  \brief Implementation of ISO-DEP protocol
 | |
|  *  
 | |
|  *  This implementation was based on the following specs:
 | |
|  *    - ISO/IEC 14443-4  2nd Edition 2008-07-15
 | |
|  *    - NFC Forum Digital Protocol  1.1 2014-01-14
 | |
|  *
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * INCLUDES
 | |
|  ******************************************************************************
 | |
|  */
 | |
| 
 | |
| #include "rfal_isoDep.h"
 | |
| #include "rfal_rf.h"
 | |
| #include "utils.h"
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * ENABLE SWITCH
 | |
|  ******************************************************************************
 | |
|  */
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP
 | |
| 
 | |
| #if(!RFAL_FEATURE_ISO_DEP_POLL && !RFAL_FEATURE_ISO_DEP_LISTEN)
 | |
| #error \
 | |
|     " RFAL: Invalid ISO-DEP Configuration. Please select at least one mode: Poller and/or Listener. "
 | |
| #endif
 | |
| 
 | |
| /* Check for valid I-Block length [RFAL_ISODEP_FSX_16 ; RFAL_ISODEP_FSX_4096]*/
 | |
| #if((RFAL_FEATURE_ISO_DEP_IBLOCK_MAX_LEN > 4096) || (RFAL_FEATURE_ISO_DEP_IBLOCK_MAX_LEN < 16))
 | |
| #error \
 | |
|     " RFAL: Invalid ISO-DEP IBlock Max length. Please change RFAL_FEATURE_ISO_DEP_IBLOCK_MAX_LEN. "
 | |
| #endif
 | |
| 
 | |
| /* Check for valid APDU length. */
 | |
| #if((RFAL_FEATURE_ISO_DEP_APDU_MAX_LEN < RFAL_FEATURE_ISO_DEP_IBLOCK_MAX_LEN))
 | |
| #error " RFAL: Invalid ISO-DEP APDU Max length. Please change RFAL_FEATURE_ISO_DEP_APDU_MAX_LEN. "
 | |
| #endif
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * DEFINES
 | |
|  ******************************************************************************
 | |
|  */
 | |
| #define ISODEP_CRC_LEN RFAL_CRC_LEN /*!< ISO1443 CRC Length */
 | |
| 
 | |
| #define ISODEP_PCB_POS (0U) /*!< PCB position on message header*/
 | |
| #define ISODEP_SWTX_INF_POS (1U) /*!< INF position in a S-WTX       */
 | |
| 
 | |
| #define ISODEP_DID_POS (1U) /*!< DID position on message header*/
 | |
| #define ISODEP_SWTX_PARAM_LEN (1U) /*!< SWTX parameter length         */
 | |
| 
 | |
| #define ISODEP_DSL_MAX_LEN \
 | |
|     (RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN) /*!< Deselect Req/Res length */
 | |
| 
 | |
| #define ISODEP_PCB_xBLOCK_MASK (0xC0U) /*!< Bit mask for Block type       */
 | |
| #define ISODEP_PCB_IBLOCK (0x00U) /*!< Bit mask indicating a I-Block */
 | |
| #define ISODEP_PCB_RBLOCK (0x80U) /*!< Bit mask indicating a R-Block */
 | |
| #define ISODEP_PCB_SBLOCK (0xC0U) /*!< Bit mask indicating a S-Block */
 | |
| #define ISODEP_PCB_INVALID (0x40U) /*!< Bit mask of an Invalid PCB    */
 | |
| 
 | |
| #define ISODEP_HDR_MAX_LEN                       \
 | |
|     (RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN + \
 | |
|      RFAL_ISODEP_NAD_LEN) /*!< Max header length (PCB + DID + NAD)      */
 | |
| 
 | |
| #define ISODEP_PCB_IB_VALID_MASK \
 | |
|     (ISODEP_PCB_B6_BIT | ISODEP_PCB_B2_BIT) /*!< Bit mask for the MUST bits on I-Block    */
 | |
| #define ISODEP_PCB_IB_VALID_VAL \
 | |
|     (ISODEP_PCB_B2_BIT) /*!< Value for the MUST bits on I-Block       */
 | |
| #define ISODEP_PCB_RB_VALID_MASK             \
 | |
|     (ISODEP_PCB_B6_BIT | ISODEP_PCB_B3_BIT | \
 | |
|      ISODEP_PCB_B2_BIT) /*!< Bit mask for the MUST bits on R-Block    */
 | |
| #define ISODEP_PCB_RB_VALID_VAL \
 | |
|     (ISODEP_PCB_B6_BIT | ISODEP_PCB_B2_BIT) /*!< Value for the MUST bits on R-Block       */
 | |
| #define ISODEP_PCB_SB_VALID_MASK             \
 | |
|     (ISODEP_PCB_B3_BIT | ISODEP_PCB_B2_BIT | \
 | |
|      ISODEP_PCB_B1_BIT) /*!< Bit mask for the MUST bits on I-Block    */
 | |
| #define ISODEP_PCB_SB_VALID_VAL \
 | |
|     (ISODEP_PCB_B2_BIT) /*!< Value for the MUST bits on I-Block       */
 | |
| 
 | |
| #define ISODEP_PCB_B1_BIT \
 | |
|     (0x01U) /*!< Bit mask for the RFU S Blocks                                        */
 | |
| #define ISODEP_PCB_B2_BIT \
 | |
|     (0x02U) /*!< Bit mask for the RFU bit2 in I,S,R Blocks                            */
 | |
| #define ISODEP_PCB_B3_BIT \
 | |
|     (0x04U) /*!< Bit mask for the RFU bit3 in R Blocks                                */
 | |
| #define ISODEP_PCB_B6_BIT \
 | |
|     (0x20U) /*!< Bit mask for the RFU bit2 in R Blocks                                */
 | |
| #define ISODEP_PCB_CHAINING_BIT \
 | |
|     (0x10U) /*!< Bit mask for the chaining bit of an ISO DEP I-Block in PCB.          */
 | |
| #define ISODEP_PCB_DID_BIT \
 | |
|     (0x08U) /*!< Bit mask for the DID presence bit of an ISO DEP I,S,R Blocks PCB.    */
 | |
| #define ISODEP_PCB_NAD_BIT \
 | |
|     (0x04U) /*!< Bit mask for the NAD presence bit of an ISO DEP I,S,R Blocks in PCB  */
 | |
| #define ISODEP_PCB_BN_MASK \
 | |
|     (0x01U) /*!< Bit mask for the block number of an ISO DEP I,R Block in PCB         */
 | |
| 
 | |
| #define ISODEP_SWTX_PL_MASK \
 | |
|     (0xC0U) /*!< Bit mask for the Power Level bits of the inf byte of an WTX request or response */
 | |
| #define ISODEP_SWTX_WTXM_MASK \
 | |
|     (0x3FU) /*!< Bit mask for the WTXM bits of the inf byte of an WTX request or response        */
 | |
| 
 | |
| #define ISODEP_RBLOCK_INF_LEN (0U) /*!< INF length of R-Block               Digital 1.1 15.1.3 */
 | |
| #define ISODEP_SDSL_INF_LEN (0U) /*!< INF length of S(DSL)                Digital 1.1 15.1.3 */
 | |
| #define ISODEP_SWTX_INF_LEN (1U) /*!< INF length of S(WTX)                Digital 1.1 15.2.2 */
 | |
| 
 | |
| #define ISODEP_WTXM_MIN (1U) /*!< Minimum allowed value for the WTXM, Digital 1.0 13.2.2 */
 | |
| #define ISODEP_WTXM_MAX (59U) /*!< Maximum allowed value for the WTXM, Digital 1.0 13.2.2 */
 | |
| 
 | |
| #define ISODEP_PCB_Sxx_MASK (0x30U) /*!< Bit mask for the S-Block type                          */
 | |
| #define ISODEP_PCB_DESELECT (0x00U) /*!< Bit mask for S-Block indicating Deselect               */
 | |
| #define ISODEP_PCB_WTX (0x30U) /*!< Bit mask for S-Block indicating Waiting Time eXtension */
 | |
| 
 | |
| #define ISODEP_PCB_Rx_MASK (0x10U) /*!< Bit mask for the R-Block type       */
 | |
| #define ISODEP_PCB_ACK (0x00U) /*!< Bit mask for R-Block indicating ACK */
 | |
| #define ISODEP_PCB_NAK (0x10U) /*!< Bit mask for R-Block indicating NAK */
 | |
| 
 | |
| /*! Maximum length of control message (no INF) */
 | |
| #define ISODEP_CONTROLMSG_BUF_LEN \
 | |
|     (RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN + RFAL_ISODEP_NAD_LEN + ISODEP_SWTX_PARAM_LEN)
 | |
| 
 | |
| #define ISODEP_FWT_DEACTIVATION \
 | |
|     (71680U) /*!< FWT used for DESELECT  Digital 2.2 B10  ISO1444-4 7.2 & 8.1 */
 | |
| #define ISODEP_MAX_RERUNS (0x0FFFFFFFU) /*!< Maximum rerun retrys for a blocking protocol run*/
 | |
| 
 | |
| #define ISODEP_PCBSBLOCK \
 | |
|     (0x00U | ISODEP_PCB_SBLOCK | ISODEP_PCB_B2_BIT) /*!< PCB Value of a S-Block                 */
 | |
| #define ISODEP_PCB_SDSL \
 | |
|     (ISODEP_PCBSBLOCK | ISODEP_PCB_DESELECT) /*!< PCB Value of a S-Block with DESELECT   */
 | |
| #define ISODEP_PCB_SWTX \
 | |
|     (ISODEP_PCBSBLOCK | ISODEP_PCB_WTX) /*!< PCB Value of a S-Block with WTX        */
 | |
| #define ISODEP_PCB_SPARAMETERS \
 | |
|     (ISODEP_PCB_SBLOCK | ISODEP_PCB_WTX) /*!< PCB Value of a S-Block with PARAMETERS */
 | |
| 
 | |
| #define ISODEP_FWI_LIS_MAX_NFC \
 | |
|     8U /*!< FWT Listener Max FWIT4ATmax FWIBmax  Digital 1.1  A6 & A3  */
 | |
| #define ISODEP_FWI_LIS_MAX_EMVCO \
 | |
|     7U /*!< FWT Listener Max FWIMAX       EMVCo 2.6 A.5                */
 | |
| #define ISODEP_FWI_LIS_MAX                               \
 | |
|     (uint8_t)(                                           \
 | |
|         (gIsoDep.compMode == RFAL_COMPLIANCE_MODE_EMV) ? \
 | |
|             ISODEP_FWI_LIS_MAX_EMVCO :                   \
 | |
|             ISODEP_FWI_LIS_MAX_NFC) /*!< FWI Listener Max as NFC / EMVCo */
 | |
| #define ISODEP_FWT_LIS_MAX \
 | |
|     rfalIsoDepFWI2FWT(ISODEP_FWI_LIS_MAX) /*!< FWT Listener Max                       */
 | |
| 
 | |
| #define ISODEP_FWI_MIN_10 (1U) /*!< Minimum value for FWI Digital 1.0 11.6.2.17 */
 | |
| #define ISODEP_FWI_MIN_11 (0U) /*!< Default value for FWI Digital 1.1 13.6.2    */
 | |
| #define ISODEP_FWI_MAX (14U) /*!< Maximum value for FWI Digital 1.0 11.6.2.17 */
 | |
| #define ISODEP_SFGI_MIN (0U) /*!< Default value for FWI Digital 1.1 13.6.2.22 */
 | |
| #define ISODEP_SFGI_MAX (14U) /*!< Maximum value for FWI Digital 1.1 13.6.2.22 */
 | |
| 
 | |
| #define RFAL_ISODEP_SPARAM_TVL_HDR_LEN (2U) /*!< S(PARAMETERS) TVL header length: Tag + Len */
 | |
| #define RFAL_ISODEP_SPARAM_HDR_LEN \
 | |
|     (RFAL_ISODEP_PCB_LEN +         \
 | |
|      RFAL_ISODEP_SPARAM_TVL_HDR_LEN) /*!< S(PARAMETERS) header length: PCB + Tag + Len */
 | |
| 
 | |
| /**********************************************************************************************************************/
 | |
| /**********************************************************************************************************************/
 | |
| #define RFAL_ISODEP_NO_PARAM (0U) /*!< No parameter flag for isoDepHandleControlMsg()     */
 | |
| 
 | |
| #define RFAL_ISODEP_CMD_RATS (0xE0U) /*!< RATS command   Digital 1.1  13.6.1                 */
 | |
| 
 | |
| #define RFAL_ISODEP_ATS_MIN_LEN (1U) /*!< Minimum ATS length   Digital 1.1  13.6.2 */
 | |
| #define RFAL_ISODEP_ATS_HDR_LEN (5U) /*!< ATS headerlength     Digital 1.1  13.6.2 */
 | |
| #define RFAL_ISODEP_ATS_MAX_LEN \
 | |
|     (RFAL_ISODEP_ATS_HDR_LEN +  \
 | |
|      RFAL_ISODEP_ATS_HB_MAX_LEN) /*!< Maximum ATS length   Digital 1.1  13.6.2 */
 | |
| #define RFAL_ISODEP_ATS_T0_FSCI_MASK (0x0FU) /*!< ATS T0's FSCI mask   Digital 1.1  13.6.2 */
 | |
| #define RFAL_ISODEP_ATS_TB_FWI_SHIFT (4U) /*!< ATS TB's FWI shift   Digital 1.1  13.6.2 */
 | |
| #define RFAL_ISODEP_ATS_FWI_MASK (0x0FU) /*!< ATS TB's FWI shift   Digital 1.1  13.6.2 */
 | |
| #define RFAL_ISODEP_ATS_TL_POS (0x00U) /*!< ATS TL's position    Digital 1.1  13.6.2 */
 | |
| 
 | |
| #define RFAL_ISODEP_PPS_SB (0xD0U) /*!< PPS REQ PPSS's SB value (no CID)   ISO14443-4  5.3 */
 | |
| #define RFAL_ISODEP_PPS_MASK (0xF0U) /*!< PPS REQ PPSS's SB mask             ISO14443-4  5.3 */
 | |
| #define RFAL_ISODEP_PPS_SB_DID_MASK \
 | |
|     (0x0FU) /*!< PPS REQ PPSS's DID|CID mask        ISO14443-4  5.3 */
 | |
| #define RFAL_ISODEP_PPS_PPS0_PPS1_PRESENT \
 | |
|     (0x11U) /*!< PPS REQ PPS0 indicating that PPS1 is present       */
 | |
| #define RFAL_ISODEP_PPS_PPS1 (0x00U) /*!< PPS REQ PPS1 fixed value           ISO14443-4  5.3 */
 | |
| #define RFAL_ISODEP_PPS_PPS1_DSI_SHIFT \
 | |
|     (2U) /*!< PPS REQ PPS1 fixed value           ISO14443-4  5.3 */
 | |
| #define RFAL_ISODEP_PPS_PPS1_DXI_MASK \
 | |
|     (0x0FU) /*!< PPS REQ PPS1 fixed value           ISO14443-4  5.3 */
 | |
| #define RFAL_ISODEP_PPS_RES_LEN (1U) /*!< PPS Response length                ISO14443-4  5.4 */
 | |
| #define RFAL_ISODEP_PPS_STARTBYTE_POS \
 | |
|     (0U) /*!< PPS REQ PPSS's byte position       ISO14443-4  5.4 */
 | |
| #define RFAL_ISODEP_PPS_PPS0_POS (1U) /*!< PPS REQ PPS0's byte position       ISO14443-4  5.4 */
 | |
| #define RFAL_ISODEP_PPS_PPS1_POS (2U) /*!< PPS REQ PPS1's byte position       ISO14443-4  5.4 */
 | |
| #define RFAL_ISODEP_PPS0_VALID_MASK \
 | |
|     (0xEFU) /*!< PPS REQ PPS0 valid coding mask     ISO14443-4  5.4 */
 | |
| 
 | |
| #define RFAL_ISODEP_CMD_ATTRIB (0x1DU) /*!< ATTRIB command                 Digital 1.1  14.6.1 */
 | |
| #define RFAL_ISODEP_ATTRIB_PARAM2_DSI_SHIFT \
 | |
|     (6U) /*!< ATTRIB PARAM2 DSI shift        Digital 1.1  14.6.1 */
 | |
| #define RFAL_ISODEP_ATTRIB_PARAM2_DRI_SHIFT \
 | |
|     (4U) /*!< ATTRIB PARAM2 DRI shift        Digital 1.1  14.6.1 */
 | |
| #define RFAL_ISODEP_ATTRIB_PARAM2_DXI_MASK \
 | |
|     (0xF0U) /*!< ATTRIB PARAM2 DxI mask         Digital 1.1  14.6.1 */
 | |
| #define RFAL_ISODEP_ATTRIB_PARAM2_FSDI_MASK \
 | |
|     (0x0FU) /*!< ATTRIB PARAM2 FSDI mask        Digital 1.1  14.6.1 */
 | |
| #define RFAL_ISODEP_ATTRIB_PARAM4_DID_MASK \
 | |
|     (0x0FU) /*!< ATTRIB PARAM4 DID mask         Digital 1.1  14.6.1 */
 | |
| #define RFAL_ISODEP_ATTRIB_HDR_LEN (9U) /*!< ATTRIB REQ header length       Digital 1.1  14.6.1 */
 | |
| 
 | |
| #define RFAL_ISODEP_ATTRIB_RES_HDR_LEN \
 | |
|     (1U) /*!< ATTRIB RES header length       Digital 1.1  14.6.2 */
 | |
| #define RFAL_ISODEP_ATTRIB_RES_MBLIDID_POS \
 | |
|     (0U) /*!< ATTRIB RES MBLI|DID position   Digital 1.1  14.6.2 */
 | |
| #define RFAL_ISODEP_ATTRIB_RES_DID_MASK \
 | |
|     (0x0FU) /*!< ATTRIB RES DID mask            Digital 1.1  14.6.2 */
 | |
| #define RFAL_ISODEP_ATTRIB_RES_MBLI_MASK \
 | |
|     (0x0FU) /*!< ATTRIB RES MBLI mask           Digital 1.1  14.6.2 */
 | |
| #define RFAL_ISODEP_ATTRIB_RES_MBLI_SHIFT \
 | |
|     (4U) /*!< ATTRIB RES MBLI shift          Digital 1.1  14.6.2 */
 | |
| 
 | |
| #define RFAL_ISODEP_DID_MASK (0x0FU) /*!< ISODEP's DID mask                                  */
 | |
| #define RFAL_ISODEP_DID_00 (0U) /*!< ISODEP's DID value 0                               */
 | |
| 
 | |
| #define RFAL_ISODEP_FSDI_MAX_NFC (8U) /*!< Max FSDI value   Digital 2.0  14.6.1.9 & B7 & B8   */
 | |
| #define RFAL_ISODEP_FSDI_MAX_NFC_21 \
 | |
|     (0x0CU) /*!< Max FSDI value   Digital 2.1  14.6.1.9 & Table 72  */
 | |
| #define RFAL_ISODEP_FSDI_MAX_EMV (0x0CU) /*!< Max FSDI value   EMVCo 3.0  5.7.2.5                */
 | |
| 
 | |
| #define RFAL_ISODEP_RATS_PARAM_FSDI_MASK \
 | |
|     (0xF0U) /*!< Mask bits for FSDI in RATS                         */
 | |
| #define RFAL_ISODEP_RATS_PARAM_FSDI_SHIFT \
 | |
|     (4U) /*!< Shift for FSDI in RATS                             */
 | |
| #define RFAL_ISODEP_RATS_PARAM_DID_MASK \
 | |
|     (0x0FU) /*!< Mask bits for DID in RATS                          */
 | |
| 
 | |
| #define RFAL_ISODEP_ATS_TL_OFFSET \
 | |
|     (0x00U) /*!< Offset of TL on ATS                                */
 | |
| #define RFAL_ISODEP_ATS_TA_OFFSET \
 | |
|     (0x02U) /*!< Offset of TA if it is present on ATS               */
 | |
| #define RFAL_ISODEP_ATS_TB_OFFSET \
 | |
|     (0x03U) /*!< Offset of TB if both TA and TB is present on ATS   */
 | |
| #define RFAL_ISODEP_ATS_TC_OFFSET \
 | |
|     (0x04U) /*!< Offset of TC if both TA,TB & TC are present on ATS */
 | |
| #define RFAL_ISODEP_ATS_HIST_OFFSET \
 | |
|     (0x05U) /*!< Offset of Historical Bytes if TA, TB & TC are present on ATS          */
 | |
| #define RFAL_ISODEP_ATS_TC_ADV_FEAT \
 | |
|     (0x10U) /*!< Bit mask indicating support for Advanced protocol features: DID & NAD */
 | |
| #define RFAL_ISODEP_ATS_TC_DID (0x02U) /*!< Bit mask indicating support for DID                 */
 | |
| #define RFAL_ISODEP_ATS_TC_NAD (0x01U) /*!< Bit mask indicating support for NAD                 */
 | |
| 
 | |
| #define RFAL_ISODEP_PPS0_PPS1_PRESENT \
 | |
|     (0x11U) /*!< PPS0 byte indicating that PPS1 is present            */
 | |
| #define RFAL_ISODEP_PPS0_PPS1_NOT_PRESENT \
 | |
|     (0x01U) /*!< PPS0 byte indicating that PPS1 is NOT present        */
 | |
| #define RFAL_ISODEP_PPS1_DRI_MASK \
 | |
|     (0x03U) /*!< PPS1 byte DRI mask bits                              */
 | |
| #define RFAL_ISODEP_PPS1_DSI_MASK \
 | |
|     (0x0CU) /*!< PPS1 byte DSI mask bits                              */
 | |
| #define RFAL_ISODEP_PPS1_DSI_SHIFT \
 | |
|     (2U) /*!< PPS1 byte DSI shift                                  */
 | |
| #define RFAL_ISODEP_PPS1_DxI_MASK \
 | |
|     (0x03U) /*!< PPS1 byte DSI/DRS mask bits                          */
 | |
| 
 | |
| /*! Delta Time for polling during Activation (ATS) : 20ms    Digital 1.0 11.7.1.1 & A.7    */
 | |
| #define RFAL_ISODEP_T4T_DTIME_POLL_10 rfalConvMsTo1fc(20)
 | |
| 
 | |
| /*! Delta Time for polling during Activation (ATS) : 16.4ms  Digital 1.1 13.8.1.1 & A.6
 | |
|  *  Use 16 ms as testcase T4AT_BI_10_03 sends a frame exactly at the border */
 | |
| #define RFAL_ISODEP_T4T_DTIME_POLL_11 216960U
 | |
| 
 | |
| /*! Activation frame waiting time FWT(act) = 71680/fc (~5286us) Digital 1.1 13.8.1.1 & A.6 */
 | |
| #define RFAL_ISODEP_T4T_FWT_ACTIVATION (71680U + RFAL_ISODEP_T4T_DTIME_POLL_11)
 | |
| 
 | |
| /*! Delta frame waiting time = 16/fc  Digital 1.0  11.7.1.3 & A.7*/
 | |
| #define RFAL_ISODEP_DFWT_10 16U
 | |
| 
 | |
| /*! Delta frame waiting time = 16/fc  Digital 2.0  14.8.1.3 & B.7*/
 | |
| #define RFAL_ISODEP_DFWT_20 49152U
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * MACROS
 | |
|  ******************************************************************************
 | |
|  */
 | |
| 
 | |
| #define isoDep_PCBisIBlock(pcb)                                       \
 | |
|     (((pcb) & (ISODEP_PCB_xBLOCK_MASK | ISODEP_PCB_IB_VALID_MASK)) == \
 | |
|      (ISODEP_PCB_IBLOCK | ISODEP_PCB_IB_VALID_VAL)) /*!< Checks if pcb is a I-Block */
 | |
| #define isoDep_PCBisRBlock(pcb)                                       \
 | |
|     (((pcb) & (ISODEP_PCB_xBLOCK_MASK | ISODEP_PCB_RB_VALID_MASK)) == \
 | |
|      (ISODEP_PCB_RBLOCK | ISODEP_PCB_RB_VALID_VAL)) /*!< Checks if pcb is a R-Block */
 | |
| #define isoDep_PCBisSBlock(pcb)                                       \
 | |
|     (((pcb) & (ISODEP_PCB_xBLOCK_MASK | ISODEP_PCB_SB_VALID_MASK)) == \
 | |
|      (ISODEP_PCB_SBLOCK | ISODEP_PCB_SB_VALID_VAL)) /*!< Checks if pcb is a S-Block */
 | |
| 
 | |
| #define isoDep_PCBisChaining(pcb)       \
 | |
|     (((pcb)&ISODEP_PCB_CHAINING_BIT) == \
 | |
|      ISODEP_PCB_CHAINING_BIT) /*!< Checks if pcb is indicating chaining */
 | |
| 
 | |
| #define isoDep_PCBisDeselect(pcb)   \
 | |
|     (((pcb)&ISODEP_PCB_Sxx_MASK) == \
 | |
|      ISODEP_PCB_DESELECT) /*!< Checks if pcb is indicating DESELECT */
 | |
| #define isoDep_PCBisWTX(pcb) \
 | |
|     (((pcb)&ISODEP_PCB_Sxx_MASK) == ISODEP_PCB_WTX) /*!< Checks if pcb is indicating WTX      */
 | |
| 
 | |
| #define isoDep_PCBisACK(pcb) \
 | |
|     (((pcb)&ISODEP_PCB_Rx_MASK) == ISODEP_PCB_ACK) /*!< Checks if pcb is indicating ACK      */
 | |
| #define isoDep_PCBisNAK(pcb) \
 | |
|     (((pcb)&ISODEP_PCB_Rx_MASK) == ISODEP_PCB_NAK) /*!< Checks if pcb is indicating ACK      */
 | |
| 
 | |
| #define isoDep_PCBhasDID(pcb) \
 | |
|     (((pcb)&ISODEP_PCB_DID_BIT) == ISODEP_PCB_DID_BIT) /*!< Checks if pcb is indicating DID      */
 | |
| #define isoDep_PCBhasNAD(pcb) \
 | |
|     (((pcb)&ISODEP_PCB_NAD_BIT) == ISODEP_PCB_NAD_BIT) /*!< Checks if pcb is indicating NAD      */
 | |
| 
 | |
| #define isoDep_PCBisIChaining(pcb) \
 | |
|     (isoDep_PCBisIBlock(pcb) &&    \
 | |
|      isoDep_PCBisChaining(pcb)) /*!< Checks if pcb is I-Block indicating chaining*/
 | |
| 
 | |
| #define isoDep_PCBisSDeselect(pcb) \
 | |
|     (isoDep_PCBisSBlock(pcb) &&    \
 | |
|      isoDep_PCBisDeselect(pcb)) /*!< Checks if pcb is S-Block indicating DESELECT*/
 | |
| #define isoDep_PCBisSWTX(pcb)   \
 | |
|     (isoDep_PCBisSBlock(pcb) && \
 | |
|      isoDep_PCBisWTX(pcb)) /*!< Checks if pcb is S-Block indicating WTX     */
 | |
| 
 | |
| #define isoDep_PCBisRACK(pcb)   \
 | |
|     (isoDep_PCBisRBlock(pcb) && \
 | |
|      isoDep_PCBisACK(pcb)) /*!< Checks if pcb is R-Block indicating ACK     */
 | |
| #define isoDep_PCBisRNAK(pcb)   \
 | |
|     (isoDep_PCBisRBlock(pcb) && \
 | |
|      isoDep_PCBisNAK(pcb)) /*!< Checks if pcb is R-Block indicating NAK     */
 | |
| 
 | |
| #define isoDep_PCBIBlock(bn) \
 | |
|     ((uint8_t)(0x00U | ISODEP_PCB_IBLOCK | ISODEP_PCB_B2_BIT | ((bn)&ISODEP_PCB_BN_MASK))) /*!< Returns an I-Block with the given block number (bn)                     */
 | |
| #define isoDep_PCBIBlockChaining(bn) \
 | |
|     ((uint8_t)(isoDep_PCBIBlock(bn) | ISODEP_PCB_CHAINING_BIT)) /*!< Returns an I-Block with the given block number (bn) indicating chaining */
 | |
| 
 | |
| #define isoDep_PCBRBlock(bn) \
 | |
|     ((uint8_t)(0x00U | ISODEP_PCB_RBLOCK | ISODEP_PCB_B6_BIT | ISODEP_PCB_B2_BIT | ((bn)&ISODEP_PCB_BN_MASK))) /*!< Returns an R-Block with the given block number (bn)                */
 | |
| #define isoDep_PCBRACK(bn) \
 | |
|     ((uint8_t)(isoDep_PCBRBlock(bn) | ISODEP_PCB_ACK)) /*!< Returns an R-Block with the given block number (bn) indicating ACK */
 | |
| #define isoDep_PCBRNAK(bn) \
 | |
|     ((uint8_t)(isoDep_PCBRBlock(bn) | ISODEP_PCB_NAK)) /*!< Returns an R-Block with the given block number (bn) indicating NAK */
 | |
| 
 | |
| #define isoDep_GetBN(pcb) \
 | |
|     ((uint8_t)((pcb)&ISODEP_PCB_BN_MASK)) /*!< Returns the block number (bn) from the given pcb */
 | |
| #define isoDep_GetWTXM(inf) \
 | |
|     ((uint8_t)((            \
 | |
|         inf)&ISODEP_SWTX_WTXM_MASK)) /*!< Returns the WTX value from the given inf byte    */
 | |
| #define isoDep_isWTXMValid(wtxm)    \
 | |
|     (((wtxm) >= ISODEP_WTXM_MIN) && \
 | |
|      ((wtxm) <= ISODEP_WTXM_MAX)) /*!< Checks if the given wtxm is valid                */
 | |
| 
 | |
| #define isoDep_WTXMListenerMax(fwt)            \
 | |
|     (MIN(                                      \
 | |
|         (uint8_t)(ISODEP_FWT_LIS_MAX / (fwt)), \
 | |
|         ISODEP_WTXM_MAX)) /*!< Calculates the Max WTXM value for the given fwt as a Listener    */
 | |
| 
 | |
| #define isoDepCalcdSGFT(s) \
 | |
|     (384U * ((uint32_t)1U  \
 | |
|              << (s))) /*!< Calculates the dSFGT with given SFGI  Digital 1.1  13.8.2.1 & A.6*/
 | |
| #define isoDepCalcSGFT(s)  \
 | |
|     (4096U * ((uint32_t)1U \
 | |
|               << (s))) /*!< Calculates the SFGT with given SFGI  Digital 1.1  13.8.2         */
 | |
| 
 | |
| #define isoDep_PCBNextBN(bn)   \
 | |
|     (((uint8_t)(bn) ^ 0x01U) & \
 | |
|      ISODEP_PCB_BN_MASK) /*!< Returns the value of the next block number based on bn     */
 | |
| #define isoDep_PCBPrevBN(bn) \
 | |
|     isoDep_PCBNextBN(bn) /*!< Returns the value of the previous block number based on bn */
 | |
| #define isoDep_ToggleBN(bn) \
 | |
|     ((bn) =                 \
 | |
|          (((bn) ^ 0x01U) &  \
 | |
|           ISODEP_PCB_BN_MASK)) /*!< Toggles the block number value of the given bn             */
 | |
| 
 | |
| #define isoDep_WTXAdjust(v) \
 | |
|     ((v) - ((v) >> 3)) /*!< Adjust WTX timer value to a percentage of the total, current 88% */
 | |
| 
 | |
| /*! ISO 14443-4 7.5.6.2 & Digital 1.1 - 15.2.6.2  The CE SHALL NOT attempt error recovery and remains in Rx mode upon Transmission or a Protocol Error */
 | |
| #define isoDepReEnableRx(rxB, rxBL, rxL) \
 | |
|     rfalTransceiveBlockingTx(NULL, 0, rxB, rxBL, rxL, RFAL_TXRX_FLAGS_DEFAULT, RFAL_FWT_NONE)
 | |
| 
 | |
| /*! Macro used for the blocking methods */
 | |
| #define rfalIsoDepRunBlocking(e, fn) \
 | |
|     do {                             \
 | |
|         (e) = (fn);                  \
 | |
|         rfalWorker();                \
 | |
|     } while((e) == ERR_BUSY)
 | |
| 
 | |
| #define isoDepTimerStart(timer, time_ms)                    \
 | |
|     do {                                                    \
 | |
|         platformTimerDestroy(timer);                        \
 | |
|         (timer) = platformTimerCreate((uint16_t)(time_ms)); \
 | |
|     } while(0) /*!< Configures and starts the WTX timer  */
 | |
| #define isoDepTimerisExpired(timer) \
 | |
|     platformTimerIsExpired(timer) /*!< Checks WTX timer has expired                     */
 | |
| #define isoDepTimerDestroy(timer) \
 | |
|     platformTimerDestroy(timer) /*!< Destroys WTX timer                               */
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * LOCAL DATA TYPES
 | |
|  ******************************************************************************
 | |
|  */
 | |
| 
 | |
| /*! Internal structure to be used in handling of S(PARAMETRS) only */
 | |
| typedef struct {
 | |
|     uint8_t pcb; /*!< PCB byte                      */
 | |
|     rfalIsoDepSParameter sParam; /*!< S(PARAMETERS)                 */
 | |
| } rfalIsoDepControlMsgSParam;
 | |
| 
 | |
| /*! Enumeration of the possible control message types */
 | |
| typedef enum {
 | |
|     ISODEP_R_ACK, /*!< R-ACK  Acknowledge            */
 | |
|     ISODEP_R_NAK, /*!< R-NACK Negative acknowledge   */
 | |
|     ISODEP_S_WTX, /*!< S-WTX  Waiting Time Extension */
 | |
|     ISODEP_S_DSL /*!< S-DSL  Deselect               */
 | |
| } rfalIsoDepControlMsg;
 | |
| 
 | |
| /*! Enumeration of the IsoDep roles */
 | |
| typedef enum {
 | |
|     ISODEP_ROLE_PCD, /*!< Perform as Reader/PCD          */
 | |
|     ISODEP_ROLE_PICC /*!< Perform as Card/PICC           */
 | |
| } rfalIsoDepRole;
 | |
| 
 | |
| /*! ISO-DEP layer states */
 | |
| typedef enum {
 | |
|     ISODEP_ST_IDLE, /*!< Idle State                     */
 | |
|     ISODEP_ST_PCD_TX, /*!< PCD Transmission State         */
 | |
|     ISODEP_ST_PCD_RX, /*!< PCD Reception State            */
 | |
|     ISODEP_ST_PCD_WAIT_DSL, /*!< PCD Wait for DSL response      */
 | |
| 
 | |
|     ISODEP_ST_PICC_ACT_ATS, /*!< PICC has replied to RATS (ATS) */
 | |
|     ISODEP_ST_PICC_ACT_ATTRIB, /*!< PICC has replied to ATTRIB     */
 | |
|     ISODEP_ST_PICC_RX, /*!< PICC Reception State           */
 | |
|     ISODEP_ST_PICC_SWTX, /*!< PICC Waiting Time eXtension    */
 | |
|     ISODEP_ST_PICC_SDSL, /*!< PICC S(DSL) response ongoing   */
 | |
|     ISODEP_ST_PICC_TX, /*!< PICC Transmission State        */
 | |
| 
 | |
|     ISODEP_ST_PCD_ACT_RATS, /*!< PCD activation (RATS)          */
 | |
|     ISODEP_ST_PCD_ACT_PPS, /*!< PCD activation (PPS)           */
 | |
| 
 | |
| } rfalIsoDepState;
 | |
| 
 | |
| /*! Holds all ISO-DEP data(counters, buffers, ID, timeouts, frame size)         */
 | |
| typedef struct {
 | |
|     rfalIsoDepState state; /*!< ISO-DEP module state                      */
 | |
|     rfalIsoDepRole role; /*!< Current ISO-DEP role                      */
 | |
| 
 | |
|     uint8_t blockNumber; /*!< Current block number                      */
 | |
|     uint8_t did; /*!< Current DID                               */
 | |
|     uint8_t nad; /*!< Current DID                               */
 | |
|     uint8_t cntIRetrys; /*!< I-Block retry counter                     */
 | |
|     uint8_t cntRRetrys; /*!< R-Block retry counter                     */
 | |
|     uint8_t cntSDslRetrys; /*!< S(DESELECT) retry counter                 */
 | |
|     uint8_t cntSWtxRetrys; /*!< Overall S(WTX) retry counter              */
 | |
|     uint8_t cntSWtxNack; /*!< R(NACK) answered with S(WTX) counter      */
 | |
|     uint32_t fwt; /*!< Current FWT (Frame Waiting Time)          */
 | |
|     uint32_t dFwt; /*!< Current delta FWT                         */
 | |
|     uint16_t fsx; /*!< Current FSx FSC or FSD (max Frame size)   */
 | |
|     bool isTxChaining; /*!< Flag for chaining on Tx                   */
 | |
|     bool isRxChaining; /*!< Flag for chaining on Rx                   */
 | |
|     uint8_t* txBuf; /*!< Tx buffer pointer                         */
 | |
|     uint8_t* rxBuf; /*!< Rx buffer pointer                         */
 | |
|     uint16_t txBufLen; /*!< Tx buffer length                          */
 | |
|     uint16_t rxBufLen; /*!< Rx buffer length                          */
 | |
|     uint8_t txBufInfPos; /*!< Start of payload in txBuf                 */
 | |
|     uint8_t rxBufInfPos; /*!< Start of payload in rxBuf                 */
 | |
| 
 | |
|     uint16_t ourFsx; /*!< Our current FSx FSC or FSD (Frame size)   */
 | |
|     uint8_t lastPCB; /*!< Last PCB sent                             */
 | |
|     uint8_t lastWTXM; /*!< Last WTXM sent                            */
 | |
|     uint8_t atsTA; /*!< TA on ATS                                 */
 | |
|     uint8_t hdrLen; /*!< Current ISO-DEP length                    */
 | |
|     rfalBitRate txBR; /*!< Current Tx Bit Rate                       */
 | |
|     rfalBitRate rxBR; /*!< Current Rx Bit Rate                       */
 | |
|     uint16_t* rxLen; /*!< Output parameter ptr to Rx length         */
 | |
|     bool* rxChaining; /*!< Output parameter ptr to Rx chaining flag  */
 | |
|     uint32_t WTXTimer; /*!< Timer used for WTX                        */
 | |
|     bool lastDID00; /*!< Last PCD block had DID flag (for DID = 0) */
 | |
| 
 | |
|     bool isTxPending; /*!< Flag pending Block while waiting WTX Ack  */
 | |
|     bool isWait4WTX; /*!< Flag for waiting WTX Ack                  */
 | |
| 
 | |
|     uint8_t maxRetriesI; /*!< Number of retries for a I-Block           */
 | |
|     uint8_t maxRetriesR; /*!< Number of retries for a R-Block           */
 | |
|     uint8_t maxRetriesSDSL; /*!< Number of retries for S(DESELECT) errors  */
 | |
|     uint8_t maxRetriesSWTX; /*!< Number of retries for S(WTX) errors       */
 | |
|     uint8_t maxRetriesSnWTX; /*!< Number of retries S(WTX) replied w NACK  */
 | |
|     uint8_t maxRetriesRATS; /*!< Number of retries for RATS                */
 | |
| 
 | |
|     rfalComplianceMode compMode; /*!< Compliance mode                           */
 | |
| 
 | |
|     uint8_t ctrlBuf[ISODEP_CONTROLMSG_BUF_LEN]; /*!< Control msg buf   */
 | |
|     uint16_t ctrlRxLen; /*!< Control msg rcvd len                         */
 | |
| 
 | |
|     union { /*  PRQA S 0750 # MISRA 19.2 - Members of the union will not be used concurrently, only one frame at a time */
 | |
| #if RFAL_FEATURE_NFCA
 | |
|         rfalIsoDepRats ratsReq;
 | |
|         rfalIsoDepPpsReq ppsReq;
 | |
| #endif /* RFAL_FEATURE_NFCA */
 | |
| 
 | |
| #if RFAL_FEATURE_NFCB
 | |
|         rfalIsoDepAttribCmd attribReq;
 | |
| #endif /* RFAL_FEATURE_NFCB */
 | |
|     } actv; /*!< Activation buffer              */
 | |
| 
 | |
|     uint8_t* rxLen8; /*!< Receive length (8-bit)         */
 | |
|     rfalIsoDepDevice* actvDev; /*!< Activation Device Info         */
 | |
|     rfalIsoDepListenActvParam actvParam; /*!< Listen Activation context      */
 | |
| 
 | |
|     rfalIsoDepApduTxRxParam APDUParam; /*!< APDU TxRx params               */
 | |
|     uint16_t APDUTxPos; /*!< APDU Tx position               */
 | |
|     uint16_t APDURxPos; /*!< APDU Rx position               */
 | |
|     bool isAPDURxChaining; /*!< APDU Transceive chaining flag  */
 | |
| 
 | |
| } rfalIsoDep;
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * LOCAL VARIABLES
 | |
|  ******************************************************************************
 | |
|  */
 | |
| 
 | |
| static rfalIsoDep gIsoDep; /*!< ISO-DEP Module instance               */
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * LOCAL FUNCTION PROTOTYPES
 | |
|  ******************************************************************************
 | |
|  */
 | |
| static void isoDepClearCounters(void);
 | |
| static ReturnCode
 | |
|     isoDepTx(uint8_t pcb, const uint8_t* txBuf, uint8_t* infBuf, uint16_t infLen, uint32_t fwt);
 | |
| static ReturnCode isoDepHandleControlMsg(rfalIsoDepControlMsg controlMsg, uint8_t param);
 | |
| static void rfalIsoDepApdu2IBLockParam(
 | |
|     rfalIsoDepApduTxRxParam apduParam,
 | |
|     rfalIsoDepTxRxParam* iBlockParam,
 | |
|     uint16_t txPos,
 | |
|     uint16_t rxPos);
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP_POLL
 | |
| static ReturnCode isoDepDataExchangePCD(uint16_t* outActRxLen, bool* outIsChaining);
 | |
| static void rfalIsoDepCalcBitRate(
 | |
|     rfalBitRate maxAllowedBR,
 | |
|     uint8_t piccBRCapability,
 | |
|     rfalBitRate* dsi,
 | |
|     rfalBitRate* dri);
 | |
| static uint32_t rfalIsoDepSFGI2SFGT(uint8_t sfgi);
 | |
| 
 | |
| #if RFAL_FEATURE_NFCA
 | |
| static ReturnCode
 | |
|     rfalIsoDepStartRATS(rfalIsoDepFSxI FSDI, uint8_t DID, rfalIsoDepAts* ats, uint8_t* atsLen);
 | |
| static ReturnCode rfalIsoDepGetRATSStatus(void);
 | |
| static ReturnCode
 | |
|     rfalIsoDepStartPPS(uint8_t DID, rfalBitRate DSI, rfalBitRate DRI, rfalIsoDepPpsRes* ppsRes);
 | |
| static ReturnCode rfalIsoDepGetPPSSTatus(void);
 | |
| #endif /* RFAL_FEATURE_NFCA */
 | |
| 
 | |
| #if RFAL_FEATURE_NFCB
 | |
| static ReturnCode rfalIsoDepStartATTRIB(
 | |
|     const uint8_t* nfcid0,
 | |
|     uint8_t PARAM1,
 | |
|     rfalBitRate DSI,
 | |
|     rfalBitRate DRI,
 | |
|     rfalIsoDepFSxI FSDI,
 | |
|     uint8_t PARAM3,
 | |
|     uint8_t DID,
 | |
|     const uint8_t* HLInfo,
 | |
|     uint8_t HLInfoLen,
 | |
|     uint32_t fwt,
 | |
|     rfalIsoDepAttribRes* attribRes,
 | |
|     uint8_t* attribResLen);
 | |
| static ReturnCode rfalIsoDepGetATTRIBStatus(void);
 | |
| #endif /* RFAL_FEATURE_NFCB */
 | |
| 
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_POLL */
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP_LISTEN
 | |
| static ReturnCode isoDepDataExchangePICC(void);
 | |
| static ReturnCode isoDepReSendControlMsg(void);
 | |
| #endif
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * LOCAL FUNCTIONS
 | |
|  ******************************************************************************
 | |
|  */
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static void isoDepClearCounters(void) {
 | |
|     gIsoDep.cntIRetrys = 0;
 | |
|     gIsoDep.cntRRetrys = 0;
 | |
|     gIsoDep.cntSDslRetrys = 0;
 | |
|     gIsoDep.cntSWtxRetrys = 0;
 | |
|     gIsoDep.cntSWtxNack = 0;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode
 | |
|     isoDepTx(uint8_t pcb, const uint8_t* txBuf, uint8_t* infBuf, uint16_t infLen, uint32_t fwt) {
 | |
|     uint8_t* txBlock;
 | |
|     uint16_t txBufLen;
 | |
|     uint8_t computedPcb;
 | |
|     rfalTransceiveContext ctx;
 | |
| 
 | |
|     txBlock = infBuf; /* Point to beginning of the INF, and go backwards     */
 | |
|     gIsoDep.lastPCB = pcb; /* Store the last PCB sent                             */
 | |
| 
 | |
|     if(infLen > 0U) {
 | |
|         if(((uint32_t)infBuf - (uint32_t)txBuf) <
 | |
|            gIsoDep.hdrLen) /* Check that we can fit the header in the given space */
 | |
|         {
 | |
|             return ERR_NOMEM;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Compute optional PCB bits */
 | |
|     computedPcb = pcb;
 | |
|     if((gIsoDep.did != RFAL_ISODEP_NO_DID) ||
 | |
|        ((gIsoDep.did == RFAL_ISODEP_DID_00) && gIsoDep.lastDID00)) {
 | |
|         computedPcb |= ISODEP_PCB_DID_BIT;
 | |
|     }
 | |
|     if(gIsoDep.nad != RFAL_ISODEP_NO_NAD) {
 | |
|         computedPcb |= ISODEP_PCB_NAD_BIT;
 | |
|     }
 | |
|     if((gIsoDep.isTxChaining) && (isoDep_PCBisIBlock(computedPcb))) {
 | |
|         computedPcb |= ISODEP_PCB_CHAINING_BIT;
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Compute Payload on the given txBuf, start by the PCB | DID | NAD | before INF */
 | |
| 
 | |
|     if(gIsoDep.nad != RFAL_ISODEP_NO_NAD) {
 | |
|         *(--txBlock) = gIsoDep.nad; /* NAD is optional */
 | |
|     }
 | |
| 
 | |
|     if((gIsoDep.did != RFAL_ISODEP_NO_DID) ||
 | |
|        ((gIsoDep.did == RFAL_ISODEP_DID_00) && gIsoDep.lastDID00)) {
 | |
|         *(--txBlock) = gIsoDep.did; /* DID is optional */
 | |
|     }
 | |
| 
 | |
|     *(--txBlock) = computedPcb; /* PCB always present */
 | |
| 
 | |
|     txBufLen =
 | |
|         (infLen +
 | |
|          (uint16_t)((uint32_t)infBuf - (uint32_t)txBlock)); /* Calculate overall buffer size */
 | |
| 
 | |
|     if(txBufLen > (gIsoDep.fsx -
 | |
|                    ISODEP_CRC_LEN)) /* Check if msg length violates the maximum frame size FSC */
 | |
|     {
 | |
|         return ERR_NOTSUPP;
 | |
|     }
 | |
| 
 | |
|     rfalCreateByteFlagsTxRxContext(
 | |
|         ctx,
 | |
|         txBlock,
 | |
|         txBufLen,
 | |
|         gIsoDep.rxBuf,
 | |
|         gIsoDep.rxBufLen,
 | |
|         gIsoDep.rxLen,
 | |
|         RFAL_TXRX_FLAGS_DEFAULT,
 | |
|         ((gIsoDep.role == ISODEP_ROLE_PICC) ? RFAL_FWT_NONE : fwt));
 | |
|     return rfalStartTransceive(&ctx);
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode isoDepHandleControlMsg(rfalIsoDepControlMsg controlMsg, uint8_t param) {
 | |
|     uint8_t pcb;
 | |
|     uint8_t infLen;
 | |
|     uint32_t fwtTemp;
 | |
| 
 | |
|     infLen = 0;
 | |
|     fwtTemp = (gIsoDep.fwt + gIsoDep.dFwt);
 | |
|     ST_MEMSET(gIsoDep.ctrlBuf, 0x00, ISODEP_CONTROLMSG_BUF_LEN);
 | |
| 
 | |
|     switch(controlMsg) {
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_R_ACK:
 | |
| 
 | |
|         if(gIsoDep.cntRRetrys++ > gIsoDep.maxRetriesR) {
 | |
|             return ERR_TIMEOUT; /* NFC Forum mandates timeout or transmission error depending on previous errors */
 | |
|         }
 | |
| 
 | |
|         pcb = isoDep_PCBRACK(gIsoDep.blockNumber);
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_R_NAK:
 | |
| 
 | |
|         if((gIsoDep.cntRRetrys++ > gIsoDep.maxRetriesR) || /* Max R Block retries reached */
 | |
|            (gIsoDep.cntSWtxNack >=
 | |
|             gIsoDep
 | |
|                 .maxRetriesSnWTX)) /* Max number PICC is allowed to respond with S(WTX) to R(NAK) */
 | |
|         {
 | |
|             return ERR_TIMEOUT;
 | |
|         }
 | |
| 
 | |
|         pcb = isoDep_PCBRNAK(gIsoDep.blockNumber);
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_S_WTX:
 | |
| 
 | |
|         if((gIsoDep.cntSWtxRetrys++ > gIsoDep.maxRetriesSWTX) &&
 | |
|            (gIsoDep.maxRetriesSWTX != RFAL_ISODEP_MAX_WTX_RETRYS_ULTD)) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         /* Check if WTXM is valid */
 | |
|         if(!isoDep_isWTXMValid(param)) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         if(gIsoDep.role == ISODEP_ROLE_PCD) {
 | |
|             /* Calculate temp Wait Time eXtension */
 | |
|             fwtTemp = (gIsoDep.fwt * param);
 | |
|             fwtTemp = MIN(RFAL_ISODEP_MAX_FWT, fwtTemp);
 | |
|             fwtTemp += gIsoDep.dFwt;
 | |
|         }
 | |
| 
 | |
|         pcb = ISODEP_PCB_SWTX;
 | |
|         gIsoDep.ctrlBuf[RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN + infLen++] = param;
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_S_DSL:
 | |
| 
 | |
|         if(gIsoDep.cntSDslRetrys++ > gIsoDep.maxRetriesSDSL) {
 | |
|             return ERR_TIMEOUT; /* NFC Forum mandates timeout or transmission error depending on previous errors */
 | |
|         }
 | |
| 
 | |
|         if(gIsoDep.role == ISODEP_ROLE_PCD) {
 | |
|             /* Digital 1.0 - 13.2.7.3 Poller must wait fwtDEACTIVATION */
 | |
|             fwtTemp = ISODEP_FWT_DEACTIVATION;
 | |
|             gIsoDep.state = ISODEP_ST_PCD_WAIT_DSL;
 | |
|         }
 | |
|         pcb = ISODEP_PCB_SDSL;
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     default:
 | |
|         return ERR_INTERNAL;
 | |
|     }
 | |
| 
 | |
|     return isoDepTx(
 | |
|         pcb,
 | |
|         gIsoDep.ctrlBuf,
 | |
|         &gIsoDep.ctrlBuf[RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN],
 | |
|         infLen,
 | |
|         fwtTemp);
 | |
| }
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP_LISTEN
 | |
| /*******************************************************************************/
 | |
| static ReturnCode isoDepReSendControlMsg(void) {
 | |
|     if(isoDep_PCBisRACK(gIsoDep.lastPCB)) {
 | |
|         return isoDepHandleControlMsg(ISODEP_R_ACK, RFAL_ISODEP_NO_PARAM);
 | |
|     }
 | |
| 
 | |
|     if(isoDep_PCBisRNAK(gIsoDep.lastPCB)) {
 | |
|         return isoDepHandleControlMsg(ISODEP_R_NAK, RFAL_ISODEP_NO_PARAM);
 | |
|     }
 | |
| 
 | |
|     if(isoDep_PCBisSDeselect(gIsoDep.lastPCB)) {
 | |
|         return isoDepHandleControlMsg(ISODEP_S_DSL, RFAL_ISODEP_NO_PARAM);
 | |
|     }
 | |
| 
 | |
|     if(isoDep_PCBisSWTX(gIsoDep.lastPCB)) {
 | |
|         return isoDepHandleControlMsg(ISODEP_S_WTX, gIsoDep.lastWTXM);
 | |
|     }
 | |
|     return ERR_WRONG_STATE;
 | |
| }
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_LISTEN */
 | |
| 
 | |
| /*
 | |
|  ******************************************************************************
 | |
|  * GLOBAL FUNCTIONS
 | |
|  ******************************************************************************
 | |
|  */
 | |
| 
 | |
| /*******************************************************************************/
 | |
| void rfalIsoDepInitialize(void) {
 | |
|     gIsoDep.state = ISODEP_ST_IDLE;
 | |
|     gIsoDep.role = ISODEP_ROLE_PCD;
 | |
|     gIsoDep.did = RFAL_ISODEP_NO_DID;
 | |
|     gIsoDep.nad = RFAL_ISODEP_NO_NAD;
 | |
|     gIsoDep.blockNumber = 0;
 | |
|     gIsoDep.isTxChaining = false;
 | |
|     gIsoDep.isRxChaining = false;
 | |
|     gIsoDep.lastDID00 = false;
 | |
|     gIsoDep.lastPCB = ISODEP_PCB_INVALID;
 | |
|     gIsoDep.fsx = (uint16_t)RFAL_ISODEP_FSX_16;
 | |
|     gIsoDep.ourFsx = (uint16_t)RFAL_ISODEP_FSX_16;
 | |
|     gIsoDep.hdrLen = RFAL_ISODEP_PCB_LEN;
 | |
| 
 | |
|     gIsoDep.rxLen = NULL;
 | |
|     gIsoDep.rxBuf = NULL;
 | |
|     gIsoDep.rxBufInfPos = 0U;
 | |
|     gIsoDep.txBufInfPos = 0U;
 | |
| 
 | |
|     gIsoDep.isTxPending = false;
 | |
|     gIsoDep.isWait4WTX = false;
 | |
| 
 | |
|     gIsoDep.compMode = RFAL_COMPLIANCE_MODE_NFC;
 | |
|     gIsoDep.maxRetriesR = RFAL_ISODEP_MAX_R_RETRYS;
 | |
|     gIsoDep.maxRetriesI = RFAL_ISODEP_MAX_I_RETRYS;
 | |
|     gIsoDep.maxRetriesSDSL = RFAL_ISODEP_MAX_DSL_RETRYS;
 | |
|     gIsoDep.maxRetriesSWTX = RFAL_ISODEP_MAX_WTX_RETRYS;
 | |
|     gIsoDep.maxRetriesSnWTX = RFAL_ISODEP_MAX_WTX_NACK_RETRYS;
 | |
|     gIsoDep.maxRetriesRATS = RFAL_ISODEP_RATS_RETRIES;
 | |
| 
 | |
|     gIsoDep.APDURxPos = 0;
 | |
|     gIsoDep.APDUTxPos = 0;
 | |
|     gIsoDep.APDUParam.rxLen = NULL;
 | |
|     gIsoDep.APDUParam.rxBuf = NULL;
 | |
|     gIsoDep.APDUParam.txBuf = NULL;
 | |
| 
 | |
|     isoDepClearCounters();
 | |
| 
 | |
|     /* Destroy any ongoing WTX timer */
 | |
|     isoDepTimerDestroy(gIsoDep.WTXTimer);
 | |
|     gIsoDep.WTXTimer = 0U;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| void rfalIsoDepInitializeWithParams(
 | |
|     rfalComplianceMode compMode,
 | |
|     uint8_t maxRetriesR,
 | |
|     uint8_t maxRetriesSnWTX,
 | |
|     uint8_t maxRetriesSWTX,
 | |
|     uint8_t maxRetriesSDSL,
 | |
|     uint8_t maxRetriesI,
 | |
|     uint8_t maxRetriesRATS) {
 | |
|     rfalIsoDepInitialize();
 | |
| 
 | |
|     gIsoDep.compMode = compMode;
 | |
|     gIsoDep.maxRetriesR = maxRetriesR;
 | |
|     gIsoDep.maxRetriesSnWTX = maxRetriesSnWTX;
 | |
|     gIsoDep.maxRetriesSWTX = maxRetriesSWTX;
 | |
|     gIsoDep.maxRetriesSDSL = maxRetriesSDSL;
 | |
|     gIsoDep.maxRetriesI = maxRetriesI;
 | |
|     gIsoDep.maxRetriesRATS = maxRetriesRATS;
 | |
| }
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP_POLL
 | |
| /*******************************************************************************/
 | |
| static ReturnCode isoDepDataExchangePCD(uint16_t* outActRxLen, bool* outIsChaining) {
 | |
|     ReturnCode ret;
 | |
|     uint8_t rxPCB;
 | |
| 
 | |
|     /* Check out parameters */
 | |
|     if((outActRxLen == NULL) || (outIsChaining == NULL)) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     *outIsChaining = false;
 | |
| 
 | |
|     /* Calculate header required and check if the buffers InfPositions are suitable */
 | |
|     gIsoDep.hdrLen = RFAL_ISODEP_PCB_LEN;
 | |
|     if(gIsoDep.did != RFAL_ISODEP_NO_DID) {
 | |
|         gIsoDep.hdrLen += RFAL_ISODEP_DID_LEN;
 | |
|     }
 | |
|     if(gIsoDep.nad != RFAL_ISODEP_NO_NAD) {
 | |
|         gIsoDep.hdrLen += RFAL_ISODEP_NAD_LEN;
 | |
|     }
 | |
| 
 | |
|     /* Check if there is enough space before the infPos to append ISO-DEP headers on rx and tx */
 | |
|     if((gIsoDep.rxBufInfPos < gIsoDep.hdrLen) || (gIsoDep.txBufInfPos < gIsoDep.hdrLen)) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     switch(gIsoDep.state) {
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_IDLE:
 | |
|         return ERR_NONE;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PCD_TX:
 | |
|         ret = isoDepTx(
 | |
|             isoDep_PCBIBlock(gIsoDep.blockNumber),
 | |
|             gIsoDep.txBuf,
 | |
|             &gIsoDep.txBuf[gIsoDep.txBufInfPos],
 | |
|             gIsoDep.txBufLen,
 | |
|             (gIsoDep.fwt + gIsoDep.dFwt));
 | |
|         switch(ret) {
 | |
|         case ERR_NONE:
 | |
|             gIsoDep.state = ISODEP_ST_PCD_RX;
 | |
|             break;
 | |
| 
 | |
|         default:
 | |
|             return ret;
 | |
|         }
 | |
|         /* fall through */
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PCD_WAIT_DSL: /*  PRQA S 2003 # MISRA 16.3 - Intentional fall through */
 | |
|     case ISODEP_ST_PCD_RX:
 | |
| 
 | |
|         ret = rfalGetTransceiveStatus();
 | |
|         switch(ret) {
 | |
|         /* Data rcvd with error or timeout -> Send R-NAK */
 | |
|         case ERR_TIMEOUT:
 | |
|         case ERR_CRC:
 | |
|         case ERR_PAR:
 | |
|         case ERR_FRAMING: /* added to handle test cases scenario TC_POL_NFCB_T4AT_BI_82_x_y & TC_POL_NFCB_T4BT_BI_82_x_y */
 | |
|         case ERR_INCOMPLETE_BYTE: /* added to handle test cases scenario TC_POL_NFCB_T4AT_BI_82_x_y & TC_POL_NFCB_T4BT_BI_82_x_y */
 | |
| 
 | |
|             if(gIsoDep
 | |
|                    .isRxChaining) { /* Rule 5 - In PICC chaining when a invalid/timeout occurs -> R-ACK */
 | |
|                 EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_R_ACK, RFAL_ISODEP_NO_PARAM));
 | |
|             } else if(
 | |
|                 gIsoDep.state ==
 | |
|                 ISODEP_ST_PCD_WAIT_DSL) { /* Rule 8 - If s-Deselect response fails MAY retransmit */
 | |
|                 EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_S_DSL, RFAL_ISODEP_NO_PARAM));
 | |
|             } else { /* Rule 4 - When a invalid block or timeout occurs -> R-NACK */
 | |
|                 EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_R_NAK, RFAL_ISODEP_NO_PARAM));
 | |
|             }
 | |
|             return ERR_BUSY;
 | |
| 
 | |
|         case ERR_NONE:
 | |
|             break;
 | |
| 
 | |
|         case ERR_BUSY:
 | |
|             return ERR_BUSY; /* Debug purposes */
 | |
| 
 | |
|         default:
 | |
|             return ret;
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* No error, process incoming msg                                              */
 | |
|         /*******************************************************************************/
 | |
| 
 | |
|         (*outActRxLen) = rfalConvBitsToBytes(*outActRxLen);
 | |
| 
 | |
|         /* Check rcvd msg length, cannot be less then the expected header */
 | |
|         if(((*outActRxLen) < gIsoDep.hdrLen) || ((*outActRxLen) >= gIsoDep.ourFsx)) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         /* Grab rcvd PCB */
 | |
|         rxPCB = gIsoDep.rxBuf[ISODEP_PCB_POS];
 | |
| 
 | |
|         /* EMVCo doesn't allow usage of for CID or NAD   EMVCo 2.6 TAble 10.2 */
 | |
|         if((gIsoDep.compMode == RFAL_COMPLIANCE_MODE_EMV) &&
 | |
|            (isoDep_PCBhasDID(rxPCB) || isoDep_PCBhasNAD(rxPCB))) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         /* If we are expecting DID, check if PCB signals its presence and if device ID match*/
 | |
|         if((gIsoDep.did != RFAL_ISODEP_NO_DID) &&
 | |
|            (!isoDep_PCBhasDID(rxPCB) || (gIsoDep.did != gIsoDep.rxBuf[ISODEP_DID_POS]))) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Process S-Block                                                             */
 | |
|         /*******************************************************************************/
 | |
|         if(isoDep_PCBisSBlock(rxPCB)) {
 | |
|             /* Check if is a Wait Time eXtension */
 | |
|             if(isoDep_PCBisSWTX(rxPCB)) {
 | |
|                 /* Check if PICC has requested S(WTX) as response to R(NAK)  EMVCo 3.0 10.3.5.5 / Digital 2.0  16.2.6.5 */
 | |
|                 if(isoDep_PCBisRNAK(gIsoDep.lastPCB)) {
 | |
|                     gIsoDep.cntSWtxNack++; /* Count S(WTX) upon R(NAK) */
 | |
|                     gIsoDep.cntRRetrys = 0; /* Reset R-Block counter has PICC has responded */
 | |
|                 } else {
 | |
|                     gIsoDep.cntSWtxNack = 0; /* Reset R(NACK)->S(WTX) counter */
 | |
|                 }
 | |
| 
 | |
|                 /* Rule 3 - respond to S-block: get 1st INF byte S(STW): Power + WTXM */
 | |
|                 EXIT_ON_ERR(
 | |
|                     ret,
 | |
|                     isoDepHandleControlMsg(
 | |
|                         ISODEP_S_WTX, isoDep_GetWTXM(gIsoDep.rxBuf[gIsoDep.hdrLen])));
 | |
|                 return ERR_BUSY;
 | |
|             }
 | |
| 
 | |
|             /* Check if is a deselect response */
 | |
|             if(isoDep_PCBisSDeselect(rxPCB)) {
 | |
|                 if(gIsoDep.state == ISODEP_ST_PCD_WAIT_DSL) {
 | |
|                     rfalIsoDepInitialize(); /* Session finished reInit vars */
 | |
|                     return ERR_NONE;
 | |
|                 }
 | |
| 
 | |
|                 /* Deselect response not expected  */
 | |
|                 /* fall through to PROTO error */
 | |
|             }
 | |
|             /* Unexpected S-Block */
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Process R-Block                                                             */
 | |
|         /*******************************************************************************/
 | |
|         else if(isoDep_PCBisRBlock(rxPCB)) {
 | |
|             if(isoDep_PCBisRACK(rxPCB)) /* Check if is a R-ACK */
 | |
|             {
 | |
|                 if(isoDep_GetBN(rxPCB) == gIsoDep.blockNumber) /* Expected block number  */
 | |
|                 {
 | |
|                     /* Rule B - ACK with expected bn -> Increment block number */
 | |
|                     gIsoDep.blockNumber = isoDep_PCBNextBN(gIsoDep.blockNumber);
 | |
| 
 | |
|                     /* R-ACK only allowed when PCD chaining */
 | |
|                     if(!gIsoDep.isTxChaining) {
 | |
|                         return ERR_PROTO;
 | |
|                     }
 | |
| 
 | |
|                     /* Rule 7 - Chaining transaction done, continue chaining */
 | |
|                     isoDepClearCounters();
 | |
|                     return ERR_NONE; /* This block has been transmitted */
 | |
|                 } else {
 | |
|                     /* Rule 6 - R-ACK with wrong block number retransmit                          */
 | |
|                     /* Digital 2.0  16.2.5.4 - Retransmit maximum two times                       */
 | |
|                     /* EMVCo 3.0 10.3.4.3 -  PCD may re-transmit the last I-Block or report error */
 | |
|                     if(gIsoDep.cntIRetrys++ < gIsoDep.maxRetriesI) {
 | |
|                         gIsoDep.cntRRetrys = 0; /* Clear R counter only */
 | |
|                         gIsoDep.state = ISODEP_ST_PCD_TX;
 | |
|                         return ERR_BUSY;
 | |
|                     }
 | |
|                     return ERR_TIMEOUT; /* NFC Forum mandates timeout or transmission error depending on previous errors */
 | |
|                 }
 | |
|             } else /* Unexcpected R-Block */
 | |
|             {
 | |
|                 return ERR_PROTO;
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Process I-Block                                                             */
 | |
|         /*******************************************************************************/
 | |
|         else if(isoDep_PCBisIBlock(rxPCB)) {
 | |
|             /*******************************************************************************/
 | |
|             /* is PICC performing chaining                                                 */
 | |
|             if(isoDep_PCBisChaining(rxPCB)) {
 | |
|                 gIsoDep.isRxChaining = true;
 | |
|                 *outIsChaining = true;
 | |
| 
 | |
|                 if(isoDep_GetBN(rxPCB) == gIsoDep.blockNumber) {
 | |
|                     /* Rule B - ACK with correct block number -> Increase Block number */
 | |
|                     isoDep_ToggleBN(gIsoDep.blockNumber);
 | |
| 
 | |
|                     isoDepClearCounters(); /* Clear counters in case R counter is already at max */
 | |
| 
 | |
|                     /* Rule 2 - Send ACK */
 | |
|                     EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_R_ACK, RFAL_ISODEP_NO_PARAM));
 | |
| 
 | |
|                     /* Received I-Block with chaining, send current data to DH */
 | |
| 
 | |
|                     /* remove ISO DEP header, check is necessary to move the INF data on the buffer */
 | |
|                     *outActRxLen -= gIsoDep.hdrLen;
 | |
|                     if((gIsoDep.hdrLen != gIsoDep.rxBufInfPos) && (*outActRxLen > 0U)) {
 | |
|                         ST_MEMMOVE(
 | |
|                             &gIsoDep.rxBuf[gIsoDep.rxBufInfPos],
 | |
|                             &gIsoDep.rxBuf[gIsoDep.hdrLen],
 | |
|                             *outActRxLen);
 | |
|                     }
 | |
| 
 | |
|                     isoDepClearCounters();
 | |
|                     return ERR_AGAIN; /* Send Again signalling to run again, but some chaining data has arrived */
 | |
|                 } else {
 | |
|                     /* Rule 5 - PICC chaining invalid I-Block -> R-ACK */
 | |
|                     EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_R_ACK, RFAL_ISODEP_NO_PARAM));
 | |
|                 }
 | |
|                 return ERR_BUSY;
 | |
|             }
 | |
| 
 | |
|             gIsoDep.isRxChaining = false; /* clear PICC chaining flag */
 | |
| 
 | |
|             if(isoDep_GetBN(rxPCB) == gIsoDep.blockNumber) {
 | |
|                 /* Rule B - I-Block with correct block number -> Increase Block number */
 | |
|                 isoDep_ToggleBN(gIsoDep.blockNumber);
 | |
| 
 | |
|                 /* I-Block transaction done successfully */
 | |
| 
 | |
|                 /* remove ISO DEP header, check is necessary to move the INF data on the buffer */
 | |
|                 *outActRxLen -= gIsoDep.hdrLen;
 | |
|                 if((gIsoDep.hdrLen != gIsoDep.rxBufInfPos) && (*outActRxLen > 0U)) {
 | |
|                     ST_MEMMOVE(
 | |
|                         &gIsoDep.rxBuf[gIsoDep.rxBufInfPos],
 | |
|                         &gIsoDep.rxBuf[gIsoDep.hdrLen],
 | |
|                         *outActRxLen);
 | |
|                 }
 | |
| 
 | |
|                 gIsoDep.state = ISODEP_ST_IDLE;
 | |
|                 isoDepClearCounters();
 | |
|                 return ERR_NONE;
 | |
|             } else {
 | |
|                 if((gIsoDep.compMode != RFAL_COMPLIANCE_MODE_ISO)) {
 | |
|                     /* Invalid Block (not chaining) -> Raise error   Digital 1.1  15.2.6.4   EMVCo 2.6  10.3.5.4 */
 | |
|                     return ERR_PROTO;
 | |
|                 }
 | |
| 
 | |
|                 /* Rule 4 - Invalid Block -> R-NAK */
 | |
|                 EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_R_NAK, RFAL_ISODEP_NO_PARAM));
 | |
|                 return ERR_BUSY;
 | |
|             }
 | |
|         } else /* not S/R/I - Block */
 | |
|         {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
|         /* fall through */
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     default: /*  PRQA S 2003 # MISRA 16.3 - Intentional fall through */
 | |
|         /* MISRA 16.4: no empty default (comment will suffice) */
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     return ERR_INTERNAL;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepDeselect(void) {
 | |
|     ReturnCode ret;
 | |
|     uint32_t cntRerun;
 | |
|     bool dummyB;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Using local static vars and static config to cope with a Deselect after     *
 | |
|      * RATS\ATTRIB without any I-Block exchanged                                   */
 | |
|     gIsoDep.rxLen = &gIsoDep.ctrlRxLen;
 | |
|     gIsoDep.rxBuf = gIsoDep.ctrlBuf;
 | |
|     gIsoDep.rxBufLen = ISODEP_CONTROLMSG_BUF_LEN - (RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN);
 | |
|     gIsoDep.rxBufInfPos = (RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN);
 | |
|     gIsoDep.txBufInfPos = (RFAL_ISODEP_PCB_LEN + RFAL_ISODEP_DID_LEN);
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* The Deselect process is being done blocking, Digital 1.0 - 13.2.7.1 MUST wait response and retry*/
 | |
|     /* Set the maximum reruns while we will wait for a response */
 | |
|     cntRerun = ISODEP_MAX_RERUNS;
 | |
| 
 | |
|     /* Send DSL request and run protocol until get a response, error or "timeout" */
 | |
|     EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_S_DSL, RFAL_ISODEP_NO_PARAM));
 | |
|     do {
 | |
|         ret = isoDepDataExchangePCD(gIsoDep.rxLen, &dummyB);
 | |
|         rfalWorker();
 | |
|     } while(((cntRerun--) != 0U) && (ret == ERR_BUSY));
 | |
| 
 | |
|     rfalIsoDepInitialize();
 | |
|     return ((cntRerun == 0U) ? ERR_TIMEOUT : ret);
 | |
| }
 | |
| 
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_POLL */
 | |
| 
 | |
| /*******************************************************************************/
 | |
| uint32_t rfalIsoDepFWI2FWT(uint8_t fwi) {
 | |
|     uint32_t result;
 | |
|     uint8_t tmpFWI;
 | |
| 
 | |
|     tmpFWI = fwi;
 | |
| 
 | |
|     /* RFU values -> take the default value  
 | |
|      * Digital 1.0  11.6.2.17  FWI[1,14]
 | |
|      * Digital 1.1  7.6.2.22   FWI[0,14]
 | |
|      * EMVCo 2.6    Table A.5  FWI[0,14] */
 | |
|     if(tmpFWI > ISODEP_FWI_MAX) {
 | |
|         tmpFWI = RFAL_ISODEP_FWI_DEFAULT;
 | |
|     }
 | |
| 
 | |
|     /* FWT = (256 x 16/fC) x 2^FWI => 2^(FWI+12)  Digital 1.1  13.8.1 & 7.9.1 */
 | |
| 
 | |
|     result = ((uint32_t)1U << (tmpFWI + 12U));
 | |
|     result = MIN(RFAL_ISODEP_MAX_FWT, result); /* Maximum Frame Waiting Time must be fulfilled */
 | |
| 
 | |
|     return result;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| uint16_t rfalIsoDepFSxI2FSx(uint8_t FSxI) {
 | |
|     uint16_t fsx;
 | |
|     uint8_t fsi;
 | |
| 
 | |
|     /* Enforce maximum FSxI/FSx allowed - NFC Forum and EMVCo differ */
 | |
|     fsi =
 | |
|         ((gIsoDep.compMode == RFAL_COMPLIANCE_MODE_EMV) ? MIN(FSxI, RFAL_ISODEP_FSDI_MAX_EMV) :
 | |
|                                                           MIN(FSxI, RFAL_ISODEP_FSDI_MAX_NFC));
 | |
| 
 | |
|     switch(fsi) {
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_16:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_16;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_24:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_24;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_32:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_32;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_40:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_40;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_48:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_48;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_64:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_64;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_96:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_96;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_128:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_128;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_256:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_256;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_512:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_512;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_1024:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_1024;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_2048:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_2048;
 | |
|         break;
 | |
|     case(uint8_t)RFAL_ISODEP_FSXI_4096:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_4096;
 | |
|         break;
 | |
|     default:
 | |
|         fsx = (uint16_t)RFAL_ISODEP_FSX_256;
 | |
|         break;
 | |
|     }
 | |
|     return fsx;
 | |
| }
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP_LISTEN
 | |
| 
 | |
| /*******************************************************************************/
 | |
| bool rfalIsoDepIsRats(const uint8_t* buf, uint8_t bufLen) {
 | |
|     if(buf != NULL) {
 | |
|         if((RFAL_ISODEP_CMD_RATS == (uint8_t)*buf) && (sizeof(rfalIsoDepRats) == bufLen)) {
 | |
|             return true;
 | |
|         }
 | |
|     }
 | |
|     return false;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| bool rfalIsoDepIsAttrib(const uint8_t* buf, uint8_t bufLen) {
 | |
|     if(buf != NULL) {
 | |
|         if((RFAL_ISODEP_CMD_ATTRIB == (uint8_t)*buf) &&
 | |
|            (RFAL_ISODEP_ATTRIB_REQ_MIN_LEN <= bufLen) &&
 | |
|            ((RFAL_ISODEP_ATTRIB_REQ_MIN_LEN + RFAL_ISODEP_ATTRIB_HLINFO_LEN) >= bufLen)) {
 | |
|             return true;
 | |
|         }
 | |
|     }
 | |
|     return false;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepListenStartActivation(
 | |
|     rfalIsoDepAtsParam* atsParam,
 | |
|     const rfalIsoDepAttribResParam* attribResParam,
 | |
|     const uint8_t* buf,
 | |
|     uint16_t bufLen,
 | |
|     rfalIsoDepListenActvParam actParam) {
 | |
|     uint8_t* txBuf;
 | |
|     uint8_t bufIt;
 | |
|     const uint8_t* buffer = buf;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     bufIt = 0;
 | |
|     txBuf =
 | |
|         (uint8_t*)actParam
 | |
|             .rxBuf; /* Use the rxBuf as TxBuf as well, the struct enforces a size enough MAX( NFCA_ATS_MAX_LEN, NFCB_ATTRIB_RES_MAX_LEN ) */
 | |
|     gIsoDep.txBR = RFAL_BR_106;
 | |
|     gIsoDep.rxBR = RFAL_BR_106;
 | |
| 
 | |
|     /* Check for a valid buffer pointer */
 | |
|     if(buffer == NULL) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     if(*buffer == RFAL_ISODEP_CMD_RATS) {
 | |
|         /* Check ATS parameters */
 | |
|         if(atsParam == NULL) {
 | |
|             return ERR_PARAM;
 | |
|         }
 | |
| 
 | |
|         /* If requested copy RATS to device info */
 | |
|         if(actParam.isoDepDev != NULL) {
 | |
|             ST_MEMCPY(
 | |
|                 (uint8_t*)&actParam.isoDepDev->activation.A.Poller.RATS,
 | |
|                 buffer,
 | |
|                 sizeof(rfalIsoDepRats)); /* Copy RATS' CMD + PARAM */
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Process RATS                                                                */
 | |
|         buffer++;
 | |
|         gIsoDep.fsx = rfalIsoDepFSxI2FSx(
 | |
|             (((*buffer) & RFAL_ISODEP_RATS_PARAM_FSDI_MASK) >> RFAL_ISODEP_RATS_PARAM_FSDI_SHIFT));
 | |
|         gIsoDep.did = (*buffer & RFAL_ISODEP_DID_MASK);
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Digital 1.1  13.6.1.8 - DID as to between 0 and 14 */
 | |
|         if(gIsoDep.did > RFAL_ISODEP_DID_MAX) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         /* Check if we are configured to support DID */
 | |
|         if((gIsoDep.did != RFAL_ISODEP_DID_00) && (!atsParam->didSupport)) {
 | |
|             return ERR_NOTSUPP;
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Check RFAL supported bit rates  */
 | |
|         if((!(RFAL_SUPPORT_BR_CE_A_212) &&
 | |
|             (((atsParam->ta & RFAL_ISODEP_ATS_TA_DPL_212) != 0U) ||
 | |
|              ((atsParam->ta & RFAL_ISODEP_ATS_TA_DLP_212) != 0U))) ||
 | |
|            (!(RFAL_SUPPORT_BR_CE_A_424) &&
 | |
|             (((atsParam->ta & RFAL_ISODEP_ATS_TA_DPL_424) != 0U) ||
 | |
|              ((atsParam->ta & RFAL_ISODEP_ATS_TA_DLP_424) != 0U))) ||
 | |
|            (!(RFAL_SUPPORT_BR_CE_A_848) &&
 | |
|             (((atsParam->ta & RFAL_ISODEP_ATS_TA_DPL_848) != 0U) ||
 | |
|              ((atsParam->ta & RFAL_ISODEP_ATS_TA_DLP_848) != 0U)))) {
 | |
|             return ERR_NOTSUPP;
 | |
|         }
 | |
| 
 | |
|         /* Enforce proper FWI configuration */
 | |
|         if(atsParam->fwi > ISODEP_FWI_LIS_MAX) {
 | |
|             atsParam->fwi = ISODEP_FWI_LIS_MAX;
 | |
|         }
 | |
| 
 | |
|         gIsoDep.atsTA = atsParam->ta;
 | |
|         gIsoDep.fwt = rfalIsoDepFWI2FWT(atsParam->fwi);
 | |
|         gIsoDep.ourFsx = rfalIsoDepFSxI2FSx(atsParam->fsci);
 | |
| 
 | |
|         /* Ensure proper/maximum Historical Bytes length  */
 | |
|         atsParam->hbLen = MIN(RFAL_ISODEP_ATS_HB_MAX_LEN, atsParam->hbLen);
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Compute ATS                                                                 */
 | |
| 
 | |
|         txBuf[bufIt++] = (RFAL_ISODEP_ATS_HIST_OFFSET + atsParam->hbLen); /* TL */
 | |
|         txBuf[bufIt++] =
 | |
|             ((RFAL_ISODEP_ATS_T0_TA_PRESENCE_MASK | RFAL_ISODEP_ATS_T0_TB_PRESENCE_MASK |
 | |
|               RFAL_ISODEP_ATS_T0_TC_PRESENCE_MASK) |
 | |
|              atsParam->fsci); /* T0 */
 | |
|         txBuf[bufIt++] = atsParam->ta; /* TA */
 | |
|         txBuf[bufIt++] =
 | |
|             ((atsParam->fwi << RFAL_ISODEP_RATS_PARAM_FSDI_SHIFT) |
 | |
|              (atsParam->sfgi & RFAL_ISODEP_RATS_PARAM_FSDI_MASK)); /* TB */
 | |
|         txBuf[bufIt++] = (uint8_t)((atsParam->didSupport) ? RFAL_ISODEP_ATS_TC_DID : 0U); /* TC */
 | |
| 
 | |
|         if(atsParam->hbLen > 0U) /* MISRA 21.18 */
 | |
|         {
 | |
|             ST_MEMCPY(&txBuf[bufIt], atsParam->hb, atsParam->hbLen); /* T1-Tk */
 | |
|             bufIt += atsParam->hbLen;
 | |
|         }
 | |
| 
 | |
|         gIsoDep.state = ISODEP_ST_PICC_ACT_ATS;
 | |
| 
 | |
|     }
 | |
|     /*******************************************************************************/
 | |
|     else if(*buffer == RFAL_ISODEP_CMD_ATTRIB) {
 | |
|         /* Check ATTRIB parameters */
 | |
|         if(attribResParam == NULL) {
 | |
|             return ERR_PARAM;
 | |
|         }
 | |
| 
 | |
|         /*  REMARK: ATTRIB handling */
 | |
|         NO_WARNING(attribResParam);
 | |
|         NO_WARNING(bufLen);
 | |
|         return ERR_NOT_IMPLEMENTED;
 | |
|     } else {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     gIsoDep.actvParam = actParam;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* If requested copy to ISO-DEP device info */
 | |
|     if(actParam.isoDepDev != NULL) {
 | |
|         actParam.isoDepDev->info.DID = gIsoDep.did;
 | |
|         actParam.isoDepDev->info.FSx = gIsoDep.fsx;
 | |
|         actParam.isoDepDev->info.FWT = gIsoDep.fwt;
 | |
|         actParam.isoDepDev->info.dFWT = 0;
 | |
|         actParam.isoDepDev->info.DSI = gIsoDep.txBR;
 | |
|         actParam.isoDepDev->info.DRI = gIsoDep.rxBR;
 | |
|     }
 | |
| 
 | |
|     return rfalTransceiveBlockingTx(
 | |
|         txBuf,
 | |
|         bufIt,
 | |
|         (uint8_t*)actParam.rxBuf,
 | |
|         sizeof(rfalIsoDepBufFormat),
 | |
|         actParam.rxLen,
 | |
|         RFAL_TXRX_FLAGS_DEFAULT,
 | |
|         RFAL_FWT_NONE);
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepListenGetActivationStatus(void) {
 | |
|     ReturnCode err;
 | |
|     uint8_t* txBuf;
 | |
|     uint8_t bufIt;
 | |
| 
 | |
|     rfalBitRate dsi;
 | |
|     rfalBitRate dri;
 | |
| 
 | |
|     /* Check if Activation is running */
 | |
|     if(gIsoDep.state < ISODEP_ST_PICC_ACT_ATS) {
 | |
|         return ERR_WRONG_STATE;
 | |
|     }
 | |
| 
 | |
|     /* Check if Activation has finished already */
 | |
|     if(gIsoDep.state >= ISODEP_ST_PICC_RX) {
 | |
|         return ERR_NONE;
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Check for incoming msg */
 | |
|     err = rfalGetTransceiveStatus();
 | |
|     switch(err) {
 | |
|     /*******************************************************************************/
 | |
|     case ERR_NONE:
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ERR_LINK_LOSS:
 | |
|     case ERR_BUSY:
 | |
|         return err;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ERR_CRC:
 | |
|     case ERR_PAR:
 | |
|     case ERR_FRAMING:
 | |
| 
 | |
|         /* ISO14443 4  5.6.2.2 2  If ATS has been replied upon a invalid block, PICC disables the PPS responses */
 | |
|         if(gIsoDep.state == ISODEP_ST_PICC_ACT_ATS) {
 | |
|             gIsoDep.state = ISODEP_ST_PICC_RX;
 | |
|             break;
 | |
|         }
 | |
|         /* fall through */
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     default: /*  PRQA S 2003 # MISRA 16.3 - Intentional fall through */
 | |
|         /* ReEnable the receiver and wait for another frame */
 | |
|         isoDepReEnableRx(
 | |
|             (uint8_t*)gIsoDep.actvParam.rxBuf,
 | |
|             sizeof(rfalIsoDepBufFormat),
 | |
|             gIsoDep.actvParam.rxLen);
 | |
| 
 | |
|         return ERR_BUSY;
 | |
|     }
 | |
| 
 | |
|     txBuf =
 | |
|         (uint8_t*)gIsoDep.actvParam
 | |
|             .rxBuf; /* Use the rxBuf as TxBuf as well, the struct enforces a size enough  MAX(NFCA_PPS_RES_LEN, ISODEP_DSL_MAX_LEN) */
 | |
|     dri = RFAL_BR_KEEP; /* The RFAL_BR_KEEP is used to check if PPS with BR change was requested */
 | |
|     dsi = RFAL_BR_KEEP; /* MISRA 9.1 */
 | |
|     bufIt = 0;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     gIsoDep.role = ISODEP_ROLE_PICC;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     if(gIsoDep.state == ISODEP_ST_PICC_ACT_ATS) {
 | |
|         /* Check for a PPS    ISO 14443-4  5.3 */
 | |
|         if((((uint8_t*)gIsoDep.actvParam.rxBuf)[RFAL_ISODEP_PPS_STARTBYTE_POS] &
 | |
|             RFAL_ISODEP_PPS_MASK) == RFAL_ISODEP_PPS_SB) {
 | |
|             /* ISO 14443-4  5.3.1  Check if the we are the addressed DID/CID */
 | |
|             /* ISO 14443-4  5.3.2  Check for a valid PPS0 */
 | |
|             if(((((uint8_t*)gIsoDep.actvParam.rxBuf)[RFAL_ISODEP_PPS_STARTBYTE_POS] &
 | |
|                  RFAL_ISODEP_DID_MASK) != gIsoDep.did) ||
 | |
|                ((((uint8_t*)gIsoDep.actvParam.rxBuf)[RFAL_ISODEP_PPS_PPS0_POS] &
 | |
|                  RFAL_ISODEP_PPS0_VALID_MASK) != RFAL_ISODEP_PPS0_PPS1_NOT_PRESENT)) {
 | |
|                 /* Invalid DID on PPS request or Invalid PPS0, reEnable the receiver and wait another frame */
 | |
|                 isoDepReEnableRx(
 | |
|                     (uint8_t*)gIsoDep.actvParam.rxBuf,
 | |
|                     sizeof(rfalIsoDepBufFormat),
 | |
|                     gIsoDep.actvParam.rxLen);
 | |
| 
 | |
|                 return ERR_BUSY;
 | |
|             }
 | |
| 
 | |
|             /*******************************************************************************/
 | |
|             /* Check PPS1 presence */
 | |
|             if(((uint8_t*)gIsoDep.actvParam.rxBuf)[RFAL_ISODEP_PPS_PPS0_POS] ==
 | |
|                RFAL_ISODEP_PPS0_PPS1_PRESENT) {
 | |
|                 uint8_t newdri = ((uint8_t*)gIsoDep.actvParam.rxBuf)[RFAL_ISODEP_PPS_PPS1_POS] &
 | |
|                                  RFAL_ISODEP_PPS1_DxI_MASK; /* MISRA 10.8 */
 | |
|                 uint8_t newdsi = (((uint8_t*)gIsoDep.actvParam.rxBuf)[RFAL_ISODEP_PPS_PPS1_POS] >>
 | |
|                                   RFAL_ISODEP_PPS1_DSI_SHIFT) &
 | |
|                                  RFAL_ISODEP_PPS1_DxI_MASK; /* MISRA 10.8 */
 | |
|                 /* PRQA S 4342 2 # MISRA 10.5 - Layout of enum rfalBitRate and above masks guarantee no invalid enum values to be created */
 | |
|                 dri = (rfalBitRate)(newdri);
 | |
|                 dsi = (rfalBitRate)(newdsi);
 | |
| 
 | |
|                 if((!(RFAL_SUPPORT_BR_CE_A_106) &&
 | |
|                     ((dsi == RFAL_BR_106) || (dri == RFAL_BR_106))) ||
 | |
|                    (!(RFAL_SUPPORT_BR_CE_A_212) &&
 | |
|                     ((dsi == RFAL_BR_212) || (dri == RFAL_BR_212))) ||
 | |
|                    (!(RFAL_SUPPORT_BR_CE_A_424) &&
 | |
|                     ((dsi == RFAL_BR_424) || (dri == RFAL_BR_424))) ||
 | |
|                    (!(RFAL_SUPPORT_BR_CE_A_848) &&
 | |
|                     ((dsi == RFAL_BR_848) || (dri == RFAL_BR_848)))) {
 | |
|                     return ERR_PROTO;
 | |
|                 }
 | |
|             }
 | |
| 
 | |
|             /*******************************************************************************/
 | |
|             /* Compute and send PPS RES / Ack                                              */
 | |
|             txBuf[bufIt++] = ((uint8_t*)gIsoDep.actvParam.rxBuf)[RFAL_ISODEP_PPS_STARTBYTE_POS];
 | |
| 
 | |
|             rfalTransceiveBlockingTx(
 | |
|                 txBuf,
 | |
|                 bufIt,
 | |
|                 (uint8_t*)gIsoDep.actvParam.rxBuf,
 | |
|                 sizeof(rfalIsoDepBufFormat),
 | |
|                 gIsoDep.actvParam.rxLen,
 | |
|                 RFAL_TXRX_FLAGS_DEFAULT,
 | |
|                 RFAL_FWT_NONE);
 | |
| 
 | |
|             /*******************************************************************************/
 | |
|             /* Exchange the bit rates if requested */
 | |
|             if(dri != RFAL_BR_KEEP) {
 | |
|                 rfalSetBitRate(
 | |
|                     dsi,
 | |
|                     dri); /*  PRQA S  2880 # MISRA 2.1 - Unreachable code due to configuration option being set/unset above (RFAL_SUPPORT_BR_CE_A_xxx) */
 | |
| 
 | |
|                 gIsoDep.txBR = dsi; /* DSI codes the divisor from PICC to PCD */
 | |
|                 gIsoDep.rxBR = dri; /* DRI codes the divisor from PCD to PICC */
 | |
| 
 | |
|                 if(gIsoDep.actvParam.isoDepDev != NULL) {
 | |
|                     gIsoDep.actvParam.isoDepDev->info.DSI = dsi;
 | |
|                     gIsoDep.actvParam.isoDepDev->info.DRI = dri;
 | |
|                 }
 | |
|             }
 | |
|         }
 | |
|         /* Check for a S-Deselect is done on Data Exchange Activity                    */
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     gIsoDep.hdrLen = RFAL_ISODEP_PCB_LEN;
 | |
|     gIsoDep.hdrLen +=
 | |
|         RFAL_ISODEP_DID_LEN; /* Always assume DID to be aligned with Digital 1.1  15.1.2 and ISO14443  4 5.6.3    #454 */
 | |
|     gIsoDep.hdrLen += (uint8_t)((gIsoDep.nad != RFAL_ISODEP_NO_NAD) ? RFAL_ISODEP_NAD_LEN : 0U);
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Rule C - The PICC block number shall be initialized to 1 at activation */
 | |
|     gIsoDep.blockNumber = 1;
 | |
| 
 | |
|     /* Activation done, keep the rcvd data in, reMap the activation buffer to the global to be retrieved by the DEP method */
 | |
|     gIsoDep.rxBuf = (uint8_t*)gIsoDep.actvParam.rxBuf;
 | |
|     gIsoDep.rxBufLen = sizeof(rfalIsoDepBufFormat);
 | |
|     gIsoDep.rxBufInfPos =
 | |
|         (uint8_t)((uint32_t)gIsoDep.actvParam.rxBuf->inf - (uint32_t)gIsoDep.actvParam.rxBuf->prologue);
 | |
|     gIsoDep.rxLen = gIsoDep.actvParam.rxLen;
 | |
|     gIsoDep.rxChaining = gIsoDep.actvParam.isRxChaining;
 | |
| 
 | |
|     gIsoDep.state = ISODEP_ST_PICC_RX;
 | |
|     return ERR_NONE;
 | |
| }
 | |
| 
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_LISTEN */
 | |
| 
 | |
| /*******************************************************************************/
 | |
| uint16_t rfalIsoDepGetMaxInfLen(void) {
 | |
|     /* Check whether all parameters are valid, otherwise return minimum default value */
 | |
|     if((gIsoDep.fsx < (uint16_t)RFAL_ISODEP_FSX_16) ||
 | |
|        (gIsoDep.fsx > (uint16_t)RFAL_ISODEP_FSX_4096) || (gIsoDep.hdrLen > ISODEP_HDR_MAX_LEN)) {
 | |
|         uint16_t isodepFsx16 = (uint16_t)RFAL_ISODEP_FSX_16; /* MISRA 10.1 */
 | |
|         return (isodepFsx16 - RFAL_ISODEP_PCB_LEN - ISODEP_CRC_LEN);
 | |
|     }
 | |
| 
 | |
|     return (gIsoDep.fsx - gIsoDep.hdrLen - ISODEP_CRC_LEN);
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepStartTransceive(rfalIsoDepTxRxParam param) {
 | |
|     gIsoDep.txBuf = param.txBuf->prologue;
 | |
|     gIsoDep.txBufInfPos = (uint8_t)((uint32_t)param.txBuf->inf - (uint32_t)param.txBuf->prologue);
 | |
|     gIsoDep.txBufLen = param.txBufLen;
 | |
|     gIsoDep.isTxChaining = param.isTxChaining;
 | |
| 
 | |
|     gIsoDep.rxBuf = param.rxBuf->prologue;
 | |
|     gIsoDep.rxBufInfPos = (uint8_t)((uint32_t)param.rxBuf->inf - (uint32_t)param.rxBuf->prologue);
 | |
|     gIsoDep.rxBufLen = sizeof(rfalIsoDepBufFormat);
 | |
| 
 | |
|     gIsoDep.rxLen = param.rxLen;
 | |
|     gIsoDep.rxChaining = param.isRxChaining;
 | |
| 
 | |
|     gIsoDep.fwt = param.FWT;
 | |
|     gIsoDep.dFwt = param.dFWT;
 | |
|     gIsoDep.fsx = param.FSx;
 | |
|     gIsoDep.did = param.DID;
 | |
| 
 | |
|     /* Only change the FSx from activation if no to Keep */
 | |
|     gIsoDep.ourFsx = ((param.ourFSx != RFAL_ISODEP_FSX_KEEP) ? param.ourFSx : gIsoDep.ourFsx);
 | |
| 
 | |
|     /* Clear inner control params for next dataExchange */
 | |
|     gIsoDep.isRxChaining = false;
 | |
|     isoDepClearCounters();
 | |
| 
 | |
|     if(gIsoDep.role == ISODEP_ROLE_PICC) {
 | |
|         if(gIsoDep.txBufLen > 0U) {
 | |
|             /* Ensure that an RTOX Ack is not being expected at moment */
 | |
|             if(!gIsoDep.isWait4WTX) {
 | |
|                 gIsoDep.state = ISODEP_ST_PICC_TX;
 | |
|                 return ERR_NONE;
 | |
|             } else {
 | |
|                 /* If RTOX Ack is expected, signal a pending Tx to be transmitted right after */
 | |
|                 gIsoDep.isTxPending = true;
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         /* Digital 1.1  15.2.5.1 The first block SHALL be sent by the Reader/Writer */
 | |
|         gIsoDep.state = ISODEP_ST_PICC_RX;
 | |
|         return ERR_NONE;
 | |
|     }
 | |
| 
 | |
|     gIsoDep.state = ISODEP_ST_PCD_TX;
 | |
|     return ERR_NONE;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepGetTransceiveStatus(void) {
 | |
|     if(gIsoDep.role == ISODEP_ROLE_PICC) {
 | |
| #if RFAL_FEATURE_ISO_DEP_LISTEN
 | |
|         return isoDepDataExchangePICC();
 | |
| #else
 | |
|         return ERR_NOTSUPP;
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_LISTEN */
 | |
|     } else {
 | |
| #if RFAL_FEATURE_ISO_DEP_POLL
 | |
|         return isoDepDataExchangePCD(gIsoDep.rxLen, gIsoDep.rxChaining);
 | |
| #else
 | |
|         return ERR_NOTSUPP;
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_POLL */
 | |
|     }
 | |
| }
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP_LISTEN
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode isoDepDataExchangePICC(void) {
 | |
|     uint8_t rxPCB;
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     switch(gIsoDep.state) {
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_IDLE:
 | |
|         return ERR_NONE;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PICC_TX:
 | |
| 
 | |
|         ret = isoDepTx(
 | |
|             isoDep_PCBIBlock(gIsoDep.blockNumber),
 | |
|             gIsoDep.txBuf,
 | |
|             &gIsoDep.txBuf[gIsoDep.txBufInfPos],
 | |
|             gIsoDep.txBufLen,
 | |
|             RFAL_FWT_NONE);
 | |
| 
 | |
|         /* Clear pending Tx flag */
 | |
|         gIsoDep.isTxPending = false;
 | |
| 
 | |
|         switch(ret) {
 | |
|         case ERR_NONE:
 | |
|             gIsoDep.state = ISODEP_ST_PICC_RX;
 | |
|             return ERR_BUSY;
 | |
| 
 | |
|         default:
 | |
|             /* MISRA 16.4: no empty default statement (a comment being enough) */
 | |
|             break;
 | |
|         }
 | |
|         return ret;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PICC_RX:
 | |
| 
 | |
|         ret = rfalGetTransceiveStatus();
 | |
|         switch(ret) {
 | |
|         /*******************************************************************************/
 | |
|         /* Data rcvd with error or timeout -> mute */
 | |
|         case ERR_TIMEOUT:
 | |
|         case ERR_CRC:
 | |
|         case ERR_PAR:
 | |
|         case ERR_FRAMING:
 | |
| 
 | |
|             /* Digital 1.1 - 15.2.6.2  The CE SHALL NOT attempt error recovery and remains in Rx mode upon Transmission or a Protocol Error */
 | |
|             isoDepReEnableRx((uint8_t*)gIsoDep.rxBuf, sizeof(rfalIsoDepBufFormat), gIsoDep.rxLen);
 | |
| 
 | |
|             return ERR_BUSY;
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         case ERR_LINK_LOSS:
 | |
|             return ret; /* Debug purposes */
 | |
| 
 | |
|         case ERR_BUSY:
 | |
|             return ret; /* Debug purposes */
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         case ERR_NONE:
 | |
|             *gIsoDep.rxLen = rfalConvBitsToBytes(*gIsoDep.rxLen);
 | |
|             break;
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         default:
 | |
|             return ret;
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PICC_SWTX:
 | |
| 
 | |
|         if(!isoDepTimerisExpired(gIsoDep.WTXTimer)) /* Do nothing until WTX timer has expired */
 | |
|         {
 | |
|             return ERR_BUSY;
 | |
|         }
 | |
| 
 | |
|         /* Set waiting for WTX Ack Flag */
 | |
|         gIsoDep.isWait4WTX = true;
 | |
| 
 | |
|         /* Digital 1.1  15.2.2.9 - Calculate the WTXM such that FWTtemp <= FWTmax */
 | |
|         gIsoDep.lastWTXM = (uint8_t)isoDep_WTXMListenerMax(gIsoDep.fwt);
 | |
|         EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_S_WTX, gIsoDep.lastWTXM));
 | |
| 
 | |
|         gIsoDep.state = ISODEP_ST_PICC_RX; /* Go back to Rx to process WTX ack        */
 | |
|         return ERR_BUSY;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PICC_SDSL:
 | |
| 
 | |
|         if(rfalIsTransceiveInRx()) /* Wait until DSL response has been sent */
 | |
|         {
 | |
|             rfalIsoDepInitialize(); /* Session finished reInit vars */
 | |
|             return ERR_SLEEP_REQ; /* Notify Deselect request      */
 | |
|         }
 | |
|         return ERR_BUSY;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     default:
 | |
|         return ERR_INTERNAL;
 | |
|     }
 | |
| 
 | |
|     /* ISO 14443-4 7.5.6.2 CE SHALL NOT attempt error recovery -> clear counters */
 | |
|     isoDepClearCounters();
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* No error, process incoming msg                                              */
 | |
|     /*******************************************************************************/
 | |
| 
 | |
|     /* Grab rcvd PCB */
 | |
|     rxPCB = gIsoDep.rxBuf[ISODEP_PCB_POS];
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* When DID=0 PCD may or may not use DID, therefore check whether current PCD request 
 | |
|      * has DID present to be reflected on max INF length                         #454  */
 | |
| 
 | |
|     /* ReCalculate Header Length */
 | |
|     gIsoDep.hdrLen = RFAL_ISODEP_PCB_LEN;
 | |
|     gIsoDep.hdrLen += (uint8_t)((isoDep_PCBhasDID(rxPCB)) ? RFAL_ISODEP_DID_LEN : 0U);
 | |
|     gIsoDep.hdrLen += (uint8_t)((isoDep_PCBhasNAD(rxPCB)) ? RFAL_ISODEP_NAD_LEN : 0U);
 | |
| 
 | |
|     /* Store whether last PCD block had DID. for PICC special handling of DID = 0 */
 | |
|     if(gIsoDep.did == RFAL_ISODEP_DID_00) {
 | |
|         gIsoDep.lastDID00 = ((isoDep_PCBhasDID(rxPCB)) ? true : false);
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Check rcvd msg length, cannot be less then the expected header    OR        * 
 | |
|      * if the rcvd msg exceeds our announced frame size (FSD)                      */
 | |
|     if(((*gIsoDep.rxLen) < gIsoDep.hdrLen) ||
 | |
|        ((*gIsoDep.rxLen) > (gIsoDep.ourFsx - ISODEP_CRC_LEN))) {
 | |
|         isoDepReEnableRx(
 | |
|             (uint8_t*)gIsoDep.actvParam.rxBuf,
 | |
|             sizeof(rfalIsoDepBufFormat),
 | |
|             gIsoDep.actvParam.rxLen);
 | |
|         return ERR_BUSY; /* ERR_PROTO Ignore this protocol request */
 | |
|     }
 | |
| 
 | |
|     /* If we are expecting DID, check if PCB signals its presence and if device ID match OR
 | |
|      * If our DID=0 and DID is sent but with an incorrect value                              */
 | |
|     if(((gIsoDep.did != RFAL_ISODEP_DID_00) &&
 | |
|         (!isoDep_PCBhasDID(rxPCB) || (gIsoDep.did != gIsoDep.rxBuf[ISODEP_DID_POS]))) ||
 | |
|        ((gIsoDep.did == RFAL_ISODEP_DID_00) && isoDep_PCBhasDID(rxPCB) &&
 | |
|         (RFAL_ISODEP_DID_00 != gIsoDep.rxBuf[ISODEP_DID_POS]))) {
 | |
|         isoDepReEnableRx(
 | |
|             (uint8_t*)gIsoDep.actvParam.rxBuf,
 | |
|             sizeof(rfalIsoDepBufFormat),
 | |
|             gIsoDep.actvParam.rxLen);
 | |
|         return ERR_BUSY; /* Ignore a wrong DID request */
 | |
|     }
 | |
| 
 | |
|     /* If we aren't expecting NAD and it's received */
 | |
|     if((gIsoDep.nad == RFAL_ISODEP_NO_NAD) && isoDep_PCBhasNAD(rxPCB)) {
 | |
|         isoDepReEnableRx(
 | |
|             (uint8_t*)gIsoDep.actvParam.rxBuf,
 | |
|             sizeof(rfalIsoDepBufFormat),
 | |
|             gIsoDep.actvParam.rxLen);
 | |
|         return ERR_BUSY; /* Ignore a unexpected NAD request */
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Process S-Block                                                             */
 | |
|     /*******************************************************************************/
 | |
|     if(isoDep_PCBisSBlock(rxPCB)) {
 | |
|         /* Check if is a Wait Time eXtension */
 | |
|         if(isoDep_PCBisSWTX(rxPCB)) {
 | |
|             /* Check if we're expecting a S-WTX */
 | |
|             if(isoDep_PCBisWTX(gIsoDep.lastPCB)) {
 | |
|                 /* Digital 1.1  15.2.2.11 S(WTX) Ack with different WTXM -> Protocol Error  *
 | |
|                  *              Power level indication also should be set to 0              */
 | |
|                 if((gIsoDep.rxBuf[gIsoDep.hdrLen] == gIsoDep.lastWTXM) &&
 | |
|                    ((*gIsoDep.rxLen - gIsoDep.hdrLen) == ISODEP_SWTX_INF_LEN)) {
 | |
|                     /* Clear waiting for RTOX Ack Flag */
 | |
|                     gIsoDep.isWait4WTX = false;
 | |
| 
 | |
|                     /* Check if a Tx is already pending */
 | |
|                     if(gIsoDep.isTxPending) {
 | |
|                         /* Has a pending Tx, go immediately to TX */
 | |
|                         gIsoDep.state = ISODEP_ST_PICC_TX;
 | |
|                         return ERR_BUSY;
 | |
|                     }
 | |
| 
 | |
|                     /* Set WTX timer */
 | |
|                     isoDepTimerStart(
 | |
|                         gIsoDep.WTXTimer,
 | |
|                         isoDep_WTXAdjust((gIsoDep.lastWTXM * rfalConv1fcToMs(gIsoDep.fwt))));
 | |
| 
 | |
|                     gIsoDep.state = ISODEP_ST_PICC_SWTX;
 | |
|                     return ERR_BUSY;
 | |
|                 }
 | |
|             }
 | |
|             /* Unexpected/Incorrect S-WTX, fall into reRenable */
 | |
|         }
 | |
| 
 | |
|         /* Check if is a Deselect request */
 | |
|         if(isoDep_PCBisSDeselect(rxPCB) &&
 | |
|            ((*gIsoDep.rxLen - gIsoDep.hdrLen) == ISODEP_SDSL_INF_LEN)) {
 | |
|             EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_S_DSL, RFAL_ISODEP_NO_PARAM));
 | |
| 
 | |
|             /* S-DSL transmission ongoing, wait until complete */
 | |
|             gIsoDep.state = ISODEP_ST_PICC_SDSL;
 | |
|             return ERR_BUSY;
 | |
|         }
 | |
| 
 | |
|         /* Unexpected S-Block, fall into reRenable */
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Process R-Block                                                             */
 | |
|     /*******************************************************************************/
 | |
|     else if(isoDep_PCBisRBlock(rxPCB) && ((*gIsoDep.rxLen - gIsoDep.hdrLen) == ISODEP_RBLOCK_INF_LEN)) {
 | |
|         if(isoDep_PCBisRACK(rxPCB)) /* Check if is a R-ACK */
 | |
|         {
 | |
|             if(isoDep_GetBN(rxPCB) == gIsoDep.blockNumber) /* Check block number  */
 | |
|             {
 | |
|                 /* Rule 11 - R(ACK) with current bn -> re-transmit */
 | |
|                 if(!isoDep_PCBisIBlock(gIsoDep.lastPCB)) {
 | |
|                     isoDepReSendControlMsg();
 | |
|                 } else {
 | |
|                     gIsoDep.state = ISODEP_ST_PICC_TX;
 | |
|                 }
 | |
| 
 | |
|                 return ERR_BUSY;
 | |
|             } else {
 | |
|                 if(!gIsoDep.isTxChaining) {
 | |
|                     /* Rule 13 violation R(ACK) without performing chaining */
 | |
|                     isoDepReEnableRx(
 | |
|                         (uint8_t*)gIsoDep.rxBuf, sizeof(rfalIsoDepBufFormat), gIsoDep.rxLen);
 | |
|                     return ERR_BUSY;
 | |
|                 }
 | |
| 
 | |
|                 /* Rule E -  R(ACK) with not current bn -> toogle bn */
 | |
|                 isoDep_ToggleBN(gIsoDep.blockNumber);
 | |
| 
 | |
|                 /* This block has been transmitted and acknowledged, perform WTX until next data is provided  */
 | |
| 
 | |
|                 /* Rule 9 - PICC is allowed to send an S(WTX) instead of an I-block or an R(ACK) */
 | |
|                 isoDepTimerStart(gIsoDep.WTXTimer, isoDep_WTXAdjust(rfalConv1fcToMs(gIsoDep.fwt)));
 | |
|                 gIsoDep.state = ISODEP_ST_PICC_SWTX;
 | |
| 
 | |
|                 /* Rule 13 - R(ACK) with not current bn -> continue chaining */
 | |
|                 return ERR_NONE; /* This block has been transmitted */
 | |
|             }
 | |
|         } else if(isoDep_PCBisRNAK(rxPCB)) /* Check if is a R-NACK */
 | |
|         {
 | |
|             if(isoDep_GetBN(rxPCB) == gIsoDep.blockNumber) /* Check block number  */
 | |
|             {
 | |
|                 /* Rule 11 - R(NAK) with current bn -> re-transmit last x-Block */
 | |
|                 if(!isoDep_PCBisIBlock(gIsoDep.lastPCB)) {
 | |
|                     isoDepReSendControlMsg();
 | |
|                 } else {
 | |
|                     gIsoDep.state = ISODEP_ST_PICC_TX;
 | |
|                 }
 | |
| 
 | |
|                 return ERR_BUSY;
 | |
|             } else {
 | |
|                 /* Rule 12 - R(NAK) with not current bn -> R(ACK) */
 | |
|                 EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_R_ACK, RFAL_ISODEP_NO_PARAM));
 | |
| 
 | |
|                 return ERR_BUSY;
 | |
|             }
 | |
|         } else {
 | |
|             /* MISRA 15.7 - Empty else */
 | |
|         }
 | |
| 
 | |
|         /* Unexpected R-Block, fall into reRenable */
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Process I-Block                                                             */
 | |
|     /*******************************************************************************/
 | |
|     else if(isoDep_PCBisIBlock(rxPCB)) {
 | |
|         /* Rule D - When an I-block is received, the PICC shall toggle its block number before sending a block */
 | |
|         isoDep_ToggleBN(gIsoDep.blockNumber);
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Check if the block number is the one expected                               */
 | |
|         /* Check if PCD sent an I-Block instead ACK/NACK when we are chaining          */
 | |
|         if((isoDep_GetBN(rxPCB) != gIsoDep.blockNumber) || (gIsoDep.isTxChaining)) {
 | |
|             /* Remain in the same Block Number */
 | |
|             isoDep_ToggleBN(gIsoDep.blockNumber);
 | |
| 
 | |
|             /* ISO 14443-4 7.5.6.2 & Digital 1.1 - 15.2.6.2  The CE SHALL NOT attempt error recovery and remains in Rx mode upon Transmission or a Protocol Error */
 | |
|             isoDepReEnableRx((uint8_t*)gIsoDep.rxBuf, sizeof(rfalIsoDepBufFormat), gIsoDep.rxLen);
 | |
|             return ERR_BUSY;
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* is PCD performing chaining  ?                                               */
 | |
|         if(isoDep_PCBisChaining(rxPCB)) {
 | |
|             gIsoDep.isRxChaining = true;
 | |
|             *gIsoDep.rxChaining = true; /* Output Parameter*/
 | |
| 
 | |
|             EXIT_ON_ERR(ret, isoDepHandleControlMsg(ISODEP_R_ACK, RFAL_ISODEP_NO_PARAM));
 | |
| 
 | |
|             /* Received I-Block with chaining, send current data to DH */
 | |
| 
 | |
|             /* remove ISO DEP header, check is necessary to move the INF data on the buffer */
 | |
|             *gIsoDep.rxLen -= gIsoDep.hdrLen;
 | |
|             if((gIsoDep.hdrLen != gIsoDep.rxBufInfPos) && (*gIsoDep.rxLen > 0U)) {
 | |
|                 ST_MEMMOVE(
 | |
|                     &gIsoDep.rxBuf[gIsoDep.rxBufInfPos],
 | |
|                     &gIsoDep.rxBuf[gIsoDep.hdrLen],
 | |
|                     *gIsoDep.rxLen);
 | |
|             }
 | |
|             return ERR_AGAIN; /* Send Again signalling to run again, but some chaining data has arrived*/
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* PCD is not performing chaining                                              */
 | |
|         gIsoDep.isRxChaining = false; /* clear PCD chaining flag */
 | |
|         *gIsoDep.rxChaining = false; /* Output Parameter        */
 | |
| 
 | |
|         /* remove ISO DEP header, check is necessary to move the INF data on the buffer */
 | |
|         *gIsoDep.rxLen -= gIsoDep.hdrLen;
 | |
|         if((gIsoDep.hdrLen != gIsoDep.rxBufInfPos) && (*gIsoDep.rxLen > 0U)) {
 | |
|             ST_MEMMOVE(
 | |
|                 &gIsoDep.rxBuf[gIsoDep.rxBufInfPos],
 | |
|                 &gIsoDep.rxBuf[gIsoDep.hdrLen],
 | |
|                 *gIsoDep.rxLen);
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Reception done, send data back and start WTX timer                          */
 | |
|         isoDepTimerStart(gIsoDep.WTXTimer, isoDep_WTXAdjust(rfalConv1fcToMs(gIsoDep.fwt)));
 | |
| 
 | |
|         gIsoDep.state = ISODEP_ST_PICC_SWTX;
 | |
|         return ERR_NONE;
 | |
|     } else {
 | |
|         /* MISRA 15.7 - Empty else */
 | |
|     }
 | |
| 
 | |
|     /* Unexpected/Unknown Block */
 | |
|     /* ISO 14443-4 7.5.6.2 & Digital 1.1 - 15.2.6.2  The CE SHALL NOT attempt error recovery and remains in Rx mode upon Transmission or a Protocol Error */
 | |
|     isoDepReEnableRx((uint8_t*)gIsoDep.rxBuf, sizeof(rfalIsoDepBufFormat), gIsoDep.rxLen);
 | |
| 
 | |
|     return ERR_BUSY;
 | |
| }
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_LISTEN */
 | |
| 
 | |
| #if RFAL_FEATURE_ISO_DEP_POLL
 | |
| 
 | |
| #if RFAL_FEATURE_NFCA
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode
 | |
|     rfalIsoDepStartRATS(rfalIsoDepFSxI FSDI, uint8_t DID, rfalIsoDepAts* ats, uint8_t* atsLen) {
 | |
|     rfalTransceiveContext ctx;
 | |
| 
 | |
|     if(ats == NULL) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     gIsoDep.rxBuf = (uint8_t*)ats;
 | |
|     gIsoDep.rxLen8 = atsLen;
 | |
|     gIsoDep.did = DID;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Compose RATS */
 | |
|     gIsoDep.actv.ratsReq.CMD = RFAL_ISODEP_CMD_RATS;
 | |
|     gIsoDep.actv.ratsReq.PARAM =
 | |
|         (((uint8_t)FSDI << RFAL_ISODEP_RATS_PARAM_FSDI_SHIFT) & RFAL_ISODEP_RATS_PARAM_FSDI_MASK) |
 | |
|         (DID & RFAL_ISODEP_RATS_PARAM_DID_MASK);
 | |
| 
 | |
|     rfalCreateByteFlagsTxRxContext(
 | |
|         ctx,
 | |
|         (uint8_t*)&gIsoDep.actv.ratsReq,
 | |
|         sizeof(rfalIsoDepRats),
 | |
|         (uint8_t*)ats,
 | |
|         sizeof(rfalIsoDepAts),
 | |
|         &gIsoDep.rxBufLen,
 | |
|         RFAL_TXRX_FLAGS_DEFAULT,
 | |
|         RFAL_ISODEP_T4T_FWT_ACTIVATION);
 | |
|     return rfalStartTransceive(&ctx);
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode rfalIsoDepGetRATSStatus(void) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     ret = rfalGetTransceiveStatus();
 | |
|     if(ret == ERR_NONE) {
 | |
|         gIsoDep.rxBufLen = rfalConvBitsToBytes(gIsoDep.rxBufLen);
 | |
| 
 | |
|         /* Check for valid ATS length  Digital 1.1  13.6.2.1 & 13.6.2.3 */
 | |
|         if((gIsoDep.rxBufLen < RFAL_ISODEP_ATS_MIN_LEN) ||
 | |
|            (gIsoDep.rxBufLen > RFAL_ISODEP_ATS_MAX_LEN) ||
 | |
|            (gIsoDep.rxBuf[RFAL_ISODEP_ATS_TL_POS] != gIsoDep.rxBufLen)) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         /* Assign our FSx, in case the a Deselect is send without Transceive */
 | |
|         gIsoDep.ourFsx = rfalIsoDepFSxI2FSx(
 | |
|             (uint8_t)(gIsoDep.actv.ratsReq.PARAM >> RFAL_ISODEP_RATS_PARAM_FSDI_SHIFT));
 | |
| 
 | |
|         /* Check and assign if ATS length was requested (length also available on TL) */
 | |
|         if(gIsoDep.rxLen8 != NULL) {
 | |
|             *gIsoDep.rxLen8 = (uint8_t)gIsoDep.rxBufLen;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepRATS(rfalIsoDepFSxI FSDI, uint8_t DID, rfalIsoDepAts* ats, uint8_t* atsLen) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     EXIT_ON_ERR(ret, rfalIsoDepStartRATS(FSDI, DID, ats, atsLen));
 | |
|     rfalIsoDepRunBlocking(ret, rfalIsoDepGetRATSStatus());
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode
 | |
|     rfalIsoDepStartPPS(uint8_t DID, rfalBitRate DSI, rfalBitRate DRI, rfalIsoDepPpsRes* ppsRes) {
 | |
|     rfalTransceiveContext ctx;
 | |
| 
 | |
|     if((ppsRes == NULL) || (DSI > RFAL_BR_848) || (DRI > RFAL_BR_848) ||
 | |
|        (DID > RFAL_ISODEP_DID_MAX)) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     gIsoDep.rxBuf = (uint8_t*)ppsRes;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Compose PPS Request */
 | |
|     gIsoDep.actv.ppsReq.PPSS = (RFAL_ISODEP_PPS_SB | (DID & RFAL_ISODEP_PPS_SB_DID_MASK));
 | |
|     gIsoDep.actv.ppsReq.PPS0 = RFAL_ISODEP_PPS_PPS0_PPS1_PRESENT;
 | |
|     gIsoDep.actv.ppsReq.PPS1 =
 | |
|         (RFAL_ISODEP_PPS_PPS1 |
 | |
|          ((((uint8_t)DSI << RFAL_ISODEP_PPS_PPS1_DSI_SHIFT) | (uint8_t)DRI) &
 | |
|           RFAL_ISODEP_PPS_PPS1_DXI_MASK));
 | |
| 
 | |
|     rfalCreateByteFlagsTxRxContext(
 | |
|         ctx,
 | |
|         (uint8_t*)&gIsoDep.actv.ppsReq,
 | |
|         sizeof(rfalIsoDepPpsReq),
 | |
|         (uint8_t*)ppsRes,
 | |
|         sizeof(rfalIsoDepPpsRes),
 | |
|         &gIsoDep.rxBufLen,
 | |
|         RFAL_TXRX_FLAGS_DEFAULT,
 | |
|         RFAL_ISODEP_T4T_FWT_ACTIVATION);
 | |
|     return rfalStartTransceive(&ctx);
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode rfalIsoDepGetPPSSTatus(void) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     ret = rfalGetTransceiveStatus();
 | |
|     if(ret == ERR_NONE) {
 | |
|         gIsoDep.rxBufLen = rfalConvBitsToBytes(gIsoDep.rxBufLen);
 | |
| 
 | |
|         /* Check for valid PPS Response   */
 | |
|         if((gIsoDep.rxBufLen != RFAL_ISODEP_PPS_RES_LEN) ||
 | |
|            (*gIsoDep.rxBuf != gIsoDep.actv.ppsReq.PPSS)) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
|     }
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPPS(uint8_t DID, rfalBitRate DSI, rfalBitRate DRI, rfalIsoDepPpsRes* ppsRes) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     EXIT_ON_ERR(ret, rfalIsoDepStartPPS(DID, DSI, DRI, ppsRes));
 | |
|     rfalIsoDepRunBlocking(ret, rfalIsoDepGetPPSSTatus());
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| #endif /* RFAL_FEATURE_NFCA */
 | |
| 
 | |
| #if RFAL_FEATURE_NFCB
 | |
| 
 | |
| static ReturnCode rfalIsoDepStartATTRIB(
 | |
|     const uint8_t* nfcid0,
 | |
|     uint8_t PARAM1,
 | |
|     rfalBitRate DSI,
 | |
|     rfalBitRate DRI,
 | |
|     rfalIsoDepFSxI FSDI,
 | |
|     uint8_t PARAM3,
 | |
|     uint8_t DID,
 | |
|     const uint8_t* HLInfo,
 | |
|     uint8_t HLInfoLen,
 | |
|     uint32_t fwt,
 | |
|     rfalIsoDepAttribRes* attribRes,
 | |
|     uint8_t* attribResLen) {
 | |
|     rfalTransceiveContext ctx;
 | |
| 
 | |
|     if((attribRes == NULL) || (attribResLen == NULL) || (DSI > RFAL_BR_848) ||
 | |
|        (DRI > RFAL_BR_848) || (DID > RFAL_ISODEP_DID_MAX)) {
 | |
|         return ERR_NONE;
 | |
|     }
 | |
| 
 | |
|     gIsoDep.rxBuf = (uint8_t*)attribRes;
 | |
|     gIsoDep.rxLen8 = attribResLen;
 | |
|     gIsoDep.did = DID;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Compose ATTRIB command */
 | |
|     gIsoDep.actv.attribReq.cmd = RFAL_ISODEP_CMD_ATTRIB;
 | |
|     gIsoDep.actv.attribReq.Param.PARAM1 = PARAM1;
 | |
|     gIsoDep.actv.attribReq.Param.PARAM2 =
 | |
|         (((((uint8_t)DSI << RFAL_ISODEP_ATTRIB_PARAM2_DSI_SHIFT) |
 | |
|            ((uint8_t)DRI << RFAL_ISODEP_ATTRIB_PARAM2_DRI_SHIFT)) &
 | |
|           RFAL_ISODEP_ATTRIB_PARAM2_DXI_MASK) |
 | |
|          ((uint8_t)FSDI & RFAL_ISODEP_ATTRIB_PARAM2_FSDI_MASK));
 | |
|     gIsoDep.actv.attribReq.Param.PARAM3 = PARAM3;
 | |
|     gIsoDep.actv.attribReq.Param.PARAM4 = (DID & RFAL_ISODEP_ATTRIB_PARAM4_DID_MASK);
 | |
|     ST_MEMCPY(gIsoDep.actv.attribReq.nfcid0, nfcid0, RFAL_NFCB_NFCID0_LEN);
 | |
| 
 | |
|     /* Append the Higher layer Info if provided */
 | |
|     if((HLInfo != NULL) && (HLInfoLen > 0U)) {
 | |
|         ST_MEMCPY(
 | |
|             gIsoDep.actv.attribReq.HLInfo, HLInfo, MIN(HLInfoLen, RFAL_ISODEP_ATTRIB_HLINFO_LEN));
 | |
|     }
 | |
| 
 | |
|     rfalCreateByteFlagsTxRxContext(
 | |
|         ctx,
 | |
|         (uint8_t*)&gIsoDep.actv.attribReq,
 | |
|         (uint16_t)(RFAL_ISODEP_ATTRIB_HDR_LEN + MIN((uint16_t)HLInfoLen, RFAL_ISODEP_ATTRIB_HLINFO_LEN)),
 | |
|         (uint8_t*)gIsoDep.rxBuf,
 | |
|         sizeof(rfalIsoDepAttribRes),
 | |
|         &gIsoDep.rxBufLen,
 | |
|         RFAL_TXRX_FLAGS_DEFAULT,
 | |
|         fwt);
 | |
|     return rfalStartTransceive(&ctx);
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static ReturnCode rfalIsoDepGetATTRIBStatus(void) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     ret = rfalGetTransceiveStatus();
 | |
|     if(ret == ERR_NONE) {
 | |
|         gIsoDep.rxBufLen = rfalConvBitsToBytes(gIsoDep.rxBufLen);
 | |
| 
 | |
|         /* Check a for valid ATTRIB Response   Digital 1.1  15.6.2.1 */
 | |
|         if((gIsoDep.rxBufLen < RFAL_ISODEP_ATTRIB_RES_HDR_LEN) ||
 | |
|            ((gIsoDep.rxBuf[RFAL_ISODEP_ATTRIB_RES_MBLIDID_POS] &
 | |
|              RFAL_ISODEP_ATTRIB_RES_DID_MASK) != gIsoDep.did)) {
 | |
|             return ERR_PROTO;
 | |
|         }
 | |
| 
 | |
|         if(gIsoDep.rxLen8 != NULL) {
 | |
|             *gIsoDep.rxLen8 = (uint8_t)gIsoDep.rxBufLen;
 | |
|         }
 | |
| 
 | |
|         gIsoDep.ourFsx = rfalIsoDepFSxI2FSx(
 | |
|             (uint8_t)(gIsoDep.actv.attribReq.Param.PARAM2 & RFAL_ISODEP_ATTRIB_PARAM2_FSDI_MASK));
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepATTRIB(
 | |
|     const uint8_t* nfcid0,
 | |
|     uint8_t PARAM1,
 | |
|     rfalBitRate DSI,
 | |
|     rfalBitRate DRI,
 | |
|     rfalIsoDepFSxI FSDI,
 | |
|     uint8_t PARAM3,
 | |
|     uint8_t DID,
 | |
|     const uint8_t* HLInfo,
 | |
|     uint8_t HLInfoLen,
 | |
|     uint32_t fwt,
 | |
|     rfalIsoDepAttribRes* attribRes,
 | |
|     uint8_t* attribResLen) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     EXIT_ON_ERR(
 | |
|         ret,
 | |
|         rfalIsoDepStartATTRIB(
 | |
|             nfcid0,
 | |
|             PARAM1,
 | |
|             DSI,
 | |
|             DRI,
 | |
|             FSDI,
 | |
|             PARAM3,
 | |
|             DID,
 | |
|             HLInfo,
 | |
|             HLInfoLen,
 | |
|             fwt,
 | |
|             attribRes,
 | |
|             attribResLen));
 | |
|     rfalIsoDepRunBlocking(ret, rfalIsoDepGetATTRIBStatus());
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| #endif /* RFAL_FEATURE_NFCB */
 | |
| 
 | |
| #if RFAL_FEATURE_NFCA
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPollAHandleActivation(
 | |
|     rfalIsoDepFSxI FSDI,
 | |
|     uint8_t DID,
 | |
|     rfalBitRate maxBR,
 | |
|     rfalIsoDepDevice* isoDepDev) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     EXIT_ON_ERR(ret, rfalIsoDepPollAStartActivation(FSDI, DID, maxBR, isoDepDev));
 | |
|     rfalIsoDepRunBlocking(ret, rfalIsoDepPollAGetActivationStatus());
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPollAStartActivation(
 | |
|     rfalIsoDepFSxI FSDI,
 | |
|     uint8_t DID,
 | |
|     rfalBitRate maxBR,
 | |
|     rfalIsoDepDevice* isoDepDev) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     if(isoDepDev == NULL) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     /* Enable EMD handling according   Digital 1.1  4.1.1.1 ; EMVCo 2.6  4.9.2 */
 | |
|     rfalSetErrorHandling(RFAL_ERRORHANDLING_EMVCO);
 | |
| 
 | |
|     /* Start RATS Transceive */
 | |
|     EXIT_ON_ERR(
 | |
|         ret,
 | |
|         rfalIsoDepStartRATS(
 | |
|             FSDI,
 | |
|             DID,
 | |
|             &isoDepDev->activation.A.Listener.ATS,
 | |
|             &isoDepDev->activation.A.Listener.ATSLen));
 | |
| 
 | |
|     isoDepDev->info.DSI = maxBR;
 | |
|     gIsoDep.actvDev = isoDepDev;
 | |
|     gIsoDep.cntRRetrys = gIsoDep.maxRetriesRATS;
 | |
|     gIsoDep.state = ISODEP_ST_PCD_ACT_RATS;
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPollAGetActivationStatus(void) {
 | |
|     ReturnCode ret;
 | |
|     uint8_t msgIt;
 | |
|     rfalBitRate maxBR;
 | |
| 
 | |
|     switch(gIsoDep.state) {
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PCD_ACT_RATS:
 | |
| 
 | |
|         ret = rfalIsoDepGetRATSStatus();
 | |
|         if(ret != ERR_BUSY) {
 | |
|             if(ret != ERR_NONE) {
 | |
|                 /* EMVCo 2.6  9.6.1.1 & 9.6.1.2  If a timeout error is detected retransmit, on transmission error abort */
 | |
|                 if((gIsoDep.compMode == RFAL_COMPLIANCE_MODE_EMV) && (ret != ERR_TIMEOUT)) {
 | |
|                     break;
 | |
|                 }
 | |
| 
 | |
|                 if(gIsoDep.cntRRetrys != 0U) {
 | |
|                     /* Ensure FDT before retransmission (reuse RFAL GT timer) */
 | |
|                     rfalSetGT(rfalGetFDTPoll());
 | |
|                     rfalFieldOnAndStartGT();
 | |
| 
 | |
|                     /* Send RATS retransmission */ /* PRQA S 4342 1 # MISRA 10.5 - Layout of enum rfalIsoDepFSxI is guaranteed whithin 4bit range */
 | |
|                     EXIT_ON_ERR(
 | |
|                         ret,
 | |
|                         rfalIsoDepStartRATS(
 | |
|                             (rfalIsoDepFSxI)(uint8_t)(gIsoDep.actv.ratsReq.PARAM >> RFAL_ISODEP_RATS_PARAM_FSDI_SHIFT),
 | |
|                             gIsoDep.did,
 | |
|                             &gIsoDep.actvDev->activation.A.Listener.ATS,
 | |
|                             &gIsoDep.actvDev->activation.A.Listener.ATSLen));
 | |
|                     gIsoDep.cntRRetrys--;
 | |
|                     ret = ERR_BUSY;
 | |
|                 }
 | |
|                 /* Switch between NFC Forum and ISO14443-4 behaviour #595
 | |
|                      *   ISO14443-4  5.6.1  If RATS fails, a Deactivation sequence should be performed as defined on clause 8  
 | |
|                      *   Activity 1.1  9.6  Device Deactivation Activity is to be only performed when there's an active device */
 | |
|                 else if(gIsoDep.compMode == RFAL_COMPLIANCE_MODE_ISO) {
 | |
|                     rfalIsoDepDeselect();
 | |
|                 } else {
 | |
|                     /* MISRA 15.7 - Empty else */
 | |
|                 }
 | |
|             } else /* ATS received */
 | |
|             {
 | |
|                 maxBR = gIsoDep.actvDev->info.DSI; /* Retrieve requested max bitrate */
 | |
| 
 | |
|                 /*******************************************************************************/
 | |
|                 /* Process ATS Response                                                        */
 | |
|                 gIsoDep.actvDev->info.FWI =
 | |
|                     RFAL_ISODEP_FWI_DEFAULT; /* Default value   EMVCo 2.6  5.7.2.6  */
 | |
|                 gIsoDep.actvDev->info.SFGI = 0U;
 | |
|                 gIsoDep.actvDev->info.MBL = 0U;
 | |
|                 gIsoDep.actvDev->info.DSI = RFAL_BR_106;
 | |
|                 gIsoDep.actvDev->info.DRI = RFAL_BR_106;
 | |
|                 gIsoDep.actvDev->info.FSxI = (uint8_t)
 | |
|                     RFAL_ISODEP_FSXI_32; /* FSC default value is 32 bytes  ISO14443-A  5.2.3 */
 | |
| 
 | |
|                 /*******************************************************************************/
 | |
|                 /* Check for ATS optional fields                                               */
 | |
|                 if(gIsoDep.actvDev->activation.A.Listener.ATS.TL > RFAL_ISODEP_ATS_MIN_LEN) {
 | |
|                     msgIt = RFAL_ISODEP_ATS_MIN_LEN;
 | |
| 
 | |
|                     /* Format byte T0 is optional, if present assign FSDI */
 | |
|                     gIsoDep.actvDev->info.FSxI =
 | |
|                         (gIsoDep.actvDev->activation.A.Listener.ATS.T0 &
 | |
|                          RFAL_ISODEP_ATS_T0_FSCI_MASK);
 | |
| 
 | |
|                     /* T0 has already been processed, always the same position */
 | |
|                     msgIt++;
 | |
| 
 | |
|                     /* Check if TA is present */
 | |
|                     if((gIsoDep.actvDev->activation.A.Listener.ATS.T0 &
 | |
|                         RFAL_ISODEP_ATS_T0_TA_PRESENCE_MASK) != 0U) {
 | |
|                         rfalIsoDepCalcBitRate(
 | |
|                             maxBR,
 | |
|                             ((uint8_t*)&gIsoDep.actvDev->activation.A.Listener.ATS)[msgIt++],
 | |
|                             &gIsoDep.actvDev->info.DSI,
 | |
|                             &gIsoDep.actvDev->info.DRI);
 | |
|                     }
 | |
| 
 | |
|                     /* Check if TB is present */
 | |
|                     if((gIsoDep.actvDev->activation.A.Listener.ATS.T0 &
 | |
|                         RFAL_ISODEP_ATS_T0_TB_PRESENCE_MASK) != 0U) {
 | |
|                         gIsoDep.actvDev->info.SFGI =
 | |
|                             ((uint8_t*)&gIsoDep.actvDev->activation.A.Listener.ATS)[msgIt++];
 | |
|                         gIsoDep.actvDev->info.FWI =
 | |
|                             (uint8_t)((gIsoDep.actvDev->info.SFGI >> RFAL_ISODEP_ATS_TB_FWI_SHIFT) & RFAL_ISODEP_ATS_FWI_MASK);
 | |
|                         gIsoDep.actvDev->info.SFGI &= RFAL_ISODEP_ATS_TB_SFGI_MASK;
 | |
|                     }
 | |
| 
 | |
|                     /* Check if TC is present */
 | |
|                     if((gIsoDep.actvDev->activation.A.Listener.ATS.T0 &
 | |
|                         RFAL_ISODEP_ATS_T0_TC_PRESENCE_MASK) != 0U) {
 | |
|                         /* Check for Protocol features support */
 | |
|                         /* Advanced protocol features defined on Digital 1.0 Table 69, removed after */
 | |
|                         gIsoDep.actvDev->info.supAdFt =
 | |
|                             (((((uint8_t*)&gIsoDep.actvDev->activation.A.Listener.ATS)[msgIt] &
 | |
|                                RFAL_ISODEP_ATS_TC_ADV_FEAT) != 0U) ?
 | |
|                                  true :
 | |
|                                  false);
 | |
|                         gIsoDep.actvDev->info.supDID =
 | |
|                             (((((uint8_t*)&gIsoDep.actvDev->activation.A.Listener.ATS)[msgIt] &
 | |
|                                RFAL_ISODEP_ATS_TC_DID) != 0U) ?
 | |
|                                  true :
 | |
|                                  false);
 | |
|                         gIsoDep.actvDev->info.supNAD =
 | |
|                             (((((uint8_t*)&gIsoDep.actvDev->activation.A.Listener.ATS)[msgIt++] &
 | |
|                                RFAL_ISODEP_ATS_TC_NAD) != 0U) ?
 | |
|                                  true :
 | |
|                                  false);
 | |
|                     }
 | |
|                 }
 | |
| 
 | |
|                 gIsoDep.actvDev->info.FSx = rfalIsoDepFSxI2FSx(gIsoDep.actvDev->info.FSxI);
 | |
|                 gIsoDep.fsx = gIsoDep.actvDev->info.FSx;
 | |
| 
 | |
|                 gIsoDep.actvDev->info.SFGT =
 | |
|                     rfalIsoDepSFGI2SFGT((uint8_t)gIsoDep.actvDev->info.SFGI);
 | |
| 
 | |
|                 /* Ensure SFGT before following frame (reuse RFAL GT timer) */
 | |
|                 rfalSetGT(rfalConvMsTo1fc(gIsoDep.actvDev->info.SFGT));
 | |
|                 rfalFieldOnAndStartGT();
 | |
| 
 | |
|                 gIsoDep.actvDev->info.FWT = rfalIsoDepFWI2FWT(gIsoDep.actvDev->info.FWI);
 | |
|                 gIsoDep.actvDev->info.dFWT = RFAL_ISODEP_DFWT_20;
 | |
| 
 | |
|                 gIsoDep.actvDev->info.DID =
 | |
|                     ((gIsoDep.actvDev->info.supDID) ? gIsoDep.did : RFAL_ISODEP_NO_DID);
 | |
|                 gIsoDep.actvDev->info.NAD = RFAL_ISODEP_NO_NAD;
 | |
| 
 | |
|                 /*******************************************************************************/
 | |
|                 /* If higher bit rates are supported by both devices, send PPS                 */
 | |
|                 if((gIsoDep.actvDev->info.DSI != RFAL_BR_106) ||
 | |
|                    (gIsoDep.actvDev->info.DRI != RFAL_BR_106)) {
 | |
|                     /* Send PPS */ /*  PRQA S 0310 1 # MISRA 11.3 - Intentional safe cast to avoiding buffer duplication */
 | |
|                     EXIT_ON_ERR(
 | |
|                         ret,
 | |
|                         rfalIsoDepStartPPS(
 | |
|                             gIsoDep.actvDev->info.DID,
 | |
|                             gIsoDep.actvDev->info.DSI,
 | |
|                             gIsoDep.actvDev->info.DRI,
 | |
|                             (rfalIsoDepPpsRes*)&gIsoDep.ctrlBuf));
 | |
| 
 | |
|                     gIsoDep.state = ISODEP_ST_PCD_ACT_PPS;
 | |
|                     return ERR_BUSY;
 | |
|                 }
 | |
| 
 | |
|                 return ERR_NONE;
 | |
|             }
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ISODEP_ST_PCD_ACT_PPS:
 | |
|         ret = rfalIsoDepGetPPSSTatus();
 | |
|         if(ret != ERR_BUSY) {
 | |
|             /* Check whether PPS has been acknowledge */
 | |
|             if(ret == ERR_NONE) {
 | |
|                 /* DSI code the divisor from PICC to PCD */
 | |
|                 /* DRI code the divisor from PCD to PICC */
 | |
|                 rfalSetBitRate(gIsoDep.actvDev->info.DRI, gIsoDep.actvDev->info.DSI);
 | |
|             } else {
 | |
|                 /* If PPS has faled keep activation bit rate */
 | |
|                 gIsoDep.actvDev->info.DSI = RFAL_BR_106;
 | |
|                 gIsoDep.actvDev->info.DRI = RFAL_BR_106;
 | |
|             }
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     default:
 | |
|         ret = ERR_WRONG_STATE;
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| #endif /* RFAL_FEATURE_NFCA */
 | |
| 
 | |
| #if RFAL_FEATURE_NFCB
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPollBHandleActivation(
 | |
|     rfalIsoDepFSxI FSDI,
 | |
|     uint8_t DID,
 | |
|     rfalBitRate maxBR,
 | |
|     uint8_t PARAM1,
 | |
|     const rfalNfcbListenDevice* nfcbDev,
 | |
|     const uint8_t* HLInfo,
 | |
|     uint8_t HLInfoLen,
 | |
|     rfalIsoDepDevice* isoDepDev) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     EXIT_ON_ERR(
 | |
|         ret,
 | |
|         rfalIsoDepPollBStartActivation(
 | |
|             FSDI, DID, maxBR, PARAM1, nfcbDev, HLInfo, HLInfoLen, isoDepDev));
 | |
|     rfalIsoDepRunBlocking(ret, rfalIsoDepPollBGetActivationStatus());
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPollBStartActivation(
 | |
|     rfalIsoDepFSxI FSDI,
 | |
|     uint8_t DID,
 | |
|     rfalBitRate maxBR,
 | |
|     uint8_t PARAM1,
 | |
|     const rfalNfcbListenDevice* nfcbDev,
 | |
|     const uint8_t* HLInfo,
 | |
|     uint8_t HLInfoLen,
 | |
|     rfalIsoDepDevice* isoDepDev) {
 | |
|     ReturnCode ret;
 | |
| 
 | |
|     /***************************************************************************/
 | |
|     /* Initialize ISO-DEP Device with info from SENSB_RES                      */
 | |
|     isoDepDev->info.FWI =
 | |
|         ((nfcbDev->sensbRes.protInfo.FwiAdcFo >> RFAL_NFCB_SENSB_RES_FWI_SHIFT) &
 | |
|          RFAL_NFCB_SENSB_RES_FWI_MASK);
 | |
|     isoDepDev->info.FWT = rfalIsoDepFWI2FWT(isoDepDev->info.FWI);
 | |
|     isoDepDev->info.dFWT = RFAL_NFCB_DFWT;
 | |
|     isoDepDev->info.SFGI =
 | |
|         (((uint32_t)nfcbDev->sensbRes.protInfo.SFGI >> RFAL_NFCB_SENSB_RES_SFGI_SHIFT) &
 | |
|          RFAL_NFCB_SENSB_RES_SFGI_MASK);
 | |
|     isoDepDev->info.SFGT = rfalIsoDepSFGI2SFGT((uint8_t)isoDepDev->info.SFGI);
 | |
|     isoDepDev->info.FSxI =
 | |
|         ((nfcbDev->sensbRes.protInfo.FsciProType >> RFAL_NFCB_SENSB_RES_FSCI_SHIFT) &
 | |
|          RFAL_NFCB_SENSB_RES_FSCI_MASK);
 | |
|     isoDepDev->info.FSx = rfalIsoDepFSxI2FSx(isoDepDev->info.FSxI);
 | |
|     isoDepDev->info.DID = DID;
 | |
|     isoDepDev->info.supDID =
 | |
|         (((nfcbDev->sensbRes.protInfo.FwiAdcFo & RFAL_NFCB_SENSB_RES_FO_DID_MASK) != 0U) ? true :
 | |
|                                                                                            false);
 | |
|     isoDepDev->info.supNAD =
 | |
|         (((nfcbDev->sensbRes.protInfo.FwiAdcFo & RFAL_NFCB_SENSB_RES_FO_NAD_MASK) != 0U) ? true :
 | |
|                                                                                            false);
 | |
| 
 | |
|     /* Check if DID requested is supported by PICC */
 | |
|     if((DID != RFAL_ISODEP_NO_DID) && (!isoDepDev->info.supDID)) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     /* Enable EMD handling according   Digital 2.1  4.1.1.1 ; EMVCo 3.0  4.9.2 */
 | |
|     rfalSetErrorHandling(RFAL_ERRORHANDLING_EMVCO);
 | |
| 
 | |
|     /***************************************************************************/
 | |
|     /* Set FDT Poll to be used on upcoming communications                      */
 | |
|     if(gIsoDep.compMode == RFAL_COMPLIANCE_MODE_EMV) {
 | |
|         /* Disregard Minimum TR2 returned by PICC, always use FDTb MIN   EMVCo 3.0  6.3.2.10  */
 | |
|         rfalSetFDTPoll(RFAL_FDT_POLL_NFCB_POLLER);
 | |
|     } else {
 | |
|         /* Apply minimum TR2 from SENSB_RES   Digital 2.1  7.6.2.23 */
 | |
|         rfalSetFDTPoll(rfalNfcbTR2ToFDT(
 | |
|             ((nfcbDev->sensbRes.protInfo.FsciProType >> RFAL_NFCB_SENSB_RES_PROTO_TR2_SHIFT) &
 | |
|              RFAL_NFCB_SENSB_RES_PROTO_TR2_MASK)));
 | |
|     }
 | |
| 
 | |
|     /* Calculate max Bit Rate */
 | |
|     rfalIsoDepCalcBitRate(
 | |
|         maxBR, nfcbDev->sensbRes.protInfo.BRC, &isoDepDev->info.DSI, &isoDepDev->info.DRI);
 | |
| 
 | |
|     /***************************************************************************/
 | |
|     /* Send ATTRIB Command                                                     */
 | |
|     EXIT_ON_ERR(
 | |
|         ret,
 | |
|         rfalIsoDepStartATTRIB(
 | |
|             (const uint8_t*)&nfcbDev->sensbRes.nfcid0,
 | |
|             (((nfcbDev->sensbRes.protInfo.FwiAdcFo & RFAL_NFCB_SENSB_RES_ADC_ADV_FEATURE_MASK) !=
 | |
|               0U) ?
 | |
|                  PARAM1 :
 | |
|                  RFAL_ISODEP_ATTRIB_REQ_PARAM1_DEFAULT),
 | |
|             isoDepDev->info.DSI,
 | |
|             isoDepDev->info.DRI,
 | |
|             FSDI,
 | |
|             (gIsoDep.compMode == RFAL_COMPLIANCE_MODE_EMV) ?
 | |
|                 RFAL_NFCB_SENSB_RES_PROTO_ISO_MASK :
 | |
|                 (nfcbDev->sensbRes.protInfo.FsciProType &
 | |
|                  ((RFAL_NFCB_SENSB_RES_PROTO_TR2_MASK << RFAL_NFCB_SENSB_RES_PROTO_TR2_SHIFT) |
 | |
|                   RFAL_NFCB_SENSB_RES_PROTO_ISO_MASK)), /* EMVCo 2.6 6.4.1.9 */
 | |
|             DID,
 | |
|             HLInfo,
 | |
|             HLInfoLen,
 | |
|             (isoDepDev->info.FWT + isoDepDev->info.dFWT),
 | |
|             &isoDepDev->activation.B.Listener.ATTRIB_RES,
 | |
|             &isoDepDev->activation.B.Listener.ATTRIB_RESLen));
 | |
| 
 | |
|     gIsoDep.actvDev = isoDepDev;
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPollBGetActivationStatus(void) {
 | |
|     ReturnCode ret;
 | |
|     uint8_t mbli;
 | |
| 
 | |
|     /***************************************************************************/
 | |
|     /* Process ATTRIB Response                                                 */
 | |
|     ret = rfalIsoDepGetATTRIBStatus();
 | |
|     if(ret != ERR_BUSY) {
 | |
|         if(ret == ERR_NONE) {
 | |
|             /* Digital 1.1 14.6.2.3 - Check if received DID match */
 | |
|             if((gIsoDep.actvDev->activation.B.Listener.ATTRIB_RES.mbliDid &
 | |
|                 RFAL_ISODEP_ATTRIB_RES_DID_MASK) != gIsoDep.did) {
 | |
|                 return ERR_PROTO;
 | |
|             }
 | |
| 
 | |
|             /* Retrieve MBLI and calculate new FDS/MBL (Maximum Buffer Length) */
 | |
|             mbli =
 | |
|                 ((gIsoDep.actvDev->activation.B.Listener.ATTRIB_RES.mbliDid >>
 | |
|                   RFAL_ISODEP_ATTRIB_RES_MBLI_SHIFT) &
 | |
|                  RFAL_ISODEP_ATTRIB_RES_MBLI_MASK);
 | |
|             if(mbli > 0U) {
 | |
|                 /* Digital 1.1  14.6.2  Calculate Maximum Buffer Length MBL = FSC x 2^(MBLI-1) */
 | |
|                 gIsoDep.actvDev->info.MBL =
 | |
|                     (gIsoDep.actvDev->info.FSx * ((uint32_t)1U << (mbli - 1U)));
 | |
|             }
 | |
| 
 | |
|             /* DSI code the divisor from PICC to PCD */
 | |
|             /* DRI code the divisor from PCD to PICC */
 | |
|             rfalSetBitRate(gIsoDep.actvDev->info.DRI, gIsoDep.actvDev->info.DSI);
 | |
| 
 | |
|             /* REMARK: SoF EoF TR0 and TR1 are not passed on to RF layer */
 | |
| 
 | |
|             /* Start the SFGT timer (reuse RFAL GT timer) */
 | |
|             rfalSetGT(rfalConvMsTo1fc(gIsoDep.actvDev->info.SFGT));
 | |
|             rfalFieldOnAndStartGT();
 | |
|         } else {
 | |
|             gIsoDep.actvDev->info.DSI = RFAL_BR_106;
 | |
|             gIsoDep.actvDev->info.DRI = RFAL_BR_106;
 | |
|         }
 | |
| 
 | |
|         /*******************************************************************************/
 | |
|         /* Store already FS info,  rfalIsoDepGetMaxInfLen() may be called before setting TxRx params */
 | |
|         gIsoDep.fsx = gIsoDep.actvDev->info.FSx;
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| #endif /* RFAL_FEATURE_NFCB */
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepPollHandleSParameters(
 | |
|     rfalIsoDepDevice* isoDepDev,
 | |
|     rfalBitRate maxTxBR,
 | |
|     rfalBitRate maxRxBR) {
 | |
|     uint8_t it;
 | |
|     uint8_t supPCD2PICC;
 | |
|     uint8_t supPICC2PCD;
 | |
|     uint8_t currenttxBR;
 | |
|     uint8_t currentrxBR;
 | |
|     rfalBitRate txBR;
 | |
|     rfalBitRate rxBR;
 | |
|     uint16_t rcvLen;
 | |
|     ReturnCode ret;
 | |
|     rfalIsoDepControlMsgSParam sParam;
 | |
| 
 | |
|     if((isoDepDev == NULL) || (maxTxBR > RFAL_BR_13560) || (maxRxBR > RFAL_BR_13560)) {
 | |
|         return ERR_PARAM;
 | |
|     }
 | |
| 
 | |
|     it = 0;
 | |
|     supPICC2PCD = 0x00;
 | |
|     supPCD2PICC = 0x00;
 | |
|     txBR = RFAL_BR_106;
 | |
|     rxBR = RFAL_BR_106;
 | |
|     sParam.pcb = ISODEP_PCB_SPARAMETERS;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Send S(PARAMETERS) - Block Info */
 | |
|     sParam.sParam.tag = RFAL_ISODEP_SPARAM_TAG_BLOCKINFO;
 | |
|     sParam.sParam.value[it++] = RFAL_ISODEP_SPARAM_TAG_BRREQ;
 | |
|     sParam.sParam.value[it++] = RFAL_ISODEP_SPARAM_TAG_BRREQ_LEN;
 | |
|     sParam.sParam.length = it;
 | |
| 
 | |
|     /* Send S(PARAMETERS). Use a fixed FWI of 4   ISO14443-4 2016  7.2 */
 | |
|     EXIT_ON_ERR(
 | |
|         ret,
 | |
|         rfalTransceiveBlockingTxRx(
 | |
|             (uint8_t*)&sParam,
 | |
|             (RFAL_ISODEP_SPARAM_HDR_LEN + (uint16_t)it),
 | |
|             (uint8_t*)&sParam,
 | |
|             sizeof(rfalIsoDepControlMsgSParam),
 | |
|             &rcvLen,
 | |
|             RFAL_TXRX_FLAGS_DEFAULT,
 | |
|             ISODEP_FWT_DEACTIVATION));
 | |
| 
 | |
|     it = 0;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Check S(PARAMETERS) response */
 | |
|     if((sParam.pcb != ISODEP_PCB_SPARAMETERS) ||
 | |
|        (sParam.sParam.tag != RFAL_ISODEP_SPARAM_TAG_BLOCKINFO) ||
 | |
|        (sParam.sParam.value[it] != RFAL_ISODEP_SPARAM_TAG_BRIND) ||
 | |
|        (rcvLen < RFAL_ISODEP_SPARAM_HDR_LEN) ||
 | |
|        (rcvLen != ((uint16_t)sParam.sParam.length + RFAL_ISODEP_SPARAM_HDR_LEN))) {
 | |
|         return ERR_PROTO;
 | |
|     }
 | |
| 
 | |
|     /* Retrieve PICC's bit rate PICC capabilities */
 | |
|     for(it = 0; it < (rcvLen - (uint16_t)RFAL_ISODEP_SPARAM_TAG_LEN); it++) {
 | |
|         if((sParam.sParam.value[it] == RFAL_ISODEP_SPARAM_TAG_SUP_PCD2PICC) &&
 | |
|            (sParam.sParam.value[it + (uint16_t)RFAL_ISODEP_SPARAM_TAG_LEN] ==
 | |
|             RFAL_ISODEP_SPARAM_TAG_PCD2PICC_LEN)) {
 | |
|             supPCD2PICC = sParam.sParam.value[it + RFAL_ISODEP_SPARAM_TAG_PCD2PICC_LEN];
 | |
|         }
 | |
| 
 | |
|         if((sParam.sParam.value[it] == RFAL_ISODEP_SPARAM_TAG_SUP_PICC2PCD) &&
 | |
|            (sParam.sParam.value[it + (uint16_t)RFAL_ISODEP_SPARAM_TAG_LEN] ==
 | |
|             RFAL_ISODEP_SPARAM_TAG_PICC2PCD_LEN)) {
 | |
|             supPICC2PCD = sParam.sParam.value[it + RFAL_ISODEP_SPARAM_TAG_PICC2PCD_LEN];
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Check if requested bit rates are supported by PICC */
 | |
|     if((supPICC2PCD == 0x00U) || (supPCD2PICC == 0x00U)) {
 | |
|         return ERR_PROTO;
 | |
|     }
 | |
| 
 | |
|     for(it = 0; it <= (uint8_t)maxTxBR; it++) {
 | |
|         if((supPCD2PICC & (0x01U << it)) != 0U) {
 | |
|             txBR = (rfalBitRate)
 | |
|                 it; /* PRQA S 4342 # MISRA 10.5 - Layout of enum rfalBitRate and above clamping of maxTxBR guarantee no invalid enum values to be created */
 | |
|         }
 | |
|     }
 | |
|     for(it = 0; it <= (uint8_t)maxRxBR; it++) {
 | |
|         if((supPICC2PCD & (0x01U << it)) != 0U) {
 | |
|             rxBR = (rfalBitRate)
 | |
|                 it; /* PRQA S 4342 # MISRA 10.5 - Layout of enum rfalBitRate and above clamping of maxTxBR guarantee no invalid enum values to be created */
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     it = 0;
 | |
|     currenttxBR = (uint8_t)txBR;
 | |
|     currentrxBR = (uint8_t)rxBR;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Send S(PARAMETERS) - Bit rates Activation */
 | |
|     sParam.sParam.tag = RFAL_ISODEP_SPARAM_TAG_BLOCKINFO;
 | |
|     sParam.sParam.value[it++] = RFAL_ISODEP_SPARAM_TAG_BRACT;
 | |
|     sParam.sParam.value[it++] =
 | |
|         (RFAL_ISODEP_SPARAM_TVL_HDR_LEN + RFAL_ISODEP_SPARAM_TAG_PCD2PICC_LEN +
 | |
|          RFAL_ISODEP_SPARAM_TVL_HDR_LEN + RFAL_ISODEP_SPARAM_TAG_PICC2PCD_LEN);
 | |
|     sParam.sParam.value[it++] = RFAL_ISODEP_SPARAM_TAG_SEL_PCD2PICC;
 | |
|     sParam.sParam.value[it++] = RFAL_ISODEP_SPARAM_TAG_PCD2PICC_LEN;
 | |
|     sParam.sParam.value[it++] = ((uint8_t)0x01U << currenttxBR);
 | |
|     sParam.sParam.value[it++] = 0x00U;
 | |
|     sParam.sParam.value[it++] = RFAL_ISODEP_SPARAM_TAG_SEL_PICC2PCD;
 | |
|     sParam.sParam.value[it++] = RFAL_ISODEP_SPARAM_TAG_PICC2PCD_LEN;
 | |
|     sParam.sParam.value[it++] = ((uint8_t)0x01U << currentrxBR);
 | |
|     sParam.sParam.value[it++] = 0x00U;
 | |
|     sParam.sParam.length = it;
 | |
| 
 | |
|     EXIT_ON_ERR(
 | |
|         ret,
 | |
|         rfalTransceiveBlockingTxRx(
 | |
|             (uint8_t*)&sParam,
 | |
|             (RFAL_ISODEP_SPARAM_HDR_LEN + (uint16_t)it),
 | |
|             (uint8_t*)&sParam,
 | |
|             sizeof(rfalIsoDepControlMsgSParam),
 | |
|             &rcvLen,
 | |
|             RFAL_TXRX_FLAGS_DEFAULT,
 | |
|             (isoDepDev->info.FWT + isoDepDev->info.dFWT)));
 | |
| 
 | |
|     it = 0;
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     /* Check S(PARAMETERS) Acknowledge  */
 | |
|     if((sParam.pcb != ISODEP_PCB_SPARAMETERS) ||
 | |
|        (sParam.sParam.tag != RFAL_ISODEP_SPARAM_TAG_BLOCKINFO) ||
 | |
|        (sParam.sParam.value[it] != RFAL_ISODEP_SPARAM_TAG_BRACK) ||
 | |
|        (rcvLen < RFAL_ISODEP_SPARAM_HDR_LEN)) {
 | |
|         return ERR_PROTO;
 | |
|     }
 | |
| 
 | |
|     EXIT_ON_ERR(ret, rfalSetBitRate(txBR, rxBR));
 | |
| 
 | |
|     isoDepDev->info.DRI = txBR;
 | |
|     isoDepDev->info.DSI = rxBR;
 | |
| 
 | |
|     return ERR_NONE;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static void rfalIsoDepCalcBitRate(
 | |
|     rfalBitRate maxAllowedBR,
 | |
|     uint8_t piccBRCapability,
 | |
|     rfalBitRate* dsi,
 | |
|     rfalBitRate* dri) {
 | |
|     uint8_t driMask;
 | |
|     uint8_t dsiMask;
 | |
|     int8_t i;
 | |
|     bool bitrateFound;
 | |
|     rfalBitRate curMaxBR;
 | |
| 
 | |
|     curMaxBR = maxAllowedBR;
 | |
| 
 | |
|     do {
 | |
|         bitrateFound = true;
 | |
| 
 | |
|         (*dsi) = RFAL_BR_106;
 | |
|         (*dri) = RFAL_BR_106;
 | |
| 
 | |
|         /* Digital 1.0  5.6.2.5 & 11.6.2.14: A received RFU value of b4 = 1b MUST be interpreted as if b7 to b1 ? 0000000b (only 106 kbits/s in both direction) */
 | |
|         if(((RFAL_ISODEP_BITRATE_RFU_MASK & piccBRCapability) != 0U) || (curMaxBR > RFAL_BR_848) ||
 | |
|            (curMaxBR == RFAL_BR_KEEP)) {
 | |
|             return;
 | |
|         }
 | |
| 
 | |
|         /***************************************************************************/
 | |
|         /* Determine Listen->Poll bit rate */
 | |
|         dsiMask = (piccBRCapability & RFAL_ISODEP_BSI_MASK);
 | |
|         for(i = 2; i >= 0; i--) // Check supported bit rate from the highest
 | |
|         {
 | |
|             if(((dsiMask & (0x10U << (uint8_t)i)) != 0U) &&
 | |
|                (((uint8_t)i + 1U) <= (uint8_t)curMaxBR)) {
 | |
|                 uint8_t newdsi = ((uint8_t)i) + 1U;
 | |
|                 (*dsi) = (rfalBitRate)
 | |
|                     newdsi; /* PRQA S 4342 # MISRA 10.5 - Layout of enum rfalBitRate and range of loop variable guarantee no invalid enum values to be created */
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         /***************************************************************************/
 | |
|         /* Determine Poll->Listen bit rate */
 | |
|         driMask = (piccBRCapability & RFAL_ISODEP_BRI_MASK);
 | |
|         for(i = 2; i >= 0; i--) /* Check supported bit rate from the highest */
 | |
|         {
 | |
|             if(((driMask & (0x01U << (uint8_t)i)) != 0U) &&
 | |
|                (((uint8_t)i + 1U) <= (uint8_t)curMaxBR)) {
 | |
|                 uint8_t newdri = ((uint8_t)i) + 1U;
 | |
|                 (*dri) = (rfalBitRate)
 | |
|                     newdri; /* PRQA S 4342 # MISRA 10.5 - Layout of enum rfalBitRate and range of loop variable guarantee no invalid enum values to be created */
 | |
|                 break;
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         /***************************************************************************/
 | |
|         /* Check if different bit rate is supported */
 | |
| 
 | |
|         /* Digital 1.0 Table 67: if b8=1b, then only the same bit rate divisor for both directions is supported */
 | |
|         if((piccBRCapability & RFAL_ISODEP_SAME_BITRATE_MASK) != 0U) {
 | |
|             (*dsi) = MIN((*dsi), (*dri));
 | |
|             (*dri) = (*dsi);
 | |
|             /* Check that the baudrate is supported */
 | |
|             if((RFAL_BR_106 != (*dsi)) &&
 | |
|                (!(((dsiMask & (0x10U << ((uint8_t)(*dsi) - 1U))) != 0U) &&
 | |
|                   ((driMask & (0x01U << ((uint8_t)(*dri) - 1U))) != 0U)))) {
 | |
|                 bitrateFound = false;
 | |
|                 curMaxBR =
 | |
|                     (*dsi); /* set allowed bitrate to be lowest and determine bit rate again */
 | |
|             }
 | |
|         }
 | |
|     } while(!(bitrateFound));
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static uint32_t rfalIsoDepSFGI2SFGT(uint8_t sfgi) {
 | |
|     uint32_t sfgt;
 | |
|     uint8_t tmpSFGI;
 | |
| 
 | |
|     tmpSFGI = sfgi;
 | |
| 
 | |
|     if(tmpSFGI > ISODEP_SFGI_MAX) {
 | |
|         tmpSFGI = ISODEP_SFGI_MIN;
 | |
|     }
 | |
| 
 | |
|     if(tmpSFGI != ISODEP_SFGI_MIN) {
 | |
|         /* If sfgi != 0 wait SFGT + dSFGT   Digital 1.1  13.8.2.1 */
 | |
|         sfgt = isoDepCalcSGFT(sfgi) + isoDepCalcdSGFT(sfgi);
 | |
|     }
 | |
|     /* Otherwise use FDTPoll min Digital  1.1  13.8.2.3*/
 | |
|     else {
 | |
|         sfgt = RFAL_FDT_POLL_NFCA_POLLER;
 | |
|     }
 | |
| 
 | |
|     /* Convert carrier cycles to milli seconds */
 | |
|     return (rfalConv1fcToMs(sfgt) + 1U);
 | |
| }
 | |
| 
 | |
| #endif /* RFAL_FEATURE_ISO_DEP_POLL */
 | |
| 
 | |
| /*******************************************************************************/
 | |
| static void rfalIsoDepApdu2IBLockParam(
 | |
|     rfalIsoDepApduTxRxParam apduParam,
 | |
|     rfalIsoDepTxRxParam* iBlockParam,
 | |
|     uint16_t txPos,
 | |
|     uint16_t rxPos) {
 | |
|     NO_WARNING(rxPos); /* Keep this param for future use */
 | |
| 
 | |
|     iBlockParam->DID = apduParam.DID;
 | |
|     iBlockParam->FSx = apduParam.FSx;
 | |
|     iBlockParam->ourFSx = apduParam.ourFSx;
 | |
|     iBlockParam->FWT = apduParam.FWT;
 | |
|     iBlockParam->dFWT = apduParam.dFWT;
 | |
| 
 | |
|     if((apduParam.txBufLen - txPos) > rfalIsoDepGetMaxInfLen()) {
 | |
|         iBlockParam->isTxChaining = true;
 | |
|         iBlockParam->txBufLen = rfalIsoDepGetMaxInfLen();
 | |
|     } else {
 | |
|         iBlockParam->isTxChaining = false;
 | |
|         iBlockParam->txBufLen = (apduParam.txBufLen - txPos);
 | |
|     }
 | |
| 
 | |
|     /* TxBuf is moved to the beginning for every I-Block */
 | |
|     iBlockParam->txBuf =
 | |
|         (rfalIsoDepBufFormat*)apduParam
 | |
|             .txBuf; /*  PRQA S 0310 # MISRA 11.3 - Intentional safe cast to avoiding large buffer duplication */
 | |
|     iBlockParam->rxBuf =
 | |
|         apduParam
 | |
|             .tmpBuf; /* Simply using the apdu buffer is not possible because of current ACK handling */
 | |
|     iBlockParam->isRxChaining = &gIsoDep.isAPDURxChaining;
 | |
|     iBlockParam->rxLen = apduParam.rxLen;
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepStartApduTransceive(rfalIsoDepApduTxRxParam param) {
 | |
|     rfalIsoDepTxRxParam txRxParam;
 | |
| 
 | |
|     /* Initialize and store APDU context */
 | |
|     gIsoDep.APDUParam = param;
 | |
|     gIsoDep.APDUTxPos = 0;
 | |
|     gIsoDep.APDURxPos = 0;
 | |
| 
 | |
|     /* Assign current FSx to calculate INF length (only change the FSx from activation if no to Keep) */
 | |
|     gIsoDep.ourFsx = ((param.ourFSx != RFAL_ISODEP_FSX_KEEP) ? param.ourFSx : gIsoDep.ourFsx);
 | |
|     gIsoDep.fsx = param.FSx;
 | |
| 
 | |
|     /* Convert APDU TxRxParams to I-Block TxRxParams */
 | |
|     rfalIsoDepApdu2IBLockParam(
 | |
|         gIsoDep.APDUParam, &txRxParam, gIsoDep.APDUTxPos, gIsoDep.APDURxPos);
 | |
| 
 | |
|     return rfalIsoDepStartTransceive(txRxParam);
 | |
| }
 | |
| 
 | |
| /*******************************************************************************/
 | |
| ReturnCode rfalIsoDepGetApduTransceiveStatus(void) {
 | |
|     ReturnCode ret;
 | |
|     rfalIsoDepTxRxParam txRxParam;
 | |
| 
 | |
|     ret = rfalIsoDepGetTransceiveStatus();
 | |
|     switch(ret) {
 | |
|     /*******************************************************************************/
 | |
|     case ERR_NONE:
 | |
| 
 | |
|         /* Check if we are still doing chaining on Tx */
 | |
|         if(gIsoDep.isTxChaining) {
 | |
|             /* Add already Tx bytes */
 | |
|             gIsoDep.APDUTxPos += gIsoDep.txBufLen;
 | |
| 
 | |
|             /* Convert APDU TxRxParams to I-Block TxRxParams */
 | |
|             rfalIsoDepApdu2IBLockParam(
 | |
|                 gIsoDep.APDUParam, &txRxParam, gIsoDep.APDUTxPos, gIsoDep.APDURxPos);
 | |
| 
 | |
|             if(txRxParam.txBufLen > 0U) /* MISRA 21.18 */
 | |
|             {
 | |
|                 /* Move next I-Block to beginning of APDU Tx buffer */
 | |
|                 ST_MEMCPY(
 | |
|                     gIsoDep.APDUParam.txBuf->apdu,
 | |
|                     &gIsoDep.APDUParam.txBuf->apdu[gIsoDep.APDUTxPos],
 | |
|                     txRxParam.txBufLen);
 | |
|             }
 | |
| 
 | |
|             EXIT_ON_ERR(ret, rfalIsoDepStartTransceive(txRxParam));
 | |
|             return ERR_BUSY;
 | |
|         }
 | |
| 
 | |
|         /* APDU TxRx is done */
 | |
|         /* fall through */
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     case ERR_AGAIN: /*  PRQA S 2003 # MISRA 16.3 - Intentional fall through */
 | |
| 
 | |
|         /* Check if no APDU transceive has been started before (data from rfalIsoDepListenStartActivation) */
 | |
|         if(gIsoDep.APDUParam.rxLen == NULL) {
 | |
|             if(ret == ERR_AGAIN) {
 | |
|                 /* In Listen mode first chained packet cannot be retrieved via APDU interface */
 | |
|                 return ERR_NOTSUPP;
 | |
|             }
 | |
| 
 | |
|             /* TxRx is complete and full data is already available */
 | |
|             return ERR_NONE;
 | |
|         }
 | |
| 
 | |
|         if(*gIsoDep.APDUParam.rxLen > 0U) /* MISRA 21.18 */
 | |
|         {
 | |
|             /* Ensure that data in tmpBuf still fits into APDU buffer */
 | |
|             if((gIsoDep.APDURxPos + (*gIsoDep.APDUParam.rxLen)) >
 | |
|                (uint16_t)RFAL_FEATURE_ISO_DEP_APDU_MAX_LEN) {
 | |
|                 return ERR_NOMEM;
 | |
|             }
 | |
| 
 | |
|             /* Copy chained packet from tmp buffer to APDU buffer */
 | |
|             ST_MEMCPY(
 | |
|                 &gIsoDep.APDUParam.rxBuf->apdu[gIsoDep.APDURxPos],
 | |
|                 gIsoDep.APDUParam.tmpBuf->inf,
 | |
|                 *gIsoDep.APDUParam.rxLen);
 | |
|             gIsoDep.APDURxPos += *gIsoDep.APDUParam.rxLen;
 | |
|         }
 | |
| 
 | |
|         /* Update output param rxLen */
 | |
|         *gIsoDep.APDUParam.rxLen = gIsoDep.APDURxPos;
 | |
| 
 | |
|         /* Wait for following I-Block or APDU TxRx has finished */
 | |
|         return ((ret == ERR_AGAIN) ? ERR_BUSY : ERR_NONE);
 | |
| 
 | |
|     /*******************************************************************************/
 | |
|     default:
 | |
|         /* MISRA 16.4: no empty default statement (a comment being enough) */
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| #endif /* RFAL_FEATURE_ISO_DEP */
 |