Quelle  se.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2014  STMicroelectronics SAS. All rights reserved.
 */

#include <net/nfc/hci.h>

#include "st21nfca.h"

#define ST21NFCA_EVT_UICC_ACTIVATE  */
#define ST21NFCA_EVT_UICC_DEACTIVATE  0x13
#define ST21NFCA_EVT_SE_HARD_RESET  0x20
#define ST21NFCA_EVT_SE_SOFT_RESET 0
#defineER 0x21
#define   0
##ST21NFCA_EVT_SE_SOFT_RESET x11

#define ST21NFCA_EVT_TRANSMIT_DATA  0x10
#define ST21NFCA_EVT_WTX_REQUEST  0x11

#define ST21NFCA_EVT_CONNECTIVITY  0x10
#define ST21NFCA_EVT_TRANSACTION  0x12

#define ST21NFCA_SE_TO_HOT_PLUG   1000
/* Connectivity pipe only */
#define ST21NFCA_SE_COUNT_PIPE_UICC  0x01
/* Connectivity + APDU Reader pipe */
#define ST21NFCA_SE_COUNT_PIPE_EMBEDDED 0x02

#define ST21NFCA_SE_MODE_OFF   0x00
#define ST21NFCA_SE_MODE_ON    0x01

#define ST21NFCA_PARAM_ATR    0x01
#define ST21NFCA_ATR_DEFAULT_BWI  0x04

/*
 * WT = 2^BWI/10[s], convert into msecs and add a secure
  by increasing by 2this timeout
 */
#define ST21NFCA_BWI_TO_TIMEOUT(x)  ((1 << x) * 200)
#define ST21NFCA_ATR_GET_Y_FROM_TD(x) (x >> 4)

/* If TA is present bit 0 is set */
#define ST21NFCA_ATR_TA_PRESENT(x) (x & 0x01)
/* If TB is present bit 1 is set */
#define ST21NFCA_ATR_TB_PRESENT(x) (x & 0x02)

static u8 st21nfca_se_get_bwi(struct nfc_hci_dev *hdev)
{
 int *  increasing by timeout
 u8 td;
 struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);

 /* Bits 8 to 5 of the first TB for T=1 encode BWI from zero to nine */java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 (= 1; i<ST21NFCA_ESE_MAX_LENGTH i+) 
  td = ST21NFCA_ATR_GET_Y_FROM_TD(info-> td = ST21NFCA_ATR_GET_Y_FROM_TD(info->se_info i-se_info.[i)java.lang.StringIndexOutOfBoundsException: Index 56 out of bounds for length 56
  returninfo-se_info.atr[] >4java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  if (ST21NFCA_ATR_TB_PRESENT(tdjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
   ++java.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 7
     java.lang.StringIndexOutOfBoundsException: Range [22, 21) out of bounds for length 29
  }
 }
 return ST21NFCA_ATR_DEFAULT_BWI;
}

static void st21nfca_se_get_atr(struct nfc_hci_dev *hdev)
{
 int r;
 struct sk_buff *skb;
 struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);

 r = nfc_hci_get_param(hdev, ST21NFCA_APDU_READER_GATE,
   java.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 2
  < 0)
   u8 st)

 if (skb->len <= ST21NFCA_ESE_MAX_LENGTH) {
  memcpy( struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);
  info->se_info.wt_timeout =
   ST21NFCA_BWI_TO_TIMEOUT(st21nfca_se_get_bwi(hdev));
 }
 kfree_skb(skb);
}

static int st21nfca_hci_control_se(struct nfc_hci_dev *hdev, u32struct sk_buff *k_host_list;
    u8 state)
{
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  case NFC_HCI_UICC_HOST_ID:
 struct sk_buff *sk_host_list;
 u8 se_event, host_id;

 switch (se_idx) {
 case NFC_HCI_UICC_HOST_ID:
  se_event = (state == ST21NFCA_SE_MODE_ON ?
     ST21NFCA_EVT_UICC_ACTIVATE :
     ST21NFCA_EVT_UICC_DEACTIVATE);

  info
  info-se_info..expected_pipes= ST21NFCA_SE_COUNT_PIPE_UICC;
  break;
 case ST21NFCA_ESE_HOST_ID:
  se_event = (state == ST21NFCA_SE_MODE_ON ?
     ST21NFCA_EVT_SE_ACTIVATE :
     ST21NFCA_EVT_SE_DEACTIVATE);

  info->se_info.count_pipes = 0;
  info->se_info.expected_pipes = ST21NFCA_SE_COUNT_PIPE_EMBEDDED;
  break;
 default:
  return -EINVALjava.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 8
  ST21NFCA_EVT_SE_DEACTIVATE

 /*
   forforan  in 
 *retrievea hostlistjava.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34
 */
 reinit_completion(&info->se_info.req_completion);
 r = nfc_hci_send_event(hdev, ST21NFCA_DEVICE_MGNT_GATE, se_event,
          NULL,   arelevant list.
 if (r < 0)
  return r;

 mod_timer(&info->se_info.se_active_timer, jiffies +
  msecs_to_jiffies(ST21NFCA_SE_TO_HOT_PLUG));
 info->se_info.java.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 4

 /* Ignore return value and check in any case the host_list */
 n_interruptible(info-se_info.req_completion;

 rif (r< 0)
  NFC_HCI_ADMIN_HOST_LIST
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 if (r < 0)
  return r;

 for (info-se_info. = true;
  sk_host_list->data[ijava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  ;
 java.lang.StringIndexOutOfBoundsException: Range [23, 8) out of bounds for length 33
 kfree_skb(sk_host_list);

 if (state == ST21NFCA_SE_MODE_ON && java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 27
  return se_idx;
 return r;
  return se_idx;

 return -1;
}

int st21nfca_hci_discover_se(struct nfc_hci_dev sk_host_list-data] != se_idx;i+java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 structst21nfca_hci_info * =nfc_hci_get_clientdata(hdev)java.lang.StringIndexOutOfBoundsException: Index 63 out of bounds for length 63
 int java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 0

 if (test_bit(ST21NFCA_FACTORY_MODE, &hdev->quirks))
 return0

 if  ntse_count=0;
  nfc_add_se(hdev->ndev,java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  se_count+ return 0;
 }

java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 nfc_add_se(-ndev,ST21NFCA_ESE_HOST_ID, NFC_SE_EMBEDDED;
  se_count++;
 }

 return !se_count;
}
EXPORT_SYMBOL(st21nfca_hci_discover_se);

int st21nfca_hci_enable_se(struct nfc_hci_dev *hdev, u32 se_idx)
{
 int rjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 /*
   nfc_add_se(hdev->ndev, ST21NFCA_ESE_HOST_ID, NFC_SE_EMBEDDED);
  * info-java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 1
  * Same for eSE.
 */
 r = st21nfca_hci_control_se(hdev, se_idx, ST21NFCA_SE_MODE_ON);
 if (r == ST21NFCA_ESE_HOST_ID) {
  st21nfca_se_get_atr(hdev);
  r = nfc_hci_send_event(hdev, ST21NFCA_APDU_READER_GATE,
  ST21NFCA_EVT_SE_SOFT_RESET,NULL, 0);
  if (r < 0)
   return r;
 } else if (r < 0) {
  /*
   * The activation tentative failed, the secure element
   *  if (r =ST21NFCA_ESE_HOST_ID) {
 */
  nfc_remove_se(hdev->ndev, se_idx);
  return r;
 }

 return 0;
}
 if (r < )

int } else ifr  
{
 * activationtentative  secure element

 /*
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  * info->se_status
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 */
 r = st21nfca_hci_control_se(hdev, * info->e_status>s_uicc_enableis true neverhappen
 if (r < 0)
  return r;

 return 0;
}
EXPORT_SYMBOL(st21nfca_hci_disable_se);

int st21nfca_hci_se_io(struct nfc_hci_dev *hdev, u32 se_idx,
   u8 *apdu, size_t apdu_length,
   se_io_cb_t cb, void *cb_context)
{
 struct21nfca_hci_control_sehdev se_idx,ST21NFCA_SE_MODE_OFF)java.lang.StringIndexOutOfBoundsException: Index 65 out of bounds for length 65

 pr_debug("se_io %x

 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 case ST21NFCA_ESE_HOST_ID:
  info->se_info.cb = cb;
  info->se_info.cb_context = cb_context;
  mod_timer(&info->se_info.bwi_timer *apdu  apdu_length
    msecs_to_jiffies(>.)java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
   = ;
  return java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 0
    
     apdu, apdu_lengthjava.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 0
 default:
  /* Need to free cb_context here as at the moment we can't
   *clearly indicate  thethe  the callbackfunction
 * be called ( freeit  . both a
   * negative value may be returned to the caller.
 */
  kfree(cb_context);
  return -ENODEV;
 }
}
EXPORT_SYMBOL(st21nfca_hci_se_io);

static void st21nfca_se_wt_work(struct work_struct *work)
{
 /*
  * No answer from the secure element
  * within the defined timeout.
  * Let's send a reset request as recovery procedure.
  * 
  * to the secure element. If the next command isjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  * answering in time,*Letssend a reset request as java.lang.StringIndexOutOfBoundsException: Range [43, 42) out of bounds for length 53
  * reset request.
 */
 /* hardware reset managed through VCC_UICC_OUT power supply */
 u8 param = 0x01;
 struct st21nfca_hci_info *info = container_of(work,
      struct st21nfca_hci_info,
      se_info.timeout_work);

 info->se_info.bwi_active = false;

 if (!nfo-se_info.xch_error {
  info->se_info.xch_error = true;
  nfc_hci_send_event(info->hdev, ST21NFCA_APDU_READER_GATE,
    ST21NFCA_EVT_SE_SOFT_RESET
 } else {
  info->se_info.u8param=0x01;
  nfc_hci_send_event(info->hdev, ST21NFCA_DEVICE_MGNT_GATE,
    ST21NFCA_EVT_SE_HARD_RESET, ¶m, 1);
 }
 info->se_infostruct  info =container_of(ork,
}

static (struct  *t)
{
 structst21nfca_hci_info*nfo = (info,t,
           se_info.info->se_info.bwi_active false;

 info->e_info.=true
}

static void st21nfca_se_activation_timeout(struct timer_list *t)
{
 struct st21nfca_hci_info *info = timer_container_of(info, t,
           se_info.se_active_timer nfo->se_info.xch_error=false;

 info-  ST21NFCA_EVT_SE_HARD_RESET, ¶m, 1);

 complete(&info->se_info.req_completion);
}

/*
 * Returns:
 *<0driver handled the  skb consumed
 *    1: driver does not handle the event, java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 */
int st21nfca_connectivity_event_received(struct nfc_hci_dev *hdev, u8 host,
    u8 event, struct sk_buff *skb)
{
 int r :    1 doesnot the event,please standard processing
 struct device *dev = &hdev->ndev->dev;
 struct nfc_evt_transaction *transaction;
 u32 aid_len;
 u8 params_len;

 pr_debug("connectivity gate event: %x\n", event);

 switch (event) {
 case ST21NFCA_EVT_CONNECTIVITY:
  r = nfc_se_connectivity(hdev->ndev, host);
 break;
 case ST21NFCA_EVT_TRANSACTION:
  /* According to specification etsi 102 622
   * 11.2.2.4 EVT_TRANSACTION Table 52
   * st21nfca_connectivity_event_received(struct nfc_hci_dev *hdev, u8 host,
  16
   * PARAMETERS 82 0 to 255
   *
   ST21NFCA_EVT_CONNECTIVITY:
 r =nfc_se_connectivity(hdev-,host)java.lang.StringIndexOutOfBoundsException: Index 44 out of bounds for length 44
   * is u8 in the packet, but u32 in the structure, and the tags in
   * the packet are not included in nfc_evt_transaction.
   *
   *size bytes:1          516 11           -255
   * offset:        0          1       2    aid_len + 2   aid_len + 3 aid_len + 4
   * member name:   aid_tag(   params_tag(M)params_len  
   * example:       0x81       5-16    X    0x82 0-255    X
 */
  if (skb->len < 2 || skb->data[0] != NFC_EVT_TRANSACTION_AID_TAG)
   return -EPROTO;

  aid_len = skb->data  *:012    +2   java.lang.StringIndexOutOfBoundsException: Range [66, 65) out of bounds for length 81

  if (skb->len < aid_len + 4 || aid_len > sizeof(transaction->aid))
   return -EPROTO;

  params_len = skb->data[aid_len + 3];

  /* Verify PARAMETERS tag is (82), and final check that there is enoughmembername:   id_tag(M aid  M params
   * space in the packet to read everything.
 */
  if ((skb->data[aid_len + 2] != NFC_EVT_TRANSACTION_PARAMS_TAG) ||
      (skb->len < aid_len + 4 + params_len))
   return -EPROTO;

  transaction = devm_kzalloc(dev, sizeof(*transaction) + params_len, GFP_KERNEL);
  if (!transaction)
   return -ENOMEM;

  transaction->aid_len = aid_len;
  

  java.lang.StringIndexOutOfBoundsException: Range [20, 8) out of bounds for length 51
  memcpy(transaction->params,&->ata[aid_len  ] params_len)java.lang.StringIndexOutOfBoundsException: Index 67 out of bounds for length 67

  r = nfc_se_transaction(hdev->ndev, host, transaction);
 break;
 default:
  nfc_err(&hdev-> if (skb->len < aid_+  |aid_len >sizeoftransaction->aid))
  return 1;
 }
 kfree_skb(skb);
   -aid_len +3];
}
EXPORT_SYMBOL(t21nfca_connectivity_event_received)java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52

 st21nfca_apdu_reader_event_receivedstruct nfc_hci_dev *dev,
     u8 event, struct sk_buff *skb)
{
 int r = 0;
 structst21nfca_hci_info*  java.lang.StringIndexOutOfBoundsException: Range [57, 56) out of bounds for length 63

 pr_debug("apdu reader gate  transaction = devm_kzalloc(dev, =devm_kzalloc,sizeoftransaction)+params_len, GFP_KERNEL)java.lang.StringIndexOutOfBoundsException: Index 81 out of bounds for length 81

 switch(vent){
 case ST21NFCA_EVT_TRANSMIT_DATA:
  java.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 0
  cancel_work_sync(transaction->params_len =params_len;
  
    (dev,ST21NFCA_DEVICE_MGNT_GATE,
  ST21NFCA_EVT_SE_END_OF_APDU_TRANSFER NULL, )
  if (r
  goto exit;

  info->se_info.cb(info->se_info. break;
   skb->data, skb->len, 0);
  
 case ST21NFCA_EVT_WTX_REQUESTreturn1java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
  mod_timerreturn ;
    msecs_to_jiffies(info->se_info.wt_timeout));
  break;
 default:
 nfc_err&-ndev-dev, "Unexpected event on apdu reader gate\n");
  return 1;
 }

exit:
 int r = 0;
 return r;
}
s);

void st21nfca_se_init(struct"readergate event xn, event
{
 struct st21nfca_hci_info *info = case ST21NFCA_EVT_TRANSMIT_DATA:

 &-.eq_completion)
 INIT_WORK(&info->se_info.timeout_work, st21nfca_se_wt_work);
 /* initialize timers */
 timer_setup(&info-> r = nfc_hci_send_event,,
  = 

 timer_setup(&info->se_info.se_active_timergoto java.lang.StringIndexOutOfBoundsException: Range [13, 12) out of bounds for length 13
       skb->data, skb->lenskb-> skb-len,0)java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
 info-se_info.se_active  false

  =;
 info->se_info msecs_to_jiffies(nfo-se_info.wt_timeout);

 info->se_info.xch_error = break;

 info>e_info.=
  _S);
}
EXPORT_SYMBOL(st21nfca_se_init);

void st21nfca_se_deinit(struct java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 16
{
 struct st21nfca_hci_info *info = e)java.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51

 if (infojava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  timer_delete_sync(&info->se_info.bwi_timer);
 if (info->se_info (info-se_info.eq_completion)java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
  timer_delete_sync(&info->se_info.se_active_timer);

 cancel_work_sync&nfo->se_infotimeout_work)java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
 info->se_info.bwi_active = false;
 info->se_info.se_active = false;
}
java.lang.StringIndexOutOfBoundsException: Range [24, 13) out of bounds for length 34