Merge branch 'master' of master.kernel.org:/pub/scm/linux/kernel/git/davem/net-2.6
[linux-2.6] / net / dccp / ccid.c
1 /*
2  *  net/dccp/ccid.c
3  *
4  *  An implementation of the DCCP protocol
5  *  Arnaldo Carvalho de Melo <acme@conectiva.com.br>
6  *
7  *  CCID infrastructure
8  *
9  *      This program is free software; you can redistribute it and/or modify it
10  *      under the terms of the GNU General Public License version 2 as
11  *      published by the Free Software Foundation.
12  */
13
14 #include "ccid.h"
15
16 static u8 builtin_ccids[] = {
17         DCCPC_CCID2,            /* CCID2 is supported by default */
18 #if defined(CONFIG_IP_DCCP_CCID3) || defined(CONFIG_IP_DCCP_CCID3_MODULE)
19         DCCPC_CCID3,
20 #endif
21 };
22
23 static struct ccid_operations *ccids[CCID_MAX];
24 #if defined(CONFIG_SMP) || defined(CONFIG_PREEMPT)
25 static atomic_t ccids_lockct = ATOMIC_INIT(0);
26 static DEFINE_SPINLOCK(ccids_lock);
27
28 /*
29  * The strategy is: modifications ccids vector are short, do not sleep and
30  * veeery rare, but read access should be free of any exclusive locks.
31  */
32 static void ccids_write_lock(void)
33 {
34         spin_lock(&ccids_lock);
35         while (atomic_read(&ccids_lockct) != 0) {
36                 spin_unlock(&ccids_lock);
37                 yield();
38                 spin_lock(&ccids_lock);
39         }
40 }
41
42 static inline void ccids_write_unlock(void)
43 {
44         spin_unlock(&ccids_lock);
45 }
46
47 static inline void ccids_read_lock(void)
48 {
49         atomic_inc(&ccids_lockct);
50         smp_mb__after_atomic_inc();
51         spin_unlock_wait(&ccids_lock);
52 }
53
54 static inline void ccids_read_unlock(void)
55 {
56         atomic_dec(&ccids_lockct);
57 }
58
59 #else
60 #define ccids_write_lock() do { } while(0)
61 #define ccids_write_unlock() do { } while(0)
62 #define ccids_read_lock() do { } while(0)
63 #define ccids_read_unlock() do { } while(0)
64 #endif
65
66 static struct kmem_cache *ccid_kmem_cache_create(int obj_size, const char *fmt,...)
67 {
68         struct kmem_cache *slab;
69         char slab_name_fmt[32], *slab_name;
70         va_list args;
71
72         va_start(args, fmt);
73         vsnprintf(slab_name_fmt, sizeof(slab_name_fmt), fmt, args);
74         va_end(args);
75
76         slab_name = kstrdup(slab_name_fmt, GFP_KERNEL);
77         if (slab_name == NULL)
78                 return NULL;
79         slab = kmem_cache_create(slab_name, sizeof(struct ccid) + obj_size, 0,
80                                  SLAB_HWCACHE_ALIGN, NULL);
81         if (slab == NULL)
82                 kfree(slab_name);
83         return slab;
84 }
85
86 static void ccid_kmem_cache_destroy(struct kmem_cache *slab)
87 {
88         if (slab != NULL) {
89                 const char *name = kmem_cache_name(slab);
90
91                 kmem_cache_destroy(slab);
92                 kfree(name);
93         }
94 }
95
96 /* check that up to @array_len members in @ccid_array are supported */
97 bool ccid_support_check(u8 const *ccid_array, u8 array_len)
98 {
99         u8 i, j, found;
100
101         for (i = 0, found = 0; i < array_len; i++, found = 0) {
102                 for (j = 0; !found && j < ARRAY_SIZE(builtin_ccids); j++)
103                         found = (ccid_array[i] == builtin_ccids[j]);
104                 if (!found)
105                         return false;
106         }
107         return true;
108 }
109
110 /**
111  * ccid_get_builtin_ccids  -  Provide copy of `builtin' CCID array
112  * @ccid_array: pointer to copy into
113  * @array_len: value to return length into
114  * This function allocates memory - caller must see that it is freed after use.
115  */
116 int ccid_get_builtin_ccids(u8 **ccid_array, u8 *array_len)
117 {
118         *ccid_array = kmemdup(builtin_ccids, sizeof(builtin_ccids), gfp_any());
119         if (*ccid_array == NULL)
120                 return -ENOBUFS;
121         *array_len = ARRAY_SIZE(builtin_ccids);
122         return 0;
123 }
124
125 int ccid_getsockopt_builtin_ccids(struct sock *sk, int len,
126                                     char __user *optval, int __user *optlen)
127 {
128         if (len < sizeof(builtin_ccids))
129                 return -EINVAL;
130
131         if (put_user(sizeof(builtin_ccids), optlen) ||
132             copy_to_user(optval, builtin_ccids, sizeof(builtin_ccids)))
133                 return -EFAULT;
134         return 0;
135 }
136
137 int ccid_register(struct ccid_operations *ccid_ops)
138 {
139         int err = -ENOBUFS;
140
141         ccid_ops->ccid_hc_rx_slab =
142                         ccid_kmem_cache_create(ccid_ops->ccid_hc_rx_obj_size,
143                                                "ccid%u_hc_rx_sock",
144                                                ccid_ops->ccid_id);
145         if (ccid_ops->ccid_hc_rx_slab == NULL)
146                 goto out;
147
148         ccid_ops->ccid_hc_tx_slab =
149                         ccid_kmem_cache_create(ccid_ops->ccid_hc_tx_obj_size,
150                                                "ccid%u_hc_tx_sock",
151                                                ccid_ops->ccid_id);
152         if (ccid_ops->ccid_hc_tx_slab == NULL)
153                 goto out_free_rx_slab;
154
155         ccids_write_lock();
156         err = -EEXIST;
157         if (ccids[ccid_ops->ccid_id] == NULL) {
158                 ccids[ccid_ops->ccid_id] = ccid_ops;
159                 err = 0;
160         }
161         ccids_write_unlock();
162         if (err != 0)
163                 goto out_free_tx_slab;
164
165         pr_info("CCID: Registered CCID %d (%s)\n",
166                 ccid_ops->ccid_id, ccid_ops->ccid_name);
167 out:
168         return err;
169 out_free_tx_slab:
170         ccid_kmem_cache_destroy(ccid_ops->ccid_hc_tx_slab);
171         ccid_ops->ccid_hc_tx_slab = NULL;
172         goto out;
173 out_free_rx_slab:
174         ccid_kmem_cache_destroy(ccid_ops->ccid_hc_rx_slab);
175         ccid_ops->ccid_hc_rx_slab = NULL;
176         goto out;
177 }
178
179 EXPORT_SYMBOL_GPL(ccid_register);
180
181 int ccid_unregister(struct ccid_operations *ccid_ops)
182 {
183         ccids_write_lock();
184         ccids[ccid_ops->ccid_id] = NULL;
185         ccids_write_unlock();
186
187         ccid_kmem_cache_destroy(ccid_ops->ccid_hc_tx_slab);
188         ccid_ops->ccid_hc_tx_slab = NULL;
189         ccid_kmem_cache_destroy(ccid_ops->ccid_hc_rx_slab);
190         ccid_ops->ccid_hc_rx_slab = NULL;
191
192         pr_info("CCID: Unregistered CCID %d (%s)\n",
193                 ccid_ops->ccid_id, ccid_ops->ccid_name);
194         return 0;
195 }
196
197 EXPORT_SYMBOL_GPL(ccid_unregister);
198
199 struct ccid *ccid_new(unsigned char id, struct sock *sk, int rx, gfp_t gfp)
200 {
201         struct ccid_operations *ccid_ops;
202         struct ccid *ccid = NULL;
203
204         ccids_read_lock();
205 #ifdef CONFIG_MODULES
206         if (ccids[id] == NULL) {
207                 /* We only try to load if in process context */
208                 ccids_read_unlock();
209                 if (gfp & GFP_ATOMIC)
210                         goto out;
211                 request_module("net-dccp-ccid-%d", id);
212                 ccids_read_lock();
213         }
214 #endif
215         ccid_ops = ccids[id];
216         if (ccid_ops == NULL)
217                 goto out_unlock;
218
219         if (!try_module_get(ccid_ops->ccid_owner))
220                 goto out_unlock;
221
222         ccids_read_unlock();
223
224         ccid = kmem_cache_alloc(rx ? ccid_ops->ccid_hc_rx_slab :
225                                      ccid_ops->ccid_hc_tx_slab, gfp);
226         if (ccid == NULL)
227                 goto out_module_put;
228         ccid->ccid_ops = ccid_ops;
229         if (rx) {
230                 memset(ccid + 1, 0, ccid_ops->ccid_hc_rx_obj_size);
231                 if (ccid->ccid_ops->ccid_hc_rx_init != NULL &&
232                     ccid->ccid_ops->ccid_hc_rx_init(ccid, sk) != 0)
233                         goto out_free_ccid;
234         } else {
235                 memset(ccid + 1, 0, ccid_ops->ccid_hc_tx_obj_size);
236                 if (ccid->ccid_ops->ccid_hc_tx_init != NULL &&
237                     ccid->ccid_ops->ccid_hc_tx_init(ccid, sk) != 0)
238                         goto out_free_ccid;
239         }
240 out:
241         return ccid;
242 out_unlock:
243         ccids_read_unlock();
244         goto out;
245 out_free_ccid:
246         kmem_cache_free(rx ? ccid_ops->ccid_hc_rx_slab :
247                         ccid_ops->ccid_hc_tx_slab, ccid);
248         ccid = NULL;
249 out_module_put:
250         module_put(ccid_ops->ccid_owner);
251         goto out;
252 }
253
254 EXPORT_SYMBOL_GPL(ccid_new);
255
256 struct ccid *ccid_hc_rx_new(unsigned char id, struct sock *sk, gfp_t gfp)
257 {
258         return ccid_new(id, sk, 1, gfp);
259 }
260
261 EXPORT_SYMBOL_GPL(ccid_hc_rx_new);
262
263 struct ccid *ccid_hc_tx_new(unsigned char id,struct sock *sk,  gfp_t gfp)
264 {
265         return ccid_new(id, sk, 0, gfp);
266 }
267
268 EXPORT_SYMBOL_GPL(ccid_hc_tx_new);
269
270 static void ccid_delete(struct ccid *ccid, struct sock *sk, int rx)
271 {
272         struct ccid_operations *ccid_ops;
273
274         if (ccid == NULL)
275                 return;
276
277         ccid_ops = ccid->ccid_ops;
278         if (rx) {
279                 if (ccid_ops->ccid_hc_rx_exit != NULL)
280                         ccid_ops->ccid_hc_rx_exit(sk);
281                 kmem_cache_free(ccid_ops->ccid_hc_rx_slab,  ccid);
282         } else {
283                 if (ccid_ops->ccid_hc_tx_exit != NULL)
284                         ccid_ops->ccid_hc_tx_exit(sk);
285                 kmem_cache_free(ccid_ops->ccid_hc_tx_slab,  ccid);
286         }
287         ccids_read_lock();
288         if (ccids[ccid_ops->ccid_id] != NULL)
289                 module_put(ccid_ops->ccid_owner);
290         ccids_read_unlock();
291 }
292
293 void ccid_hc_rx_delete(struct ccid *ccid, struct sock *sk)
294 {
295         ccid_delete(ccid, sk, 1);
296 }
297
298 EXPORT_SYMBOL_GPL(ccid_hc_rx_delete);
299
300 void ccid_hc_tx_delete(struct ccid *ccid, struct sock *sk)
301 {
302         ccid_delete(ccid, sk, 0);
303 }
304
305 EXPORT_SYMBOL_GPL(ccid_hc_tx_delete);