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 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
30 #include <linux/types.h>
31 #include <linux/interrupt.h>
32 #include <linux/bitops.h>
33 #include <linux/skbuff.h>
36 #include <net/nfc/nci.h>
37 #include <net/nfc/nci_core.h>
38 #include <linux/nfc.h>
40 /* Handle NCI Notification packets */
42 static void nci_core_conn_credits_ntf_packet(struct nci_dev
*ndev
,
45 struct nci_core_conn_credit_ntf
*ntf
= (void *) skb
->data
;
48 pr_debug("entry, num_entries %d\n", ntf
->num_entries
);
50 if (ntf
->num_entries
> NCI_MAX_NUM_CONN
)
51 ntf
->num_entries
= NCI_MAX_NUM_CONN
;
53 /* update the credits */
54 for (i
= 0; i
< ntf
->num_entries
; i
++) {
55 pr_debug("entry[%d]: conn_id %d, credits %d\n",
56 i
, ntf
->conn_entries
[i
].conn_id
,
57 ntf
->conn_entries
[i
].credits
);
59 if (ntf
->conn_entries
[i
].conn_id
== NCI_STATIC_RF_CONN_ID
) {
60 /* found static rf connection */
61 atomic_add(ntf
->conn_entries
[i
].credits
,
66 /* trigger the next tx */
67 if (!skb_queue_empty(&ndev
->tx_q
))
68 queue_work(ndev
->tx_wq
, &ndev
->tx_work
);
71 static __u8
*nci_extract_rf_params_nfca_passive_poll(struct nci_dev
*ndev
,
72 struct nci_rf_intf_activated_ntf
*ntf
, __u8
*data
)
74 struct rf_tech_specific_params_nfca_poll
*nfca_poll
;
76 nfca_poll
= &ntf
->rf_tech_specific_params
.nfca_poll
;
78 nfca_poll
->sens_res
= __le16_to_cpu(*((__u16
*)data
));
81 nfca_poll
->nfcid1_len
= *data
++;
83 pr_debug("sens_res 0x%x, nfcid1_len %d\n",
84 nfca_poll
->sens_res
, nfca_poll
->nfcid1_len
);
86 memcpy(nfca_poll
->nfcid1
, data
, nfca_poll
->nfcid1_len
);
87 data
+= nfca_poll
->nfcid1_len
;
89 nfca_poll
->sel_res_len
= *data
++;
91 if (nfca_poll
->sel_res_len
!= 0)
92 nfca_poll
->sel_res
= *data
++;
94 pr_debug("sel_res_len %d, sel_res 0x%x\n",
95 nfca_poll
->sel_res_len
,
101 static int nci_extract_activation_params_iso_dep(struct nci_dev
*ndev
,
102 struct nci_rf_intf_activated_ntf
*ntf
, __u8
*data
)
104 struct activation_params_nfca_poll_iso_dep
*nfca_poll
;
106 switch (ntf
->activation_rf_tech_and_mode
) {
107 case NCI_NFC_A_PASSIVE_POLL_MODE
:
108 nfca_poll
= &ntf
->activation_params
.nfca_poll_iso_dep
;
109 nfca_poll
->rats_res_len
= *data
++;
110 if (nfca_poll
->rats_res_len
> 0) {
111 memcpy(nfca_poll
->rats_res
,
113 nfca_poll
->rats_res_len
);
118 pr_err("unsupported activation_rf_tech_and_mode 0x%x\n",
119 ntf
->activation_rf_tech_and_mode
);
126 static void nci_target_found(struct nci_dev
*ndev
,
127 struct nci_rf_intf_activated_ntf
*ntf
)
129 struct nfc_target nfc_tgt
;
131 if (ntf
->rf_protocol
== NCI_RF_PROTOCOL_T2T
) /* T2T MifareUL */
132 nfc_tgt
.supported_protocols
= NFC_PROTO_MIFARE_MASK
;
133 else if (ntf
->rf_protocol
== NCI_RF_PROTOCOL_ISO_DEP
) /* 4A */
134 nfc_tgt
.supported_protocols
= NFC_PROTO_ISO14443_MASK
;
136 nfc_tgt
.supported_protocols
= 0;
138 nfc_tgt
.sens_res
= ntf
->rf_tech_specific_params
.nfca_poll
.sens_res
;
139 nfc_tgt
.sel_res
= ntf
->rf_tech_specific_params
.nfca_poll
.sel_res
;
141 if (!(nfc_tgt
.supported_protocols
& ndev
->poll_prots
)) {
142 pr_debug("the target found does not have the desired protocol\n");
146 pr_debug("new target found, supported_protocols 0x%x\n",
147 nfc_tgt
.supported_protocols
);
149 ndev
->target_available_prots
= nfc_tgt
.supported_protocols
;
151 nfc_targets_found(ndev
->nfc_dev
, &nfc_tgt
, 1);
154 static void nci_rf_intf_activated_ntf_packet(struct nci_dev
*ndev
,
157 struct nci_rf_intf_activated_ntf ntf
;
158 __u8
*data
= skb
->data
;
161 clear_bit(NCI_DISCOVERY
, &ndev
->flags
);
162 set_bit(NCI_POLL_ACTIVE
, &ndev
->flags
);
164 ntf
.rf_discovery_id
= *data
++;
165 ntf
.rf_interface_type
= *data
++;
166 ntf
.rf_protocol
= *data
++;
167 ntf
.activation_rf_tech_and_mode
= *data
++;
168 ntf
.rf_tech_specific_params_len
= *data
++;
170 pr_debug("rf_discovery_id %d\n", ntf
.rf_discovery_id
);
171 pr_debug("rf_interface_type 0x%x\n", ntf
.rf_interface_type
);
172 pr_debug("rf_protocol 0x%x\n", ntf
.rf_protocol
);
173 pr_debug("activation_rf_tech_and_mode 0x%x\n",
174 ntf
.activation_rf_tech_and_mode
);
175 pr_debug("rf_tech_specific_params_len %d\n",
176 ntf
.rf_tech_specific_params_len
);
178 if (ntf
.rf_tech_specific_params_len
> 0) {
179 switch (ntf
.activation_rf_tech_and_mode
) {
180 case NCI_NFC_A_PASSIVE_POLL_MODE
:
181 data
= nci_extract_rf_params_nfca_passive_poll(ndev
,
186 pr_err("unsupported activation_rf_tech_and_mode 0x%x\n",
187 ntf
.activation_rf_tech_and_mode
);
192 ntf
.data_exch_rf_tech_and_mode
= *data
++;
193 ntf
.data_exch_tx_bit_rate
= *data
++;
194 ntf
.data_exch_rx_bit_rate
= *data
++;
195 ntf
.activation_params_len
= *data
++;
197 pr_debug("data_exch_rf_tech_and_mode 0x%x\n",
198 ntf
.data_exch_rf_tech_and_mode
);
199 pr_debug("data_exch_tx_bit_rate 0x%x\n",
200 ntf
.data_exch_tx_bit_rate
);
201 pr_debug("data_exch_rx_bit_rate 0x%x\n",
202 ntf
.data_exch_rx_bit_rate
);
203 pr_debug("activation_params_len %d\n",
204 ntf
.activation_params_len
);
206 if (ntf
.activation_params_len
> 0) {
207 switch (ntf
.rf_interface_type
) {
208 case NCI_RF_INTERFACE_ISO_DEP
:
209 err
= nci_extract_activation_params_iso_dep(ndev
,
213 case NCI_RF_INTERFACE_FRAME
:
214 /* no activation params */
218 pr_err("unsupported rf_interface_type 0x%x\n",
219 ntf
.rf_interface_type
);
225 nci_target_found(ndev
, &ntf
);
228 static void nci_rf_deactivate_ntf_packet(struct nci_dev
*ndev
,
231 struct nci_rf_deactivate_ntf
*ntf
= (void *) skb
->data
;
233 pr_debug("entry, type 0x%x, reason 0x%x\n", ntf
->type
, ntf
->reason
);
235 clear_bit(NCI_POLL_ACTIVE
, &ndev
->flags
);
236 ndev
->target_active_prot
= 0;
238 /* drop tx data queue */
239 skb_queue_purge(&ndev
->tx_q
);
241 /* drop partial rx data packet */
242 if (ndev
->rx_data_reassembly
) {
243 kfree_skb(ndev
->rx_data_reassembly
);
244 ndev
->rx_data_reassembly
= 0;
247 /* set the available credits to initial value */
248 atomic_set(&ndev
->credits_cnt
, ndev
->initial_num_credits
);
250 /* complete the data exchange transaction, if exists */
251 if (test_bit(NCI_DATA_EXCHANGE
, &ndev
->flags
))
252 nci_data_exchange_complete(ndev
, NULL
, -EIO
);
255 void nci_ntf_packet(struct nci_dev
*ndev
, struct sk_buff
*skb
)
257 __u16 ntf_opcode
= nci_opcode(skb
->data
);
259 pr_debug("NCI RX: MT=ntf, PBF=%d, GID=0x%x, OID=0x%x, plen=%d\n",
261 nci_opcode_gid(ntf_opcode
),
262 nci_opcode_oid(ntf_opcode
),
263 nci_plen(skb
->data
));
265 /* strip the nci control header */
266 skb_pull(skb
, NCI_CTRL_HDR_SIZE
);
268 switch (ntf_opcode
) {
269 case NCI_OP_CORE_CONN_CREDITS_NTF
:
270 nci_core_conn_credits_ntf_packet(ndev
, skb
);
273 case NCI_OP_RF_INTF_ACTIVATED_NTF
:
274 nci_rf_intf_activated_ntf_packet(ndev
, skb
);
277 case NCI_OP_RF_DEACTIVATE_NTF
:
278 nci_rf_deactivate_ntf_packet(ndev
, skb
);
282 pr_err("unknown ntf opcode 0x%x\n", ntf_opcode
);