771 строка
16 KiB
C
771 строка
16 KiB
C
/*
|
|
* 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);
|
|
}
|