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