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 1998b32decc83ed3137e3ddbc918b102f8fc406b6dJeff Kirsher * along with this program; if not, see <http://www.gnu.org/licenses/>. 206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias * 216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias */ 226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2352858b51b2c779a8f9db32accf774b165522ad81Samuel Ortiz#define pr_fmt(fmt) KBUILD_MODNAME ": %s: " fmt, __func__ 24ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches 256a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/types.h> 266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/interrupt.h> 276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/wait.h> 286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/bitops.h> 296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/skbuff.h> 306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include "../nfc.h" 326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <net/nfc/nci.h> 336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <net/nfc/nci_core.h> 346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias#include <linux/nfc.h> 356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 366a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Complete data exchange transaction and forward skb to nfc core */ 37eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortizvoid nci_data_exchange_complete(struct nci_dev *ndev, 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 4324bf33048579096958083449c9f5a68f9c5c0d6dJoe Perches pr_debug("len %d, err %d\n", skb ? skb->len : 0, err); 446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 45c4bf98b220cba7a8618405261d69ee53a265110eIlan Elias /* data exchange is complete, stop the data timer */ 46c4bf98b220cba7a8618405261d69ee53a265110eIlan Elias del_timer_sync(&ndev->data_timer); 47c4bf98b220cba7a8618405261d69ee53a265110eIlan Elias clear_bit(NCI_DATA_EXCHANGE_TO, &ndev->flags); 48c4bf98b220cba7a8618405261d69ee53a265110eIlan Elias 496a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (cb) { 506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->data_exchange_cb = NULL; 51040487f364e03fc4d9fcab5549618642cc3f6fe7H Hartley Sweeten ndev->data_exchange_cb_context = NULL; 526a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 536a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* forward skb to nfc core */ 546a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias cb(cb_context, skb, err); 556a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } else if (skb) { 56ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches pr_err("no rx callback, dropping rx data...\n"); 576a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 586a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* no waiting callback, free skb */ 596a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 606a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 6138f04c6b1b682f1879441e2925403ad9aff9e229Ilan Elias 6238f04c6b1b682f1879441e2925403ad9aff9e229Ilan Elias clear_bit(NCI_DATA_EXCHANGE, &ndev->flags); 636a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 646a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 656a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* ----------------- NCI TX Data ----------------- */ 666a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 676a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic inline void nci_push_data_hdr(struct nci_dev *ndev, 68eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz __u8 conn_id, 69eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz struct sk_buff *skb, 70eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz __u8 pbf) 716a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 726a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias struct nci_data_hdr *hdr; 736a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int plen = skb->len; 746a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 756a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr = (struct nci_data_hdr *) skb_push(skb, NCI_DATA_HDR_SIZE); 766a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->conn_id = conn_id; 776a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->rfu = 0; 786a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias hdr->plen = plen; 796a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 806a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_mt_set((__u8 *)hdr, NCI_MT_DATA_PKT); 816a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_pbf_set((__u8 *)hdr, pbf); 826a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 836a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 846a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic int nci_queue_tx_data_frags(struct nci_dev *ndev, 85eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz __u8 conn_id, 86eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz 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, 104eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz (NCI_DATA_HDR_SIZE + frag_len), 105eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz 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, 117eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz ((total_len == frag_len) ? 118eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz (NCI_PBF_LAST) : (NCI_PBF_CONT))); 1196a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_tail(&frags_q, skb_frag); 1216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias data += frag_len; 1236a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias total_len -= frag_len; 1246a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 12520c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches pr_debug("frag_len %d, remaining total_len %d\n", 12620c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches frag_len, total_len); 1276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* queue all fragments atomically */ 1306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias spin_lock_irqsave(&ndev->tx_q.lock, flags); 1316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while ((skb_frag = __skb_dequeue(&frags_q)) != NULL) 1336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __skb_queue_tail(&ndev->tx_q, skb_frag); 1346a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias spin_unlock_irqrestore(&ndev->tx_q.lock, flags); 1366a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1376a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* free the original skb */ 1386a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1396a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 1416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasfree_exit: 1436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias while ((skb_frag = __skb_dequeue(&frags_q)) != NULL) 1446a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb_frag); 1456a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1466a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 1476a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return rc; 1486a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 1496a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Send NCI data */ 1516a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasint nci_send_data(struct nci_dev *ndev, __u8 conn_id, struct sk_buff *skb) 1526a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 1536a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int rc = 0; 1546a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 15524bf33048579096958083449c9f5a68f9c5c0d6dJoe Perches pr_debug("conn_id 0x%x, plen %d\n", conn_id, skb->len); 1566a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1576a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* check if the packet need to be fragmented */ 158e8c0dacd9836dc2dcb28d236c9cc3cfaa9965a20Ilan Elias if (skb->len <= ndev->max_data_pkt_payload_size) { 1596a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* no need to fragment packet */ 1606a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_push_data_hdr(ndev, conn_id, skb, NCI_PBF_LAST); 1616a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1626a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_queue_tail(&ndev->tx_q, skb); 1636a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } else { 1646a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* fragment packet and queue the fragments */ 1656a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias rc = nci_queue_tx_data_frags(ndev, conn_id, skb); 1666a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (rc) { 167ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches pr_err("failed to fragment tx data packet\n"); 1686a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto free_exit; 1696a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1706a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 1716a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1726a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias queue_work(ndev->tx_wq, &ndev->tx_work); 1736a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1746a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 1756a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1766a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasfree_exit: 1776a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 1786a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1796a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 1806a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return rc; 1816a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 1826a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1836a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* ----------------- NCI RX Data ----------------- */ 1846a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1856a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasstatic void nci_add_rx_data_frag(struct nci_dev *ndev, 186eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz struct sk_buff *skb, 187eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz __u8 pbf) 1886a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 1896a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int reassembly_len; 1906a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias int err = 0; 1916a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1926a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (ndev->rx_data_reassembly) { 1936a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias reassembly_len = ndev->rx_data_reassembly->len; 1946a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1956a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* first, make enough room for the already accumulated data */ 1966a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (skb_cow_head(skb, reassembly_len)) { 197ed1e0ad8816389ceefa2d94a9a3d3520088e410fJoe Perches pr_err("error adding room for accumulated rx data\n"); 1986a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 1996a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(skb); 200040487f364e03fc4d9fcab5549618642cc3f6fe7H Hartley Sweeten skb = NULL; 2016a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2026a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(ndev->rx_data_reassembly); 203040487f364e03fc4d9fcab5549618642cc3f6fe7H Hartley Sweeten ndev->rx_data_reassembly = NULL; 2046a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2056a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias err = -ENOMEM; 2066a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias goto exit; 2076a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2086a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2096a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* second, combine the two fragments */ 2106a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias memcpy(skb_push(skb, reassembly_len), 211eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz ndev->rx_data_reassembly->data, 212eb9bc6e9a0ac668d2283b8fea1534f8ba31d1692Samuel Ortiz reassembly_len); 2136a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2146a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* third, free old reassembly */ 2156a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias kfree_skb(ndev->rx_data_reassembly); 216040487f364e03fc4d9fcab5549618642cc3f6fe7H Hartley Sweeten ndev->rx_data_reassembly = NULL; 2176a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2186a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2196a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias if (pbf == NCI_PBF_CONT) { 2206a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* need to wait for next fragment, store skb and exit */ 2216a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias ndev->rx_data_reassembly = skb; 2226a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias return; 2236a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2246a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2256a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasexit: 2266a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_data_exchange_complete(ndev, skb, err); 2276a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 2286a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2296a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias/* Rx Data packet */ 2306a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Eliasvoid nci_rx_data_packet(struct nci_dev *ndev, struct sk_buff *skb) 2316a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias{ 2326a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias __u8 pbf = nci_pbf(skb->data); 2336a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 23424bf33048579096958083449c9f5a68f9c5c0d6dJoe Perches pr_debug("len %d\n", skb->len); 2356a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 23620c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches pr_debug("NCI RX: MT=data, PBF=%d, conn_id=%d, plen=%d\n", 23720c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches nci_pbf(skb->data), 23820c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches nci_conn_id(skb->data), 23920c239c1390bd6f3bb389fe1a7e8307f29f52563Joe Perches nci_plen(skb->data)); 2406a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2416a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* strip the nci data header */ 2426a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_pull(skb, NCI_DATA_HDR_SIZE); 2436a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 24483724c3329c93f9efc7f53498edd4c538e724366Vincent Cuissard if (ndev->target_active_prot == NFC_PROTO_MIFARE || 24583724c3329c93f9efc7f53498edd4c538e724366Vincent Cuissard ndev->target_active_prot == NFC_PROTO_JEWEL || 24683724c3329c93f9efc7f53498edd4c538e724366Vincent Cuissard ndev->target_active_prot == NFC_PROTO_FELICA || 24783724c3329c93f9efc7f53498edd4c538e724366Vincent Cuissard ndev->target_active_prot == NFC_PROTO_ISO15693) { 2486a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias /* frame I/F => remove the status byte */ 24983724c3329c93f9efc7f53498edd4c538e724366Vincent Cuissard pr_debug("frame I/F => remove the status byte\n"); 2506a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias skb_trim(skb, (skb->len - 1)); 2516a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias } 2526a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias 2536a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias nci_add_rx_data_frag(ndev, skb, pbf); 2546a2968aaf50c7a22fced77a5e24aa636281efca8Ilan Elias} 255