data.c revision 6a2968aaf50c7a22fced77a5e24aa636281efca8
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 246a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/types.h> 256a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/interrupt.h> 266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/wait.h> 276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/bitops.h> 286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/skbuff.h> 296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include "../nfc.h" 316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <net/nfc/nci.h> 326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <net/nfc/nci_core.h> 336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/nfc.h> 346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Complete data exchange transaction and forward skb to nfc core */ 366a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasvoid nci_data_exchange_complete(struct nci_dev *ndev, 376a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb, 386a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int err) 396a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias data_exchange_cb_t cb = ndev->data_exchange_cb; 416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias void *cb_context = ndev->data_exchange_cb_context; 426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_dbg("entry, len %d, err %d", ((skb) ? (skb->len) : (0)), err); 446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 456a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (cb) { 466a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->data_exchange_cb = NULL; 476a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->data_exchange_cb_context = 0; 486a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 496a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* forward skb to nfc core */ 506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias cb(cb_context, skb, err); 516a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } else if (skb) { 526a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_err("no rx callback, dropping rx data..."); 536a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 546a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* no waiting callback, free skb */ 556a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 566a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 576a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 586a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 596a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* ----------------- NCI TX Data ----------------- */ 606a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 616a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic inline void nci_push_data_hdr(struct nci_dev *ndev, 626a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 conn_id, 636a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb, 646a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 pbf) 656a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 666a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct nci_data_hdr *hdr; 676a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int plen = skb->len; 686a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 696a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr = (struct nci_data_hdr *) skb_push(skb, NCI_DATA_HDR_SIZE); 706a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->conn_id = conn_id; 716a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->rfu = 0; 726a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->plen = plen; 736a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 746a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_mt_set((__u8 *)hdr, NCI_MT_DATA_PKT); 756a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_pbf_set((__u8 *)hdr, pbf); 766a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 776a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb->dev = (void *) ndev; 786a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 796a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 806a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic int nci_queue_tx_data_frags(struct nci_dev *ndev, 816a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 conn_id, 826a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb) { 836a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int total_len = skb->len; 846a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias unsigned char *data = skb->data; 856a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias unsigned long flags; 866a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff_head frags_q; 876a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb_frag; 886a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int frag_len; 896a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int rc = 0; 906a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 916a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_dbg("entry, conn_id 0x%x, total_len %d", conn_id, total_len); 926a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 936a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_head_init(&frags_q); 946a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 956a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while (total_len) { 966a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias frag_len = min_t(int, total_len, ndev->max_pkt_payload_size); 976a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 986a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_frag = nci_skb_alloc(ndev, 996a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias (NCI_DATA_HDR_SIZE + frag_len), 1006a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias GFP_KERNEL); 1016a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (skb_frag == NULL) { 1026a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias rc = -ENOMEM; 1036a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto free_exit; 1046a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1056a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_reserve(skb_frag, NCI_DATA_HDR_SIZE); 1066a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1076a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* first, copy the data */ 1086a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias memcpy(skb_put(skb_frag, frag_len), data, frag_len); 1096a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1106a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* second, set the header */ 1116a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_push_data_hdr(ndev, conn_id, skb_frag, 1126a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ((total_len == frag_len) ? (NCI_PBF_LAST) : (NCI_PBF_CONT))); 1136a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1146a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_tail(&frags_q, skb_frag); 1156a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1166a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias data += frag_len; 1176a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias total_len -= frag_len; 1186a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1196a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_dbg("frag_len %d, remaining total_len %d", 1206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias frag_len, total_len); 1216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1236a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* queue all fragments atomically */ 1246a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias spin_lock_irqsave(&ndev->tx_q.lock, flags); 1256a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while ((skb_frag = __skb_dequeue(&frags_q)) != NULL) 1276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_tail(&ndev->tx_q, skb_frag); 1286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias spin_unlock_irqrestore(&ndev->tx_q.lock, flags); 1306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* free the original skb */ 1326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 1356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1366a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasfree_exit: 1376a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while ((skb_frag = __skb_dequeue(&frags_q)) != NULL) 1386a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb_frag); 1396a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 1416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return rc; 1426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 1436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Send NCI data */ 1456a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasint nci_send_data(struct nci_dev *ndev, __u8 conn_id, struct sk_buff *skb) 1466a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 1476a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int rc = 0; 1486a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1496a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_dbg("entry, conn_id 0x%x, plen %d", conn_id, skb->len); 1506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1516a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* check if the packet need to be fragmented */ 1526a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (skb->len <= ndev->max_pkt_payload_size) { 1536a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* no need to fragment packet */ 1546a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_push_data_hdr(ndev, conn_id, skb, NCI_PBF_LAST); 1556a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1566a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_queue_tail(&ndev->tx_q, skb); 1576a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } else { 1586a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* fragment packet and queue the fragments */ 1596a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias rc = nci_queue_tx_data_frags(ndev, conn_id, skb); 1606a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (rc) { 1616a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_err("failed to fragment tx data packet"); 1626a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto free_exit; 1636a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1646a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1656a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1666a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias queue_work(ndev->tx_wq, &ndev->tx_work); 1676a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1686a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 1696a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1706a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasfree_exit: 1716a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1726a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1736a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 1746a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return rc; 1756a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 1766a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1776a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* ----------------- NCI RX Data ----------------- */ 1786a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1796a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic void nci_add_rx_data_frag(struct nci_dev *ndev, 1806a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct sk_buff *skb, 1816a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 pbf) 1826a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 1836a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int reassembly_len; 1846a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int err = 0; 1856a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1866a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (ndev->rx_data_reassembly) { 1876a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias reassembly_len = ndev->rx_data_reassembly->len; 1886a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1896a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* first, make enough room for the already accumulated data */ 1906a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (skb_cow_head(skb, reassembly_len)) { 1916a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_err("error adding room for accumulated rx data"); 1926a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1936a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1946a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb = 0; 1956a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1966a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(ndev->rx_data_reassembly); 1976a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly = 0; 1986a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1996a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias err = -ENOMEM; 2006a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 2016a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2026a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2036a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* second, combine the two fragments */ 2046a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias memcpy(skb_push(skb, reassembly_len), 2056a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly->data, 2066a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias reassembly_len); 2076a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2086a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* third, free old reassembly */ 2096a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(ndev->rx_data_reassembly); 2106a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly = 0; 2116a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2126a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2136a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (pbf == NCI_PBF_CONT) { 2146a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* need to wait for next fragment, store skb and exit */ 2156a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly = skb; 2166a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return; 2176a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2186a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2196a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 2206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_data_exchange_complete(ndev, skb, err); 2216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 2226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2236a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Rx Data packet */ 2246a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasvoid nci_rx_data_packet(struct nci_dev *ndev, struct sk_buff *skb) 2256a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 2266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 pbf = nci_pbf(skb->data); 2276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_dbg("entry, len %d", skb->len); 2296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_dbg("NCI RX: MT=data, PBF=%d, conn_id=%d, plen=%d", 2316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_pbf(skb->data), 2326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_conn_id(skb->data), 2336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_plen(skb->data)); 2346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* strip the nci data header */ 2366a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_pull(skb, NCI_DATA_HDR_SIZE); 2376a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2386a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (ndev->target_active_prot == NFC_PROTO_MIFARE) { 2396a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* frame I/F => remove the status byte */ 2406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nfc_dbg("NFC_PROTO_MIFARE => remove the status byte"); 2416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_trim(skb, (skb->len - 1)); 2426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_add_rx_data_frag(ndev, skb, pbf); 2456a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 246