[NET]: Rework dev_base via list_head (v3)
[linux-2.6.git] / net / llc / llc_core.c
1 /*
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>
22 #include <net/llc.h>
23
24 LIST_HEAD(llc_sap_list);
25 DEFINE_RWLOCK(llc_sap_list_lock);
26
27 unsigned char llc_station_mac_sa[ETH_ALEN];
28
29 /**
30  *      llc_sap_alloc - allocates and initializes sap.
31  *
32  *      Allocates and initializes sap.
33  */
34 static struct llc_sap *llc_sap_alloc(void)
35 {
36         struct llc_sap *sap = kzalloc(sizeof(*sap), GFP_ATOMIC);
37
38         if (sap) {
39                 sap->state = LLC_SAP_STATE_ACTIVE;
40                 memcpy(sap->laddr.mac, llc_station_mac_sa, ETH_ALEN);
41                 rwlock_init(&sap->sk_list.lock);
42                 atomic_set(&sap->refcnt, 1);
43         }
44         return sap;
45 }
46
47 /**
48  *      llc_add_sap - add sap to station list
49  *      @sap: Address of the sap
50  *
51  *      Adds a sap to the LLC's station sap list.
52  */
53 static void llc_add_sap(struct llc_sap *sap)
54 {
55         list_add_tail(&sap->node, &llc_sap_list);
56 }
57
58 /**
59  *      llc_del_sap - del sap from station list
60  *      @sap: Address of the sap
61  *
62  *      Removes a sap to the LLC's station sap list.
63  */
64 static void llc_del_sap(struct llc_sap *sap)
65 {
66         write_lock_bh(&llc_sap_list_lock);
67         list_del(&sap->node);
68         write_unlock_bh(&llc_sap_list_lock);
69 }
70
71 static struct llc_sap *__llc_sap_find(unsigned char sap_value)
72 {
73         struct llc_sap* sap;
74
75         list_for_each_entry(sap, &llc_sap_list, node)
76                 if (sap->laddr.lsap == sap_value)
77                         goto out;
78         sap = NULL;
79 out:
80         return sap;
81 }
82
83 /**
84  *      llc_sap_find - searchs a SAP in station
85  *      @sap_value: sap to be found
86  *
87  *      Searchs for a sap in the sap list of the LLC's station upon the sap ID.
88  *      If the sap is found it will be refcounted and the user will have to do
89  *      a llc_sap_put after use.
90  *      Returns the sap or %NULL if not found.
91  */
92 struct llc_sap *llc_sap_find(unsigned char sap_value)
93 {
94         struct llc_sap* sap;
95
96         read_lock_bh(&llc_sap_list_lock);
97         sap = __llc_sap_find(sap_value);
98         if (sap)
99                 llc_sap_hold(sap);
100         read_unlock_bh(&llc_sap_list_lock);
101         return sap;
102 }
103
104 /**
105  *      llc_sap_open - open interface to the upper layers.
106  *      @lsap: SAP number.
107  *      @func: rcv func for datalink protos
108  *
109  *      Interface function to upper layer. Each one who wants to get a SAP
110  *      (for example NetBEUI) should call this function. Returns the opened
111  *      SAP for success, NULL for failure.
112  */
113 struct llc_sap *llc_sap_open(unsigned char lsap,
114                              int (*func)(struct sk_buff *skb,
115                                          struct net_device *dev,
116                                          struct packet_type *pt,
117                                          struct net_device *orig_dev))
118 {
119         struct llc_sap *sap = NULL;
120
121         write_lock_bh(&llc_sap_list_lock);
122         if (__llc_sap_find(lsap)) /* SAP already exists */
123                 goto out;
124         sap = llc_sap_alloc();
125         if (!sap)
126                 goto out;
127         sap->laddr.lsap = lsap;
128         sap->rcv_func   = func;
129         llc_add_sap(sap);
130 out:
131         write_unlock_bh(&llc_sap_list_lock);
132         return sap;
133 }
134
135 /**
136  *      llc_sap_close - close interface for upper layers.
137  *      @sap: SAP to be closed.
138  *
139  *      Close interface function to upper layer. Each one who wants to
140  *      close an open SAP (for example NetBEUI) should call this function.
141  *      Removes this sap from the list of saps in the station and then
142  *      frees the memory for this sap.
143  */
144 void llc_sap_close(struct llc_sap *sap)
145 {
146         WARN_ON(!hlist_empty(&sap->sk_list.list));
147         llc_del_sap(sap);
148         kfree(sap);
149 }
150
151 static struct packet_type llc_packet_type = {
152         .type = __constant_htons(ETH_P_802_2),
153         .func = llc_rcv,
154 };
155
156 static struct packet_type llc_tr_packet_type = {
157         .type = __constant_htons(ETH_P_TR_802_2),
158         .func = llc_rcv,
159 };
160
161 static int __init llc_init(void)
162 {
163         struct net_device *dev;
164
165         dev = first_net_device();
166         if (dev != NULL)
167                 dev = next_net_device(dev);
168
169         if (dev != NULL)
170                 memcpy(llc_station_mac_sa, dev->dev_addr, ETH_ALEN);
171         else
172                 memset(llc_station_mac_sa, 0, ETH_ALEN);
173         dev_add_pack(&llc_packet_type);
174         dev_add_pack(&llc_tr_packet_type);
175         return 0;
176 }
177
178 static void __exit llc_exit(void)
179 {
180         dev_remove_pack(&llc_packet_type);
181         dev_remove_pack(&llc_tr_packet_type);
182 }
183
184 module_init(llc_init);
185 module_exit(llc_exit);
186
187 EXPORT_SYMBOL(llc_station_mac_sa);
188 EXPORT_SYMBOL(llc_sap_list);
189 EXPORT_SYMBOL(llc_sap_list_lock);
190 EXPORT_SYMBOL(llc_sap_find);
191 EXPORT_SYMBOL(llc_sap_open);
192 EXPORT_SYMBOL(llc_sap_close);
193
194 MODULE_LICENSE("GPL");
195 MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
196 MODULE_DESCRIPTION("LLC IEEE 802.2 core support");