Upgrade b43 and mac80211.
[openwrt/staging/lynxis/omap.git] / package / mac80211 / src / net / wireless / wext.c
1 /*
2 * This file implement the Wireless Extensions APIs.
3 *
4 * Authors : Jean Tourrilhes - HPL - <jt@hpl.hp.com>
5 * Copyright (c) 1997-2007 Jean Tourrilhes, All Rights Reserved.
6 *
7 * (As all part of the Linux kernel, this file is GPL)
8 */
9
10 /************************** DOCUMENTATION **************************/
11 /*
12 * API definition :
13 * --------------
14 * See <linux/wireless.h> for details of the APIs and the rest.
15 *
16 * History :
17 * -------
18 *
19 * v1 - 5.12.01 - Jean II
20 * o Created this file.
21 *
22 * v2 - 13.12.01 - Jean II
23 * o Move /proc/net/wireless stuff from net/core/dev.c to here
24 * o Make Wireless Extension IOCTLs go through here
25 * o Added iw_handler handling ;-)
26 * o Added standard ioctl description
27 * o Initial dumb commit strategy based on orinoco.c
28 *
29 * v3 - 19.12.01 - Jean II
30 * o Make sure we don't go out of standard_ioctl[] in ioctl_standard_call
31 * o Add event dispatcher function
32 * o Add event description
33 * o Propagate events as rtnetlink IFLA_WIRELESS option
34 * o Generate event on selected SET requests
35 *
36 * v4 - 18.04.02 - Jean II
37 * o Fix stupid off by one in iw_ioctl_description : IW_ESSID_MAX_SIZE + 1
38 *
39 * v5 - 21.06.02 - Jean II
40 * o Add IW_PRIV_TYPE_ADDR in priv_type_size (+cleanup)
41 * o Reshuffle IW_HEADER_TYPE_XXX to map IW_PRIV_TYPE_XXX changes
42 * o Add IWEVCUSTOM for driver specific event/scanning token
43 * o Turn on WE_STRICT_WRITE by default + kernel warning
44 * o Fix WE_STRICT_WRITE in ioctl_export_private() (32 => iw_num)
45 * o Fix off-by-one in test (extra_size <= IFNAMSIZ)
46 *
47 * v6 - 9.01.03 - Jean II
48 * o Add common spy support : iw_handler_set_spy(), wireless_spy_update()
49 * o Add enhanced spy support : iw_handler_set_thrspy() and event.
50 * o Add WIRELESS_EXT version display in /proc/net/wireless
51 *
52 * v6 - 18.06.04 - Jean II
53 * o Change get_spydata() method for added safety
54 * o Remove spy #ifdef, they are always on -> cleaner code
55 * o Allow any size GET request if user specifies length > max
56 * and if request has IW_DESCR_FLAG_NOMAX flag or is SIOCGIWPRIV
57 * o Start migrating get_wireless_stats to struct iw_handler_def
58 * o Add wmb() in iw_handler_set_spy() for non-coherent archs/cpus
59 * Based on patch from Pavel Roskin <proski@gnu.org> :
60 * o Fix kernel data leak to user space in private handler handling
61 *
62 * v7 - 18.3.05 - Jean II
63 * o Remove (struct iw_point *)->pointer from events and streams
64 * o Remove spy_offset from struct iw_handler_def
65 * o Start deprecating dev->get_wireless_stats, output a warning
66 * o If IW_QUAL_DBM is set, show dBm values in /proc/net/wireless
67 * o Don't loose INVALID/DBM flags when clearing UPDATED flags (iwstats)
68 *
69 * v8 - 17.02.06 - Jean II
70 * o RtNetlink requests support (SET/GET)
71 *
72 * v8b - 03.08.06 - Herbert Xu
73 * o Fix Wireless Event locking issues.
74 *
75 * v9 - 14.3.06 - Jean II
76 * o Change length in ESSID and NICK to strlen() instead of strlen()+1
77 * o Make standard_ioctl_num and standard_event_num unsigned
78 * o Remove (struct net_device *)->get_wireless_stats()
79 *
80 * v10 - 16.3.07 - Jean II
81 * o Prevent leaking of kernel space in stream on 64 bits.
82 */
83
84 /***************************** INCLUDES *****************************/
85
86 #include <linux/module.h>
87 #include <linux/types.h> /* off_t */
88 #include <linux/netdevice.h> /* struct ifreq, dev_get_by_name() */
89 #include <linux/proc_fs.h>
90 #include <linux/rtnetlink.h> /* rtnetlink stuff */
91 #include <linux/seq_file.h>
92 #include <linux/init.h> /* for __init */
93 #include <linux/if_arp.h> /* ARPHRD_ETHER */
94 #include <linux/etherdevice.h> /* compare_ether_addr */
95 #include <linux/interrupt.h>
96 #include <net/net_namespace.h>
97
98 #include <linux/wireless.h> /* Pretty obvious */
99 #include <net/iw_handler.h> /* New driver API */
100 #include <net/netlink.h>
101 #include <net/wext.h>
102
103 #include <asm/uaccess.h> /* copy_to_user() */
104
105 /************************* GLOBAL VARIABLES *************************/
106 /*
107 * You should not use global variables, because of re-entrancy.
108 * On our case, it's only const, so it's OK...
109 */
110 /*
111 * Meta-data about all the standard Wireless Extension request we
112 * know about.
113 */
114 static const struct iw_ioctl_description standard_ioctl[] = {
115 [SIOCSIWCOMMIT - SIOCIWFIRST] = {
116 .header_type = IW_HEADER_TYPE_NULL,
117 },
118 [SIOCGIWNAME - SIOCIWFIRST] = {
119 .header_type = IW_HEADER_TYPE_CHAR,
120 .flags = IW_DESCR_FLAG_DUMP,
121 },
122 [SIOCSIWNWID - SIOCIWFIRST] = {
123 .header_type = IW_HEADER_TYPE_PARAM,
124 .flags = IW_DESCR_FLAG_EVENT,
125 },
126 [SIOCGIWNWID - SIOCIWFIRST] = {
127 .header_type = IW_HEADER_TYPE_PARAM,
128 .flags = IW_DESCR_FLAG_DUMP,
129 },
130 [SIOCSIWFREQ - SIOCIWFIRST] = {
131 .header_type = IW_HEADER_TYPE_FREQ,
132 .flags = IW_DESCR_FLAG_EVENT,
133 },
134 [SIOCGIWFREQ - SIOCIWFIRST] = {
135 .header_type = IW_HEADER_TYPE_FREQ,
136 .flags = IW_DESCR_FLAG_DUMP,
137 },
138 [SIOCSIWMODE - SIOCIWFIRST] = {
139 .header_type = IW_HEADER_TYPE_UINT,
140 .flags = IW_DESCR_FLAG_EVENT,
141 },
142 [SIOCGIWMODE - SIOCIWFIRST] = {
143 .header_type = IW_HEADER_TYPE_UINT,
144 .flags = IW_DESCR_FLAG_DUMP,
145 },
146 [SIOCSIWSENS - SIOCIWFIRST] = {
147 .header_type = IW_HEADER_TYPE_PARAM,
148 },
149 [SIOCGIWSENS - SIOCIWFIRST] = {
150 .header_type = IW_HEADER_TYPE_PARAM,
151 },
152 [SIOCSIWRANGE - SIOCIWFIRST] = {
153 .header_type = IW_HEADER_TYPE_NULL,
154 },
155 [SIOCGIWRANGE - SIOCIWFIRST] = {
156 .header_type = IW_HEADER_TYPE_POINT,
157 .token_size = 1,
158 .max_tokens = sizeof(struct iw_range),
159 .flags = IW_DESCR_FLAG_DUMP,
160 },
161 [SIOCSIWPRIV - SIOCIWFIRST] = {
162 .header_type = IW_HEADER_TYPE_NULL,
163 },
164 [SIOCGIWPRIV - SIOCIWFIRST] = { /* (handled directly by us) */
165 .header_type = IW_HEADER_TYPE_POINT,
166 .token_size = sizeof(struct iw_priv_args),
167 .max_tokens = 16,
168 .flags = IW_DESCR_FLAG_NOMAX,
169 },
170 [SIOCSIWSTATS - SIOCIWFIRST] = {
171 .header_type = IW_HEADER_TYPE_NULL,
172 },
173 [SIOCGIWSTATS - SIOCIWFIRST] = { /* (handled directly by us) */
174 .header_type = IW_HEADER_TYPE_POINT,
175 .token_size = 1,
176 .max_tokens = sizeof(struct iw_statistics),
177 .flags = IW_DESCR_FLAG_DUMP,
178 },
179 [SIOCSIWSPY - SIOCIWFIRST] = {
180 .header_type = IW_HEADER_TYPE_POINT,
181 .token_size = sizeof(struct sockaddr),
182 .max_tokens = IW_MAX_SPY,
183 },
184 [SIOCGIWSPY - SIOCIWFIRST] = {
185 .header_type = IW_HEADER_TYPE_POINT,
186 .token_size = sizeof(struct sockaddr) +
187 sizeof(struct iw_quality),
188 .max_tokens = IW_MAX_SPY,
189 },
190 [SIOCSIWTHRSPY - SIOCIWFIRST] = {
191 .header_type = IW_HEADER_TYPE_POINT,
192 .token_size = sizeof(struct iw_thrspy),
193 .min_tokens = 1,
194 .max_tokens = 1,
195 },
196 [SIOCGIWTHRSPY - SIOCIWFIRST] = {
197 .header_type = IW_HEADER_TYPE_POINT,
198 .token_size = sizeof(struct iw_thrspy),
199 .min_tokens = 1,
200 .max_tokens = 1,
201 },
202 [SIOCSIWAP - SIOCIWFIRST] = {
203 .header_type = IW_HEADER_TYPE_ADDR,
204 },
205 [SIOCGIWAP - SIOCIWFIRST] = {
206 .header_type = IW_HEADER_TYPE_ADDR,
207 .flags = IW_DESCR_FLAG_DUMP,
208 },
209 [SIOCSIWMLME - SIOCIWFIRST] = {
210 .header_type = IW_HEADER_TYPE_POINT,
211 .token_size = 1,
212 .min_tokens = sizeof(struct iw_mlme),
213 .max_tokens = sizeof(struct iw_mlme),
214 },
215 [SIOCGIWAPLIST - SIOCIWFIRST] = {
216 .header_type = IW_HEADER_TYPE_POINT,
217 .token_size = sizeof(struct sockaddr) +
218 sizeof(struct iw_quality),
219 .max_tokens = IW_MAX_AP,
220 .flags = IW_DESCR_FLAG_NOMAX,
221 },
222 [SIOCSIWSCAN - SIOCIWFIRST] = {
223 .header_type = IW_HEADER_TYPE_POINT,
224 .token_size = 1,
225 .min_tokens = 0,
226 .max_tokens = sizeof(struct iw_scan_req),
227 },
228 [SIOCGIWSCAN - SIOCIWFIRST] = {
229 .header_type = IW_HEADER_TYPE_POINT,
230 .token_size = 1,
231 .max_tokens = IW_SCAN_MAX_DATA,
232 .flags = IW_DESCR_FLAG_NOMAX,
233 },
234 [SIOCSIWESSID - SIOCIWFIRST] = {
235 .header_type = IW_HEADER_TYPE_POINT,
236 .token_size = 1,
237 .max_tokens = IW_ESSID_MAX_SIZE,
238 .flags = IW_DESCR_FLAG_EVENT,
239 },
240 [SIOCGIWESSID - SIOCIWFIRST] = {
241 .header_type = IW_HEADER_TYPE_POINT,
242 .token_size = 1,
243 .max_tokens = IW_ESSID_MAX_SIZE,
244 .flags = IW_DESCR_FLAG_DUMP,
245 },
246 [SIOCSIWNICKN - SIOCIWFIRST] = {
247 .header_type = IW_HEADER_TYPE_POINT,
248 .token_size = 1,
249 .max_tokens = IW_ESSID_MAX_SIZE,
250 },
251 [SIOCGIWNICKN - SIOCIWFIRST] = {
252 .header_type = IW_HEADER_TYPE_POINT,
253 .token_size = 1,
254 .max_tokens = IW_ESSID_MAX_SIZE,
255 },
256 [SIOCSIWRATE - SIOCIWFIRST] = {
257 .header_type = IW_HEADER_TYPE_PARAM,
258 },
259 [SIOCGIWRATE - SIOCIWFIRST] = {
260 .header_type = IW_HEADER_TYPE_PARAM,
261 },
262 [SIOCSIWRTS - SIOCIWFIRST] = {
263 .header_type = IW_HEADER_TYPE_PARAM,
264 },
265 [SIOCGIWRTS - SIOCIWFIRST] = {
266 .header_type = IW_HEADER_TYPE_PARAM,
267 },
268 [SIOCSIWFRAG - SIOCIWFIRST] = {
269 .header_type = IW_HEADER_TYPE_PARAM,
270 },
271 [SIOCGIWFRAG - SIOCIWFIRST] = {
272 .header_type = IW_HEADER_TYPE_PARAM,
273 },
274 [SIOCSIWTXPOW - SIOCIWFIRST] = {
275 .header_type = IW_HEADER_TYPE_PARAM,
276 },
277 [SIOCGIWTXPOW - SIOCIWFIRST] = {
278 .header_type = IW_HEADER_TYPE_PARAM,
279 },
280 [SIOCSIWRETRY - SIOCIWFIRST] = {
281 .header_type = IW_HEADER_TYPE_PARAM,
282 },
283 [SIOCGIWRETRY - SIOCIWFIRST] = {
284 .header_type = IW_HEADER_TYPE_PARAM,
285 },
286 [SIOCSIWENCODE - SIOCIWFIRST] = {
287 .header_type = IW_HEADER_TYPE_POINT,
288 .token_size = 1,
289 .max_tokens = IW_ENCODING_TOKEN_MAX,
290 .flags = IW_DESCR_FLAG_EVENT | IW_DESCR_FLAG_RESTRICT,
291 },
292 [SIOCGIWENCODE - SIOCIWFIRST] = {
293 .header_type = IW_HEADER_TYPE_POINT,
294 .token_size = 1,
295 .max_tokens = IW_ENCODING_TOKEN_MAX,
296 .flags = IW_DESCR_FLAG_DUMP | IW_DESCR_FLAG_RESTRICT,
297 },
298 [SIOCSIWPOWER - SIOCIWFIRST] = {
299 .header_type = IW_HEADER_TYPE_PARAM,
300 },
301 [SIOCGIWPOWER - SIOCIWFIRST] = {
302 .header_type = IW_HEADER_TYPE_PARAM,
303 },
304 [SIOCSIWGENIE - SIOCIWFIRST] = {
305 .header_type = IW_HEADER_TYPE_POINT,
306 .token_size = 1,
307 .max_tokens = IW_GENERIC_IE_MAX,
308 },
309 [SIOCGIWGENIE - SIOCIWFIRST] = {
310 .header_type = IW_HEADER_TYPE_POINT,
311 .token_size = 1,
312 .max_tokens = IW_GENERIC_IE_MAX,
313 },
314 [SIOCSIWAUTH - SIOCIWFIRST] = {
315 .header_type = IW_HEADER_TYPE_PARAM,
316 },
317 [SIOCGIWAUTH - SIOCIWFIRST] = {
318 .header_type = IW_HEADER_TYPE_PARAM,
319 },
320 [SIOCSIWENCODEEXT - SIOCIWFIRST] = {
321 .header_type = IW_HEADER_TYPE_POINT,
322 .token_size = 1,
323 .min_tokens = sizeof(struct iw_encode_ext),
324 .max_tokens = sizeof(struct iw_encode_ext) +
325 IW_ENCODING_TOKEN_MAX,
326 },
327 [SIOCGIWENCODEEXT - SIOCIWFIRST] = {
328 .header_type = IW_HEADER_TYPE_POINT,
329 .token_size = 1,
330 .min_tokens = sizeof(struct iw_encode_ext),
331 .max_tokens = sizeof(struct iw_encode_ext) +
332 IW_ENCODING_TOKEN_MAX,
333 },
334 [SIOCSIWPMKSA - SIOCIWFIRST] = {
335 .header_type = IW_HEADER_TYPE_POINT,
336 .token_size = 1,
337 .min_tokens = sizeof(struct iw_pmksa),
338 .max_tokens = sizeof(struct iw_pmksa),
339 },
340 };
341 static const unsigned standard_ioctl_num = ARRAY_SIZE(standard_ioctl);
342
343 /*
344 * Meta-data about all the additional standard Wireless Extension events
345 * we know about.
346 */
347 static const struct iw_ioctl_description standard_event[] = {
348 [IWEVTXDROP - IWEVFIRST] = {
349 .header_type = IW_HEADER_TYPE_ADDR,
350 },
351 [IWEVQUAL - IWEVFIRST] = {
352 .header_type = IW_HEADER_TYPE_QUAL,
353 },
354 [IWEVCUSTOM - IWEVFIRST] = {
355 .header_type = IW_HEADER_TYPE_POINT,
356 .token_size = 1,
357 .max_tokens = IW_CUSTOM_MAX,
358 },
359 [IWEVREGISTERED - IWEVFIRST] = {
360 .header_type = IW_HEADER_TYPE_ADDR,
361 },
362 [IWEVEXPIRED - IWEVFIRST] = {
363 .header_type = IW_HEADER_TYPE_ADDR,
364 },
365 [IWEVGENIE - IWEVFIRST] = {
366 .header_type = IW_HEADER_TYPE_POINT,
367 .token_size = 1,
368 .max_tokens = IW_GENERIC_IE_MAX,
369 },
370 [IWEVMICHAELMICFAILURE - IWEVFIRST] = {
371 .header_type = IW_HEADER_TYPE_POINT,
372 .token_size = 1,
373 .max_tokens = sizeof(struct iw_michaelmicfailure),
374 },
375 [IWEVASSOCREQIE - IWEVFIRST] = {
376 .header_type = IW_HEADER_TYPE_POINT,
377 .token_size = 1,
378 .max_tokens = IW_GENERIC_IE_MAX,
379 },
380 [IWEVASSOCRESPIE - IWEVFIRST] = {
381 .header_type = IW_HEADER_TYPE_POINT,
382 .token_size = 1,
383 .max_tokens = IW_GENERIC_IE_MAX,
384 },
385 [IWEVPMKIDCAND - IWEVFIRST] = {
386 .header_type = IW_HEADER_TYPE_POINT,
387 .token_size = 1,
388 .max_tokens = sizeof(struct iw_pmkid_cand),
389 },
390 };
391 static const unsigned standard_event_num = ARRAY_SIZE(standard_event);
392
393 /* Size (in bytes) of the various private data types */
394 static const char iw_priv_type_size[] = {
395 0, /* IW_PRIV_TYPE_NONE */
396 1, /* IW_PRIV_TYPE_BYTE */
397 1, /* IW_PRIV_TYPE_CHAR */
398 0, /* Not defined */
399 sizeof(__u32), /* IW_PRIV_TYPE_INT */
400 sizeof(struct iw_freq), /* IW_PRIV_TYPE_FLOAT */
401 sizeof(struct sockaddr), /* IW_PRIV_TYPE_ADDR */
402 0, /* Not defined */
403 };
404
405 /* Size (in bytes) of various events */
406 static const int event_type_size[] = {
407 IW_EV_LCP_LEN, /* IW_HEADER_TYPE_NULL */
408 0,
409 IW_EV_CHAR_LEN, /* IW_HEADER_TYPE_CHAR */
410 0,
411 IW_EV_UINT_LEN, /* IW_HEADER_TYPE_UINT */
412 IW_EV_FREQ_LEN, /* IW_HEADER_TYPE_FREQ */
413 IW_EV_ADDR_LEN, /* IW_HEADER_TYPE_ADDR */
414 0,
415 IW_EV_POINT_LEN, /* Without variable payload */
416 IW_EV_PARAM_LEN, /* IW_HEADER_TYPE_PARAM */
417 IW_EV_QUAL_LEN, /* IW_HEADER_TYPE_QUAL */
418 };
419
420
421 /************************ COMMON SUBROUTINES ************************/
422 /*
423 * Stuff that may be used in various place or doesn't fit in one
424 * of the section below.
425 */
426
427 /* ---------------------------------------------------------------- */
428 /*
429 * Return the driver handler associated with a specific Wireless Extension.
430 */
431 static iw_handler get_handler(struct net_device *dev, unsigned int cmd)
432 {
433 /* Don't "optimise" the following variable, it will crash */
434 unsigned int index; /* *MUST* be unsigned */
435
436 /* Check if we have some wireless handlers defined */
437 if (dev->wireless_handlers == NULL)
438 return NULL;
439
440 /* Try as a standard command */
441 index = cmd - SIOCIWFIRST;
442 if (index < dev->wireless_handlers->num_standard)
443 return dev->wireless_handlers->standard[index];
444
445 /* Try as a private command */
446 index = cmd - SIOCIWFIRSTPRIV;
447 if (index < dev->wireless_handlers->num_private)
448 return dev->wireless_handlers->private[index];
449
450 /* Not found */
451 return NULL;
452 }
453
454 /* ---------------------------------------------------------------- */
455 /*
456 * Get statistics out of the driver
457 */
458 static struct iw_statistics *get_wireless_stats(struct net_device *dev)
459 {
460 /* New location */
461 if ((dev->wireless_handlers != NULL) &&
462 (dev->wireless_handlers->get_wireless_stats != NULL))
463 return dev->wireless_handlers->get_wireless_stats(dev);
464
465 /* Not found */
466 return NULL;
467 }
468
469 /* ---------------------------------------------------------------- */
470 /*
471 * Call the commit handler in the driver
472 * (if exist and if conditions are right)
473 *
474 * Note : our current commit strategy is currently pretty dumb,
475 * but we will be able to improve on that...
476 * The goal is to try to agreagate as many changes as possible
477 * before doing the commit. Drivers that will define a commit handler
478 * are usually those that need a reset after changing parameters, so
479 * we want to minimise the number of reset.
480 * A cool idea is to use a timer : at each "set" command, we re-set the
481 * timer, when the timer eventually fires, we call the driver.
482 * Hopefully, more on that later.
483 *
484 * Also, I'm waiting to see how many people will complain about the
485 * netif_running(dev) test. I'm open on that one...
486 * Hopefully, the driver will remember to do a commit in "open()" ;-)
487 */
488 static int call_commit_handler(struct net_device *dev)
489 {
490 if ((netif_running(dev)) &&
491 (dev->wireless_handlers->standard[0] != NULL))
492 /* Call the commit handler on the driver */
493 return dev->wireless_handlers->standard[0](dev, NULL,
494 NULL, NULL);
495 else
496 return 0; /* Command completed successfully */
497 }
498
499 /* ---------------------------------------------------------------- */
500 /*
501 * Calculate size of private arguments
502 */
503 static inline int get_priv_size(__u16 args)
504 {
505 int num = args & IW_PRIV_SIZE_MASK;
506 int type = (args & IW_PRIV_TYPE_MASK) >> 12;
507
508 return num * iw_priv_type_size[type];
509 }
510
511 /* ---------------------------------------------------------------- */
512 /*
513 * Re-calculate the size of private arguments
514 */
515 static inline int adjust_priv_size(__u16 args,
516 union iwreq_data * wrqu)
517 {
518 int num = wrqu->data.length;
519 int max = args & IW_PRIV_SIZE_MASK;
520 int type = (args & IW_PRIV_TYPE_MASK) >> 12;
521
522 /* Make sure the driver doesn't goof up */
523 if (max < num)
524 num = max;
525
526 return num * iw_priv_type_size[type];
527 }
528
529 /* ---------------------------------------------------------------- */
530 /*
531 * Standard Wireless Handler : get wireless stats
532 * Allow programatic access to /proc/net/wireless even if /proc
533 * doesn't exist... Also more efficient...
534 */
535 static int iw_handler_get_iwstats(struct net_device * dev,
536 struct iw_request_info * info,
537 union iwreq_data * wrqu,
538 char * extra)
539 {
540 /* Get stats from the driver */
541 struct iw_statistics *stats;
542
543 stats = get_wireless_stats(dev);
544 if (stats) {
545 /* Copy statistics to extra */
546 memcpy(extra, stats, sizeof(struct iw_statistics));
547 wrqu->data.length = sizeof(struct iw_statistics);
548
549 /* Check if we need to clear the updated flag */
550 if (wrqu->data.flags != 0)
551 stats->qual.updated &= ~IW_QUAL_ALL_UPDATED;
552 return 0;
553 } else
554 return -EOPNOTSUPP;
555 }
556
557 /* ---------------------------------------------------------------- */
558 /*
559 * Standard Wireless Handler : get iwpriv definitions
560 * Export the driver private handler definition
561 * They will be picked up by tools like iwpriv...
562 */
563 static int iw_handler_get_private(struct net_device * dev,
564 struct iw_request_info * info,
565 union iwreq_data * wrqu,
566 char * extra)
567 {
568 /* Check if the driver has something to export */
569 if ((dev->wireless_handlers->num_private_args == 0) ||
570 (dev->wireless_handlers->private_args == NULL))
571 return -EOPNOTSUPP;
572
573 /* Check if there is enough buffer up there */
574 if (wrqu->data.length < dev->wireless_handlers->num_private_args) {
575 /* User space can't know in advance how large the buffer
576 * needs to be. Give it a hint, so that we can support
577 * any size buffer we want somewhat efficiently... */
578 wrqu->data.length = dev->wireless_handlers->num_private_args;
579 return -E2BIG;
580 }
581
582 /* Set the number of available ioctls. */
583 wrqu->data.length = dev->wireless_handlers->num_private_args;
584
585 /* Copy structure to the user buffer. */
586 memcpy(extra, dev->wireless_handlers->private_args,
587 sizeof(struct iw_priv_args) * wrqu->data.length);
588
589 return 0;
590 }
591
592
593 /******************** /proc/net/wireless SUPPORT ********************/
594 /*
595 * The /proc/net/wireless file is a human readable user-space interface
596 * exporting various wireless specific statistics from the wireless devices.
597 * This is the most popular part of the Wireless Extensions ;-)
598 *
599 * This interface is a pure clone of /proc/net/dev (in net/core/dev.c).
600 * The content of the file is basically the content of "struct iw_statistics".
601 */
602
603 #ifdef CONFIG_PROC_FS
604
605 /* ---------------------------------------------------------------- */
606 /*
607 * Print one entry (line) of /proc/net/wireless
608 */
609 static void wireless_seq_printf_stats(struct seq_file *seq,
610 struct net_device *dev)
611 {
612 /* Get stats from the driver */
613 struct iw_statistics *stats = get_wireless_stats(dev);
614
615 if (stats) {
616 seq_printf(seq, "%6s: %04x %3d%c %3d%c %3d%c %6d %6d %6d "
617 "%6d %6d %6d\n",
618 dev->name, stats->status, stats->qual.qual,
619 stats->qual.updated & IW_QUAL_QUAL_UPDATED
620 ? '.' : ' ',
621 ((__s32) stats->qual.level) -
622 ((stats->qual.updated & IW_QUAL_DBM) ? 0x100 : 0),
623 stats->qual.updated & IW_QUAL_LEVEL_UPDATED
624 ? '.' : ' ',
625 ((__s32) stats->qual.noise) -
626 ((stats->qual.updated & IW_QUAL_DBM) ? 0x100 : 0),
627 stats->qual.updated & IW_QUAL_NOISE_UPDATED
628 ? '.' : ' ',
629 stats->discard.nwid, stats->discard.code,
630 stats->discard.fragment, stats->discard.retries,
631 stats->discard.misc, stats->miss.beacon);
632 stats->qual.updated &= ~IW_QUAL_ALL_UPDATED;
633 }
634 }
635
636 /* ---------------------------------------------------------------- */
637 /*
638 * Print info for /proc/net/wireless (print all entries)
639 */
640 static int wireless_seq_show(struct seq_file *seq, void *v)
641 {
642 if (v == SEQ_START_TOKEN)
643 seq_printf(seq, "Inter-| sta-| Quality | Discarded "
644 "packets | Missed | WE\n"
645 " face | tus | link level noise | nwid "
646 "crypt frag retry misc | beacon | %d\n",
647 WIRELESS_EXT);
648 else
649 wireless_seq_printf_stats(seq, v);
650 return 0;
651 }
652
653 static const struct seq_operations wireless_seq_ops = {
654 .start = dev_seq_start,
655 .next = dev_seq_next,
656 .stop = dev_seq_stop,
657 .show = wireless_seq_show,
658 };
659
660 static int wireless_seq_open(struct inode *inode, struct file *file)
661 {
662 struct seq_file *seq;
663 int res;
664 res = seq_open(file, &wireless_seq_ops);
665 if (!res) {
666 seq = file->private_data;
667 seq->private = get_proc_net(inode);
668 if (!seq->private) {
669 seq_release(inode, file);
670 res = -ENXIO;
671 }
672 }
673 return res;
674 }
675
676 static int wireless_seq_release(struct inode *inode, struct file *file)
677 {
678 struct seq_file *seq = file->private_data;
679 struct net *net = seq->private;
680 put_net(net);
681 return seq_release(inode, file);
682 }
683
684 static const struct file_operations wireless_seq_fops = {
685 .owner = THIS_MODULE,
686 .open = wireless_seq_open,
687 .read = seq_read,
688 .llseek = seq_lseek,
689 .release = wireless_seq_release,
690 };
691
692 int wext_proc_init(struct net *net)
693 {
694 /* Create /proc/net/wireless entry */
695 if (!proc_net_fops_create(net, "wireless", S_IRUGO, &wireless_seq_fops))
696 return -ENOMEM;
697
698 return 0;
699 }
700
701 void wext_proc_exit(struct net *net)
702 {
703 proc_net_remove(net, "wireless");
704 }
705 #endif /* CONFIG_PROC_FS */
706
707 /************************** IOCTL SUPPORT **************************/
708 /*
709 * The original user space API to configure all those Wireless Extensions
710 * is through IOCTLs.
711 * In there, we check if we need to call the new driver API (iw_handler)
712 * or just call the driver ioctl handler.
713 */
714
715 /* ---------------------------------------------------------------- */
716 /*
717 * Wrapper to call a standard Wireless Extension handler.
718 * We do various checks and also take care of moving data between
719 * user space and kernel space.
720 */
721 static int ioctl_standard_call(struct net_device * dev,
722 struct ifreq * ifr,
723 unsigned int cmd,
724 iw_handler handler)
725 {
726 struct iwreq * iwr = (struct iwreq *) ifr;
727 const struct iw_ioctl_description * descr;
728 struct iw_request_info info;
729 int ret = -EINVAL;
730
731 /* Get the description of the IOCTL */
732 if ((cmd - SIOCIWFIRST) >= standard_ioctl_num)
733 return -EOPNOTSUPP;
734 descr = &(standard_ioctl[cmd - SIOCIWFIRST]);
735
736 /* Prepare the call */
737 info.cmd = cmd;
738 info.flags = 0;
739
740 /* Check if we have a pointer to user space data or not */
741 if (descr->header_type != IW_HEADER_TYPE_POINT) {
742
743 /* No extra arguments. Trivial to handle */
744 ret = handler(dev, &info, &(iwr->u), NULL);
745
746 /* Generate an event to notify listeners of the change */
747 if ((descr->flags & IW_DESCR_FLAG_EVENT) &&
748 ((ret == 0) || (ret == -EIWCOMMIT)))
749 wireless_send_event(dev, cmd, &(iwr->u), NULL);
750 } else {
751 char * extra;
752 int extra_size;
753 int user_length = 0;
754 int err;
755 int essid_compat = 0;
756
757 /* Calculate space needed by arguments. Always allocate
758 * for max space. Easier, and won't last long... */
759 extra_size = descr->max_tokens * descr->token_size;
760
761 /* Check need for ESSID compatibility for WE < 21 */
762 switch (cmd) {
763 case SIOCSIWESSID:
764 case SIOCGIWESSID:
765 case SIOCSIWNICKN:
766 case SIOCGIWNICKN:
767 if (iwr->u.data.length == descr->max_tokens + 1)
768 essid_compat = 1;
769 else if (IW_IS_SET(cmd) && (iwr->u.data.length != 0)) {
770 char essid[IW_ESSID_MAX_SIZE + 1];
771
772 err = copy_from_user(essid, iwr->u.data.pointer,
773 iwr->u.data.length *
774 descr->token_size);
775 if (err)
776 return -EFAULT;
777
778 if (essid[iwr->u.data.length - 1] == '\0')
779 essid_compat = 1;
780 }
781 break;
782 default:
783 break;
784 }
785
786 iwr->u.data.length -= essid_compat;
787
788 /* Check what user space is giving us */
789 if (IW_IS_SET(cmd)) {
790 /* Check NULL pointer */
791 if ((iwr->u.data.pointer == NULL) &&
792 (iwr->u.data.length != 0))
793 return -EFAULT;
794 /* Check if number of token fits within bounds */
795 if (iwr->u.data.length > descr->max_tokens)
796 return -E2BIG;
797 if (iwr->u.data.length < descr->min_tokens)
798 return -EINVAL;
799 } else {
800 /* Check NULL pointer */
801 if (iwr->u.data.pointer == NULL)
802 return -EFAULT;
803 /* Save user space buffer size for checking */
804 user_length = iwr->u.data.length;
805
806 /* Don't check if user_length > max to allow forward
807 * compatibility. The test user_length < min is
808 * implied by the test at the end. */
809
810 /* Support for very large requests */
811 if ((descr->flags & IW_DESCR_FLAG_NOMAX) &&
812 (user_length > descr->max_tokens)) {
813 /* Allow userspace to GET more than max so
814 * we can support any size GET requests.
815 * There is still a limit : -ENOMEM. */
816 extra_size = user_length * descr->token_size;
817 /* Note : user_length is originally a __u16,
818 * and token_size is controlled by us,
819 * so extra_size won't get negative and
820 * won't overflow... */
821 }
822 }
823
824 /* Create the kernel buffer */
825 /* kzalloc ensures NULL-termination for essid_compat */
826 extra = kzalloc(extra_size, GFP_KERNEL);
827 if (extra == NULL)
828 return -ENOMEM;
829
830 /* If it is a SET, get all the extra data in here */
831 if (IW_IS_SET(cmd) && (iwr->u.data.length != 0)) {
832 err = copy_from_user(extra, iwr->u.data.pointer,
833 iwr->u.data.length *
834 descr->token_size);
835 if (err) {
836 kfree(extra);
837 return -EFAULT;
838 }
839 }
840
841 /* Call the handler */
842 ret = handler(dev, &info, &(iwr->u), extra);
843
844 iwr->u.data.length += essid_compat;
845
846 /* If we have something to return to the user */
847 if (!ret && IW_IS_GET(cmd)) {
848 /* Check if there is enough buffer up there */
849 if (user_length < iwr->u.data.length) {
850 kfree(extra);
851 return -E2BIG;
852 }
853
854 err = copy_to_user(iwr->u.data.pointer, extra,
855 iwr->u.data.length *
856 descr->token_size);
857 if (err)
858 ret = -EFAULT;
859 }
860
861 /* Generate an event to notify listeners of the change */
862 if ((descr->flags & IW_DESCR_FLAG_EVENT) &&
863 ((ret == 0) || (ret == -EIWCOMMIT))) {
864 if (descr->flags & IW_DESCR_FLAG_RESTRICT)
865 /* If the event is restricted, don't
866 * export the payload */
867 wireless_send_event(dev, cmd, &(iwr->u), NULL);
868 else
869 wireless_send_event(dev, cmd, &(iwr->u),
870 extra);
871 }
872
873 /* Cleanup - I told you it wasn't that long ;-) */
874 kfree(extra);
875 }
876
877 /* Call commit handler if needed and defined */
878 if (ret == -EIWCOMMIT)
879 ret = call_commit_handler(dev);
880
881 /* Here, we will generate the appropriate event if needed */
882
883 return ret;
884 }
885
886 /* ---------------------------------------------------------------- */
887 /*
888 * Wrapper to call a private Wireless Extension handler.
889 * We do various checks and also take care of moving data between
890 * user space and kernel space.
891 * It's not as nice and slimline as the standard wrapper. The cause
892 * is struct iw_priv_args, which was not really designed for the
893 * job we are going here.
894 *
895 * IMPORTANT : This function prevent to set and get data on the same
896 * IOCTL and enforce the SET/GET convention. Not doing it would be
897 * far too hairy...
898 * If you need to set and get data at the same time, please don't use
899 * a iw_handler but process it in your ioctl handler (i.e. use the
900 * old driver API).
901 */
902 static int ioctl_private_call(struct net_device *dev, struct ifreq *ifr,
903 unsigned int cmd, iw_handler handler)
904 {
905 struct iwreq * iwr = (struct iwreq *) ifr;
906 const struct iw_priv_args * descr = NULL;
907 struct iw_request_info info;
908 int extra_size = 0;
909 int i;
910 int ret = -EINVAL;
911
912 /* Get the description of the IOCTL */
913 for (i = 0; i < dev->wireless_handlers->num_private_args; i++)
914 if (cmd == dev->wireless_handlers->private_args[i].cmd) {
915 descr = &(dev->wireless_handlers->private_args[i]);
916 break;
917 }
918
919 /* Compute the size of the set/get arguments */
920 if (descr != NULL) {
921 if (IW_IS_SET(cmd)) {
922 int offset = 0; /* For sub-ioctls */
923 /* Check for sub-ioctl handler */
924 if (descr->name[0] == '\0')
925 /* Reserve one int for sub-ioctl index */
926 offset = sizeof(__u32);
927
928 /* Size of set arguments */
929 extra_size = get_priv_size(descr->set_args);
930
931 /* Does it fits in iwr ? */
932 if ((descr->set_args & IW_PRIV_SIZE_FIXED) &&
933 ((extra_size + offset) <= IFNAMSIZ))
934 extra_size = 0;
935 } else {
936 /* Size of get arguments */
937 extra_size = get_priv_size(descr->get_args);
938
939 /* Does it fits in iwr ? */
940 if ((descr->get_args & IW_PRIV_SIZE_FIXED) &&
941 (extra_size <= IFNAMSIZ))
942 extra_size = 0;
943 }
944 }
945
946 /* Prepare the call */
947 info.cmd = cmd;
948 info.flags = 0;
949
950 /* Check if we have a pointer to user space data or not. */
951 if (extra_size == 0) {
952 /* No extra arguments. Trivial to handle */
953 ret = handler(dev, &info, &(iwr->u), (char *) &(iwr->u));
954 } else {
955 char * extra;
956 int err;
957
958 /* Check what user space is giving us */
959 if (IW_IS_SET(cmd)) {
960 /* Check NULL pointer */
961 if ((iwr->u.data.pointer == NULL) &&
962 (iwr->u.data.length != 0))
963 return -EFAULT;
964
965 /* Does it fits within bounds ? */
966 if (iwr->u.data.length > (descr->set_args &
967 IW_PRIV_SIZE_MASK))
968 return -E2BIG;
969 } else if (iwr->u.data.pointer == NULL)
970 return -EFAULT;
971
972 /* Always allocate for max space. Easier, and won't last
973 * long... */
974 extra = kmalloc(extra_size, GFP_KERNEL);
975 if (extra == NULL)
976 return -ENOMEM;
977
978 /* If it is a SET, get all the extra data in here */
979 if (IW_IS_SET(cmd) && (iwr->u.data.length != 0)) {
980 err = copy_from_user(extra, iwr->u.data.pointer,
981 extra_size);
982 if (err) {
983 kfree(extra);
984 return -EFAULT;
985 }
986 }
987
988 /* Call the handler */
989 ret = handler(dev, &info, &(iwr->u), extra);
990
991 /* If we have something to return to the user */
992 if (!ret && IW_IS_GET(cmd)) {
993
994 /* Adjust for the actual length if it's variable,
995 * avoid leaking kernel bits outside. */
996 if (!(descr->get_args & IW_PRIV_SIZE_FIXED)) {
997 extra_size = adjust_priv_size(descr->get_args,
998 &(iwr->u));
999 }
1000
1001 err = copy_to_user(iwr->u.data.pointer, extra,
1002 extra_size);
1003 if (err)
1004 ret = -EFAULT;
1005 }
1006
1007 /* Cleanup - I told you it wasn't that long ;-) */
1008 kfree(extra);
1009 }
1010
1011
1012 /* Call commit handler if needed and defined */
1013 if (ret == -EIWCOMMIT)
1014 ret = call_commit_handler(dev);
1015
1016 return ret;
1017 }
1018
1019 /* ---------------------------------------------------------------- */
1020 /*
1021 * Main IOCTl dispatcher.
1022 * Check the type of IOCTL and call the appropriate wrapper...
1023 */
1024 static int wireless_process_ioctl(struct net *net, struct ifreq *ifr, unsigned int cmd)
1025 {
1026 struct net_device *dev;
1027 iw_handler handler;
1028
1029 /* Permissions are already checked in dev_ioctl() before calling us.
1030 * The copy_to/from_user() of ifr is also dealt with in there */
1031
1032 /* Make sure the device exist */
1033 if ((dev = __dev_get_by_name(net, ifr->ifr_name)) == NULL)
1034 return -ENODEV;
1035
1036 /* A bunch of special cases, then the generic case...
1037 * Note that 'cmd' is already filtered in dev_ioctl() with
1038 * (cmd >= SIOCIWFIRST && cmd <= SIOCIWLAST) */
1039 if (cmd == SIOCGIWSTATS)
1040 return ioctl_standard_call(dev, ifr, cmd,
1041 &iw_handler_get_iwstats);
1042
1043 if (cmd == SIOCGIWPRIV && dev->wireless_handlers)
1044 return ioctl_standard_call(dev, ifr, cmd,
1045 &iw_handler_get_private);
1046
1047 /* Basic check */
1048 if (!netif_device_present(dev))
1049 return -ENODEV;
1050
1051 /* New driver API : try to find the handler */
1052 handler = get_handler(dev, cmd);
1053 if (handler) {
1054 /* Standard and private are not the same */
1055 if (cmd < SIOCIWFIRSTPRIV)
1056 return ioctl_standard_call(dev, ifr, cmd, handler);
1057 else
1058 return ioctl_private_call(dev, ifr, cmd, handler);
1059 }
1060 /* Old driver API : call driver ioctl handler */
1061 if (dev->do_ioctl)
1062 return dev->do_ioctl(dev, ifr, cmd);
1063 return -EOPNOTSUPP;
1064 }
1065
1066 /* entry point from dev ioctl */
1067 int wext_handle_ioctl(struct net *net, struct ifreq *ifr, unsigned int cmd,
1068 void __user *arg)
1069 {
1070 int ret;
1071
1072 /* If command is `set a parameter', or
1073 * `get the encoding parameters', check if
1074 * the user has the right to do it */
1075 if ((IW_IS_SET(cmd) || cmd == SIOCGIWENCODE || cmd == SIOCGIWENCODEEXT)
1076 && !capable(CAP_NET_ADMIN))
1077 return -EPERM;
1078
1079 dev_load(net, ifr->ifr_name);
1080 rtnl_lock();
1081 ret = wireless_process_ioctl(net, ifr, cmd);
1082 rtnl_unlock();
1083 if (IW_IS_GET(cmd) && copy_to_user(arg, ifr, sizeof(struct iwreq)))
1084 return -EFAULT;
1085 return ret;
1086 }
1087
1088 /************************* EVENT PROCESSING *************************/
1089 /*
1090 * Process events generated by the wireless layer or the driver.
1091 * Most often, the event will be propagated through rtnetlink
1092 */
1093
1094 /* ---------------------------------------------------------------- */
1095 /*
1096 * Locking...
1097 * ----------
1098 *
1099 * Thanks to Herbert Xu <herbert@gondor.apana.org.au> for fixing
1100 * the locking issue in here and implementing this code !
1101 *
1102 * The issue : wireless_send_event() is often called in interrupt context,
1103 * while the Netlink layer can never be called in interrupt context.
1104 * The fully formed RtNetlink events are queued, and then a tasklet is run
1105 * to feed those to Netlink.
1106 * The skb_queue is interrupt safe, and its lock is not held while calling
1107 * Netlink, so there is no possibility of dealock.
1108 * Jean II
1109 */
1110
1111 static struct sk_buff_head wireless_nlevent_queue;
1112
1113 static int __init wireless_nlevent_init(void)
1114 {
1115 skb_queue_head_init(&wireless_nlevent_queue);
1116 return 0;
1117 }
1118
1119 subsys_initcall(wireless_nlevent_init);
1120
1121 static void wireless_nlevent_process(unsigned long data)
1122 {
1123 struct sk_buff *skb;
1124
1125 while ((skb = skb_dequeue(&wireless_nlevent_queue)))
1126 rtnl_notify(skb, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
1127 }
1128
1129 static DECLARE_TASKLET(wireless_nlevent_tasklet, wireless_nlevent_process, 0);
1130
1131 /* ---------------------------------------------------------------- */
1132 /*
1133 * Fill a rtnetlink message with our event data.
1134 * Note that we propage only the specified event and don't dump the
1135 * current wireless config. Dumping the wireless config is far too
1136 * expensive (for each parameter, the driver need to query the hardware).
1137 */
1138 static int rtnetlink_fill_iwinfo(struct sk_buff *skb, struct net_device *dev,
1139 int type, char *event, int event_len)
1140 {
1141 struct ifinfomsg *r;
1142 struct nlmsghdr *nlh;
1143
1144 nlh = nlmsg_put(skb, 0, 0, type, sizeof(*r), 0);
1145 if (nlh == NULL)
1146 return -EMSGSIZE;
1147
1148 r = nlmsg_data(nlh);
1149 r->ifi_family = AF_UNSPEC;
1150 r->__ifi_pad = 0;
1151 r->ifi_type = dev->type;
1152 r->ifi_index = dev->ifindex;
1153 r->ifi_flags = dev_get_flags(dev);
1154 r->ifi_change = 0; /* Wireless changes don't affect those flags */
1155
1156 /* Add the wireless events in the netlink packet */
1157 NLA_PUT(skb, IFLA_WIRELESS, event_len, event);
1158
1159 return nlmsg_end(skb, nlh);
1160
1161 nla_put_failure:
1162 nlmsg_cancel(skb, nlh);
1163 return -EMSGSIZE;
1164 }
1165
1166 /* ---------------------------------------------------------------- */
1167 /*
1168 * Create and broadcast and send it on the standard rtnetlink socket
1169 * This is a pure clone rtmsg_ifinfo() in net/core/rtnetlink.c
1170 * Andrzej Krzysztofowicz mandated that I used a IFLA_XXX field
1171 * within a RTM_NEWLINK event.
1172 */
1173 static void rtmsg_iwinfo(struct net_device *dev, char *event, int event_len)
1174 {
1175 struct sk_buff *skb;
1176 int err;
1177
1178 skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
1179 if (!skb)
1180 return;
1181
1182 err = rtnetlink_fill_iwinfo(skb, dev, RTM_NEWLINK, event, event_len);
1183 if (err < 0) {
1184 WARN_ON(err == -EMSGSIZE);
1185 kfree_skb(skb);
1186 return;
1187 }
1188
1189 NETLINK_CB(skb).dst_group = RTNLGRP_LINK;
1190 skb_queue_tail(&wireless_nlevent_queue, skb);
1191 tasklet_schedule(&wireless_nlevent_tasklet);
1192 }
1193
1194 /* ---------------------------------------------------------------- */
1195 /*
1196 * Main event dispatcher. Called from other parts and drivers.
1197 * Send the event on the appropriate channels.
1198 * May be called from interrupt context.
1199 */
1200 void wireless_send_event(struct net_device * dev,
1201 unsigned int cmd,
1202 union iwreq_data * wrqu,
1203 char * extra)
1204 {
1205 const struct iw_ioctl_description * descr = NULL;
1206 int extra_len = 0;
1207 struct iw_event *event; /* Mallocated whole event */
1208 int event_len; /* Its size */
1209 int hdr_len; /* Size of the event header */
1210 int wrqu_off = 0; /* Offset in wrqu */
1211 /* Don't "optimise" the following variable, it will crash */
1212 unsigned cmd_index; /* *MUST* be unsigned */
1213
1214 /* Get the description of the Event */
1215 if (cmd <= SIOCIWLAST) {
1216 cmd_index = cmd - SIOCIWFIRST;
1217 if (cmd_index < standard_ioctl_num)
1218 descr = &(standard_ioctl[cmd_index]);
1219 } else {
1220 cmd_index = cmd - IWEVFIRST;
1221 if (cmd_index < standard_event_num)
1222 descr = &(standard_event[cmd_index]);
1223 }
1224 /* Don't accept unknown events */
1225 if (descr == NULL) {
1226 /* Note : we don't return an error to the driver, because
1227 * the driver would not know what to do about it. It can't
1228 * return an error to the user, because the event is not
1229 * initiated by a user request.
1230 * The best the driver could do is to log an error message.
1231 * We will do it ourselves instead...
1232 */
1233 printk(KERN_ERR "%s (WE) : Invalid/Unknown Wireless Event (0x%04X)\n",
1234 dev->name, cmd);
1235 return;
1236 }
1237
1238 /* Check extra parameters and set extra_len */
1239 if (descr->header_type == IW_HEADER_TYPE_POINT) {
1240 /* Check if number of token fits within bounds */
1241 if (wrqu->data.length > descr->max_tokens) {
1242 printk(KERN_ERR "%s (WE) : Wireless Event too big (%d)\n", dev->name, wrqu->data.length);
1243 return;
1244 }
1245 if (wrqu->data.length < descr->min_tokens) {
1246 printk(KERN_ERR "%s (WE) : Wireless Event too small (%d)\n", dev->name, wrqu->data.length);
1247 return;
1248 }
1249 /* Calculate extra_len - extra is NULL for restricted events */
1250 if (extra != NULL)
1251 extra_len = wrqu->data.length * descr->token_size;
1252 /* Always at an offset in wrqu */
1253 wrqu_off = IW_EV_POINT_OFF;
1254 }
1255
1256 /* Total length of the event */
1257 hdr_len = event_type_size[descr->header_type];
1258 event_len = hdr_len + extra_len;
1259
1260 /* Create temporary buffer to hold the event */
1261 event = kmalloc(event_len, GFP_ATOMIC);
1262 if (event == NULL)
1263 return;
1264
1265 /* Fill event */
1266 event->len = event_len;
1267 event->cmd = cmd;
1268 memcpy(&event->u, ((char *) wrqu) + wrqu_off, hdr_len - IW_EV_LCP_LEN);
1269 if (extra)
1270 memcpy(((char *) event) + hdr_len, extra, extra_len);
1271
1272 /* Send via the RtNetlink event channel */
1273 rtmsg_iwinfo(dev, (char *) event, event_len);
1274
1275 /* Cleanup */
1276 kfree(event);
1277
1278 return; /* Always success, I guess ;-) */
1279 }
1280 EXPORT_SYMBOL(wireless_send_event);
1281
1282 /********************** ENHANCED IWSPY SUPPORT **********************/
1283 /*
1284 * In the old days, the driver was handling spy support all by itself.
1285 * Now, the driver can delegate this task to Wireless Extensions.
1286 * It needs to use those standard spy iw_handler in struct iw_handler_def,
1287 * push data to us via wireless_spy_update() and include struct iw_spy_data
1288 * in its private part (and export it in net_device->wireless_data->spy_data).
1289 * One of the main advantage of centralising spy support here is that
1290 * it becomes much easier to improve and extend it without having to touch
1291 * the drivers. One example is the addition of the Spy-Threshold events.
1292 */
1293
1294 /* ---------------------------------------------------------------- */
1295 /*
1296 * Return the pointer to the spy data in the driver.
1297 * Because this is called on the Rx path via wireless_spy_update(),
1298 * we want it to be efficient...
1299 */
1300 static inline struct iw_spy_data *get_spydata(struct net_device *dev)
1301 {
1302 /* This is the new way */
1303 if (dev->wireless_data)
1304 return dev->wireless_data->spy_data;
1305 return NULL;
1306 }
1307
1308 /*------------------------------------------------------------------*/
1309 /*
1310 * Standard Wireless Handler : set Spy List
1311 */
1312 int iw_handler_set_spy(struct net_device * dev,
1313 struct iw_request_info * info,
1314 union iwreq_data * wrqu,
1315 char * extra)
1316 {
1317 struct iw_spy_data * spydata = get_spydata(dev);
1318 struct sockaddr * address = (struct sockaddr *) extra;
1319
1320 /* Make sure driver is not buggy or using the old API */
1321 if (!spydata)
1322 return -EOPNOTSUPP;
1323
1324 /* Disable spy collection while we copy the addresses.
1325 * While we copy addresses, any call to wireless_spy_update()
1326 * will NOP. This is OK, as anyway the addresses are changing. */
1327 spydata->spy_number = 0;
1328
1329 /* We want to operate without locking, because wireless_spy_update()
1330 * most likely will happen in the interrupt handler, and therefore
1331 * have its own locking constraints and needs performance.
1332 * The rtnl_lock() make sure we don't race with the other iw_handlers.
1333 * This make sure wireless_spy_update() "see" that the spy list
1334 * is temporarily disabled. */
1335 smp_wmb();
1336
1337 /* Are there are addresses to copy? */
1338 if (wrqu->data.length > 0) {
1339 int i;
1340
1341 /* Copy addresses */
1342 for (i = 0; i < wrqu->data.length; i++)
1343 memcpy(spydata->spy_address[i], address[i].sa_data,
1344 ETH_ALEN);
1345 /* Reset stats */
1346 memset(spydata->spy_stat, 0,
1347 sizeof(struct iw_quality) * IW_MAX_SPY);
1348 }
1349
1350 /* Make sure above is updated before re-enabling */
1351 smp_wmb();
1352
1353 /* Enable addresses */
1354 spydata->spy_number = wrqu->data.length;
1355
1356 return 0;
1357 }
1358 EXPORT_SYMBOL(iw_handler_set_spy);
1359
1360 /*------------------------------------------------------------------*/
1361 /*
1362 * Standard Wireless Handler : get Spy List
1363 */
1364 int iw_handler_get_spy(struct net_device * dev,
1365 struct iw_request_info * info,
1366 union iwreq_data * wrqu,
1367 char * extra)
1368 {
1369 struct iw_spy_data * spydata = get_spydata(dev);
1370 struct sockaddr * address = (struct sockaddr *) extra;
1371 int i;
1372
1373 /* Make sure driver is not buggy or using the old API */
1374 if (!spydata)
1375 return -EOPNOTSUPP;
1376
1377 wrqu->data.length = spydata->spy_number;
1378
1379 /* Copy addresses. */
1380 for (i = 0; i < spydata->spy_number; i++) {
1381 memcpy(address[i].sa_data, spydata->spy_address[i], ETH_ALEN);
1382 address[i].sa_family = AF_UNIX;
1383 }
1384 /* Copy stats to the user buffer (just after). */
1385 if (spydata->spy_number > 0)
1386 memcpy(extra + (sizeof(struct sockaddr) *spydata->spy_number),
1387 spydata->spy_stat,
1388 sizeof(struct iw_quality) * spydata->spy_number);
1389 /* Reset updated flags. */
1390 for (i = 0; i < spydata->spy_number; i++)
1391 spydata->spy_stat[i].updated &= ~IW_QUAL_ALL_UPDATED;
1392 return 0;
1393 }
1394 EXPORT_SYMBOL(iw_handler_get_spy);
1395
1396 /*------------------------------------------------------------------*/
1397 /*
1398 * Standard Wireless Handler : set spy threshold
1399 */
1400 int iw_handler_set_thrspy(struct net_device * dev,
1401 struct iw_request_info *info,
1402 union iwreq_data * wrqu,
1403 char * extra)
1404 {
1405 struct iw_spy_data * spydata = get_spydata(dev);
1406 struct iw_thrspy * threshold = (struct iw_thrspy *) extra;
1407
1408 /* Make sure driver is not buggy or using the old API */
1409 if (!spydata)
1410 return -EOPNOTSUPP;
1411
1412 /* Just do it */
1413 memcpy(&(spydata->spy_thr_low), &(threshold->low),
1414 2 * sizeof(struct iw_quality));
1415
1416 /* Clear flag */
1417 memset(spydata->spy_thr_under, '\0', sizeof(spydata->spy_thr_under));
1418
1419 return 0;
1420 }
1421 EXPORT_SYMBOL(iw_handler_set_thrspy);
1422
1423 /*------------------------------------------------------------------*/
1424 /*
1425 * Standard Wireless Handler : get spy threshold
1426 */
1427 int iw_handler_get_thrspy(struct net_device * dev,
1428 struct iw_request_info *info,
1429 union iwreq_data * wrqu,
1430 char * extra)
1431 {
1432 struct iw_spy_data * spydata = get_spydata(dev);
1433 struct iw_thrspy * threshold = (struct iw_thrspy *) extra;
1434
1435 /* Make sure driver is not buggy or using the old API */
1436 if (!spydata)
1437 return -EOPNOTSUPP;
1438
1439 /* Just do it */
1440 memcpy(&(threshold->low), &(spydata->spy_thr_low),
1441 2 * sizeof(struct iw_quality));
1442
1443 return 0;
1444 }
1445 EXPORT_SYMBOL(iw_handler_get_thrspy);
1446
1447 /*------------------------------------------------------------------*/
1448 /*
1449 * Prepare and send a Spy Threshold event
1450 */
1451 static void iw_send_thrspy_event(struct net_device * dev,
1452 struct iw_spy_data * spydata,
1453 unsigned char * address,
1454 struct iw_quality * wstats)
1455 {
1456 union iwreq_data wrqu;
1457 struct iw_thrspy threshold;
1458
1459 /* Init */
1460 wrqu.data.length = 1;
1461 wrqu.data.flags = 0;
1462 /* Copy address */
1463 memcpy(threshold.addr.sa_data, address, ETH_ALEN);
1464 threshold.addr.sa_family = ARPHRD_ETHER;
1465 /* Copy stats */
1466 memcpy(&(threshold.qual), wstats, sizeof(struct iw_quality));
1467 /* Copy also thresholds */
1468 memcpy(&(threshold.low), &(spydata->spy_thr_low),
1469 2 * sizeof(struct iw_quality));
1470
1471 /* Send event to user space */
1472 wireless_send_event(dev, SIOCGIWTHRSPY, &wrqu, (char *) &threshold);
1473 }
1474
1475 /* ---------------------------------------------------------------- */
1476 /*
1477 * Call for the driver to update the spy data.
1478 * For now, the spy data is a simple array. As the size of the array is
1479 * small, this is good enough. If we wanted to support larger number of
1480 * spy addresses, we should use something more efficient...
1481 */
1482 void wireless_spy_update(struct net_device * dev,
1483 unsigned char * address,
1484 struct iw_quality * wstats)
1485 {
1486 struct iw_spy_data * spydata = get_spydata(dev);
1487 int i;
1488 int match = -1;
1489
1490 /* Make sure driver is not buggy or using the old API */
1491 if (!spydata)
1492 return;
1493
1494 /* Update all records that match */
1495 for (i = 0; i < spydata->spy_number; i++)
1496 if (!compare_ether_addr(address, spydata->spy_address[i])) {
1497 memcpy(&(spydata->spy_stat[i]), wstats,
1498 sizeof(struct iw_quality));
1499 match = i;
1500 }
1501
1502 /* Generate an event if we cross the spy threshold.
1503 * To avoid event storms, we have a simple hysteresis : we generate
1504 * event only when we go under the low threshold or above the
1505 * high threshold. */
1506 if (match >= 0) {
1507 if (spydata->spy_thr_under[match]) {
1508 if (wstats->level > spydata->spy_thr_high.level) {
1509 spydata->spy_thr_under[match] = 0;
1510 iw_send_thrspy_event(dev, spydata,
1511 address, wstats);
1512 }
1513 } else {
1514 if (wstats->level < spydata->spy_thr_low.level) {
1515 spydata->spy_thr_under[match] = 1;
1516 iw_send_thrspy_event(dev, spydata,
1517 address, wstats);
1518 }
1519 }
1520 }
1521 }
1522 EXPORT_SYMBOL(wireless_spy_update);