^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * NFC Digital Protocol stack
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (c) 2013, Intel Corporation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #define pr_fmt(fmt) "digital: %s: " fmt, __func__
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include "digital.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #define DIGITAL_CMD_SENS_REQ 0x26
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #define DIGITAL_CMD_ALL_REQ 0x52
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #define DIGITAL_CMD_SEL_REQ_CL1 0x93
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #define DIGITAL_CMD_SEL_REQ_CL2 0x95
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #define DIGITAL_CMD_SEL_REQ_CL3 0x97
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #define DIGITAL_SDD_REQ_SEL_PAR 0x20
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define DIGITAL_SDD_RES_CT 0x88
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define DIGITAL_SDD_RES_LEN 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define DIGITAL_SEL_RES_LEN 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define DIGITAL_SEL_RES_NFCID1_COMPLETE(sel_res) (!((sel_res) & 0x04))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define DIGITAL_SEL_RES_IS_T2T(sel_res) (!((sel_res) & 0x60))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define DIGITAL_SEL_RES_IS_T4T(sel_res) ((sel_res) & 0x20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define DIGITAL_SEL_RES_IS_NFC_DEP(sel_res) ((sel_res) & 0x40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define DIGITAL_SENS_RES_IS_T1T(sens_res) (((sens_res) & 0x0C00) == 0x0C00)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define DIGITAL_SENS_RES_IS_VALID(sens_res) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) ((!((sens_res) & 0x001F) && (((sens_res) & 0x0C00) == 0x0C00)) || \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) (((sens_res) & 0x001F) && ((sens_res) & 0x0C00) != 0x0C00))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define DIGITAL_MIFARE_READ_RES_LEN 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define DIGITAL_MIFARE_ACK_RES 0x0A
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define DIGITAL_CMD_SENSB_REQ 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define DIGITAL_SENSB_ADVANCED BIT(5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define DIGITAL_SENSB_EXTENDED BIT(4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define DIGITAL_SENSB_ALLB_REQ BIT(3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define DIGITAL_SENSB_N(n) ((n) & 0x7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define DIGITAL_CMD_SENSB_RES 0x50
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define DIGITAL_CMD_ATTRIB_REQ 0x1D
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define DIGITAL_ATTRIB_P1_TR0_DEFAULT (0x0 << 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define DIGITAL_ATTRIB_P1_TR1_DEFAULT (0x0 << 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define DIGITAL_ATTRIB_P1_SUPRESS_EOS BIT(3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define DIGITAL_ATTRIB_P1_SUPRESS_SOS BIT(2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define DIGITAL_ATTRIB_P2_LISTEN_POLL_1 (0x0 << 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) #define DIGITAL_ATTRIB_P2_POLL_LISTEN_1 (0x0 << 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define DIGITAL_ATTRIB_P2_MAX_FRAME_256 0x8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define DIGITAL_ATTRIB_P4_DID(n) ((n) & 0xf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) #define DIGITAL_CMD_SENSF_REQ 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) #define DIGITAL_CMD_SENSF_RES 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) #define DIGITAL_SENSF_RES_MIN_LENGTH 17
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) #define DIGITAL_SENSF_RES_RD_AP_B1 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) #define DIGITAL_SENSF_RES_RD_AP_B2 0x8F
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) #define DIGITAL_SENSF_REQ_RC_NONE 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) #define DIGITAL_SENSF_REQ_RC_SC 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) #define DIGITAL_SENSF_REQ_RC_AP 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) #define DIGITAL_CMD_ISO15693_INVENTORY_REQ 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) #define DIGITAL_ISO15693_REQ_FLAG_DATA_RATE BIT(1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) #define DIGITAL_ISO15693_REQ_FLAG_INVENTORY BIT(2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) #define DIGITAL_ISO15693_REQ_FLAG_NB_SLOTS BIT(5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) #define DIGITAL_ISO15693_RES_FLAG_ERROR BIT(0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) #define DIGITAL_ISO15693_RES_IS_VALID(flags) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) (!((flags) & DIGITAL_ISO15693_RES_FLAG_ERROR))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) #define DIGITAL_ISO_DEP_I_PCB 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) #define DIGITAL_ISO_DEP_PNI(pni) ((pni) & 0x01)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) #define DIGITAL_ISO_DEP_PCB_TYPE(pcb) ((pcb) & 0xC0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) #define DIGITAL_ISO_DEP_I_BLOCK 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) #define DIGITAL_ISO_DEP_BLOCK_HAS_DID(pcb) ((pcb) & 0x08)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) static const u8 digital_ats_fsc[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 16, 24, 32, 40, 48, 64, 96, 128,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) #define DIGITAL_ATS_FSCI(t0) ((t0) & 0x0F)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) #define DIGITAL_SENSB_FSCI(pi2) (((pi2) & 0xF0) >> 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) #define DIGITAL_ATS_MAX_FSC 256
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) #define DIGITAL_RATS_BYTE1 0xE0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) #define DIGITAL_RATS_PARAM 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) struct digital_sdd_res {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) u8 nfcid1[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) u8 bcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) struct digital_sel_req {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) u8 sel_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) u8 b2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) u8 nfcid1[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) u8 bcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) struct digital_sensb_req {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) u8 afi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) u8 param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) struct digital_sensb_res {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) u8 nfcid0[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) u8 app_data[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) u8 proto_info[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) struct digital_attrib_req {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) u8 nfcid0[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) u8 param1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) u8 param2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) u8 param3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) u8 param4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) struct digital_attrib_res {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) u8 mbli_did;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) struct digital_sensf_req {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) u8 sc1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) u8 sc2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) u8 rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) u8 tsn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) struct digital_sensf_res {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) u8 nfcid2[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) u8 pad0[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) u8 pad1[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) u8 mrti_check;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) u8 mrti_update;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) u8 pad2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) u8 rd[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) struct digital_iso15693_inv_req {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) u8 flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) u8 mask_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) u64 mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) struct digital_iso15693_inv_res {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) u8 flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) u8 dsfid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) u64 uid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) static int digital_in_send_sdd_req(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) struct nfc_target *target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) int digital_in_iso_dep_pull_sod(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) u8 pcb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) u8 block_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) if (skb->len < 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) pcb = *skb->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) block_type = DIGITAL_ISO_DEP_PCB_TYPE(pcb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) /* No support fo R-block nor S-block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) if (block_type != DIGITAL_ISO_DEP_I_BLOCK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) pr_err("ISO_DEP R-block and S-block not supported\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) if (DIGITAL_ISO_DEP_BLOCK_HAS_DID(pcb)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) pr_err("DID field in ISO_DEP PCB not supported\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) skb_pull(skb, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) int digital_in_iso_dep_push_sod(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) * Chaining not supported so skb->len + 1 PCB byte + 2 CRC bytes must
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) * not be greater than remote FSC
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) if (skb->len + 3 > ddev->target_fsc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) skb_push(skb, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) *skb->data = DIGITAL_ISO_DEP_I_PCB | ddev->curr_nfc_dep_pni;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) ddev->curr_nfc_dep_pni =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) DIGITAL_ISO_DEP_PNI(ddev->curr_nfc_dep_pni + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) static void digital_in_recv_ats(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) struct nfc_target *target = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) u8 fsdi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) if (resp->len < 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) fsdi = DIGITAL_ATS_FSCI(resp->data[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) if (fsdi >= 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) ddev->target_fsc = DIGITAL_ATS_MAX_FSC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) ddev->target_fsc = digital_ats_fsc[fsdi];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) ddev->curr_nfc_dep_pni = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) rc = digital_target_found(ddev, target, NFC_PROTO_ISO14443);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) kfree(target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) static int digital_in_send_rats(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) struct nfc_target *target)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) skb = digital_skb_alloc(ddev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) skb_put_u8(skb, DIGITAL_RATS_BYTE1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) skb_put_u8(skb, DIGITAL_RATS_PARAM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_ats,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) static void digital_in_recv_sel_res(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) struct nfc_target *target = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) u8 sel_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) u8 nfc_proto;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) if (!DIGITAL_DRV_CAPS_IN_CRC(ddev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) rc = digital_skb_check_crc_a(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) PROTOCOL_ERR("4.4.1.3");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) if (resp->len != DIGITAL_SEL_RES_LEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) sel_res = resp->data[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (!DIGITAL_SEL_RES_NFCID1_COMPLETE(sel_res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) rc = digital_in_send_sdd_req(ddev, target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) goto exit_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) target->sel_res = sel_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) if (DIGITAL_SEL_RES_IS_T2T(sel_res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) nfc_proto = NFC_PROTO_MIFARE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) } else if (DIGITAL_SEL_RES_IS_NFC_DEP(sel_res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) nfc_proto = NFC_PROTO_NFC_DEP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) } else if (DIGITAL_SEL_RES_IS_T4T(sel_res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) rc = digital_in_send_rats(ddev, target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) * Skip target_found and don't free it for now. This will be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) * done when receiving the ATS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) goto exit_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) rc = -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) rc = digital_target_found(ddev, target, nfc_proto);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) kfree(target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) exit_free_skb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) static int digital_in_send_sel_req(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) struct nfc_target *target,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) struct digital_sdd_res *sdd_res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) struct digital_sel_req *sel_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) u8 sel_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) skb = digital_skb_alloc(ddev, sizeof(struct digital_sel_req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) skb_put(skb, sizeof(struct digital_sel_req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) sel_req = (struct digital_sel_req *)skb->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) if (target->nfcid1_len <= 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) sel_cmd = DIGITAL_CMD_SEL_REQ_CL1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) else if (target->nfcid1_len < 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) sel_cmd = DIGITAL_CMD_SEL_REQ_CL2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) sel_cmd = DIGITAL_CMD_SEL_REQ_CL3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) sel_req->sel_cmd = sel_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) sel_req->b2 = 0x70;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) memcpy(sel_req->nfcid1, sdd_res->nfcid1, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) sel_req->bcc = sdd_res->bcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) if (DIGITAL_DRV_CAPS_IN_CRC(ddev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) NFC_DIGITAL_FRAMING_NFCA_STANDARD_WITH_CRC_A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) digital_skb_add_crc_a(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sel_res,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) static void digital_in_recv_sdd_res(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) struct nfc_target *target = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) struct digital_sdd_res *sdd_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) u8 offset, size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) u8 i, bcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) if (resp->len < DIGITAL_SDD_RES_LEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) PROTOCOL_ERR("4.7.2.8");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) sdd_res = (struct digital_sdd_res *)resp->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) for (i = 0, bcc = 0; i < 4; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) bcc ^= sdd_res->nfcid1[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) if (bcc != sdd_res->bcc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) PROTOCOL_ERR("4.7.2.6");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) if (sdd_res->nfcid1[0] == DIGITAL_SDD_RES_CT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) offset = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) size = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) size = 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) memcpy(target->nfcid1 + target->nfcid1_len, sdd_res->nfcid1 + offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) target->nfcid1_len += size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) rc = digital_in_send_sel_req(ddev, target, sdd_res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) kfree(target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) static int digital_in_send_sdd_req(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) struct nfc_target *target)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) u8 sel_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) NFC_DIGITAL_FRAMING_NFCA_STANDARD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) skb = digital_skb_alloc(ddev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) if (target->nfcid1_len == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) sel_cmd = DIGITAL_CMD_SEL_REQ_CL1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) else if (target->nfcid1_len == 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) sel_cmd = DIGITAL_CMD_SEL_REQ_CL2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) sel_cmd = DIGITAL_CMD_SEL_REQ_CL3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) skb_put_u8(skb, sel_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) skb_put_u8(skb, DIGITAL_SDD_REQ_SEL_PAR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sdd_res,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) static void digital_in_recv_sens_res(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) struct nfc_target *target = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) if (resp->len < sizeof(u16)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) target = kzalloc(sizeof(struct nfc_target), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) if (!target) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) target->sens_res = __le16_to_cpu(*(__le16 *)resp->data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) if (!DIGITAL_SENS_RES_IS_VALID(target->sens_res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) PROTOCOL_ERR("4.6.3.3");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) if (DIGITAL_SENS_RES_IS_T1T(target->sens_res))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) rc = digital_target_found(ddev, target, NFC_PROTO_JEWEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) rc = digital_in_send_sdd_req(ddev, target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) kfree(target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) int digital_in_send_sens_req(struct nfc_digital_dev *ddev, u8 rf_tech)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) NFC_DIGITAL_RF_TECH_106A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) NFC_DIGITAL_FRAMING_NFCA_SHORT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) skb = digital_skb_alloc(ddev, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) skb_put_u8(skb, DIGITAL_CMD_SENS_REQ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sens_res, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) int digital_in_recv_mifare_res(struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) /* Successful READ command response is 16 data bytes + 2 CRC bytes long.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) * Since the driver can't differentiate a ACK/NACK response from a valid
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) * READ response, the CRC calculation must be handled at digital level
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) * even if the driver supports it for this technology.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) if (resp->len == DIGITAL_MIFARE_READ_RES_LEN + DIGITAL_CRC_LEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) if (digital_skb_check_crc_a(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) PROTOCOL_ERR("9.4.1.2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) /* ACK response (i.e. successful WRITE). */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) if (resp->len == 1 && resp->data[0] == DIGITAL_MIFARE_ACK_RES) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) resp->data[0] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) /* NACK and any other responses are treated as error. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) static void digital_in_recv_attrib_res(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) struct nfc_target *target = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) struct digital_attrib_res *attrib_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) if (resp->len < sizeof(*attrib_res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) PROTOCOL_ERR("12.6.2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) attrib_res = (struct digital_attrib_res *)resp->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) if (attrib_res->mbli_did & 0x0f) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) PROTOCOL_ERR("12.6.2.1");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) rc = digital_target_found(ddev, target, NFC_PROTO_ISO14443_B);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) kfree(target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) static int digital_in_send_attrib_req(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) struct nfc_target *target,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) struct digital_sensb_res *sensb_res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) struct digital_attrib_req *attrib_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) skb = digital_skb_alloc(ddev, sizeof(*attrib_req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) attrib_req = skb_put(skb, sizeof(*attrib_req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) attrib_req->cmd = DIGITAL_CMD_ATTRIB_REQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) memcpy(attrib_req->nfcid0, sensb_res->nfcid0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) sizeof(attrib_req->nfcid0));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) attrib_req->param1 = DIGITAL_ATTRIB_P1_TR0_DEFAULT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) DIGITAL_ATTRIB_P1_TR1_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) attrib_req->param2 = DIGITAL_ATTRIB_P2_LISTEN_POLL_1 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) DIGITAL_ATTRIB_P2_POLL_LISTEN_1 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) DIGITAL_ATTRIB_P2_MAX_FRAME_256;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) attrib_req->param3 = sensb_res->proto_info[1] & 0x07;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) attrib_req->param4 = DIGITAL_ATTRIB_P4_DID(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_attrib_res,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) static void digital_in_recv_sensb_res(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) struct nfc_target *target = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) struct digital_sensb_res *sensb_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) u8 fsci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) if (resp->len != sizeof(*sensb_res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) PROTOCOL_ERR("5.6.2.1");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) sensb_res = (struct digital_sensb_res *)resp->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) if (sensb_res->cmd != DIGITAL_CMD_SENSB_RES) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) PROTOCOL_ERR("5.6.2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) if (!(sensb_res->proto_info[1] & BIT(0))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) PROTOCOL_ERR("5.6.2.12");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) if (sensb_res->proto_info[1] & BIT(3)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) PROTOCOL_ERR("5.6.2.16");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) fsci = DIGITAL_SENSB_FSCI(sensb_res->proto_info[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) if (fsci >= 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) ddev->target_fsc = DIGITAL_ATS_MAX_FSC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) ddev->target_fsc = digital_ats_fsc[fsci];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) target = kzalloc(sizeof(struct nfc_target), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) if (!target) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) rc = digital_in_send_attrib_req(ddev, target, sensb_res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) kfree(target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) int digital_in_send_sensb_req(struct nfc_digital_dev *ddev, u8 rf_tech)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) struct digital_sensb_req *sensb_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) NFC_DIGITAL_RF_TECH_106B);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) NFC_DIGITAL_FRAMING_NFCB);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) skb = digital_skb_alloc(ddev, sizeof(*sensb_req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) sensb_req = skb_put(skb, sizeof(*sensb_req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) sensb_req->cmd = DIGITAL_CMD_SENSB_REQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) sensb_req->afi = 0x00; /* All families and sub-families */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) sensb_req->param = DIGITAL_SENSB_N(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sensb_res,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) static void digital_in_recv_sensf_res(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) u8 proto;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) struct nfc_target target;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) struct digital_sensf_res *sensf_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) if (resp->len < DIGITAL_SENSF_RES_MIN_LENGTH) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) if (!DIGITAL_DRV_CAPS_IN_CRC(ddev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) rc = digital_skb_check_crc_f(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) PROTOCOL_ERR("6.4.1.8");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) skb_pull(resp, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) memset(&target, 0, sizeof(struct nfc_target));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) sensf_res = (struct digital_sensf_res *)resp->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) memcpy(target.sensf_res, sensf_res, resp->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) target.sensf_res_len = resp->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) memcpy(target.nfcid2, sensf_res->nfcid2, NFC_NFCID2_MAXSIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) target.nfcid2_len = NFC_NFCID2_MAXSIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) if (target.nfcid2[0] == DIGITAL_SENSF_NFCID2_NFC_DEP_B1 &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) target.nfcid2[1] == DIGITAL_SENSF_NFCID2_NFC_DEP_B2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) proto = NFC_PROTO_NFC_DEP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) proto = NFC_PROTO_FELICA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) rc = digital_target_found(ddev, &target, proto);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) int digital_in_send_sensf_req(struct nfc_digital_dev *ddev, u8 rf_tech)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) struct digital_sensf_req *sensf_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) u8 size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) NFC_DIGITAL_FRAMING_NFCF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) size = sizeof(struct digital_sensf_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) skb = digital_skb_alloc(ddev, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) skb_put(skb, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) sensf_req = (struct digital_sensf_req *)skb->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) sensf_req->cmd = DIGITAL_CMD_SENSF_REQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) sensf_req->sc1 = 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) sensf_req->sc2 = 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) sensf_req->rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) sensf_req->tsn = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) *(u8 *)skb_push(skb, 1) = size + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) if (!DIGITAL_DRV_CAPS_IN_CRC(ddev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) digital_skb_add_crc_f(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sensf_res,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) static void digital_in_recv_iso15693_inv_res(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) void *arg, struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) struct digital_iso15693_inv_res *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) struct nfc_target *target = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) goto out_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) if (resp->len != sizeof(*res)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) rc = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) goto out_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) res = (struct digital_iso15693_inv_res *)resp->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) if (!DIGITAL_ISO15693_RES_IS_VALID(res->flags)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) PROTOCOL_ERR("ISO15693 - 10.3.1");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) goto out_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) target = kzalloc(sizeof(*target), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867) if (!target) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) goto out_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) target->is_iso15693 = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) target->iso15693_dsfid = res->dsfid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) memcpy(target->iso15693_uid, &res->uid, sizeof(target->iso15693_uid));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) rc = digital_target_found(ddev, target, NFC_PROTO_ISO15693);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) kfree(target);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) out_free_skb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) int digital_in_send_iso15693_inv_req(struct nfc_digital_dev *ddev, u8 rf_tech)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889) struct digital_iso15693_inv_req *req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) NFC_DIGITAL_RF_TECH_ISO15693);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) NFC_DIGITAL_FRAMING_ISO15693_INVENTORY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903) skb = digital_skb_alloc(ddev, sizeof(*req));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) skb_put(skb, sizeof(*req) - sizeof(req->mask)); /* No mask */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) req = (struct digital_iso15693_inv_req *)skb->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) /* Single sub-carrier, high data rate, no AFI, single slot
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) * Inventory command
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) req->flags = DIGITAL_ISO15693_REQ_FLAG_DATA_RATE |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) DIGITAL_ISO15693_REQ_FLAG_INVENTORY |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915) DIGITAL_ISO15693_REQ_FLAG_NB_SLOTS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) req->cmd = DIGITAL_CMD_ISO15693_INVENTORY_REQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917) req->mask_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) rc = digital_in_send_cmd(ddev, skb, 30,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920) digital_in_recv_iso15693_inv_res, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) static int digital_tg_send_sel_res(struct nfc_digital_dev *ddev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932) skb = digital_skb_alloc(ddev, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936) skb_put_u8(skb, DIGITAL_SEL_RES_NFC_DEP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938) if (!DIGITAL_DRV_CAPS_TG_CRC(ddev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939) digital_skb_add_crc_a(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941) rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) NFC_DIGITAL_FRAMING_NFCA_ANTICOL_COMPLETE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948) rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_atr_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 956) static void digital_tg_recv_sel_req(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 957) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 958) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 959) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 960)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 961) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 962) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 963) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 964) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 965) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 966)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 967) if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 968) rc = digital_skb_check_crc_a(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 969) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 970) PROTOCOL_ERR("4.4.1.3");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 971) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 972) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 973) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 974)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 975) /* Silently ignore SEL_REQ content and send a SEL_RES for NFC-DEP */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 976)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 977) rc = digital_tg_send_sel_res(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 978)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 979) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 980) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 981) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 982)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 983) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 984) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 985)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 986) static int digital_tg_send_sdd_res(struct nfc_digital_dev *ddev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 987) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 988) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 989) struct digital_sdd_res *sdd_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 990) int rc, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 991)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 992) skb = digital_skb_alloc(ddev, sizeof(struct digital_sdd_res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 993) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 994) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 995)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 996) skb_put(skb, sizeof(struct digital_sdd_res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 997) sdd_res = (struct digital_sdd_res *)skb->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 998)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 999) sdd_res->nfcid1[0] = 0x08;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000) get_random_bytes(sdd_res->nfcid1 + 1, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002) sdd_res->bcc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) for (i = 0; i < 4; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) sdd_res->bcc ^= sdd_res->nfcid1[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007) NFC_DIGITAL_FRAMING_NFCA_STANDARD_WITH_CRC_A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_sel_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) static void digital_tg_recv_sdd_req(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024) u8 *sdd_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) sdd_req = resp->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035) if (resp->len < 2 || sdd_req[0] != DIGITAL_CMD_SEL_REQ_CL1 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) sdd_req[1] != DIGITAL_SDD_REQ_SEL_PAR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041) rc = digital_tg_send_sdd_res(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) static int digital_tg_send_sens_res(struct nfc_digital_dev *ddev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) u8 *sens_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056) skb = digital_skb_alloc(ddev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) sens_res = skb_put(skb, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) sens_res[0] = (DIGITAL_SENS_RES_NFC_DEP >> 8) & 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) sens_res[1] = DIGITAL_SENS_RES_NFC_DEP & 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065) rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066) NFC_DIGITAL_FRAMING_NFCA_STANDARD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072) rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_sdd_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) void digital_tg_recv_sens_req(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083) u8 sens_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) sens_req = resp->data[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) if (!resp->len || (sens_req != DIGITAL_CMD_SENS_REQ &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095) sens_req != DIGITAL_CMD_ALL_REQ)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100) rc = digital_tg_send_sens_res(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) static void digital_tg_recv_atr_or_sensf_req(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) void *arg, struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112) if (!IS_ERR(resp) && (resp->len >= 2) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113) (resp->data[1] == DIGITAL_CMD_SENSF_REQ))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) digital_tg_recv_sensf_req(ddev, arg, resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) digital_tg_recv_atr_req(ddev, arg, resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121) static int digital_tg_send_sensf_res(struct nfc_digital_dev *ddev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) struct digital_sensf_req *sensf_req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) u8 size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) struct digital_sensf_res *sensf_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129) size = sizeof(struct digital_sensf_res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131) if (sensf_req->rc == DIGITAL_SENSF_REQ_RC_NONE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132) size -= sizeof(sensf_res->rd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134) skb = digital_skb_alloc(ddev, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138) skb_put(skb, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140) sensf_res = (struct digital_sensf_res *)skb->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) memset(sensf_res, 0, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) sensf_res->cmd = DIGITAL_CMD_SENSF_RES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145) sensf_res->nfcid2[0] = DIGITAL_SENSF_NFCID2_NFC_DEP_B1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146) sensf_res->nfcid2[1] = DIGITAL_SENSF_NFCID2_NFC_DEP_B2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) get_random_bytes(&sensf_res->nfcid2[2], 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) switch (sensf_req->rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150) case DIGITAL_SENSF_REQ_RC_SC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151) sensf_res->rd[0] = sensf_req->sc1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152) sensf_res->rd[1] = sensf_req->sc2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154) case DIGITAL_SENSF_REQ_RC_AP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) sensf_res->rd[0] = DIGITAL_SENSF_RES_RD_AP_B1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) sensf_res->rd[1] = DIGITAL_SENSF_RES_RD_AP_B2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160) *(u8 *)skb_push(skb, sizeof(u8)) = size + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162) if (!DIGITAL_DRV_CAPS_TG_CRC(ddev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163) digital_skb_add_crc_f(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165) rc = digital_tg_send_cmd(ddev, skb, 300,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) digital_tg_recv_atr_or_sensf_req, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173) void digital_tg_recv_sensf_req(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176) struct digital_sensf_req *sensf_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180) rc = PTR_ERR(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185) if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186) rc = digital_skb_check_crc_f(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) PROTOCOL_ERR("6.4.1.8");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) if (resp->len != sizeof(struct digital_sensf_req) + 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) skb_pull(resp, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199) sensf_req = (struct digital_sensf_req *)resp->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) if (sensf_req->cmd != DIGITAL_CMD_SENSF_REQ) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202) rc = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) goto exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206) rc = digital_tg_send_sensf_res(ddev, sensf_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215) static int digital_tg_config_nfca(struct nfc_digital_dev *ddev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219) rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) NFC_DIGITAL_RF_TECH_106A);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224) return digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) NFC_DIGITAL_FRAMING_NFCA_NFC_DEP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) int digital_tg_listen_nfca(struct nfc_digital_dev *ddev, u8 rf_tech)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232) rc = digital_tg_config_nfca(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) return digital_tg_listen(ddev, 300, digital_tg_recv_sens_req, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239) static int digital_tg_config_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247) return digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248) NFC_DIGITAL_FRAMING_NFCF_NFC_DEP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) int digital_tg_listen_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) rc = digital_tg_config_nfcf(ddev, rf_tech);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259) return digital_tg_listen(ddev, 300, digital_tg_recv_sensf_req, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) void digital_tg_recv_md_req(struct nfc_digital_dev *ddev, void *arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263) struct sk_buff *resp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265) u8 rf_tech;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268) if (IS_ERR(resp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269) resp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270) goto exit_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) rc = ddev->ops->tg_get_rf_tech(ddev, &rf_tech);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) goto exit_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277) switch (rf_tech) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278) case NFC_DIGITAL_RF_TECH_106A:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279) rc = digital_tg_config_nfca(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) goto exit_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) digital_tg_recv_sens_req(ddev, arg, resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284) case NFC_DIGITAL_RF_TECH_212F:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) case NFC_DIGITAL_RF_TECH_424F:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) rc = digital_tg_config_nfcf(ddev, rf_tech);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1287) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1288) goto exit_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1289) digital_tg_recv_sensf_req(ddev, arg, resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1290) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1291) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1292) goto exit_free_skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1293) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1294)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1295) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1297) exit_free_skb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1298) digital_poll_next_tech(ddev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1299) dev_kfree_skb(resp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1300) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags