| /* | |
| * NFC Digital Protocol stack | |
| * Copyright (c) 2013, Intel Corporation. | |
| * | |
| * This program is free software; you can redistribute it and/or modify it | |
| * under the terms and conditions of the GNU General Public License, | |
| * version 2, as published by the Free Software Foundation. | |
| * | |
| * This program is distributed in the hope it will be useful, but WITHOUT | |
| * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
| * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
| * more details. | |
| * | |
| */ | |
| #define pr_fmt(fmt) "digital: %s: " fmt, __func__ | |
| #include "digital.h" | |
| #define DIGITAL_CMD_SENS_REQ 0x26 | |
| #define DIGITAL_CMD_ALL_REQ 0x52 | |
| #define DIGITAL_CMD_SEL_REQ_CL1 0x93 | |
| #define DIGITAL_CMD_SEL_REQ_CL2 0x95 | |
| #define DIGITAL_CMD_SEL_REQ_CL3 0x97 | |
| #define DIGITAL_SDD_REQ_SEL_PAR 0x20 | |
| #define DIGITAL_SDD_RES_CT 0x88 | |
| #define DIGITAL_SDD_RES_LEN 5 | |
| #define DIGITAL_SEL_RES_NFCID1_COMPLETE(sel_res) (!((sel_res) & 0x04)) | |
| #define DIGITAL_SEL_RES_IS_T2T(sel_res) (!((sel_res) & 0x60)) | |
| #define DIGITAL_SEL_RES_IS_NFC_DEP(sel_res) ((sel_res) & 0x40) | |
| #define DIGITAL_SENS_RES_IS_T1T(sens_res) (((sens_res) & 0x0C00) == 0x0C00) | |
| #define DIGITAL_SENS_RES_IS_VALID(sens_res) \ | |
| ((!((sens_res) & 0x001F) && (((sens_res) & 0x0C00) == 0x0C00)) || \ | |
| (((sens_res) & 0x001F) && ((sens_res) & 0x0C00) != 0x0C00)) | |
| #define DIGITAL_MIFARE_READ_RES_LEN 16 | |
| #define DIGITAL_MIFARE_ACK_RES 0x0A | |
| #define DIGITAL_CMD_SENSF_REQ 0x00 | |
| #define DIGITAL_CMD_SENSF_RES 0x01 | |
| #define DIGITAL_SENSF_RES_MIN_LENGTH 17 | |
| #define DIGITAL_SENSF_RES_RD_AP_B1 0x00 | |
| #define DIGITAL_SENSF_RES_RD_AP_B2 0x8F | |
| #define DIGITAL_SENSF_REQ_RC_NONE 0 | |
| #define DIGITAL_SENSF_REQ_RC_SC 1 | |
| #define DIGITAL_SENSF_REQ_RC_AP 2 | |
| struct digital_sdd_res { | |
| u8 nfcid1[4]; | |
| u8 bcc; | |
| } __packed; | |
| struct digital_sel_req { | |
| u8 sel_cmd; | |
| u8 b2; | |
| u8 nfcid1[4]; | |
| u8 bcc; | |
| } __packed; | |
| struct digital_sensf_req { | |
| u8 cmd; | |
| u8 sc1; | |
| u8 sc2; | |
| u8 rc; | |
| u8 tsn; | |
| } __packed; | |
| struct digital_sensf_res { | |
| u8 cmd; | |
| u8 nfcid2[8]; | |
| u8 pad0[2]; | |
| u8 pad1[3]; | |
| u8 mrti_check; | |
| u8 mrti_update; | |
| u8 pad2; | |
| u8 rd[2]; | |
| } __packed; | |
| static int digital_in_send_sdd_req(struct nfc_digital_dev *ddev, | |
| struct nfc_target *target); | |
| static void digital_in_recv_sel_res(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| struct nfc_target *target = arg; | |
| int rc; | |
| u8 sel_res; | |
| u8 nfc_proto; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| if (!DIGITAL_DRV_CAPS_IN_CRC(ddev)) { | |
| rc = digital_skb_check_crc_a(resp); | |
| if (rc) { | |
| PROTOCOL_ERR("4.4.1.3"); | |
| goto exit; | |
| } | |
| } | |
| if (!resp->len) { | |
| rc = -EIO; | |
| goto exit; | |
| } | |
| sel_res = resp->data[0]; | |
| if (!DIGITAL_SEL_RES_NFCID1_COMPLETE(sel_res)) { | |
| rc = digital_in_send_sdd_req(ddev, target); | |
| if (rc) | |
| goto exit; | |
| goto exit_free_skb; | |
| } | |
| if (DIGITAL_SEL_RES_IS_T2T(sel_res)) { | |
| nfc_proto = NFC_PROTO_MIFARE; | |
| } else if (DIGITAL_SEL_RES_IS_NFC_DEP(sel_res)) { | |
| nfc_proto = NFC_PROTO_NFC_DEP; | |
| } else { | |
| rc = -EOPNOTSUPP; | |
| goto exit; | |
| } | |
| target->sel_res = sel_res; | |
| rc = digital_target_found(ddev, target, nfc_proto); | |
| exit: | |
| kfree(target); | |
| exit_free_skb: | |
| dev_kfree_skb(resp); | |
| if (rc) | |
| digital_poll_next_tech(ddev); | |
| } | |
| static int digital_in_send_sel_req(struct nfc_digital_dev *ddev, | |
| struct nfc_target *target, | |
| struct digital_sdd_res *sdd_res) | |
| { | |
| struct sk_buff *skb; | |
| struct digital_sel_req *sel_req; | |
| u8 sel_cmd; | |
| int rc; | |
| skb = digital_skb_alloc(ddev, sizeof(struct digital_sel_req)); | |
| if (!skb) | |
| return -ENOMEM; | |
| skb_put(skb, sizeof(struct digital_sel_req)); | |
| sel_req = (struct digital_sel_req *)skb->data; | |
| if (target->nfcid1_len <= 4) | |
| sel_cmd = DIGITAL_CMD_SEL_REQ_CL1; | |
| else if (target->nfcid1_len < 10) | |
| sel_cmd = DIGITAL_CMD_SEL_REQ_CL2; | |
| else | |
| sel_cmd = DIGITAL_CMD_SEL_REQ_CL3; | |
| sel_req->sel_cmd = sel_cmd; | |
| sel_req->b2 = 0x70; | |
| memcpy(sel_req->nfcid1, sdd_res->nfcid1, 4); | |
| sel_req->bcc = sdd_res->bcc; | |
| if (DIGITAL_DRV_CAPS_IN_CRC(ddev)) { | |
| rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING, | |
| NFC_DIGITAL_FRAMING_NFCA_STANDARD_WITH_CRC_A); | |
| if (rc) | |
| goto exit; | |
| } else { | |
| digital_skb_add_crc_a(skb); | |
| } | |
| rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sel_res, | |
| target); | |
| exit: | |
| if (rc) | |
| kfree_skb(skb); | |
| return rc; | |
| } | |
| static void digital_in_recv_sdd_res(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| struct nfc_target *target = arg; | |
| struct digital_sdd_res *sdd_res; | |
| int rc; | |
| u8 offset, size; | |
| u8 i, bcc; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| if (resp->len < DIGITAL_SDD_RES_LEN) { | |
| PROTOCOL_ERR("4.7.2.8"); | |
| rc = -EINVAL; | |
| goto exit; | |
| } | |
| sdd_res = (struct digital_sdd_res *)resp->data; | |
| for (i = 0, bcc = 0; i < 4; i++) | |
| bcc ^= sdd_res->nfcid1[i]; | |
| if (bcc != sdd_res->bcc) { | |
| PROTOCOL_ERR("4.7.2.6"); | |
| rc = -EINVAL; | |
| goto exit; | |
| } | |
| if (sdd_res->nfcid1[0] == DIGITAL_SDD_RES_CT) { | |
| offset = 1; | |
| size = 3; | |
| } else { | |
| offset = 0; | |
| size = 4; | |
| } | |
| memcpy(target->nfcid1 + target->nfcid1_len, sdd_res->nfcid1 + offset, | |
| size); | |
| target->nfcid1_len += size; | |
| rc = digital_in_send_sel_req(ddev, target, sdd_res); | |
| exit: | |
| dev_kfree_skb(resp); | |
| if (rc) { | |
| kfree(target); | |
| digital_poll_next_tech(ddev); | |
| } | |
| } | |
| static int digital_in_send_sdd_req(struct nfc_digital_dev *ddev, | |
| struct nfc_target *target) | |
| { | |
| int rc; | |
| struct sk_buff *skb; | |
| u8 sel_cmd; | |
| rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING, | |
| NFC_DIGITAL_FRAMING_NFCA_STANDARD); | |
| if (rc) | |
| return rc; | |
| skb = digital_skb_alloc(ddev, 2); | |
| if (!skb) | |
| return -ENOMEM; | |
| if (target->nfcid1_len == 0) | |
| sel_cmd = DIGITAL_CMD_SEL_REQ_CL1; | |
| else if (target->nfcid1_len == 3) | |
| sel_cmd = DIGITAL_CMD_SEL_REQ_CL2; | |
| else | |
| sel_cmd = DIGITAL_CMD_SEL_REQ_CL3; | |
| *skb_put(skb, sizeof(u8)) = sel_cmd; | |
| *skb_put(skb, sizeof(u8)) = DIGITAL_SDD_REQ_SEL_PAR; | |
| return digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sdd_res, | |
| target); | |
| } | |
| static void digital_in_recv_sens_res(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| struct nfc_target *target = NULL; | |
| int rc; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| if (resp->len < sizeof(u16)) { | |
| rc = -EIO; | |
| goto exit; | |
| } | |
| target = kzalloc(sizeof(struct nfc_target), GFP_KERNEL); | |
| if (!target) { | |
| rc = -ENOMEM; | |
| goto exit; | |
| } | |
| target->sens_res = __le16_to_cpu(*(__le16 *)resp->data); | |
| if (!DIGITAL_SENS_RES_IS_VALID(target->sens_res)) { | |
| PROTOCOL_ERR("4.6.3.3"); | |
| rc = -EINVAL; | |
| goto exit; | |
| } | |
| if (DIGITAL_SENS_RES_IS_T1T(target->sens_res)) | |
| rc = digital_target_found(ddev, target, NFC_PROTO_JEWEL); | |
| else | |
| rc = digital_in_send_sdd_req(ddev, target); | |
| exit: | |
| dev_kfree_skb(resp); | |
| if (rc) { | |
| kfree(target); | |
| digital_poll_next_tech(ddev); | |
| } | |
| } | |
| int digital_in_send_sens_req(struct nfc_digital_dev *ddev, u8 rf_tech) | |
| { | |
| struct sk_buff *skb; | |
| int rc; | |
| rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, | |
| NFC_DIGITAL_RF_TECH_106A); | |
| if (rc) | |
| return rc; | |
| rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING, | |
| NFC_DIGITAL_FRAMING_NFCA_SHORT); | |
| if (rc) | |
| return rc; | |
| skb = digital_skb_alloc(ddev, 1); | |
| if (!skb) | |
| return -ENOMEM; | |
| *skb_put(skb, sizeof(u8)) = DIGITAL_CMD_SENS_REQ; | |
| rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sens_res, NULL); | |
| if (rc) | |
| kfree_skb(skb); | |
| return rc; | |
| } | |
| int digital_in_recv_mifare_res(struct sk_buff *resp) | |
| { | |
| /* Successful READ command response is 16 data bytes + 2 CRC bytes long. | |
| * Since the driver can't differentiate a ACK/NACK response from a valid | |
| * READ response, the CRC calculation must be handled at digital level | |
| * even if the driver supports it for this technology. | |
| */ | |
| if (resp->len == DIGITAL_MIFARE_READ_RES_LEN + DIGITAL_CRC_LEN) { | |
| if (digital_skb_check_crc_a(resp)) { | |
| PROTOCOL_ERR("9.4.1.2"); | |
| return -EIO; | |
| } | |
| return 0; | |
| } | |
| /* ACK response (i.e. successful WRITE). */ | |
| if (resp->len == 1 && resp->data[0] == DIGITAL_MIFARE_ACK_RES) { | |
| resp->data[0] = 0; | |
| return 0; | |
| } | |
| /* NACK and any other responses are treated as error. */ | |
| return -EIO; | |
| } | |
| static void digital_in_recv_sensf_res(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| int rc; | |
| u8 proto; | |
| struct nfc_target target; | |
| struct digital_sensf_res *sensf_res; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| if (resp->len < DIGITAL_SENSF_RES_MIN_LENGTH) { | |
| rc = -EIO; | |
| goto exit; | |
| } | |
| if (!DIGITAL_DRV_CAPS_IN_CRC(ddev)) { | |
| rc = digital_skb_check_crc_f(resp); | |
| if (rc) { | |
| PROTOCOL_ERR("6.4.1.8"); | |
| goto exit; | |
| } | |
| } | |
| skb_pull(resp, 1); | |
| memset(&target, 0, sizeof(struct nfc_target)); | |
| sensf_res = (struct digital_sensf_res *)resp->data; | |
| memcpy(target.sensf_res, sensf_res, resp->len); | |
| target.sensf_res_len = resp->len; | |
| memcpy(target.nfcid2, sensf_res->nfcid2, NFC_NFCID2_MAXSIZE); | |
| target.nfcid2_len = NFC_NFCID2_MAXSIZE; | |
| if (target.nfcid2[0] == DIGITAL_SENSF_NFCID2_NFC_DEP_B1 && | |
| target.nfcid2[1] == DIGITAL_SENSF_NFCID2_NFC_DEP_B2) | |
| proto = NFC_PROTO_NFC_DEP; | |
| else | |
| proto = NFC_PROTO_FELICA; | |
| rc = digital_target_found(ddev, &target, proto); | |
| exit: | |
| dev_kfree_skb(resp); | |
| if (rc) | |
| digital_poll_next_tech(ddev); | |
| } | |
| int digital_in_send_sensf_req(struct nfc_digital_dev *ddev, u8 rf_tech) | |
| { | |
| struct digital_sensf_req *sensf_req; | |
| struct sk_buff *skb; | |
| int rc; | |
| u8 size; | |
| rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech); | |
| if (rc) | |
| return rc; | |
| rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING, | |
| NFC_DIGITAL_FRAMING_NFCF); | |
| if (rc) | |
| return rc; | |
| size = sizeof(struct digital_sensf_req); | |
| skb = digital_skb_alloc(ddev, size); | |
| if (!skb) | |
| return -ENOMEM; | |
| skb_put(skb, size); | |
| sensf_req = (struct digital_sensf_req *)skb->data; | |
| sensf_req->cmd = DIGITAL_CMD_SENSF_REQ; | |
| sensf_req->sc1 = 0xFF; | |
| sensf_req->sc2 = 0xFF; | |
| sensf_req->rc = 0; | |
| sensf_req->tsn = 0; | |
| *skb_push(skb, 1) = size + 1; | |
| if (!DIGITAL_DRV_CAPS_IN_CRC(ddev)) | |
| digital_skb_add_crc_f(skb); | |
| rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sensf_res, | |
| NULL); | |
| if (rc) | |
| kfree_skb(skb); | |
| return rc; | |
| } | |
| static int digital_tg_send_sel_res(struct nfc_digital_dev *ddev) | |
| { | |
| struct sk_buff *skb; | |
| int rc; | |
| skb = digital_skb_alloc(ddev, 1); | |
| if (!skb) | |
| return -ENOMEM; | |
| *skb_put(skb, 1) = DIGITAL_SEL_RES_NFC_DEP; | |
| if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) | |
| digital_skb_add_crc_a(skb); | |
| rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_atr_req, | |
| NULL); | |
| if (rc) | |
| kfree_skb(skb); | |
| return rc; | |
| } | |
| static void digital_tg_recv_sel_req(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| int rc; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) { | |
| rc = digital_skb_check_crc_a(resp); | |
| if (rc) { | |
| PROTOCOL_ERR("4.4.1.3"); | |
| goto exit; | |
| } | |
| } | |
| /* Silently ignore SEL_REQ content and send a SEL_RES for NFC-DEP */ | |
| rc = digital_tg_send_sel_res(ddev); | |
| exit: | |
| if (rc) | |
| digital_poll_next_tech(ddev); | |
| dev_kfree_skb(resp); | |
| } | |
| static int digital_tg_send_sdd_res(struct nfc_digital_dev *ddev) | |
| { | |
| struct sk_buff *skb; | |
| struct digital_sdd_res *sdd_res; | |
| int rc, i; | |
| skb = digital_skb_alloc(ddev, sizeof(struct digital_sdd_res)); | |
| if (!skb) | |
| return -ENOMEM; | |
| skb_put(skb, sizeof(struct digital_sdd_res)); | |
| sdd_res = (struct digital_sdd_res *)skb->data; | |
| sdd_res->nfcid1[0] = 0x08; | |
| get_random_bytes(sdd_res->nfcid1 + 1, 3); | |
| sdd_res->bcc = 0; | |
| for (i = 0; i < 4; i++) | |
| sdd_res->bcc ^= sdd_res->nfcid1[i]; | |
| rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_sel_req, | |
| NULL); | |
| if (rc) | |
| kfree_skb(skb); | |
| return rc; | |
| } | |
| static void digital_tg_recv_sdd_req(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| u8 *sdd_req; | |
| int rc; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| sdd_req = resp->data; | |
| if (resp->len < 2 || sdd_req[0] != DIGITAL_CMD_SEL_REQ_CL1 || | |
| sdd_req[1] != DIGITAL_SDD_REQ_SEL_PAR) { | |
| rc = -EINVAL; | |
| goto exit; | |
| } | |
| rc = digital_tg_send_sdd_res(ddev); | |
| exit: | |
| if (rc) | |
| digital_poll_next_tech(ddev); | |
| dev_kfree_skb(resp); | |
| } | |
| static int digital_tg_send_sens_res(struct nfc_digital_dev *ddev) | |
| { | |
| struct sk_buff *skb; | |
| u8 *sens_res; | |
| int rc; | |
| skb = digital_skb_alloc(ddev, 2); | |
| if (!skb) | |
| return -ENOMEM; | |
| sens_res = skb_put(skb, 2); | |
| sens_res[0] = (DIGITAL_SENS_RES_NFC_DEP >> 8) & 0xFF; | |
| sens_res[1] = DIGITAL_SENS_RES_NFC_DEP & 0xFF; | |
| rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_sdd_req, | |
| NULL); | |
| if (rc) | |
| kfree_skb(skb); | |
| return rc; | |
| } | |
| void digital_tg_recv_sens_req(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| u8 sens_req; | |
| int rc; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| sens_req = resp->data[0]; | |
| if (!resp->len || (sens_req != DIGITAL_CMD_SENS_REQ && | |
| sens_req != DIGITAL_CMD_ALL_REQ)) { | |
| rc = -EINVAL; | |
| goto exit; | |
| } | |
| rc = digital_tg_send_sens_res(ddev); | |
| exit: | |
| if (rc) | |
| digital_poll_next_tech(ddev); | |
| dev_kfree_skb(resp); | |
| } | |
| static int digital_tg_send_sensf_res(struct nfc_digital_dev *ddev, | |
| struct digital_sensf_req *sensf_req) | |
| { | |
| struct sk_buff *skb; | |
| u8 size; | |
| int rc; | |
| struct digital_sensf_res *sensf_res; | |
| size = sizeof(struct digital_sensf_res); | |
| if (sensf_req->rc != DIGITAL_SENSF_REQ_RC_NONE) | |
| size -= sizeof(sensf_res->rd); | |
| skb = digital_skb_alloc(ddev, size); | |
| if (!skb) | |
| return -ENOMEM; | |
| skb_put(skb, size); | |
| sensf_res = (struct digital_sensf_res *)skb->data; | |
| memset(sensf_res, 0, size); | |
| sensf_res->cmd = DIGITAL_CMD_SENSF_RES; | |
| sensf_res->nfcid2[0] = DIGITAL_SENSF_NFCID2_NFC_DEP_B1; | |
| sensf_res->nfcid2[1] = DIGITAL_SENSF_NFCID2_NFC_DEP_B2; | |
| get_random_bytes(&sensf_res->nfcid2[2], 6); | |
| switch (sensf_req->rc) { | |
| case DIGITAL_SENSF_REQ_RC_SC: | |
| sensf_res->rd[0] = sensf_req->sc1; | |
| sensf_res->rd[1] = sensf_req->sc2; | |
| break; | |
| case DIGITAL_SENSF_REQ_RC_AP: | |
| sensf_res->rd[0] = DIGITAL_SENSF_RES_RD_AP_B1; | |
| sensf_res->rd[1] = DIGITAL_SENSF_RES_RD_AP_B2; | |
| break; | |
| } | |
| *skb_push(skb, sizeof(u8)) = size + 1; | |
| if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) | |
| digital_skb_add_crc_f(skb); | |
| rc = digital_tg_send_cmd(ddev, skb, 300, | |
| digital_tg_recv_atr_req, NULL); | |
| if (rc) | |
| kfree_skb(skb); | |
| return rc; | |
| } | |
| void digital_tg_recv_sensf_req(struct nfc_digital_dev *ddev, void *arg, | |
| struct sk_buff *resp) | |
| { | |
| struct digital_sensf_req *sensf_req; | |
| int rc; | |
| if (IS_ERR(resp)) { | |
| rc = PTR_ERR(resp); | |
| resp = NULL; | |
| goto exit; | |
| } | |
| if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) { | |
| rc = digital_skb_check_crc_f(resp); | |
| if (rc) { | |
| PROTOCOL_ERR("6.4.1.8"); | |
| goto exit; | |
| } | |
| } | |
| if (resp->len != sizeof(struct digital_sensf_req) + 1) { | |
| rc = -EINVAL; | |
| goto exit; | |
| } | |
| skb_pull(resp, 1); | |
| sensf_req = (struct digital_sensf_req *)resp->data; | |
| if (sensf_req->cmd != DIGITAL_CMD_SENSF_REQ) { | |
| rc = -EINVAL; | |
| goto exit; | |
| } | |
| rc = digital_tg_send_sensf_res(ddev, sensf_req); | |
| exit: | |
| if (rc) | |
| digital_poll_next_tech(ddev); | |
| dev_kfree_skb(resp); | |
| } | |
| int digital_tg_listen_nfca(struct nfc_digital_dev *ddev, u8 rf_tech) | |
| { | |
| int rc; | |
| rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech); | |
| if (rc) | |
| return rc; | |
| rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING, | |
| NFC_DIGITAL_FRAMING_NFCA_NFC_DEP); | |
| if (rc) | |
| return rc; | |
| return digital_tg_listen(ddev, 300, digital_tg_recv_sens_req, NULL); | |
| } | |
| int digital_tg_listen_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech) | |
| { | |
| int rc; | |
| u8 *nfcid2; | |
| rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech); | |
| if (rc) | |
| return rc; | |
| rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING, | |
| NFC_DIGITAL_FRAMING_NFCF_NFC_DEP); | |
| if (rc) | |
| return rc; | |
| nfcid2 = kzalloc(NFC_NFCID2_MAXSIZE, GFP_KERNEL); | |
| if (!nfcid2) | |
| return -ENOMEM; | |
| nfcid2[0] = DIGITAL_SENSF_NFCID2_NFC_DEP_B1; | |
| nfcid2[1] = DIGITAL_SENSF_NFCID2_NFC_DEP_B2; | |
| get_random_bytes(nfcid2 + 2, NFC_NFCID2_MAXSIZE - 2); | |
| return digital_tg_listen(ddev, 300, digital_tg_recv_sensf_req, nfcid2); | |
| } |