[linux.git] / net / nfc / digital_dep.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_NFC_DEP_FRAME_DIR_OUT 0xD4
#define DIGITAL_NFC_DEP_FRAME_DIR_IN  0xD5

#define DIGITAL_NFC_DEP_NFCA_SOD_SB   0xF0

#define DIGITAL_CMD_ATR_REQ 0x00
#define DIGITAL_CMD_ATR_RES 0x01
#define DIGITAL_CMD_PSL_REQ 0x04
#define DIGITAL_CMD_PSL_RES 0x05
#define DIGITAL_CMD_DEP_REQ 0x06
#define DIGITAL_CMD_DEP_RES 0x07

#define DIGITAL_ATR_REQ_MIN_SIZE 16
#define DIGITAL_ATR_REQ_MAX_SIZE 64

#define DIGITAL_LR_BITS_PAYLOAD_SIZE_254B 0x30
#define DIGITAL_FSL_BITS_PAYLOAD_SIZE_254B \
				(DIGITAL_LR_BITS_PAYLOAD_SIZE_254B >> 4)
#define DIGITAL_GB_BIT	0x02

#define DIGITAL_NFC_DEP_PFB_TYPE(pfb) ((pfb) & 0xE0)

#define DIGITAL_NFC_DEP_PFB_TIMEOUT_BIT 0x10

#define DIGITAL_NFC_DEP_PFB_IS_TIMEOUT(pfb) \
				((pfb) & DIGITAL_NFC_DEP_PFB_TIMEOUT_BIT)
#define DIGITAL_NFC_DEP_MI_BIT_SET(pfb)  ((pfb) & 0x10)
#define DIGITAL_NFC_DEP_NAD_BIT_SET(pfb) ((pfb) & 0x08)
#define DIGITAL_NFC_DEP_DID_BIT_SET(pfb) ((pfb) & 0x04)
#define DIGITAL_NFC_DEP_PFB_PNI(pfb)     ((pfb) & 0x03)

#define DIGITAL_NFC_DEP_PFB_I_PDU          0x00
#define DIGITAL_NFC_DEP_PFB_ACK_NACK_PDU   0x40
#define DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU 0x80

struct digital_atr_req {
	u8 dir;
	u8 cmd;
	u8 nfcid3[10];
	u8 did;
	u8 bs;
	u8 br;
	u8 pp;
	u8 gb[0];
} __packed;

struct digital_atr_res {
	u8 dir;
	u8 cmd;
	u8 nfcid3[10];
	u8 did;
	u8 bs;
	u8 br;
	u8 to;
	u8 pp;
	u8 gb[0];
} __packed;

struct digital_psl_req {
	u8 dir;
	u8 cmd;
	u8 did;
	u8 brs;
	u8 fsl;
} __packed;

struct digital_psl_res {
	u8 dir;
	u8 cmd;
	u8 did;
} __packed;

struct digital_dep_req_res {
	u8 dir;
	u8 cmd;
	u8 pfb;
} __packed;

static void digital_in_recv_dep_res(struct nfc_digital_dev *ddev, void *arg,
				    struct sk_buff *resp);

static void digital_skb_push_dep_sod(struct nfc_digital_dev *ddev,
				     struct sk_buff *skb)
{
	skb_push(skb, sizeof(u8));

	skb->data[0] = skb->len;

	if (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)
		*skb_push(skb, sizeof(u8)) = DIGITAL_NFC_DEP_NFCA_SOD_SB;
}

static int digital_skb_pull_dep_sod(struct nfc_digital_dev *ddev,
				    struct sk_buff *skb)
{
	u8 size;

	if (skb->len < 2)
		return -EIO;

	if (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)
		skb_pull(skb, sizeof(u8));

	size = skb->data[0];
	if (size != skb->len)
		return -EIO;

	skb_pull(skb, sizeof(u8));

	return 0;
}

static void digital_in_recv_psl_res(struct nfc_digital_dev *ddev, void *arg,
				    struct sk_buff *resp)
{
	struct nfc_target *target = arg;
	struct digital_psl_res *psl_res;
	int rc;

	if (IS_ERR(resp)) {
		rc = PTR_ERR(resp);
		resp = NULL;
		goto exit;
	}

	rc = ddev->skb_check_crc(resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.6");
		goto exit;
	}

	rc = digital_skb_pull_dep_sod(ddev, resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.2");
		goto exit;
	}

	psl_res = (struct digital_psl_res *)resp->data;

	if ((resp->len != sizeof(*psl_res)) ||
	    (psl_res->dir != DIGITAL_NFC_DEP_FRAME_DIR_IN) ||
	    (psl_res->cmd != DIGITAL_CMD_PSL_RES)) {
		rc = -EIO;
		goto exit;
	}

	rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
				     NFC_DIGITAL_RF_TECH_424F);
	if (rc)
		goto exit;

	rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
				     NFC_DIGITAL_FRAMING_NFCF_NFC_DEP);
	if (rc)
		goto exit;

	if (!DIGITAL_DRV_CAPS_IN_CRC(ddev) &&
	    (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)) {
		ddev->skb_add_crc = digital_skb_add_crc_f;
		ddev->skb_check_crc = digital_skb_check_crc_f;
	}

	ddev->curr_rf_tech = NFC_DIGITAL_RF_TECH_424F;

	nfc_dep_link_is_up(ddev->nfc_dev, target->idx, NFC_COMM_ACTIVE,
			   NFC_RF_INITIATOR);

	ddev->curr_nfc_dep_pni = 0;

exit:
	dev_kfree_skb(resp);

	if (rc)
		ddev->curr_protocol = 0;
}

static int digital_in_send_psl_req(struct nfc_digital_dev *ddev,
				   struct nfc_target *target)
{
	struct sk_buff *skb;
	struct digital_psl_req *psl_req;

	skb = digital_skb_alloc(ddev, sizeof(*psl_req));
	if (!skb)
		return -ENOMEM;

	skb_put(skb, sizeof(*psl_req));

	psl_req = (struct digital_psl_req *)skb->data;

	psl_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
	psl_req->cmd = DIGITAL_CMD_PSL_REQ;
	psl_req->did = 0;
	psl_req->brs = (0x2 << 3) | 0x2; /* 424F both directions */
	psl_req->fsl = DIGITAL_FSL_BITS_PAYLOAD_SIZE_254B;

	digital_skb_push_dep_sod(ddev, skb);

	ddev->skb_add_crc(skb);

	return digital_in_send_cmd(ddev, skb, 500, digital_in_recv_psl_res,
				   target);
}

static void digital_in_recv_atr_res(struct nfc_digital_dev *ddev, void *arg,
				 struct sk_buff *resp)
{
	struct nfc_target *target = arg;
	struct digital_atr_res *atr_res;
	u8 gb_len;
	int rc;

	if (IS_ERR(resp)) {
		rc = PTR_ERR(resp);
		resp = NULL;
		goto exit;
	}

	rc = ddev->skb_check_crc(resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.6");
		goto exit;
	}

	rc = digital_skb_pull_dep_sod(ddev, resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.2");
		goto exit;
	}

	if (resp->len < sizeof(struct digital_atr_res)) {
		rc = -EIO;
		goto exit;
	}

	gb_len = resp->len - sizeof(struct digital_atr_res);

	atr_res = (struct digital_atr_res *)resp->data;

	rc = nfc_set_remote_general_bytes(ddev->nfc_dev, atr_res->gb, gb_len);
	if (rc)
		goto exit;

	if ((ddev->protocols & NFC_PROTO_FELICA_MASK) &&
	    (ddev->curr_rf_tech != NFC_DIGITAL_RF_TECH_424F)) {
		rc = digital_in_send_psl_req(ddev, target);
		if (!rc)
			goto exit;
	}

	rc = nfc_dep_link_is_up(ddev->nfc_dev, target->idx, NFC_COMM_ACTIVE,
				NFC_RF_INITIATOR);

	ddev->curr_nfc_dep_pni = 0;

exit:
	dev_kfree_skb(resp);

	if (rc)
		ddev->curr_protocol = 0;
}

int digital_in_send_atr_req(struct nfc_digital_dev *ddev,
			    struct nfc_target *target, __u8 comm_mode, __u8 *gb,
			    size_t gb_len)
{
	struct sk_buff *skb;
	struct digital_atr_req *atr_req;
	uint size;

	size = DIGITAL_ATR_REQ_MIN_SIZE + gb_len;

	if (size > DIGITAL_ATR_REQ_MAX_SIZE) {
		PROTOCOL_ERR("14.6.1.1");
		return -EINVAL;
	}

	skb = digital_skb_alloc(ddev, size);
	if (!skb)
		return -ENOMEM;

	skb_put(skb, sizeof(struct digital_atr_req));

	atr_req = (struct digital_atr_req *)skb->data;
	memset(atr_req, 0, sizeof(struct digital_atr_req));

	atr_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
	atr_req->cmd = DIGITAL_CMD_ATR_REQ;
	if (target->nfcid2_len)
		memcpy(atr_req->nfcid3, target->nfcid2, NFC_NFCID2_MAXSIZE);
	else
		get_random_bytes(atr_req->nfcid3, NFC_NFCID3_MAXSIZE);

	atr_req->did = 0;
	atr_req->bs = 0;
	atr_req->br = 0;

	atr_req->pp = DIGITAL_LR_BITS_PAYLOAD_SIZE_254B;

	if (gb_len) {
		atr_req->pp |= DIGITAL_GB_BIT;
		memcpy(skb_put(skb, gb_len), gb, gb_len);
	}

	digital_skb_push_dep_sod(ddev, skb);

	ddev->skb_add_crc(skb);

	return digital_in_send_cmd(ddev, skb, 500, digital_in_recv_atr_res,
				   target);
}

static int digital_in_send_rtox(struct nfc_digital_dev *ddev,
				struct digital_data_exch *data_exch, u8 rtox)
{
	struct digital_dep_req_res *dep_req;
	struct sk_buff *skb;
	int rc;

	skb = digital_skb_alloc(ddev, 1);
	if (!skb)
		return -ENOMEM;

	*skb_put(skb, 1) = rtox;

	skb_push(skb, sizeof(struct digital_dep_req_res));

	dep_req = (struct digital_dep_req_res *)skb->data;

	dep_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
	dep_req->cmd = DIGITAL_CMD_DEP_REQ;
	dep_req->pfb = DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU |
		       DIGITAL_NFC_DEP_PFB_TIMEOUT_BIT;

	digital_skb_push_dep_sod(ddev, skb);

	ddev->skb_add_crc(skb);

	rc = digital_in_send_cmd(ddev, skb, 1500, digital_in_recv_dep_res,
				 data_exch);

	return rc;
}

static void digital_in_recv_dep_res(struct nfc_digital_dev *ddev, void *arg,
				    struct sk_buff *resp)
{
	struct digital_data_exch *data_exch = arg;
	struct digital_dep_req_res *dep_res;
	u8 pfb;
	uint size;
	int rc;

	if (IS_ERR(resp)) {
		rc = PTR_ERR(resp);
		resp = NULL;
		goto exit;
	}

	rc = ddev->skb_check_crc(resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.6");
		goto error;
	}

	rc = digital_skb_pull_dep_sod(ddev, resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.2");
		goto exit;
	}

	dep_res = (struct digital_dep_req_res *)resp->data;

	if (resp->len < sizeof(struct digital_dep_req_res) ||
	    dep_res->dir != DIGITAL_NFC_DEP_FRAME_DIR_IN ||
	    dep_res->cmd != DIGITAL_CMD_DEP_RES) {
		rc = -EIO;
		goto error;
	}

	pfb = dep_res->pfb;

	switch (DIGITAL_NFC_DEP_PFB_TYPE(pfb)) {
	case DIGITAL_NFC_DEP_PFB_I_PDU:
		if (DIGITAL_NFC_DEP_PFB_PNI(pfb) != ddev->curr_nfc_dep_pni) {
			PROTOCOL_ERR("14.12.3.3");
			rc = -EIO;
			goto error;
		}

		ddev->curr_nfc_dep_pni =
			DIGITAL_NFC_DEP_PFB_PNI(ddev->curr_nfc_dep_pni + 1);
		rc = 0;
		break;

	case DIGITAL_NFC_DEP_PFB_ACK_NACK_PDU:
		pr_err("Received a ACK/NACK PDU\n");
		rc = -EIO;
		goto error;

	case DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU:
		if (!DIGITAL_NFC_DEP_PFB_IS_TIMEOUT(pfb)) {
			rc = -EINVAL;
			goto error;
		}

		rc = digital_in_send_rtox(ddev, data_exch, resp->data[3]);
		if (rc)
			goto error;

		kfree_skb(resp);
		return;
	}

	if (DIGITAL_NFC_DEP_MI_BIT_SET(pfb)) {
		pr_err("MI bit set. Chained PDU not supported\n");
		rc = -EIO;
		goto error;
	}

	size = sizeof(struct digital_dep_req_res);

	if (DIGITAL_NFC_DEP_DID_BIT_SET(pfb))
		size++;

	if (size > resp->len) {
		rc = -EIO;
		goto error;
	}

	skb_pull(resp, size);

exit:
	data_exch->cb(data_exch->cb_context, resp, rc);

error:
	kfree(data_exch);

	if (rc)
		kfree_skb(resp);
}

int digital_in_send_dep_req(struct nfc_digital_dev *ddev,
			    struct nfc_target *target, struct sk_buff *skb,
			    struct digital_data_exch *data_exch)
{
	struct digital_dep_req_res *dep_req;

	skb_push(skb, sizeof(struct digital_dep_req_res));

	dep_req = (struct digital_dep_req_res *)skb->data;
	dep_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
	dep_req->cmd = DIGITAL_CMD_DEP_REQ;
	dep_req->pfb = ddev->curr_nfc_dep_pni;

	digital_skb_push_dep_sod(ddev, skb);

	ddev->skb_add_crc(skb);

	return digital_in_send_cmd(ddev, skb, 1500, digital_in_recv_dep_res,
				   data_exch);
}

static void digital_tg_set_rf_tech(struct nfc_digital_dev *ddev, u8 rf_tech)
{
	ddev->curr_rf_tech = rf_tech;

	ddev->skb_add_crc = digital_skb_add_crc_none;
	ddev->skb_check_crc = digital_skb_check_crc_none;

	if (DIGITAL_DRV_CAPS_TG_CRC(ddev))
		return;

	switch (ddev->curr_rf_tech) {
	case NFC_DIGITAL_RF_TECH_106A:
		ddev->skb_add_crc = digital_skb_add_crc_a;
		ddev->skb_check_crc = digital_skb_check_crc_a;
		break;

	case NFC_DIGITAL_RF_TECH_212F:
	case NFC_DIGITAL_RF_TECH_424F:
		ddev->skb_add_crc = digital_skb_add_crc_f;
		ddev->skb_check_crc = digital_skb_check_crc_f;
		break;

	default:
		break;
	}
}

static void digital_tg_recv_dep_req(struct nfc_digital_dev *ddev, void *arg,
				    struct sk_buff *resp)
{
	int rc;
	struct digital_dep_req_res *dep_req;
	size_t size;

	if (IS_ERR(resp)) {
		rc = PTR_ERR(resp);
		resp = NULL;
		goto exit;
	}

	rc = ddev->skb_check_crc(resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.6");
		goto exit;
	}

	rc = digital_skb_pull_dep_sod(ddev, resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.2");
		goto exit;
	}

	size = sizeof(struct digital_dep_req_res);
	dep_req = (struct digital_dep_req_res *)resp->data;

	if (resp->len < size || dep_req->dir != DIGITAL_NFC_DEP_FRAME_DIR_OUT ||
	    dep_req->cmd != DIGITAL_CMD_DEP_REQ) {
		rc = -EIO;
		goto exit;
	}

	if (DIGITAL_NFC_DEP_DID_BIT_SET(dep_req->pfb))
		size++;

	if (resp->len < size) {
		rc = -EIO;
		goto exit;
	}

	switch (DIGITAL_NFC_DEP_PFB_TYPE(dep_req->pfb)) {
	case DIGITAL_NFC_DEP_PFB_I_PDU:
		pr_debug("DIGITAL_NFC_DEP_PFB_I_PDU\n");
		ddev->curr_nfc_dep_pni = DIGITAL_NFC_DEP_PFB_PNI(dep_req->pfb);
		break;
	case DIGITAL_NFC_DEP_PFB_ACK_NACK_PDU:
		pr_err("Received a ACK/NACK PDU\n");
		rc = -EINVAL;
		goto exit;
	case DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU:
		pr_err("Received a SUPERVISOR PDU\n");
		rc = -EINVAL;
		goto exit;
	}

	skb_pull(resp, size);

	rc = nfc_tm_data_received(ddev->nfc_dev, resp);

exit:
	if (rc)
		kfree_skb(resp);
}

int digital_tg_send_dep_res(struct nfc_digital_dev *ddev, struct sk_buff *skb)
{
	struct digital_dep_req_res *dep_res;

	skb_push(skb, sizeof(struct digital_dep_req_res));
	dep_res = (struct digital_dep_req_res *)skb->data;

	dep_res->dir = DIGITAL_NFC_DEP_FRAME_DIR_IN;
	dep_res->cmd = DIGITAL_CMD_DEP_RES;
	dep_res->pfb = ddev->curr_nfc_dep_pni;

	digital_skb_push_dep_sod(ddev, skb);

	ddev->skb_add_crc(skb);

	return digital_tg_send_cmd(ddev, skb, 1500, digital_tg_recv_dep_req,
				   NULL);
}

static void digital_tg_send_psl_res_complete(struct nfc_digital_dev *ddev,
					     void *arg, struct sk_buff *resp)
{
	u8 rf_tech = (unsigned long)arg;

	if (IS_ERR(resp))
		return;

	digital_tg_set_rf_tech(ddev, rf_tech);

	digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);

	digital_tg_listen(ddev, 1500, digital_tg_recv_dep_req, NULL);

	dev_kfree_skb(resp);
}

static int digital_tg_send_psl_res(struct nfc_digital_dev *ddev, u8 did,
				   u8 rf_tech)
{
	struct digital_psl_res *psl_res;
	struct sk_buff *skb;
	int rc;

	skb = digital_skb_alloc(ddev, sizeof(struct digital_psl_res));
	if (!skb)
		return -ENOMEM;

	skb_put(skb, sizeof(struct digital_psl_res));

	psl_res = (struct digital_psl_res *)skb->data;

	psl_res->dir = DIGITAL_NFC_DEP_FRAME_DIR_IN;
	psl_res->cmd = DIGITAL_CMD_PSL_RES;
	psl_res->did = did;

	digital_skb_push_dep_sod(ddev, skb);

	ddev->skb_add_crc(skb);

	rc = digital_tg_send_cmd(ddev, skb, 0, digital_tg_send_psl_res_complete,
				 (void *)(unsigned long)rf_tech);

	if (rc)
		kfree_skb(skb);

	return rc;
}

static void digital_tg_recv_psl_req(struct nfc_digital_dev *ddev, void *arg,
				    struct sk_buff *resp)
{
	int rc;
	struct digital_psl_req *psl_req;
	u8 rf_tech;
	u8 dsi;

	if (IS_ERR(resp)) {
		rc = PTR_ERR(resp);
		resp = NULL;
		goto exit;
	}

	rc = ddev->skb_check_crc(resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.6");
		goto exit;
	}

	rc = digital_skb_pull_dep_sod(ddev, resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.2");
		goto exit;
	}

	psl_req = (struct digital_psl_req *)resp->data;

	if (resp->len != sizeof(struct digital_psl_req) ||
	    psl_req->dir != DIGITAL_NFC_DEP_FRAME_DIR_OUT ||
	    psl_req->cmd != DIGITAL_CMD_PSL_REQ) {
		rc = -EIO;
		goto exit;
	}

	dsi = (psl_req->brs >> 3) & 0x07;
	switch (dsi) {
	case 0:
		rf_tech = NFC_DIGITAL_RF_TECH_106A;
		break;
	case 1:
		rf_tech = NFC_DIGITAL_RF_TECH_212F;
		break;
	case 2:
		rf_tech = NFC_DIGITAL_RF_TECH_424F;
		break;
	default:
		pr_err("Unsupported dsi value %d\n", dsi);
		goto exit;
	}

	rc = digital_tg_send_psl_res(ddev, psl_req->did, rf_tech);

exit:
	kfree_skb(resp);
}

static void digital_tg_send_atr_res_complete(struct nfc_digital_dev *ddev,
					     void *arg, struct sk_buff *resp)
{
	int offset;

	if (IS_ERR(resp)) {
		digital_poll_next_tech(ddev);
		return;
	}

	offset = 2;
	if (resp->data[0] == DIGITAL_NFC_DEP_NFCA_SOD_SB)
		offset++;

	if (resp->data[offset] == DIGITAL_CMD_PSL_REQ)
		digital_tg_recv_psl_req(ddev, arg, resp);
	else
		digital_tg_recv_dep_req(ddev, arg, resp);
}

static int digital_tg_send_atr_res(struct nfc_digital_dev *ddev,
				   struct digital_atr_req *atr_req)
{
	struct digital_atr_res *atr_res;
	struct sk_buff *skb;
	u8 *gb;
	size_t gb_len;
	int rc;

	gb = nfc_get_local_general_bytes(ddev->nfc_dev, &gb_len);
	if (!gb)
		gb_len = 0;

	skb = digital_skb_alloc(ddev, sizeof(struct digital_atr_res) + gb_len);
	if (!skb)
		return -ENOMEM;

	skb_put(skb, sizeof(struct digital_atr_res));
	atr_res = (struct digital_atr_res *)skb->data;

	memset(atr_res, 0, sizeof(struct digital_atr_res));

	atr_res->dir = DIGITAL_NFC_DEP_FRAME_DIR_IN;
	atr_res->cmd = DIGITAL_CMD_ATR_RES;
	memcpy(atr_res->nfcid3, atr_req->nfcid3, sizeof(atr_req->nfcid3));
	atr_res->to = 8;
	atr_res->pp = DIGITAL_LR_BITS_PAYLOAD_SIZE_254B;
	if (gb_len) {
		skb_put(skb, gb_len);

		atr_res->pp |= DIGITAL_GB_BIT;
		memcpy(atr_res->gb, gb, gb_len);
	}

	digital_skb_push_dep_sod(ddev, skb);

	ddev->skb_add_crc(skb);

	rc = digital_tg_send_cmd(ddev, skb, 999,
				 digital_tg_send_atr_res_complete, NULL);
	if (rc) {
		kfree_skb(skb);
		return rc;
	}

	return rc;
}

void digital_tg_recv_atr_req(struct nfc_digital_dev *ddev, void *arg,
			     struct sk_buff *resp)
{
	int rc;
	struct digital_atr_req *atr_req;
	size_t gb_len, min_size;
	u8 poll_tech_count;

	if (IS_ERR(resp)) {
		rc = PTR_ERR(resp);
		resp = NULL;
		goto exit;
	}

	if (!resp->len) {
		rc = -EIO;
		goto exit;
	}

	if (resp->data[0] == DIGITAL_NFC_DEP_NFCA_SOD_SB) {
		min_size = DIGITAL_ATR_REQ_MIN_SIZE + 2;
		digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_106A);
	} else {
		min_size = DIGITAL_ATR_REQ_MIN_SIZE + 1;
		digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_212F);
	}

	if (resp->len < min_size) {
		rc = -EIO;
		goto exit;
	}

	ddev->curr_protocol = NFC_PROTO_NFC_DEP_MASK;

	rc = ddev->skb_check_crc(resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.6");
		goto exit;
	}

	rc = digital_skb_pull_dep_sod(ddev, resp);
	if (rc) {
		PROTOCOL_ERR("14.4.1.2");
		goto exit;
	}

	atr_req = (struct digital_atr_req *)resp->data;

	if (atr_req->dir != DIGITAL_NFC_DEP_FRAME_DIR_OUT ||
	    atr_req->cmd != DIGITAL_CMD_ATR_REQ) {
		rc = -EINVAL;
		goto exit;
	}

	rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
				     NFC_DIGITAL_FRAMING_NFC_DEP_ACTIVATED);
	if (rc)
		goto exit;

	rc = digital_tg_send_atr_res(ddev, atr_req);
	if (rc)
		goto exit;

	gb_len = resp->len - sizeof(struct digital_atr_req);

	poll_tech_count = ddev->poll_tech_count;
	ddev->poll_tech_count = 0;

	rc = nfc_tm_activated(ddev->nfc_dev, NFC_PROTO_NFC_DEP_MASK,
			      NFC_COMM_PASSIVE, atr_req->gb, gb_len);
	if (rc) {
		ddev->poll_tech_count = poll_tech_count;
		goto exit;
	}

	rc = 0;
exit:
	if (rc)
		digital_poll_next_tech(ddev);

	dev_kfree_skb(resp);
}
Commit	Line	Data
7d0911c0 TE	1	/*
	2	* NFC Digital Protocol stack
	3	* Copyright (c) 2013, Intel Corporation.
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms and conditions of the GNU General Public License,
	7	* version 2, as published by the Free Software Foundation.
	8	*
	9	* This program is distributed in the hope it will be useful, but WITHOUT
	10	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	11	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	12	* more details.
	13	*
	14	*/
	15
c5da0e4a SO	16	#define pr_fmt(fmt) "digital: %s: " fmt, __func__
c5da0e4a SO	17
7d0911c0 TE	18	#include "digital.h"
	19
	20	#define DIGITAL_NFC_DEP_FRAME_DIR_OUT 0xD4
	21	#define DIGITAL_NFC_DEP_FRAME_DIR_IN 0xD5
	22
	23	#define DIGITAL_NFC_DEP_NFCA_SOD_SB 0xF0
	24
	25	#define DIGITAL_CMD_ATR_REQ 0x00
	26	#define DIGITAL_CMD_ATR_RES 0x01
	27	#define DIGITAL_CMD_PSL_REQ 0x04
	28	#define DIGITAL_CMD_PSL_RES 0x05
	29	#define DIGITAL_CMD_DEP_REQ 0x06
	30	#define DIGITAL_CMD_DEP_RES 0x07
	31
	32	#define DIGITAL_ATR_REQ_MIN_SIZE 16
	33	#define DIGITAL_ATR_REQ_MAX_SIZE 64
	34
7d0911c0	35	#define DIGITAL_LR_BITS_PAYLOAD_SIZE_254B 0x30
dddb3da0 MG	36	#define DIGITAL_FSL_BITS_PAYLOAD_SIZE_254B \
dddb3da0 MG	37	(DIGITAL_LR_BITS_PAYLOAD_SIZE_254B >> 4)
7d0911c0 TE	38	#define DIGITAL_GB_BIT 0x02
	39
	40	#define DIGITAL_NFC_DEP_PFB_TYPE(pfb) ((pfb) & 0xE0)
	41
	42	#define DIGITAL_NFC_DEP_PFB_TIMEOUT_BIT 0x10
	43
	44	#define DIGITAL_NFC_DEP_PFB_IS_TIMEOUT(pfb) \
	45	((pfb) & DIGITAL_NFC_DEP_PFB_TIMEOUT_BIT)
	46	#define DIGITAL_NFC_DEP_MI_BIT_SET(pfb) ((pfb) & 0x10)
	47	#define DIGITAL_NFC_DEP_NAD_BIT_SET(pfb) ((pfb) & 0x08)
	48	#define DIGITAL_NFC_DEP_DID_BIT_SET(pfb) ((pfb) & 0x04)
	49	#define DIGITAL_NFC_DEP_PFB_PNI(pfb) ((pfb) & 0x03)
	50
	51	#define DIGITAL_NFC_DEP_PFB_I_PDU 0x00
	52	#define DIGITAL_NFC_DEP_PFB_ACK_NACK_PDU 0x40
	53	#define DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU 0x80
	54
	55	struct digital_atr_req {
	56	u8 dir;
	57	u8 cmd;
	58	u8 nfcid3[10];
	59	u8 did;
	60	u8 bs;
	61	u8 br;
	62	u8 pp;
	63	u8 gb[0];
	64	} __packed;
	65
	66	struct digital_atr_res {
	67	u8 dir;
	68	u8 cmd;
	69	u8 nfcid3[10];
	70	u8 did;
	71	u8 bs;
	72	u8 br;
	73	u8 to;
	74	u8 pp;
	75	u8 gb[0];
	76	} __packed;
	77
	78	struct digital_psl_req {
	79	u8 dir;
	80	u8 cmd;
	81	u8 did;
	82	u8 brs;
	83	u8 fsl;
	84	} __packed;
	85
	86	struct digital_psl_res {
	87	u8 dir;
	88	u8 cmd;
	89	u8 did;
	90	} __packed;
	91
	92	struct digital_dep_req_res {
	93	u8 dir;
	94	u8 cmd;
	95	u8 pfb;
	96	} __packed;
	97
	98	static void digital_in_recv_dep_res(struct nfc_digital_dev ddev, void arg,
	99	struct sk_buff *resp);
	100
	101	static void digital_skb_push_dep_sod(struct nfc_digital_dev *ddev,
102	struct sk_buff *skb)
103	{
104	skb_push(skb, sizeof(u8));
105
106	skb->data[0] = skb->len;
107
108	if (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)
109	*skb_push(skb, sizeof(u8)) = DIGITAL_NFC_DEP_NFCA_SOD_SB;
110	}
111
112	static int digital_skb_pull_dep_sod(struct nfc_digital_dev *ddev,
113	struct sk_buff *skb)
114	{
115	u8 size;
116
117	if (skb->len < 2)
118	return -EIO;
119
120	if (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)
121	skb_pull(skb, sizeof(u8));
122
123	size = skb->data[0];
124	if (size != skb->len)
125	return -EIO;
126
127	skb_pull(skb, sizeof(u8));
128
129	return 0;
130	}
131
dddb3da0 MG	132	static void digital_in_recv_psl_res(struct nfc_digital_dev ddev, void arg,
	133	struct sk_buff *resp)
	134	{
	135	struct nfc_target *target = arg;
	136	struct digital_psl_res *psl_res;
	137	int rc;
	138
	139	if (IS_ERR(resp)) {
	140	rc = PTR_ERR(resp);
	141	resp = NULL;
	142	goto exit;
	143	}
	144
	145	rc = ddev->skb_check_crc(resp);
	146	if (rc) {
	147	PROTOCOL_ERR("14.4.1.6");
	148	goto exit;
	149	}
	150
	151	rc = digital_skb_pull_dep_sod(ddev, resp);
	152	if (rc) {
	153	PROTOCOL_ERR("14.4.1.2");
	154	goto exit;
	155	}
	156
	157	psl_res = (struct digital_psl_res *)resp->data;
	158
	159	if ((resp->len != sizeof(*psl_res)) \|\|
	160	(psl_res->dir != DIGITAL_NFC_DEP_FRAME_DIR_IN) \|\|
	161	(psl_res->cmd != DIGITAL_CMD_PSL_RES)) {
	162	rc = -EIO;
	163	goto exit;
	164	}
	165
	166	rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
	167	NFC_DIGITAL_RF_TECH_424F);
	168	if (rc)
	169	goto exit;
	170
	171	rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
	172	NFC_DIGITAL_FRAMING_NFCF_NFC_DEP);
	173	if (rc)
	174	goto exit;
	175
	176	if (!DIGITAL_DRV_CAPS_IN_CRC(ddev) &&
	177	(ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)) {
	178	ddev->skb_add_crc = digital_skb_add_crc_f;
	179	ddev->skb_check_crc = digital_skb_check_crc_f;
	180	}
	181
	182	ddev->curr_rf_tech = NFC_DIGITAL_RF_TECH_424F;
	183
	184	nfc_dep_link_is_up(ddev->nfc_dev, target->idx, NFC_COMM_ACTIVE,
	185	NFC_RF_INITIATOR);
	186
	187	ddev->curr_nfc_dep_pni = 0;
	188
	189	exit:
	190	dev_kfree_skb(resp);
	191
	192	if (rc)
	193	ddev->curr_protocol = 0;
	194	}
	195
196	static int digital_in_send_psl_req(struct nfc_digital_dev *ddev,
197	struct nfc_target *target)
198	{
199	struct sk_buff *skb;
200	struct digital_psl_req *psl_req;
201
202	skb = digital_skb_alloc(ddev, sizeof(*psl_req));
203	if (!skb)
204	return -ENOMEM;
205
206	skb_put(skb, sizeof(*psl_req));
207
208	psl_req = (struct digital_psl_req *)skb->data;
209
210	psl_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
211	psl_req->cmd = DIGITAL_CMD_PSL_REQ;
212	psl_req->did = 0;
213	psl_req->brs = (0x2 << 3) \| 0x2; /* 424F both directions */
214	psl_req->fsl = DIGITAL_FSL_BITS_PAYLOAD_SIZE_254B;
215
216	digital_skb_push_dep_sod(ddev, skb);
217
218	ddev->skb_add_crc(skb);
219
220	return digital_in_send_cmd(ddev, skb, 500, digital_in_recv_psl_res,
221	target);
222	}
223
7d0911c0 TE	224	static void digital_in_recv_atr_res(struct nfc_digital_dev ddev, void arg,
	225	struct sk_buff *resp)
	226	{
	227	struct nfc_target *target = arg;
	228	struct digital_atr_res *atr_res;
	229	u8 gb_len;
	230	int rc;
	231
	232	if (IS_ERR(resp)) {
	233	rc = PTR_ERR(resp);
	234	resp = NULL;
	235	goto exit;
	236	}
	237
	238	rc = ddev->skb_check_crc(resp);
	239	if (rc) {
	240	PROTOCOL_ERR("14.4.1.6");
	241	goto exit;
	242	}
	243
	244	rc = digital_skb_pull_dep_sod(ddev, resp);
	245	if (rc) {
	246	PROTOCOL_ERR("14.4.1.2");
	247	goto exit;
	248	}
	249
	250	if (resp->len < sizeof(struct digital_atr_res)) {
	251	rc = -EIO;
	252	goto exit;
	253	}
	254
	255	gb_len = resp->len - sizeof(struct digital_atr_res);
	256
	257	atr_res = (struct digital_atr_res *)resp->data;
	258
	259	rc = nfc_set_remote_general_bytes(ddev->nfc_dev, atr_res->gb, gb_len);
	260	if (rc)
	261	goto exit;
	262
dddb3da0 MG	263	if ((ddev->protocols & NFC_PROTO_FELICA_MASK) &&
	264	(ddev->curr_rf_tech != NFC_DIGITAL_RF_TECH_424F)) {
	265	rc = digital_in_send_psl_req(ddev, target);
	266	if (!rc)
	267	goto exit;
	268	}
	269
7d0911c0 TE	270	rc = nfc_dep_link_is_up(ddev->nfc_dev, target->idx, NFC_COMM_ACTIVE,
	271	NFC_RF_INITIATOR);
	272
	273	ddev->curr_nfc_dep_pni = 0;
	274
	275	exit:
	276	dev_kfree_skb(resp);
	277
	278	if (rc)
	279	ddev->curr_protocol = 0;
	280	}
	281
	282	int digital_in_send_atr_req(struct nfc_digital_dev *ddev,
	283	struct nfc_target target, __u8 comm_mode, __u8 gb,
	284	size_t gb_len)
	285	{
	286	struct sk_buff *skb;
	287	struct digital_atr_req *atr_req;
	288	uint size;
	289
	290	size = DIGITAL_ATR_REQ_MIN_SIZE + gb_len;
	291
	292	if (size > DIGITAL_ATR_REQ_MAX_SIZE) {
	293	PROTOCOL_ERR("14.6.1.1");
	294	return -EINVAL;
	295	}
	296
	297	skb = digital_skb_alloc(ddev, size);
	298	if (!skb)
	299	return -ENOMEM;
	300
	301	skb_put(skb, sizeof(struct digital_atr_req));
	302
	303	atr_req = (struct digital_atr_req *)skb->data;
	304	memset(atr_req, 0, sizeof(struct digital_atr_req));
	305
	306	atr_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
	307	atr_req->cmd = DIGITAL_CMD_ATR_REQ;
	308	if (target->nfcid2_len)
4f319e32	309	memcpy(atr_req->nfcid3, target->nfcid2, NFC_NFCID2_MAXSIZE);
7d0911c0	310	else
4f319e32	311	get_random_bytes(atr_req->nfcid3, NFC_NFCID3_MAXSIZE);
7d0911c0 TE	312
	313	atr_req->did = 0;
	314	atr_req->bs = 0;
	315	atr_req->br = 0;
	316
	317	atr_req->pp = DIGITAL_LR_BITS_PAYLOAD_SIZE_254B;
	318
	319	if (gb_len) {
	320	atr_req->pp \|= DIGITAL_GB_BIT;
	321	memcpy(skb_put(skb, gb_len), gb, gb_len);
	322	}
	323
	324	digital_skb_push_dep_sod(ddev, skb);
	325
	326	ddev->skb_add_crc(skb);
	327
00e625df TE	328	return digital_in_send_cmd(ddev, skb, 500, digital_in_recv_atr_res,
00e625df TE	329	target);
7d0911c0 TE	330	}
	331
	332	static int digital_in_send_rtox(struct nfc_digital_dev *ddev,
	333	struct digital_data_exch *data_exch, u8 rtox)
	334	{
	335	struct digital_dep_req_res *dep_req;
	336	struct sk_buff *skb;
	337	int rc;
	338
	339	skb = digital_skb_alloc(ddev, 1);
	340	if (!skb)
	341	return -ENOMEM;
	342
	343	*skb_put(skb, 1) = rtox;
	344
	345	skb_push(skb, sizeof(struct digital_dep_req_res));
	346
	347	dep_req = (struct digital_dep_req_res *)skb->data;
	348
	349	dep_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
	350	dep_req->cmd = DIGITAL_CMD_DEP_REQ;
	351	dep_req->pfb = DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU \|
	352	DIGITAL_NFC_DEP_PFB_TIMEOUT_BIT;
	353
	354	digital_skb_push_dep_sod(ddev, skb);
	355
	356	ddev->skb_add_crc(skb);
	357
	358	rc = digital_in_send_cmd(ddev, skb, 1500, digital_in_recv_dep_res,
	359	data_exch);
	360
	361	return rc;
	362	}
	363
	364	static void digital_in_recv_dep_res(struct nfc_digital_dev ddev, void arg,
	365	struct sk_buff *resp)
	366	{
	367	struct digital_data_exch *data_exch = arg;
	368	struct digital_dep_req_res *dep_res;
	369	u8 pfb;
	370	uint size;
	371	int rc;
	372
	373	if (IS_ERR(resp)) {
	374	rc = PTR_ERR(resp);
	375	resp = NULL;
	376	goto exit;
	377	}
	378
	379	rc = ddev->skb_check_crc(resp);
	380	if (rc) {
	381	PROTOCOL_ERR("14.4.1.6");
	382	goto error;
	383	}
	384
	385	rc = digital_skb_pull_dep_sod(ddev, resp);
	386	if (rc) {
	387	PROTOCOL_ERR("14.4.1.2");
	388	goto exit;
	389	}
	390
	391	dep_res = (struct digital_dep_req_res *)resp->data;
	392
	393	if (resp->len < sizeof(struct digital_dep_req_res) \|\|
394	dep_res->dir != DIGITAL_NFC_DEP_FRAME_DIR_IN \|\|
395	dep_res->cmd != DIGITAL_CMD_DEP_RES) {
396	rc = -EIO;
397	goto error;
398	}
399
400	pfb = dep_res->pfb;
401
402	switch (DIGITAL_NFC_DEP_PFB_TYPE(pfb)) {
403	case DIGITAL_NFC_DEP_PFB_I_PDU:
404	if (DIGITAL_NFC_DEP_PFB_PNI(pfb) != ddev->curr_nfc_dep_pni) {
405	PROTOCOL_ERR("14.12.3.3");
406	rc = -EIO;
407	goto error;
408	}
409
410	ddev->curr_nfc_dep_pni =
411	DIGITAL_NFC_DEP_PFB_PNI(ddev->curr_nfc_dep_pni + 1);
412	rc = 0;
413	break;
414
415	case DIGITAL_NFC_DEP_PFB_ACK_NACK_PDU:
26042530	416	pr_err("Received a ACK/NACK PDU\n");
7d0911c0 TE	417	rc = -EIO;
	418	goto error;
	419
	420	case DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU:
	421	if (!DIGITAL_NFC_DEP_PFB_IS_TIMEOUT(pfb)) {
	422	rc = -EINVAL;
	423	goto error;
	424	}
	425
	426	rc = digital_in_send_rtox(ddev, data_exch, resp->data[3]);
	427	if (rc)
	428	goto error;
	429
	430	kfree_skb(resp);
	431	return;
	432	}
	433
	434	if (DIGITAL_NFC_DEP_MI_BIT_SET(pfb)) {
26042530	435	pr_err("MI bit set. Chained PDU not supported\n");
7d0911c0 TE	436	rc = -EIO;
	437	goto error;
	438	}
	439
	440	size = sizeof(struct digital_dep_req_res);
	441
	442	if (DIGITAL_NFC_DEP_DID_BIT_SET(pfb))
	443	size++;
	444
	445	if (size > resp->len) {
	446	rc = -EIO;
	447	goto error;
	448	}
	449
	450	skb_pull(resp, size);
	451
	452	exit:
	453	data_exch->cb(data_exch->cb_context, resp, rc);
	454
	455	error:
	456	kfree(data_exch);
	457
	458	if (rc)
	459	kfree_skb(resp);
	460	}
	461
	462	int digital_in_send_dep_req(struct nfc_digital_dev *ddev,
	463	struct nfc_target target, struct sk_buff skb,
	464	struct digital_data_exch *data_exch)
	465	{
	466	struct digital_dep_req_res *dep_req;
	467
	468	skb_push(skb, sizeof(struct digital_dep_req_res));
	469
	470	dep_req = (struct digital_dep_req_res *)skb->data;
	471	dep_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
	472	dep_req->cmd = DIGITAL_CMD_DEP_REQ;
	473	dep_req->pfb = ddev->curr_nfc_dep_pni;
	474
	475	digital_skb_push_dep_sod(ddev, skb);
	476
	477	ddev->skb_add_crc(skb);
	478
	479	return digital_in_send_cmd(ddev, skb, 1500, digital_in_recv_dep_res,
	480	data_exch);
	481	}
1c7a4c24	482
b711ad52 TE	483	static void digital_tg_set_rf_tech(struct nfc_digital_dev *ddev, u8 rf_tech)
	484	{
	485	ddev->curr_rf_tech = rf_tech;
	486
	487	ddev->skb_add_crc = digital_skb_add_crc_none;
	488	ddev->skb_check_crc = digital_skb_check_crc_none;
	489
	490	if (DIGITAL_DRV_CAPS_TG_CRC(ddev))
	491	return;
	492
	493	switch (ddev->curr_rf_tech) {
	494	case NFC_DIGITAL_RF_TECH_106A:
	495	ddev->skb_add_crc = digital_skb_add_crc_a;
	496	ddev->skb_check_crc = digital_skb_check_crc_a;
	497	break;
	498
	499	case NFC_DIGITAL_RF_TECH_212F:
	500	case NFC_DIGITAL_RF_TECH_424F:
	501	ddev->skb_add_crc = digital_skb_add_crc_f;
	502	ddev->skb_check_crc = digital_skb_check_crc_f;
	503	break;
	504
	505	default:
	506	break;
	507	}
	508	}
	509
1c7a4c24 TE	510	static void digital_tg_recv_dep_req(struct nfc_digital_dev ddev, void arg,
	511	struct sk_buff *resp)
	512	{
	513	int rc;
	514	struct digital_dep_req_res *dep_req;
	515	size_t size;
	516
	517	if (IS_ERR(resp)) {
	518	rc = PTR_ERR(resp);
	519	resp = NULL;
	520	goto exit;
	521	}
	522
	523	rc = ddev->skb_check_crc(resp);
	524	if (rc) {
	525	PROTOCOL_ERR("14.4.1.6");
	526	goto exit;
	527	}
	528
	529	rc = digital_skb_pull_dep_sod(ddev, resp);
	530	if (rc) {
	531	PROTOCOL_ERR("14.4.1.2");
	532	goto exit;
	533	}
	534
	535	size = sizeof(struct digital_dep_req_res);
	536	dep_req = (struct digital_dep_req_res *)resp->data;
	537
	538	if (resp->len < size \|\| dep_req->dir != DIGITAL_NFC_DEP_FRAME_DIR_OUT \|\|
	539	dep_req->cmd != DIGITAL_CMD_DEP_REQ) {
	540	rc = -EIO;
	541	goto exit;
	542	}
	543
	544	if (DIGITAL_NFC_DEP_DID_BIT_SET(dep_req->pfb))
	545	size++;
	546
	547	if (resp->len < size) {
	548	rc = -EIO;
	549	goto exit;
	550	}
	551
	552	switch (DIGITAL_NFC_DEP_PFB_TYPE(dep_req->pfb)) {
	553	case DIGITAL_NFC_DEP_PFB_I_PDU:
26042530	554	pr_debug("DIGITAL_NFC_DEP_PFB_I_PDU\n");
1c7a4c24 TE	555	ddev->curr_nfc_dep_pni = DIGITAL_NFC_DEP_PFB_PNI(dep_req->pfb);
	556	break;
	557	case DIGITAL_NFC_DEP_PFB_ACK_NACK_PDU:
26042530	558	pr_err("Received a ACK/NACK PDU\n");
1c7a4c24 TE	559	rc = -EINVAL;
1c7a4c24 TE	560	goto exit;
1c7a4c24	561	case DIGITAL_NFC_DEP_PFB_SUPERVISOR_PDU:
26042530	562	pr_err("Received a SUPERVISOR PDU\n");
1c7a4c24 TE	563	rc = -EINVAL;
1c7a4c24 TE	564	goto exit;
1c7a4c24 TE	565	}
	566
	567	skb_pull(resp, size);
	568
	569	rc = nfc_tm_data_received(ddev->nfc_dev, resp);
	570
	571	exit:
	572	if (rc)
	573	kfree_skb(resp);
	574	}
	575
	576	int digital_tg_send_dep_res(struct nfc_digital_dev ddev, struct sk_buff skb)
	577	{
	578	struct digital_dep_req_res *dep_res;
	579
	580	skb_push(skb, sizeof(struct digital_dep_req_res));
	581	dep_res = (struct digital_dep_req_res *)skb->data;
	582
	583	dep_res->dir = DIGITAL_NFC_DEP_FRAME_DIR_IN;
	584	dep_res->cmd = DIGITAL_CMD_DEP_RES;
	585	dep_res->pfb = ddev->curr_nfc_dep_pni;
	586
	587	digital_skb_push_dep_sod(ddev, skb);
	588
	589	ddev->skb_add_crc(skb);
	590
	591	return digital_tg_send_cmd(ddev, skb, 1500, digital_tg_recv_dep_req,
	592	NULL);
	593	}
	594
	595	static void digital_tg_send_psl_res_complete(struct nfc_digital_dev *ddev,
	596	void arg, struct sk_buff resp)
	597	{
67af1d7a	598	u8 rf_tech = (unsigned long)arg;
1c7a4c24 TE	599
	600	if (IS_ERR(resp))
	601	return;
	602
b711ad52 TE	603	digital_tg_set_rf_tech(ddev, rf_tech);
b711ad52 TE	604
1c7a4c24 TE	605	digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);
	606
	607	digital_tg_listen(ddev, 1500, digital_tg_recv_dep_req, NULL);
	608
	609	dev_kfree_skb(resp);
	610	}
	611
	612	static int digital_tg_send_psl_res(struct nfc_digital_dev *ddev, u8 did,
	613	u8 rf_tech)
	614	{
	615	struct digital_psl_res *psl_res;
	616	struct sk_buff *skb;
	617	int rc;
	618
	619	skb = digital_skb_alloc(ddev, sizeof(struct digital_psl_res));
	620	if (!skb)
	621	return -ENOMEM;
	622
	623	skb_put(skb, sizeof(struct digital_psl_res));
	624
	625	psl_res = (struct digital_psl_res *)skb->data;
	626
	627	psl_res->dir = DIGITAL_NFC_DEP_FRAME_DIR_IN;
	628	psl_res->cmd = DIGITAL_CMD_PSL_RES;
	629	psl_res->did = did;
	630
	631	digital_skb_push_dep_sod(ddev, skb);
	632
	633	ddev->skb_add_crc(skb);
	634
	635	rc = digital_tg_send_cmd(ddev, skb, 0, digital_tg_send_psl_res_complete,
67af1d7a	636	(void *)(unsigned long)rf_tech);
1c7a4c24 TE	637
	638	if (rc)
	639	kfree_skb(skb);
	640
	641	return rc;
	642	}
	643
	644	static void digital_tg_recv_psl_req(struct nfc_digital_dev ddev, void arg,
	645	struct sk_buff *resp)
	646	{
	647	int rc;
	648	struct digital_psl_req *psl_req;
	649	u8 rf_tech;
	650	u8 dsi;
	651
	652	if (IS_ERR(resp)) {
	653	rc = PTR_ERR(resp);
	654	resp = NULL;
	655	goto exit;
	656	}
	657
	658	rc = ddev->skb_check_crc(resp);
	659	if (rc) {
	660	PROTOCOL_ERR("14.4.1.6");
	661	goto exit;
	662	}
	663
	664	rc = digital_skb_pull_dep_sod(ddev, resp);
	665	if (rc) {
	666	PROTOCOL_ERR("14.4.1.2");
	667	goto exit;
	668	}
	669
	670	psl_req = (struct digital_psl_req *)resp->data;
	671
	672	if (resp->len != sizeof(struct digital_psl_req) \|\|
	673	psl_req->dir != DIGITAL_NFC_DEP_FRAME_DIR_OUT \|\|
	674	psl_req->cmd != DIGITAL_CMD_PSL_REQ) {
	675	rc = -EIO;
	676	goto exit;
	677	}
	678
	679	dsi = (psl_req->brs >> 3) & 0x07;
	680	switch (dsi) {
	681	case 0:
	682	rf_tech = NFC_DIGITAL_RF_TECH_106A;
	683	break;
	684	case 1:
	685	rf_tech = NFC_DIGITAL_RF_TECH_212F;
	686	break;
	687	case 2:
	688	rf_tech = NFC_DIGITAL_RF_TECH_424F;
	689	break;
	690	default:
77d84ff8	691	pr_err("Unsupported dsi value %d\n", dsi);
1c7a4c24 TE	692	goto exit;
	693	}
	694
	695	rc = digital_tg_send_psl_res(ddev, psl_req->did, rf_tech);
	696
	697	exit:
	698	kfree_skb(resp);
	699	}
	700
	701	static void digital_tg_send_atr_res_complete(struct nfc_digital_dev *ddev,
	702	void arg, struct sk_buff resp)
	703	{
	704	int offset;
	705
	706	if (IS_ERR(resp)) {
	707	digital_poll_next_tech(ddev);
	708	return;
	709	}
	710
	711	offset = 2;
	712	if (resp->data[0] == DIGITAL_NFC_DEP_NFCA_SOD_SB)
	713	offset++;
	714
	715	if (resp->data[offset] == DIGITAL_CMD_PSL_REQ)
	716	digital_tg_recv_psl_req(ddev, arg, resp);
	717	else
	718	digital_tg_recv_dep_req(ddev, arg, resp);
	719	}
	720
	721	static int digital_tg_send_atr_res(struct nfc_digital_dev *ddev,
	722	struct digital_atr_req *atr_req)
	723	{
	724	struct digital_atr_res *atr_res;
	725	struct sk_buff *skb;
	726	u8 *gb;
	727	size_t gb_len;
	728	int rc;
	729
	730	gb = nfc_get_local_general_bytes(ddev->nfc_dev, &gb_len);
	731	if (!gb)
	732	gb_len = 0;
	733
	734	skb = digital_skb_alloc(ddev, sizeof(struct digital_atr_res) + gb_len);
	735	if (!skb)
	736	return -ENOMEM;
	737
	738	skb_put(skb, sizeof(struct digital_atr_res));
	739	atr_res = (struct digital_atr_res *)skb->data;
	740
	741	memset(atr_res, 0, sizeof(struct digital_atr_res));
	742
	743	atr_res->dir = DIGITAL_NFC_DEP_FRAME_DIR_IN;
	744	atr_res->cmd = DIGITAL_CMD_ATR_RES;
	745	memcpy(atr_res->nfcid3, atr_req->nfcid3, sizeof(atr_req->nfcid3));
	746	atr_res->to = 8;
	747	atr_res->pp = DIGITAL_LR_BITS_PAYLOAD_SIZE_254B;
	748	if (gb_len) {
	749	skb_put(skb, gb_len);
	750
	751	atr_res->pp \|= DIGITAL_GB_BIT;
	752	memcpy(atr_res->gb, gb, gb_len);
	753	}
	754
	755	digital_skb_push_dep_sod(ddev, skb);
756
757	ddev->skb_add_crc(skb);
758
759	rc = digital_tg_send_cmd(ddev, skb, 999,
760	digital_tg_send_atr_res_complete, NULL);
761	if (rc) {
762	kfree_skb(skb);
763	return rc;
764	}
765
766	return rc;
767	}
768
769	void digital_tg_recv_atr_req(struct nfc_digital_dev ddev, void arg,
770	struct sk_buff *resp)
771	{
772	int rc;
773	struct digital_atr_req *atr_req;
774	size_t gb_len, min_size;
0529a7ad	775	u8 poll_tech_count;
1c7a4c24 TE	776
	777	if (IS_ERR(resp)) {
	778	rc = PTR_ERR(resp);
	779	resp = NULL;
	780	goto exit;
	781	}
	782
	783	if (!resp->len) {
	784	rc = -EIO;
	785	goto exit;
	786	}
	787
	788	if (resp->data[0] == DIGITAL_NFC_DEP_NFCA_SOD_SB) {
	789	min_size = DIGITAL_ATR_REQ_MIN_SIZE + 2;
b711ad52	790	digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_106A);
1c7a4c24 TE	791	} else {
1c7a4c24 TE	792	min_size = DIGITAL_ATR_REQ_MIN_SIZE + 1;
b711ad52	793	digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_212F);
1c7a4c24 TE	794	}
	795
	796	if (resp->len < min_size) {
	797	rc = -EIO;
	798	goto exit;
	799	}
	800
48e10445	801	ddev->curr_protocol = NFC_PROTO_NFC_DEP_MASK;
1c7a4c24 TE	802
	803	rc = ddev->skb_check_crc(resp);
	804	if (rc) {
	805	PROTOCOL_ERR("14.4.1.6");
	806	goto exit;
	807	}
	808
	809	rc = digital_skb_pull_dep_sod(ddev, resp);
	810	if (rc) {
	811	PROTOCOL_ERR("14.4.1.2");
	812	goto exit;
	813	}
	814
	815	atr_req = (struct digital_atr_req *)resp->data;
	816
	817	if (atr_req->dir != DIGITAL_NFC_DEP_FRAME_DIR_OUT \|\|
	818	atr_req->cmd != DIGITAL_CMD_ATR_REQ) {
	819	rc = -EINVAL;
	820	goto exit;
	821	}
	822
	823	rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
	824	NFC_DIGITAL_FRAMING_NFC_DEP_ACTIVATED);
	825	if (rc)
	826	goto exit;
	827
	828	rc = digital_tg_send_atr_res(ddev, atr_req);
	829	if (rc)
	830	goto exit;
	831
	832	gb_len = resp->len - sizeof(struct digital_atr_req);
0529a7ad MG	833
	834	poll_tech_count = ddev->poll_tech_count;
	835	ddev->poll_tech_count = 0;
	836
1c7a4c24 TE	837	rc = nfc_tm_activated(ddev->nfc_dev, NFC_PROTO_NFC_DEP_MASK,
1c7a4c24 TE	838	NFC_COMM_PASSIVE, atr_req->gb, gb_len);
0529a7ad MG	839	if (rc) {
0529a7ad MG	840	ddev->poll_tech_count = poll_tech_count;
1c7a4c24	841	goto exit;
0529a7ad	842	}
1c7a4c24 TE	843
	844	rc = 0;
	845	exit:
	846	if (rc)
	847	digital_poll_next_tech(ddev);
	848
	849	dev_kfree_skb(resp);
	850	}