?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
allow coexistance of N build and AC build.
[tomato.git] / release / src-rt-6.x / linux / linux-2.6 / drivers / net / wireless / prism54 / isl_ioctl.c
blob283be4a70524b650920b02e86506d5ffab1940d7
1 /*
2 * Copyright (C) 2002 Intersil Americas Inc.
3 * (C) 2003,2004 Aurelien Alleaume <slts@free.fr>
4 * (C) 2003 Herbert Valerio Riedel <hvr@gnu.org>
5 * (C) 2003 Luis R. Rodriguez <mcgrof@ruslug.rutgers.edu>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 *
20 */
21
22 #include <linux/module.h>
23 #include <linux/kernel.h>
24 #include <linux/if_arp.h>
25 #include <linux/pci.h>
26
27 #include <asm/uaccess.h>
28
29 #include "prismcompat.h"
30 #include "isl_ioctl.h"
31 #include "islpci_mgt.h"
32 #include "isl_oid.h" /* additional types and defs for isl38xx fw */
33 #include "oid_mgt.h"
34
35 #include <net/iw_handler.h> /* New driver API */
36
37 #define KEY_SIZE_WEP104 13 /* 104/128-bit WEP keys */
38 #define KEY_SIZE_WEP40 5 /* 40/64-bit WEP keys */
39 /* KEY_SIZE_TKIP should match isl_oid.h, struct obj_key.key[] size */
40 #define KEY_SIZE_TKIP 32 /* TKIP keys */
41
42 static void prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
43 u8 *wpa_ie, size_t wpa_ie_len);
44 static size_t prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie);
45 static int prism54_set_wpa(struct net_device *, struct iw_request_info *,
46 __u32 *, char *);
47
48 /* In 500 kbps */
49 static const unsigned char scan_rate_list[] = { 2, 4, 11, 22,
50 12, 18, 24, 36,
51 48, 72, 96, 108 };
52
53 /**
54 * prism54_mib_mode_helper - MIB change mode helper function
55 * @mib: the &struct islpci_mib object to modify
56 * @iw_mode: new mode (%IW_MODE_*)
57 *
58 * This is a helper function, hence it does not lock. Make sure
59 * caller deals with locking *if* necessary. This function sets the
60 * mode-dependent mib values and does the mapping of the Linux
61 * Wireless API modes to Device firmware modes. It also checks for
62 * correct valid Linux wireless modes.
63 */
64 static int
65 prism54_mib_mode_helper(islpci_private *priv, u32 iw_mode)
66 {
67 u32 config = INL_CONFIG_MANUALRUN;
68 u32 mode, bsstype;
69
70 /* For now, just catch early the Repeater and Secondary modes here */
71 if (iw_mode == IW_MODE_REPEAT || iw_mode == IW_MODE_SECOND) {
72 printk(KERN_DEBUG
73 "%s(): Sorry, Repeater mode and Secondary mode "
74 "are not yet supported by this driver.\n", __FUNCTION__);
75 return -EINVAL;
76 }
77
78 priv->iw_mode = iw_mode;
79
80 switch (iw_mode) {
81 case IW_MODE_AUTO:
82 mode = INL_MODE_CLIENT;
83 bsstype = DOT11_BSSTYPE_ANY;
84 break;
85 case IW_MODE_ADHOC:
86 mode = INL_MODE_CLIENT;
87 bsstype = DOT11_BSSTYPE_IBSS;
88 break;
89 case IW_MODE_INFRA:
90 mode = INL_MODE_CLIENT;
91 bsstype = DOT11_BSSTYPE_INFRA;
92 break;
93 case IW_MODE_MASTER:
94 mode = INL_MODE_AP;
95 bsstype = DOT11_BSSTYPE_INFRA;
96 break;
97 case IW_MODE_MONITOR:
98 mode = INL_MODE_PROMISCUOUS;
99 bsstype = DOT11_BSSTYPE_ANY;
100 config |= INL_CONFIG_RXANNEX;
101 break;
102 default:
103 return -EINVAL;
104 }
105
106 if (init_wds)
107 config |= INL_CONFIG_WDS;
108 mgt_set(priv, DOT11_OID_BSSTYPE, &bsstype);
109 mgt_set(priv, OID_INL_CONFIG, &config);
110 mgt_set(priv, OID_INL_MODE, &mode);
111
112 return 0;
113 }
114
115 /**
116 * prism54_mib_init - fill MIB cache with defaults
117 *
118 * this function initializes the struct given as @mib with defaults,
119 * of which many are retrieved from the global module parameter
120 * variables.
121 */
122
123 void
124 prism54_mib_init(islpci_private *priv)
125 {
126 u32 channel, authen, wep, filter, dot1x, mlme, conformance, power, mode;
127 struct obj_buffer psm_buffer = {
128 .size = PSM_BUFFER_SIZE,
129 .addr = priv->device_psm_buffer
130 };
131
132 channel = CARD_DEFAULT_CHANNEL;
133 authen = CARD_DEFAULT_AUTHEN;
134 wep = CARD_DEFAULT_WEP;
135 filter = CARD_DEFAULT_FILTER; /* (0) Do not filter un-encrypted data */
136 dot1x = CARD_DEFAULT_DOT1X;
137 mlme = CARD_DEFAULT_MLME_MODE;
138 conformance = CARD_DEFAULT_CONFORMANCE;
139 power = 127;
140 mode = CARD_DEFAULT_IW_MODE;
141
142 mgt_set(priv, DOT11_OID_CHANNEL, &channel);
143 mgt_set(priv, DOT11_OID_AUTHENABLE, &authen);
144 mgt_set(priv, DOT11_OID_PRIVACYINVOKED, &wep);
145 mgt_set(priv, DOT11_OID_PSMBUFFER, &psm_buffer);
146 mgt_set(priv, DOT11_OID_EXUNENCRYPTED, &filter);
147 mgt_set(priv, DOT11_OID_DOT1XENABLE, &dot1x);
148 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlme);
149 mgt_set(priv, OID_INL_DOT11D_CONFORMANCE, &conformance);
150 mgt_set(priv, OID_INL_OUTPUTPOWER, &power);
151
152 /* This sets all of the mode-dependent values */
153 prism54_mib_mode_helper(priv, mode);
154 }
155
156 /* this will be executed outside of atomic context thanks to
157 * schedule_work(), thus we can as well use sleeping semaphore
158 * locking */
159 void
160 prism54_update_stats(struct work_struct *work)
161 {
162 islpci_private *priv = container_of(work, islpci_private, stats_work);
163 char *data;
164 int j;
165 struct obj_bss bss, *bss2;
166 union oid_res_t r;
167
168 if (down_interruptible(&priv->stats_sem))
169 return;
170
171 /* Noise floor.
172 * I'm not sure if the unit is dBm.
173 * Note : If we are not connected, this value seems to be irrelevant. */
174
175 mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
176 priv->local_iwstatistics.qual.noise = r.u;
177
178 /* Get the rssi of the link. To do this we need to retrieve a bss. */
179
180 /* First get the MAC address of the AP we are associated with. */
181 mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
182 data = r.ptr;
183
184 /* copy this MAC to the bss */
185 memcpy(bss.address, data, 6);
186 kfree(data);
187
188 /* now ask for the corresponding bss */
189 j = mgt_get_request(priv, DOT11_OID_BSSFIND, 0, (void *) &bss, &r);
190 bss2 = r.ptr;
191 /* report the rssi and use it to calculate
192 * link quality through a signal-noise
193 * ratio */
194 priv->local_iwstatistics.qual.level = bss2->rssi;
195 priv->local_iwstatistics.qual.qual =
196 bss2->rssi - priv->iwstatistics.qual.noise;
197
198 kfree(bss2);
199
200 /* report that the stats are new */
201 priv->local_iwstatistics.qual.updated = 0x7;
202
203 /* Rx : unable to decrypt the MPDU */
204 mgt_get_request(priv, DOT11_OID_PRIVRXFAILED, 0, NULL, &r);
205 priv->local_iwstatistics.discard.code = r.u;
206
207 /* Tx : Max MAC retries num reached */
208 mgt_get_request(priv, DOT11_OID_MPDUTXFAILED, 0, NULL, &r);
209 priv->local_iwstatistics.discard.retries = r.u;
210
211 up(&priv->stats_sem);
212
213 return;
214 }
215
216 struct iw_statistics *
217 prism54_get_wireless_stats(struct net_device *ndev)
218 {
219 islpci_private *priv = netdev_priv(ndev);
220
221 /* If the stats are being updated return old data */
222 if (down_trylock(&priv->stats_sem) == 0) {
223 memcpy(&priv->iwstatistics, &priv->local_iwstatistics,
224 sizeof (struct iw_statistics));
225 /* They won't be marked updated for the next time */
226 priv->local_iwstatistics.qual.updated = 0;
227 up(&priv->stats_sem);
228 } else
229 priv->iwstatistics.qual.updated = 0;
230
231 /* Update our wireless stats, but do not schedule to often
232 * (max 1 HZ) */
233 if ((priv->stats_timestamp == 0) ||
234 time_after(jiffies, priv->stats_timestamp + 1 * HZ)) {
235 schedule_work(&priv->stats_work);
236 priv->stats_timestamp = jiffies;
237 }
238
239 return &priv->iwstatistics;
240 }
241
242 static int
243 prism54_commit(struct net_device *ndev, struct iw_request_info *info,
244 char *cwrq, char *extra)
245 {
246 islpci_private *priv = netdev_priv(ndev);
247
248 /* simply re-set the last set SSID, this should commit most stuff */
249
250 /* Commit in Monitor mode is not necessary, also setting essid
251 * in Monitor mode does not make sense and isn't allowed for this
252 * device's firmware */
253 if (priv->iw_mode != IW_MODE_MONITOR)
254 return mgt_set_request(priv, DOT11_OID_SSID, 0, NULL);
255 return 0;
256 }
257
258 static int
259 prism54_get_name(struct net_device *ndev, struct iw_request_info *info,
260 char *cwrq, char *extra)
261 {
262 islpci_private *priv = netdev_priv(ndev);
263 char *capabilities;
264 union oid_res_t r;
265 int rvalue;
266
267 if (islpci_get_state(priv) < PRV_STATE_INIT) {
268 strncpy(cwrq, "NOT READY!", IFNAMSIZ);
269 return 0;
270 }
271 rvalue = mgt_get_request(priv, OID_INL_PHYCAPABILITIES, 0, NULL, &r);
272
273 switch (r.u) {
274 case INL_PHYCAP_5000MHZ:
275 capabilities = "IEEE 802.11a/b/g";
276 break;
277 case INL_PHYCAP_FAA:
278 capabilities = "IEEE 802.11b/g - FAA Support";
279 break;
280 case INL_PHYCAP_2400MHZ:
281 default:
282 capabilities = "IEEE 802.11b/g"; /* Default */
283 break;
284 }
285 strncpy(cwrq, capabilities, IFNAMSIZ);
286 return rvalue;
287 }
288
289 static int
290 prism54_set_freq(struct net_device *ndev, struct iw_request_info *info,
291 struct iw_freq *fwrq, char *extra)
292 {
293 islpci_private *priv = netdev_priv(ndev);
294 int rvalue;
295 u32 c;
296
297 if (fwrq->m < 1000)
298 /* we have a channel number */
299 c = fwrq->m;
300 else
301 c = (fwrq->e == 1) ? channel_of_freq(fwrq->m / 100000) : 0;
302
303 rvalue = c ? mgt_set_request(priv, DOT11_OID_CHANNEL, 0, &c) : -EINVAL;
304
305 /* Call commit handler */
306 return (rvalue ? rvalue : -EINPROGRESS);
307 }
308
309 static int
310 prism54_get_freq(struct net_device *ndev, struct iw_request_info *info,
311 struct iw_freq *fwrq, char *extra)
312 {
313 islpci_private *priv = netdev_priv(ndev);
314 union oid_res_t r;
315 int rvalue;
316
317 rvalue = mgt_get_request(priv, DOT11_OID_CHANNEL, 0, NULL, &r);
318 fwrq->i = r.u;
319 rvalue |= mgt_get_request(priv, DOT11_OID_FREQUENCY, 0, NULL, &r);
320 fwrq->m = r.u;
321 fwrq->e = 3;
322
323 return rvalue;
324 }
325
326 static int
327 prism54_set_mode(struct net_device *ndev, struct iw_request_info *info,
328 __u32 * uwrq, char *extra)
329 {
330 islpci_private *priv = netdev_priv(ndev);
331 u32 mlmeautolevel = CARD_DEFAULT_MLME_MODE;
332
333 /* Let's see if the user passed a valid Linux Wireless mode */
334 if (*uwrq > IW_MODE_MONITOR || *uwrq < IW_MODE_AUTO) {
335 printk(KERN_DEBUG
336 "%s: %s() You passed a non-valid init_mode.\n",
337 priv->ndev->name, __FUNCTION__);
338 return -EINVAL;
339 }
340
341 down_write(&priv->mib_sem);
342
343 if (prism54_mib_mode_helper(priv, *uwrq)) {
344 up_write(&priv->mib_sem);
345 return -EOPNOTSUPP;
346 }
347
348 /* the ACL code needs an intermediate mlmeautolevel. The wpa stuff an
349 * extended one.
350 */
351 if ((*uwrq == IW_MODE_MASTER) && (priv->acl.policy != MAC_POLICY_OPEN))
352 mlmeautolevel = DOT11_MLME_INTERMEDIATE;
353 if (priv->wpa)
354 mlmeautolevel = DOT11_MLME_EXTENDED;
355
356 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
357
358 if (mgt_commit(priv)) {
359 up_write(&priv->mib_sem);
360 return -EIO;
361 }
362 priv->ndev->type = (priv->iw_mode == IW_MODE_MONITOR)
363 ? priv->monitor_type : ARPHRD_ETHER;
364 up_write(&priv->mib_sem);
365
366 return 0;
367 }
368
369 /* Use mib cache */
370 static int
371 prism54_get_mode(struct net_device *ndev, struct iw_request_info *info,
372 __u32 * uwrq, char *extra)
373 {
374 islpci_private *priv = netdev_priv(ndev);
375
376 BUG_ON((priv->iw_mode < IW_MODE_AUTO) || (priv->iw_mode >
377 IW_MODE_MONITOR));
378 *uwrq = priv->iw_mode;
379
380 return 0;
381 }
382
383 /* we use DOT11_OID_EDTHRESHOLD. From what I guess the card will not try to
384 * emit data if (sensitivity > rssi - noise) (in dBm).
385 * prism54_set_sens does not seem to work.
386 */
387
388 static int
389 prism54_set_sens(struct net_device *ndev, struct iw_request_info *info,
390 struct iw_param *vwrq, char *extra)
391 {
392 islpci_private *priv = netdev_priv(ndev);
393 u32 sens;
394
395 /* by default the card sets this to 20. */
396 sens = vwrq->disabled ? 20 : vwrq->value;
397
398 return mgt_set_request(priv, DOT11_OID_EDTHRESHOLD, 0, &sens);
399 }
400
401 static int
402 prism54_get_sens(struct net_device *ndev, struct iw_request_info *info,
403 struct iw_param *vwrq, char *extra)
404 {
405 islpci_private *priv = netdev_priv(ndev);
406 union oid_res_t r;
407 int rvalue;
408
409 rvalue = mgt_get_request(priv, DOT11_OID_EDTHRESHOLD, 0, NULL, &r);
410
411 vwrq->value = r.u;
412 vwrq->disabled = (vwrq->value == 0);
413 vwrq->fixed = 1;
414
415 return rvalue;
416 }
417
418 static int
419 prism54_get_range(struct net_device *ndev, struct iw_request_info *info,
420 struct iw_point *dwrq, char *extra)
421 {
422 struct iw_range *range = (struct iw_range *) extra;
423 islpci_private *priv = netdev_priv(ndev);
424 u8 *data;
425 int i, m, rvalue;
426 struct obj_frequencies *freq;
427 union oid_res_t r;
428
429 memset(range, 0, sizeof (struct iw_range));
430 dwrq->length = sizeof (struct iw_range);
431
432 /* set the wireless extension version number */
433 range->we_version_source = SUPPORTED_WIRELESS_EXT;
434 range->we_version_compiled = WIRELESS_EXT;
435
436 /* Now the encoding capabilities */
437 range->num_encoding_sizes = 3;
438 /* 64(40) bits WEP */
439 range->encoding_size[0] = 5;
440 /* 128(104) bits WEP */
441 range->encoding_size[1] = 13;
442 /* 256 bits for WPA-PSK */
443 range->encoding_size[2] = 32;
444 /* 4 keys are allowed */
445 range->max_encoding_tokens = 4;
446
447 /* we don't know the quality range... */
448 range->max_qual.level = 0;
449 range->max_qual.noise = 0;
450 range->max_qual.qual = 0;
451 /* these value describe an average quality. Needs more tweaking... */
452 range->avg_qual.level = -80; /* -80 dBm */
453 range->avg_qual.noise = 0; /* don't know what to put here */
454 range->avg_qual.qual = 0;
455
456 range->sensitivity = 200;
457
458 /* retry limit capabilities */
459 range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
460 range->retry_flags = IW_RETRY_LIMIT;
461 range->r_time_flags = IW_RETRY_LIFETIME;
462
463 /* I don't know the range. Put stupid things here */
464 range->min_retry = 1;
465 range->max_retry = 65535;
466 range->min_r_time = 1024;
467 range->max_r_time = 65535 * 1024;
468
469 /* txpower is supported in dBm's */
470 range->txpower_capa = IW_TXPOW_DBM;
471
472 /* Event capability (kernel + driver) */
473 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
474 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
475 IW_EVENT_CAPA_MASK(SIOCGIWAP));
476 range->event_capa[1] = IW_EVENT_CAPA_K_1;
477 range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVCUSTOM);
478
479 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
480 IW_ENC_CAPA_CIPHER_TKIP;
481
482 if (islpci_get_state(priv) < PRV_STATE_INIT)
483 return 0;
484
485 /* Request the device for the supported frequencies
486 * not really relevant since some devices will report the 5 GHz band
487 * frequencies even if they don't support them.
488 */
489 rvalue =
490 mgt_get_request(priv, DOT11_OID_SUPPORTEDFREQUENCIES, 0, NULL, &r);
491 freq = r.ptr;
492
493 range->num_channels = freq->nr;
494 range->num_frequency = freq->nr;
495
496 m = min(IW_MAX_FREQUENCIES, (int) freq->nr);
497 for (i = 0; i < m; i++) {
498 range->freq[i].m = freq->mhz[i];
499 range->freq[i].e = 6;
500 range->freq[i].i = channel_of_freq(freq->mhz[i]);
501 }
502 kfree(freq);
503
504 rvalue |= mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r);
505 data = r.ptr;
506
507 /* We got an array of char. It is NULL terminated. */
508 i = 0;
509 while ((i < IW_MAX_BITRATES) && (*data != 0)) {
510 /* the result must be in bps. The card gives us 500Kbps */
511 range->bitrate[i] = *data * 500000;
512 i++;
513 data++;
514 }
515 range->num_bitrates = i;
516 kfree(r.ptr);
517
518 return rvalue;
519 }
520
521 /* Set AP address*/
522
523 static int
524 prism54_set_wap(struct net_device *ndev, struct iw_request_info *info,
525 struct sockaddr *awrq, char *extra)
526 {
527 islpci_private *priv = netdev_priv(ndev);
528 char bssid[6];
529 int rvalue;
530
531 if (awrq->sa_family != ARPHRD_ETHER)
532 return -EINVAL;
533
534 /* prepare the structure for the set object */
535 memcpy(&bssid[0], awrq->sa_data, 6);
536
537 /* set the bssid -- does this make sense when in AP mode? */
538 rvalue = mgt_set_request(priv, DOT11_OID_BSSID, 0, &bssid);
539
540 return (rvalue ? rvalue : -EINPROGRESS); /* Call commit handler */
541 }
542
543 /* get AP address*/
544
545 static int
546 prism54_get_wap(struct net_device *ndev, struct iw_request_info *info,
547 struct sockaddr *awrq, char *extra)
548 {
549 islpci_private *priv = netdev_priv(ndev);
550 union oid_res_t r;
551 int rvalue;
552
553 rvalue = mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
554 memcpy(awrq->sa_data, r.ptr, 6);
555 awrq->sa_family = ARPHRD_ETHER;
556 kfree(r.ptr);
557
558 return rvalue;
559 }
560
561 static int
562 prism54_set_scan(struct net_device *dev, struct iw_request_info *info,
563 struct iw_param *vwrq, char *extra)
564 {
565 /* hehe the device does this automagicaly */
566 return 0;
567 }
568
569 /* a little helper that will translate our data into a card independent
570 * format that the Wireless Tools will understand. This was inspired by
571 * the "Aironet driver for 4500 and 4800 series cards" (GPL)
572 */
573
574 static char *
575 prism54_translate_bss(struct net_device *ndev, char *current_ev,
576 char *end_buf, struct obj_bss *bss, char noise)
577 {
578 struct iw_event iwe; /* Temporary buffer */
579 short cap;
580 islpci_private *priv = netdev_priv(ndev);
581 u8 wpa_ie[MAX_WPA_IE_LEN];
582 size_t wpa_ie_len;
583
584 /* The first entry must be the MAC address */
585 memcpy(iwe.u.ap_addr.sa_data, bss->address, 6);
586 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
587 iwe.cmd = SIOCGIWAP;
588 current_ev =
589 iwe_stream_add_event(current_ev, end_buf, &iwe, IW_EV_ADDR_LEN);
590
591 /* The following entries will be displayed in the same order we give them */
592
593 /* The ESSID. */
594 iwe.u.data.length = bss->ssid.length;
595 iwe.u.data.flags = 1;
596 iwe.cmd = SIOCGIWESSID;
597 current_ev = iwe_stream_add_point(current_ev, end_buf,
598 &iwe, bss->ssid.octets);
599
600 /* Capabilities */
601 #define CAP_ESS 0x01
602 #define CAP_IBSS 0x02
603 #define CAP_CRYPT 0x10
604
605 /* Mode */
606 cap = bss->capinfo;
607 iwe.u.mode = 0;
608 if (cap & CAP_ESS)
609 iwe.u.mode = IW_MODE_MASTER;
610 else if (cap & CAP_IBSS)
611 iwe.u.mode = IW_MODE_ADHOC;
612 iwe.cmd = SIOCGIWMODE;
613 if (iwe.u.mode)
614 current_ev =
615 iwe_stream_add_event(current_ev, end_buf, &iwe,
616 IW_EV_UINT_LEN);
617
618 /* Encryption capability */
619 if (cap & CAP_CRYPT)
620 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
621 else
622 iwe.u.data.flags = IW_ENCODE_DISABLED;
623 iwe.u.data.length = 0;
624 iwe.cmd = SIOCGIWENCODE;
625 current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe, NULL);
626
627 /* Add frequency. (short) bss->channel is the frequency in MHz */
628 iwe.u.freq.m = bss->channel;
629 iwe.u.freq.e = 6;
630 iwe.cmd = SIOCGIWFREQ;
631 current_ev =
632 iwe_stream_add_event(current_ev, end_buf, &iwe, IW_EV_FREQ_LEN);
633
634 /* Add quality statistics */
635 iwe.u.qual.level = bss->rssi;
636 iwe.u.qual.noise = noise;
637 /* do a simple SNR for quality */
638 iwe.u.qual.qual = bss->rssi - noise;
639 iwe.cmd = IWEVQUAL;
640 current_ev =
641 iwe_stream_add_event(current_ev, end_buf, &iwe, IW_EV_QUAL_LEN);
642
643 /* Add WPA/RSN Information Element, if any */
644 wpa_ie_len = prism54_wpa_bss_ie_get(priv, bss->address, wpa_ie);
645 if (wpa_ie_len > 0) {
646 iwe.cmd = IWEVGENIE;
647 iwe.u.data.length = min(wpa_ie_len, (size_t)MAX_WPA_IE_LEN);
648 current_ev = iwe_stream_add_point(current_ev, end_buf,
649 &iwe, wpa_ie);
650 }
651 /* Do the bitrates */
652 {
653 char * current_val = current_ev + IW_EV_LCP_LEN;
654 int i;
655 int mask;
656
657 iwe.cmd = SIOCGIWRATE;
658 /* Those two flags are ignored... */
659 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
660
661 /* Parse the bitmask */
662 mask = 0x1;
663 for(i = 0; i < sizeof(scan_rate_list); i++) {
664 if(bss->rates & mask) {
665 iwe.u.bitrate.value = (scan_rate_list[i] * 500000);
666 current_val = iwe_stream_add_value(current_ev, current_val,
667 end_buf, &iwe,
668 IW_EV_PARAM_LEN);
669 }
670 mask <<= 1;
671 }
672 /* Check if we added any event */
673 if ((current_val - current_ev) > IW_EV_LCP_LEN)
674 current_ev = current_val;
675 }
676
677 return current_ev;
678 }
679
680 static int
681 prism54_get_scan(struct net_device *ndev, struct iw_request_info *info,
682 struct iw_point *dwrq, char *extra)
683 {
684 islpci_private *priv = netdev_priv(ndev);
685 int i, rvalue;
686 struct obj_bsslist *bsslist;
687 u32 noise = 0;
688 char *current_ev = extra;
689 union oid_res_t r;
690
691 if (islpci_get_state(priv) < PRV_STATE_INIT) {
692 /* device is not ready, fail gently */
693 dwrq->length = 0;
694 return 0;
695 }
696
697 /* first get the noise value. We will use it to report the link quality */
698 rvalue = mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
699 noise = r.u;
700
701 /* Ask the device for a list of known bss.
702 * The old API, using SIOCGIWAPLIST, had a hard limit of IW_MAX_AP=64.
703 * The new API, using SIOCGIWSCAN, is only limited by the buffer size.
704 * WE-14->WE-16, the buffer is limited to IW_SCAN_MAX_DATA bytes.
705 * Starting with WE-17, the buffer can be as big as needed.
706 * But the device won't repport anything if you change the value
707 * of IWMAX_BSS=24. */
708
709 rvalue |= mgt_get_request(priv, DOT11_OID_BSSLIST, 0, NULL, &r);
710 bsslist = r.ptr;
711
712 /* ok now, scan the list and translate its info */
713 for (i = 0; i < (int) bsslist->nr; i++) {
714 current_ev = prism54_translate_bss(ndev, current_ev,
715 extra + dwrq->length,
716 &(bsslist->bsslist[i]),
717 noise);
718
719 /* Check if there is space for one more entry */
720 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
721 /* Ask user space to try again with a bigger buffer */
722 rvalue = -E2BIG;
723 break;
724 }
725 }
726
727 kfree(bsslist);
728 dwrq->length = (current_ev - extra);
729 dwrq->flags = 0; /* todo */
730
731 return rvalue;
732 }
733
734 static int
735 prism54_set_essid(struct net_device *ndev, struct iw_request_info *info,
736 struct iw_point *dwrq, char *extra)
737 {
738 islpci_private *priv = netdev_priv(ndev);
739 struct obj_ssid essid;
740
741 memset(essid.octets, 0, 33);
742
743 /* Check if we were asked for `any' */
744 if (dwrq->flags && dwrq->length) {
745 if (dwrq->length > 32)
746 return -E2BIG;
747 essid.length = dwrq->length;
748 memcpy(essid.octets, extra, dwrq->length);
749 } else
750 essid.length = 0;
751
752 if (priv->iw_mode != IW_MODE_MONITOR)
753 return mgt_set_request(priv, DOT11_OID_SSID, 0, &essid);
754
755 /* If in monitor mode, just save to mib */
756 mgt_set(priv, DOT11_OID_SSID, &essid);
757 return 0;
758
759 }
760
761 static int
762 prism54_get_essid(struct net_device *ndev, struct iw_request_info *info,
763 struct iw_point *dwrq, char *extra)
764 {
765 islpci_private *priv = netdev_priv(ndev);
766 struct obj_ssid *essid;
767 union oid_res_t r;
768 int rvalue;
769
770 rvalue = mgt_get_request(priv, DOT11_OID_SSID, 0, NULL, &r);
771 essid = r.ptr;
772
773 if (essid->length) {
774 dwrq->flags = 1; /* set ESSID to ON for Wireless Extensions */
775 /* if it is too big, trunk it */
776 dwrq->length = min((u8)IW_ESSID_MAX_SIZE, essid->length);
777 } else {
778 dwrq->flags = 0;
779 dwrq->length = 0;
780 }
781 essid->octets[essid->length] = '\0';
782 memcpy(extra, essid->octets, dwrq->length);
783 kfree(essid);
784
785 return rvalue;
786 }
787
788 /* Provides no functionality, just completes the ioctl. In essence this is a
789 * just a cosmetic ioctl.
790 */
791 static int
792 prism54_set_nick(struct net_device *ndev, struct iw_request_info *info,
793 struct iw_point *dwrq, char *extra)
794 {
795 islpci_private *priv = netdev_priv(ndev);
796
797 if (dwrq->length > IW_ESSID_MAX_SIZE)
798 return -E2BIG;
799
800 down_write(&priv->mib_sem);
801 memset(priv->nickname, 0, sizeof (priv->nickname));
802 memcpy(priv->nickname, extra, dwrq->length);
803 up_write(&priv->mib_sem);
804
805 return 0;
806 }
807
808 static int
809 prism54_get_nick(struct net_device *ndev, struct iw_request_info *info,
810 struct iw_point *dwrq, char *extra)
811 {
812 islpci_private *priv = netdev_priv(ndev);
813
814 dwrq->length = 0;
815
816 down_read(&priv->mib_sem);
817 dwrq->length = strlen(priv->nickname);
818 memcpy(extra, priv->nickname, dwrq->length);
819 up_read(&priv->mib_sem);
820
821 return 0;
822 }
823
824 /* Set the allowed Bitrates */
825
826 static int
827 prism54_set_rate(struct net_device *ndev,
828 struct iw_request_info *info,
829 struct iw_param *vwrq, char *extra)
830 {
831
832 islpci_private *priv = netdev_priv(ndev);
833 u32 rate, profile;
834 char *data;
835 int ret, i;
836 union oid_res_t r;
837
838 if (vwrq->value == -1) {
839 /* auto mode. No limit. */
840 profile = 1;
841 return mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile);
842 }
843
844 ret = mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r);
845 if (ret) {
846 kfree(r.ptr);
847 return ret;
848 }
849
850 rate = (u32) (vwrq->value / 500000);
851 data = r.ptr;
852 i = 0;
853
854 while (data[i]) {
855 if (rate && (data[i] == rate)) {
856 break;
857 }
858 if (vwrq->value == i) {
859 break;
860 }
861 data[i] |= 0x80;
862 i++;
863 }
864
865 if (!data[i]) {
866 kfree(r.ptr);
867 return -EINVAL;
868 }
869
870 data[i] |= 0x80;
871 data[i + 1] = 0;
872
873 /* Now, check if we want a fixed or auto value */
874 if (vwrq->fixed) {
875 data[0] = data[i];
876 data[1] = 0;
877 }
878
879 /*
880 i = 0;
881 printk("prism54 rate: ");
882 while(data[i]) {
883 printk("%u ", data[i]);
884 i++;
885 }
886 printk("0\n");
887 */
888 profile = -1;
889 ret = mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile);
890 ret |= mgt_set_request(priv, DOT11_OID_EXTENDEDRATES, 0, data);
891 ret |= mgt_set_request(priv, DOT11_OID_RATES, 0, data);
892
893 kfree(r.ptr);
894
895 return ret;
896 }
897
898 /* Get the current bit rate */
899 static int
900 prism54_get_rate(struct net_device *ndev,
901 struct iw_request_info *info,
902 struct iw_param *vwrq, char *extra)
903 {
904 islpci_private *priv = netdev_priv(ndev);
905 int rvalue;
906 char *data;
907 union oid_res_t r;
908
909 /* Get the current bit rate */
910 if ((rvalue = mgt_get_request(priv, GEN_OID_LINKSTATE, 0, NULL, &r)))
911 return rvalue;
912 vwrq->value = r.u * 500000;
913
914 /* request the device for the enabled rates */
915 rvalue = mgt_get_request(priv, DOT11_OID_RATES, 0, NULL, &r);
916 if (rvalue) {
917 kfree(r.ptr);
918 return rvalue;
919 }
920 data = r.ptr;
921 vwrq->fixed = (data[0] != 0) && (data[1] == 0);
922 kfree(r.ptr);
923
924 return 0;
925 }
926
927 static int
928 prism54_set_rts(struct net_device *ndev, struct iw_request_info *info,
929 struct iw_param *vwrq, char *extra)
930 {
931 islpci_private *priv = netdev_priv(ndev);
932
933 return mgt_set_request(priv, DOT11_OID_RTSTHRESH, 0, &vwrq->value);
934 }
935
936 static int
937 prism54_get_rts(struct net_device *ndev, struct iw_request_info *info,
938 struct iw_param *vwrq, char *extra)
939 {
940 islpci_private *priv = netdev_priv(ndev);
941 union oid_res_t r;
942 int rvalue;
943
944 /* get the rts threshold */
945 rvalue = mgt_get_request(priv, DOT11_OID_RTSTHRESH, 0, NULL, &r);
946 vwrq->value = r.u;
947
948 return rvalue;
949 }
950
951 static int
952 prism54_set_frag(struct net_device *ndev, struct iw_request_info *info,
953 struct iw_param *vwrq, char *extra)
954 {
955 islpci_private *priv = netdev_priv(ndev);
956
957 return mgt_set_request(priv, DOT11_OID_FRAGTHRESH, 0, &vwrq->value);
958 }
959
960 static int
961 prism54_get_frag(struct net_device *ndev, struct iw_request_info *info,
962 struct iw_param *vwrq, char *extra)
963 {
964 islpci_private *priv = netdev_priv(ndev);
965 union oid_res_t r;
966 int rvalue;
967
968 rvalue = mgt_get_request(priv, DOT11_OID_FRAGTHRESH, 0, NULL, &r);
969 vwrq->value = r.u;
970
971 return rvalue;
972 }
973
974 /* Here we have (min,max) = max retries for (small frames, big frames). Where
975 * big frame <=> bigger than the rts threshold
976 * small frame <=> smaller than the rts threshold
977 * This is not really the behavior expected by the wireless tool but it seems
978 * to be a common behavior in other drivers.
979 */
980
981 static int
982 prism54_set_retry(struct net_device *ndev, struct iw_request_info *info,
983 struct iw_param *vwrq, char *extra)
984 {
985 islpci_private *priv = netdev_priv(ndev);
986 u32 slimit = 0, llimit = 0; /* short and long limit */
987 u32 lifetime = 0;
988 int rvalue = 0;
989
990 if (vwrq->disabled)
991 /* we cannot disable this feature */
992 return -EINVAL;
993
994 if (vwrq->flags & IW_RETRY_LIMIT) {
995 if (vwrq->flags & IW_RETRY_SHORT)
996 slimit = vwrq->value;
997 else if (vwrq->flags & IW_RETRY_LONG)
998 llimit = vwrq->value;
999 else {
1000 /* we are asked to set both */
1001 slimit = vwrq->value;
1002 llimit = vwrq->value;
1003 }
1004 }
1005 if (vwrq->flags & IW_RETRY_LIFETIME)
1006 /* Wireless tools use us unit while the device uses 1024 us unit */
1007 lifetime = vwrq->value / 1024;
1008
1009 /* now set what is requested */
1010 if (slimit)
1011 rvalue =
1012 mgt_set_request(priv, DOT11_OID_SHORTRETRIES, 0, &slimit);
1013 if (llimit)
1014 rvalue |=
1015 mgt_set_request(priv, DOT11_OID_LONGRETRIES, 0, &llimit);
1016 if (lifetime)
1017 rvalue |=
1018 mgt_set_request(priv, DOT11_OID_MAXTXLIFETIME, 0,
1019 &lifetime);
1020 return rvalue;
1021 }
1022
1023 static int
1024 prism54_get_retry(struct net_device *ndev, struct iw_request_info *info,
1025 struct iw_param *vwrq, char *extra)
1026 {
1027 islpci_private *priv = netdev_priv(ndev);
1028 union oid_res_t r;
1029 int rvalue = 0;
1030 vwrq->disabled = 0; /* It cannot be disabled */
1031
1032 if ((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
1033 /* we are asked for the life time */
1034 rvalue =
1035 mgt_get_request(priv, DOT11_OID_MAXTXLIFETIME, 0, NULL, &r);
1036 vwrq->value = r.u * 1024;
1037 vwrq->flags = IW_RETRY_LIFETIME;
1038 } else if ((vwrq->flags & IW_RETRY_LONG)) {
1039 /* we are asked for the long retry limit */
1040 rvalue |=
1041 mgt_get_request(priv, DOT11_OID_LONGRETRIES, 0, NULL, &r);
1042 vwrq->value = r.u;
1043 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
1044 } else {
1045 /* default. get the short retry limit */
1046 rvalue |=
1047 mgt_get_request(priv, DOT11_OID_SHORTRETRIES, 0, NULL, &r);
1048 vwrq->value = r.u;
1049 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
1050 }
1051
1052 return rvalue;
1053 }
1054
1055 static int
1056 prism54_set_encode(struct net_device *ndev, struct iw_request_info *info,
1057 struct iw_point *dwrq, char *extra)
1058 {
1059 islpci_private *priv = netdev_priv(ndev);
1060 int rvalue = 0, force = 0;
1061 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
1062 union oid_res_t r;
1063
1064 /* with the new API, it's impossible to get a NULL pointer.
1065 * New version of iwconfig set the IW_ENCODE_NOKEY flag
1066 * when no key is given, but older versions don't. */
1067
1068 if (dwrq->length > 0) {
1069 /* we have a key to set */
1070 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1071 int current_index;
1072 struct obj_key key = { DOT11_PRIV_WEP, 0, "" };
1073
1074 /* get the current key index */
1075 rvalue = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1076 current_index = r.u;
1077 /* Verify that the key is not marked as invalid */
1078 if (!(dwrq->flags & IW_ENCODE_NOKEY)) {
1079 if (dwrq->length > KEY_SIZE_TKIP) {
1080 /* User-provided key data too big */
1081 return -EINVAL;
1082 }
1083 if (dwrq->length > KEY_SIZE_WEP104) {
1084 /* WPA-PSK TKIP */
1085 key.type = DOT11_PRIV_TKIP;
1086 key.length = KEY_SIZE_TKIP;
1087 } else if (dwrq->length > KEY_SIZE_WEP40) {
1088 /* WEP 104/128 */
1089 key.length = KEY_SIZE_WEP104;
1090 } else {
1091 /* WEP 40/64 */
1092 key.length = KEY_SIZE_WEP40;
1093 }
1094 memset(key.key, 0, sizeof (key.key));
1095 memcpy(key.key, extra, dwrq->length);
1096
1097 if ((index < 0) || (index > 3))
1098 /* no index provided use the current one */
1099 index = current_index;
1100
1101 /* now send the key to the card */
1102 rvalue |=
1103 mgt_set_request(priv, DOT11_OID_DEFKEYX, index,
1104 &key);
1105 }
1106 /*
1107 * If a valid key is set, encryption should be enabled
1108 * (user may turn it off later).
1109 * This is also how "iwconfig ethX key on" works
1110 */
1111 if ((index == current_index) && (key.length > 0))
1112 force = 1;
1113 } else {
1114 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1115 if ((index >= 0) && (index <= 3)) {
1116 /* we want to set the key index */
1117 rvalue |=
1118 mgt_set_request(priv, DOT11_OID_DEFKEYID, 0,
1119 &index);
1120 } else {
1121 if (!dwrq->flags & IW_ENCODE_MODE) {
1122 /* we cannot do anything. Complain. */
1123 return -EINVAL;
1124 }
1125 }
1126 }
1127 /* now read the flags */
1128 if (dwrq->flags & IW_ENCODE_DISABLED) {
1129 /* Encoding disabled,
1130 * authen = DOT11_AUTH_OS;
1131 * invoke = 0;
1132 * exunencrypt = 0; */
1133 }
1134 if (dwrq->flags & IW_ENCODE_OPEN)
1135 /* Encode but accept non-encoded packets. No auth */
1136 invoke = 1;
1137 if ((dwrq->flags & IW_ENCODE_RESTRICTED) || force) {
1138 /* Refuse non-encoded packets. Auth */
1139 authen = DOT11_AUTH_BOTH;
1140 invoke = 1;
1141 exunencrypt = 1;
1142 }
1143 /* do the change if requested */
1144 if ((dwrq->flags & IW_ENCODE_MODE) || force) {
1145 rvalue |=
1146 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
1147 rvalue |=
1148 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &invoke);
1149 rvalue |=
1150 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
1151 &exunencrypt);
1152 }
1153 return rvalue;
1154 }
1155
1156 static int
1157 prism54_get_encode(struct net_device *ndev, struct iw_request_info *info,
1158 struct iw_point *dwrq, char *extra)
1159 {
1160 islpci_private *priv = netdev_priv(ndev);
1161 struct obj_key *key;
1162 u32 devindex, index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1163 u32 authen = 0, invoke = 0, exunencrypt = 0;
1164 int rvalue;
1165 union oid_res_t r;
1166
1167 /* first get the flags */
1168 rvalue = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1169 authen = r.u;
1170 rvalue |= mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1171 invoke = r.u;
1172 rvalue |= mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1173 exunencrypt = r.u;
1174
1175 if (invoke && (authen == DOT11_AUTH_BOTH) && exunencrypt)
1176 dwrq->flags = IW_ENCODE_RESTRICTED;
1177 else if ((authen == DOT11_AUTH_OS) && !exunencrypt) {
1178 if (invoke)
1179 dwrq->flags = IW_ENCODE_OPEN;
1180 else
1181 dwrq->flags = IW_ENCODE_DISABLED;
1182 } else
1183 /* The card should not work in this state */
1184 dwrq->flags = 0;
1185
1186 /* get the current device key index */
1187 rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1188 devindex = r.u;
1189 /* Now get the key, return it */
1190 if ((index < 0) || (index > 3))
1191 /* no index provided, use the current one */
1192 index = devindex;
1193 rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYX, index, NULL, &r);
1194 key = r.ptr;
1195 dwrq->length = key->length;
1196 memcpy(extra, key->key, dwrq->length);
1197 kfree(key);
1198 /* return the used key index */
1199 dwrq->flags |= devindex + 1;
1200
1201 return rvalue;
1202 }
1203
1204 static int
1205 prism54_get_txpower(struct net_device *ndev, struct iw_request_info *info,
1206 struct iw_param *vwrq, char *extra)
1207 {
1208 islpci_private *priv = netdev_priv(ndev);
1209 union oid_res_t r;
1210 int rvalue;
1211
1212 rvalue = mgt_get_request(priv, OID_INL_OUTPUTPOWER, 0, NULL, &r);
1213 /* intersil firmware operates in 0.25 dBm (1/4 dBm) */
1214 vwrq->value = (s32) r.u / 4;
1215 vwrq->fixed = 1;
1216 /* radio is not turned of
1217 * btw: how is possible to turn off only the radio
1218 */
1219 vwrq->disabled = 0;
1220
1221 return rvalue;
1222 }
1223
1224 static int
1225 prism54_set_txpower(struct net_device *ndev, struct iw_request_info *info,
1226 struct iw_param *vwrq, char *extra)
1227 {
1228 islpci_private *priv = netdev_priv(ndev);
1229 s32 u = vwrq->value;
1230
1231 /* intersil firmware operates in 0.25 dBm (1/4) */
1232 u *= 4;
1233 if (vwrq->disabled) {
1234 /* don't know how to disable radio */
1235 printk(KERN_DEBUG
1236 "%s: %s() disabling radio is not yet supported.\n",
1237 priv->ndev->name, __FUNCTION__);
1238 return -ENOTSUPP;
1239 } else if (vwrq->fixed)
1240 /* currently only fixed value is supported */
1241 return mgt_set_request(priv, OID_INL_OUTPUTPOWER, 0, &u);
1242 else {
1243 printk(KERN_DEBUG
1244 "%s: %s() auto power will be implemented later.\n",
1245 priv->ndev->name, __FUNCTION__);
1246 return -ENOTSUPP;
1247 }
1248 }
1249
1250 static int prism54_set_genie(struct net_device *ndev,
1251 struct iw_request_info *info,
1252 struct iw_point *data, char *extra)
1253 {
1254 islpci_private *priv = netdev_priv(ndev);
1255 int alen, ret = 0;
1256 struct obj_attachment *attach;
1257
1258 if (data->length > MAX_WPA_IE_LEN ||
1259 (data->length && extra == NULL))
1260 return -EINVAL;
1261
1262 memcpy(priv->wpa_ie, extra, data->length);
1263 priv->wpa_ie_len = data->length;
1264
1265 alen = sizeof(*attach) + priv->wpa_ie_len;
1266 attach = kzalloc(alen, GFP_KERNEL);
1267 if (attach == NULL)
1268 return -ENOMEM;
1269
1270 #define WLAN_FC_TYPE_MGMT 0
1271 #define WLAN_FC_STYPE_ASSOC_REQ 0
1272 #define WLAN_FC_STYPE_REASSOC_REQ 2
1273
1274 /* Note: endianness is covered by mgt_set_varlen */
1275 attach->type = (WLAN_FC_TYPE_MGMT << 2) |
1276 (WLAN_FC_STYPE_ASSOC_REQ << 4);
1277 attach->id = -1;
1278 attach->size = priv->wpa_ie_len;
1279 memcpy(attach->data, extra, priv->wpa_ie_len);
1280
1281 ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach,
1282 priv->wpa_ie_len);
1283 if (ret == 0) {
1284 attach->type = (WLAN_FC_TYPE_MGMT << 2) |
1285 (WLAN_FC_STYPE_REASSOC_REQ << 4);
1286
1287 ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach,
1288 priv->wpa_ie_len);
1289 if (ret == 0)
1290 printk(KERN_DEBUG "%s: WPA IE Attachment was set\n",
1291 ndev->name);
1292 }
1293
1294 kfree(attach);
1295 return ret;
1296 }
1297
1298
1299 static int prism54_get_genie(struct net_device *ndev,
1300 struct iw_request_info *info,
1301 struct iw_point *data, char *extra)
1302 {
1303 islpci_private *priv = netdev_priv(ndev);
1304 int len = priv->wpa_ie_len;
1305
1306 if (len <= 0) {
1307 data->length = 0;
1308 return 0;
1309 }
1310
1311 if (data->length < len)
1312 return -E2BIG;
1313
1314 data->length = len;
1315 memcpy(extra, priv->wpa_ie, len);
1316
1317 return 0;
1318 }
1319
1320 static int prism54_set_auth(struct net_device *ndev,
1321 struct iw_request_info *info,
1322 union iwreq_data *wrqu, char *extra)
1323 {
1324 islpci_private *priv = netdev_priv(ndev);
1325 struct iw_param *param = &wrqu->param;
1326 u32 mlmelevel = 0, authen = 0, dot1x = 0;
1327 u32 exunencrypt = 0, privinvoked = 0, wpa = 0;
1328 u32 old_wpa;
1329 int ret = 0;
1330 union oid_res_t r;
1331
1332 if (islpci_get_state(priv) < PRV_STATE_INIT)
1333 return 0;
1334
1335 /* first get the flags */
1336 down_write(&priv->mib_sem);
1337 wpa = old_wpa = priv->wpa;
1338 up_write(&priv->mib_sem);
1339 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1340 authen = r.u;
1341 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1342 privinvoked = r.u;
1343 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1344 exunencrypt = r.u;
1345 ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r);
1346 dot1x = r.u;
1347 ret = mgt_get_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, NULL, &r);
1348 mlmelevel = r.u;
1349
1350 if (ret < 0)
1351 goto out;
1352
1353 switch (param->flags & IW_AUTH_INDEX) {
1354 case IW_AUTH_CIPHER_PAIRWISE:
1355 case IW_AUTH_CIPHER_GROUP:
1356 case IW_AUTH_KEY_MGMT:
1357 break;
1358
1359 case IW_AUTH_WPA_ENABLED:
1360 /* Do the same thing as IW_AUTH_WPA_VERSION */
1361 if (param->value) {
1362 wpa = 1;
1363 privinvoked = 1; /* For privacy invoked */
1364 exunencrypt = 1; /* Filter out all unencrypted frames */
1365 dot1x = 0x01; /* To enable eap filter */
1366 mlmelevel = DOT11_MLME_EXTENDED;
1367 authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
1368 } else {
1369 wpa = 0;
1370 privinvoked = 0;
1371 exunencrypt = 0; /* Do not filter un-encrypted data */
1372 dot1x = 0;
1373 mlmelevel = DOT11_MLME_AUTO;
1374 }
1375 break;
1376
1377 case IW_AUTH_WPA_VERSION:
1378 if (param->value & IW_AUTH_WPA_VERSION_DISABLED) {
1379 wpa = 0;
1380 privinvoked = 0;
1381 exunencrypt = 0; /* Do not filter un-encrypted data */
1382 dot1x = 0;
1383 mlmelevel = DOT11_MLME_AUTO;
1384 } else {
1385 if (param->value & IW_AUTH_WPA_VERSION_WPA)
1386 wpa = 1;
1387 else if (param->value & IW_AUTH_WPA_VERSION_WPA2)
1388 wpa = 2;
1389 privinvoked = 1; /* For privacy invoked */
1390 exunencrypt = 1; /* Filter out all unencrypted frames */
1391 dot1x = 0x01; /* To enable eap filter */
1392 mlmelevel = DOT11_MLME_EXTENDED;
1393 authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
1394 }
1395 break;
1396
1397 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1398 /* dot1x should be the opposite of RX_UNENCRYPTED_EAPOL;
1399 * turn off dot1x when allowing receipt of unencrypted EAPOL
1400 * frames, turn on dot1x when receipt should be disallowed
1401 */
1402 dot1x = param->value ? 0 : 0x01;
1403 break;
1404
1405 case IW_AUTH_PRIVACY_INVOKED:
1406 privinvoked = param->value ? 1 : 0;
1407 break;
1408
1409 case IW_AUTH_DROP_UNENCRYPTED:
1410 exunencrypt = param->value ? 1 : 0;
1411 break;
1412
1413 case IW_AUTH_80211_AUTH_ALG:
1414 if (param->value & IW_AUTH_ALG_SHARED_KEY) {
1415 /* Only WEP uses _SK and _BOTH */
1416 if (wpa > 0) {
1417 ret = -EINVAL;
1418 goto out;
1419 }
1420 authen = DOT11_AUTH_SK;
1421 } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
1422 authen = DOT11_AUTH_OS;
1423 } else {
1424 ret = -EINVAL;
1425 goto out;
1426 }
1427 break;
1428
1429 default:
1430 return -EOPNOTSUPP;
1431 }
1432
1433 /* Set all the values */
1434 down_write(&priv->mib_sem);
1435 priv->wpa = wpa;
1436 up_write(&priv->mib_sem);
1437 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
1438 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &privinvoked);
1439 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &exunencrypt);
1440 mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x);
1441 mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlmelevel);
1442
1443 out:
1444 return ret;
1445 }
1446
1447 static int prism54_get_auth(struct net_device *ndev,
1448 struct iw_request_info *info,
1449 union iwreq_data *wrqu, char *extra)
1450 {
1451 islpci_private *priv = netdev_priv(ndev);
1452 struct iw_param *param = &wrqu->param;
1453 u32 wpa = 0;
1454 int ret = 0;
1455 union oid_res_t r;
1456
1457 if (islpci_get_state(priv) < PRV_STATE_INIT)
1458 return 0;
1459
1460 /* first get the flags */
1461 down_write(&priv->mib_sem);
1462 wpa = priv->wpa;
1463 up_write(&priv->mib_sem);
1464
1465 switch (param->flags & IW_AUTH_INDEX) {
1466 case IW_AUTH_CIPHER_PAIRWISE:
1467 case IW_AUTH_CIPHER_GROUP:
1468 case IW_AUTH_KEY_MGMT:
1469 /*
1470 * wpa_supplicant will control these internally
1471 */
1472 ret = -EOPNOTSUPP;
1473 break;
1474
1475 case IW_AUTH_WPA_VERSION:
1476 switch (wpa) {
1477 case 1:
1478 param->value = IW_AUTH_WPA_VERSION_WPA;
1479 break;
1480 case 2:
1481 param->value = IW_AUTH_WPA_VERSION_WPA2;
1482 break;
1483 case 0:
1484 default:
1485 param->value = IW_AUTH_WPA_VERSION_DISABLED;
1486 break;
1487 }
1488 break;
1489
1490 case IW_AUTH_DROP_UNENCRYPTED:
1491 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1492 if (ret >= 0)
1493 param->value = r.u > 0 ? 1 : 0;
1494 break;
1495
1496 case IW_AUTH_80211_AUTH_ALG:
1497 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1498 if (ret >= 0) {
1499 switch (r.u) {
1500 case DOT11_AUTH_OS:
1501 param->value = IW_AUTH_ALG_OPEN_SYSTEM;
1502 break;
1503 case DOT11_AUTH_BOTH:
1504 case DOT11_AUTH_SK:
1505 param->value = IW_AUTH_ALG_SHARED_KEY;
1506 case DOT11_AUTH_NONE:
1507 default:
1508 param->value = 0;
1509 break;
1510 }
1511 }
1512 break;
1513
1514 case IW_AUTH_WPA_ENABLED:
1515 param->value = wpa > 0 ? 1 : 0;
1516 break;
1517
1518 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1519 ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r);
1520 if (ret >= 0)
1521 param->value = r.u > 0 ? 1 : 0;
1522 break;
1523
1524 case IW_AUTH_PRIVACY_INVOKED:
1525 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1526 if (ret >= 0)
1527 param->value = r.u > 0 ? 1 : 0;
1528 break;
1529
1530 default:
1531 return -EOPNOTSUPP;
1532 }
1533 return ret;
1534 }
1535
1536 static int prism54_set_encodeext(struct net_device *ndev,
1537 struct iw_request_info *info,
1538 union iwreq_data *wrqu,
1539 char *extra)
1540 {
1541 islpci_private *priv = netdev_priv(ndev);
1542 struct iw_point *encoding = &wrqu->encoding;
1543 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1544 int idx, alg = ext->alg, set_key = 1;
1545 union oid_res_t r;
1546 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
1547 int ret = 0;
1548
1549 if (islpci_get_state(priv) < PRV_STATE_INIT)
1550 return 0;
1551
1552 /* Determine and validate the key index */
1553 idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1554 if (idx) {
1555 if (idx < 0 || idx > 3)
1556 return -EINVAL;
1557 } else {
1558 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1559 if (ret < 0)
1560 goto out;
1561 idx = r.u;
1562 }
1563
1564 if (encoding->flags & IW_ENCODE_DISABLED)
1565 alg = IW_ENCODE_ALG_NONE;
1566
1567 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
1568 /* Only set transmit key index here, actual
1569 * key is set below if needed.
1570 */
1571 ret = mgt_set_request(priv, DOT11_OID_DEFKEYID, 0, &idx);
1572 set_key = ext->key_len > 0 ? 1 : 0;
1573 }
1574
1575 if (set_key) {
1576 struct obj_key key = { DOT11_PRIV_WEP, 0, "" };
1577 switch (alg) {
1578 case IW_ENCODE_ALG_NONE:
1579 break;
1580 case IW_ENCODE_ALG_WEP:
1581 if (ext->key_len > KEY_SIZE_WEP104) {
1582 ret = -EINVAL;
1583 goto out;
1584 }
1585 if (ext->key_len > KEY_SIZE_WEP40)
1586 key.length = KEY_SIZE_WEP104;
1587 else
1588 key.length = KEY_SIZE_WEP40;
1589 break;
1590 case IW_ENCODE_ALG_TKIP:
1591 if (ext->key_len > KEY_SIZE_TKIP) {
1592 ret = -EINVAL;
1593 goto out;
1594 }
1595 key.type = DOT11_PRIV_TKIP;
1596 key.length = KEY_SIZE_TKIP;
1597 break;
1598 default:
1599 return -EINVAL;
1600 }
1601
1602 if (key.length) {
1603 memset(key.key, 0, sizeof(key.key));
1604 memcpy(key.key, ext->key, ext->key_len);
1605 ret = mgt_set_request(priv, DOT11_OID_DEFKEYX, idx,
1606 &key);
1607 if (ret < 0)
1608 goto out;
1609 }
1610 }
1611
1612 /* Read the flags */
1613 if (encoding->flags & IW_ENCODE_DISABLED) {
1614 /* Encoding disabled,
1615 * authen = DOT11_AUTH_OS;
1616 * invoke = 0;
1617 * exunencrypt = 0; */
1618 }
1619 if (encoding->flags & IW_ENCODE_OPEN) {
1620 /* Encode but accept non-encoded packets. No auth */
1621 invoke = 1;
1622 }
1623 if (encoding->flags & IW_ENCODE_RESTRICTED) {
1624 /* Refuse non-encoded packets. Auth */
1625 authen = DOT11_AUTH_BOTH;
1626 invoke = 1;
1627 exunencrypt = 1;
1628 }
1629
1630 /* do the change if requested */
1631 if (encoding->flags & IW_ENCODE_MODE) {
1632 ret = mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0,
1633 &authen);
1634 ret = mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0,
1635 &invoke);
1636 ret = mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
1637 &exunencrypt);
1638 }
1639
1640 out:
1641 return ret;
1642 }
1643
1644
1645 static int prism54_get_encodeext(struct net_device *ndev,
1646 struct iw_request_info *info,
1647 union iwreq_data *wrqu,
1648 char *extra)
1649 {
1650 islpci_private *priv = netdev_priv(ndev);
1651 struct iw_point *encoding = &wrqu->encoding;
1652 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1653 int idx, max_key_len;
1654 union oid_res_t r;
1655 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0, wpa = 0;
1656 int ret = 0;
1657
1658 if (islpci_get_state(priv) < PRV_STATE_INIT)
1659 return 0;
1660
1661 /* first get the flags */
1662 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1663 authen = r.u;
1664 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1665 invoke = r.u;
1666 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1667 exunencrypt = r.u;
1668 if (ret < 0)
1669 goto out;
1670
1671 max_key_len = encoding->length - sizeof(*ext);
1672 if (max_key_len < 0)
1673 return -EINVAL;
1674
1675 idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1676 if (idx) {
1677 if (idx < 0 || idx > 3)
1678 return -EINVAL;
1679 } else {
1680 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1681 if (ret < 0)
1682 goto out;
1683 idx = r.u;
1684 }
1685
1686 encoding->flags = idx + 1;
1687 memset(ext, 0, sizeof(*ext));
1688
1689 switch (authen) {
1690 case DOT11_AUTH_BOTH:
1691 case DOT11_AUTH_SK:
1692 wrqu->encoding.flags |= IW_ENCODE_RESTRICTED;
1693 case DOT11_AUTH_OS:
1694 default:
1695 wrqu->encoding.flags |= IW_ENCODE_OPEN;
1696 break;
1697 }
1698
1699 down_write(&priv->mib_sem);
1700 wpa = priv->wpa;
1701 up_write(&priv->mib_sem);
1702
1703 if (authen == DOT11_AUTH_OS && !exunencrypt && !invoke && !wpa) {
1704 /* No encryption */
1705 ext->alg = IW_ENCODE_ALG_NONE;
1706 ext->key_len = 0;
1707 wrqu->encoding.flags |= IW_ENCODE_DISABLED;
1708 } else {
1709 struct obj_key *key;
1710
1711 ret = mgt_get_request(priv, DOT11_OID_DEFKEYX, idx, NULL, &r);
1712 if (ret < 0)
1713 goto out;
1714 key = r.ptr;
1715 if (max_key_len < key->length) {
1716 ret = -E2BIG;
1717 goto out;
1718 }
1719 memcpy(ext->key, key->key, key->length);
1720 ext->key_len = key->length;
1721
1722 switch (key->type) {
1723 case DOT11_PRIV_TKIP:
1724 ext->alg = IW_ENCODE_ALG_TKIP;
1725 break;
1726 default:
1727 case DOT11_PRIV_WEP:
1728 ext->alg = IW_ENCODE_ALG_WEP;
1729 break;
1730 }
1731 wrqu->encoding.flags |= IW_ENCODE_ENABLED;
1732 }
1733
1734 out:
1735 return ret;
1736 }
1737
1738
1739 static int
1740 prism54_reset(struct net_device *ndev, struct iw_request_info *info,
1741 __u32 * uwrq, char *extra)
1742 {
1743 islpci_reset(netdev_priv(ndev), 0);
1744
1745 return 0;
1746 }
1747
1748 static int
1749 prism54_get_oid(struct net_device *ndev, struct iw_request_info *info,
1750 struct iw_point *dwrq, char *extra)
1751 {
1752 union oid_res_t r;
1753 int rvalue;
1754 enum oid_num_t n = dwrq->flags;
1755
1756 rvalue = mgt_get_request((islpci_private *) ndev->priv, n, 0, NULL, &r);
1757 dwrq->length = mgt_response_to_str(n, &r, extra);
1758 if ((isl_oid[n].flags & OID_FLAG_TYPE) != OID_TYPE_U32)
1759 kfree(r.ptr);
1760 return rvalue;
1761 }
1762
1763 static int
1764 prism54_set_u32(struct net_device *ndev, struct iw_request_info *info,
1765 __u32 * uwrq, char *extra)
1766 {
1767 u32 oid = uwrq[0], u = uwrq[1];
1768
1769 return mgt_set_request((islpci_private *) ndev->priv, oid, 0, &u);
1770 }
1771
1772 static int
1773 prism54_set_raw(struct net_device *ndev, struct iw_request_info *info,
1774 struct iw_point *dwrq, char *extra)
1775 {
1776 u32 oid = dwrq->flags;
1777
1778 return mgt_set_request((islpci_private *) ndev->priv, oid, 0, extra);
1779 }
1780
1781 void
1782 prism54_acl_init(struct islpci_acl *acl)
1783 {
1784 sema_init(&acl->sem, 1);
1785 INIT_LIST_HEAD(&acl->mac_list);
1786 acl->size = 0;
1787 acl->policy = MAC_POLICY_OPEN;
1788 }
1789
1790 static void
1791 prism54_clear_mac(struct islpci_acl *acl)
1792 {
1793 struct list_head *ptr, *next;
1794 struct mac_entry *entry;
1795
1796 if (down_interruptible(&acl->sem))
1797 return;
1798
1799 if (acl->size == 0) {
1800 up(&acl->sem);
1801 return;
1802 }
1803
1804 for (ptr = acl->mac_list.next, next = ptr->next;
1805 ptr != &acl->mac_list; ptr = next, next = ptr->next) {
1806 entry = list_entry(ptr, struct mac_entry, _list);
1807 list_del(ptr);
1808 kfree(entry);
1809 }
1810 acl->size = 0;
1811 up(&acl->sem);
1812 }
1813
1814 void
1815 prism54_acl_clean(struct islpci_acl *acl)
1816 {
1817 prism54_clear_mac(acl);
1818 }
1819
1820 static int
1821 prism54_add_mac(struct net_device *ndev, struct iw_request_info *info,
1822 struct sockaddr *awrq, char *extra)
1823 {
1824 islpci_private *priv = netdev_priv(ndev);
1825 struct islpci_acl *acl = &priv->acl;
1826 struct mac_entry *entry;
1827 struct sockaddr *addr = (struct sockaddr *) extra;
1828
1829 if (addr->sa_family != ARPHRD_ETHER)
1830 return -EOPNOTSUPP;
1831
1832 entry = kmalloc(sizeof (struct mac_entry), GFP_KERNEL);
1833 if (entry == NULL)
1834 return -ENOMEM;
1835
1836 memcpy(entry->addr, addr->sa_data, ETH_ALEN);
1837
1838 if (down_interruptible(&acl->sem)) {
1839 kfree(entry);
1840 return -ERESTARTSYS;
1841 }
1842 list_add_tail(&entry->_list, &acl->mac_list);
1843 acl->size++;
1844 up(&acl->sem);
1845
1846 return 0;
1847 }
1848
1849 static int
1850 prism54_del_mac(struct net_device *ndev, struct iw_request_info *info,
1851 struct sockaddr *awrq, char *extra)
1852 {
1853 islpci_private *priv = netdev_priv(ndev);
1854 struct islpci_acl *acl = &priv->acl;
1855 struct mac_entry *entry;
1856 struct list_head *ptr;
1857 struct sockaddr *addr = (struct sockaddr *) extra;
1858
1859 if (addr->sa_family != ARPHRD_ETHER)
1860 return -EOPNOTSUPP;
1861
1862 if (down_interruptible(&acl->sem))
1863 return -ERESTARTSYS;
1864 for (ptr = acl->mac_list.next; ptr != &acl->mac_list; ptr = ptr->next) {
1865 entry = list_entry(ptr, struct mac_entry, _list);
1866
1867 if (memcmp(entry->addr, addr->sa_data, ETH_ALEN) == 0) {
1868 list_del(ptr);
1869 acl->size--;
1870 kfree(entry);
1871 up(&acl->sem);
1872 return 0;
1873 }
1874 }
1875 up(&acl->sem);
1876 return -EINVAL;
1877 }
1878
1879 static int
1880 prism54_get_mac(struct net_device *ndev, struct iw_request_info *info,
1881 struct iw_point *dwrq, char *extra)
1882 {
1883 islpci_private *priv = netdev_priv(ndev);
1884 struct islpci_acl *acl = &priv->acl;
1885 struct mac_entry *entry;
1886 struct list_head *ptr;
1887 struct sockaddr *dst = (struct sockaddr *) extra;
1888
1889 dwrq->length = 0;
1890
1891 if (down_interruptible(&acl->sem))
1892 return -ERESTARTSYS;
1893
1894 for (ptr = acl->mac_list.next; ptr != &acl->mac_list; ptr = ptr->next) {
1895 entry = list_entry(ptr, struct mac_entry, _list);
1896
1897 memcpy(dst->sa_data, entry->addr, ETH_ALEN);
1898 dst->sa_family = ARPHRD_ETHER;
1899 dwrq->length++;
1900 dst++;
1901 }
1902 up(&acl->sem);
1903 return 0;
1904 }
1905
1906 /* Setting policy also clears the MAC acl, even if we don't change the defaut
1907 * policy
1908 */
1909
1910 static int
1911 prism54_set_policy(struct net_device *ndev, struct iw_request_info *info,
1912 __u32 * uwrq, char *extra)
1913 {
1914 islpci_private *priv = netdev_priv(ndev);
1915 struct islpci_acl *acl = &priv->acl;
1916 u32 mlmeautolevel;
1917
1918 prism54_clear_mac(acl);
1919
1920 if ((*uwrq < MAC_POLICY_OPEN) || (*uwrq > MAC_POLICY_REJECT))
1921 return -EINVAL;
1922
1923 down_write(&priv->mib_sem);
1924
1925 acl->policy = *uwrq;
1926
1927 /* the ACL code needs an intermediate mlmeautolevel */
1928 if ((priv->iw_mode == IW_MODE_MASTER) &&
1929 (acl->policy != MAC_POLICY_OPEN))
1930 mlmeautolevel = DOT11_MLME_INTERMEDIATE;
1931 else
1932 mlmeautolevel = CARD_DEFAULT_MLME_MODE;
1933 if (priv->wpa)
1934 mlmeautolevel = DOT11_MLME_EXTENDED;
1935 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
1936 /* restart the card with our new policy */
1937 if (mgt_commit(priv)) {
1938 up_write(&priv->mib_sem);
1939 return -EIO;
1940 }
1941 up_write(&priv->mib_sem);
1942
1943 return 0;
1944 }
1945
1946 static int
1947 prism54_get_policy(struct net_device *ndev, struct iw_request_info *info,
1948 __u32 * uwrq, char *extra)
1949 {
1950 islpci_private *priv = netdev_priv(ndev);
1951 struct islpci_acl *acl = &priv->acl;
1952
1953 *uwrq = acl->policy;
1954
1955 return 0;
1956 }
1957
1958 /* Return 1 only if client should be accepted. */
1959
1960 static int
1961 prism54_mac_accept(struct islpci_acl *acl, char *mac)
1962 {
1963 struct list_head *ptr;
1964 struct mac_entry *entry;
1965 int res = 0;
1966
1967 if (down_interruptible(&acl->sem))
1968 return -ERESTARTSYS;
1969
1970 if (acl->policy == MAC_POLICY_OPEN) {
1971 up(&acl->sem);
1972 return 1;
1973 }
1974
1975 for (ptr = acl->mac_list.next; ptr != &acl->mac_list; ptr = ptr->next) {
1976 entry = list_entry(ptr, struct mac_entry, _list);
1977 if (memcmp(entry->addr, mac, ETH_ALEN) == 0) {
1978 res = 1;
1979 break;
1980 }
1981 }
1982 res = (acl->policy == MAC_POLICY_ACCEPT) ? !res : res;
1983 up(&acl->sem);
1984
1985 return res;
1986 }
1987
1988 static int
1989 prism54_kick_all(struct net_device *ndev, struct iw_request_info *info,
1990 struct iw_point *dwrq, char *extra)
1991 {
1992 struct obj_mlme *mlme;
1993 int rvalue;
1994
1995 mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
1996 if (mlme == NULL)
1997 return -ENOMEM;
1998
1999 /* Tell the card to kick every client */
2000 mlme->id = 0;
2001 rvalue =
2002 mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
2003 kfree(mlme);
2004
2005 return rvalue;
2006 }
2007
2008 static int
2009 prism54_kick_mac(struct net_device *ndev, struct iw_request_info *info,
2010 struct sockaddr *awrq, char *extra)
2011 {
2012 struct obj_mlme *mlme;
2013 struct sockaddr *addr = (struct sockaddr *) extra;
2014 int rvalue;
2015
2016 if (addr->sa_family != ARPHRD_ETHER)
2017 return -EOPNOTSUPP;
2018
2019 mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
2020 if (mlme == NULL)
2021 return -ENOMEM;
2022
2023 /* Tell the card to only kick the corresponding bastard */
2024 memcpy(mlme->address, addr->sa_data, ETH_ALEN);
2025 mlme->id = -1;
2026 rvalue =
2027 mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
2028
2029 kfree(mlme);
2030
2031 return rvalue;
2032 }
2033
2034 /* Translate a TRAP oid into a wireless event. Called in islpci_mgt_receive. */
2035
2036 static void
2037 format_event(islpci_private *priv, char *dest, const char *str,
2038 const struct obj_mlme *mlme, u16 *length, int error)
2039 {
2040 const u8 *a = mlme->address;
2041 int n = snprintf(dest, IW_CUSTOM_MAX,
2042 "%s %s %2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X %s (%2.2X)",
2043 str,
2044 ((priv->iw_mode == IW_MODE_MASTER) ? "from" : "to"),
2045 a[0], a[1], a[2], a[3], a[4], a[5],
2046 (error ? (mlme->code ? " : REJECTED " : " : ACCEPTED ")
2047 : ""), mlme->code);
2048 BUG_ON(n > IW_CUSTOM_MAX);
2049 *length = n;
2050 }
2051
2052 static void
2053 send_formatted_event(islpci_private *priv, const char *str,
2054 const struct obj_mlme *mlme, int error)
2055 {
2056 union iwreq_data wrqu;
2057 char *memptr;
2058
2059 memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2060 if (!memptr)
2061 return;
2062 wrqu.data.pointer = memptr;
2063 wrqu.data.length = 0;
2064 format_event(priv, memptr, str, mlme, &wrqu.data.length,
2065 error);
2066 wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2067 kfree(memptr);
2068 }
2069
2070 static void
2071 send_simple_event(islpci_private *priv, const char *str)
2072 {
2073 union iwreq_data wrqu;
2074 char *memptr;
2075 int n = strlen(str);
2076
2077 memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2078 if (!memptr)
2079 return;
2080 BUG_ON(n > IW_CUSTOM_MAX);
2081 wrqu.data.pointer = memptr;
2082 wrqu.data.length = n;
2083 strcpy(memptr, str);
2084 wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2085 kfree(memptr);
2086 }
2087
2088 static void
2089 link_changed(struct net_device *ndev, u32 bitrate)
2090 {
2091 islpci_private *priv = netdev_priv(ndev);
2092
2093 if (bitrate) {
2094 if (priv->iw_mode == IW_MODE_INFRA) {
2095 union iwreq_data uwrq;
2096 prism54_get_wap(ndev, NULL, (struct sockaddr *) &uwrq,
2097 NULL);
2098 wireless_send_event(ndev, SIOCGIWAP, &uwrq, NULL);
2099 } else
2100 send_simple_event(netdev_priv(ndev),
2101 "Link established");
2102 } else
2103 send_simple_event(netdev_priv(ndev), "Link lost");
2104 }
2105
2106 /* Beacon/ProbeResp payload header */
2107 struct ieee80211_beacon_phdr {
2108 u8 timestamp[8];
2109 u16 beacon_int;
2110 u16 capab_info;
2111 } __attribute__ ((packed));
2112
2113 #define WLAN_EID_GENERIC 0xdd
2114 static u8 wpa_oid[4] = { 0x00, 0x50, 0xf2, 1 };
2115
2116 #define MAC2STR(a) (a)[0], (a)[1], (a)[2], (a)[3], (a)[4], (a)[5]
2117 #define MACSTR "%02x:%02x:%02x:%02x:%02x:%02x"
2118
2119 static void
2120 prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
2121 u8 *wpa_ie, size_t wpa_ie_len)
2122 {
2123 struct list_head *ptr;
2124 struct islpci_bss_wpa_ie *bss = NULL;
2125
2126 if (wpa_ie_len > MAX_WPA_IE_LEN)
2127 wpa_ie_len = MAX_WPA_IE_LEN;
2128
2129 if (down_interruptible(&priv->wpa_sem))
2130 return;
2131
2132 /* try to use existing entry */
2133 list_for_each(ptr, &priv->bss_wpa_list) {
2134 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2135 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0) {
2136 list_move(&bss->list, &priv->bss_wpa_list);
2137 break;
2138 }
2139 bss = NULL;
2140 }
2141
2142 if (bss == NULL) {
2143 /* add a new BSS entry; if max number of entries is already
2144 * reached, replace the least recently updated */
2145 if (priv->num_bss_wpa >= MAX_BSS_WPA_IE_COUNT) {
2146 bss = list_entry(priv->bss_wpa_list.prev,
2147 struct islpci_bss_wpa_ie, list);
2148 list_del(&bss->list);
2149 } else {
2150 bss = kzalloc(sizeof (*bss), GFP_ATOMIC);
2151 if (bss != NULL)
2152 priv->num_bss_wpa++;
2153 }
2154 if (bss != NULL) {
2155 memcpy(bss->bssid, bssid, ETH_ALEN);
2156 list_add(&bss->list, &priv->bss_wpa_list);
2157 }
2158 }
2159
2160 if (bss != NULL) {
2161 memcpy(bss->wpa_ie, wpa_ie, wpa_ie_len);
2162 bss->wpa_ie_len = wpa_ie_len;
2163 bss->last_update = jiffies;
2164 } else {
2165 printk(KERN_DEBUG "Failed to add BSS WPA entry for " MACSTR
2166 "\n", MAC2STR(bssid));
2167 }
2168
2169 /* expire old entries from WPA list */
2170 while (priv->num_bss_wpa > 0) {
2171 bss = list_entry(priv->bss_wpa_list.prev,
2172 struct islpci_bss_wpa_ie, list);
2173 if (!time_after(jiffies, bss->last_update + 60 * HZ))
2174 break;
2175
2176 list_del(&bss->list);
2177 priv->num_bss_wpa--;
2178 kfree(bss);
2179 }
2180
2181 up(&priv->wpa_sem);
2182 }
2183
2184 static size_t
2185 prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie)
2186 {
2187 struct list_head *ptr;
2188 struct islpci_bss_wpa_ie *bss = NULL;
2189 size_t len = 0;
2190
2191 if (down_interruptible(&priv->wpa_sem))
2192 return 0;
2193
2194 list_for_each(ptr, &priv->bss_wpa_list) {
2195 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2196 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0)
2197 break;
2198 bss = NULL;
2199 }
2200 if (bss) {
2201 len = bss->wpa_ie_len;
2202 memcpy(wpa_ie, bss->wpa_ie, len);
2203 }
2204 up(&priv->wpa_sem);
2205
2206 return len;
2207 }
2208
2209 void
2210 prism54_wpa_bss_ie_init(islpci_private *priv)
2211 {
2212 INIT_LIST_HEAD(&priv->bss_wpa_list);
2213 sema_init(&priv->wpa_sem, 1);
2214 }
2215
2216 void
2217 prism54_wpa_bss_ie_clean(islpci_private *priv)
2218 {
2219 struct list_head *ptr, *n;
2220
2221 list_for_each_safe(ptr, n, &priv->bss_wpa_list) {
2222 struct islpci_bss_wpa_ie *bss;
2223 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2224 kfree(bss);
2225 }
2226 }
2227
2228 static void
2229 prism54_process_bss_data(islpci_private *priv, u32 oid, u8 *addr,
2230 u8 *payload, size_t len)
2231 {
2232 struct ieee80211_beacon_phdr *hdr;
2233 u8 *pos, *end;
2234
2235 if (!priv->wpa)
2236 return;
2237
2238 hdr = (struct ieee80211_beacon_phdr *) payload;
2239 pos = (u8 *) (hdr + 1);
2240 end = payload + len;
2241 while (pos < end) {
2242 if (pos + 2 + pos[1] > end) {
2243 printk(KERN_DEBUG "Parsing Beacon/ProbeResp failed "
2244 "for " MACSTR "\n", MAC2STR(addr));
2245 return;
2246 }
2247 if (pos[0] == WLAN_EID_GENERIC && pos[1] >= 4 &&
2248 memcmp(pos + 2, wpa_oid, 4) == 0) {
2249 prism54_wpa_bss_ie_add(priv, addr, pos, pos[1] + 2);
2250 return;
2251 }
2252 pos += 2 + pos[1];
2253 }
2254 }
2255
2256 static void
2257 handle_request(islpci_private *priv, struct obj_mlme *mlme, enum oid_num_t oid)
2258 {
2259 if (((mlme->state == DOT11_STATE_AUTHING) ||
2260 (mlme->state == DOT11_STATE_ASSOCING))
2261 && mgt_mlme_answer(priv)) {
2262 /* Someone is requesting auth and we must respond. Just send back
2263 * the trap with error code set accordingly.
2264 */
2265 mlme->code = prism54_mac_accept(&priv->acl,
2266 mlme->address) ? 0 : 1;
2267 mgt_set_request(priv, oid, 0, mlme);
2268 }
2269 }
2270
2271 static int
2272 prism54_process_trap_helper(islpci_private *priv, enum oid_num_t oid,
2273 char *data)
2274 {
2275 struct obj_mlme *mlme = (struct obj_mlme *) data;
2276 struct obj_mlmeex *mlmeex = (struct obj_mlmeex *) data;
2277 struct obj_mlmeex *confirm;
2278 u8 wpa_ie[MAX_WPA_IE_LEN];
2279 int wpa_ie_len;
2280 size_t len = 0; /* u16, better? */
2281 u8 *payload = NULL, *pos = NULL;
2282 int ret;
2283
2284 /* I think all trapable objects are listed here.
2285 * Some oids have a EX version. The difference is that they are emitted
2286 * in DOT11_MLME_EXTENDED mode (set with DOT11_OID_MLMEAUTOLEVEL)
2287 * with more info.
2288 * The few events already defined by the wireless tools are not really
2289 * suited. We use the more flexible custom event facility.
2290 */
2291
2292 if (oid >= DOT11_OID_BEACON) {
2293 len = mlmeex->size;
2294 payload = pos = mlmeex->data;
2295 }
2296
2297 /* I fear prism54_process_bss_data won't work with big endian data */
2298 if ((oid == DOT11_OID_BEACON) || (oid == DOT11_OID_PROBE))
2299 prism54_process_bss_data(priv, oid, mlmeex->address,
2300 payload, len);
2301
2302 mgt_le_to_cpu(isl_oid[oid].flags & OID_FLAG_TYPE, (void *) mlme);
2303
2304 switch (oid) {
2305
2306 case GEN_OID_LINKSTATE:
2307 link_changed(priv->ndev, (u32) *data);
2308 break;
2309
2310 case DOT11_OID_MICFAILURE:
2311 send_simple_event(priv, "Mic failure");
2312 break;
2313
2314 case DOT11_OID_DEAUTHENTICATE:
2315 send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2316 break;
2317
2318 case DOT11_OID_AUTHENTICATE:
2319 handle_request(priv, mlme, oid);
2320 send_formatted_event(priv, "Authenticate request", mlme, 1);
2321 break;
2322
2323 case DOT11_OID_DISASSOCIATE:
2324 send_formatted_event(priv, "Disassociate request", mlme, 0);
2325 break;
2326
2327 case DOT11_OID_ASSOCIATE:
2328 handle_request(priv, mlme, oid);
2329 send_formatted_event(priv, "Associate request", mlme, 1);
2330 break;
2331
2332 case DOT11_OID_REASSOCIATE:
2333 handle_request(priv, mlme, oid);
2334 send_formatted_event(priv, "ReAssociate request", mlme, 1);
2335 break;
2336
2337 case DOT11_OID_BEACON:
2338 send_formatted_event(priv,
2339 "Received a beacon from an unkown AP",
2340 mlme, 0);
2341 break;
2342
2343 case DOT11_OID_PROBE:
2344 /* we received a probe from a client. */
2345 send_formatted_event(priv, "Received a probe from client", mlme,
2346 0);
2347 break;
2348
2349 /* Note : "mlme" is actually a "struct obj_mlmeex *" here, but this
2350 * is backward compatible layout-wise with "struct obj_mlme".
2351 */
2352
2353 case DOT11_OID_DEAUTHENTICATEEX:
2354 send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2355 break;
2356
2357 case DOT11_OID_AUTHENTICATEEX:
2358 handle_request(priv, mlme, oid);
2359 send_formatted_event(priv, "Authenticate request (ex)", mlme, 1);
2360
2361 if (priv->iw_mode != IW_MODE_MASTER
2362 && mlmeex->state != DOT11_STATE_AUTHING)
2363 break;
2364
2365 confirm = kmalloc(sizeof(struct obj_mlmeex) + 6, GFP_ATOMIC);
2366
2367 if (!confirm)
2368 break;
2369
2370 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2371 printk(KERN_DEBUG "Authenticate from: address:\t%02x:%02x:%02x:%02x:%02x:%02x\n",
2372 mlmeex->address[0],
2373 mlmeex->address[1],
2374 mlmeex->address[2],
2375 mlmeex->address[3],
2376 mlmeex->address[4],
2377 mlmeex->address[5]
2378 );
2379 confirm->id = -1; /* or mlmeex->id ? */
2380 confirm->state = 0; /* not used */
2381 confirm->code = 0;
2382 confirm->size = 6;
2383 confirm->data[0] = 0x00;
2384 confirm->data[1] = 0x00;
2385 confirm->data[2] = 0x02;
2386 confirm->data[3] = 0x00;
2387 confirm->data[4] = 0x00;
2388 confirm->data[5] = 0x00;
2389
2390 ret = mgt_set_varlen(priv, DOT11_OID_ASSOCIATEEX, confirm, 6);
2391
2392 kfree(confirm);
2393 if (ret)
2394 return ret;
2395 break;
2396
2397 case DOT11_OID_DISASSOCIATEEX:
2398 send_formatted_event(priv, "Disassociate request (ex)", mlme, 0);
2399 break;
2400
2401 case DOT11_OID_ASSOCIATEEX:
2402 handle_request(priv, mlme, oid);
2403 send_formatted_event(priv, "Associate request (ex)", mlme, 1);
2404
2405 if (priv->iw_mode != IW_MODE_MASTER
2406 && mlmeex->state != DOT11_STATE_ASSOCING)
2407 break;
2408
2409 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2410
2411 if (!confirm)
2412 break;
2413
2414 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2415
2416 confirm->id = ((struct obj_mlmeex *)mlme)->id;
2417 confirm->state = 0; /* not used */
2418 confirm->code = 0;
2419
2420 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2421
2422 if (!wpa_ie_len) {
2423 printk(KERN_DEBUG "No WPA IE found from "
2424 "address:\t%02x:%02x:%02x:%02x:%02x:%02x\n",
2425 mlmeex->address[0],
2426 mlmeex->address[1],
2427 mlmeex->address[2],
2428 mlmeex->address[3],
2429 mlmeex->address[4],
2430 mlmeex->address[5]
2431 );
2432 kfree(confirm);
2433 break;
2434 }
2435
2436 confirm->size = wpa_ie_len;
2437 memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2438
2439 mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2440
2441 kfree(confirm);
2442
2443 break;
2444
2445 case DOT11_OID_REASSOCIATEEX:
2446 handle_request(priv, mlme, oid);
2447 send_formatted_event(priv, "Reassociate request (ex)", mlme, 1);
2448
2449 if (priv->iw_mode != IW_MODE_MASTER
2450 && mlmeex->state != DOT11_STATE_ASSOCING)
2451 break;
2452
2453 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2454
2455 if (!confirm)
2456 break;
2457
2458 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2459
2460 confirm->id = mlmeex->id;
2461 confirm->state = 0; /* not used */
2462 confirm->code = 0;
2463
2464 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2465
2466 if (!wpa_ie_len) {
2467 printk(KERN_DEBUG "No WPA IE found from "
2468 "address:\t%02x:%02x:%02x:%02x:%02x:%02x\n",
2469 mlmeex->address[0],
2470 mlmeex->address[1],
2471 mlmeex->address[2],
2472 mlmeex->address[3],
2473 mlmeex->address[4],
2474 mlmeex->address[5]
2475 );
2476 kfree(confirm);
2477 break;
2478 }
2479
2480 confirm->size = wpa_ie_len;
2481 memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2482
2483 mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2484
2485 kfree(confirm);
2486
2487 break;
2488
2489 default:
2490 return -EINVAL;
2491 }
2492
2493 return 0;
2494 }
2495
2496 /*
2497 * Process a device trap. This is called via schedule_work(), outside of
2498 * interrupt context, no locks held.
2499 */
2500 void
2501 prism54_process_trap(struct work_struct *work)
2502 {
2503 struct islpci_mgmtframe *frame =
2504 container_of(work, struct islpci_mgmtframe, ws);
2505 struct net_device *ndev = frame->ndev;
2506 enum oid_num_t n = mgt_oidtonum(frame->header->oid);
2507
2508 if (n != OID_NUM_LAST)
2509 prism54_process_trap_helper(netdev_priv(ndev), n, frame->data);
2510 islpci_mgt_release(frame);
2511 }
2512
2513 int
2514 prism54_set_mac_address(struct net_device *ndev, void *addr)
2515 {
2516 islpci_private *priv = netdev_priv(ndev);
2517 int ret;
2518
2519 if (ndev->addr_len != 6)
2520 return -EINVAL;
2521 ret = mgt_set_request(priv, GEN_OID_MACADDRESS, 0,
2522 &((struct sockaddr *) addr)->sa_data);
2523 if (!ret)
2524 memcpy(priv->ndev->dev_addr,
2525 &((struct sockaddr *) addr)->sa_data, 6);
2526
2527 return ret;
2528 }
2529
2530 /* Note: currently, use hostapd ioctl from the Host AP driver for WPA
2531 * support. This is to be replaced with Linux wireless extensions once they
2532 * get WPA support. */
2533
2534 /* Note II: please leave all this together as it will be easier to remove later,
2535 * once wireless extensions add WPA support -mcgrof */
2536
2537 /* PRISM54_HOSTAPD ioctl() cmd: */
2538 enum {
2539 PRISM2_SET_ENCRYPTION = 6,
2540 PRISM2_HOSTAPD_SET_GENERIC_ELEMENT = 12,
2541 PRISM2_HOSTAPD_MLME = 13,
2542 PRISM2_HOSTAPD_SCAN_REQ = 14,
2543 };
2544
2545 #define PRISM54_SET_WPA SIOCIWFIRSTPRIV+12
2546 #define PRISM54_HOSTAPD SIOCIWFIRSTPRIV+25
2547 #define PRISM54_DROP_UNENCRYPTED SIOCIWFIRSTPRIV+26
2548
2549 #define PRISM2_HOSTAPD_MAX_BUF_SIZE 1024
2550 #define PRISM2_HOSTAPD_GENERIC_ELEMENT_HDR_LEN \
2551 ((int) (&((struct prism2_hostapd_param *) 0)->u.generic_elem.data))
2552
2553 /* Maximum length for algorithm names (-1 for nul termination)
2554 * used in ioctl() */
2555 #define HOSTAP_CRYPT_ALG_NAME_LEN 16
2556
2557 struct prism2_hostapd_param {
2558 u32 cmd;
2559 u8 sta_addr[ETH_ALEN];
2560 union {
2561 struct {
2562 u8 alg[HOSTAP_CRYPT_ALG_NAME_LEN];
2563 u32 flags;
2564 u32 err;
2565 u8 idx;
2566 u8 seq[8]; /* sequence counter (set: RX, get: TX) */
2567 u16 key_len;
2568 u8 key[0];
2569 } crypt;
2570 struct {
2571 u8 len;
2572 u8 data[0];
2573 } generic_elem;
2574 struct {
2575 #define MLME_STA_DEAUTH 0
2576 #define MLME_STA_DISASSOC 1
2577 u16 cmd;
2578 u16 reason_code;
2579 } mlme;
2580 struct {
2581 u8 ssid_len;
2582 u8 ssid[32];
2583 } scan_req;
2584 } u;
2585 };
2586
2587
2588 static int
2589 prism2_ioctl_set_encryption(struct net_device *dev,
2590 struct prism2_hostapd_param *param,
2591 int param_len)
2592 {
2593 islpci_private *priv = netdev_priv(dev);
2594 int rvalue = 0, force = 0;
2595 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
2596 union oid_res_t r;
2597
2598 /* with the new API, it's impossible to get a NULL pointer.
2599 * New version of iwconfig set the IW_ENCODE_NOKEY flag
2600 * when no key is given, but older versions don't. */
2601
2602 if (param->u.crypt.key_len > 0) {
2603 /* we have a key to set */
2604 int index = param->u.crypt.idx;
2605 int current_index;
2606 struct obj_key key = { DOT11_PRIV_TKIP, 0, "" };
2607
2608 /* get the current key index */
2609 rvalue = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
2610 current_index = r.u;
2611 /* Verify that the key is not marked as invalid */
2612 if (!(param->u.crypt.flags & IW_ENCODE_NOKEY)) {
2613 key.length = param->u.crypt.key_len > sizeof (param->u.crypt.key) ?
2614 sizeof (param->u.crypt.key) : param->u.crypt.key_len;
2615 memcpy(key.key, param->u.crypt.key, key.length);
2616 if (key.length == 32)
2617 /* we want WPA-PSK */
2618 key.type = DOT11_PRIV_TKIP;
2619 if ((index < 0) || (index > 3))
2620 /* no index provided use the current one */
2621 index = current_index;
2622
2623 /* now send the key to the card */
2624 rvalue |=
2625 mgt_set_request(priv, DOT11_OID_DEFKEYX, index,
2626 &key);
2627 }
2628 /*
2629 * If a valid key is set, encryption should be enabled
2630 * (user may turn it off later).
2631 * This is also how "iwconfig ethX key on" works
2632 */
2633 if ((index == current_index) && (key.length > 0))
2634 force = 1;
2635 } else {
2636 int index = (param->u.crypt.flags & IW_ENCODE_INDEX) - 1;
2637 if ((index >= 0) && (index <= 3)) {
2638 /* we want to set the key index */
2639 rvalue |=
2640 mgt_set_request(priv, DOT11_OID_DEFKEYID, 0,
2641 &index);
2642 } else {
2643 if (!param->u.crypt.flags & IW_ENCODE_MODE) {
2644 /* we cannot do anything. Complain. */
2645 return -EINVAL;
2646 }
2647 }
2648 }
2649 /* now read the flags */
2650 if (param->u.crypt.flags & IW_ENCODE_DISABLED) {
2651 /* Encoding disabled,
2652 * authen = DOT11_AUTH_OS;
2653 * invoke = 0;
2654 * exunencrypt = 0; */
2655 }
2656 if (param->u.crypt.flags & IW_ENCODE_OPEN)
2657 /* Encode but accept non-encoded packets. No auth */
2658 invoke = 1;
2659 if ((param->u.crypt.flags & IW_ENCODE_RESTRICTED) || force) {
2660 /* Refuse non-encoded packets. Auth */
2661 authen = DOT11_AUTH_BOTH;
2662 invoke = 1;
2663 exunencrypt = 1;
2664 }
2665 /* do the change if requested */
2666 if ((param->u.crypt.flags & IW_ENCODE_MODE) || force) {
2667 rvalue |=
2668 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
2669 rvalue |=
2670 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &invoke);
2671 rvalue |=
2672 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
2673 &exunencrypt);
2674 }
2675 return rvalue;
2676 }
2677
2678 static int
2679 prism2_ioctl_set_generic_element(struct net_device *ndev,
2680 struct prism2_hostapd_param *param,
2681 int param_len)
2682 {
2683 islpci_private *priv = netdev_priv(ndev);
2684 int max_len, len, alen, ret=0;
2685 struct obj_attachment *attach;
2686
2687 len = param->u.generic_elem.len;
2688 max_len = param_len - PRISM2_HOSTAPD_GENERIC_ELEMENT_HDR_LEN;
2689 if (max_len < 0 || max_len < len)
2690 return -EINVAL;
2691
2692 alen = sizeof(*attach) + len;
2693 attach = kzalloc(alen, GFP_KERNEL);
2694 if (attach == NULL)
2695 return -ENOMEM;
2696
2697 #define WLAN_FC_TYPE_MGMT 0
2698 #define WLAN_FC_STYPE_ASSOC_REQ 0
2699 #define WLAN_FC_STYPE_REASSOC_REQ 2
2700
2701 /* Note: endianness is covered by mgt_set_varlen */
2702
2703 attach->type = (WLAN_FC_TYPE_MGMT << 2) |
2704 (WLAN_FC_STYPE_ASSOC_REQ << 4);
2705 attach->id = -1;
2706 attach->size = len;
2707 memcpy(attach->data, param->u.generic_elem.data, len);
2708
2709 ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach, len);
2710
2711 if (ret == 0) {
2712 attach->type = (WLAN_FC_TYPE_MGMT << 2) |
2713 (WLAN_FC_STYPE_REASSOC_REQ << 4);
2714
2715 ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach, len);
2716
2717 if (ret == 0)
2718 printk(KERN_DEBUG "%s: WPA IE Attachment was set\n",
2719 ndev->name);
2720 }
2721
2722 kfree(attach);
2723 return ret;
2724
2725 }
2726
2727 static int
2728 prism2_ioctl_mlme(struct net_device *dev, struct prism2_hostapd_param *param)
2729 {
2730 return -EOPNOTSUPP;
2731 }
2732
2733 static int
2734 prism2_ioctl_scan_req(struct net_device *ndev,
2735 struct prism2_hostapd_param *param)
2736 {
2737 islpci_private *priv = netdev_priv(ndev);
2738 int i, rvalue;
2739 struct obj_bsslist *bsslist;
2740 u32 noise = 0;
2741 char *extra = "";
2742 char *current_ev = "foo";
2743 union oid_res_t r;
2744
2745 if (islpci_get_state(priv) < PRV_STATE_INIT) {
2746 /* device is not ready, fail gently */
2747 return 0;
2748 }
2749
2750 /* first get the noise value. We will use it to report the link quality */
2751 rvalue = mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
2752 noise = r.u;
2753
2754 /* Ask the device for a list of known bss. We can report at most
2755 * IW_MAX_AP=64 to the range struct. But the device won't repport anything
2756 * if you change the value of IWMAX_BSS=24.
2757 */
2758 rvalue |= mgt_get_request(priv, DOT11_OID_BSSLIST, 0, NULL, &r);
2759 bsslist = r.ptr;
2760
2761 /* ok now, scan the list and translate its info */
2762 for (i = 0; i < min(IW_MAX_AP, (int) bsslist->nr); i++)
2763 current_ev = prism54_translate_bss(ndev, current_ev,
2764 extra + IW_SCAN_MAX_DATA,
2765 &(bsslist->bsslist[i]),
2766 noise);
2767 kfree(bsslist);
2768
2769 return rvalue;
2770 }
2771
2772 static int
2773 prism54_hostapd(struct net_device *ndev, struct iw_point *p)
2774 {
2775 struct prism2_hostapd_param *param;
2776 int ret = 0;
2777 u32 uwrq;
2778
2779 printk(KERN_DEBUG "prism54_hostapd - len=%d\n", p->length);
2780 if (p->length < sizeof(struct prism2_hostapd_param) ||
2781 p->length > PRISM2_HOSTAPD_MAX_BUF_SIZE || !p->pointer)
2782 return -EINVAL;
2783
2784 param = kmalloc(p->length, GFP_KERNEL);
2785 if (param == NULL)
2786 return -ENOMEM;
2787
2788 if (copy_from_user(param, p->pointer, p->length)) {
2789 kfree(param);
2790 return -EFAULT;
2791 }
2792
2793 switch (param->cmd) {
2794 case PRISM2_SET_ENCRYPTION:
2795 printk(KERN_DEBUG "%s: Caught WPA supplicant set encryption request\n",
2796 ndev->name);
2797 ret = prism2_ioctl_set_encryption(ndev, param, p->length);
2798 break;
2799 case PRISM2_HOSTAPD_SET_GENERIC_ELEMENT:
2800 printk(KERN_DEBUG "%s: Caught WPA supplicant set WPA IE request\n",
2801 ndev->name);
2802 ret = prism2_ioctl_set_generic_element(ndev, param,
2803 p->length);
2804 break;
2805 case PRISM2_HOSTAPD_MLME:
2806 printk(KERN_DEBUG "%s: Caught WPA supplicant MLME request\n",
2807 ndev->name);
2808 ret = prism2_ioctl_mlme(ndev, param);
2809 break;
2810 case PRISM2_HOSTAPD_SCAN_REQ:
2811 printk(KERN_DEBUG "%s: Caught WPA supplicant scan request\n",
2812 ndev->name);
2813 ret = prism2_ioctl_scan_req(ndev, param);
2814 break;
2815 case PRISM54_SET_WPA:
2816 printk(KERN_DEBUG "%s: Caught WPA supplicant wpa init request\n",
2817 ndev->name);
2818 uwrq = 1;
2819 ret = prism54_set_wpa(ndev, NULL, &uwrq, NULL);
2820 break;
2821 case PRISM54_DROP_UNENCRYPTED:
2822 printk(KERN_DEBUG "%s: Caught WPA drop unencrypted request\n",
2823 ndev->name);
2824 #if 0
2825 uwrq = 0x01;
2826 mgt_set(priv, DOT11_OID_EXUNENCRYPTED, &uwrq);
2827 down_write(&priv->mib_sem);
2828 mgt_commit(priv);
2829 up_write(&priv->mib_sem);
2830 #endif
2831 /* Not necessary, as set_wpa does it, should we just do it here though? */
2832 ret = 0;
2833 break;
2834 default:
2835 printk(KERN_DEBUG "%s: Caught a WPA supplicant request that is not supported\n",
2836 ndev->name);
2837 ret = -EOPNOTSUPP;
2838 break;
2839 }
2840
2841 if (ret == 0 && copy_to_user(p->pointer, param, p->length))
2842 ret = -EFAULT;
2843
2844 kfree(param);
2845
2846 return ret;
2847 }
2848
2849 static int
2850 prism54_set_wpa(struct net_device *ndev, struct iw_request_info *info,
2851 __u32 * uwrq, char *extra)
2852 {
2853 islpci_private *priv = netdev_priv(ndev);
2854 u32 mlme, authen, dot1x, filter, wep;
2855
2856 if (islpci_get_state(priv) < PRV_STATE_INIT)
2857 return 0;
2858
2859 wep = 1; /* For privacy invoked */
2860 filter = 1; /* Filter out all unencrypted frames */
2861 dot1x = 0x01; /* To enable eap filter */
2862 mlme = DOT11_MLME_EXTENDED;
2863 authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
2864
2865 down_write(&priv->mib_sem);
2866 priv->wpa = *uwrq;
2867
2868 switch (priv->wpa) {
2869 default:
2870 case 0: /* Clears/disables WPA and friends */
2871 wep = 0;
2872 filter = 0; /* Do not filter un-encrypted data */
2873 dot1x = 0;
2874 mlme = DOT11_MLME_AUTO;
2875 printk("%s: Disabling WPA\n", ndev->name);
2876 break;
2877 case 2:
2878 case 1: /* WPA */
2879 printk("%s: Enabling WPA\n", ndev->name);
2880 break;
2881 }
2882 up_write(&priv->mib_sem);
2883
2884 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
2885 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &wep);
2886 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &filter);
2887 mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x);
2888 mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlme);
2889
2890 return 0;
2891 }
2892
2893 static int
2894 prism54_get_wpa(struct net_device *ndev, struct iw_request_info *info,
2895 __u32 * uwrq, char *extra)
2896 {
2897 islpci_private *priv = netdev_priv(ndev);
2898 *uwrq = priv->wpa;
2899 return 0;
2900 }
2901
2902 static int
2903 prism54_set_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2904 __u32 * uwrq, char *extra)
2905 {
2906 islpci_private *priv = netdev_priv(ndev);
2907 priv->monitor_type =
2908 (*uwrq ? ARPHRD_IEEE80211_PRISM : ARPHRD_IEEE80211);
2909 if (priv->iw_mode == IW_MODE_MONITOR)
2910 priv->ndev->type = priv->monitor_type;
2911
2912 return 0;
2913 }
2914
2915 static int
2916 prism54_get_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2917 __u32 * uwrq, char *extra)
2918 {
2919 islpci_private *priv = netdev_priv(ndev);
2920 *uwrq = (priv->monitor_type == ARPHRD_IEEE80211_PRISM);
2921 return 0;
2922 }
2923
2924 static int
2925 prism54_debug_oid(struct net_device *ndev, struct iw_request_info *info,
2926 __u32 * uwrq, char *extra)
2927 {
2928 islpci_private *priv = netdev_priv(ndev);
2929
2930 priv->priv_oid = *uwrq;
2931 printk("%s: oid 0x%08X\n", ndev->name, *uwrq);
2932
2933 return 0;
2934 }
2935
2936 static int
2937 prism54_debug_get_oid(struct net_device *ndev, struct iw_request_info *info,
2938 struct iw_point *data, char *extra)
2939 {
2940 islpci_private *priv = netdev_priv(ndev);
2941 struct islpci_mgmtframe *response;
2942 int ret = -EIO;
2943
2944 printk("%s: get_oid 0x%08X\n", ndev->name, priv->priv_oid);
2945 data->length = 0;
2946
2947 if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2948 ret =
2949 islpci_mgt_transaction(priv->ndev, PIMFOR_OP_GET,
2950 priv->priv_oid, extra, 256,
2951 &response);
2952 printk("%s: ret: %i\n", ndev->name, ret);
2953 if (ret || !response
2954 || response->header->operation == PIMFOR_OP_ERROR) {
2955 if (response) {
2956 islpci_mgt_release(response);
2957 }
2958 printk("%s: EIO\n", ndev->name);
2959 ret = -EIO;
2960 }
2961 if (!ret) {
2962 data->length = response->header->length;
2963 memcpy(extra, response->data, data->length);
2964 islpci_mgt_release(response);
2965 printk("%s: len: %i\n", ndev->name, data->length);
2966 }
2967 }
2968
2969 return ret;
2970 }
2971
2972 static int
2973 prism54_debug_set_oid(struct net_device *ndev, struct iw_request_info *info,
2974 struct iw_point *data, char *extra)
2975 {
2976 islpci_private *priv = netdev_priv(ndev);
2977 struct islpci_mgmtframe *response;
2978 int ret = 0, response_op = PIMFOR_OP_ERROR;
2979
2980 printk("%s: set_oid 0x%08X\tlen: %d\n", ndev->name, priv->priv_oid,
2981 data->length);
2982
2983 if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2984 ret =
2985 islpci_mgt_transaction(priv->ndev, PIMFOR_OP_SET,
2986 priv->priv_oid, extra, data->length,
2987 &response);
2988 printk("%s: ret: %i\n", ndev->name, ret);
2989 if (ret || !response
2990 || response->header->operation == PIMFOR_OP_ERROR) {
2991 if (response) {
2992 islpci_mgt_release(response);
2993 }
2994 printk("%s: EIO\n", ndev->name);
2995 ret = -EIO;
2996 }
2997 if (!ret) {
2998 response_op = response->header->operation;
2999 printk("%s: response_op: %i\n", ndev->name,
3000 response_op);
3001 islpci_mgt_release(response);
3002 }
3003 }
3004
3005 return (ret ? ret : -EINPROGRESS);
3006 }
3007
3008 static int
3009 prism54_set_spy(struct net_device *ndev,
3010 struct iw_request_info *info,
3011 union iwreq_data *uwrq, char *extra)
3012 {
3013 islpci_private *priv = netdev_priv(ndev);
3014 u32 u, oid = OID_INL_CONFIG;
3015
3016 down_write(&priv->mib_sem);
3017 mgt_get(priv, OID_INL_CONFIG, &u);
3018
3019 if ((uwrq->data.length == 0) && (priv->spy_data.spy_number > 0))
3020 /* disable spy */
3021 u &= ~INL_CONFIG_RXANNEX;
3022 else if ((uwrq->data.length > 0) && (priv->spy_data.spy_number == 0))
3023 /* enable spy */
3024 u |= INL_CONFIG_RXANNEX;
3025
3026 mgt_set(priv, OID_INL_CONFIG, &u);
3027 mgt_commit_list(priv, &oid, 1);
3028 up_write(&priv->mib_sem);
3029
3030 return iw_handler_set_spy(ndev, info, uwrq, extra);
3031 }
3032
3033 static const iw_handler prism54_handler[] = {
3034 (iw_handler) prism54_commit, /* SIOCSIWCOMMIT */
3035 (iw_handler) prism54_get_name, /* SIOCGIWNAME */
3036 (iw_handler) NULL, /* SIOCSIWNWID */
3037 (iw_handler) NULL, /* SIOCGIWNWID */
3038 (iw_handler) prism54_set_freq, /* SIOCSIWFREQ */
3039 (iw_handler) prism54_get_freq, /* SIOCGIWFREQ */
3040 (iw_handler) prism54_set_mode, /* SIOCSIWMODE */
3041 (iw_handler) prism54_get_mode, /* SIOCGIWMODE */
3042 (iw_handler) prism54_set_sens, /* SIOCSIWSENS */
3043 (iw_handler) prism54_get_sens, /* SIOCGIWSENS */
3044 (iw_handler) NULL, /* SIOCSIWRANGE */
3045 (iw_handler) prism54_get_range, /* SIOCGIWRANGE */
3046 (iw_handler) NULL, /* SIOCSIWPRIV */
3047 (iw_handler) NULL, /* SIOCGIWPRIV */
3048 (iw_handler) NULL, /* SIOCSIWSTATS */
3049 (iw_handler) NULL, /* SIOCGIWSTATS */
3050 prism54_set_spy, /* SIOCSIWSPY */
3051 iw_handler_get_spy, /* SIOCGIWSPY */
3052 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
3053 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
3054 (iw_handler) prism54_set_wap, /* SIOCSIWAP */
3055 (iw_handler) prism54_get_wap, /* SIOCGIWAP */
3056 (iw_handler) NULL, /* -- hole -- */
3057 (iw_handler) NULL, /* SIOCGIWAPLIST deprecated */
3058 (iw_handler) prism54_set_scan, /* SIOCSIWSCAN */
3059 (iw_handler) prism54_get_scan, /* SIOCGIWSCAN */
3060 (iw_handler) prism54_set_essid, /* SIOCSIWESSID */
3061 (iw_handler) prism54_get_essid, /* SIOCGIWESSID */
3062 (iw_handler) prism54_set_nick, /* SIOCSIWNICKN */
3063 (iw_handler) prism54_get_nick, /* SIOCGIWNICKN */
3064 (iw_handler) NULL, /* -- hole -- */
3065 (iw_handler) NULL, /* -- hole -- */
3066 (iw_handler) prism54_set_rate, /* SIOCSIWRATE */
3067 (iw_handler) prism54_get_rate, /* SIOCGIWRATE */
3068 (iw_handler) prism54_set_rts, /* SIOCSIWRTS */
3069 (iw_handler) prism54_get_rts, /* SIOCGIWRTS */
3070 (iw_handler) prism54_set_frag, /* SIOCSIWFRAG */
3071 (iw_handler) prism54_get_frag, /* SIOCGIWFRAG */
3072 (iw_handler) prism54_set_txpower, /* SIOCSIWTXPOW */
3073 (iw_handler) prism54_get_txpower, /* SIOCGIWTXPOW */
3074 (iw_handler) prism54_set_retry, /* SIOCSIWRETRY */
3075 (iw_handler) prism54_get_retry, /* SIOCGIWRETRY */
3076 (iw_handler) prism54_set_encode, /* SIOCSIWENCODE */
3077 (iw_handler) prism54_get_encode, /* SIOCGIWENCODE */
3078 (iw_handler) NULL, /* SIOCSIWPOWER */
3079 (iw_handler) NULL, /* SIOCGIWPOWER */
3080 NULL, /* -- hole -- */
3081 NULL, /* -- hole -- */
3082 (iw_handler) prism54_set_genie, /* SIOCSIWGENIE */
3083 (iw_handler) prism54_get_genie, /* SIOCGIWGENIE */
3084 (iw_handler) prism54_set_auth, /* SIOCSIWAUTH */
3085 (iw_handler) prism54_get_auth, /* SIOCGIWAUTH */
3086 (iw_handler) prism54_set_encodeext, /* SIOCSIWENCODEEXT */
3087 (iw_handler) prism54_get_encodeext, /* SIOCGIWENCODEEXT */
3088 NULL, /* SIOCSIWPMKSA */
3089 };
3090
3091 /* The low order bit identify a SET (0) or a GET (1) ioctl. */
3092
3093 #define PRISM54_RESET SIOCIWFIRSTPRIV
3094 #define PRISM54_GET_POLICY SIOCIWFIRSTPRIV+1
3095 #define PRISM54_SET_POLICY SIOCIWFIRSTPRIV+2
3096 #define PRISM54_GET_MAC SIOCIWFIRSTPRIV+3
3097 #define PRISM54_ADD_MAC SIOCIWFIRSTPRIV+4
3098
3099 #define PRISM54_DEL_MAC SIOCIWFIRSTPRIV+6
3100
3101 #define PRISM54_KICK_MAC SIOCIWFIRSTPRIV+8
3102
3103 #define PRISM54_KICK_ALL SIOCIWFIRSTPRIV+10
3104
3105 #define PRISM54_GET_WPA SIOCIWFIRSTPRIV+11
3106 #define PRISM54_SET_WPA SIOCIWFIRSTPRIV+12
3107
3108 #define PRISM54_DBG_OID SIOCIWFIRSTPRIV+14
3109 #define PRISM54_DBG_GET_OID SIOCIWFIRSTPRIV+15
3110 #define PRISM54_DBG_SET_OID SIOCIWFIRSTPRIV+16
3111
3112 #define PRISM54_GET_OID SIOCIWFIRSTPRIV+17
3113 #define PRISM54_SET_OID_U32 SIOCIWFIRSTPRIV+18
3114 #define PRISM54_SET_OID_STR SIOCIWFIRSTPRIV+20
3115 #define PRISM54_SET_OID_ADDR SIOCIWFIRSTPRIV+22
3116
3117 #define PRISM54_GET_PRISMHDR SIOCIWFIRSTPRIV+23
3118 #define PRISM54_SET_PRISMHDR SIOCIWFIRSTPRIV+24
3119
3120 #define IWPRIV_SET_U32(n,x) { n, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
3121 #define IWPRIV_SET_SSID(n,x) { n, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
3122 #define IWPRIV_SET_ADDR(n,x) { n, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
3123 #define IWPRIV_GET(n,x) { n, 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, "g_"x }
3124
3125 #define IWPRIV_U32(n,x) IWPRIV_SET_U32(n,x), IWPRIV_GET(n,x)
3126 #define IWPRIV_SSID(n,x) IWPRIV_SET_SSID(n,x), IWPRIV_GET(n,x)
3127 #define IWPRIV_ADDR(n,x) IWPRIV_SET_ADDR(n,x), IWPRIV_GET(n,x)
3128
3129 /* Note : limited to 128 private ioctls (wireless tools 26) */
3130
3131 static const struct iw_priv_args prism54_private_args[] = {
3132 /*{ cmd, set_args, get_args, name } */
3133 {PRISM54_RESET, 0, 0, "reset"},
3134 {PRISM54_GET_PRISMHDR, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3135 "get_prismhdr"},
3136 {PRISM54_SET_PRISMHDR, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
3137 "set_prismhdr"},
3138 {PRISM54_GET_POLICY, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3139 "getPolicy"},
3140 {PRISM54_SET_POLICY, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
3141 "setPolicy"},
3142 {PRISM54_GET_MAC, 0, IW_PRIV_TYPE_ADDR | 64, "getMac"},
3143 {PRISM54_ADD_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
3144 "addMac"},
3145 {PRISM54_DEL_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
3146 "delMac"},
3147 {PRISM54_KICK_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
3148 "kickMac"},
3149 {PRISM54_KICK_ALL, 0, 0, "kickAll"},
3150 {PRISM54_GET_WPA, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
3151 "get_wpa"},
3152 {PRISM54_SET_WPA, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
3153 "set_wpa"},
3154 {PRISM54_DBG_OID, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
3155 "dbg_oid"},
3156 {PRISM54_DBG_GET_OID, 0, IW_PRIV_TYPE_BYTE | 256, "dbg_get_oid"},
3157 {PRISM54_DBG_SET_OID, IW_PRIV_TYPE_BYTE | 256, 0, "dbg_set_oid"},
3158 /* --- sub-ioctls handlers --- */
3159 {PRISM54_GET_OID,
3160 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, ""},
3161 {PRISM54_SET_OID_U32,
3162 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, ""},
3163 {PRISM54_SET_OID_STR,
3164 IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
3165 {PRISM54_SET_OID_ADDR,
3166 IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
3167 /* --- sub-ioctls definitions --- */
3168 IWPRIV_ADDR(GEN_OID_MACADDRESS, "addr"),
3169 IWPRIV_GET(GEN_OID_LINKSTATE, "linkstate"),
3170 IWPRIV_U32(DOT11_OID_BSSTYPE, "bsstype"),
3171 IWPRIV_ADDR(DOT11_OID_BSSID, "bssid"),
3172 IWPRIV_U32(DOT11_OID_STATE, "state"),
3173 IWPRIV_U32(DOT11_OID_AID, "aid"),
3174
3175 IWPRIV_SSID(DOT11_OID_SSIDOVERRIDE, "ssidoverride"),
3176
3177 IWPRIV_U32(DOT11_OID_MEDIUMLIMIT, "medlimit"),
3178 IWPRIV_U32(DOT11_OID_BEACONPERIOD, "beacon"),
3179 IWPRIV_U32(DOT11_OID_DTIMPERIOD, "dtimperiod"),
3180
3181 IWPRIV_U32(DOT11_OID_AUTHENABLE, "authenable"),
3182 IWPRIV_U32(DOT11_OID_PRIVACYINVOKED, "privinvok"),
3183 IWPRIV_U32(DOT11_OID_EXUNENCRYPTED, "exunencrypt"),
3184
3185 IWPRIV_U32(DOT11_OID_REKEYTHRESHOLD, "rekeythresh"),
3186
3187 IWPRIV_U32(DOT11_OID_MAXTXLIFETIME, "maxtxlife"),
3188 IWPRIV_U32(DOT11_OID_MAXRXLIFETIME, "maxrxlife"),
3189 IWPRIV_U32(DOT11_OID_ALOFT_FIXEDRATE, "fixedrate"),
3190 IWPRIV_U32(DOT11_OID_MAXFRAMEBURST, "frameburst"),
3191 IWPRIV_U32(DOT11_OID_PSM, "psm"),
3192
3193 IWPRIV_U32(DOT11_OID_BRIDGELOCAL, "bridge"),
3194 IWPRIV_U32(DOT11_OID_CLIENTS, "clients"),
3195 IWPRIV_U32(DOT11_OID_CLIENTSASSOCIATED, "clientassoc"),
3196 IWPRIV_U32(DOT11_OID_DOT1XENABLE, "dot1xenable"),
3197 IWPRIV_U32(DOT11_OID_ANTENNARX, "rxant"),
3198 IWPRIV_U32(DOT11_OID_ANTENNATX, "txant"),
3199 IWPRIV_U32(DOT11_OID_ANTENNADIVERSITY, "antdivers"),
3200 IWPRIV_U32(DOT11_OID_EDTHRESHOLD, "edthresh"),
3201 IWPRIV_U32(DOT11_OID_PREAMBLESETTINGS, "preamble"),
3202 IWPRIV_GET(DOT11_OID_RATES, "rates"),
3203 IWPRIV_U32(DOT11_OID_OUTPUTPOWER, ".11outpower"),
3204 IWPRIV_GET(DOT11_OID_SUPPORTEDRATES, "supprates"),
3205 IWPRIV_GET(DOT11_OID_SUPPORTEDFREQUENCIES, "suppfreq"),
3206
3207 IWPRIV_U32(DOT11_OID_NOISEFLOOR, "noisefloor"),
3208 IWPRIV_GET(DOT11_OID_FREQUENCYACTIVITY, "freqactivity"),
3209 IWPRIV_U32(DOT11_OID_NONERPPROTECTION, "nonerpprotec"),
3210 IWPRIV_U32(DOT11_OID_PROFILES, "profile"),
3211 IWPRIV_GET(DOT11_OID_EXTENDEDRATES, "extrates"),
3212 IWPRIV_U32(DOT11_OID_MLMEAUTOLEVEL, "mlmelevel"),
3213
3214 IWPRIV_GET(DOT11_OID_BSSS, "bsss"),
3215 IWPRIV_GET(DOT11_OID_BSSLIST, "bsslist"),
3216 IWPRIV_U32(OID_INL_MODE, "mode"),
3217 IWPRIV_U32(OID_INL_CONFIG, "config"),
3218 IWPRIV_U32(OID_INL_DOT11D_CONFORMANCE, ".11dconform"),
3219 IWPRIV_GET(OID_INL_PHYCAPABILITIES, "phycapa"),
3220 IWPRIV_U32(OID_INL_OUTPUTPOWER, "outpower"),
3221 };
3222
3223 static const iw_handler prism54_private_handler[] = {
3224 (iw_handler) prism54_reset,
3225 (iw_handler) prism54_get_policy,
3226 (iw_handler) prism54_set_policy,
3227 (iw_handler) prism54_get_mac,
3228 (iw_handler) prism54_add_mac,
3229 (iw_handler) NULL,
3230 (iw_handler) prism54_del_mac,
3231 (iw_handler) NULL,
3232 (iw_handler) prism54_kick_mac,
3233 (iw_handler) NULL,
3234 (iw_handler) prism54_kick_all,
3235 (iw_handler) prism54_get_wpa,
3236 (iw_handler) prism54_set_wpa,
3237 (iw_handler) NULL,
3238 (iw_handler) prism54_debug_oid,
3239 (iw_handler) prism54_debug_get_oid,
3240 (iw_handler) prism54_debug_set_oid,
3241 (iw_handler) prism54_get_oid,
3242 (iw_handler) prism54_set_u32,
3243 (iw_handler) NULL,
3244 (iw_handler) prism54_set_raw,
3245 (iw_handler) NULL,
3246 (iw_handler) prism54_set_raw,
3247 (iw_handler) prism54_get_prismhdr,
3248 (iw_handler) prism54_set_prismhdr,
3249 };
3250
3251 const struct iw_handler_def prism54_handler_def = {
3252 .num_standard = sizeof (prism54_handler) / sizeof (iw_handler),
3253 .num_private = sizeof (prism54_private_handler) / sizeof (iw_handler),
3254 .num_private_args =
3255 sizeof (prism54_private_args) / sizeof (struct iw_priv_args),
3256 .standard = (iw_handler *) prism54_handler,
3257 .private = (iw_handler *) prism54_private_handler,
3258 .private_args = (struct iw_priv_args *) prism54_private_args,
3259 .get_wireless_stats = prism54_get_wireless_stats,
3260 };
3261
3262 /* For wpa_supplicant */
3263
3264 int
3265 prism54_ioctl(struct net_device *ndev, struct ifreq *rq, int cmd)
3266 {
3267 struct iwreq *wrq = (struct iwreq *) rq;
3268 int ret = -1;
3269 switch (cmd) {
3270 case PRISM54_HOSTAPD:
3271 if (!capable(CAP_NET_ADMIN))
3272 return -EPERM;
3273 ret = prism54_hostapd(ndev, &wrq->u.data);
3274 return ret;
3275 }
3276 return -EOPNOTSUPP;
3277 }
Tomato firmware and modifications.