aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/nfc/pn544/pn544.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/nfc/pn544/pn544.c')
-rw-r--r--drivers/nfc/pn544/pn544.c862
1 files changed, 862 insertions, 0 deletions
diff --git a/drivers/nfc/pn544/pn544.c b/drivers/nfc/pn544/pn544.c
new file mode 100644
index 000000000000..cf344450815c
--- /dev/null
+++ b/drivers/nfc/pn544/pn544.c
@@ -0,0 +1,862 @@
1/*
2 * HCI based Driver for NXP PN544 NFC Chip
3 *
4 * Copyright (C) 2012 Intel Corporation. All rights reserved.
5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms and conditions of the GNU General Public License,
8 * version 2, as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the
17 * Free Software Foundation, Inc.,
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20
21#include <linux/delay.h>
22#include <linux/slab.h>
23
24#include <linux/nfc.h>
25#include <net/nfc/hci.h>
26#include <net/nfc/llc.h>
27
28#include "pn544.h"
29
30/* Timing restrictions (ms) */
31#define PN544_HCI_RESETVEN_TIME 30
32
33#define HCI_MODE 0
34#define FW_MODE 1
35
36enum pn544_state {
37 PN544_ST_COLD,
38 PN544_ST_FW_READY,
39 PN544_ST_READY,
40};
41
42#define FULL_VERSION_LEN 11
43
44/* Proprietary commands */
45#define PN544_WRITE 0x3f
46
47/* Proprietary gates, events, commands and registers */
48
49/* NFC_HCI_RF_READER_A_GATE additional registers and commands */
50#define PN544_RF_READER_A_AUTO_ACTIVATION 0x10
51#define PN544_RF_READER_A_CMD_CONTINUE_ACTIVATION 0x12
52#define PN544_MIFARE_CMD 0x21
53
54/* Commands that apply to all RF readers */
55#define PN544_RF_READER_CMD_PRESENCE_CHECK 0x30
56#define PN544_RF_READER_CMD_ACTIVATE_NEXT 0x32
57
58/* NFC_HCI_ID_MGMT_GATE additional registers */
59#define PN544_ID_MGMT_FULL_VERSION_SW 0x10
60
61#define PN544_RF_READER_ISO15693_GATE 0x12
62
63#define PN544_RF_READER_F_GATE 0x14
64#define PN544_FELICA_ID 0x04
65#define PN544_FELICA_RAW 0x20
66
67#define PN544_RF_READER_JEWEL_GATE 0x15
68#define PN544_JEWEL_RAW_CMD 0x23
69
70#define PN544_RF_READER_NFCIP1_INITIATOR_GATE 0x30
71#define PN544_RF_READER_NFCIP1_TARGET_GATE 0x31
72
73#define PN544_SYS_MGMT_GATE 0x90
74#define PN544_SYS_MGMT_INFO_NOTIFICATION 0x02
75
76#define PN544_POLLING_LOOP_MGMT_GATE 0x94
77#define PN544_DEP_MODE 0x01
78#define PN544_DEP_ATR_REQ 0x02
79#define PN544_DEP_ATR_RES 0x03
80#define PN544_DEP_MERGE 0x0D
81#define PN544_PL_RDPHASES 0x06
82#define PN544_PL_EMULATION 0x07
83#define PN544_PL_NFCT_DEACTIVATED 0x09
84
85#define PN544_SWP_MGMT_GATE 0xA0
86
87#define PN544_NFC_WI_MGMT_GATE 0xA1
88
89#define PN544_HCI_EVT_SND_DATA 0x01
90#define PN544_HCI_EVT_ACTIVATED 0x02
91#define PN544_HCI_EVT_DEACTIVATED 0x03
92#define PN544_HCI_EVT_RCV_DATA 0x04
93#define PN544_HCI_EVT_CONTINUE_MI 0x05
94
95#define PN544_HCI_CMD_ATTREQUEST 0x12
96#define PN544_HCI_CMD_CONTINUE_ACTIVATION 0x13
97
98static struct nfc_hci_gate pn544_gates[] = {
99 {NFC_HCI_ADMIN_GATE, NFC_HCI_INVALID_PIPE},
100 {NFC_HCI_LOOPBACK_GATE, NFC_HCI_INVALID_PIPE},
101 {NFC_HCI_ID_MGMT_GATE, NFC_HCI_INVALID_PIPE},
102 {NFC_HCI_LINK_MGMT_GATE, NFC_HCI_INVALID_PIPE},
103 {NFC_HCI_RF_READER_B_GATE, NFC_HCI_INVALID_PIPE},
104 {NFC_HCI_RF_READER_A_GATE, NFC_HCI_INVALID_PIPE},
105 {PN544_SYS_MGMT_GATE, NFC_HCI_INVALID_PIPE},
106 {PN544_SWP_MGMT_GATE, NFC_HCI_INVALID_PIPE},
107 {PN544_POLLING_LOOP_MGMT_GATE, NFC_HCI_INVALID_PIPE},
108 {PN544_NFC_WI_MGMT_GATE, NFC_HCI_INVALID_PIPE},
109 {PN544_RF_READER_F_GATE, NFC_HCI_INVALID_PIPE},
110 {PN544_RF_READER_JEWEL_GATE, NFC_HCI_INVALID_PIPE},
111 {PN544_RF_READER_ISO15693_GATE, NFC_HCI_INVALID_PIPE},
112 {PN544_RF_READER_NFCIP1_INITIATOR_GATE, NFC_HCI_INVALID_PIPE},
113 {PN544_RF_READER_NFCIP1_TARGET_GATE, NFC_HCI_INVALID_PIPE}
114};
115
116/* Largest headroom needed for outgoing custom commands */
117#define PN544_CMDS_HEADROOM 2
118
119struct pn544_hci_info {
120 struct nfc_phy_ops *phy_ops;
121 void *phy_id;
122
123 struct nfc_hci_dev *hdev;
124
125 enum pn544_state state;
126
127 struct mutex info_lock;
128
129 int async_cb_type;
130 data_exchange_cb_t async_cb;
131 void *async_cb_context;
132};
133
134static int pn544_hci_open(struct nfc_hci_dev *hdev)
135{
136 struct pn544_hci_info *info = nfc_hci_get_clientdata(hdev);
137 int r = 0;
138
139 mutex_lock(&info->info_lock);
140
141 if (info->state != PN544_ST_COLD) {
142 r = -EBUSY;
143 goto out;
144 }
145
146 r = info->phy_ops->enable(info->phy_id);
147
148 if (r == 0)
149 info->state = PN544_ST_READY;
150
151out:
152 mutex_unlock(&info->info_lock);
153 return r;
154}
155
156static void pn544_hci_close(struct nfc_hci_dev *hdev)
157{
158 struct pn544_hci_info *info = nfc_hci_get_clientdata(hdev);
159
160 mutex_lock(&info->info_lock);
161
162 if (info->state == PN544_ST_COLD)
163 goto out;
164
165 info->phy_ops->disable(info->phy_id);
166
167 info->state = PN544_ST_COLD;
168
169out:
170 mutex_unlock(&info->info_lock);
171}
172
173static int pn544_hci_ready(struct nfc_hci_dev *hdev)
174{
175 struct sk_buff *skb;
176 static struct hw_config {
177 u8 adr[2];
178 u8 value;
179 } hw_config[] = {
180 {{0x9f, 0x9a}, 0x00},
181
182 {{0x98, 0x10}, 0xbc},
183
184 {{0x9e, 0x71}, 0x00},
185
186 {{0x98, 0x09}, 0x00},
187
188 {{0x9e, 0xb4}, 0x00},
189
190 {{0x9e, 0xd9}, 0xff},
191 {{0x9e, 0xda}, 0xff},
192 {{0x9e, 0xdb}, 0x23},
193 {{0x9e, 0xdc}, 0x21},
194 {{0x9e, 0xdd}, 0x22},
195 {{0x9e, 0xde}, 0x24},
196
197 {{0x9c, 0x01}, 0x08},
198
199 {{0x9e, 0xaa}, 0x01},
200
201 {{0x9b, 0xd1}, 0x0d},
202 {{0x9b, 0xd2}, 0x24},
203 {{0x9b, 0xd3}, 0x0a},
204 {{0x9b, 0xd4}, 0x22},
205 {{0x9b, 0xd5}, 0x08},
206 {{0x9b, 0xd6}, 0x1e},
207 {{0x9b, 0xdd}, 0x1c},
208
209 {{0x9b, 0x84}, 0x13},
210 {{0x99, 0x81}, 0x7f},
211 {{0x99, 0x31}, 0x70},
212
213 {{0x98, 0x00}, 0x3f},
214
215 {{0x9f, 0x09}, 0x00},
216
217 {{0x9f, 0x0a}, 0x05},
218
219 {{0x9e, 0xd1}, 0xa1},
220 {{0x99, 0x23}, 0x00},
221
222 {{0x9e, 0x74}, 0x80},
223
224 {{0x9f, 0x28}, 0x10},
225
226 {{0x9f, 0x35}, 0x14},
227
228 {{0x9f, 0x36}, 0x60},
229
230 {{0x9c, 0x31}, 0x00},
231
232 {{0x9c, 0x32}, 0xc8},
233
234 {{0x9c, 0x19}, 0x40},
235
236 {{0x9c, 0x1a}, 0x40},
237
238 {{0x9c, 0x0c}, 0x00},
239
240 {{0x9c, 0x0d}, 0x00},
241
242 {{0x9c, 0x12}, 0x00},
243
244 {{0x9c, 0x13}, 0x00},
245
246 {{0x98, 0xa2}, 0x0e},
247
248 {{0x98, 0x93}, 0x40},
249
250 {{0x98, 0x7d}, 0x02},
251 {{0x98, 0x7e}, 0x00},
252 {{0x9f, 0xc8}, 0x01},
253 };
254 struct hw_config *p = hw_config;
255 int count = ARRAY_SIZE(hw_config);
256 struct sk_buff *res_skb;
257 u8 param[4];
258 int r;
259
260 param[0] = 0;
261 while (count--) {
262 param[1] = p->adr[0];
263 param[2] = p->adr[1];
264 param[3] = p->value;
265
266 r = nfc_hci_send_cmd(hdev, PN544_SYS_MGMT_GATE, PN544_WRITE,
267 param, 4, &res_skb);
268 if (r < 0)
269 return r;
270
271 if (res_skb->len != 1) {
272 kfree_skb(res_skb);
273 return -EPROTO;
274 }
275
276 if (res_skb->data[0] != p->value) {
277 kfree_skb(res_skb);
278 return -EIO;
279 }
280
281 kfree_skb(res_skb);
282
283 p++;
284 }
285
286 param[0] = NFC_HCI_UICC_HOST_ID;
287 r = nfc_hci_set_param(hdev, NFC_HCI_ADMIN_GATE,
288 NFC_HCI_ADMIN_WHITELIST, param, 1);
289 if (r < 0)
290 return r;
291
292 param[0] = 0x3d;
293 r = nfc_hci_set_param(hdev, PN544_SYS_MGMT_GATE,
294 PN544_SYS_MGMT_INFO_NOTIFICATION, param, 1);
295 if (r < 0)
296 return r;
297
298 param[0] = 0x0;
299 r = nfc_hci_set_param(hdev, NFC_HCI_RF_READER_A_GATE,
300 PN544_RF_READER_A_AUTO_ACTIVATION, param, 1);
301 if (r < 0)
302 return r;
303
304 r = nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE,
305 NFC_HCI_EVT_END_OPERATION, NULL, 0);
306 if (r < 0)
307 return r;
308
309 param[0] = 0x1;
310 r = nfc_hci_set_param(hdev, PN544_POLLING_LOOP_MGMT_GATE,
311 PN544_PL_NFCT_DEACTIVATED, param, 1);
312 if (r < 0)
313 return r;
314
315 param[0] = 0x0;
316 r = nfc_hci_set_param(hdev, PN544_POLLING_LOOP_MGMT_GATE,
317 PN544_PL_RDPHASES, param, 1);
318 if (r < 0)
319 return r;
320
321 r = nfc_hci_get_param(hdev, NFC_HCI_ID_MGMT_GATE,
322 PN544_ID_MGMT_FULL_VERSION_SW, &skb);
323 if (r < 0)
324 return r;
325
326 if (skb->len != FULL_VERSION_LEN) {
327 kfree_skb(skb);
328 return -EINVAL;
329 }
330
331 print_hex_dump(KERN_DEBUG, "FULL VERSION SOFTWARE INFO: ",
332 DUMP_PREFIX_NONE, 16, 1,
333 skb->data, FULL_VERSION_LEN, false);
334
335 kfree_skb(skb);
336
337 return 0;
338}
339
340static int pn544_hci_xmit(struct nfc_hci_dev *hdev, struct sk_buff *skb)
341{
342 struct pn544_hci_info *info = nfc_hci_get_clientdata(hdev);
343
344 return info->phy_ops->write(info->phy_id, skb);
345}
346
347static int pn544_hci_start_poll(struct nfc_hci_dev *hdev,
348 u32 im_protocols, u32 tm_protocols)
349{
350 u8 phases = 0;
351 int r;
352 u8 duration[2];
353 u8 activated;
354 u8 i_mode = 0x3f; /* Enable all supported modes */
355 u8 t_mode = 0x0f;
356 u8 t_merge = 0x01; /* Enable merge by default */
357
358 pr_info(DRIVER_DESC ": %s protocols 0x%x 0x%x\n",
359 __func__, im_protocols, tm_protocols);
360
361 r = nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE,
362 NFC_HCI_EVT_END_OPERATION, NULL, 0);
363 if (r < 0)
364 return r;
365
366 duration[0] = 0x18;
367 duration[1] = 0x6a;
368 r = nfc_hci_set_param(hdev, PN544_POLLING_LOOP_MGMT_GATE,
369 PN544_PL_EMULATION, duration, 2);
370 if (r < 0)
371 return r;
372
373 activated = 0;
374 r = nfc_hci_set_param(hdev, PN544_POLLING_LOOP_MGMT_GATE,
375 PN544_PL_NFCT_DEACTIVATED, &activated, 1);
376 if (r < 0)
377 return r;
378
379 if (im_protocols & (NFC_PROTO_ISO14443_MASK | NFC_PROTO_MIFARE_MASK |
380 NFC_PROTO_JEWEL_MASK))
381 phases |= 1; /* Type A */
382 if (im_protocols & NFC_PROTO_FELICA_MASK) {
383 phases |= (1 << 2); /* Type F 212 */
384 phases |= (1 << 3); /* Type F 424 */
385 }
386
387 phases |= (1 << 5); /* NFC active */
388
389 r = nfc_hci_set_param(hdev, PN544_POLLING_LOOP_MGMT_GATE,
390 PN544_PL_RDPHASES, &phases, 1);
391 if (r < 0)
392 return r;
393
394 if ((im_protocols | tm_protocols) & NFC_PROTO_NFC_DEP_MASK) {
395 hdev->gb = nfc_get_local_general_bytes(hdev->ndev,
396 &hdev->gb_len);
397 pr_debug("generate local bytes %p", hdev->gb);
398 if (hdev->gb == NULL || hdev->gb_len == 0) {
399 im_protocols &= ~NFC_PROTO_NFC_DEP_MASK;
400 tm_protocols &= ~NFC_PROTO_NFC_DEP_MASK;
401 }
402 }
403
404 if (im_protocols & NFC_PROTO_NFC_DEP_MASK) {
405 r = nfc_hci_send_event(hdev,
406 PN544_RF_READER_NFCIP1_INITIATOR_GATE,
407 NFC_HCI_EVT_END_OPERATION, NULL, 0);
408 if (r < 0)
409 return r;
410
411 r = nfc_hci_set_param(hdev,
412 PN544_RF_READER_NFCIP1_INITIATOR_GATE,
413 PN544_DEP_MODE, &i_mode, 1);
414 if (r < 0)
415 return r;
416
417 r = nfc_hci_set_param(hdev,
418 PN544_RF_READER_NFCIP1_INITIATOR_GATE,
419 PN544_DEP_ATR_REQ, hdev->gb, hdev->gb_len);
420 if (r < 0)
421 return r;
422
423 r = nfc_hci_send_event(hdev,
424 PN544_RF_READER_NFCIP1_INITIATOR_GATE,
425 NFC_HCI_EVT_READER_REQUESTED, NULL, 0);
426 if (r < 0)
427 nfc_hci_send_event(hdev,
428 PN544_RF_READER_NFCIP1_INITIATOR_GATE,
429 NFC_HCI_EVT_END_OPERATION, NULL, 0);
430 }
431
432 if (tm_protocols & NFC_PROTO_NFC_DEP_MASK) {
433 r = nfc_hci_set_param(hdev, PN544_RF_READER_NFCIP1_TARGET_GATE,
434 PN544_DEP_MODE, &t_mode, 1);
435 if (r < 0)
436 return r;
437
438 r = nfc_hci_set_param(hdev, PN544_RF_READER_NFCIP1_TARGET_GATE,
439 PN544_DEP_ATR_RES, hdev->gb, hdev->gb_len);
440 if (r < 0)
441 return r;
442
443 r = nfc_hci_set_param(hdev, PN544_RF_READER_NFCIP1_TARGET_GATE,
444 PN544_DEP_MERGE, &t_merge, 1);
445 if (r < 0)
446 return r;
447 }
448
449 r = nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE,
450 NFC_HCI_EVT_READER_REQUESTED, NULL, 0);
451 if (r < 0)
452 nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE,
453 NFC_HCI_EVT_END_OPERATION, NULL, 0);
454
455 return r;
456}
457
458static int pn544_hci_dep_link_up(struct nfc_hci_dev *hdev,
459 struct nfc_target *target, u8 comm_mode,
460 u8 *gb, size_t gb_len)
461{
462 struct sk_buff *rgb_skb = NULL;
463 int r;
464
465 r = nfc_hci_get_param(hdev, target->hci_reader_gate,
466 PN544_DEP_ATR_RES, &rgb_skb);
467 if (r < 0)
468 return r;
469
470 if (rgb_skb->len == 0 || rgb_skb->len > NFC_GB_MAXSIZE) {
471 r = -EPROTO;
472 goto exit;
473 }
474 print_hex_dump(KERN_DEBUG, "remote gb: ", DUMP_PREFIX_OFFSET,
475 16, 1, rgb_skb->data, rgb_skb->len, true);
476
477 r = nfc_set_remote_general_bytes(hdev->ndev, rgb_skb->data,
478 rgb_skb->len);
479
480 if (r == 0)
481 r = nfc_dep_link_is_up(hdev->ndev, target->idx, comm_mode,
482 NFC_RF_INITIATOR);
483exit:
484 kfree_skb(rgb_skb);
485 return r;
486}
487
488static int pn544_hci_dep_link_down(struct nfc_hci_dev *hdev)
489{
490
491 return nfc_hci_send_event(hdev, PN544_RF_READER_NFCIP1_INITIATOR_GATE,
492 NFC_HCI_EVT_END_OPERATION, NULL, 0);
493}
494
495static int pn544_hci_target_from_gate(struct nfc_hci_dev *hdev, u8 gate,
496 struct nfc_target *target)
497{
498 switch (gate) {
499 case PN544_RF_READER_F_GATE:
500 target->supported_protocols = NFC_PROTO_FELICA_MASK;
501 break;
502 case PN544_RF_READER_JEWEL_GATE:
503 target->supported_protocols = NFC_PROTO_JEWEL_MASK;
504 target->sens_res = 0x0c00;
505 break;
506 case PN544_RF_READER_NFCIP1_INITIATOR_GATE:
507 target->supported_protocols = NFC_PROTO_NFC_DEP_MASK;
508 break;
509 default:
510 return -EPROTO;
511 }
512
513 return 0;
514}
515
516static int pn544_hci_complete_target_discovered(struct nfc_hci_dev *hdev,
517 u8 gate,
518 struct nfc_target *target)
519{
520 struct sk_buff *uid_skb;
521 int r = 0;
522
523 if (gate == PN544_RF_READER_NFCIP1_INITIATOR_GATE)
524 return r;
525
526 if (target->supported_protocols & NFC_PROTO_NFC_DEP_MASK) {
527 r = nfc_hci_send_cmd(hdev,
528 PN544_RF_READER_NFCIP1_INITIATOR_GATE,
529 PN544_HCI_CMD_CONTINUE_ACTIVATION, NULL, 0, NULL);
530 if (r < 0)
531 return r;
532
533 target->hci_reader_gate = PN544_RF_READER_NFCIP1_INITIATOR_GATE;
534 } else if (target->supported_protocols & NFC_PROTO_MIFARE_MASK) {
535 if (target->nfcid1_len != 4 && target->nfcid1_len != 7 &&
536 target->nfcid1_len != 10)
537 return -EPROTO;
538
539 r = nfc_hci_send_cmd(hdev, NFC_HCI_RF_READER_A_GATE,
540 PN544_RF_READER_CMD_ACTIVATE_NEXT,
541 target->nfcid1, target->nfcid1_len, NULL);
542 } else if (target->supported_protocols & NFC_PROTO_FELICA_MASK) {
543 r = nfc_hci_get_param(hdev, PN544_RF_READER_F_GATE,
544 PN544_FELICA_ID, &uid_skb);
545 if (r < 0)
546 return r;
547
548 if (uid_skb->len != 8) {
549 kfree_skb(uid_skb);
550 return -EPROTO;
551 }
552
553 r = nfc_hci_send_cmd(hdev, PN544_RF_READER_F_GATE,
554 PN544_RF_READER_CMD_ACTIVATE_NEXT,
555 uid_skb->data, uid_skb->len, NULL);
556 kfree_skb(uid_skb);
557
558 r = nfc_hci_send_cmd(hdev,
559 PN544_RF_READER_NFCIP1_INITIATOR_GATE,
560 PN544_HCI_CMD_CONTINUE_ACTIVATION,
561 NULL, 0, NULL);
562 if (r < 0)
563 return r;
564
565 target->hci_reader_gate = PN544_RF_READER_NFCIP1_INITIATOR_GATE;
566 target->supported_protocols = NFC_PROTO_NFC_DEP_MASK;
567 } else if (target->supported_protocols & NFC_PROTO_ISO14443_MASK) {
568 /*
569 * TODO: maybe other ISO 14443 require some kind of continue
570 * activation, but for now we've seen only this one below.
571 */
572 if (target->sens_res == 0x4403) /* Type 4 Mifare DESFire */
573 r = nfc_hci_send_cmd(hdev, NFC_HCI_RF_READER_A_GATE,
574 PN544_RF_READER_A_CMD_CONTINUE_ACTIVATION,
575 NULL, 0, NULL);
576 }
577
578 return r;
579}
580
581#define PN544_CB_TYPE_READER_F 1
582
583static void pn544_hci_data_exchange_cb(void *context, struct sk_buff *skb,
584 int err)
585{
586 struct pn544_hci_info *info = context;
587
588 switch (info->async_cb_type) {
589 case PN544_CB_TYPE_READER_F:
590 if (err == 0)
591 skb_pull(skb, 1);
592 info->async_cb(info->async_cb_context, skb, err);
593 break;
594 default:
595 if (err == 0)
596 kfree_skb(skb);
597 break;
598 }
599}
600
601#define MIFARE_CMD_AUTH_KEY_A 0x60
602#define MIFARE_CMD_AUTH_KEY_B 0x61
603#define MIFARE_CMD_HEADER 2
604#define MIFARE_UID_LEN 4
605#define MIFARE_KEY_LEN 6
606#define MIFARE_CMD_LEN 12
607/*
608 * Returns:
609 * <= 0: driver handled the data exchange
610 * 1: driver doesn't especially handle, please do standard processing
611 */
612static int pn544_hci_im_transceive(struct nfc_hci_dev *hdev,
613 struct nfc_target *target,
614 struct sk_buff *skb, data_exchange_cb_t cb,
615 void *cb_context)
616{
617 struct pn544_hci_info *info = nfc_hci_get_clientdata(hdev);
618
619 pr_info(DRIVER_DESC ": %s for gate=%d\n", __func__,
620 target->hci_reader_gate);
621
622 switch (target->hci_reader_gate) {
623 case NFC_HCI_RF_READER_A_GATE:
624 if (target->supported_protocols & NFC_PROTO_MIFARE_MASK) {
625 /*
626 * It seems that pn544 is inverting key and UID for
627 * MIFARE authentication commands.
628 */
629 if (skb->len == MIFARE_CMD_LEN &&
630 (skb->data[0] == MIFARE_CMD_AUTH_KEY_A ||
631 skb->data[0] == MIFARE_CMD_AUTH_KEY_B)) {
632 u8 uid[MIFARE_UID_LEN];
633 u8 *data = skb->data + MIFARE_CMD_HEADER;
634
635 memcpy(uid, data + MIFARE_KEY_LEN,
636 MIFARE_UID_LEN);
637 memmove(data + MIFARE_UID_LEN, data,
638 MIFARE_KEY_LEN);
639 memcpy(data, uid, MIFARE_UID_LEN);
640 }
641
642 return nfc_hci_send_cmd_async(hdev,
643 target->hci_reader_gate,
644 PN544_MIFARE_CMD,
645 skb->data, skb->len,
646 cb, cb_context);
647 } else
648 return 1;
649 case PN544_RF_READER_F_GATE:
650 *skb_push(skb, 1) = 0;
651 *skb_push(skb, 1) = 0;
652
653 info->async_cb_type = PN544_CB_TYPE_READER_F;
654 info->async_cb = cb;
655 info->async_cb_context = cb_context;
656
657 return nfc_hci_send_cmd_async(hdev, target->hci_reader_gate,
658 PN544_FELICA_RAW, skb->data,
659 skb->len,
660 pn544_hci_data_exchange_cb, info);
661 case PN544_RF_READER_JEWEL_GATE:
662 return nfc_hci_send_cmd_async(hdev, target->hci_reader_gate,
663 PN544_JEWEL_RAW_CMD, skb->data,
664 skb->len, cb, cb_context);
665 case PN544_RF_READER_NFCIP1_INITIATOR_GATE:
666 *skb_push(skb, 1) = 0;
667
668 return nfc_hci_send_event(hdev, target->hci_reader_gate,
669 PN544_HCI_EVT_SND_DATA, skb->data,
670 skb->len);
671 default:
672 return 1;
673 }
674}
675
676static int pn544_hci_tm_send(struct nfc_hci_dev *hdev, struct sk_buff *skb)
677{
678 /* Set default false for multiple information chaining */
679 *skb_push(skb, 1) = 0;
680
681 return nfc_hci_send_event(hdev, PN544_RF_READER_NFCIP1_TARGET_GATE,
682 PN544_HCI_EVT_SND_DATA, skb->data, skb->len);
683}
684
685static int pn544_hci_check_presence(struct nfc_hci_dev *hdev,
686 struct nfc_target *target)
687{
688 pr_debug("supported protocol %d", target->supported_protocols);
689 if (target->supported_protocols & (NFC_PROTO_ISO14443_MASK |
690 NFC_PROTO_ISO14443_B_MASK)) {
691 return nfc_hci_send_cmd(hdev, target->hci_reader_gate,
692 PN544_RF_READER_CMD_PRESENCE_CHECK,
693 NULL, 0, NULL);
694 } else if (target->supported_protocols & NFC_PROTO_MIFARE_MASK) {
695 if (target->nfcid1_len != 4 && target->nfcid1_len != 7 &&
696 target->nfcid1_len != 10)
697 return -EOPNOTSUPP;
698
699 return nfc_hci_send_cmd(hdev, NFC_HCI_RF_READER_A_GATE,
700 PN544_RF_READER_CMD_ACTIVATE_NEXT,
701 target->nfcid1, target->nfcid1_len, NULL);
702 } else if (target->supported_protocols & NFC_PROTO_JEWEL_MASK) {
703 return nfc_hci_send_cmd(hdev, target->hci_reader_gate,
704 PN544_JEWEL_RAW_CMD, NULL, 0, NULL);
705 } else if (target->supported_protocols & NFC_PROTO_FELICA_MASK) {
706 return nfc_hci_send_cmd(hdev, PN544_RF_READER_F_GATE,
707 PN544_FELICA_RAW, NULL, 0, NULL);
708 } else if (target->supported_protocols & NFC_PROTO_NFC_DEP_MASK) {
709 return nfc_hci_send_cmd(hdev, target->hci_reader_gate,
710 PN544_HCI_CMD_ATTREQUEST,
711 NULL, 0, NULL);
712 }
713
714 return 0;
715}
716
717void pn544_hci_event_received(struct nfc_hci_dev *hdev, u8 gate, u8 event,
718 struct sk_buff *skb)
719{
720 struct sk_buff *rgb_skb = NULL;
721 int r = 0;
722
723 pr_debug("hci event %d", event);
724 switch (event) {
725 case PN544_HCI_EVT_ACTIVATED:
726 if (gate == PN544_RF_READER_NFCIP1_INITIATOR_GATE)
727 nfc_hci_target_discovered(hdev, gate);
728 else if (gate == PN544_RF_READER_NFCIP1_TARGET_GATE) {
729 r = nfc_hci_get_param(hdev, gate, PN544_DEP_ATR_REQ,
730 &rgb_skb);
731
732 if (r < 0)
733 goto exit;
734
735 nfc_tm_activated(hdev->ndev, NFC_PROTO_NFC_DEP_MASK,
736 NFC_COMM_PASSIVE, rgb_skb->data,
737 rgb_skb->len);
738
739 kfree_skb(rgb_skb);
740 }
741
742 break;
743 case PN544_HCI_EVT_DEACTIVATED:
744 nfc_hci_send_event(hdev, gate,
745 NFC_HCI_EVT_END_OPERATION, NULL, 0);
746 break;
747 case PN544_HCI_EVT_RCV_DATA:
748 if (skb->len < 2) {
749 r = -EPROTO;
750 goto exit;
751 }
752
753 if (skb->data[0] != 0) {
754 pr_debug("data0 %d", skb->data[0]);
755 r = -EPROTO;
756 goto exit;
757 }
758
759 skb_pull(skb, 2);
760 nfc_tm_data_received(hdev->ndev, skb);
761
762 return;
763 default:
764 break;
765 }
766
767exit:
768 kfree_skb(skb);
769}
770
771static struct nfc_hci_ops pn544_hci_ops = {
772 .open = pn544_hci_open,
773 .close = pn544_hci_close,
774 .hci_ready = pn544_hci_ready,
775 .xmit = pn544_hci_xmit,
776 .start_poll = pn544_hci_start_poll,
777 .dep_link_up = pn544_hci_dep_link_up,
778 .dep_link_down = pn544_hci_dep_link_down,
779 .target_from_gate = pn544_hci_target_from_gate,
780 .complete_target_discovered = pn544_hci_complete_target_discovered,
781 .im_transceive = pn544_hci_im_transceive,
782 .tm_send = pn544_hci_tm_send,
783 .check_presence = pn544_hci_check_presence,
784 .event_received = pn544_hci_event_received,
785};
786
787int pn544_hci_probe(void *phy_id, struct nfc_phy_ops *phy_ops, char *llc_name,
788 int phy_headroom, int phy_tailroom, int phy_payload,
789 struct nfc_hci_dev **hdev)
790{
791 struct pn544_hci_info *info;
792 u32 protocols;
793 struct nfc_hci_init_data init_data;
794 int r;
795
796 info = kzalloc(sizeof(struct pn544_hci_info), GFP_KERNEL);
797 if (!info) {
798 pr_err("Cannot allocate memory for pn544_hci_info.\n");
799 r = -ENOMEM;
800 goto err_info_alloc;
801 }
802
803 info->phy_ops = phy_ops;
804 info->phy_id = phy_id;
805 info->state = PN544_ST_COLD;
806 mutex_init(&info->info_lock);
807
808 init_data.gate_count = ARRAY_SIZE(pn544_gates);
809
810 memcpy(init_data.gates, pn544_gates, sizeof(pn544_gates));
811
812 /*
813 * TODO: Session id must include the driver name + some bus addr
814 * persistent info to discriminate 2 identical chips
815 */
816 strcpy(init_data.session_id, "ID544HCI");
817
818 protocols = NFC_PROTO_JEWEL_MASK |
819 NFC_PROTO_MIFARE_MASK |
820 NFC_PROTO_FELICA_MASK |
821 NFC_PROTO_ISO14443_MASK |
822 NFC_PROTO_ISO14443_B_MASK |
823 NFC_PROTO_NFC_DEP_MASK;
824
825 info->hdev = nfc_hci_allocate_device(&pn544_hci_ops, &init_data,
826 protocols, llc_name,
827 phy_headroom + PN544_CMDS_HEADROOM,
828 phy_tailroom, phy_payload);
829 if (!info->hdev) {
830 pr_err("Cannot allocate nfc hdev.\n");
831 r = -ENOMEM;
832 goto err_alloc_hdev;
833 }
834
835 nfc_hci_set_clientdata(info->hdev, info);
836
837 r = nfc_hci_register_device(info->hdev);
838 if (r)
839 goto err_regdev;
840
841 *hdev = info->hdev;
842
843 return 0;
844
845err_regdev:
846 nfc_hci_free_device(info->hdev);
847
848err_alloc_hdev:
849 kfree(info);
850
851err_info_alloc:
852 return r;
853}
854
855void pn544_hci_remove(struct nfc_hci_dev *hdev)
856{
857 struct pn544_hci_info *info = nfc_hci_get_clientdata(hdev);
858
859 nfc_hci_unregister_device(hdev);
860 nfc_hci_free_device(hdev);
861 kfree(info);
862}
generated by cgit v1.2.2 (git 2.25.0) at 2024-12-21 10:26:08 -0500