data.c revision 24bf33048579096958083449c9f5a68f9c5c0d6d
16a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* 26a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * The NFC Controller Interface is the communication protocol between an 36a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * NFC Controller (NFCC) and a Device Host (DH). 46a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * 56a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * Copyright (C) 2011 Texas Instruments, Inc. 66a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * 76a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * Written by Ilan Elias <ilane@ti.com> 86a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * 96a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * This program is free software; you can redistribute it and/or modify 106a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * it under the terms of the GNU General Public License version 2 116a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * as published by the Free Software Foundation 126a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * 136a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * This program is distributed in the hope that it will be useful, 146a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * but WITHOUT ANY WARRANTY; without even the implied warranty of 156a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 166a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * GNU General Public License for more details. 176a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * 186a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * You should have received a copy of the GNU General Public License 196a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * along with this program; if not, write to the Free Software 206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * 226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias */ 236a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 24ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 25ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches 266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/types.h> 276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/interrupt.h> 286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/wait.h> 296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/bitops.h> 306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/skbuff.h> 316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include "../nfc.h" 336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <net/nfc/nci.h> 346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <net/nfc/nci_core.h> 356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/nfc.h> 366a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 376a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Complete data exchange transaction and forward skb to nfc core */ 386a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasvoid nci_data_exchange_complete(struct nci_dev *ndev, 396a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb, 406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int err) 416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias data_exchange_cb_t cb = ndev->data_exchange_cb; 436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias void *cb_context = ndev->data_exchange_cb_context; 446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 4524bf33048579096958083449c9f5a68f9c5c0d6dJoe Perches pr_debug("len %d, err %d\n", skb ? skb->len : 0, err); 466a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 476a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (cb) { 486a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->data_exchange_cb = NULL; 496a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->data_exchange_cb_context = 0; 506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 516a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* forward skb to nfc core */ 526a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias cb(cb_context, skb, err); 536a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } else if (skb) { 54ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches pr_err("no rx callback, dropping rx data...\n"); 556a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 566a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* no waiting callback, free skb */ 576a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 586a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 5938f04c6b1b682f1879441e2925403ad9aff9e229Ilan Elias 6038f04c6b1b682f1879441e2925403ad9aff9e229Ilan Elias clear_bit(NCI_DATA_EXCHANGE, &ndev->flags); 616a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 626a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 636a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* ----------------- NCI TX Data ----------------- */ 646a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 656a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic inline void nci_push_data_hdr(struct nci_dev *ndev, 666a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 conn_id, 676a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb, 686a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 pbf) 696a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 706a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct nci_data_hdr *hdr; 716a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int plen = skb->len; 726a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 736a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr = (struct nci_data_hdr *) skb_push(skb, NCI_DATA_HDR_SIZE); 746a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->conn_id = conn_id; 756a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->rfu = 0; 766a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->plen = plen; 776a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 786a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_mt_set((__u8 *)hdr, NCI_MT_DATA_PKT); 796a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_pbf_set((__u8 *)hdr, pbf); 806a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 816a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb->dev = (void *) ndev; 826a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 836a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 846a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic int nci_queue_tx_data_frags(struct nci_dev *ndev, 856a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 conn_id, 866a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb) { 876a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int total_len = skb->len; 886a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias unsigned char *data = skb->data; 896a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias unsigned long flags; 906a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff_head frags_q; 916a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb_frag; 926a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int frag_len; 936a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int rc = 0; 946a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 9524bf33048579096958083449c9f5a68f9c5c0d6dJoe Perches pr_debug("conn_id 0x%x, total_len %d\n", conn_id, total_len); 966a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 976a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_head_init(&frags_q); 986a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 996a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while (total_len) { 100e8c0dacd9836dc2dcb28d236c9cc3cfaa9965a20Ilan Elias frag_len = 101e8c0dacd9836dc2dcb28d236c9cc3cfaa9965a20Ilan Elias min_t(int, total_len, ndev->max_data_pkt_payload_size); 1026a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1036a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_frag = nci_skb_alloc(ndev, 1046a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias (NCI_DATA_HDR_SIZE + frag_len), 1056a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias GFP_KERNEL); 1066a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (skb_frag == NULL) { 1076a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias rc = -ENOMEM; 1086a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto free_exit; 1096a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1106a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_reserve(skb_frag, NCI_DATA_HDR_SIZE); 1116a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1126a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* first, copy the data */ 1136a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias memcpy(skb_put(skb_frag, frag_len), data, frag_len); 1146a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1156a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* second, set the header */ 1166a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_push_data_hdr(ndev, conn_id, skb_frag, 1176a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ((total_len == frag_len) ? (NCI_PBF_LAST) : (NCI_PBF_CONT))); 1186a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1196a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_tail(&frags_q, skb_frag); 1206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias data += frag_len; 1226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias total_len -= frag_len; 1236a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 12420c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches pr_debug("frag_len %d, remaining total_len %d\n", 12520c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches frag_len, total_len); 1266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* queue all fragments atomically */ 1296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias spin_lock_irqsave(&ndev->tx_q.lock, flags); 1306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while ((skb_frag = __skb_dequeue(&frags_q)) != NULL) 1326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_tail(&ndev->tx_q, skb_frag); 1336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias spin_unlock_irqrestore(&ndev->tx_q.lock, flags); 1356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1366a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* free the original skb */ 1376a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1386a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1396a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 1406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasfree_exit: 1426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while ((skb_frag = __skb_dequeue(&frags_q)) != NULL) 1436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb_frag); 1446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1456a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 1466a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return rc; 1476a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 1486a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1496a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Send NCI data */ 1506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasint nci_send_data(struct nci_dev *ndev, __u8 conn_id, struct sk_buff *skb) 1516a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 1526a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int rc = 0; 1536a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 15424bf33048579096958083449c9f5a68f9c5c0d6dJoe Perches pr_debug("conn_id 0x%x, plen %d\n", conn_id, skb->len); 1556a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1566a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* check if the packet need to be fragmented */ 157e8c0dacd9836dc2dcb28d236c9cc3cfaa9965a20Ilan Elias if (skb->len <= ndev->max_data_pkt_payload_size) { 1586a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* no need to fragment packet */ 1596a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_push_data_hdr(ndev, conn_id, skb, NCI_PBF_LAST); 1606a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1616a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_queue_tail(&ndev->tx_q, skb); 1626a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } else { 1636a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* fragment packet and queue the fragments */ 1646a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias rc = nci_queue_tx_data_frags(ndev, conn_id, skb); 1656a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (rc) { 166ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches pr_err("failed to fragment tx data packet\n"); 1676a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto free_exit; 1686a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1696a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1706a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1716a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias queue_work(ndev->tx_wq, &ndev->tx_work); 1726a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1736a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 1746a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1756a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasfree_exit: 1766a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1776a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1786a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 1796a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return rc; 1806a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 1816a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1826a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* ----------------- NCI RX Data ----------------- */ 1836a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1846a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic void nci_add_rx_data_frag(struct nci_dev *ndev, 1856a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb, 1866a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 pbf) 1876a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 1886a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int reassembly_len; 1896a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int err = 0; 1906a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1916a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (ndev->rx_data_reassembly) { 1926a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias reassembly_len = ndev->rx_data_reassembly->len; 1936a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1946a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* first, make enough room for the already accumulated data */ 1956a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (skb_cow_head(skb, reassembly_len)) { 196ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches pr_err("error adding room for accumulated rx data\n"); 1976a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1986a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1996a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb = 0; 2006a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2016a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(ndev->rx_data_reassembly); 2026a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly = 0; 2036a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2046a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias err = -ENOMEM; 2056a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 2066a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2076a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2086a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* second, combine the two fragments */ 2096a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias memcpy(skb_push(skb, reassembly_len), 2106a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly->data, 2116a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias reassembly_len); 2126a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2136a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* third, free old reassembly */ 2146a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(ndev->rx_data_reassembly); 2156a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly = 0; 2166a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2176a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2186a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (pbf == NCI_PBF_CONT) { 2196a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* need to wait for next fragment, store skb and exit */ 2206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly = skb; 2216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return; 2226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2236a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2246a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 2256a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_data_exchange_complete(ndev, skb, err); 2266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 2276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Rx Data packet */ 2296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasvoid nci_rx_data_packet(struct nci_dev *ndev, struct sk_buff *skb) 2306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 2316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 pbf = nci_pbf(skb->data); 2326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 23324bf33048579096958083449c9f5a68f9c5c0d6dJoe Perches pr_debug("len %d\n", skb->len); 2346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 23520c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches pr_debug("NCI RX: MT=data, PBF=%d, conn_id=%d, plen=%d\n", 23620c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches nci_pbf(skb->data), 23720c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches nci_conn_id(skb->data), 23820c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches nci_plen(skb->data)); 2396a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* strip the nci data header */ 2416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_pull(skb, NCI_DATA_HDR_SIZE); 2426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (ndev->target_active_prot == NFC_PROTO_MIFARE) { 2446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* frame I/F => remove the status byte */ 24520c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches pr_debug("NFC_PROTO_MIFARE => remove the status byte\n"); 2466a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_trim(skb, (skb->len - 1)); 2476a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2486a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2496a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_add_rx_data_frag(ndev, skb, pbf); 2506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 251