projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
NFC: nci: Move close ops call in nci_close_device
[deliverable/linux.git] / net / nfc / nci / core.c
1 /*
2 * The NFC Controller Interface is the communication protocol between an
3 * NFC Controller (NFCC) and a Device Host (DH).
4 *
5 * Copyright (C) 2011 Texas Instruments, Inc.
6 * Copyright (C) 2014 Marvell International Ltd.
7 *
8 * Written by Ilan Elias <ilane@ti.com>
9 *
10 * Acknowledgements:
11 * This file is based on hci_core.c, which was written
12 * by Maxim Krasnyansky.
13 *
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License version 2
16 * as published by the Free Software Foundation
17 *
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, see <http://www.gnu.org/licenses/>.
25 *
26 */
27
28 #define pr_fmt(fmt) KBUILD_MODNAME ": %s: " fmt, __func__
29
30 #include <linux/module.h>
31 #include <linux/kernel.h>
32 #include <linux/types.h>
33 #include <linux/workqueue.h>
34 #include <linux/completion.h>
35 #include <linux/export.h>
36 #include <linux/sched.h>
37 #include <linux/bitops.h>
38 #include <linux/skbuff.h>
39
40 #include "../nfc.h"
41 #include <net/nfc/nci.h>
42 #include <net/nfc/nci_core.h>
43 #include <linux/nfc.h>
44
45 struct core_conn_create_data {
46 int length;
47 struct nci_core_conn_create_cmd *cmd;
48 };
49
50 static void nci_cmd_work(struct work_struct *work);
51 static void nci_rx_work(struct work_struct *work);
52 static void nci_tx_work(struct work_struct *work);
53
54 struct nci_conn_info *nci_get_conn_info_by_conn_id(struct nci_dev *ndev,
55 int conn_id)
56 {
57 struct nci_conn_info *conn_info;
58
59 list_for_each_entry(conn_info, &ndev->conn_info_list, list) {
60 if (conn_info->conn_id == conn_id)
61 return conn_info;
62 }
63
64 return NULL;
65 }
66
67 /* ---- NCI requests ---- */
68
69 void nci_req_complete(struct nci_dev *ndev, int result)
70 {
71 if (ndev->req_status == NCI_REQ_PEND) {
72 ndev->req_result = result;
73 ndev->req_status = NCI_REQ_DONE;
74 complete(&ndev->req_completion);
75 }
76 }
77
78 static void nci_req_cancel(struct nci_dev *ndev, int err)
79 {
80 if (ndev->req_status == NCI_REQ_PEND) {
81 ndev->req_result = err;
82 ndev->req_status = NCI_REQ_CANCELED;
83 complete(&ndev->req_completion);
84 }
85 }
86
87 /* Execute request and wait for completion. */
88 static int __nci_request(struct nci_dev *ndev,
89 void (*req)(struct nci_dev *ndev, unsigned long opt),
90 unsigned long opt, __u32 timeout)
91 {
92 int rc = 0;
93 long completion_rc;
94
95 ndev->req_status = NCI_REQ_PEND;
96
97 reinit_completion(&ndev->req_completion);
98 req(ndev, opt);
99 completion_rc =
100 wait_for_completion_interruptible_timeout(&ndev->req_completion,
101 timeout);
102
103 pr_debug("wait_for_completion return %ld\n", completion_rc);
104
105 if (completion_rc > 0) {
106 switch (ndev->req_status) {
107 case NCI_REQ_DONE:
108 rc = nci_to_errno(ndev->req_result);
109 break;
110
111 case NCI_REQ_CANCELED:
112 rc = -ndev->req_result;
113 break;
114
115 default:
116 rc = -ETIMEDOUT;
117 break;
118 }
119 } else {
120 pr_err("wait_for_completion_interruptible_timeout failed %ld\n",
121 completion_rc);
122
123 rc = ((completion_rc == 0) ? (-ETIMEDOUT) : (completion_rc));
124 }
125
126 ndev->req_status = ndev->req_result = 0;
127
128 return rc;
129 }
130
131 inline int nci_request(struct nci_dev *ndev,
132 void (*req)(struct nci_dev *ndev,
133 unsigned long opt),
134 unsigned long opt, __u32 timeout)
135 {
136 int rc;
137
138 if (!test_bit(NCI_UP, &ndev->flags))
139 return -ENETDOWN;
140
141 /* Serialize all requests */
142 mutex_lock(&ndev->req_lock);
143 rc = __nci_request(ndev, req, opt, timeout);
144 mutex_unlock(&ndev->req_lock);
145
146 return rc;
147 }
148
149 static void nci_reset_req(struct nci_dev *ndev, unsigned long opt)
150 {
151 struct nci_core_reset_cmd cmd;
152
153 cmd.reset_type = NCI_RESET_TYPE_RESET_CONFIG;
154 nci_send_cmd(ndev, NCI_OP_CORE_RESET_CMD, 1, &cmd);
155 }
156
157 static void nci_init_req(struct nci_dev *ndev, unsigned long opt)
158 {
159 nci_send_cmd(ndev, NCI_OP_CORE_INIT_CMD, 0, NULL);
160 }
161
162 static void nci_init_complete_req(struct nci_dev *ndev, unsigned long opt)
163 {
164 struct nci_rf_disc_map_cmd cmd;
165 struct disc_map_config *cfg = cmd.mapping_configs;
166 __u8 *num = &cmd.num_mapping_configs;
167 int i;
168
169 /* set rf mapping configurations */
170 *num = 0;
171
172 /* by default mapping is set to NCI_RF_INTERFACE_FRAME */
173 for (i = 0; i < ndev->num_supported_rf_interfaces; i++) {
174 if (ndev->supported_rf_interfaces[i] ==
175 NCI_RF_INTERFACE_ISO_DEP) {
176 cfg[*num].rf_protocol = NCI_RF_PROTOCOL_ISO_DEP;
177 cfg[*num].mode = NCI_DISC_MAP_MODE_POLL |
178 NCI_DISC_MAP_MODE_LISTEN;
179 cfg[*num].rf_interface = NCI_RF_INTERFACE_ISO_DEP;
180 (*num)++;
181 } else if (ndev->supported_rf_interfaces[i] ==
182 NCI_RF_INTERFACE_NFC_DEP) {
183 cfg[*num].rf_protocol = NCI_RF_PROTOCOL_NFC_DEP;
184 cfg[*num].mode = NCI_DISC_MAP_MODE_POLL |
185 NCI_DISC_MAP_MODE_LISTEN;
186 cfg[*num].rf_interface = NCI_RF_INTERFACE_NFC_DEP;
187 (*num)++;
188 }
189
190 if (*num == NCI_MAX_NUM_MAPPING_CONFIGS)
191 break;
192 }
193
194 nci_send_cmd(ndev, NCI_OP_RF_DISCOVER_MAP_CMD,
195 (1 + ((*num) * sizeof(struct disc_map_config))), &cmd);
196 }
197
198 struct nci_set_config_param {
199 __u8 id;
200 size_t len;
201 __u8 *val;
202 };
203
204 static void nci_set_config_req(struct nci_dev *ndev, unsigned long opt)
205 {
206 struct nci_set_config_param *param = (struct nci_set_config_param *)opt;
207 struct nci_core_set_config_cmd cmd;
208
209 BUG_ON(param->len > NCI_MAX_PARAM_LEN);
210
211 cmd.num_params = 1;
212 cmd.param.id = param->id;
213 cmd.param.len = param->len;
214 memcpy(cmd.param.val, param->val, param->len);
215
216 nci_send_cmd(ndev, NCI_OP_CORE_SET_CONFIG_CMD, (3 + param->len), &cmd);
217 }
218
219 struct nci_rf_discover_param {
220 __u32 im_protocols;
221 __u32 tm_protocols;
222 };
223
224 static void nci_rf_discover_req(struct nci_dev *ndev, unsigned long opt)
225 {
226 struct nci_rf_discover_param *param =
227 (struct nci_rf_discover_param *)opt;
228 struct nci_rf_disc_cmd cmd;
229
230 cmd.num_disc_configs = 0;
231
232 if ((cmd.num_disc_configs < NCI_MAX_NUM_RF_CONFIGS) &&
233 (param->im_protocols & NFC_PROTO_JEWEL_MASK ||
234 param->im_protocols & NFC_PROTO_MIFARE_MASK ||
235 param->im_protocols & NFC_PROTO_ISO14443_MASK ||
236 param->im_protocols & NFC_PROTO_NFC_DEP_MASK)) {
237 cmd.disc_configs[cmd.num_disc_configs].rf_tech_and_mode =
238 NCI_NFC_A_PASSIVE_POLL_MODE;
239 cmd.disc_configs[cmd.num_disc_configs].frequency = 1;
240 cmd.num_disc_configs++;
241 }
242
243 if ((cmd.num_disc_configs < NCI_MAX_NUM_RF_CONFIGS) &&
244 (param->im_protocols & NFC_PROTO_ISO14443_B_MASK)) {
245 cmd.disc_configs[cmd.num_disc_configs].rf_tech_and_mode =
246 NCI_NFC_B_PASSIVE_POLL_MODE;
247 cmd.disc_configs[cmd.num_disc_configs].frequency = 1;
248 cmd.num_disc_configs++;
249 }
250
251 if ((cmd.num_disc_configs < NCI_MAX_NUM_RF_CONFIGS) &&
252 (param->im_protocols & NFC_PROTO_FELICA_MASK ||
253 param->im_protocols & NFC_PROTO_NFC_DEP_MASK)) {
254 cmd.disc_configs[cmd.num_disc_configs].rf_tech_and_mode =
255 NCI_NFC_F_PASSIVE_POLL_MODE;
256 cmd.disc_configs[cmd.num_disc_configs].frequency = 1;
257 cmd.num_disc_configs++;
258 }
259
260 if ((cmd.num_disc_configs < NCI_MAX_NUM_RF_CONFIGS) &&
261 (param->im_protocols & NFC_PROTO_ISO15693_MASK)) {
262 cmd.disc_configs[cmd.num_disc_configs].rf_tech_and_mode =
263 NCI_NFC_V_PASSIVE_POLL_MODE;
264 cmd.disc_configs[cmd.num_disc_configs].frequency = 1;
265 cmd.num_disc_configs++;
266 }
267
268 if ((cmd.num_disc_configs < NCI_MAX_NUM_RF_CONFIGS - 1) &&
269 (param->tm_protocols & NFC_PROTO_NFC_DEP_MASK)) {
270 cmd.disc_configs[cmd.num_disc_configs].rf_tech_and_mode =
271 NCI_NFC_A_PASSIVE_LISTEN_MODE;
272 cmd.disc_configs[cmd.num_disc_configs].frequency = 1;
273 cmd.num_disc_configs++;
274 cmd.disc_configs[cmd.num_disc_configs].rf_tech_and_mode =
275 NCI_NFC_F_PASSIVE_LISTEN_MODE;
276 cmd.disc_configs[cmd.num_disc_configs].frequency = 1;
277 cmd.num_disc_configs++;
278 }
279
280 nci_send_cmd(ndev, NCI_OP_RF_DISCOVER_CMD,
281 (1 + (cmd.num_disc_configs * sizeof(struct disc_config))),
282 &cmd);
283 }
284
285 struct nci_rf_discover_select_param {
286 __u8 rf_discovery_id;
287 __u8 rf_protocol;
288 };
289
290 static void nci_rf_discover_select_req(struct nci_dev *ndev, unsigned long opt)
291 {
292 struct nci_rf_discover_select_param *param =
293 (struct nci_rf_discover_select_param *)opt;
294 struct nci_rf_discover_select_cmd cmd;
295
296 cmd.rf_discovery_id = param->rf_discovery_id;
297 cmd.rf_protocol = param->rf_protocol;
298
299 switch (cmd.rf_protocol) {
300 case NCI_RF_PROTOCOL_ISO_DEP:
301 cmd.rf_interface = NCI_RF_INTERFACE_ISO_DEP;
302 break;
303
304 case NCI_RF_PROTOCOL_NFC_DEP:
305 cmd.rf_interface = NCI_RF_INTERFACE_NFC_DEP;
306 break;
307
308 default:
309 cmd.rf_interface = NCI_RF_INTERFACE_FRAME;
310 break;
311 }
312
313 nci_send_cmd(ndev, NCI_OP_RF_DISCOVER_SELECT_CMD,
314 sizeof(struct nci_rf_discover_select_cmd), &cmd);
315 }
316
317 static void nci_rf_deactivate_req(struct nci_dev *ndev, unsigned long opt)
318 {
319 struct nci_rf_deactivate_cmd cmd;
320
321 cmd.type = opt;
322
323 nci_send_cmd(ndev, NCI_OP_RF_DEACTIVATE_CMD,
324 sizeof(struct nci_rf_deactivate_cmd), &cmd);
325 }
326
327 struct nci_prop_cmd_param {
328 __u16 opcode;
329 size_t len;
330 __u8 *payload;
331 };
332
333 static void nci_prop_cmd_req(struct nci_dev *ndev, unsigned long opt)
334 {
335 struct nci_prop_cmd_param *param = (struct nci_prop_cmd_param *)opt;
336
337 nci_send_cmd(ndev, param->opcode, param->len, param->payload);
338 }
339
340 int nci_prop_cmd(struct nci_dev *ndev, __u8 oid, size_t len, __u8 *payload)
341 {
342 struct nci_prop_cmd_param param;
343
344 param.opcode = nci_opcode_pack(NCI_GID_PROPRIETARY, oid);
345 param.len = len;
346 param.payload = payload;
347
348 return __nci_request(ndev, nci_prop_cmd_req, (unsigned long)&param,
349 msecs_to_jiffies(NCI_CMD_TIMEOUT));
350 }
351 EXPORT_SYMBOL(nci_prop_cmd);
352
353 static int nci_open_device(struct nci_dev *ndev)
354 {
355 int rc = 0;
356
357 mutex_lock(&ndev->req_lock);
358
359 if (test_bit(NCI_UP, &ndev->flags)) {
360 rc = -EALREADY;
361 goto done;
362 }
363
364 if (ndev->ops->open(ndev)) {
365 rc = -EIO;
366 goto done;
367 }
368
369 atomic_set(&ndev->cmd_cnt, 1);
370
371 set_bit(NCI_INIT, &ndev->flags);
372
373 if (ndev->ops->init)
374 rc = ndev->ops->init(ndev);
375
376 if (!rc) {
377 rc = __nci_request(ndev, nci_reset_req, 0,
378 msecs_to_jiffies(NCI_RESET_TIMEOUT));
379 }
380
381 if (!rc && ndev->ops->setup) {
382 rc = ndev->ops->setup(ndev);
383 }
384
385 if (!rc) {
386 rc = __nci_request(ndev, nci_init_req, 0,
387 msecs_to_jiffies(NCI_INIT_TIMEOUT));
388 }
389
390 if (!rc) {
391 rc = __nci_request(ndev, nci_init_complete_req, 0,
392 msecs_to_jiffies(NCI_INIT_TIMEOUT));
393 }
394
395 clear_bit(NCI_INIT, &ndev->flags);
396
397 if (!rc) {
398 set_bit(NCI_UP, &ndev->flags);
399 nci_clear_target_list(ndev);
400 atomic_set(&ndev->state, NCI_IDLE);
401 } else {
402 /* Init failed, cleanup */
403 skb_queue_purge(&ndev->cmd_q);
404 skb_queue_purge(&ndev->rx_q);
405 skb_queue_purge(&ndev->tx_q);
406
407 ndev->ops->close(ndev);
408 ndev->flags = 0;
409 }
410
411 done:
412 mutex_unlock(&ndev->req_lock);
413 return rc;
414 }
415
416 static int nci_close_device(struct nci_dev *ndev)
417 {
418 nci_req_cancel(ndev, ENODEV);
419 mutex_lock(&ndev->req_lock);
420
421 if (!test_and_clear_bit(NCI_UP, &ndev->flags)) {
422 del_timer_sync(&ndev->cmd_timer);
423 del_timer_sync(&ndev->data_timer);
424 mutex_unlock(&ndev->req_lock);
425 return 0;
426 }
427
428 /* Drop RX and TX queues */
429 skb_queue_purge(&ndev->rx_q);
430 skb_queue_purge(&ndev->tx_q);
431
432 /* Flush RX and TX wq */
433 flush_workqueue(ndev->rx_wq);
434 flush_workqueue(ndev->tx_wq);
435
436 /* Reset device */
437 skb_queue_purge(&ndev->cmd_q);
438 atomic_set(&ndev->cmd_cnt, 1);
439
440 set_bit(NCI_INIT, &ndev->flags);
441 __nci_request(ndev, nci_reset_req, 0,
442 msecs_to_jiffies(NCI_RESET_TIMEOUT));
443
444 /* After this point our queues are empty
445 * and no works are scheduled.
446 */
447 ndev->ops->close(ndev);
448
449 clear_bit(NCI_INIT, &ndev->flags);
450
451 del_timer_sync(&ndev->cmd_timer);
452
453 /* Flush cmd wq */
454 flush_workqueue(ndev->cmd_wq);
455
456 /* Clear flags */
457 ndev->flags = 0;
458
459 mutex_unlock(&ndev->req_lock);
460
461 return 0;
462 }
463
464 /* NCI command timer function */
465 static void nci_cmd_timer(unsigned long arg)
466 {
467 struct nci_dev *ndev = (void *) arg;
468
469 atomic_set(&ndev->cmd_cnt, 1);
470 queue_work(ndev->cmd_wq, &ndev->cmd_work);
471 }
472
473 /* NCI data exchange timer function */
474 static void nci_data_timer(unsigned long arg)
475 {
476 struct nci_dev *ndev = (void *) arg;
477
478 set_bit(NCI_DATA_EXCHANGE_TO, &ndev->flags);
479 queue_work(ndev->rx_wq, &ndev->rx_work);
480 }
481
482 static int nci_dev_up(struct nfc_dev *nfc_dev)
483 {
484 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
485
486 return nci_open_device(ndev);
487 }
488
489 static int nci_dev_down(struct nfc_dev *nfc_dev)
490 {
491 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
492
493 return nci_close_device(ndev);
494 }
495
496 int nci_set_config(struct nci_dev *ndev, __u8 id, size_t len, __u8 *val)
497 {
498 struct nci_set_config_param param;
499
500 if (!val || !len)
501 return 0;
502
503 param.id = id;
504 param.len = len;
505 param.val = val;
506
507 return __nci_request(ndev, nci_set_config_req, (unsigned long)&param,
508 msecs_to_jiffies(NCI_SET_CONFIG_TIMEOUT));
509 }
510 EXPORT_SYMBOL(nci_set_config);
511
512 static void nci_nfcee_discover_req(struct nci_dev *ndev, unsigned long opt)
513 {
514 struct nci_nfcee_discover_cmd cmd;
515 __u8 action = opt;
516
517 cmd.discovery_action = action;
518
519 nci_send_cmd(ndev, NCI_OP_NFCEE_DISCOVER_CMD, 1, &cmd);
520 }
521
522 int nci_nfcee_discover(struct nci_dev *ndev, u8 action)
523 {
524 return nci_request(ndev, nci_nfcee_discover_req, action,
525 msecs_to_jiffies(NCI_CMD_TIMEOUT));
526 }
527 EXPORT_SYMBOL(nci_nfcee_discover);
528
529 static void nci_nfcee_mode_set_req(struct nci_dev *ndev, unsigned long opt)
530 {
531 struct nci_nfcee_mode_set_cmd *cmd =
532 (struct nci_nfcee_mode_set_cmd *)opt;
533
534 nci_send_cmd(ndev, NCI_OP_NFCEE_MODE_SET_CMD,
535 sizeof(struct nci_nfcee_mode_set_cmd), cmd);
536 }
537
538 int nci_nfcee_mode_set(struct nci_dev *ndev, u8 nfcee_id, u8 nfcee_mode)
539 {
540 struct nci_nfcee_mode_set_cmd cmd;
541
542 cmd.nfcee_id = nfcee_id;
543 cmd.nfcee_mode = nfcee_mode;
544
545 return nci_request(ndev, nci_nfcee_mode_set_req, (unsigned long)&cmd,
546 msecs_to_jiffies(NCI_CMD_TIMEOUT));
547 }
548 EXPORT_SYMBOL(nci_nfcee_mode_set);
549
550 static void nci_core_conn_create_req(struct nci_dev *ndev, unsigned long opt)
551 {
552 struct core_conn_create_data *data =
553 (struct core_conn_create_data *)opt;
554
555 nci_send_cmd(ndev, NCI_OP_CORE_CONN_CREATE_CMD, data->length, data->cmd);
556 }
557
558 int nci_core_conn_create(struct nci_dev *ndev, u8 destination_type,
559 u8 number_destination_params,
560 size_t params_len,
561 struct core_conn_create_dest_spec_params *params)
562 {
563 int r;
564 struct nci_core_conn_create_cmd *cmd;
565 struct core_conn_create_data data;
566
567 data.length = params_len + sizeof(struct nci_core_conn_create_cmd);
568 cmd = kzalloc(data.length, GFP_KERNEL);
569 if (!cmd)
570 return -ENOMEM;
571
572 cmd->destination_type = destination_type;
573 cmd->number_destination_params = number_destination_params;
574 memcpy(cmd->params, params, params_len);
575
576 data.cmd = cmd;
577 ndev->cur_id = params->value[DEST_SPEC_PARAMS_ID_INDEX];
578
579 r = __nci_request(ndev, nci_core_conn_create_req,
580 (unsigned long)&data,
581 msecs_to_jiffies(NCI_CMD_TIMEOUT));
582 kfree(cmd);
583 return r;
584 }
585 EXPORT_SYMBOL(nci_core_conn_create);
586
587 static void nci_core_conn_close_req(struct nci_dev *ndev, unsigned long opt)
588 {
589 __u8 conn_id = opt;
590
591 nci_send_cmd(ndev, NCI_OP_CORE_CONN_CLOSE_CMD, 1, &conn_id);
592 }
593
594 int nci_core_conn_close(struct nci_dev *ndev, u8 conn_id)
595 {
596 return nci_request(ndev, nci_core_conn_close_req, conn_id,
597 msecs_to_jiffies(NCI_CMD_TIMEOUT));
598 }
599 EXPORT_SYMBOL(nci_core_conn_close);
600
601 static int nci_set_local_general_bytes(struct nfc_dev *nfc_dev)
602 {
603 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
604 struct nci_set_config_param param;
605 int rc;
606
607 param.val = nfc_get_local_general_bytes(nfc_dev, &param.len);
608 if ((param.val == NULL) || (param.len == 0))
609 return 0;
610
611 if (param.len > NFC_MAX_GT_LEN)
612 return -EINVAL;
613
614 param.id = NCI_PN_ATR_REQ_GEN_BYTES;
615
616 rc = nci_request(ndev, nci_set_config_req, (unsigned long)&param,
617 msecs_to_jiffies(NCI_SET_CONFIG_TIMEOUT));
618 if (rc)
619 return rc;
620
621 param.id = NCI_LN_ATR_RES_GEN_BYTES;
622
623 return nci_request(ndev, nci_set_config_req, (unsigned long)&param,
624 msecs_to_jiffies(NCI_SET_CONFIG_TIMEOUT));
625 }
626
627 static int nci_set_listen_parameters(struct nfc_dev *nfc_dev)
628 {
629 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
630 int rc;
631 __u8 val;
632
633 val = NCI_LA_SEL_INFO_NFC_DEP_MASK;
634
635 rc = nci_set_config(ndev, NCI_LA_SEL_INFO, 1, &val);
636 if (rc)
637 return rc;
638
639 val = NCI_LF_PROTOCOL_TYPE_NFC_DEP_MASK;
640
641 rc = nci_set_config(ndev, NCI_LF_PROTOCOL_TYPE, 1, &val);
642 if (rc)
643 return rc;
644
645 val = NCI_LF_CON_BITR_F_212 | NCI_LF_CON_BITR_F_424;
646
647 return nci_set_config(ndev, NCI_LF_CON_BITR_F, 1, &val);
648 }
649
650 static int nci_start_poll(struct nfc_dev *nfc_dev,
651 __u32 im_protocols, __u32 tm_protocols)
652 {
653 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
654 struct nci_rf_discover_param param;
655 int rc;
656
657 if ((atomic_read(&ndev->state) == NCI_DISCOVERY) ||
658 (atomic_read(&ndev->state) == NCI_W4_ALL_DISCOVERIES)) {
659 pr_err("unable to start poll, since poll is already active\n");
660 return -EBUSY;
661 }
662
663 if (ndev->target_active_prot) {
664 pr_err("there is an active target\n");
665 return -EBUSY;
666 }
667
668 if ((atomic_read(&ndev->state) == NCI_W4_HOST_SELECT) ||
669 (atomic_read(&ndev->state) == NCI_POLL_ACTIVE)) {
670 pr_debug("target active or w4 select, implicitly deactivate\n");
671
672 rc = nci_request(ndev, nci_rf_deactivate_req,
673 NCI_DEACTIVATE_TYPE_IDLE_MODE,
674 msecs_to_jiffies(NCI_RF_DEACTIVATE_TIMEOUT));
675 if (rc)
676 return -EBUSY;
677 }
678
679 if ((im_protocols | tm_protocols) & NFC_PROTO_NFC_DEP_MASK) {
680 rc = nci_set_local_general_bytes(nfc_dev);
681 if (rc) {
682 pr_err("failed to set local general bytes\n");
683 return rc;
684 }
685 }
686
687 if (tm_protocols & NFC_PROTO_NFC_DEP_MASK) {
688 rc = nci_set_listen_parameters(nfc_dev);
689 if (rc)
690 pr_err("failed to set listen parameters\n");
691 }
692
693 param.im_protocols = im_protocols;
694 param.tm_protocols = tm_protocols;
695 rc = nci_request(ndev, nci_rf_discover_req, (unsigned long)&param,
696 msecs_to_jiffies(NCI_RF_DISC_TIMEOUT));
697
698 if (!rc)
699 ndev->poll_prots = im_protocols;
700
701 return rc;
702 }
703
704 static void nci_stop_poll(struct nfc_dev *nfc_dev)
705 {
706 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
707
708 if ((atomic_read(&ndev->state) != NCI_DISCOVERY) &&
709 (atomic_read(&ndev->state) != NCI_W4_ALL_DISCOVERIES)) {
710 pr_err("unable to stop poll, since poll is not active\n");
711 return;
712 }
713
714 nci_request(ndev, nci_rf_deactivate_req, NCI_DEACTIVATE_TYPE_IDLE_MODE,
715 msecs_to_jiffies(NCI_RF_DEACTIVATE_TIMEOUT));
716 }
717
718 static int nci_activate_target(struct nfc_dev *nfc_dev,
719 struct nfc_target *target, __u32 protocol)
720 {
721 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
722 struct nci_rf_discover_select_param param;
723 struct nfc_target *nci_target = NULL;
724 int i;
725 int rc = 0;
726
727 pr_debug("target_idx %d, protocol 0x%x\n", target->idx, protocol);
728
729 if ((atomic_read(&ndev->state) != NCI_W4_HOST_SELECT) &&
730 (atomic_read(&ndev->state) != NCI_POLL_ACTIVE)) {
731 pr_err("there is no available target to activate\n");
732 return -EINVAL;
733 }
734
735 if (ndev->target_active_prot) {
736 pr_err("there is already an active target\n");
737 return -EBUSY;
738 }
739
740 for (i = 0; i < ndev->n_targets; i++) {
741 if (ndev->targets[i].idx == target->idx) {
742 nci_target = &ndev->targets[i];
743 break;
744 }
745 }
746
747 if (!nci_target) {
748 pr_err("unable to find the selected target\n");
749 return -EINVAL;
750 }
751
752 if (!(nci_target->supported_protocols & (1 << protocol))) {
753 pr_err("target does not support the requested protocol 0x%x\n",
754 protocol);
755 return -EINVAL;
756 }
757
758 if (atomic_read(&ndev->state) == NCI_W4_HOST_SELECT) {
759 param.rf_discovery_id = nci_target->logical_idx;
760
761 if (protocol == NFC_PROTO_JEWEL)
762 param.rf_protocol = NCI_RF_PROTOCOL_T1T;
763 else if (protocol == NFC_PROTO_MIFARE)
764 param.rf_protocol = NCI_RF_PROTOCOL_T2T;
765 else if (protocol == NFC_PROTO_FELICA)
766 param.rf_protocol = NCI_RF_PROTOCOL_T3T;
767 else if (protocol == NFC_PROTO_ISO14443 ||
768 protocol == NFC_PROTO_ISO14443_B)
769 param.rf_protocol = NCI_RF_PROTOCOL_ISO_DEP;
770 else
771 param.rf_protocol = NCI_RF_PROTOCOL_NFC_DEP;
772
773 rc = nci_request(ndev, nci_rf_discover_select_req,
774 (unsigned long)&param,
775 msecs_to_jiffies(NCI_RF_DISC_SELECT_TIMEOUT));
776 }
777
778 if (!rc)
779 ndev->target_active_prot = protocol;
780
781 return rc;
782 }
783
784 static void nci_deactivate_target(struct nfc_dev *nfc_dev,
785 struct nfc_target *target)
786 {
787 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
788
789 pr_debug("entry\n");
790
791 if (!ndev->target_active_prot) {
792 pr_err("unable to deactivate target, no active target\n");
793 return;
794 }
795
796 ndev->target_active_prot = 0;
797
798 if (atomic_read(&ndev->state) == NCI_POLL_ACTIVE) {
799 nci_request(ndev, nci_rf_deactivate_req,
800 NCI_DEACTIVATE_TYPE_SLEEP_MODE,
801 msecs_to_jiffies(NCI_RF_DEACTIVATE_TIMEOUT));
802 }
803 }
804
805 static int nci_dep_link_up(struct nfc_dev *nfc_dev, struct nfc_target *target,
806 __u8 comm_mode, __u8 *gb, size_t gb_len)
807 {
808 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
809 int rc;
810
811 pr_debug("target_idx %d, comm_mode %d\n", target->idx, comm_mode);
812
813 rc = nci_activate_target(nfc_dev, target, NFC_PROTO_NFC_DEP);
814 if (rc)
815 return rc;
816
817 rc = nfc_set_remote_general_bytes(nfc_dev, ndev->remote_gb,
818 ndev->remote_gb_len);
819 if (!rc)
820 rc = nfc_dep_link_is_up(nfc_dev, target->idx, NFC_COMM_PASSIVE,
821 NFC_RF_INITIATOR);
822
823 return rc;
824 }
825
826 static int nci_dep_link_down(struct nfc_dev *nfc_dev)
827 {
828 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
829 int rc;
830
831 pr_debug("entry\n");
832
833 if (nfc_dev->rf_mode == NFC_RF_INITIATOR) {
834 nci_deactivate_target(nfc_dev, NULL);
835 } else {
836 if (atomic_read(&ndev->state) == NCI_LISTEN_ACTIVE ||
837 atomic_read(&ndev->state) == NCI_DISCOVERY) {
838 nci_request(ndev, nci_rf_deactivate_req, 0,
839 msecs_to_jiffies(NCI_RF_DEACTIVATE_TIMEOUT));
840 }
841
842 rc = nfc_tm_deactivated(nfc_dev);
843 if (rc)
844 pr_err("error when signaling tm deactivation\n");
845 }
846
847 return 0;
848 }
849
850
851 static int nci_transceive(struct nfc_dev *nfc_dev, struct nfc_target *target,
852 struct sk_buff *skb,
853 data_exchange_cb_t cb, void *cb_context)
854 {
855 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
856 int rc;
857 struct nci_conn_info *conn_info;
858
859 conn_info = ndev->rf_conn_info;
860 if (!conn_info)
861 return -EPROTO;
862
863 pr_debug("target_idx %d, len %d\n", target->idx, skb->len);
864
865 if (!ndev->target_active_prot) {
866 pr_err("unable to exchange data, no active target\n");
867 return -EINVAL;
868 }
869
870 if (test_and_set_bit(NCI_DATA_EXCHANGE, &ndev->flags))
871 return -EBUSY;
872
873 /* store cb and context to be used on receiving data */
874 conn_info->data_exchange_cb = cb;
875 conn_info->data_exchange_cb_context = cb_context;
876
877 rc = nci_send_data(ndev, NCI_STATIC_RF_CONN_ID, skb);
878 if (rc)
879 clear_bit(NCI_DATA_EXCHANGE, &ndev->flags);
880
881 return rc;
882 }
883
884 static int nci_tm_send(struct nfc_dev *nfc_dev, struct sk_buff *skb)
885 {
886 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
887 int rc;
888
889 rc = nci_send_data(ndev, NCI_STATIC_RF_CONN_ID, skb);
890 if (rc)
891 pr_err("unable to send data\n");
892
893 return rc;
894 }
895
896 static int nci_enable_se(struct nfc_dev *nfc_dev, u32 se_idx)
897 {
898 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
899
900 if (ndev->ops->enable_se)
901 return ndev->ops->enable_se(ndev, se_idx);
902
903 return 0;
904 }
905
906 static int nci_disable_se(struct nfc_dev *nfc_dev, u32 se_idx)
907 {
908 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
909
910 if (ndev->ops->disable_se)
911 return ndev->ops->disable_se(ndev, se_idx);
912
913 return 0;
914 }
915
916 static int nci_discover_se(struct nfc_dev *nfc_dev)
917 {
918 int r;
919 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
920
921 if (ndev->ops->discover_se) {
922 r = nci_nfcee_discover(ndev, NCI_NFCEE_DISCOVERY_ACTION_ENABLE);
923 if (r != NCI_STATUS_OK)
924 return -EPROTO;
925
926 return ndev->ops->discover_se(ndev);
927 }
928
929 return 0;
930 }
931
932 static int nci_se_io(struct nfc_dev *nfc_dev, u32 se_idx,
933 u8 *apdu, size_t apdu_length,
934 se_io_cb_t cb, void *cb_context)
935 {
936 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
937
938 if (ndev->ops->se_io)
939 return ndev->ops->se_io(ndev, se_idx, apdu,
940 apdu_length, cb, cb_context);
941
942 return 0;
943 }
944
945 static int nci_fw_download(struct nfc_dev *nfc_dev, const char *firmware_name)
946 {
947 struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
948
949 if (!ndev->ops->fw_download)
950 return -ENOTSUPP;
951
952 return ndev->ops->fw_download(ndev, firmware_name);
953 }
954
955 static struct nfc_ops nci_nfc_ops = {
956 .dev_up = nci_dev_up,
957 .dev_down = nci_dev_down,
958 .start_poll = nci_start_poll,
959 .stop_poll = nci_stop_poll,
960 .dep_link_up = nci_dep_link_up,
961 .dep_link_down = nci_dep_link_down,
962 .activate_target = nci_activate_target,
963 .deactivate_target = nci_deactivate_target,
964 .im_transceive = nci_transceive,
965 .tm_send = nci_tm_send,
966 .enable_se = nci_enable_se,
967 .disable_se = nci_disable_se,
968 .discover_se = nci_discover_se,
969 .se_io = nci_se_io,
970 .fw_download = nci_fw_download,
971 };
972
973 /* ---- Interface to NCI drivers ---- */
974 /**
975 * nci_allocate_device - allocate a new nci device
976 *
977 * @ops: device operations
978 * @supported_protocols: NFC protocols supported by the device
979 */
980 struct nci_dev *nci_allocate_device(struct nci_ops *ops,
981 __u32 supported_protocols,
982 int tx_headroom, int tx_tailroom)
983 {
984 struct nci_dev *ndev;
985
986 pr_debug("supported_protocols 0x%x\n", supported_protocols);
987
988 if (!ops->open || !ops->close || !ops->send)
989 return NULL;
990
991 if (!supported_protocols)
992 return NULL;
993
994 ndev = kzalloc(sizeof(struct nci_dev), GFP_KERNEL);
995 if (!ndev)
996 return NULL;
997
998 ndev->ops = ops;
999
1000 if (ops->n_prop_ops > NCI_MAX_PROPRIETARY_CMD) {
1001 pr_err("Too many proprietary commands: %zd\n",
1002 ops->n_prop_ops);
1003 ops->prop_ops = NULL;
1004 ops->n_prop_ops = 0;
1005 }
1006
1007 ndev->tx_headroom = tx_headroom;
1008 ndev->tx_tailroom = tx_tailroom;
1009 init_completion(&ndev->req_completion);
1010
1011 ndev->nfc_dev = nfc_allocate_device(&nci_nfc_ops,
1012 supported_protocols,
1013 tx_headroom + NCI_DATA_HDR_SIZE,
1014 tx_tailroom);
1015 if (!ndev->nfc_dev)
1016 goto free_nci;
1017
1018 ndev->hci_dev = nci_hci_allocate(ndev);
1019 if (!ndev->hci_dev)
1020 goto free_nfc;
1021
1022 nfc_set_drvdata(ndev->nfc_dev, ndev);
1023
1024 return ndev;
1025
1026 free_nfc:
1027 kfree(ndev->nfc_dev);
1028
1029 free_nci:
1030 kfree(ndev);
1031 return NULL;
1032 }
1033 EXPORT_SYMBOL(nci_allocate_device);
1034
1035 /**
1036 * nci_free_device - deallocate nci device
1037 *
1038 * @ndev: The nci device to deallocate
1039 */
1040 void nci_free_device(struct nci_dev *ndev)
1041 {
1042 nfc_free_device(ndev->nfc_dev);
1043 kfree(ndev);
1044 }
1045 EXPORT_SYMBOL(nci_free_device);
1046
1047 /**
1048 * nci_register_device - register a nci device in the nfc subsystem
1049 *
1050 * @dev: The nci device to register
1051 */
1052 int nci_register_device(struct nci_dev *ndev)
1053 {
1054 int rc;
1055 struct device *dev = &ndev->nfc_dev->dev;
1056 char name[32];
1057
1058 ndev->flags = 0;
1059
1060 INIT_WORK(&ndev->cmd_work, nci_cmd_work);
1061 snprintf(name, sizeof(name), "%s_nci_cmd_wq", dev_name(dev));
1062 ndev->cmd_wq = create_singlethread_workqueue(name);
1063 if (!ndev->cmd_wq) {
1064 rc = -ENOMEM;
1065 goto exit;
1066 }
1067
1068 INIT_WORK(&ndev->rx_work, nci_rx_work);
1069 snprintf(name, sizeof(name), "%s_nci_rx_wq", dev_name(dev));
1070 ndev->rx_wq = create_singlethread_workqueue(name);
1071 if (!ndev->rx_wq) {
1072 rc = -ENOMEM;
1073 goto destroy_cmd_wq_exit;
1074 }
1075
1076 INIT_WORK(&ndev->tx_work, nci_tx_work);
1077 snprintf(name, sizeof(name), "%s_nci_tx_wq", dev_name(dev));
1078 ndev->tx_wq = create_singlethread_workqueue(name);
1079 if (!ndev->tx_wq) {
1080 rc = -ENOMEM;
1081 goto destroy_rx_wq_exit;
1082 }
1083
1084 skb_queue_head_init(&ndev->cmd_q);
1085 skb_queue_head_init(&ndev->rx_q);
1086 skb_queue_head_init(&ndev->tx_q);
1087
1088 setup_timer(&ndev->cmd_timer, nci_cmd_timer,
1089 (unsigned long) ndev);
1090 setup_timer(&ndev->data_timer, nci_data_timer,
1091 (unsigned long) ndev);
1092
1093 mutex_init(&ndev->req_lock);
1094 INIT_LIST_HEAD(&ndev->conn_info_list);
1095
1096 rc = nfc_register_device(ndev->nfc_dev);
1097 if (rc)
1098 goto destroy_rx_wq_exit;
1099
1100 goto exit;
1101
1102 destroy_rx_wq_exit:
1103 destroy_workqueue(ndev->rx_wq);
1104
1105 destroy_cmd_wq_exit:
1106 destroy_workqueue(ndev->cmd_wq);
1107
1108 exit:
1109 return rc;
1110 }
1111 EXPORT_SYMBOL(nci_register_device);
1112
1113 /**
1114 * nci_unregister_device - unregister a nci device in the nfc subsystem
1115 *
1116 * @dev: The nci device to unregister
1117 */
1118 void nci_unregister_device(struct nci_dev *ndev)
1119 {
1120 struct nci_conn_info *conn_info, *n;
1121
1122 nci_close_device(ndev);
1123
1124 destroy_workqueue(ndev->cmd_wq);
1125 destroy_workqueue(ndev->rx_wq);
1126 destroy_workqueue(ndev->tx_wq);
1127
1128 list_for_each_entry_safe(conn_info, n, &ndev->conn_info_list, list) {
1129 list_del(&conn_info->list);
1130 /* conn_info is allocated with devm_kzalloc */
1131 }
1132
1133 nfc_unregister_device(ndev->nfc_dev);
1134 }
1135 EXPORT_SYMBOL(nci_unregister_device);
1136
1137 /**
1138 * nci_recv_frame - receive frame from NCI drivers
1139 *
1140 * @ndev: The nci device
1141 * @skb: The sk_buff to receive
1142 */
1143 int nci_recv_frame(struct nci_dev *ndev, struct sk_buff *skb)
1144 {
1145 pr_debug("len %d\n", skb->len);
1146
1147 if (!ndev || (!test_bit(NCI_UP, &ndev->flags) &&
1148 !test_bit(NCI_INIT, &ndev->flags))) {
1149 kfree_skb(skb);
1150 return -ENXIO;
1151 }
1152
1153 /* Queue frame for rx worker thread */
1154 skb_queue_tail(&ndev->rx_q, skb);
1155 queue_work(ndev->rx_wq, &ndev->rx_work);
1156
1157 return 0;
1158 }
1159 EXPORT_SYMBOL(nci_recv_frame);
1160
1161 static int nci_send_frame(struct nci_dev *ndev, struct sk_buff *skb)
1162 {
1163 pr_debug("len %d\n", skb->len);
1164
1165 if (!ndev) {
1166 kfree_skb(skb);
1167 return -ENODEV;
1168 }
1169
1170 /* Get rid of skb owner, prior to sending to the driver. */
1171 skb_orphan(skb);
1172
1173 /* Send copy to sniffer */
1174 nfc_send_to_raw_sock(ndev->nfc_dev, skb,
1175 RAW_PAYLOAD_NCI, NFC_DIRECTION_TX);
1176
1177 return ndev->ops->send(ndev, skb);
1178 }
1179
1180 /* Send NCI command */
1181 int nci_send_cmd(struct nci_dev *ndev, __u16 opcode, __u8 plen, void *payload)
1182 {
1183 struct nci_ctrl_hdr *hdr;
1184 struct sk_buff *skb;
1185
1186 pr_debug("opcode 0x%x, plen %d\n", opcode, plen);
1187
1188 skb = nci_skb_alloc(ndev, (NCI_CTRL_HDR_SIZE + plen), GFP_KERNEL);
1189 if (!skb) {
1190 pr_err("no memory for command\n");
1191 return -ENOMEM;
1192 }
1193
1194 hdr = (struct nci_ctrl_hdr *) skb_put(skb, NCI_CTRL_HDR_SIZE);
1195 hdr->gid = nci_opcode_gid(opcode);
1196 hdr->oid = nci_opcode_oid(opcode);
1197 hdr->plen = plen;
1198
1199 nci_mt_set((__u8 *)hdr, NCI_MT_CMD_PKT);
1200 nci_pbf_set((__u8 *)hdr, NCI_PBF_LAST);
1201
1202 if (plen)
1203 memcpy(skb_put(skb, plen), payload, plen);
1204
1205 skb_queue_tail(&ndev->cmd_q, skb);
1206 queue_work(ndev->cmd_wq, &ndev->cmd_work);
1207
1208 return 0;
1209 }
1210
1211 /* Proprietary commands API */
1212 static struct nci_prop_ops *prop_cmd_lookup(struct nci_dev *ndev,
1213 __u16 opcode)
1214 {
1215 size_t i;
1216 struct nci_prop_ops *prop_op;
1217
1218 if (!ndev->ops->prop_ops || !ndev->ops->n_prop_ops)
1219 return NULL;
1220
1221 for (i = 0; i < ndev->ops->n_prop_ops; i++) {
1222 prop_op = &ndev->ops->prop_ops[i];
1223 if (prop_op->opcode == opcode)
1224 return prop_op;
1225 }
1226
1227 return NULL;
1228 }
1229
1230 int nci_prop_rsp_packet(struct nci_dev *ndev, __u16 rsp_opcode,
1231 struct sk_buff *skb)
1232 {
1233 struct nci_prop_ops *prop_op;
1234
1235 prop_op = prop_cmd_lookup(ndev, rsp_opcode);
1236 if (!prop_op || !prop_op->rsp)
1237 return -ENOTSUPP;
1238
1239 return prop_op->rsp(ndev, skb);
1240 }
1241
1242 int nci_prop_ntf_packet(struct nci_dev *ndev, __u16 ntf_opcode,
1243 struct sk_buff *skb)
1244 {
1245 struct nci_prop_ops *prop_op;
1246
1247 prop_op = prop_cmd_lookup(ndev, ntf_opcode);
1248 if (!prop_op || !prop_op->ntf)
1249 return -ENOTSUPP;
1250
1251 return prop_op->ntf(ndev, skb);
1252 }
1253
1254 /* ---- NCI TX Data worker thread ---- */
1255
1256 static void nci_tx_work(struct work_struct *work)
1257 {
1258 struct nci_dev *ndev = container_of(work, struct nci_dev, tx_work);
1259 struct nci_conn_info *conn_info;
1260 struct sk_buff *skb;
1261
1262 conn_info = nci_get_conn_info_by_conn_id(ndev, ndev->cur_conn_id);
1263 if (!conn_info)
1264 return;
1265
1266 pr_debug("credits_cnt %d\n", atomic_read(&conn_info->credits_cnt));
1267
1268 /* Send queued tx data */
1269 while (atomic_read(&conn_info->credits_cnt)) {
1270 skb = skb_dequeue(&ndev->tx_q);
1271 if (!skb)
1272 return;
1273
1274 /* Check if data flow control is used */
1275 if (atomic_read(&conn_info->credits_cnt) !=
1276 NCI_DATA_FLOW_CONTROL_NOT_USED)
1277 atomic_dec(&conn_info->credits_cnt);
1278
1279 pr_debug("NCI TX: MT=data, PBF=%d, conn_id=%d, plen=%d\n",
1280 nci_pbf(skb->data),
1281 nci_conn_id(skb->data),
1282 nci_plen(skb->data));
1283
1284 nci_send_frame(ndev, skb);
1285
1286 mod_timer(&ndev->data_timer,
1287 jiffies + msecs_to_jiffies(NCI_DATA_TIMEOUT));
1288 }
1289 }
1290
1291 /* ----- NCI RX worker thread (data & control) ----- */
1292
1293 static void nci_rx_work(struct work_struct *work)
1294 {
1295 struct nci_dev *ndev = container_of(work, struct nci_dev, rx_work);
1296 struct sk_buff *skb;
1297
1298 while ((skb = skb_dequeue(&ndev->rx_q))) {
1299
1300 /* Send copy to sniffer */
1301 nfc_send_to_raw_sock(ndev->nfc_dev, skb,
1302 RAW_PAYLOAD_NCI, NFC_DIRECTION_RX);
1303
1304 /* Process frame */
1305 switch (nci_mt(skb->data)) {
1306 case NCI_MT_RSP_PKT:
1307 nci_rsp_packet(ndev, skb);
1308 break;
1309
1310 case NCI_MT_NTF_PKT:
1311 nci_ntf_packet(ndev, skb);
1312 break;
1313
1314 case NCI_MT_DATA_PKT:
1315 nci_rx_data_packet(ndev, skb);
1316 break;
1317
1318 default:
1319 pr_err("unknown MT 0x%x\n", nci_mt(skb->data));
1320 kfree_skb(skb);
1321 break;
1322 }
1323 }
1324
1325 /* check if a data exchange timout has occurred */
1326 if (test_bit(NCI_DATA_EXCHANGE_TO, &ndev->flags)) {
1327 /* complete the data exchange transaction, if exists */
1328 if (test_bit(NCI_DATA_EXCHANGE, &ndev->flags))
1329 nci_data_exchange_complete(ndev, NULL,
1330 ndev->cur_conn_id,
1331 -ETIMEDOUT);
1332
1333 clear_bit(NCI_DATA_EXCHANGE_TO, &ndev->flags);
1334 }
1335 }
1336
1337 /* ----- NCI TX CMD worker thread ----- */
1338
1339 static void nci_cmd_work(struct work_struct *work)
1340 {
1341 struct nci_dev *ndev = container_of(work, struct nci_dev, cmd_work);
1342 struct sk_buff *skb;
1343
1344 pr_debug("cmd_cnt %d\n", atomic_read(&ndev->cmd_cnt));
1345
1346 /* Send queued command */
1347 if (atomic_read(&ndev->cmd_cnt)) {
1348 skb = skb_dequeue(&ndev->cmd_q);
1349 if (!skb)
1350 return;
1351
1352 atomic_dec(&ndev->cmd_cnt);
1353
1354 pr_debug("NCI TX: MT=cmd, PBF=%d, GID=0x%x, OID=0x%x, plen=%d\n",
1355 nci_pbf(skb->data),
1356 nci_opcode_gid(nci_opcode(skb->data)),
1357 nci_opcode_oid(nci_opcode(skb->data)),
1358 nci_plen(skb->data));
1359
1360 nci_send_frame(ndev, skb);
1361
1362 mod_timer(&ndev->cmd_timer,
1363 jiffies + msecs_to_jiffies(NCI_CMD_TIMEOUT));
1364 }
1365 }
1366
1367 MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.067902 seconds and 5 git commands to generate.