blob: f1e442a39db8d9f37f547103c37991ca335dfb79 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * llc_core.c - Minimum needed routines for sap handling and module init/exit
3 *
4 * Copyright (c) 1997 by Procom Technology, Inc.
5 * 2001-2003 by Arnaldo Carvalho de Melo <acme@conectiva.com.br>
6 *
7 * This program can be redistributed or modified under the terms of the
8 * GNU General Public License as published by the Free Software Foundation.
9 * This program is distributed without any warranty or implied warranty
10 * of merchantability or fitness for a particular purpose.
11 *
12 * See the GNU General Public License for more details.
13 */
14
15#include <linux/module.h>
16#include <linux/interrupt.h>
17#include <linux/if_ether.h>
18#include <linux/netdevice.h>
19#include <linux/slab.h>
20#include <linux/string.h>
21#include <linux/init.h>
Eric W. Biederman881d9662007-09-17 11:56:21 -070022#include <net/net_namespace.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <net/llc.h>
24
25LIST_HEAD(llc_sap_list);
stephen hemminger5e419e62014-01-03 09:19:51 -080026static DEFINE_SPINLOCK(llc_sap_list_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070027
Linus Torvalds1da177e2005-04-16 15:20:36 -070028/**
29 * llc_sap_alloc - allocates and initializes sap.
30 *
31 * Allocates and initializes sap.
32 */
33static struct llc_sap *llc_sap_alloc(void)
34{
Panagiotis Issaris0da974f2006-07-21 14:51:30 -070035 struct llc_sap *sap = kzalloc(sizeof(*sap), GFP_ATOMIC);
Octavian Purdila52d58ae2009-12-26 11:51:05 +000036 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
38 if (sap) {
Joonwoo Parka5a04812008-03-28 16:28:36 -070039 /* sap->laddr.mac - leave as a null, it's filled by bind */
Linus Torvalds1da177e2005-04-16 15:20:36 -070040 sap->state = LLC_SAP_STATE_ACTIVE;
Octavian Purdilab76f5a82009-12-26 11:51:02 +000041 spin_lock_init(&sap->sk_lock);
Octavian Purdila52d58ae2009-12-26 11:51:05 +000042 for (i = 0; i < LLC_SK_LADDR_HASH_ENTRIES; i++)
43 INIT_HLIST_NULLS_HEAD(&sap->sk_laddr_hash[i], i);
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -030044 atomic_set(&sap->refcnt, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -070045 }
46 return sap;
47}
48
Arnaldo Carvalho de Melo2928c192005-09-22 05:14:33 -030049static struct llc_sap *__llc_sap_find(unsigned char sap_value)
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -030050{
Weilong Chen3cdba602013-12-20 11:14:59 +080051 struct llc_sap *sap;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -030052
53 list_for_each_entry(sap, &llc_sap_list, node)
54 if (sap->laddr.lsap == sap_value)
55 goto out;
56 sap = NULL;
57out:
58 return sap;
59}
60
Linus Torvalds1da177e2005-04-16 15:20:36 -070061/**
62 * llc_sap_find - searchs a SAP in station
63 * @sap_value: sap to be found
64 *
65 * Searchs for a sap in the sap list of the LLC's station upon the sap ID.
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -030066 * If the sap is found it will be refcounted and the user will have to do
67 * a llc_sap_put after use.
Linus Torvalds1da177e2005-04-16 15:20:36 -070068 * Returns the sap or %NULL if not found.
69 */
70struct llc_sap *llc_sap_find(unsigned char sap_value)
71{
Octavian Purdila8beb9ab2009-12-26 11:51:06 +000072 struct llc_sap *sap;
Linus Torvalds1da177e2005-04-16 15:20:36 -070073
Octavian Purdila8beb9ab2009-12-26 11:51:06 +000074 rcu_read_lock_bh();
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -030075 sap = __llc_sap_find(sap_value);
Cong Wang2ff9f082018-08-07 12:41:38 -070076 if (!sap || !llc_sap_hold_safe(sap))
77 sap = NULL;
Octavian Purdila8beb9ab2009-12-26 11:51:06 +000078 rcu_read_unlock_bh();
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 return sap;
80}
81
82/**
83 * llc_sap_open - open interface to the upper layers.
84 * @lsap: SAP number.
85 * @func: rcv func for datalink protos
86 *
87 * Interface function to upper layer. Each one who wants to get a SAP
88 * (for example NetBEUI) should call this function. Returns the opened
89 * SAP for success, NULL for failure.
90 */
91struct llc_sap *llc_sap_open(unsigned char lsap,
92 int (*func)(struct sk_buff *skb,
93 struct net_device *dev,
David S. Millerf2ccd8f2005-08-09 19:34:12 -070094 struct packet_type *pt,
95 struct net_device *orig_dev))
Linus Torvalds1da177e2005-04-16 15:20:36 -070096{
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -030097 struct llc_sap *sap = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Octavian Purdila8beb9ab2009-12-26 11:51:06 +000099 spin_lock_bh(&llc_sap_list_lock);
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300100 if (__llc_sap_find(lsap)) /* SAP already exists */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 sap = llc_sap_alloc();
103 if (!sap)
104 goto out;
105 sap->laddr.lsap = lsap;
106 sap->rcv_func = func;
Octavian Purdila8beb9ab2009-12-26 11:51:06 +0000107 list_add_tail_rcu(&sap->node, &llc_sap_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108out:
Octavian Purdila8beb9ab2009-12-26 11:51:06 +0000109 spin_unlock_bh(&llc_sap_list_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 return sap;
111}
112
113/**
114 * llc_sap_close - close interface for upper layers.
115 * @sap: SAP to be closed.
116 *
117 * Close interface function to upper layer. Each one who wants to
118 * close an open SAP (for example NetBEUI) should call this function.
119 * Removes this sap from the list of saps in the station and then
120 * frees the memory for this sap.
121 */
122void llc_sap_close(struct llc_sap *sap)
123{
Octavian Purdila52d58ae2009-12-26 11:51:05 +0000124 WARN_ON(sap->sk_count);
Octavian Purdila8beb9ab2009-12-26 11:51:06 +0000125
126 spin_lock_bh(&llc_sap_list_lock);
127 list_del_rcu(&sap->node);
128 spin_unlock_bh(&llc_sap_list_lock);
129
Cong Wang7228cb82018-09-11 11:42:06 -0700130 kfree_rcu(sap, rcu);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131}
132
Stephen Hemminger7546dd92009-03-09 08:18:29 +0000133static struct packet_type llc_packet_type __read_mostly = {
Harvey Harrison09640e62009-02-01 00:45:17 -0800134 .type = cpu_to_be16(ETH_P_802_2),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 .func = llc_rcv,
136};
137
Stephen Hemminger7546dd92009-03-09 08:18:29 +0000138static struct packet_type llc_tr_packet_type __read_mostly = {
Harvey Harrison09640e62009-02-01 00:45:17 -0800139 .type = cpu_to_be16(ETH_P_TR_802_2),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 .func = llc_rcv,
141};
142
143static int __init llc_init(void)
144{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145 dev_add_pack(&llc_packet_type);
146 dev_add_pack(&llc_tr_packet_type);
147 return 0;
148}
149
150static void __exit llc_exit(void)
151{
152 dev_remove_pack(&llc_packet_type);
153 dev_remove_pack(&llc_tr_packet_type);
154}
155
156module_init(llc_init);
157module_exit(llc_exit);
158
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159EXPORT_SYMBOL(llc_sap_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160EXPORT_SYMBOL(llc_sap_find);
161EXPORT_SYMBOL(llc_sap_open);
162EXPORT_SYMBOL(llc_sap_close);
163
164MODULE_LICENSE("GPL");
165MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
166MODULE_DESCRIPTION("LLC IEEE 802.2 core support");