?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[PATCH] UML: fix wall_to_monotonic initialization
[linux-2.6/libata-dev.git] / net / core / wireless.c
blobd2bc72d318f7bdb41dc4ab9c1ab3c08978c5af4e
1 /*
2 * This file implement the Wireless Extensions APIs.
3 *
4 * Authors : Jean Tourrilhes - HPL - <jt@hpl.hp.com>
5 * Copyright (c) 1997-2006 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
73 /***************************** INCLUDES *****************************/
74
75 #include <linux/config.h> /* Not needed ??? */
76 #include <linux/module.h>
77 #include <linux/types.h> /* off_t */
78 #include <linux/netdevice.h> /* struct ifreq, dev_get_by_name() */
79 #include <linux/proc_fs.h>
80 #include <linux/rtnetlink.h> /* rtnetlink stuff */
81 #include <linux/seq_file.h>
82 #include <linux/init.h> /* for __init */
83 #include <linux/if_arp.h> /* ARPHRD_ETHER */
84 #include <linux/etherdevice.h> /* compare_ether_addr */
85
86 #include <linux/wireless.h> /* Pretty obvious */
87 #include <net/iw_handler.h> /* New driver API */
88
89 #include <asm/uaccess.h> /* copy_to_user() */
90
91 /**************************** CONSTANTS ****************************/
92
93 /* Debugging stuff */
94 #undef WE_IOCTL_DEBUG /* Debug IOCTL API */
95 #undef WE_RTNETLINK_DEBUG /* Debug RtNetlink API */
96 #undef WE_EVENT_DEBUG /* Debug Event dispatcher */
97 #undef WE_SPY_DEBUG /* Debug enhanced spy support */
98
99 /* Options */
100 //CONFIG_NET_WIRELESS_RTNETLINK /* Wireless requests over RtNetlink */
101 #define WE_EVENT_RTNETLINK /* Propagate events using RtNetlink */
102 #define WE_SET_EVENT /* Generate an event on some set commands */
103
104 /************************* GLOBAL VARIABLES *************************/
105 /*
106 * You should not use global variables, because of re-entrancy.
107 * On our case, it's only const, so it's OK...
108 */
109 /*
110 * Meta-data about all the standard Wireless Extension request we
111 * know about.
112 */
113 static const struct iw_ioctl_description standard_ioctl[] = {
114 [SIOCSIWCOMMIT - SIOCIWFIRST] = {
115 .header_type = IW_HEADER_TYPE_NULL,
116 },
117 [SIOCGIWNAME - SIOCIWFIRST] = {
118 .header_type = IW_HEADER_TYPE_CHAR,
119 .flags = IW_DESCR_FLAG_DUMP,
120 },
121 [SIOCSIWNWID - SIOCIWFIRST] = {
122 .header_type = IW_HEADER_TYPE_PARAM,
123 .flags = IW_DESCR_FLAG_EVENT,
124 },
125 [SIOCGIWNWID - SIOCIWFIRST] = {
126 .header_type = IW_HEADER_TYPE_PARAM,
127 .flags = IW_DESCR_FLAG_DUMP,
128 },
129 [SIOCSIWFREQ - SIOCIWFIRST] = {
130 .header_type = IW_HEADER_TYPE_FREQ,
131 .flags = IW_DESCR_FLAG_EVENT,
132 },
133 [SIOCGIWFREQ - SIOCIWFIRST] = {
134 .header_type = IW_HEADER_TYPE_FREQ,
135 .flags = IW_DESCR_FLAG_DUMP,
136 },
137 [SIOCSIWMODE - SIOCIWFIRST] = {
138 .header_type = IW_HEADER_TYPE_UINT,
139 .flags = IW_DESCR_FLAG_EVENT,
140 },
141 [SIOCGIWMODE - SIOCIWFIRST] = {
142 .header_type = IW_HEADER_TYPE_UINT,
143 .flags = IW_DESCR_FLAG_DUMP,
144 },
145 [SIOCSIWSENS - SIOCIWFIRST] = {
146 .header_type = IW_HEADER_TYPE_PARAM,
147 },
148 [SIOCGIWSENS - SIOCIWFIRST] = {
149 .header_type = IW_HEADER_TYPE_PARAM,
150 },
151 [SIOCSIWRANGE - SIOCIWFIRST] = {
152 .header_type = IW_HEADER_TYPE_NULL,
153 },
154 [SIOCGIWRANGE - SIOCIWFIRST] = {
155 .header_type = IW_HEADER_TYPE_POINT,
156 .token_size = 1,
157 .max_tokens = sizeof(struct iw_range),
158 .flags = IW_DESCR_FLAG_DUMP,
159 },
160 [SIOCSIWPRIV - SIOCIWFIRST] = {
161 .header_type = IW_HEADER_TYPE_NULL,
162 },
163 [SIOCGIWPRIV - SIOCIWFIRST] = { /* (handled directly by us) */
164 .header_type = IW_HEADER_TYPE_POINT,
165 .token_size = sizeof(struct iw_priv_args),
166 .max_tokens = 16,
167 .flags = IW_DESCR_FLAG_NOMAX,
168 },
169 [SIOCSIWSTATS - SIOCIWFIRST] = {
170 .header_type = IW_HEADER_TYPE_NULL,
171 },
172 [SIOCGIWSTATS - SIOCIWFIRST] = { /* (handled directly by us) */
173 .header_type = IW_HEADER_TYPE_POINT,
174 .token_size = 1,
175 .max_tokens = sizeof(struct iw_statistics),
176 .flags = IW_DESCR_FLAG_DUMP,
177 },
178 [SIOCSIWSPY - SIOCIWFIRST] = {
179 .header_type = IW_HEADER_TYPE_POINT,
180 .token_size = sizeof(struct sockaddr),
181 .max_tokens = IW_MAX_SPY,
182 },
183 [SIOCGIWSPY - SIOCIWFIRST] = {
184 .header_type = IW_HEADER_TYPE_POINT,
185 .token_size = sizeof(struct sockaddr) +
186 sizeof(struct iw_quality),
187 .max_tokens = IW_MAX_SPY,
188 },
189 [SIOCSIWTHRSPY - SIOCIWFIRST] = {
190 .header_type = IW_HEADER_TYPE_POINT,
191 .token_size = sizeof(struct iw_thrspy),
192 .min_tokens = 1,
193 .max_tokens = 1,
194 },
195 [SIOCGIWTHRSPY - SIOCIWFIRST] = {
196 .header_type = IW_HEADER_TYPE_POINT,
197 .token_size = sizeof(struct iw_thrspy),
198 .min_tokens = 1,
199 .max_tokens = 1,
200 },
201 [SIOCSIWAP - SIOCIWFIRST] = {
202 .header_type = IW_HEADER_TYPE_ADDR,
203 },
204 [SIOCGIWAP - SIOCIWFIRST] = {
205 .header_type = IW_HEADER_TYPE_ADDR,
206 .flags = IW_DESCR_FLAG_DUMP,
207 },
208 [SIOCSIWMLME - SIOCIWFIRST] = {
209 .header_type = IW_HEADER_TYPE_POINT,
210 .token_size = 1,
211 .min_tokens = sizeof(struct iw_mlme),
212 .max_tokens = sizeof(struct iw_mlme),
213 },
214 [SIOCGIWAPLIST - SIOCIWFIRST] = {
215 .header_type = IW_HEADER_TYPE_POINT,
216 .token_size = sizeof(struct sockaddr) +
217 sizeof(struct iw_quality),
218 .max_tokens = IW_MAX_AP,
219 .flags = IW_DESCR_FLAG_NOMAX,
220 },
221 [SIOCSIWSCAN - SIOCIWFIRST] = {
222 .header_type = IW_HEADER_TYPE_POINT,
223 .token_size = 1,
224 .min_tokens = 0,
225 .max_tokens = sizeof(struct iw_scan_req),
226 },
227 [SIOCGIWSCAN - SIOCIWFIRST] = {
228 .header_type = IW_HEADER_TYPE_POINT,
229 .token_size = 1,
230 .max_tokens = IW_SCAN_MAX_DATA,
231 .flags = IW_DESCR_FLAG_NOMAX,
232 },
233 [SIOCSIWESSID - SIOCIWFIRST] = {
234 .header_type = IW_HEADER_TYPE_POINT,
235 .token_size = 1,
236 .max_tokens = IW_ESSID_MAX_SIZE + 1,
237 .flags = IW_DESCR_FLAG_EVENT,
238 },
239 [SIOCGIWESSID - SIOCIWFIRST] = {
240 .header_type = IW_HEADER_TYPE_POINT,
241 .token_size = 1,
242 .max_tokens = IW_ESSID_MAX_SIZE + 1,
243 .flags = IW_DESCR_FLAG_DUMP,
244 },
245 [SIOCSIWNICKN - SIOCIWFIRST] = {
246 .header_type = IW_HEADER_TYPE_POINT,
247 .token_size = 1,
248 .max_tokens = IW_ESSID_MAX_SIZE + 1,
249 },
250 [SIOCGIWNICKN - SIOCIWFIRST] = {
251 .header_type = IW_HEADER_TYPE_POINT,
252 .token_size = 1,
253 .max_tokens = IW_ESSID_MAX_SIZE + 1,
254 },
255 [SIOCSIWRATE - SIOCIWFIRST] = {
256 .header_type = IW_HEADER_TYPE_PARAM,
257 },
258 [SIOCGIWRATE - SIOCIWFIRST] = {
259 .header_type = IW_HEADER_TYPE_PARAM,
260 },
261 [SIOCSIWRTS - SIOCIWFIRST] = {
262 .header_type = IW_HEADER_TYPE_PARAM,
263 },
264 [SIOCGIWRTS - SIOCIWFIRST] = {
265 .header_type = IW_HEADER_TYPE_PARAM,
266 },
267 [SIOCSIWFRAG - SIOCIWFIRST] = {
268 .header_type = IW_HEADER_TYPE_PARAM,
269 },
270 [SIOCGIWFRAG - SIOCIWFIRST] = {
271 .header_type = IW_HEADER_TYPE_PARAM,
272 },
273 [SIOCSIWTXPOW - SIOCIWFIRST] = {
274 .header_type = IW_HEADER_TYPE_PARAM,
275 },
276 [SIOCGIWTXPOW - SIOCIWFIRST] = {
277 .header_type = IW_HEADER_TYPE_PARAM,
278 },
279 [SIOCSIWRETRY - SIOCIWFIRST] = {
280 .header_type = IW_HEADER_TYPE_PARAM,
281 },
282 [SIOCGIWRETRY - SIOCIWFIRST] = {
283 .header_type = IW_HEADER_TYPE_PARAM,
284 },
285 [SIOCSIWENCODE - SIOCIWFIRST] = {
286 .header_type = IW_HEADER_TYPE_POINT,
287 .token_size = 1,
288 .max_tokens = IW_ENCODING_TOKEN_MAX,
289 .flags = IW_DESCR_FLAG_EVENT | IW_DESCR_FLAG_RESTRICT,
290 },
291 [SIOCGIWENCODE - SIOCIWFIRST] = {
292 .header_type = IW_HEADER_TYPE_POINT,
293 .token_size = 1,
294 .max_tokens = IW_ENCODING_TOKEN_MAX,
295 .flags = IW_DESCR_FLAG_DUMP | IW_DESCR_FLAG_RESTRICT,
296 },
297 [SIOCSIWPOWER - SIOCIWFIRST] = {
298 .header_type = IW_HEADER_TYPE_PARAM,
299 },
300 [SIOCGIWPOWER - SIOCIWFIRST] = {
301 .header_type = IW_HEADER_TYPE_PARAM,
302 },
303 [SIOCSIWGENIE - SIOCIWFIRST] = {
304 .header_type = IW_HEADER_TYPE_POINT,
305 .token_size = 1,
306 .max_tokens = IW_GENERIC_IE_MAX,
307 },
308 [SIOCGIWGENIE - SIOCIWFIRST] = {
309 .header_type = IW_HEADER_TYPE_POINT,
310 .token_size = 1,
311 .max_tokens = IW_GENERIC_IE_MAX,
312 },
313 [SIOCSIWAUTH - SIOCIWFIRST] = {
314 .header_type = IW_HEADER_TYPE_PARAM,
315 },
316 [SIOCGIWAUTH - SIOCIWFIRST] = {
317 .header_type = IW_HEADER_TYPE_PARAM,
318 },
319 [SIOCSIWENCODEEXT - SIOCIWFIRST] = {
320 .header_type = IW_HEADER_TYPE_POINT,
321 .token_size = 1,
322 .min_tokens = sizeof(struct iw_encode_ext),
323 .max_tokens = sizeof(struct iw_encode_ext) +
324 IW_ENCODING_TOKEN_MAX,
325 },
326 [SIOCGIWENCODEEXT - SIOCIWFIRST] = {
327 .header_type = IW_HEADER_TYPE_POINT,
328 .token_size = 1,
329 .min_tokens = sizeof(struct iw_encode_ext),
330 .max_tokens = sizeof(struct iw_encode_ext) +
331 IW_ENCODING_TOKEN_MAX,
332 },
333 [SIOCSIWPMKSA - SIOCIWFIRST] = {
334 .header_type = IW_HEADER_TYPE_POINT,
335 .token_size = 1,
336 .min_tokens = sizeof(struct iw_pmksa),
337 .max_tokens = sizeof(struct iw_pmksa),
338 },
339 };
340 static const int standard_ioctl_num = (sizeof(standard_ioctl) /
341 sizeof(struct iw_ioctl_description));
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 int standard_event_num = (sizeof(standard_event) /
392 sizeof(struct iw_ioctl_description));
393
394 /* Size (in bytes) of the various private data types */
395 static const char iw_priv_type_size[] = {
396 0, /* IW_PRIV_TYPE_NONE */
397 1, /* IW_PRIV_TYPE_BYTE */
398 1, /* IW_PRIV_TYPE_CHAR */
399 0, /* Not defined */
400 sizeof(__u32), /* IW_PRIV_TYPE_INT */
401 sizeof(struct iw_freq), /* IW_PRIV_TYPE_FLOAT */
402 sizeof(struct sockaddr), /* IW_PRIV_TYPE_ADDR */
403 0, /* Not defined */
404 };
405
406 /* Size (in bytes) of various events */
407 static const int event_type_size[] = {
408 IW_EV_LCP_LEN, /* IW_HEADER_TYPE_NULL */
409 0,
410 IW_EV_CHAR_LEN, /* IW_HEADER_TYPE_CHAR */
411 0,
412 IW_EV_UINT_LEN, /* IW_HEADER_TYPE_UINT */
413 IW_EV_FREQ_LEN, /* IW_HEADER_TYPE_FREQ */
414 IW_EV_ADDR_LEN, /* IW_HEADER_TYPE_ADDR */
415 0,
416 IW_EV_POINT_LEN, /* Without variable payload */
417 IW_EV_PARAM_LEN, /* IW_HEADER_TYPE_PARAM */
418 IW_EV_QUAL_LEN, /* IW_HEADER_TYPE_QUAL */
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 * Called from various place, so make sure it remains efficient.
431 */
432 static inline iw_handler get_handler(struct net_device *dev,
433 unsigned int cmd)
434 {
435 /* Don't "optimise" the following variable, it will crash */
436 unsigned int index; /* *MUST* be unsigned */
437
438 /* Check if we have some wireless handlers defined */
439 if(dev->wireless_handlers == NULL)
440 return NULL;
441
442 /* Try as a standard command */
443 index = cmd - SIOCIWFIRST;
444 if(index < dev->wireless_handlers->num_standard)
445 return dev->wireless_handlers->standard[index];
446
447 /* Try as a private command */
448 index = cmd - SIOCIWFIRSTPRIV;
449 if(index < dev->wireless_handlers->num_private)
450 return dev->wireless_handlers->private[index];
451
452 /* Not found */
453 return NULL;
454 }
455
456 /* ---------------------------------------------------------------- */
457 /*
458 * Get statistics out of the driver
459 */
460 static inline struct iw_statistics *get_wireless_stats(struct net_device *dev)
461 {
462 /* New location */
463 if((dev->wireless_handlers != NULL) &&
464 (dev->wireless_handlers->get_wireless_stats != NULL))
465 return dev->wireless_handlers->get_wireless_stats(dev);
466
467 /* Old location, field to be removed in next WE */
468 if(dev->get_wireless_stats) {
469 static int printed_message;
470
471 if (!printed_message++)
472 printk(KERN_DEBUG "%s (WE) : Driver using old /proc/net/wireless support, please fix driver !\n",
473 dev->name);
474
475 return dev->get_wireless_stats(dev);
476 }
477
478 /* Not found */
479 return (struct iw_statistics *) NULL;
480 }
481
482 /* ---------------------------------------------------------------- */
483 /*
484 * Call the commit handler in the driver
485 * (if exist and if conditions are right)
486 *
487 * Note : our current commit strategy is currently pretty dumb,
488 * but we will be able to improve on that...
489 * The goal is to try to agreagate as many changes as possible
490 * before doing the commit. Drivers that will define a commit handler
491 * are usually those that need a reset after changing parameters, so
492 * we want to minimise the number of reset.
493 * A cool idea is to use a timer : at each "set" command, we re-set the
494 * timer, when the timer eventually fires, we call the driver.
495 * Hopefully, more on that later.
496 *
497 * Also, I'm waiting to see how many people will complain about the
498 * netif_running(dev) test. I'm open on that one...
499 * Hopefully, the driver will remember to do a commit in "open()" ;-)
500 */
501 static inline int call_commit_handler(struct net_device * dev)
502 {
503 if((netif_running(dev)) &&
504 (dev->wireless_handlers->standard[0] != NULL)) {
505 /* Call the commit handler on the driver */
506 return dev->wireless_handlers->standard[0](dev, NULL,
507 NULL, NULL);
508 } else
509 return 0; /* Command completed successfully */
510 }
511
512 /* ---------------------------------------------------------------- */
513 /*
514 * Calculate size of private arguments
515 */
516 static inline int get_priv_size(__u16 args)
517 {
518 int num = args & IW_PRIV_SIZE_MASK;
519 int type = (args & IW_PRIV_TYPE_MASK) >> 12;
520
521 return num * iw_priv_type_size[type];
522 }
523
524 /* ---------------------------------------------------------------- */
525 /*
526 * Re-calculate the size of private arguments
527 */
528 static inline int adjust_priv_size(__u16 args,
529 union iwreq_data * wrqu)
530 {
531 int num = wrqu->data.length;
532 int max = args & IW_PRIV_SIZE_MASK;
533 int type = (args & IW_PRIV_TYPE_MASK) >> 12;
534
535 /* Make sure the driver doesn't goof up */
536 if (max < num)
537 num = max;
538
539 return num * iw_priv_type_size[type];
540 }
541
542 /* ---------------------------------------------------------------- */
543 /*
544 * Standard Wireless Handler : get wireless stats
545 * Allow programatic access to /proc/net/wireless even if /proc
546 * doesn't exist... Also more efficient...
547 */
548 static int iw_handler_get_iwstats(struct net_device * dev,
549 struct iw_request_info * info,
550 union iwreq_data * wrqu,
551 char * extra)
552 {
553 /* Get stats from the driver */
554 struct iw_statistics *stats;
555
556 stats = get_wireless_stats(dev);
557 if (stats != (struct iw_statistics *) NULL) {
558
559 /* Copy statistics to extra */
560 memcpy(extra, stats, sizeof(struct iw_statistics));
561 wrqu->data.length = sizeof(struct iw_statistics);
562
563 /* Check if we need to clear the updated flag */
564 if(wrqu->data.flags != 0)
565 stats->qual.updated &= ~IW_QUAL_ALL_UPDATED;
566 return 0;
567 } else
568 return -EOPNOTSUPP;
569 }
570
571 /* ---------------------------------------------------------------- */
572 /*
573 * Standard Wireless Handler : get iwpriv definitions
574 * Export the driver private handler definition
575 * They will be picked up by tools like iwpriv...
576 */
577 static int iw_handler_get_private(struct net_device * dev,
578 struct iw_request_info * info,
579 union iwreq_data * wrqu,
580 char * extra)
581 {
582 /* Check if the driver has something to export */
583 if((dev->wireless_handlers->num_private_args == 0) ||
584 (dev->wireless_handlers->private_args == NULL))
585 return -EOPNOTSUPP;
586
587 /* Check if there is enough buffer up there */
588 if(wrqu->data.length < dev->wireless_handlers->num_private_args) {
589 /* User space can't know in advance how large the buffer
590 * needs to be. Give it a hint, so that we can support
591 * any size buffer we want somewhat efficiently... */
592 wrqu->data.length = dev->wireless_handlers->num_private_args;
593 return -E2BIG;
594 }
595
596 /* Set the number of available ioctls. */
597 wrqu->data.length = dev->wireless_handlers->num_private_args;
598
599 /* Copy structure to the user buffer. */
600 memcpy(extra, dev->wireless_handlers->private_args,
601 sizeof(struct iw_priv_args) * wrqu->data.length);
602
603 return 0;
604 }
605
606
607 /******************** /proc/net/wireless SUPPORT ********************/
608 /*
609 * The /proc/net/wireless file is a human readable user-space interface
610 * exporting various wireless specific statistics from the wireless devices.
611 * This is the most popular part of the Wireless Extensions ;-)
612 *
613 * This interface is a pure clone of /proc/net/dev (in net/core/dev.c).
614 * The content of the file is basically the content of "struct iw_statistics".
615 */
616
617 #ifdef CONFIG_PROC_FS
618
619 /* ---------------------------------------------------------------- */
620 /*
621 * Print one entry (line) of /proc/net/wireless
622 */
623 static __inline__ void wireless_seq_printf_stats(struct seq_file *seq,
624 struct net_device *dev)
625 {
626 /* Get stats from the driver */
627 struct iw_statistics *stats = get_wireless_stats(dev);
628
629 if (stats) {
630 seq_printf(seq, "%6s: %04x %3d%c %3d%c %3d%c %6d %6d %6d "
631 "%6d %6d %6d\n",
632 dev->name, stats->status, stats->qual.qual,
633 stats->qual.updated & IW_QUAL_QUAL_UPDATED
634 ? '.' : ' ',
635 ((__s32) stats->qual.level) -
636 ((stats->qual.updated & IW_QUAL_DBM) ? 0x100 : 0),
637 stats->qual.updated & IW_QUAL_LEVEL_UPDATED
638 ? '.' : ' ',
639 ((__s32) stats->qual.noise) -
640 ((stats->qual.updated & IW_QUAL_DBM) ? 0x100 : 0),
641 stats->qual.updated & IW_QUAL_NOISE_UPDATED
642 ? '.' : ' ',
643 stats->discard.nwid, stats->discard.code,
644 stats->discard.fragment, stats->discard.retries,
645 stats->discard.misc, stats->miss.beacon);
646 stats->qual.updated &= ~IW_QUAL_ALL_UPDATED;
647 }
648 }
649
650 /* ---------------------------------------------------------------- */
651 /*
652 * Print info for /proc/net/wireless (print all entries)
653 */
654 static int wireless_seq_show(struct seq_file *seq, void *v)
655 {
656 if (v == SEQ_START_TOKEN)
657 seq_printf(seq, "Inter-| sta-| Quality | Discarded "
658 "packets | Missed | WE\n"
659 " face | tus | link level noise | nwid "
660 "crypt frag retry misc | beacon | %d\n",
661 WIRELESS_EXT);
662 else
663 wireless_seq_printf_stats(seq, v);
664 return 0;
665 }
666
667 static struct seq_operations wireless_seq_ops = {
668 .start = dev_seq_start,
669 .next = dev_seq_next,
670 .stop = dev_seq_stop,
671 .show = wireless_seq_show,
672 };
673
674 static int wireless_seq_open(struct inode *inode, struct file *file)
675 {
676 return seq_open(file, &wireless_seq_ops);
677 }
678
679 static struct file_operations wireless_seq_fops = {
680 .owner = THIS_MODULE,
681 .open = wireless_seq_open,
682 .read = seq_read,
683 .llseek = seq_lseek,
684 .release = seq_release,
685 };
686
687 int __init wireless_proc_init(void)
688 {
689 /* Create /proc/net/wireless entry */
690 if (!proc_net_fops_create("wireless", S_IRUGO, &wireless_seq_fops))
691 return -ENOMEM;
692
693 return 0;
694 }
695 #endif /* CONFIG_PROC_FS */
696
697 /************************** IOCTL SUPPORT **************************/
698 /*
699 * The original user space API to configure all those Wireless Extensions
700 * is through IOCTLs.
701 * In there, we check if we need to call the new driver API (iw_handler)
702 * or just call the driver ioctl handler.
703 */
704
705 /* ---------------------------------------------------------------- */
706 /*
707 * Wrapper to call a standard Wireless Extension handler.
708 * We do various checks and also take care of moving data between
709 * user space and kernel space.
710 */
711 static int ioctl_standard_call(struct net_device * dev,
712 struct ifreq * ifr,
713 unsigned int cmd,
714 iw_handler handler)
715 {
716 struct iwreq * iwr = (struct iwreq *) ifr;
717 const struct iw_ioctl_description * descr;
718 struct iw_request_info info;
719 int ret = -EINVAL;
720
721 /* Get the description of the IOCTL */
722 if((cmd - SIOCIWFIRST) >= standard_ioctl_num)
723 return -EOPNOTSUPP;
724 descr = &(standard_ioctl[cmd - SIOCIWFIRST]);
725
726 #ifdef WE_IOCTL_DEBUG
727 printk(KERN_DEBUG "%s (WE) : Found standard handler for 0x%04X\n",
728 ifr->ifr_name, cmd);
729 printk(KERN_DEBUG "%s (WE) : Header type : %d, Token type : %d, size : %d, token : %d\n", dev->name, descr->header_type, descr->token_type, descr->token_size, descr->max_tokens);
730 #endif /* WE_IOCTL_DEBUG */
731
732 /* Prepare the call */
733 info.cmd = cmd;
734 info.flags = 0;
735
736 /* Check if we have a pointer to user space data or not */
737 if(descr->header_type != IW_HEADER_TYPE_POINT) {
738
739 /* No extra arguments. Trivial to handle */
740 ret = handler(dev, &info, &(iwr->u), NULL);
741
742 #ifdef WE_SET_EVENT
743 /* Generate an event to notify listeners of the change */
744 if((descr->flags & IW_DESCR_FLAG_EVENT) &&
745 ((ret == 0) || (ret == -EIWCOMMIT)))
746 wireless_send_event(dev, cmd, &(iwr->u), NULL);
747 #endif /* WE_SET_EVENT */
748 } else {
749 char * extra;
750 int extra_size;
751 int user_length = 0;
752 int err;
753
754 /* Calculate space needed by arguments. Always allocate
755 * for max space. Easier, and won't last long... */
756 extra_size = descr->max_tokens * descr->token_size;
757
758 /* Check what user space is giving us */
759 if(IW_IS_SET(cmd)) {
760 /* Check NULL pointer */
761 if((iwr->u.data.pointer == NULL) &&
762 (iwr->u.data.length != 0))
763 return -EFAULT;
764 /* Check if number of token fits within bounds */
765 if(iwr->u.data.length > descr->max_tokens)
766 return -E2BIG;
767 if(iwr->u.data.length < descr->min_tokens)
768 return -EINVAL;
769 } else {
770 /* Check NULL pointer */
771 if(iwr->u.data.pointer == NULL)
772 return -EFAULT;
773 /* Save user space buffer size for checking */
774 user_length = iwr->u.data.length;
775
776 /* Don't check if user_length > max to allow forward
777 * compatibility. The test user_length < min is
778 * implied by the test at the end. */
779
780 /* Support for very large requests */
781 if((descr->flags & IW_DESCR_FLAG_NOMAX) &&
782 (user_length > descr->max_tokens)) {
783 /* Allow userspace to GET more than max so
784 * we can support any size GET requests.
785 * There is still a limit : -ENOMEM. */
786 extra_size = user_length * descr->token_size;
787 /* Note : user_length is originally a __u16,
788 * and token_size is controlled by us,
789 * so extra_size won't get negative and
790 * won't overflow... */
791 }
792 }
793
794 #ifdef WE_IOCTL_DEBUG
795 printk(KERN_DEBUG "%s (WE) : Malloc %d bytes\n",
796 dev->name, extra_size);
797 #endif /* WE_IOCTL_DEBUG */
798
799 /* Create the kernel buffer */
800 extra = kmalloc(extra_size, GFP_KERNEL);
801 if (extra == NULL) {
802 return -ENOMEM;
803 }
804
805 /* If it is a SET, get all the extra data in here */
806 if(IW_IS_SET(cmd) && (iwr->u.data.length != 0)) {
807 err = copy_from_user(extra, iwr->u.data.pointer,
808 iwr->u.data.length *
809 descr->token_size);
810 if (err) {
811 kfree(extra);
812 return -EFAULT;
813 }
814 #ifdef WE_IOCTL_DEBUG
815 printk(KERN_DEBUG "%s (WE) : Got %d bytes\n",
816 dev->name,
817 iwr->u.data.length * descr->token_size);
818 #endif /* WE_IOCTL_DEBUG */
819 }
820
821 /* Call the handler */
822 ret = handler(dev, &info, &(iwr->u), extra);
823
824 /* If we have something to return to the user */
825 if (!ret && IW_IS_GET(cmd)) {
826 /* Check if there is enough buffer up there */
827 if(user_length < iwr->u.data.length) {
828 kfree(extra);
829 return -E2BIG;
830 }
831
832 err = copy_to_user(iwr->u.data.pointer, extra,
833 iwr->u.data.length *
834 descr->token_size);
835 if (err)
836 ret = -EFAULT;
837 #ifdef WE_IOCTL_DEBUG
838 printk(KERN_DEBUG "%s (WE) : Wrote %d bytes\n",
839 dev->name,
840 iwr->u.data.length * descr->token_size);
841 #endif /* WE_IOCTL_DEBUG */
842 }
843
844 #ifdef WE_SET_EVENT
845 /* Generate an event to notify listeners of the change */
846 if((descr->flags & IW_DESCR_FLAG_EVENT) &&
847 ((ret == 0) || (ret == -EIWCOMMIT))) {
848 if(descr->flags & IW_DESCR_FLAG_RESTRICT)
849 /* If the event is restricted, don't
850 * export the payload */
851 wireless_send_event(dev, cmd, &(iwr->u), NULL);
852 else
853 wireless_send_event(dev, cmd, &(iwr->u),
854 extra);
855 }
856 #endif /* WE_SET_EVENT */
857
858 /* Cleanup - I told you it wasn't that long ;-) */
859 kfree(extra);
860 }
861
862 /* Call commit handler if needed and defined */
863 if(ret == -EIWCOMMIT)
864 ret = call_commit_handler(dev);
865
866 /* Here, we will generate the appropriate event if needed */
867
868 return ret;
869 }
870
871 /* ---------------------------------------------------------------- */
872 /*
873 * Wrapper to call a private Wireless Extension handler.
874 * We do various checks and also take care of moving data between
875 * user space and kernel space.
876 * It's not as nice and slimline as the standard wrapper. The cause
877 * is struct iw_priv_args, which was not really designed for the
878 * job we are going here.
879 *
880 * IMPORTANT : This function prevent to set and get data on the same
881 * IOCTL and enforce the SET/GET convention. Not doing it would be
882 * far too hairy...
883 * If you need to set and get data at the same time, please don't use
884 * a iw_handler but process it in your ioctl handler (i.e. use the
885 * old driver API).
886 */
887 static inline int ioctl_private_call(struct net_device * dev,
888 struct ifreq * ifr,
889 unsigned int cmd,
890 iw_handler handler)
891 {
892 struct iwreq * iwr = (struct iwreq *) ifr;
893 const struct iw_priv_args * descr = NULL;
894 struct iw_request_info info;
895 int extra_size = 0;
896 int i;
897 int ret = -EINVAL;
898
899 /* Get the description of the IOCTL */
900 for(i = 0; i < dev->wireless_handlers->num_private_args; i++)
901 if(cmd == dev->wireless_handlers->private_args[i].cmd) {
902 descr = &(dev->wireless_handlers->private_args[i]);
903 break;
904 }
905
906 #ifdef WE_IOCTL_DEBUG
907 printk(KERN_DEBUG "%s (WE) : Found private handler for 0x%04X\n",
908 ifr->ifr_name, cmd);
909 if(descr) {
910 printk(KERN_DEBUG "%s (WE) : Name %s, set %X, get %X\n",
911 dev->name, descr->name,
912 descr->set_args, descr->get_args);
913 }
914 #endif /* WE_IOCTL_DEBUG */
915
916 /* Compute the size of the set/get arguments */
917 if(descr != NULL) {
918 if(IW_IS_SET(cmd)) {
919 int offset = 0; /* For sub-ioctls */
920 /* Check for sub-ioctl handler */
921 if(descr->name[0] == '\0')
922 /* Reserve one int for sub-ioctl index */
923 offset = sizeof(__u32);
924
925 /* Size of set arguments */
926 extra_size = get_priv_size(descr->set_args);
927
928 /* Does it fits in iwr ? */
929 if((descr->set_args & IW_PRIV_SIZE_FIXED) &&
930 ((extra_size + offset) <= IFNAMSIZ))
931 extra_size = 0;
932 } else {
933 /* Size of get arguments */
934 extra_size = get_priv_size(descr->get_args);
935
936 /* Does it fits in iwr ? */
937 if((descr->get_args & IW_PRIV_SIZE_FIXED) &&
938 (extra_size <= IFNAMSIZ))
939 extra_size = 0;
940 }
941 }
942
943 /* Prepare the call */
944 info.cmd = cmd;
945 info.flags = 0;
946
947 /* Check if we have a pointer to user space data or not. */
948 if(extra_size == 0) {
949 /* No extra arguments. Trivial to handle */
950 ret = handler(dev, &info, &(iwr->u), (char *) &(iwr->u));
951 } else {
952 char * extra;
953 int err;
954
955 /* Check what user space is giving us */
956 if(IW_IS_SET(cmd)) {
957 /* Check NULL pointer */
958 if((iwr->u.data.pointer == NULL) &&
959 (iwr->u.data.length != 0))
960 return -EFAULT;
961
962 /* Does it fits within bounds ? */
963 if(iwr->u.data.length > (descr->set_args &
964 IW_PRIV_SIZE_MASK))
965 return -E2BIG;
966 } else {
967 /* Check NULL pointer */
968 if(iwr->u.data.pointer == NULL)
969 return -EFAULT;
970 }
971
972 #ifdef WE_IOCTL_DEBUG
973 printk(KERN_DEBUG "%s (WE) : Malloc %d bytes\n",
974 dev->name, extra_size);
975 #endif /* WE_IOCTL_DEBUG */
976
977 /* Always allocate for max space. Easier, and won't last
978 * long... */
979 extra = kmalloc(extra_size, GFP_KERNEL);
980 if (extra == NULL) {
981 return -ENOMEM;
982 }
983
984 /* If it is a SET, get all the extra data in here */
985 if(IW_IS_SET(cmd) && (iwr->u.data.length != 0)) {
986 err = copy_from_user(extra, iwr->u.data.pointer,
987 extra_size);
988 if (err) {
989 kfree(extra);
990 return -EFAULT;
991 }
992 #ifdef WE_IOCTL_DEBUG
993 printk(KERN_DEBUG "%s (WE) : Got %d elem\n",
994 dev->name, iwr->u.data.length);
995 #endif /* WE_IOCTL_DEBUG */
996 }
997
998 /* Call the handler */
999 ret = handler(dev, &info, &(iwr->u), extra);
1000
1001 /* If we have something to return to the user */
1002 if (!ret && IW_IS_GET(cmd)) {
1003
1004 /* Adjust for the actual length if it's variable,
1005 * avoid leaking kernel bits outside. */
1006 if (!(descr->get_args & IW_PRIV_SIZE_FIXED)) {
1007 extra_size = adjust_priv_size(descr->get_args,
1008 &(iwr->u));
1009 }
1010
1011 err = copy_to_user(iwr->u.data.pointer, extra,
1012 extra_size);
1013 if (err)
1014 ret = -EFAULT;
1015 #ifdef WE_IOCTL_DEBUG
1016 printk(KERN_DEBUG "%s (WE) : Wrote %d elem\n",
1017 dev->name, iwr->u.data.length);
1018 #endif /* WE_IOCTL_DEBUG */
1019 }
1020
1021 /* Cleanup - I told you it wasn't that long ;-) */
1022 kfree(extra);
1023 }
1024
1025
1026 /* Call commit handler if needed and defined */
1027 if(ret == -EIWCOMMIT)
1028 ret = call_commit_handler(dev);
1029
1030 return ret;
1031 }
1032
1033 /* ---------------------------------------------------------------- */
1034 /*
1035 * Main IOCTl dispatcher. Called from the main networking code
1036 * (dev_ioctl() in net/core/dev.c).
1037 * Check the type of IOCTL and call the appropriate wrapper...
1038 */
1039 int wireless_process_ioctl(struct ifreq *ifr, unsigned int cmd)
1040 {
1041 struct net_device *dev;
1042 iw_handler handler;
1043
1044 /* Permissions are already checked in dev_ioctl() before calling us.
1045 * The copy_to/from_user() of ifr is also dealt with in there */
1046
1047 /* Make sure the device exist */
1048 if ((dev = __dev_get_by_name(ifr->ifr_name)) == NULL)
1049 return -ENODEV;
1050
1051 /* A bunch of special cases, then the generic case...
1052 * Note that 'cmd' is already filtered in dev_ioctl() with
1053 * (cmd >= SIOCIWFIRST && cmd <= SIOCIWLAST) */
1054 switch(cmd)
1055 {
1056 case SIOCGIWSTATS:
1057 /* Get Wireless Stats */
1058 return ioctl_standard_call(dev,
1059 ifr,
1060 cmd,
1061 &iw_handler_get_iwstats);
1062
1063 case SIOCGIWPRIV:
1064 /* Check if we have some wireless handlers defined */
1065 if(dev->wireless_handlers != NULL) {
1066 /* We export to user space the definition of
1067 * the private handler ourselves */
1068 return ioctl_standard_call(dev,
1069 ifr,
1070 cmd,
1071 &iw_handler_get_private);
1072 }
1073 // ## Fall-through for old API ##
1074 default:
1075 /* Generic IOCTL */
1076 /* Basic check */
1077 if (!netif_device_present(dev))
1078 return -ENODEV;
1079 /* New driver API : try to find the handler */
1080 handler = get_handler(dev, cmd);
1081 if(handler != NULL) {
1082 /* Standard and private are not the same */
1083 if(cmd < SIOCIWFIRSTPRIV)
1084 return ioctl_standard_call(dev,
1085 ifr,
1086 cmd,
1087 handler);
1088 else
1089 return ioctl_private_call(dev,
1090 ifr,
1091 cmd,
1092 handler);
1093 }
1094 /* Old driver API : call driver ioctl handler */
1095 if (dev->do_ioctl) {
1096 return dev->do_ioctl(dev, ifr, cmd);
1097 }
1098 return -EOPNOTSUPP;
1099 }
1100 /* Not reached */
1101 return -EINVAL;
1102 }
1103
1104 /********************** RTNETLINK REQUEST API **********************/
1105 /*
1106 * The alternate user space API to configure all those Wireless Extensions
1107 * is through RtNetlink.
1108 * This API support only the new driver API (iw_handler).
1109 *
1110 * This RtNetlink API use the same query/reply model as the ioctl API.
1111 * Maximum effort has been done to fit in the RtNetlink model, and
1112 * we support both RtNetlink Set and RtNelink Get operations.
1113 * On the other hand, we don't offer Dump operations because of the
1114 * following reasons :
1115 * o Large number of parameters, most optional
1116 * o Large size of some parameters (> 100 bytes)
1117 * o Each parameters need to be extracted from hardware
1118 * o Scan requests can take seconds and disable network activity.
1119 * Because of this high cost/overhead, we want to return only the
1120 * parameters the user application is really interested in.
1121 * We could offer partial Dump using the IW_DESCR_FLAG_DUMP flag.
1122 *
1123 * The API uses the standard RtNetlink socket. When the RtNetlink code
1124 * find a IFLA_WIRELESS field in a RtNetlink SET_LINK request,
1125 * it calls here.
1126 */
1127
1128 #ifdef CONFIG_NET_WIRELESS_RTNETLINK
1129 /* ---------------------------------------------------------------- */
1130 /*
1131 * Wrapper to call a standard Wireless Extension GET handler.
1132 * We do various checks and call the handler with the proper args.
1133 */
1134 static int rtnetlink_standard_get(struct net_device * dev,
1135 struct iw_event * request,
1136 int request_len,
1137 iw_handler handler,
1138 char ** p_buf,
1139 int * p_len)
1140 {
1141 const struct iw_ioctl_description * descr = NULL;
1142 unsigned int cmd;
1143 union iwreq_data * wrqu;
1144 int hdr_len;
1145 struct iw_request_info info;
1146 char * buffer = NULL;
1147 int buffer_size = 0;
1148 int ret = -EINVAL;
1149
1150 /* Get the description of the Request */
1151 cmd = request->cmd;
1152 if((cmd - SIOCIWFIRST) >= standard_ioctl_num)
1153 return -EOPNOTSUPP;
1154 descr = &(standard_ioctl[cmd - SIOCIWFIRST]);
1155
1156 #ifdef WE_RTNETLINK_DEBUG
1157 printk(KERN_DEBUG "%s (WE.r) : Found standard handler for 0x%04X\n",
1158 dev->name, cmd);
1159 printk(KERN_DEBUG "%s (WE.r) : Header type : %d, Token type : %d, size : %d, token : %d\n", dev->name, descr->header_type, descr->token_type, descr->token_size, descr->max_tokens);
1160 #endif /* WE_RTNETLINK_DEBUG */
1161
1162 /* Check if wrqu is complete */
1163 hdr_len = event_type_size[descr->header_type];
1164 if(request_len < hdr_len) {
1165 #ifdef WE_RTNETLINK_DEBUG
1166 printk(KERN_DEBUG
1167 "%s (WE.r) : Wireless request too short (%d)\n",
1168 dev->name, request_len);
1169 #endif /* WE_RTNETLINK_DEBUG */
1170 return -EINVAL;
1171 }
1172
1173 /* Prepare the call */
1174 info.cmd = cmd;
1175 info.flags = 0;
1176
1177 /* Check if we have extra data in the reply or not */
1178 if(descr->header_type != IW_HEADER_TYPE_POINT) {
1179
1180 /* Create the kernel buffer that we will return.
1181 * It's at an offset to match the TYPE_POINT case... */
1182 buffer_size = request_len + IW_EV_POINT_OFF;
1183 buffer = kmalloc(buffer_size, GFP_KERNEL);
1184 if (buffer == NULL) {
1185 return -ENOMEM;
1186 }
1187 /* Copy event data */
1188 memcpy(buffer + IW_EV_POINT_OFF, request, request_len);
1189 /* Use our own copy of wrqu */
1190 wrqu = (union iwreq_data *) (buffer + IW_EV_POINT_OFF
1191 + IW_EV_LCP_LEN);
1192
1193 /* No extra arguments. Trivial to handle */
1194 ret = handler(dev, &info, wrqu, NULL);
1195
1196 } else {
1197 union iwreq_data wrqu_point;
1198 char * extra = NULL;
1199 int extra_size = 0;
1200
1201 /* Get a temp copy of wrqu (skip pointer) */
1202 memcpy(((char *) &wrqu_point) + IW_EV_POINT_OFF,
1203 ((char *) request) + IW_EV_LCP_LEN,
1204 IW_EV_POINT_LEN - IW_EV_LCP_LEN);
1205
1206 /* Calculate space needed by arguments. Always allocate
1207 * for max space. Easier, and won't last long... */
1208 extra_size = descr->max_tokens * descr->token_size;
1209 /* Support for very large requests */
1210 if((descr->flags & IW_DESCR_FLAG_NOMAX) &&
1211 (wrqu_point.data.length > descr->max_tokens))
1212 extra_size = (wrqu_point.data.length
1213 * descr->token_size);
1214 buffer_size = extra_size + IW_EV_POINT_LEN + IW_EV_POINT_OFF;
1215 #ifdef WE_RTNETLINK_DEBUG
1216 printk(KERN_DEBUG "%s (WE.r) : Malloc %d bytes (%d bytes)\n",
1217 dev->name, extra_size, buffer_size);
1218 #endif /* WE_RTNETLINK_DEBUG */
1219
1220 /* Create the kernel buffer that we will return */
1221 buffer = kmalloc(buffer_size, GFP_KERNEL);
1222 if (buffer == NULL) {
1223 return -ENOMEM;
1224 }
1225
1226 /* Put wrqu in the right place (just before extra).
1227 * Leave space for IWE header and dummy pointer...
1228 * Note that IW_EV_LCP_LEN==4 bytes, so it's still aligned...
1229 */
1230 memcpy(buffer + IW_EV_LCP_LEN + IW_EV_POINT_OFF,
1231 ((char *) &wrqu_point) + IW_EV_POINT_OFF,
1232 IW_EV_POINT_LEN - IW_EV_LCP_LEN);
1233 wrqu = (union iwreq_data *) (buffer + IW_EV_LCP_LEN);
1234
1235 /* Extra comes logically after that. Offset +12 bytes. */
1236 extra = buffer + IW_EV_POINT_OFF + IW_EV_POINT_LEN;
1237
1238 /* Call the handler */
1239 ret = handler(dev, &info, wrqu, extra);
1240
1241 /* Calculate real returned length */
1242 extra_size = (wrqu->data.length * descr->token_size);
1243 /* Re-adjust reply size */
1244 request->len = extra_size + IW_EV_POINT_LEN;
1245
1246 /* Put the iwe header where it should, i.e. scrap the
1247 * dummy pointer. */
1248 memcpy(buffer + IW_EV_POINT_OFF, request, IW_EV_LCP_LEN);
1249
1250 #ifdef WE_RTNETLINK_DEBUG
1251 printk(KERN_DEBUG "%s (WE.r) : Reply 0x%04X, hdr_len %d, tokens %d, extra_size %d, buffer_size %d\n", dev->name, cmd, hdr_len, wrqu->data.length, extra_size, buffer_size);
1252 #endif /* WE_RTNETLINK_DEBUG */
1253
1254 /* Check if there is enough buffer up there */
1255 if(wrqu_point.data.length < wrqu->data.length)
1256 ret = -E2BIG;
1257 }
1258
1259 /* Return the buffer to the caller */
1260 if (!ret) {
1261 *p_buf = buffer;
1262 *p_len = request->len;
1263 } else {
1264 /* Cleanup */
1265 if(buffer)
1266 kfree(buffer);
1267 }
1268
1269 return ret;
1270 }
1271
1272 /* ---------------------------------------------------------------- */
1273 /*
1274 * Wrapper to call a standard Wireless Extension SET handler.
1275 * We do various checks and call the handler with the proper args.
1276 */
1277 static inline int rtnetlink_standard_set(struct net_device * dev,
1278 struct iw_event * request,
1279 int request_len,
1280 iw_handler handler)
1281 {
1282 const struct iw_ioctl_description * descr = NULL;
1283 unsigned int cmd;
1284 union iwreq_data * wrqu;
1285 union iwreq_data wrqu_point;
1286 int hdr_len;
1287 char * extra = NULL;
1288 int extra_size = 0;
1289 struct iw_request_info info;
1290 int ret = -EINVAL;
1291
1292 /* Get the description of the Request */
1293 cmd = request->cmd;
1294 if((cmd - SIOCIWFIRST) >= standard_ioctl_num)
1295 return -EOPNOTSUPP;
1296 descr = &(standard_ioctl[cmd - SIOCIWFIRST]);
1297
1298 #ifdef WE_RTNETLINK_DEBUG
1299 printk(KERN_DEBUG "%s (WE.r) : Found standard SET handler for 0x%04X\n",
1300 dev->name, cmd);
1301 printk(KERN_DEBUG "%s (WE.r) : Header type : %d, Token type : %d, size : %d, token : %d\n", dev->name, descr->header_type, descr->token_type, descr->token_size, descr->max_tokens);
1302 #endif /* WE_RTNETLINK_DEBUG */
1303
1304 /* Extract fixed header from request. This is properly aligned. */
1305 wrqu = &request->u;
1306
1307 /* Check if wrqu is complete */
1308 hdr_len = event_type_size[descr->header_type];
1309 if(request_len < hdr_len) {
1310 #ifdef WE_RTNETLINK_DEBUG
1311 printk(KERN_DEBUG
1312 "%s (WE.r) : Wireless request too short (%d)\n",
1313 dev->name, request_len);
1314 #endif /* WE_RTNETLINK_DEBUG */
1315 return -EINVAL;
1316 }
1317
1318 /* Prepare the call */
1319 info.cmd = cmd;
1320 info.flags = 0;
1321
1322 /* Check if we have extra data in the request or not */
1323 if(descr->header_type != IW_HEADER_TYPE_POINT) {
1324
1325 /* No extra arguments. Trivial to handle */
1326 ret = handler(dev, &info, wrqu, NULL);
1327
1328 } else {
1329 int extra_len;
1330
1331 /* Put wrqu in the right place (skip pointer) */
1332 memcpy(((char *) &wrqu_point) + IW_EV_POINT_OFF,
1333 wrqu, IW_EV_POINT_LEN - IW_EV_LCP_LEN);
1334 /* Don't forget about the event code... */
1335 wrqu = &wrqu_point;
1336
1337 /* Check if number of token fits within bounds */
1338 if(wrqu_point.data.length > descr->max_tokens)
1339 return -E2BIG;
1340 if(wrqu_point.data.length < descr->min_tokens)
1341 return -EINVAL;
1342
1343 /* Real length of payload */
1344 extra_len = wrqu_point.data.length * descr->token_size;
1345
1346 /* Check if request is self consistent */
1347 if((request_len - hdr_len) < extra_len) {
1348 #ifdef WE_RTNETLINK_DEBUG
1349 printk(KERN_DEBUG "%s (WE.r) : Wireless request data too short (%d)\n",
1350 dev->name, extra_size);
1351 #endif /* WE_RTNETLINK_DEBUG */
1352 return -EINVAL;
1353 }
1354
1355 #ifdef WE_RTNETLINK_DEBUG
1356 printk(KERN_DEBUG "%s (WE.r) : Malloc %d bytes\n",
1357 dev->name, extra_size);
1358 #endif /* WE_RTNETLINK_DEBUG */
1359
1360 /* Always allocate for max space. Easier, and won't last
1361 * long... */
1362 extra_size = descr->max_tokens * descr->token_size;
1363 extra = kmalloc(extra_size, GFP_KERNEL);
1364 if (extra == NULL)
1365 return -ENOMEM;
1366
1367 /* Copy extra in aligned buffer */
1368 memcpy(extra, ((char *) request) + hdr_len, extra_len);
1369
1370 /* Call the handler */
1371 ret = handler(dev, &info, &wrqu_point, extra);
1372 }
1373
1374 #ifdef WE_SET_EVENT
1375 /* Generate an event to notify listeners of the change */
1376 if((descr->flags & IW_DESCR_FLAG_EVENT) &&
1377 ((ret == 0) || (ret == -EIWCOMMIT))) {
1378 if(descr->flags & IW_DESCR_FLAG_RESTRICT)
1379 /* If the event is restricted, don't
1380 * export the payload */
1381 wireless_send_event(dev, cmd, wrqu, NULL);
1382 else
1383 wireless_send_event(dev, cmd, wrqu, extra);
1384 }
1385 #endif /* WE_SET_EVENT */
1386
1387 /* Cleanup - I told you it wasn't that long ;-) */
1388 if(extra)
1389 kfree(extra);
1390
1391 /* Call commit handler if needed and defined */
1392 if(ret == -EIWCOMMIT)
1393 ret = call_commit_handler(dev);
1394
1395 return ret;
1396 }
1397
1398 /* ---------------------------------------------------------------- */
1399 /*
1400 * Wrapper to call a private Wireless Extension GET handler.
1401 * Same as above...
1402 * It's not as nice and slimline as the standard wrapper. The cause
1403 * is struct iw_priv_args, which was not really designed for the
1404 * job we are going here.
1405 *
1406 * IMPORTANT : This function prevent to set and get data on the same
1407 * IOCTL and enforce the SET/GET convention. Not doing it would be
1408 * far too hairy...
1409 * If you need to set and get data at the same time, please don't use
1410 * a iw_handler but process it in your ioctl handler (i.e. use the
1411 * old driver API).
1412 */
1413 static inline int rtnetlink_private_get(struct net_device * dev,
1414 struct iw_event * request,
1415 int request_len,
1416 iw_handler handler,
1417 char ** p_buf,
1418 int * p_len)
1419 {
1420 const struct iw_priv_args * descr = NULL;
1421 unsigned int cmd;
1422 union iwreq_data * wrqu;
1423 int hdr_len;
1424 struct iw_request_info info;
1425 int extra_size = 0;
1426 int i;
1427 char * buffer = NULL;
1428 int buffer_size = 0;
1429 int ret = -EINVAL;
1430
1431 /* Get the description of the Request */
1432 cmd = request->cmd;
1433 for(i = 0; i < dev->wireless_handlers->num_private_args; i++)
1434 if(cmd == dev->wireless_handlers->private_args[i].cmd) {
1435 descr = &(dev->wireless_handlers->private_args[i]);
1436 break;
1437 }
1438 if(descr == NULL)
1439 return -EOPNOTSUPP;
1440
1441 #ifdef WE_RTNETLINK_DEBUG
1442 printk(KERN_DEBUG "%s (WE.r) : Found private handler for 0x%04X\n",
1443 dev->name, cmd);
1444 printk(KERN_DEBUG "%s (WE.r) : Name %s, set %X, get %X\n",
1445 dev->name, descr->name, descr->set_args, descr->get_args);
1446 #endif /* WE_RTNETLINK_DEBUG */
1447
1448 /* Compute the max size of the get arguments */
1449 extra_size = get_priv_size(descr->get_args);
1450
1451 /* Does it fits in wrqu ? */
1452 if((descr->get_args & IW_PRIV_SIZE_FIXED) &&
1453 (extra_size <= IFNAMSIZ)) {
1454 hdr_len = extra_size;
1455 extra_size = 0;
1456 } else {
1457 hdr_len = IW_EV_POINT_LEN;
1458 }
1459
1460 /* Check if wrqu is complete */
1461 if(request_len < hdr_len) {
1462 #ifdef WE_RTNETLINK_DEBUG
1463 printk(KERN_DEBUG
1464 "%s (WE.r) : Wireless request too short (%d)\n",
1465 dev->name, request_len);
1466 #endif /* WE_RTNETLINK_DEBUG */
1467 return -EINVAL;
1468 }
1469
1470 /* Prepare the call */
1471 info.cmd = cmd;
1472 info.flags = 0;
1473
1474 /* Check if we have a pointer to user space data or not. */
1475 if(extra_size == 0) {
1476
1477 /* Create the kernel buffer that we will return.
1478 * It's at an offset to match the TYPE_POINT case... */
1479 buffer_size = request_len + IW_EV_POINT_OFF;
1480 buffer = kmalloc(buffer_size, GFP_KERNEL);
1481 if (buffer == NULL) {
1482 return -ENOMEM;
1483 }
1484 /* Copy event data */
1485 memcpy(buffer + IW_EV_POINT_OFF, request, request_len);
1486 /* Use our own copy of wrqu */
1487 wrqu = (union iwreq_data *) (buffer + IW_EV_POINT_OFF
1488 + IW_EV_LCP_LEN);
1489
1490 /* No extra arguments. Trivial to handle */
1491 ret = handler(dev, &info, wrqu, (char *) wrqu);
1492
1493 } else {
1494 char * extra;
1495
1496 /* Buffer for full reply */
1497 buffer_size = extra_size + IW_EV_POINT_LEN + IW_EV_POINT_OFF;
1498
1499 #ifdef WE_RTNETLINK_DEBUG
1500 printk(KERN_DEBUG "%s (WE.r) : Malloc %d bytes (%d bytes)\n",
1501 dev->name, extra_size, buffer_size);
1502 #endif /* WE_RTNETLINK_DEBUG */
1503
1504 /* Create the kernel buffer that we will return */
1505 buffer = kmalloc(buffer_size, GFP_KERNEL);
1506 if (buffer == NULL) {
1507 return -ENOMEM;
1508 }
1509
1510 /* Put wrqu in the right place (just before extra).
1511 * Leave space for IWE header and dummy pointer...
1512 * Note that IW_EV_LCP_LEN==4 bytes, so it's still aligned...
1513 */
1514 memcpy(buffer + IW_EV_LCP_LEN + IW_EV_POINT_OFF,
1515 ((char *) request) + IW_EV_LCP_LEN,
1516 IW_EV_POINT_LEN - IW_EV_LCP_LEN);
1517 wrqu = (union iwreq_data *) (buffer + IW_EV_LCP_LEN);
1518
1519 /* Extra comes logically after that. Offset +12 bytes. */
1520 extra = buffer + IW_EV_POINT_OFF + IW_EV_POINT_LEN;
1521
1522 /* Call the handler */
1523 ret = handler(dev, &info, wrqu, extra);
1524
1525 /* Adjust for the actual length if it's variable,
1526 * avoid leaking kernel bits outside. */
1527 if (!(descr->get_args & IW_PRIV_SIZE_FIXED))
1528 extra_size = adjust_priv_size(descr->get_args, wrqu);
1529 /* Re-adjust reply size */
1530 request->len = extra_size + IW_EV_POINT_LEN;
1531
1532 /* Put the iwe header where it should, i.e. scrap the
1533 * dummy pointer. */
1534 memcpy(buffer + IW_EV_POINT_OFF, request, IW_EV_LCP_LEN);
1535
1536 #ifdef WE_RTNETLINK_DEBUG
1537 printk(KERN_DEBUG "%s (WE.r) : Reply 0x%04X, hdr_len %d, tokens %d, extra_size %d, buffer_size %d\n", dev->name, cmd, hdr_len, wrqu->data.length, extra_size, buffer_size);
1538 #endif /* WE_RTNETLINK_DEBUG */
1539 }
1540
1541 /* Return the buffer to the caller */
1542 if (!ret) {
1543 *p_buf = buffer;
1544 *p_len = request->len;
1545 } else {
1546 /* Cleanup */
1547 if(buffer)
1548 kfree(buffer);
1549 }
1550
1551 return ret;
1552 }
1553
1554 /* ---------------------------------------------------------------- */
1555 /*
1556 * Wrapper to call a private Wireless Extension SET handler.
1557 * Same as above...
1558 * It's not as nice and slimline as the standard wrapper. The cause
1559 * is struct iw_priv_args, which was not really designed for the
1560 * job we are going here.
1561 *
1562 * IMPORTANT : This function prevent to set and get data on the same
1563 * IOCTL and enforce the SET/GET convention. Not doing it would be
1564 * far too hairy...
1565 * If you need to set and get data at the same time, please don't use
1566 * a iw_handler but process it in your ioctl handler (i.e. use the
1567 * old driver API).
1568 */
1569 static inline int rtnetlink_private_set(struct net_device * dev,
1570 struct iw_event * request,
1571 int request_len,
1572 iw_handler handler)
1573 {
1574 const struct iw_priv_args * descr = NULL;
1575 unsigned int cmd;
1576 union iwreq_data * wrqu;
1577 union iwreq_data wrqu_point;
1578 int hdr_len;
1579 char * extra = NULL;
1580 int extra_size = 0;
1581 int offset = 0; /* For sub-ioctls */
1582 struct iw_request_info info;
1583 int i;
1584 int ret = -EINVAL;
1585
1586 /* Get the description of the Request */
1587 cmd = request->cmd;
1588 for(i = 0; i < dev->wireless_handlers->num_private_args; i++)
1589 if(cmd == dev->wireless_handlers->private_args[i].cmd) {
1590 descr = &(dev->wireless_handlers->private_args[i]);
1591 break;
1592 }
1593 if(descr == NULL)
1594 return -EOPNOTSUPP;
1595
1596 #ifdef WE_RTNETLINK_DEBUG
1597 printk(KERN_DEBUG "%s (WE.r) : Found private handler for 0x%04X\n",
1598 ifr->ifr_name, cmd);
1599 printk(KERN_DEBUG "%s (WE.r) : Name %s, set %X, get %X\n",
1600 dev->name, descr->name, descr->set_args, descr->get_args);
1601 #endif /* WE_RTNETLINK_DEBUG */
1602
1603 /* Compute the size of the set arguments */
1604 /* Check for sub-ioctl handler */
1605 if(descr->name[0] == '\0')
1606 /* Reserve one int for sub-ioctl index */
1607 offset = sizeof(__u32);
1608
1609 /* Size of set arguments */
1610 extra_size = get_priv_size(descr->set_args);
1611
1612 /* Does it fits in wrqu ? */
1613 if((descr->set_args & IW_PRIV_SIZE_FIXED) &&
1614 (extra_size <= IFNAMSIZ)) {
1615 hdr_len = IW_EV_LCP_LEN + extra_size;
1616 extra_size = 0;
1617 } else {
1618 hdr_len = IW_EV_POINT_LEN;
1619 }
1620
1621 /* Extract fixed header from request. This is properly aligned. */
1622 wrqu = &request->u;
1623
1624 /* Check if wrqu is complete */
1625 if(request_len < hdr_len) {
1626 #ifdef WE_RTNETLINK_DEBUG
1627 printk(KERN_DEBUG
1628 "%s (WE.r) : Wireless request too short (%d)\n",
1629 dev->name, request_len);
1630 #endif /* WE_RTNETLINK_DEBUG */
1631 return -EINVAL;
1632 }
1633
1634 /* Prepare the call */
1635 info.cmd = cmd;
1636 info.flags = 0;
1637
1638 /* Check if we have a pointer to user space data or not. */
1639 if(extra_size == 0) {
1640
1641 /* No extra arguments. Trivial to handle */
1642 ret = handler(dev, &info, wrqu, (char *) wrqu);
1643
1644 } else {
1645 int extra_len;
1646
1647 /* Put wrqu in the right place (skip pointer) */
1648 memcpy(((char *) &wrqu_point) + IW_EV_POINT_OFF,
1649 wrqu, IW_EV_POINT_LEN - IW_EV_LCP_LEN);
1650
1651 /* Does it fits within bounds ? */
1652 if(wrqu_point.data.length > (descr->set_args &
1653 IW_PRIV_SIZE_MASK))
1654 return -E2BIG;
1655
1656 /* Real length of payload */
1657 extra_len = adjust_priv_size(descr->set_args, &wrqu_point);
1658
1659 /* Check if request is self consistent */
1660 if((request_len - hdr_len) < extra_len) {
1661 #ifdef WE_RTNETLINK_DEBUG
1662 printk(KERN_DEBUG "%s (WE.r) : Wireless request data too short (%d)\n",
1663 dev->name, extra_size);
1664 #endif /* WE_RTNETLINK_DEBUG */
1665 return -EINVAL;
1666 }
1667
1668 #ifdef WE_RTNETLINK_DEBUG
1669 printk(KERN_DEBUG "%s (WE.r) : Malloc %d bytes\n",
1670 dev->name, extra_size);
1671 #endif /* WE_RTNETLINK_DEBUG */
1672
1673 /* Always allocate for max space. Easier, and won't last
1674 * long... */
1675 extra = kmalloc(extra_size, GFP_KERNEL);
1676 if (extra == NULL)
1677 return -ENOMEM;
1678
1679 /* Copy extra in aligned buffer */
1680 memcpy(extra, ((char *) request) + hdr_len, extra_len);
1681
1682 /* Call the handler */
1683 ret = handler(dev, &info, &wrqu_point, extra);
1684
1685 /* Cleanup - I told you it wasn't that long ;-) */
1686 kfree(extra);
1687 }
1688
1689 /* Call commit handler if needed and defined */
1690 if(ret == -EIWCOMMIT)
1691 ret = call_commit_handler(dev);
1692
1693 return ret;
1694 }
1695
1696 /* ---------------------------------------------------------------- */
1697 /*
1698 * Main RtNetlink dispatcher. Called from the main networking code
1699 * (do_getlink() in net/core/rtnetlink.c).
1700 * Check the type of Request and call the appropriate wrapper...
1701 */
1702 int wireless_rtnetlink_get(struct net_device * dev,
1703 char * data,
1704 int len,
1705 char ** p_buf,
1706 int * p_len)
1707 {
1708 struct iw_event * request = (struct iw_event *) data;
1709 iw_handler handler;
1710
1711 /* Check length */
1712 if(len < IW_EV_LCP_LEN) {
1713 printk(KERN_DEBUG "%s (WE.r) : RtNetlink request too short (%d)\n",
1714 dev->name, len);
1715 return -EINVAL;
1716 }
1717
1718 /* ReCheck length (len may have padding) */
1719 if(request->len > len) {
1720 printk(KERN_DEBUG "%s (WE.r) : RtNetlink request len invalid (%d-%d)\n",
1721 dev->name, request->len, len);
1722 return -EINVAL;
1723 }
1724
1725 /* Only accept GET requests in here */
1726 if(!IW_IS_GET(request->cmd))
1727 return -EOPNOTSUPP;
1728
1729 /* If command is `get the encoding parameters', check if
1730 * the user has the right to do it */
1731 if (request->cmd == SIOCGIWENCODE ||
1732 request->cmd == SIOCGIWENCODEEXT) {
1733 if (!capable(CAP_NET_ADMIN))
1734 return -EPERM;
1735 }
1736
1737 /* Special cases */
1738 if(request->cmd == SIOCGIWSTATS)
1739 /* Get Wireless Stats */
1740 return rtnetlink_standard_get(dev,
1741 request,
1742 request->len,
1743 &iw_handler_get_iwstats,
1744 p_buf, p_len);
1745 if(request->cmd == SIOCGIWPRIV) {
1746 /* Check if we have some wireless handlers defined */
1747 if(dev->wireless_handlers == NULL)
1748 return -EOPNOTSUPP;
1749 /* Get Wireless Stats */
1750 return rtnetlink_standard_get(dev,
1751 request,
1752 request->len,
1753 &iw_handler_get_private,
1754 p_buf, p_len);
1755 }
1756
1757 /* Basic check */
1758 if (!netif_device_present(dev))
1759 return -ENODEV;
1760
1761 /* Try to find the handler */
1762 handler = get_handler(dev, request->cmd);
1763 if(handler != NULL) {
1764 /* Standard and private are not the same */
1765 if(request->cmd < SIOCIWFIRSTPRIV)
1766 return rtnetlink_standard_get(dev,
1767 request,
1768 request->len,
1769 handler,
1770 p_buf, p_len);
1771 else
1772 return rtnetlink_private_get(dev,
1773 request,
1774 request->len,
1775 handler,
1776 p_buf, p_len);
1777 }
1778
1779 return -EOPNOTSUPP;
1780 }
1781
1782 /* ---------------------------------------------------------------- */
1783 /*
1784 * Main RtNetlink dispatcher. Called from the main networking code
1785 * (do_setlink() in net/core/rtnetlink.c).
1786 * Check the type of Request and call the appropriate wrapper...
1787 */
1788 int wireless_rtnetlink_set(struct net_device * dev,
1789 char * data,
1790 int len)
1791 {
1792 struct iw_event * request = (struct iw_event *) data;
1793 iw_handler handler;
1794
1795 /* Check length */
1796 if(len < IW_EV_LCP_LEN) {
1797 printk(KERN_DEBUG "%s (WE.r) : RtNetlink request too short (%d)\n",
1798 dev->name, len);
1799 return -EINVAL;
1800 }
1801
1802 /* ReCheck length (len may have padding) */
1803 if(request->len > len) {
1804 printk(KERN_DEBUG "%s (WE.r) : RtNetlink request len invalid (%d-%d)\n",
1805 dev->name, request->len, len);
1806 return -EINVAL;
1807 }
1808
1809 /* Only accept SET requests in here */
1810 if(!IW_IS_SET(request->cmd))
1811 return -EOPNOTSUPP;
1812
1813 /* Basic check */
1814 if (!netif_device_present(dev))
1815 return -ENODEV;
1816
1817 /* New driver API : try to find the handler */
1818 handler = get_handler(dev, request->cmd);
1819 if(handler != NULL) {
1820 /* Standard and private are not the same */
1821 if(request->cmd < SIOCIWFIRSTPRIV)
1822 return rtnetlink_standard_set(dev,
1823 request,
1824 request->len,
1825 handler);
1826 else
1827 return rtnetlink_private_set(dev,
1828 request,
1829 request->len,
1830 handler);
1831 }
1832
1833 return -EOPNOTSUPP;
1834 }
1835 #endif /* CONFIG_NET_WIRELESS_RTNETLINK */
1836
1837
1838 /************************* EVENT PROCESSING *************************/
1839 /*
1840 * Process events generated by the wireless layer or the driver.
1841 * Most often, the event will be propagated through rtnetlink
1842 */
1843
1844 #ifdef WE_EVENT_RTNETLINK
1845 /* ---------------------------------------------------------------- */
1846 /*
1847 * Fill a rtnetlink message with our event data.
1848 * Note that we propage only the specified event and don't dump the
1849 * current wireless config. Dumping the wireless config is far too
1850 * expensive (for each parameter, the driver need to query the hardware).
1851 */
1852 static inline int rtnetlink_fill_iwinfo(struct sk_buff * skb,
1853 struct net_device * dev,
1854 int type,
1855 char * event,
1856 int event_len)
1857 {
1858 struct ifinfomsg *r;
1859 struct nlmsghdr *nlh;
1860 unsigned char *b = skb->tail;
1861
1862 nlh = NLMSG_PUT(skb, 0, 0, type, sizeof(*r));
1863 r = NLMSG_DATA(nlh);
1864 r->ifi_family = AF_UNSPEC;
1865 r->__ifi_pad = 0;
1866 r->ifi_type = dev->type;
1867 r->ifi_index = dev->ifindex;
1868 r->ifi_flags = dev_get_flags(dev);
1869 r->ifi_change = 0; /* Wireless changes don't affect those flags */
1870
1871 /* Add the wireless events in the netlink packet */
1872 RTA_PUT(skb, IFLA_WIRELESS, event_len, event);
1873
1874 nlh->nlmsg_len = skb->tail - b;
1875 return skb->len;
1876
1877 nlmsg_failure:
1878 rtattr_failure:
1879 skb_trim(skb, b - skb->data);
1880 return -1;
1881 }
1882
1883 /* ---------------------------------------------------------------- */
1884 /*
1885 * Create and broadcast and send it on the standard rtnetlink socket
1886 * This is a pure clone rtmsg_ifinfo() in net/core/rtnetlink.c
1887 * Andrzej Krzysztofowicz mandated that I used a IFLA_XXX field
1888 * within a RTM_NEWLINK event.
1889 */
1890 static inline void rtmsg_iwinfo(struct net_device * dev,
1891 char * event,
1892 int event_len)
1893 {
1894 struct sk_buff *skb;
1895 int size = NLMSG_GOODSIZE;
1896
1897 skb = alloc_skb(size, GFP_ATOMIC);
1898 if (!skb)
1899 return;
1900
1901 if (rtnetlink_fill_iwinfo(skb, dev, RTM_NEWLINK,
1902 event, event_len) < 0) {
1903 kfree_skb(skb);
1904 return;
1905 }
1906 NETLINK_CB(skb).dst_group = RTNLGRP_LINK;
1907 netlink_broadcast(rtnl, skb, 0, RTNLGRP_LINK, GFP_ATOMIC);
1908 }
1909 #endif /* WE_EVENT_RTNETLINK */
1910
1911 /* ---------------------------------------------------------------- */
1912 /*
1913 * Main event dispatcher. Called from other parts and drivers.
1914 * Send the event on the appropriate channels.
1915 * May be called from interrupt context.
1916 */
1917 void wireless_send_event(struct net_device * dev,
1918 unsigned int cmd,
1919 union iwreq_data * wrqu,
1920 char * extra)
1921 {
1922 const struct iw_ioctl_description * descr = NULL;
1923 int extra_len = 0;
1924 struct iw_event *event; /* Mallocated whole event */
1925 int event_len; /* Its size */
1926 int hdr_len; /* Size of the event header */
1927 int wrqu_off = 0; /* Offset in wrqu */
1928 /* Don't "optimise" the following variable, it will crash */
1929 unsigned cmd_index; /* *MUST* be unsigned */
1930
1931 /* Get the description of the Event */
1932 if(cmd <= SIOCIWLAST) {
1933 cmd_index = cmd - SIOCIWFIRST;
1934 if(cmd_index < standard_ioctl_num)
1935 descr = &(standard_ioctl[cmd_index]);
1936 } else {
1937 cmd_index = cmd - IWEVFIRST;
1938 if(cmd_index < standard_event_num)
1939 descr = &(standard_event[cmd_index]);
1940 }
1941 /* Don't accept unknown events */
1942 if(descr == NULL) {
1943 /* Note : we don't return an error to the driver, because
1944 * the driver would not know what to do about it. It can't
1945 * return an error to the user, because the event is not
1946 * initiated by a user request.
1947 * The best the driver could do is to log an error message.
1948 * We will do it ourselves instead...
1949 */
1950 printk(KERN_ERR "%s (WE) : Invalid/Unknown Wireless Event (0x%04X)\n",
1951 dev->name, cmd);
1952 return;
1953 }
1954 #ifdef WE_EVENT_DEBUG
1955 printk(KERN_DEBUG "%s (WE) : Got event 0x%04X\n",
1956 dev->name, cmd);
1957 printk(KERN_DEBUG "%s (WE) : Header type : %d, Token type : %d, size : %d, token : %d\n", dev->name, descr->header_type, descr->token_type, descr->token_size, descr->max_tokens);
1958 #endif /* WE_EVENT_DEBUG */
1959
1960 /* Check extra parameters and set extra_len */
1961 if(descr->header_type == IW_HEADER_TYPE_POINT) {
1962 /* Check if number of token fits within bounds */
1963 if(wrqu->data.length > descr->max_tokens) {
1964 printk(KERN_ERR "%s (WE) : Wireless Event too big (%d)\n", dev->name, wrqu->data.length);
1965 return;
1966 }
1967 if(wrqu->data.length < descr->min_tokens) {
1968 printk(KERN_ERR "%s (WE) : Wireless Event too small (%d)\n", dev->name, wrqu->data.length);
1969 return;
1970 }
1971 /* Calculate extra_len - extra is NULL for restricted events */
1972 if(extra != NULL)
1973 extra_len = wrqu->data.length * descr->token_size;
1974 /* Always at an offset in wrqu */
1975 wrqu_off = IW_EV_POINT_OFF;
1976 #ifdef WE_EVENT_DEBUG
1977 printk(KERN_DEBUG "%s (WE) : Event 0x%04X, tokens %d, extra_len %d\n", dev->name, cmd, wrqu->data.length, extra_len);
1978 #endif /* WE_EVENT_DEBUG */
1979 }
1980
1981 /* Total length of the event */
1982 hdr_len = event_type_size[descr->header_type];
1983 event_len = hdr_len + extra_len;
1984
1985 #ifdef WE_EVENT_DEBUG
1986 printk(KERN_DEBUG "%s (WE) : Event 0x%04X, hdr_len %d, wrqu_off %d, event_len %d\n", dev->name, cmd, hdr_len, wrqu_off, event_len);
1987 #endif /* WE_EVENT_DEBUG */
1988
1989 /* Create temporary buffer to hold the event */
1990 event = kmalloc(event_len, GFP_ATOMIC);
1991 if(event == NULL)
1992 return;
1993
1994 /* Fill event */
1995 event->len = event_len;
1996 event->cmd = cmd;
1997 memcpy(&event->u, ((char *) wrqu) + wrqu_off, hdr_len - IW_EV_LCP_LEN);
1998 if(extra != NULL)
1999 memcpy(((char *) event) + hdr_len, extra, extra_len);
2000
2001 #ifdef WE_EVENT_RTNETLINK
2002 /* Send via the RtNetlink event channel */
2003 rtmsg_iwinfo(dev, (char *) event, event_len);
2004 #endif /* WE_EVENT_RTNETLINK */
2005
2006 /* Cleanup */
2007 kfree(event);
2008
2009 return; /* Always success, I guess ;-) */
2010 }
2011
2012 /********************** ENHANCED IWSPY SUPPORT **********************/
2013 /*
2014 * In the old days, the driver was handling spy support all by itself.
2015 * Now, the driver can delegate this task to Wireless Extensions.
2016 * It needs to use those standard spy iw_handler in struct iw_handler_def,
2017 * push data to us via wireless_spy_update() and include struct iw_spy_data
2018 * in its private part (and export it in net_device->wireless_data->spy_data).
2019 * One of the main advantage of centralising spy support here is that
2020 * it becomes much easier to improve and extend it without having to touch
2021 * the drivers. One example is the addition of the Spy-Threshold events.
2022 */
2023
2024 /* ---------------------------------------------------------------- */
2025 /*
2026 * Return the pointer to the spy data in the driver.
2027 * Because this is called on the Rx path via wireless_spy_update(),
2028 * we want it to be efficient...
2029 */
2030 static inline struct iw_spy_data * get_spydata(struct net_device *dev)
2031 {
2032 /* This is the new way */
2033 if(dev->wireless_data)
2034 return(dev->wireless_data->spy_data);
2035 return NULL;
2036 }
2037
2038 /*------------------------------------------------------------------*/
2039 /*
2040 * Standard Wireless Handler : set Spy List
2041 */
2042 int iw_handler_set_spy(struct net_device * dev,
2043 struct iw_request_info * info,
2044 union iwreq_data * wrqu,
2045 char * extra)
2046 {
2047 struct iw_spy_data * spydata = get_spydata(dev);
2048 struct sockaddr * address = (struct sockaddr *) extra;
2049
2050 /* Make sure driver is not buggy or using the old API */
2051 if(!spydata)
2052 return -EOPNOTSUPP;
2053
2054 /* Disable spy collection while we copy the addresses.
2055 * While we copy addresses, any call to wireless_spy_update()
2056 * will NOP. This is OK, as anyway the addresses are changing. */
2057 spydata->spy_number = 0;
2058
2059 /* We want to operate without locking, because wireless_spy_update()
2060 * most likely will happen in the interrupt handler, and therefore
2061 * have its own locking constraints and needs performance.
2062 * The rtnl_lock() make sure we don't race with the other iw_handlers.
2063 * This make sure wireless_spy_update() "see" that the spy list
2064 * is temporarily disabled. */
2065 wmb();
2066
2067 /* Are there are addresses to copy? */
2068 if(wrqu->data.length > 0) {
2069 int i;
2070
2071 /* Copy addresses */
2072 for(i = 0; i < wrqu->data.length; i++)
2073 memcpy(spydata->spy_address[i], address[i].sa_data,
2074 ETH_ALEN);
2075 /* Reset stats */
2076 memset(spydata->spy_stat, 0,
2077 sizeof(struct iw_quality) * IW_MAX_SPY);
2078
2079 #ifdef WE_SPY_DEBUG
2080 printk(KERN_DEBUG "iw_handler_set_spy() : wireless_data %p, spydata %p, num %d\n", dev->wireless_data, spydata, wrqu->data.length);
2081 for (i = 0; i < wrqu->data.length; i++)
2082 printk(KERN_DEBUG
2083 "%02X:%02X:%02X:%02X:%02X:%02X \n",
2084 spydata->spy_address[i][0],
2085 spydata->spy_address[i][1],
2086 spydata->spy_address[i][2],
2087 spydata->spy_address[i][3],
2088 spydata->spy_address[i][4],
2089 spydata->spy_address[i][5]);
2090 #endif /* WE_SPY_DEBUG */
2091 }
2092
2093 /* Make sure above is updated before re-enabling */
2094 wmb();
2095
2096 /* Enable addresses */
2097 spydata->spy_number = wrqu->data.length;
2098
2099 return 0;
2100 }
2101
2102 /*------------------------------------------------------------------*/
2103 /*
2104 * Standard Wireless Handler : get Spy List
2105 */
2106 int iw_handler_get_spy(struct net_device * dev,
2107 struct iw_request_info * info,
2108 union iwreq_data * wrqu,
2109 char * extra)
2110 {
2111 struct iw_spy_data * spydata = get_spydata(dev);
2112 struct sockaddr * address = (struct sockaddr *) extra;
2113 int i;
2114
2115 /* Make sure driver is not buggy or using the old API */
2116 if(!spydata)
2117 return -EOPNOTSUPP;
2118
2119 wrqu->data.length = spydata->spy_number;
2120
2121 /* Copy addresses. */
2122 for(i = 0; i < spydata->spy_number; i++) {
2123 memcpy(address[i].sa_data, spydata->spy_address[i], ETH_ALEN);
2124 address[i].sa_family = AF_UNIX;
2125 }
2126 /* Copy stats to the user buffer (just after). */
2127 if(spydata->spy_number > 0)
2128 memcpy(extra + (sizeof(struct sockaddr) *spydata->spy_number),
2129 spydata->spy_stat,
2130 sizeof(struct iw_quality) * spydata->spy_number);
2131 /* Reset updated flags. */
2132 for(i = 0; i < spydata->spy_number; i++)
2133 spydata->spy_stat[i].updated &= ~IW_QUAL_ALL_UPDATED;
2134 return 0;
2135 }
2136
2137 /*------------------------------------------------------------------*/
2138 /*
2139 * Standard Wireless Handler : set spy threshold
2140 */
2141 int iw_handler_set_thrspy(struct net_device * dev,
2142 struct iw_request_info *info,
2143 union iwreq_data * wrqu,
2144 char * extra)
2145 {
2146 struct iw_spy_data * spydata = get_spydata(dev);
2147 struct iw_thrspy * threshold = (struct iw_thrspy *) extra;
2148
2149 /* Make sure driver is not buggy or using the old API */
2150 if(!spydata)
2151 return -EOPNOTSUPP;
2152
2153 /* Just do it */
2154 memcpy(&(spydata->spy_thr_low), &(threshold->low),
2155 2 * sizeof(struct iw_quality));
2156
2157 /* Clear flag */
2158 memset(spydata->spy_thr_under, '\0', sizeof(spydata->spy_thr_under));
2159
2160 #ifdef WE_SPY_DEBUG
2161 printk(KERN_DEBUG "iw_handler_set_thrspy() : low %d ; high %d\n", spydata->spy_thr_low.level, spydata->spy_thr_high.level);
2162 #endif /* WE_SPY_DEBUG */
2163
2164 return 0;
2165 }
2166
2167 /*------------------------------------------------------------------*/
2168 /*
2169 * Standard Wireless Handler : get spy threshold
2170 */
2171 int iw_handler_get_thrspy(struct net_device * dev,
2172 struct iw_request_info *info,
2173 union iwreq_data * wrqu,
2174 char * extra)
2175 {
2176 struct iw_spy_data * spydata = get_spydata(dev);
2177 struct iw_thrspy * threshold = (struct iw_thrspy *) extra;
2178
2179 /* Make sure driver is not buggy or using the old API */
2180 if(!spydata)
2181 return -EOPNOTSUPP;
2182
2183 /* Just do it */
2184 memcpy(&(threshold->low), &(spydata->spy_thr_low),
2185 2 * sizeof(struct iw_quality));
2186
2187 return 0;
2188 }
2189
2190 /*------------------------------------------------------------------*/
2191 /*
2192 * Prepare and send a Spy Threshold event
2193 */
2194 static void iw_send_thrspy_event(struct net_device * dev,
2195 struct iw_spy_data * spydata,
2196 unsigned char * address,
2197 struct iw_quality * wstats)
2198 {
2199 union iwreq_data wrqu;
2200 struct iw_thrspy threshold;
2201
2202 /* Init */
2203 wrqu.data.length = 1;
2204 wrqu.data.flags = 0;
2205 /* Copy address */
2206 memcpy(threshold.addr.sa_data, address, ETH_ALEN);
2207 threshold.addr.sa_family = ARPHRD_ETHER;
2208 /* Copy stats */
2209 memcpy(&(threshold.qual), wstats, sizeof(struct iw_quality));
2210 /* Copy also thresholds */
2211 memcpy(&(threshold.low), &(spydata->spy_thr_low),
2212 2 * sizeof(struct iw_quality));
2213
2214 #ifdef WE_SPY_DEBUG
2215 printk(KERN_DEBUG "iw_send_thrspy_event() : address %02X:%02X:%02X:%02X:%02X:%02X, level %d, up = %d\n",
2216 threshold.addr.sa_data[0],
2217 threshold.addr.sa_data[1],
2218 threshold.addr.sa_data[2],
2219 threshold.addr.sa_data[3],
2220 threshold.addr.sa_data[4],
2221 threshold.addr.sa_data[5], threshold.qual.level);
2222 #endif /* WE_SPY_DEBUG */
2223
2224 /* Send event to user space */
2225 wireless_send_event(dev, SIOCGIWTHRSPY, &wrqu, (char *) &threshold);
2226 }
2227
2228 /* ---------------------------------------------------------------- */
2229 /*
2230 * Call for the driver to update the spy data.
2231 * For now, the spy data is a simple array. As the size of the array is
2232 * small, this is good enough. If we wanted to support larger number of
2233 * spy addresses, we should use something more efficient...
2234 */
2235 void wireless_spy_update(struct net_device * dev,
2236 unsigned char * address,
2237 struct iw_quality * wstats)
2238 {
2239 struct iw_spy_data * spydata = get_spydata(dev);
2240 int i;
2241 int match = -1;
2242
2243 /* Make sure driver is not buggy or using the old API */
2244 if(!spydata)
2245 return;
2246
2247 #ifdef WE_SPY_DEBUG
2248 printk(KERN_DEBUG "wireless_spy_update() : wireless_data %p, spydata %p, address %02X:%02X:%02X:%02X:%02X:%02X\n", dev->wireless_data, spydata, address[0], address[1], address[2], address[3], address[4], address[5]);
2249 #endif /* WE_SPY_DEBUG */
2250
2251 /* Update all records that match */
2252 for(i = 0; i < spydata->spy_number; i++)
2253 if(!compare_ether_addr(address, spydata->spy_address[i])) {
2254 memcpy(&(spydata->spy_stat[i]), wstats,
2255 sizeof(struct iw_quality));
2256 match = i;
2257 }
2258
2259 /* Generate an event if we cross the spy threshold.
2260 * To avoid event storms, we have a simple hysteresis : we generate
2261 * event only when we go under the low threshold or above the
2262 * high threshold. */
2263 if(match >= 0) {
2264 if(spydata->spy_thr_under[match]) {
2265 if(wstats->level > spydata->spy_thr_high.level) {
2266 spydata->spy_thr_under[match] = 0;
2267 iw_send_thrspy_event(dev, spydata,
2268 address, wstats);
2269 }
2270 } else {
2271 if(wstats->level < spydata->spy_thr_low.level) {
2272 spydata->spy_thr_under[match] = 1;
2273 iw_send_thrspy_event(dev, spydata,
2274 address, wstats);
2275 }
2276 }
2277 }
2278 }
2279
2280 EXPORT_SYMBOL(iw_handler_get_spy);
2281 EXPORT_SYMBOL(iw_handler_get_thrspy);
2282 EXPORT_SYMBOL(iw_handler_set_spy);
2283 EXPORT_SYMBOL(iw_handler_set_thrspy);
2284 EXPORT_SYMBOL(wireless_send_event);
2285 EXPORT_SYMBOL(wireless_spy_update);
Linux 2.6 libata-dev (mirror)