2 * The NFC Controller Interface is the communication protocol between an
3 * NFC Controller (NFCC) and a Device Host (DH).
5 * Copyright (C) 2011 Texas Instruments, Inc.
7 * Written by Ilan Elias <ilane@ti.com>
10 * This file is based on hci_event.c, which was written
11 * by Maxim Krasnyansky.
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License version 2
15 * as published by the Free Software Foundation
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
28 #include <linux/types.h>
29 #include <linux/interrupt.h>
30 #include <linux/bitops.h>
31 #include <linux/skbuff.h>
34 #include <net/nfc/nci.h>
35 #include <net/nfc/nci_core.h>
37 /* Handle NCI Response packets */
39 static void nci_core_reset_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
41 struct nci_core_reset_rsp *rsp = (void *) skb->data;
43 nfc_dbg("entry, status 0x%x", rsp->status);
45 if (rsp->status == NCI_STATUS_OK) {
46 ndev->nci_ver = rsp->nci_ver;
47 nfc_dbg("nci_ver 0x%x, config_status 0x%x",
48 rsp->nci_ver, rsp->config_status);
51 nci_req_complete(ndev, rsp->status);
54 static void nci_core_init_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
56 struct nci_core_init_rsp_1 *rsp_1 = (void *) skb->data;
57 struct nci_core_init_rsp_2 *rsp_2;
59 nfc_dbg("entry, status 0x%x", rsp_1->status);
61 if (rsp_1->status != NCI_STATUS_OK)
64 ndev->nfcc_features = __le32_to_cpu(rsp_1->nfcc_features);
65 ndev->num_supported_rf_interfaces = rsp_1->num_supported_rf_interfaces;
67 if (ndev->num_supported_rf_interfaces >
68 NCI_MAX_SUPPORTED_RF_INTERFACES) {
69 ndev->num_supported_rf_interfaces =
70 NCI_MAX_SUPPORTED_RF_INTERFACES;
73 memcpy(ndev->supported_rf_interfaces,
74 rsp_1->supported_rf_interfaces,
75 ndev->num_supported_rf_interfaces);
77 rsp_2 = (void *) (skb->data + 6 + rsp_1->num_supported_rf_interfaces);
79 ndev->max_logical_connections =
80 rsp_2->max_logical_connections;
81 ndev->max_routing_table_size =
82 __le16_to_cpu(rsp_2->max_routing_table_size);
83 ndev->max_ctrl_pkt_payload_len =
84 rsp_2->max_ctrl_pkt_payload_len;
85 ndev->max_size_for_large_params =
86 __le16_to_cpu(rsp_2->max_size_for_large_params);
87 ndev->max_data_pkt_payload_size =
88 rsp_2->max_data_pkt_payload_size;
89 ndev->initial_num_credits =
90 rsp_2->initial_num_credits;
93 ndev->manufact_specific_info =
94 __le32_to_cpu(rsp_2->manufact_specific_info);
96 atomic_set(&ndev->credits_cnt, ndev->initial_num_credits);
98 nfc_dbg("nfcc_features 0x%x",
100 nfc_dbg("num_supported_rf_interfaces %d",
101 ndev->num_supported_rf_interfaces);
102 nfc_dbg("supported_rf_interfaces[0] 0x%x",
103 ndev->supported_rf_interfaces[0]);
104 nfc_dbg("supported_rf_interfaces[1] 0x%x",
105 ndev->supported_rf_interfaces[1]);
106 nfc_dbg("supported_rf_interfaces[2] 0x%x",
107 ndev->supported_rf_interfaces[2]);
108 nfc_dbg("supported_rf_interfaces[3] 0x%x",
109 ndev->supported_rf_interfaces[3]);
110 nfc_dbg("max_logical_connections %d",
111 ndev->max_logical_connections);
112 nfc_dbg("max_routing_table_size %d",
113 ndev->max_routing_table_size);
114 nfc_dbg("max_ctrl_pkt_payload_len %d",
115 ndev->max_ctrl_pkt_payload_len);
116 nfc_dbg("max_size_for_large_params %d",
117 ndev->max_size_for_large_params);
118 nfc_dbg("max_data_pkt_payload_size %d",
119 ndev->max_data_pkt_payload_size);
120 nfc_dbg("initial_num_credits %d",
121 ndev->initial_num_credits);
122 nfc_dbg("manufact_id 0x%x",
124 nfc_dbg("manufact_specific_info 0x%x",
125 ndev->manufact_specific_info);
128 nci_req_complete(ndev, rsp_1->status);
131 static void nci_rf_disc_map_rsp_packet(struct nci_dev *ndev,
134 __u8 status = skb->data[0];
136 nfc_dbg("entry, status 0x%x", status);
138 nci_req_complete(ndev, status);
141 static void nci_rf_disc_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
143 __u8 status = skb->data[0];
145 nfc_dbg("entry, status 0x%x", status);
147 if (status == NCI_STATUS_OK)
148 set_bit(NCI_DISCOVERY, &ndev->flags);
150 nci_req_complete(ndev, status);
153 static void nci_rf_deactivate_rsp_packet(struct nci_dev *ndev,
156 __u8 status = skb->data[0];
158 nfc_dbg("entry, status 0x%x", status);
160 clear_bit(NCI_DISCOVERY, &ndev->flags);
162 nci_req_complete(ndev, status);
165 void nci_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
167 __u16 rsp_opcode = nci_opcode(skb->data);
169 /* we got a rsp, stop the cmd timer */
170 del_timer(&ndev->cmd_timer);
172 nfc_dbg("NCI RX: MT=rsp, PBF=%d, GID=0x%x, OID=0x%x, plen=%d",
174 nci_opcode_gid(rsp_opcode),
175 nci_opcode_oid(rsp_opcode),
176 nci_plen(skb->data));
178 /* strip the nci control header */
179 skb_pull(skb, NCI_CTRL_HDR_SIZE);
181 switch (rsp_opcode) {
182 case NCI_OP_CORE_RESET_RSP:
183 nci_core_reset_rsp_packet(ndev, skb);
186 case NCI_OP_CORE_INIT_RSP:
187 nci_core_init_rsp_packet(ndev, skb);
190 case NCI_OP_RF_DISCOVER_MAP_RSP:
191 nci_rf_disc_map_rsp_packet(ndev, skb);
194 case NCI_OP_RF_DISCOVER_RSP:
195 nci_rf_disc_rsp_packet(ndev, skb);
198 case NCI_OP_RF_DEACTIVATE_RSP:
199 nci_rf_deactivate_rsp_packet(ndev, skb);
203 nfc_err("unknown rsp opcode 0x%x", rsp_opcode);
209 /* trigger the next cmd */
210 atomic_set(&ndev->cmd_cnt, 1);
211 if (!skb_queue_empty(&ndev->cmd_q))
212 queue_work(ndev->cmd_wq, &ndev->cmd_work);