2 * Link Layer Control manager
4 * Copyright (C) 2012 Intel Corporation. All rights reserved.
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.
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.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, see <http://www.gnu.org/licenses/>.
19 #include <net/nfc/llc.h>
23 static struct list_head llc_engines;
25 int nfc_llc_init(void)
29 INIT_LIST_HEAD(&llc_engines);
31 r = nfc_llc_nop_register();
35 r = nfc_llc_shdlc_register();
46 void nfc_llc_exit(void)
48 struct nfc_llc_engine *llc_engine, *n;
50 list_for_each_entry_safe(llc_engine, n, &llc_engines, entry) {
51 list_del(&llc_engine->entry);
52 kfree(llc_engine->name);
57 int nfc_llc_register(const char *name, struct nfc_llc_ops *ops)
59 struct nfc_llc_engine *llc_engine;
61 llc_engine = kzalloc(sizeof(struct nfc_llc_engine), GFP_KERNEL);
62 if (llc_engine == NULL)
65 llc_engine->name = kstrdup(name, GFP_KERNEL);
66 if (llc_engine->name == NULL) {
70 llc_engine->ops = ops;
72 INIT_LIST_HEAD(&llc_engine->entry);
73 list_add_tail(&llc_engine->entry, &llc_engines);
78 static struct nfc_llc_engine *nfc_llc_name_to_engine(const char *name)
80 struct nfc_llc_engine *llc_engine;
82 list_for_each_entry(llc_engine, &llc_engines, entry) {
83 if (strcmp(llc_engine->name, name) == 0)
90 void nfc_llc_unregister(const char *name)
92 struct nfc_llc_engine *llc_engine;
94 llc_engine = nfc_llc_name_to_engine(name);
95 if (llc_engine == NULL)
98 list_del(&llc_engine->entry);
99 kfree(llc_engine->name);
103 struct nfc_llc *nfc_llc_allocate(const char *name, struct nfc_hci_dev *hdev,
104 xmit_to_drv_t xmit_to_drv,
105 rcv_to_hci_t rcv_to_hci, int tx_headroom,
106 int tx_tailroom, llc_failure_t llc_failure)
108 struct nfc_llc_engine *llc_engine;
111 llc_engine = nfc_llc_name_to_engine(name);
112 if (llc_engine == NULL)
115 llc = kzalloc(sizeof(struct nfc_llc), GFP_KERNEL);
119 llc->data = llc_engine->ops->init(hdev, xmit_to_drv, rcv_to_hci,
120 tx_headroom, tx_tailroom,
121 &llc->rx_headroom, &llc->rx_tailroom,
123 if (llc->data == NULL) {
127 llc->ops = llc_engine->ops;
132 void nfc_llc_free(struct nfc_llc *llc)
134 llc->ops->deinit(llc);
138 inline void nfc_llc_get_rx_head_tail_room(struct nfc_llc *llc, int *rx_headroom,
141 *rx_headroom = llc->rx_headroom;
142 *rx_tailroom = llc->rx_tailroom;
145 inline int nfc_llc_start(struct nfc_llc *llc)
147 return llc->ops->start(llc);
150 inline int nfc_llc_stop(struct nfc_llc *llc)
152 return llc->ops->stop(llc);
155 inline void nfc_llc_rcv_from_drv(struct nfc_llc *llc, struct sk_buff *skb)
157 llc->ops->rcv_from_drv(llc, skb);
160 inline int nfc_llc_xmit_from_hci(struct nfc_llc *llc, struct sk_buff *skb)
162 return llc->ops->xmit_from_hci(llc, skb);
165 inline void *nfc_llc_get_data(struct nfc_llc *llc)