Loading...
Note: File does not exist in v6.8.
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, see <http://www.gnu.org/licenses/>.
18 *
19 */
20
21#include <linux/capability.h>
22#include <linux/module.h>
23#include <linux/kernel.h>
24#include <linux/if_arp.h>
25#include <linux/slab.h>
26#include <linux/pci.h>
27#include <linux/etherdevice.h>
28
29#include <linux/uaccess.h>
30
31#include "prismcompat.h"
32#include "isl_ioctl.h"
33#include "islpci_mgt.h"
34#include "isl_oid.h" /* additional types and defs for isl38xx fw */
35#include "oid_mgt.h"
36
37#include <net/iw_handler.h> /* New driver API */
38
39#define KEY_SIZE_WEP104 13 /* 104/128-bit WEP keys */
40#define KEY_SIZE_WEP40 5 /* 40/64-bit WEP keys */
41/* KEY_SIZE_TKIP should match isl_oid.h, struct obj_key.key[] size */
42#define KEY_SIZE_TKIP 32 /* TKIP keys */
43
44static void prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
45 u8 *wpa_ie, size_t wpa_ie_len);
46static size_t prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie);
47static int prism54_set_wpa(struct net_device *, struct iw_request_info *,
48 __u32 *, char *);
49
50/* In 500 kbps */
51static const unsigned char scan_rate_list[] = { 2, 4, 11, 22,
52 12, 18, 24, 36,
53 48, 72, 96, 108 };
54
55/**
56 * prism54_mib_mode_helper - MIB change mode helper function
57 * @mib: the &struct islpci_mib object to modify
58 * @iw_mode: new mode (%IW_MODE_*)
59 *
60 * This is a helper function, hence it does not lock. Make sure
61 * caller deals with locking *if* necessary. This function sets the
62 * mode-dependent mib values and does the mapping of the Linux
63 * Wireless API modes to Device firmware modes. It also checks for
64 * correct valid Linux wireless modes.
65 */
66static int
67prism54_mib_mode_helper(islpci_private *priv, u32 iw_mode)
68{
69 u32 config = INL_CONFIG_MANUALRUN;
70 u32 mode, bsstype;
71
72 /* For now, just catch early the Repeater and Secondary modes here */
73 if (iw_mode == IW_MODE_REPEAT || iw_mode == IW_MODE_SECOND) {
74 printk(KERN_DEBUG
75 "%s(): Sorry, Repeater mode and Secondary mode "
76 "are not yet supported by this driver.\n", __func__);
77 return -EINVAL;
78 }
79
80 priv->iw_mode = iw_mode;
81
82 switch (iw_mode) {
83 case IW_MODE_AUTO:
84 mode = INL_MODE_CLIENT;
85 bsstype = DOT11_BSSTYPE_ANY;
86 break;
87 case IW_MODE_ADHOC:
88 mode = INL_MODE_CLIENT;
89 bsstype = DOT11_BSSTYPE_IBSS;
90 break;
91 case IW_MODE_INFRA:
92 mode = INL_MODE_CLIENT;
93 bsstype = DOT11_BSSTYPE_INFRA;
94 break;
95 case IW_MODE_MASTER:
96 mode = INL_MODE_AP;
97 bsstype = DOT11_BSSTYPE_INFRA;
98 break;
99 case IW_MODE_MONITOR:
100 mode = INL_MODE_PROMISCUOUS;
101 bsstype = DOT11_BSSTYPE_ANY;
102 config |= INL_CONFIG_RXANNEX;
103 break;
104 default:
105 return -EINVAL;
106 }
107
108 if (init_wds)
109 config |= INL_CONFIG_WDS;
110 mgt_set(priv, DOT11_OID_BSSTYPE, &bsstype);
111 mgt_set(priv, OID_INL_CONFIG, &config);
112 mgt_set(priv, OID_INL_MODE, &mode);
113
114 return 0;
115}
116
117/**
118 * prism54_mib_init - fill MIB cache with defaults
119 *
120 * this function initializes the struct given as @mib with defaults,
121 * of which many are retrieved from the global module parameter
122 * variables.
123 */
124
125void
126prism54_mib_init(islpci_private *priv)
127{
128 u32 channel, authen, wep, filter, dot1x, mlme, conformance, power, mode;
129 struct obj_buffer psm_buffer = {
130 .size = PSM_BUFFER_SIZE,
131 .addr = priv->device_psm_buffer
132 };
133
134 channel = CARD_DEFAULT_CHANNEL;
135 authen = CARD_DEFAULT_AUTHEN;
136 wep = CARD_DEFAULT_WEP;
137 filter = CARD_DEFAULT_FILTER; /* (0) Do not filter un-encrypted data */
138 dot1x = CARD_DEFAULT_DOT1X;
139 mlme = CARD_DEFAULT_MLME_MODE;
140 conformance = CARD_DEFAULT_CONFORMANCE;
141 power = 127;
142 mode = CARD_DEFAULT_IW_MODE;
143
144 mgt_set(priv, DOT11_OID_CHANNEL, &channel);
145 mgt_set(priv, DOT11_OID_AUTHENABLE, &authen);
146 mgt_set(priv, DOT11_OID_PRIVACYINVOKED, &wep);
147 mgt_set(priv, DOT11_OID_PSMBUFFER, &psm_buffer);
148 mgt_set(priv, DOT11_OID_EXUNENCRYPTED, &filter);
149 mgt_set(priv, DOT11_OID_DOT1XENABLE, &dot1x);
150 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlme);
151 mgt_set(priv, OID_INL_DOT11D_CONFORMANCE, &conformance);
152 mgt_set(priv, OID_INL_OUTPUTPOWER, &power);
153
154 /* This sets all of the mode-dependent values */
155 prism54_mib_mode_helper(priv, mode);
156}
157
158/* this will be executed outside of atomic context thanks to
159 * schedule_work(), thus we can as well use sleeping semaphore
160 * locking */
161void
162prism54_update_stats(struct work_struct *work)
163{
164 islpci_private *priv = container_of(work, islpci_private, stats_work);
165 char *data;
166 int j;
167 struct obj_bss bss, *bss2;
168 union oid_res_t r;
169
170 mutex_lock(&priv->stats_lock);
171
172/* Noise floor.
173 * I'm not sure if the unit is dBm.
174 * Note : If we are not connected, this value seems to be irrelevant. */
175
176 mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
177 priv->local_iwstatistics.qual.noise = r.u;
178
179/* Get the rssi of the link. To do this we need to retrieve a bss. */
180
181 /* First get the MAC address of the AP we are associated with. */
182 mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
183 data = r.ptr;
184
185 /* copy this MAC to the bss */
186 memcpy(bss.address, data, ETH_ALEN);
187 kfree(data);
188
189 /* now ask for the corresponding bss */
190 j = mgt_get_request(priv, DOT11_OID_BSSFIND, 0, (void *) &bss, &r);
191 bss2 = r.ptr;
192 /* report the rssi and use it to calculate
193 * link quality through a signal-noise
194 * ratio */
195 priv->local_iwstatistics.qual.level = bss2->rssi;
196 priv->local_iwstatistics.qual.qual =
197 bss2->rssi - priv->iwstatistics.qual.noise;
198
199 kfree(bss2);
200
201 /* report that the stats are new */
202 priv->local_iwstatistics.qual.updated = 0x7;
203
204/* Rx : unable to decrypt the MPDU */
205 mgt_get_request(priv, DOT11_OID_PRIVRXFAILED, 0, NULL, &r);
206 priv->local_iwstatistics.discard.code = r.u;
207
208/* Tx : Max MAC retries num reached */
209 mgt_get_request(priv, DOT11_OID_MPDUTXFAILED, 0, NULL, &r);
210 priv->local_iwstatistics.discard.retries = r.u;
211
212 mutex_unlock(&priv->stats_lock);
213}
214
215struct iw_statistics *
216prism54_get_wireless_stats(struct net_device *ndev)
217{
218 islpci_private *priv = netdev_priv(ndev);
219
220 /* If the stats are being updated return old data */
221 if (mutex_trylock(&priv->stats_lock)) {
222 memcpy(&priv->iwstatistics, &priv->local_iwstatistics,
223 sizeof (struct iw_statistics));
224 /* They won't be marked updated for the next time */
225 priv->local_iwstatistics.qual.updated = 0;
226 mutex_unlock(&priv->stats_lock);
227 } else
228 priv->iwstatistics.qual.updated = 0;
229
230 /* Update our wireless stats, but do not schedule to often
231 * (max 1 HZ) */
232 if ((priv->stats_timestamp == 0) ||
233 time_after(jiffies, priv->stats_timestamp + 1 * HZ)) {
234 schedule_work(&priv->stats_work);
235 priv->stats_timestamp = jiffies;
236 }
237
238 return &priv->iwstatistics;
239}
240
241static int
242prism54_commit(struct net_device *ndev, struct iw_request_info *info,
243 char *cwrq, char *extra)
244{
245 islpci_private *priv = netdev_priv(ndev);
246
247 /* simply re-set the last set SSID, this should commit most stuff */
248
249 /* Commit in Monitor mode is not necessary, also setting essid
250 * in Monitor mode does not make sense and isn't allowed for this
251 * device's firmware */
252 if (priv->iw_mode != IW_MODE_MONITOR)
253 return mgt_set_request(priv, DOT11_OID_SSID, 0, NULL);
254 return 0;
255}
256
257static int
258prism54_get_name(struct net_device *ndev, struct iw_request_info *info,
259 char *cwrq, char *extra)
260{
261 islpci_private *priv = netdev_priv(ndev);
262 char *capabilities;
263 union oid_res_t r;
264 int rvalue;
265
266 if (islpci_get_state(priv) < PRV_STATE_INIT) {
267 strncpy(cwrq, "NOT READY!", IFNAMSIZ);
268 return 0;
269 }
270 rvalue = mgt_get_request(priv, OID_INL_PHYCAPABILITIES, 0, NULL, &r);
271
272 switch (r.u) {
273 case INL_PHYCAP_5000MHZ:
274 capabilities = "IEEE 802.11a/b/g";
275 break;
276 case INL_PHYCAP_FAA:
277 capabilities = "IEEE 802.11b/g - FAA Support";
278 break;
279 case INL_PHYCAP_2400MHZ:
280 default:
281 capabilities = "IEEE 802.11b/g"; /* Default */
282 break;
283 }
284 strncpy(cwrq, capabilities, IFNAMSIZ);
285 return rvalue;
286}
287
288static int
289prism54_set_freq(struct net_device *ndev, struct iw_request_info *info,
290 struct iw_freq *fwrq, char *extra)
291{
292 islpci_private *priv = netdev_priv(ndev);
293 int rvalue;
294 u32 c;
295
296 if (fwrq->m < 1000)
297 /* we have a channel number */
298 c = fwrq->m;
299 else
300 c = (fwrq->e == 1) ? channel_of_freq(fwrq->m / 100000) : 0;
301
302 rvalue = c ? mgt_set_request(priv, DOT11_OID_CHANNEL, 0, &c) : -EINVAL;
303
304 /* Call commit handler */
305 return (rvalue ? rvalue : -EINPROGRESS);
306}
307
308static int
309prism54_get_freq(struct net_device *ndev, struct iw_request_info *info,
310 struct iw_freq *fwrq, char *extra)
311{
312 islpci_private *priv = netdev_priv(ndev);
313 union oid_res_t r;
314 int rvalue;
315
316 rvalue = mgt_get_request(priv, DOT11_OID_CHANNEL, 0, NULL, &r);
317 fwrq->i = r.u;
318 rvalue |= mgt_get_request(priv, DOT11_OID_FREQUENCY, 0, NULL, &r);
319 fwrq->m = r.u;
320 fwrq->e = 3;
321
322 return rvalue;
323}
324
325static int
326prism54_set_mode(struct net_device *ndev, struct iw_request_info *info,
327 __u32 * uwrq, char *extra)
328{
329 islpci_private *priv = netdev_priv(ndev);
330 u32 mlmeautolevel = CARD_DEFAULT_MLME_MODE;
331
332 /* Let's see if the user passed a valid Linux Wireless mode */
333 if (*uwrq > IW_MODE_MONITOR || *uwrq < IW_MODE_AUTO) {
334 printk(KERN_DEBUG
335 "%s: %s() You passed a non-valid init_mode.\n",
336 priv->ndev->name, __func__);
337 return -EINVAL;
338 }
339
340 down_write(&priv->mib_sem);
341
342 if (prism54_mib_mode_helper(priv, *uwrq)) {
343 up_write(&priv->mib_sem);
344 return -EOPNOTSUPP;
345 }
346
347 /* the ACL code needs an intermediate mlmeautolevel. The wpa stuff an
348 * extended one.
349 */
350 if ((*uwrq == IW_MODE_MASTER) && (priv->acl.policy != MAC_POLICY_OPEN))
351 mlmeautolevel = DOT11_MLME_INTERMEDIATE;
352 if (priv->wpa)
353 mlmeautolevel = DOT11_MLME_EXTENDED;
354
355 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
356
357 if (mgt_commit(priv)) {
358 up_write(&priv->mib_sem);
359 return -EIO;
360 }
361 priv->ndev->type = (priv->iw_mode == IW_MODE_MONITOR)
362 ? priv->monitor_type : ARPHRD_ETHER;
363 up_write(&priv->mib_sem);
364
365 return 0;
366}
367
368/* Use mib cache */
369static int
370prism54_get_mode(struct net_device *ndev, struct iw_request_info *info,
371 __u32 * uwrq, char *extra)
372{
373 islpci_private *priv = netdev_priv(ndev);
374
375 BUG_ON((priv->iw_mode < IW_MODE_AUTO) || (priv->iw_mode >
376 IW_MODE_MONITOR));
377 *uwrq = priv->iw_mode;
378
379 return 0;
380}
381
382/* we use DOT11_OID_EDTHRESHOLD. From what I guess the card will not try to
383 * emit data if (sensitivity > rssi - noise) (in dBm).
384 * prism54_set_sens does not seem to work.
385 */
386
387static int
388prism54_set_sens(struct net_device *ndev, struct iw_request_info *info,
389 struct iw_param *vwrq, char *extra)
390{
391 islpci_private *priv = netdev_priv(ndev);
392 u32 sens;
393
394 /* by default the card sets this to 20. */
395 sens = vwrq->disabled ? 20 : vwrq->value;
396
397 return mgt_set_request(priv, DOT11_OID_EDTHRESHOLD, 0, &sens);
398}
399
400static int
401prism54_get_sens(struct net_device *ndev, struct iw_request_info *info,
402 struct iw_param *vwrq, char *extra)
403{
404 islpci_private *priv = netdev_priv(ndev);
405 union oid_res_t r;
406 int rvalue;
407
408 rvalue = mgt_get_request(priv, DOT11_OID_EDTHRESHOLD, 0, NULL, &r);
409
410 vwrq->value = r.u;
411 vwrq->disabled = (vwrq->value == 0);
412 vwrq->fixed = 1;
413
414 return rvalue;
415}
416
417static int
418prism54_get_range(struct net_device *ndev, struct iw_request_info *info,
419 struct iw_point *dwrq, char *extra)
420{
421 struct iw_range *range = (struct iw_range *) extra;
422 islpci_private *priv = netdev_priv(ndev);
423 u8 *data;
424 int i, m, rvalue;
425 struct obj_frequencies *freq;
426 union oid_res_t r;
427
428 memset(range, 0, sizeof (struct iw_range));
429 dwrq->length = sizeof (struct iw_range);
430
431 /* set the wireless extension version number */
432 range->we_version_source = SUPPORTED_WIRELESS_EXT;
433 range->we_version_compiled = WIRELESS_EXT;
434
435 /* Now the encoding capabilities */
436 range->num_encoding_sizes = 3;
437 /* 64(40) bits WEP */
438 range->encoding_size[0] = 5;
439 /* 128(104) bits WEP */
440 range->encoding_size[1] = 13;
441 /* 256 bits for WPA-PSK */
442 range->encoding_size[2] = 32;
443 /* 4 keys are allowed */
444 range->max_encoding_tokens = 4;
445
446 /* we don't know the quality range... */
447 range->max_qual.level = 0;
448 range->max_qual.noise = 0;
449 range->max_qual.qual = 0;
450 /* these value describe an average quality. Needs more tweaking... */
451 range->avg_qual.level = -80; /* -80 dBm */
452 range->avg_qual.noise = 0; /* don't know what to put here */
453 range->avg_qual.qual = 0;
454
455 range->sensitivity = 200;
456
457 /* retry limit capabilities */
458 range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
459 range->retry_flags = IW_RETRY_LIMIT;
460 range->r_time_flags = IW_RETRY_LIFETIME;
461
462 /* I don't know the range. Put stupid things here */
463 range->min_retry = 1;
464 range->max_retry = 65535;
465 range->min_r_time = 1024;
466 range->max_r_time = 65535 * 1024;
467
468 /* txpower is supported in dBm's */
469 range->txpower_capa = IW_TXPOW_DBM;
470
471 /* Event capability (kernel + driver) */
472 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
473 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
474 IW_EVENT_CAPA_MASK(SIOCGIWAP));
475 range->event_capa[1] = IW_EVENT_CAPA_K_1;
476 range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVCUSTOM);
477
478 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
479 IW_ENC_CAPA_CIPHER_TKIP;
480
481 if (islpci_get_state(priv) < PRV_STATE_INIT)
482 return 0;
483
484 /* Request the device for the supported frequencies
485 * not really relevant since some devices will report the 5 GHz band
486 * frequencies even if they don't support them.
487 */
488 rvalue =
489 mgt_get_request(priv, DOT11_OID_SUPPORTEDFREQUENCIES, 0, NULL, &r);
490 freq = r.ptr;
491
492 range->num_channels = freq->nr;
493 range->num_frequency = freq->nr;
494
495 m = min(IW_MAX_FREQUENCIES, (int) freq->nr);
496 for (i = 0; i < m; i++) {
497 range->freq[i].m = freq->mhz[i];
498 range->freq[i].e = 6;
499 range->freq[i].i = channel_of_freq(freq->mhz[i]);
500 }
501 kfree(freq);
502
503 rvalue |= mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r);
504 data = r.ptr;
505
506 /* We got an array of char. It is NULL terminated. */
507 i = 0;
508 while ((i < IW_MAX_BITRATES) && (*data != 0)) {
509 /* the result must be in bps. The card gives us 500Kbps */
510 range->bitrate[i] = *data * 500000;
511 i++;
512 data++;
513 }
514 range->num_bitrates = i;
515 kfree(r.ptr);
516
517 return rvalue;
518}
519
520/* Set AP address*/
521
522static int
523prism54_set_wap(struct net_device *ndev, struct iw_request_info *info,
524 struct sockaddr *awrq, char *extra)
525{
526 islpci_private *priv = netdev_priv(ndev);
527 char bssid[6];
528 int rvalue;
529
530 if (awrq->sa_family != ARPHRD_ETHER)
531 return -EINVAL;
532
533 /* prepare the structure for the set object */
534 memcpy(&bssid[0], awrq->sa_data, ETH_ALEN);
535
536 /* set the bssid -- does this make sense when in AP mode? */
537 rvalue = mgt_set_request(priv, DOT11_OID_BSSID, 0, &bssid);
538
539 return (rvalue ? rvalue : -EINPROGRESS); /* Call commit handler */
540}
541
542/* get AP address*/
543
544static int
545prism54_get_wap(struct net_device *ndev, struct iw_request_info *info,
546 struct sockaddr *awrq, char *extra)
547{
548 islpci_private *priv = netdev_priv(ndev);
549 union oid_res_t r;
550 int rvalue;
551
552 rvalue = mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
553 memcpy(awrq->sa_data, r.ptr, ETH_ALEN);
554 awrq->sa_family = ARPHRD_ETHER;
555 kfree(r.ptr);
556
557 return rvalue;
558}
559
560static int
561prism54_set_scan(struct net_device *dev, struct iw_request_info *info,
562 struct iw_param *vwrq, char *extra)
563{
564 /* hehe the device does this automagicaly */
565 return 0;
566}
567
568/* a little helper that will translate our data into a card independent
569 * format that the Wireless Tools will understand. This was inspired by
570 * the "Aironet driver for 4500 and 4800 series cards" (GPL)
571 */
572
573static char *
574prism54_translate_bss(struct net_device *ndev, struct iw_request_info *info,
575 char *current_ev, char *end_buf, struct obj_bss *bss,
576 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, ETH_ALEN);
586 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
587 iwe.cmd = SIOCGIWAP;
588 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
589 &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(info, 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 = iwe_stream_add_event(info, current_ev, end_buf,
615 &iwe, IW_EV_UINT_LEN);
616
617 /* Encryption capability */
618 if (cap & CAP_CRYPT)
619 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
620 else
621 iwe.u.data.flags = IW_ENCODE_DISABLED;
622 iwe.u.data.length = 0;
623 iwe.cmd = SIOCGIWENCODE;
624 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
625 &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 = iwe_stream_add_event(info, current_ev, end_buf,
632 &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 = iwe_stream_add_event(info, current_ev, end_buf,
641 &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_t(size_t, wpa_ie_len, MAX_WPA_IE_LEN);
648 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
649 &iwe, wpa_ie);
650 }
651 /* Do the bitrates */
652 {
653 char *current_val = current_ev + iwe_stream_lcp_len(info);
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(
667 info, current_ev, current_val,
668 end_buf, &iwe, IW_EV_PARAM_LEN);
669 }
670 mask <<= 1;
671 }
672 /* Check if we added any event */
673 if ((current_val - current_ev) > iwe_stream_lcp_len(info))
674 current_ev = current_val;
675 }
676
677 return current_ev;
678}
679
680static int
681prism54_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, info, 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
734static int
735prism54_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
761static int
762prism54_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[dwrq->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 */
791static int
792prism54_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
808static int
809prism54_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
826static int
827prism54_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 */
899static int
900prism54_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
927static int
928prism54_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
936static int
937prism54_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
951static int
952prism54_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
960static int
961prism54_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
981static int
982prism54_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
1023static int
1024prism54_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
1055static int
1056prism54_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
1156static int
1157prism54_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 == -1 || 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
1204static int
1205prism54_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
1224static int
1225prism54_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, __func__);
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, __func__);
1246 return -ENOTSUPP;
1247 }
1248}
1249
1250static 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
1299static 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
1320static 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
1443out:
1444 return ret;
1445}
1446
1447static 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 break;
1507 case DOT11_AUTH_NONE:
1508 default:
1509 param->value = 0;
1510 break;
1511 }
1512 }
1513 break;
1514
1515 case IW_AUTH_WPA_ENABLED:
1516 param->value = wpa > 0 ? 1 : 0;
1517 break;
1518
1519 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1520 ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r);
1521 if (ret >= 0)
1522 param->value = r.u > 0 ? 1 : 0;
1523 break;
1524
1525 case IW_AUTH_PRIVACY_INVOKED:
1526 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1527 if (ret >= 0)
1528 param->value = r.u > 0 ? 1 : 0;
1529 break;
1530
1531 default:
1532 return -EOPNOTSUPP;
1533 }
1534 return ret;
1535}
1536
1537static int prism54_set_encodeext(struct net_device *ndev,
1538 struct iw_request_info *info,
1539 union iwreq_data *wrqu,
1540 char *extra)
1541{
1542 islpci_private *priv = netdev_priv(ndev);
1543 struct iw_point *encoding = &wrqu->encoding;
1544 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1545 int idx, alg = ext->alg, set_key = 1;
1546 union oid_res_t r;
1547 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
1548 int ret = 0;
1549
1550 if (islpci_get_state(priv) < PRV_STATE_INIT)
1551 return 0;
1552
1553 /* Determine and validate the key index */
1554 idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1555 if (idx) {
1556 if (idx < 0 || idx > 3)
1557 return -EINVAL;
1558 } else {
1559 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1560 if (ret < 0)
1561 goto out;
1562 idx = r.u;
1563 }
1564
1565 if (encoding->flags & IW_ENCODE_DISABLED)
1566 alg = IW_ENCODE_ALG_NONE;
1567
1568 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
1569 /* Only set transmit key index here, actual
1570 * key is set below if needed.
1571 */
1572 ret = mgt_set_request(priv, DOT11_OID_DEFKEYID, 0, &idx);
1573 set_key = ext->key_len > 0 ? 1 : 0;
1574 }
1575
1576 if (set_key) {
1577 struct obj_key key = { DOT11_PRIV_WEP, 0, "" };
1578 switch (alg) {
1579 case IW_ENCODE_ALG_NONE:
1580 break;
1581 case IW_ENCODE_ALG_WEP:
1582 if (ext->key_len > KEY_SIZE_WEP104) {
1583 ret = -EINVAL;
1584 goto out;
1585 }
1586 if (ext->key_len > KEY_SIZE_WEP40)
1587 key.length = KEY_SIZE_WEP104;
1588 else
1589 key.length = KEY_SIZE_WEP40;
1590 break;
1591 case IW_ENCODE_ALG_TKIP:
1592 if (ext->key_len > KEY_SIZE_TKIP) {
1593 ret = -EINVAL;
1594 goto out;
1595 }
1596 key.type = DOT11_PRIV_TKIP;
1597 key.length = KEY_SIZE_TKIP;
1598 break;
1599 default:
1600 return -EINVAL;
1601 }
1602
1603 if (key.length) {
1604 memset(key.key, 0, sizeof(key.key));
1605 memcpy(key.key, ext->key, ext->key_len);
1606 ret = mgt_set_request(priv, DOT11_OID_DEFKEYX, idx,
1607 &key);
1608 if (ret < 0)
1609 goto out;
1610 }
1611 }
1612
1613 /* Read the flags */
1614 if (encoding->flags & IW_ENCODE_DISABLED) {
1615 /* Encoding disabled,
1616 * authen = DOT11_AUTH_OS;
1617 * invoke = 0;
1618 * exunencrypt = 0; */
1619 }
1620 if (encoding->flags & IW_ENCODE_OPEN) {
1621 /* Encode but accept non-encoded packets. No auth */
1622 invoke = 1;
1623 }
1624 if (encoding->flags & IW_ENCODE_RESTRICTED) {
1625 /* Refuse non-encoded packets. Auth */
1626 authen = DOT11_AUTH_BOTH;
1627 invoke = 1;
1628 exunencrypt = 1;
1629 }
1630
1631 /* do the change if requested */
1632 if (encoding->flags & IW_ENCODE_MODE) {
1633 ret = mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0,
1634 &authen);
1635 ret = mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0,
1636 &invoke);
1637 ret = mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
1638 &exunencrypt);
1639 }
1640
1641out:
1642 return ret;
1643}
1644
1645
1646static int prism54_get_encodeext(struct net_device *ndev,
1647 struct iw_request_info *info,
1648 union iwreq_data *wrqu,
1649 char *extra)
1650{
1651 islpci_private *priv = netdev_priv(ndev);
1652 struct iw_point *encoding = &wrqu->encoding;
1653 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1654 int idx, max_key_len;
1655 union oid_res_t r;
1656 int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0, wpa = 0;
1657 int ret = 0;
1658
1659 if (islpci_get_state(priv) < PRV_STATE_INIT)
1660 return 0;
1661
1662 /* first get the flags */
1663 ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1664 authen = r.u;
1665 ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1666 invoke = r.u;
1667 ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1668 exunencrypt = r.u;
1669 if (ret < 0)
1670 goto out;
1671
1672 max_key_len = encoding->length - sizeof(*ext);
1673 if (max_key_len < 0)
1674 return -EINVAL;
1675
1676 idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1677 if (idx) {
1678 if (idx < 0 || idx > 3)
1679 return -EINVAL;
1680 } else {
1681 ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1682 if (ret < 0)
1683 goto out;
1684 idx = r.u;
1685 }
1686
1687 encoding->flags = idx + 1;
1688 memset(ext, 0, sizeof(*ext));
1689
1690 switch (authen) {
1691 case DOT11_AUTH_BOTH:
1692 case DOT11_AUTH_SK:
1693 wrqu->encoding.flags |= IW_ENCODE_RESTRICTED;
1694 /* fall through */
1695 case DOT11_AUTH_OS:
1696 default:
1697 wrqu->encoding.flags |= IW_ENCODE_OPEN;
1698 break;
1699 }
1700
1701 down_write(&priv->mib_sem);
1702 wpa = priv->wpa;
1703 up_write(&priv->mib_sem);
1704
1705 if (authen == DOT11_AUTH_OS && !exunencrypt && !invoke && !wpa) {
1706 /* No encryption */
1707 ext->alg = IW_ENCODE_ALG_NONE;
1708 ext->key_len = 0;
1709 wrqu->encoding.flags |= IW_ENCODE_DISABLED;
1710 } else {
1711 struct obj_key *key;
1712
1713 ret = mgt_get_request(priv, DOT11_OID_DEFKEYX, idx, NULL, &r);
1714 if (ret < 0)
1715 goto out;
1716 key = r.ptr;
1717 if (max_key_len < key->length) {
1718 ret = -E2BIG;
1719 goto out;
1720 }
1721 memcpy(ext->key, key->key, key->length);
1722 ext->key_len = key->length;
1723
1724 switch (key->type) {
1725 case DOT11_PRIV_TKIP:
1726 ext->alg = IW_ENCODE_ALG_TKIP;
1727 break;
1728 default:
1729 case DOT11_PRIV_WEP:
1730 ext->alg = IW_ENCODE_ALG_WEP;
1731 break;
1732 }
1733 wrqu->encoding.flags |= IW_ENCODE_ENABLED;
1734 }
1735
1736out:
1737 return ret;
1738}
1739
1740
1741static int
1742prism54_reset(struct net_device *ndev, struct iw_request_info *info,
1743 __u32 * uwrq, char *extra)
1744{
1745 islpci_reset(netdev_priv(ndev), 0);
1746
1747 return 0;
1748}
1749
1750static int
1751prism54_get_oid(struct net_device *ndev, struct iw_request_info *info,
1752 struct iw_point *dwrq, char *extra)
1753{
1754 union oid_res_t r;
1755 int rvalue;
1756 enum oid_num_t n = dwrq->flags;
1757
1758 rvalue = mgt_get_request(netdev_priv(ndev), n, 0, NULL, &r);
1759 dwrq->length = mgt_response_to_str(n, &r, extra);
1760 if ((isl_oid[n].flags & OID_FLAG_TYPE) != OID_TYPE_U32)
1761 kfree(r.ptr);
1762 return rvalue;
1763}
1764
1765static int
1766prism54_set_u32(struct net_device *ndev, struct iw_request_info *info,
1767 __u32 * uwrq, char *extra)
1768{
1769 u32 oid = uwrq[0], u = uwrq[1];
1770
1771 return mgt_set_request(netdev_priv(ndev), oid, 0, &u);
1772}
1773
1774static int
1775prism54_set_raw(struct net_device *ndev, struct iw_request_info *info,
1776 struct iw_point *dwrq, char *extra)
1777{
1778 u32 oid = dwrq->flags;
1779
1780 return mgt_set_request(netdev_priv(ndev), oid, 0, extra);
1781}
1782
1783void
1784prism54_acl_init(struct islpci_acl *acl)
1785{
1786 mutex_init(&acl->lock);
1787 INIT_LIST_HEAD(&acl->mac_list);
1788 acl->size = 0;
1789 acl->policy = MAC_POLICY_OPEN;
1790}
1791
1792static void
1793prism54_clear_mac(struct islpci_acl *acl)
1794{
1795 struct list_head *ptr, *next;
1796 struct mac_entry *entry;
1797
1798 mutex_lock(&acl->lock);
1799
1800 if (acl->size == 0) {
1801 mutex_unlock(&acl->lock);
1802 return;
1803 }
1804
1805 for (ptr = acl->mac_list.next, next = ptr->next;
1806 ptr != &acl->mac_list; ptr = next, next = ptr->next) {
1807 entry = list_entry(ptr, struct mac_entry, _list);
1808 list_del(ptr);
1809 kfree(entry);
1810 }
1811 acl->size = 0;
1812 mutex_unlock(&acl->lock);
1813}
1814
1815void
1816prism54_acl_clean(struct islpci_acl *acl)
1817{
1818 prism54_clear_mac(acl);
1819}
1820
1821static int
1822prism54_add_mac(struct net_device *ndev, struct iw_request_info *info,
1823 struct sockaddr *awrq, char *extra)
1824{
1825 islpci_private *priv = netdev_priv(ndev);
1826 struct islpci_acl *acl = &priv->acl;
1827 struct mac_entry *entry;
1828 struct sockaddr *addr = (struct sockaddr *) extra;
1829
1830 if (addr->sa_family != ARPHRD_ETHER)
1831 return -EOPNOTSUPP;
1832
1833 entry = kmalloc(sizeof (struct mac_entry), GFP_KERNEL);
1834 if (entry == NULL)
1835 return -ENOMEM;
1836
1837 memcpy(entry->addr, addr->sa_data, ETH_ALEN);
1838
1839 if (mutex_lock_interruptible(&acl->lock)) {
1840 kfree(entry);
1841 return -ERESTARTSYS;
1842 }
1843 list_add_tail(&entry->_list, &acl->mac_list);
1844 acl->size++;
1845 mutex_unlock(&acl->lock);
1846
1847 return 0;
1848}
1849
1850static int
1851prism54_del_mac(struct net_device *ndev, struct iw_request_info *info,
1852 struct sockaddr *awrq, char *extra)
1853{
1854 islpci_private *priv = netdev_priv(ndev);
1855 struct islpci_acl *acl = &priv->acl;
1856 struct mac_entry *entry;
1857 struct sockaddr *addr = (struct sockaddr *) extra;
1858
1859 if (addr->sa_family != ARPHRD_ETHER)
1860 return -EOPNOTSUPP;
1861
1862 if (mutex_lock_interruptible(&acl->lock))
1863 return -ERESTARTSYS;
1864 list_for_each_entry(entry, &acl->mac_list, _list) {
1865 if (ether_addr_equal(entry->addr, addr->sa_data)) {
1866 list_del(&entry->_list);
1867 acl->size--;
1868 kfree(entry);
1869 mutex_unlock(&acl->lock);
1870 return 0;
1871 }
1872 }
1873 mutex_unlock(&acl->lock);
1874 return -EINVAL;
1875}
1876
1877static int
1878prism54_get_mac(struct net_device *ndev, struct iw_request_info *info,
1879 struct iw_point *dwrq, char *extra)
1880{
1881 islpci_private *priv = netdev_priv(ndev);
1882 struct islpci_acl *acl = &priv->acl;
1883 struct mac_entry *entry;
1884 struct sockaddr *dst = (struct sockaddr *) extra;
1885
1886 dwrq->length = 0;
1887
1888 if (mutex_lock_interruptible(&acl->lock))
1889 return -ERESTARTSYS;
1890
1891 list_for_each_entry(entry, &acl->mac_list, _list) {
1892 memcpy(dst->sa_data, entry->addr, ETH_ALEN);
1893 dst->sa_family = ARPHRD_ETHER;
1894 dwrq->length++;
1895 dst++;
1896 }
1897 mutex_unlock(&acl->lock);
1898 return 0;
1899}
1900
1901/* Setting policy also clears the MAC acl, even if we don't change the default
1902 * policy
1903 */
1904
1905static int
1906prism54_set_policy(struct net_device *ndev, struct iw_request_info *info,
1907 __u32 * uwrq, char *extra)
1908{
1909 islpci_private *priv = netdev_priv(ndev);
1910 struct islpci_acl *acl = &priv->acl;
1911 u32 mlmeautolevel;
1912
1913 prism54_clear_mac(acl);
1914
1915 if ((*uwrq < MAC_POLICY_OPEN) || (*uwrq > MAC_POLICY_REJECT))
1916 return -EINVAL;
1917
1918 down_write(&priv->mib_sem);
1919
1920 acl->policy = *uwrq;
1921
1922 /* the ACL code needs an intermediate mlmeautolevel */
1923 if ((priv->iw_mode == IW_MODE_MASTER) &&
1924 (acl->policy != MAC_POLICY_OPEN))
1925 mlmeautolevel = DOT11_MLME_INTERMEDIATE;
1926 else
1927 mlmeautolevel = CARD_DEFAULT_MLME_MODE;
1928 if (priv->wpa)
1929 mlmeautolevel = DOT11_MLME_EXTENDED;
1930 mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
1931 /* restart the card with our new policy */
1932 if (mgt_commit(priv)) {
1933 up_write(&priv->mib_sem);
1934 return -EIO;
1935 }
1936 up_write(&priv->mib_sem);
1937
1938 return 0;
1939}
1940
1941static int
1942prism54_get_policy(struct net_device *ndev, struct iw_request_info *info,
1943 __u32 * uwrq, char *extra)
1944{
1945 islpci_private *priv = netdev_priv(ndev);
1946 struct islpci_acl *acl = &priv->acl;
1947
1948 *uwrq = acl->policy;
1949
1950 return 0;
1951}
1952
1953/* Return 1 only if client should be accepted. */
1954
1955static int
1956prism54_mac_accept(struct islpci_acl *acl, char *mac)
1957{
1958 struct mac_entry *entry;
1959 int res = 0;
1960
1961 if (mutex_lock_interruptible(&acl->lock))
1962 return -ERESTARTSYS;
1963
1964 if (acl->policy == MAC_POLICY_OPEN) {
1965 mutex_unlock(&acl->lock);
1966 return 1;
1967 }
1968
1969 list_for_each_entry(entry, &acl->mac_list, _list) {
1970 if (memcmp(entry->addr, mac, ETH_ALEN) == 0) {
1971 res = 1;
1972 break;
1973 }
1974 }
1975 res = (acl->policy == MAC_POLICY_ACCEPT) ? !res : res;
1976 mutex_unlock(&acl->lock);
1977
1978 return res;
1979}
1980
1981static int
1982prism54_kick_all(struct net_device *ndev, struct iw_request_info *info,
1983 struct iw_point *dwrq, char *extra)
1984{
1985 struct obj_mlme *mlme;
1986 int rvalue;
1987
1988 mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
1989 if (mlme == NULL)
1990 return -ENOMEM;
1991
1992 /* Tell the card to kick every client */
1993 mlme->id = 0;
1994 rvalue =
1995 mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
1996 kfree(mlme);
1997
1998 return rvalue;
1999}
2000
2001static int
2002prism54_kick_mac(struct net_device *ndev, struct iw_request_info *info,
2003 struct sockaddr *awrq, char *extra)
2004{
2005 struct obj_mlme *mlme;
2006 struct sockaddr *addr = (struct sockaddr *) extra;
2007 int rvalue;
2008
2009 if (addr->sa_family != ARPHRD_ETHER)
2010 return -EOPNOTSUPP;
2011
2012 mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
2013 if (mlme == NULL)
2014 return -ENOMEM;
2015
2016 /* Tell the card to only kick the corresponding bastard */
2017 memcpy(mlme->address, addr->sa_data, ETH_ALEN);
2018 mlme->id = -1;
2019 rvalue =
2020 mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
2021
2022 kfree(mlme);
2023
2024 return rvalue;
2025}
2026
2027/* Translate a TRAP oid into a wireless event. Called in islpci_mgt_receive. */
2028
2029static void
2030format_event(islpci_private *priv, char *dest, const char *str,
2031 const struct obj_mlme *mlme, u16 *length, int error)
2032{
2033 int n = snprintf(dest, IW_CUSTOM_MAX,
2034 "%s %s %pM %s (%2.2X)",
2035 str,
2036 ((priv->iw_mode == IW_MODE_MASTER) ? "from" : "to"),
2037 mlme->address,
2038 (error ? (mlme->code ? " : REJECTED " : " : ACCEPTED ")
2039 : ""), mlme->code);
2040 WARN_ON(n >= IW_CUSTOM_MAX);
2041 *length = n;
2042}
2043
2044static void
2045send_formatted_event(islpci_private *priv, const char *str,
2046 const struct obj_mlme *mlme, int error)
2047{
2048 union iwreq_data wrqu;
2049 char *memptr;
2050
2051 memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2052 if (!memptr)
2053 return;
2054 wrqu.data.pointer = memptr;
2055 wrqu.data.length = 0;
2056 format_event(priv, memptr, str, mlme, &wrqu.data.length,
2057 error);
2058 wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2059 kfree(memptr);
2060}
2061
2062static void
2063send_simple_event(islpci_private *priv, const char *str)
2064{
2065 union iwreq_data wrqu;
2066 char *memptr;
2067 int n = strlen(str);
2068
2069 memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2070 if (!memptr)
2071 return;
2072 BUG_ON(n >= IW_CUSTOM_MAX);
2073 wrqu.data.pointer = memptr;
2074 wrqu.data.length = n;
2075 strcpy(memptr, str);
2076 wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2077 kfree(memptr);
2078}
2079
2080static void
2081link_changed(struct net_device *ndev, u32 bitrate)
2082{
2083 islpci_private *priv = netdev_priv(ndev);
2084
2085 if (bitrate) {
2086 netif_carrier_on(ndev);
2087 if (priv->iw_mode == IW_MODE_INFRA) {
2088 union iwreq_data uwrq;
2089 prism54_get_wap(ndev, NULL, (struct sockaddr *) &uwrq,
2090 NULL);
2091 wireless_send_event(ndev, SIOCGIWAP, &uwrq, NULL);
2092 } else
2093 send_simple_event(netdev_priv(ndev),
2094 "Link established");
2095 } else {
2096 netif_carrier_off(ndev);
2097 send_simple_event(netdev_priv(ndev), "Link lost");
2098 }
2099}
2100
2101/* Beacon/ProbeResp payload header */
2102struct ieee80211_beacon_phdr {
2103 u8 timestamp[8];
2104 u16 beacon_int;
2105 u16 capab_info;
2106} __packed;
2107
2108#define WLAN_EID_GENERIC 0xdd
2109static u8 wpa_oid[4] = { 0x00, 0x50, 0xf2, 1 };
2110
2111static void
2112prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
2113 u8 *wpa_ie, size_t wpa_ie_len)
2114{
2115 struct list_head *ptr;
2116 struct islpci_bss_wpa_ie *bss = NULL;
2117
2118 if (wpa_ie_len > MAX_WPA_IE_LEN)
2119 wpa_ie_len = MAX_WPA_IE_LEN;
2120
2121 mutex_lock(&priv->wpa_lock);
2122
2123 /* try to use existing entry */
2124 list_for_each(ptr, &priv->bss_wpa_list) {
2125 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2126 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0) {
2127 list_move(&bss->list, &priv->bss_wpa_list);
2128 break;
2129 }
2130 bss = NULL;
2131 }
2132
2133 if (bss == NULL) {
2134 /* add a new BSS entry; if max number of entries is already
2135 * reached, replace the least recently updated */
2136 if (priv->num_bss_wpa >= MAX_BSS_WPA_IE_COUNT) {
2137 bss = list_entry(priv->bss_wpa_list.prev,
2138 struct islpci_bss_wpa_ie, list);
2139 list_del(&bss->list);
2140 } else {
2141 bss = kzalloc(sizeof (*bss), GFP_ATOMIC);
2142 if (bss != NULL)
2143 priv->num_bss_wpa++;
2144 }
2145 if (bss != NULL) {
2146 memcpy(bss->bssid, bssid, ETH_ALEN);
2147 list_add(&bss->list, &priv->bss_wpa_list);
2148 }
2149 }
2150
2151 if (bss != NULL) {
2152 memcpy(bss->wpa_ie, wpa_ie, wpa_ie_len);
2153 bss->wpa_ie_len = wpa_ie_len;
2154 bss->last_update = jiffies;
2155 } else {
2156 printk(KERN_DEBUG "Failed to add BSS WPA entry for "
2157 "%pM\n", bssid);
2158 }
2159
2160 /* expire old entries from WPA list */
2161 while (priv->num_bss_wpa > 0) {
2162 bss = list_entry(priv->bss_wpa_list.prev,
2163 struct islpci_bss_wpa_ie, list);
2164 if (!time_after(jiffies, bss->last_update + 60 * HZ))
2165 break;
2166
2167 list_del(&bss->list);
2168 priv->num_bss_wpa--;
2169 kfree(bss);
2170 }
2171
2172 mutex_unlock(&priv->wpa_lock);
2173}
2174
2175static size_t
2176prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie)
2177{
2178 struct list_head *ptr;
2179 struct islpci_bss_wpa_ie *bss = NULL;
2180 size_t len = 0;
2181
2182 mutex_lock(&priv->wpa_lock);
2183
2184 list_for_each(ptr, &priv->bss_wpa_list) {
2185 bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2186 if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0)
2187 break;
2188 bss = NULL;
2189 }
2190 if (bss) {
2191 len = bss->wpa_ie_len;
2192 memcpy(wpa_ie, bss->wpa_ie, len);
2193 }
2194 mutex_unlock(&priv->wpa_lock);
2195
2196 return len;
2197}
2198
2199void
2200prism54_wpa_bss_ie_init(islpci_private *priv)
2201{
2202 INIT_LIST_HEAD(&priv->bss_wpa_list);
2203 mutex_init(&priv->wpa_lock);
2204}
2205
2206void
2207prism54_wpa_bss_ie_clean(islpci_private *priv)
2208{
2209 struct islpci_bss_wpa_ie *bss, *n;
2210
2211 list_for_each_entry_safe(bss, n, &priv->bss_wpa_list, list) {
2212 kfree(bss);
2213 }
2214}
2215
2216static void
2217prism54_process_bss_data(islpci_private *priv, u32 oid, u8 *addr,
2218 u8 *payload, size_t len)
2219{
2220 struct ieee80211_beacon_phdr *hdr;
2221 u8 *pos, *end;
2222
2223 if (!priv->wpa)
2224 return;
2225
2226 hdr = (struct ieee80211_beacon_phdr *) payload;
2227 pos = (u8 *) (hdr + 1);
2228 end = payload + len;
2229 while (pos < end) {
2230 if (pos + 2 + pos[1] > end) {
2231 printk(KERN_DEBUG "Parsing Beacon/ProbeResp failed "
2232 "for %pM\n", addr);
2233 return;
2234 }
2235 if (pos[0] == WLAN_EID_GENERIC && pos[1] >= 4 &&
2236 memcmp(pos + 2, wpa_oid, 4) == 0) {
2237 prism54_wpa_bss_ie_add(priv, addr, pos, pos[1] + 2);
2238 return;
2239 }
2240 pos += 2 + pos[1];
2241 }
2242}
2243
2244static void
2245handle_request(islpci_private *priv, struct obj_mlme *mlme, enum oid_num_t oid)
2246{
2247 if (((mlme->state == DOT11_STATE_AUTHING) ||
2248 (mlme->state == DOT11_STATE_ASSOCING))
2249 && mgt_mlme_answer(priv)) {
2250 /* Someone is requesting auth and we must respond. Just send back
2251 * the trap with error code set accordingly.
2252 */
2253 mlme->code = prism54_mac_accept(&priv->acl,
2254 mlme->address) ? 0 : 1;
2255 mgt_set_request(priv, oid, 0, mlme);
2256 }
2257}
2258
2259static int
2260prism54_process_trap_helper(islpci_private *priv, enum oid_num_t oid,
2261 char *data)
2262{
2263 struct obj_mlme *mlme = (struct obj_mlme *) data;
2264 struct obj_mlmeex *mlmeex = (struct obj_mlmeex *) data;
2265 struct obj_mlmeex *confirm;
2266 u8 wpa_ie[MAX_WPA_IE_LEN];
2267 int wpa_ie_len;
2268 size_t len = 0; /* u16, better? */
2269 u8 *payload = NULL, *pos = NULL;
2270 int ret;
2271
2272 /* I think all trapable objects are listed here.
2273 * Some oids have a EX version. The difference is that they are emitted
2274 * in DOT11_MLME_EXTENDED mode (set with DOT11_OID_MLMEAUTOLEVEL)
2275 * with more info.
2276 * The few events already defined by the wireless tools are not really
2277 * suited. We use the more flexible custom event facility.
2278 */
2279
2280 if (oid >= DOT11_OID_BEACON) {
2281 len = mlmeex->size;
2282 payload = pos = mlmeex->data;
2283 }
2284
2285 /* I fear prism54_process_bss_data won't work with big endian data */
2286 if ((oid == DOT11_OID_BEACON) || (oid == DOT11_OID_PROBE))
2287 prism54_process_bss_data(priv, oid, mlmeex->address,
2288 payload, len);
2289
2290 mgt_le_to_cpu(isl_oid[oid].flags & OID_FLAG_TYPE, (void *) mlme);
2291
2292 switch (oid) {
2293
2294 case GEN_OID_LINKSTATE:
2295 link_changed(priv->ndev, (u32) *data);
2296 break;
2297
2298 case DOT11_OID_MICFAILURE:
2299 send_simple_event(priv, "Mic failure");
2300 break;
2301
2302 case DOT11_OID_DEAUTHENTICATE:
2303 send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2304 break;
2305
2306 case DOT11_OID_AUTHENTICATE:
2307 handle_request(priv, mlme, oid);
2308 send_formatted_event(priv, "Authenticate request", mlme, 1);
2309 break;
2310
2311 case DOT11_OID_DISASSOCIATE:
2312 send_formatted_event(priv, "Disassociate request", mlme, 0);
2313 break;
2314
2315 case DOT11_OID_ASSOCIATE:
2316 handle_request(priv, mlme, oid);
2317 send_formatted_event(priv, "Associate request", mlme, 1);
2318 break;
2319
2320 case DOT11_OID_REASSOCIATE:
2321 handle_request(priv, mlme, oid);
2322 send_formatted_event(priv, "ReAssociate request", mlme, 1);
2323 break;
2324
2325 case DOT11_OID_BEACON:
2326 send_formatted_event(priv,
2327 "Received a beacon from an unknown AP",
2328 mlme, 0);
2329 break;
2330
2331 case DOT11_OID_PROBE:
2332 /* we received a probe from a client. */
2333 send_formatted_event(priv, "Received a probe from client", mlme,
2334 0);
2335 break;
2336
2337 /* Note : "mlme" is actually a "struct obj_mlmeex *" here, but this
2338 * is backward compatible layout-wise with "struct obj_mlme".
2339 */
2340
2341 case DOT11_OID_DEAUTHENTICATEEX:
2342 send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2343 break;
2344
2345 case DOT11_OID_AUTHENTICATEEX:
2346 handle_request(priv, mlme, oid);
2347 send_formatted_event(priv, "Authenticate request (ex)", mlme, 1);
2348
2349 if (priv->iw_mode != IW_MODE_MASTER
2350 && mlmeex->state != DOT11_STATE_AUTHING)
2351 break;
2352
2353 confirm = kmalloc(sizeof(struct obj_mlmeex) + 6, GFP_ATOMIC);
2354
2355 if (!confirm)
2356 break;
2357
2358 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2359 printk(KERN_DEBUG "Authenticate from: address:\t%pM\n",
2360 mlmeex->address);
2361 confirm->id = -1; /* or mlmeex->id ? */
2362 confirm->state = 0; /* not used */
2363 confirm->code = 0;
2364 confirm->size = 6;
2365 confirm->data[0] = 0x00;
2366 confirm->data[1] = 0x00;
2367 confirm->data[2] = 0x02;
2368 confirm->data[3] = 0x00;
2369 confirm->data[4] = 0x00;
2370 confirm->data[5] = 0x00;
2371
2372 ret = mgt_set_varlen(priv, DOT11_OID_ASSOCIATEEX, confirm, 6);
2373
2374 kfree(confirm);
2375 if (ret)
2376 return ret;
2377 break;
2378
2379 case DOT11_OID_DISASSOCIATEEX:
2380 send_formatted_event(priv, "Disassociate request (ex)", mlme, 0);
2381 break;
2382
2383 case DOT11_OID_ASSOCIATEEX:
2384 handle_request(priv, mlme, oid);
2385 send_formatted_event(priv, "Associate request (ex)", mlme, 1);
2386
2387 if (priv->iw_mode != IW_MODE_MASTER
2388 && mlmeex->state != DOT11_STATE_ASSOCING)
2389 break;
2390
2391 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2392
2393 if (!confirm)
2394 break;
2395
2396 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2397
2398 confirm->id = ((struct obj_mlmeex *)mlme)->id;
2399 confirm->state = 0; /* not used */
2400 confirm->code = 0;
2401
2402 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2403
2404 if (!wpa_ie_len) {
2405 printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n",
2406 mlmeex->address);
2407 kfree(confirm);
2408 break;
2409 }
2410
2411 confirm->size = wpa_ie_len;
2412 memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2413
2414 mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2415
2416 kfree(confirm);
2417
2418 break;
2419
2420 case DOT11_OID_REASSOCIATEEX:
2421 handle_request(priv, mlme, oid);
2422 send_formatted_event(priv, "Reassociate request (ex)", mlme, 1);
2423
2424 if (priv->iw_mode != IW_MODE_MASTER
2425 && mlmeex->state != DOT11_STATE_ASSOCING)
2426 break;
2427
2428 confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2429
2430 if (!confirm)
2431 break;
2432
2433 memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2434
2435 confirm->id = mlmeex->id;
2436 confirm->state = 0; /* not used */
2437 confirm->code = 0;
2438
2439 wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2440
2441 if (!wpa_ie_len) {
2442 printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n",
2443 mlmeex->address);
2444 kfree(confirm);
2445 break;
2446 }
2447
2448 confirm->size = wpa_ie_len;
2449 memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2450
2451 mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2452
2453 kfree(confirm);
2454
2455 break;
2456
2457 default:
2458 return -EINVAL;
2459 }
2460
2461 return 0;
2462}
2463
2464/*
2465 * Process a device trap. This is called via schedule_work(), outside of
2466 * interrupt context, no locks held.
2467 */
2468void
2469prism54_process_trap(struct work_struct *work)
2470{
2471 struct islpci_mgmtframe *frame =
2472 container_of(work, struct islpci_mgmtframe, ws);
2473 struct net_device *ndev = frame->ndev;
2474 enum oid_num_t n = mgt_oidtonum(frame->header->oid);
2475
2476 if (n != OID_NUM_LAST)
2477 prism54_process_trap_helper(netdev_priv(ndev), n, frame->data);
2478 islpci_mgt_release(frame);
2479}
2480
2481int
2482prism54_set_mac_address(struct net_device *ndev, void *addr)
2483{
2484 islpci_private *priv = netdev_priv(ndev);
2485 int ret;
2486
2487 if (ndev->addr_len != 6)
2488 return -EINVAL;
2489 ret = mgt_set_request(priv, GEN_OID_MACADDRESS, 0,
2490 &((struct sockaddr *) addr)->sa_data);
2491 if (!ret)
2492 memcpy(priv->ndev->dev_addr,
2493 &((struct sockaddr *) addr)->sa_data, ETH_ALEN);
2494
2495 return ret;
2496}
2497
2498#define PRISM54_SET_WPA SIOCIWFIRSTPRIV+12
2499
2500static int
2501prism54_set_wpa(struct net_device *ndev, struct iw_request_info *info,
2502 __u32 * uwrq, char *extra)
2503{
2504 islpci_private *priv = netdev_priv(ndev);
2505 u32 mlme, authen, dot1x, filter, wep;
2506
2507 if (islpci_get_state(priv) < PRV_STATE_INIT)
2508 return 0;
2509
2510 wep = 1; /* For privacy invoked */
2511 filter = 1; /* Filter out all unencrypted frames */
2512 dot1x = 0x01; /* To enable eap filter */
2513 mlme = DOT11_MLME_EXTENDED;
2514 authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
2515
2516 down_write(&priv->mib_sem);
2517 priv->wpa = *uwrq;
2518
2519 switch (priv->wpa) {
2520 default:
2521 case 0: /* Clears/disables WPA and friends */
2522 wep = 0;
2523 filter = 0; /* Do not filter un-encrypted data */
2524 dot1x = 0;
2525 mlme = DOT11_MLME_AUTO;
2526 printk("%s: Disabling WPA\n", ndev->name);
2527 break;
2528 case 2:
2529 case 1: /* WPA */
2530 printk("%s: Enabling WPA\n", ndev->name);
2531 break;
2532 }
2533 up_write(&priv->mib_sem);
2534
2535 mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
2536 mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &wep);
2537 mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &filter);
2538 mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x);
2539 mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlme);
2540
2541 return 0;
2542}
2543
2544static int
2545prism54_get_wpa(struct net_device *ndev, struct iw_request_info *info,
2546 __u32 * uwrq, char *extra)
2547{
2548 islpci_private *priv = netdev_priv(ndev);
2549 *uwrq = priv->wpa;
2550 return 0;
2551}
2552
2553static int
2554prism54_set_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2555 __u32 * uwrq, char *extra)
2556{
2557 islpci_private *priv = netdev_priv(ndev);
2558 priv->monitor_type =
2559 (*uwrq ? ARPHRD_IEEE80211_PRISM : ARPHRD_IEEE80211);
2560 if (priv->iw_mode == IW_MODE_MONITOR)
2561 priv->ndev->type = priv->monitor_type;
2562
2563 return 0;
2564}
2565
2566static int
2567prism54_get_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2568 __u32 * uwrq, char *extra)
2569{
2570 islpci_private *priv = netdev_priv(ndev);
2571 *uwrq = (priv->monitor_type == ARPHRD_IEEE80211_PRISM);
2572 return 0;
2573}
2574
2575static int
2576prism54_debug_oid(struct net_device *ndev, struct iw_request_info *info,
2577 __u32 * uwrq, char *extra)
2578{
2579 islpci_private *priv = netdev_priv(ndev);
2580
2581 priv->priv_oid = *uwrq;
2582 printk("%s: oid 0x%08X\n", ndev->name, *uwrq);
2583
2584 return 0;
2585}
2586
2587static int
2588prism54_debug_get_oid(struct net_device *ndev, struct iw_request_info *info,
2589 struct iw_point *data, char *extra)
2590{
2591 islpci_private *priv = netdev_priv(ndev);
2592 struct islpci_mgmtframe *response;
2593 int ret = -EIO;
2594
2595 printk("%s: get_oid 0x%08X\n", ndev->name, priv->priv_oid);
2596 data->length = 0;
2597
2598 if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2599 ret =
2600 islpci_mgt_transaction(priv->ndev, PIMFOR_OP_GET,
2601 priv->priv_oid, extra, 256,
2602 &response);
2603 printk("%s: ret: %i\n", ndev->name, ret);
2604 if (ret || !response
2605 || response->header->operation == PIMFOR_OP_ERROR) {
2606 if (response) {
2607 islpci_mgt_release(response);
2608 }
2609 printk("%s: EIO\n", ndev->name);
2610 ret = -EIO;
2611 }
2612 if (!ret) {
2613 data->length = response->header->length;
2614 memcpy(extra, response->data, data->length);
2615 islpci_mgt_release(response);
2616 printk("%s: len: %i\n", ndev->name, data->length);
2617 }
2618 }
2619
2620 return ret;
2621}
2622
2623static int
2624prism54_debug_set_oid(struct net_device *ndev, struct iw_request_info *info,
2625 struct iw_point *data, char *extra)
2626{
2627 islpci_private *priv = netdev_priv(ndev);
2628 struct islpci_mgmtframe *response;
2629 int ret = 0, response_op = PIMFOR_OP_ERROR;
2630
2631 printk("%s: set_oid 0x%08X\tlen: %d\n", ndev->name, priv->priv_oid,
2632 data->length);
2633
2634 if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2635 ret =
2636 islpci_mgt_transaction(priv->ndev, PIMFOR_OP_SET,
2637 priv->priv_oid, extra, data->length,
2638 &response);
2639 printk("%s: ret: %i\n", ndev->name, ret);
2640 if (ret || !response
2641 || response->header->operation == PIMFOR_OP_ERROR) {
2642 if (response) {
2643 islpci_mgt_release(response);
2644 }
2645 printk("%s: EIO\n", ndev->name);
2646 ret = -EIO;
2647 }
2648 if (!ret) {
2649 response_op = response->header->operation;
2650 printk("%s: response_op: %i\n", ndev->name,
2651 response_op);
2652 islpci_mgt_release(response);
2653 }
2654 }
2655
2656 return (ret ? ret : -EINPROGRESS);
2657}
2658
2659static int
2660prism54_set_spy(struct net_device *ndev,
2661 struct iw_request_info *info,
2662 union iwreq_data *uwrq, char *extra)
2663{
2664 islpci_private *priv = netdev_priv(ndev);
2665 u32 u;
2666 enum oid_num_t oid = OID_INL_CONFIG;
2667
2668 down_write(&priv->mib_sem);
2669 mgt_get(priv, OID_INL_CONFIG, &u);
2670
2671 if ((uwrq->data.length == 0) && (priv->spy_data.spy_number > 0))
2672 /* disable spy */
2673 u &= ~INL_CONFIG_RXANNEX;
2674 else if ((uwrq->data.length > 0) && (priv->spy_data.spy_number == 0))
2675 /* enable spy */
2676 u |= INL_CONFIG_RXANNEX;
2677
2678 mgt_set(priv, OID_INL_CONFIG, &u);
2679 mgt_commit_list(priv, &oid, 1);
2680 up_write(&priv->mib_sem);
2681
2682 return iw_handler_set_spy(ndev, info, uwrq, extra);
2683}
2684
2685static const iw_handler prism54_handler[] = {
2686 (iw_handler) prism54_commit, /* SIOCSIWCOMMIT */
2687 (iw_handler) prism54_get_name, /* SIOCGIWNAME */
2688 (iw_handler) NULL, /* SIOCSIWNWID */
2689 (iw_handler) NULL, /* SIOCGIWNWID */
2690 (iw_handler) prism54_set_freq, /* SIOCSIWFREQ */
2691 (iw_handler) prism54_get_freq, /* SIOCGIWFREQ */
2692 (iw_handler) prism54_set_mode, /* SIOCSIWMODE */
2693 (iw_handler) prism54_get_mode, /* SIOCGIWMODE */
2694 (iw_handler) prism54_set_sens, /* SIOCSIWSENS */
2695 (iw_handler) prism54_get_sens, /* SIOCGIWSENS */
2696 (iw_handler) NULL, /* SIOCSIWRANGE */
2697 (iw_handler) prism54_get_range, /* SIOCGIWRANGE */
2698 (iw_handler) NULL, /* SIOCSIWPRIV */
2699 (iw_handler) NULL, /* SIOCGIWPRIV */
2700 (iw_handler) NULL, /* SIOCSIWSTATS */
2701 (iw_handler) NULL, /* SIOCGIWSTATS */
2702 prism54_set_spy, /* SIOCSIWSPY */
2703 iw_handler_get_spy, /* SIOCGIWSPY */
2704 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
2705 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
2706 (iw_handler) prism54_set_wap, /* SIOCSIWAP */
2707 (iw_handler) prism54_get_wap, /* SIOCGIWAP */
2708 (iw_handler) NULL, /* -- hole -- */
2709 (iw_handler) NULL, /* SIOCGIWAPLIST deprecated */
2710 (iw_handler) prism54_set_scan, /* SIOCSIWSCAN */
2711 (iw_handler) prism54_get_scan, /* SIOCGIWSCAN */
2712 (iw_handler) prism54_set_essid, /* SIOCSIWESSID */
2713 (iw_handler) prism54_get_essid, /* SIOCGIWESSID */
2714 (iw_handler) prism54_set_nick, /* SIOCSIWNICKN */
2715 (iw_handler) prism54_get_nick, /* SIOCGIWNICKN */
2716 (iw_handler) NULL, /* -- hole -- */
2717 (iw_handler) NULL, /* -- hole -- */
2718 (iw_handler) prism54_set_rate, /* SIOCSIWRATE */
2719 (iw_handler) prism54_get_rate, /* SIOCGIWRATE */
2720 (iw_handler) prism54_set_rts, /* SIOCSIWRTS */
2721 (iw_handler) prism54_get_rts, /* SIOCGIWRTS */
2722 (iw_handler) prism54_set_frag, /* SIOCSIWFRAG */
2723 (iw_handler) prism54_get_frag, /* SIOCGIWFRAG */
2724 (iw_handler) prism54_set_txpower, /* SIOCSIWTXPOW */
2725 (iw_handler) prism54_get_txpower, /* SIOCGIWTXPOW */
2726 (iw_handler) prism54_set_retry, /* SIOCSIWRETRY */
2727 (iw_handler) prism54_get_retry, /* SIOCGIWRETRY */
2728 (iw_handler) prism54_set_encode, /* SIOCSIWENCODE */
2729 (iw_handler) prism54_get_encode, /* SIOCGIWENCODE */
2730 (iw_handler) NULL, /* SIOCSIWPOWER */
2731 (iw_handler) NULL, /* SIOCGIWPOWER */
2732 NULL, /* -- hole -- */
2733 NULL, /* -- hole -- */
2734 (iw_handler) prism54_set_genie, /* SIOCSIWGENIE */
2735 (iw_handler) prism54_get_genie, /* SIOCGIWGENIE */
2736 (iw_handler) prism54_set_auth, /* SIOCSIWAUTH */
2737 (iw_handler) prism54_get_auth, /* SIOCGIWAUTH */
2738 (iw_handler) prism54_set_encodeext, /* SIOCSIWENCODEEXT */
2739 (iw_handler) prism54_get_encodeext, /* SIOCGIWENCODEEXT */
2740 NULL, /* SIOCSIWPMKSA */
2741};
2742
2743/* The low order bit identify a SET (0) or a GET (1) ioctl. */
2744
2745#define PRISM54_RESET SIOCIWFIRSTPRIV
2746#define PRISM54_GET_POLICY SIOCIWFIRSTPRIV+1
2747#define PRISM54_SET_POLICY SIOCIWFIRSTPRIV+2
2748#define PRISM54_GET_MAC SIOCIWFIRSTPRIV+3
2749#define PRISM54_ADD_MAC SIOCIWFIRSTPRIV+4
2750
2751#define PRISM54_DEL_MAC SIOCIWFIRSTPRIV+6
2752
2753#define PRISM54_KICK_MAC SIOCIWFIRSTPRIV+8
2754
2755#define PRISM54_KICK_ALL SIOCIWFIRSTPRIV+10
2756
2757#define PRISM54_GET_WPA SIOCIWFIRSTPRIV+11
2758#define PRISM54_SET_WPA SIOCIWFIRSTPRIV+12
2759
2760#define PRISM54_DBG_OID SIOCIWFIRSTPRIV+14
2761#define PRISM54_DBG_GET_OID SIOCIWFIRSTPRIV+15
2762#define PRISM54_DBG_SET_OID SIOCIWFIRSTPRIV+16
2763
2764#define PRISM54_GET_OID SIOCIWFIRSTPRIV+17
2765#define PRISM54_SET_OID_U32 SIOCIWFIRSTPRIV+18
2766#define PRISM54_SET_OID_STR SIOCIWFIRSTPRIV+20
2767#define PRISM54_SET_OID_ADDR SIOCIWFIRSTPRIV+22
2768
2769#define PRISM54_GET_PRISMHDR SIOCIWFIRSTPRIV+23
2770#define PRISM54_SET_PRISMHDR SIOCIWFIRSTPRIV+24
2771
2772#define IWPRIV_SET_U32(n,x) { n, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2773#define IWPRIV_SET_SSID(n,x) { n, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2774#define IWPRIV_SET_ADDR(n,x) { n, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2775#define IWPRIV_GET(n,x) { n, 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, "g_"x }
2776
2777#define IWPRIV_U32(n,x) IWPRIV_SET_U32(n,x), IWPRIV_GET(n,x)
2778#define IWPRIV_SSID(n,x) IWPRIV_SET_SSID(n,x), IWPRIV_GET(n,x)
2779#define IWPRIV_ADDR(n,x) IWPRIV_SET_ADDR(n,x), IWPRIV_GET(n,x)
2780
2781/* Note : limited to 128 private ioctls (wireless tools 26) */
2782
2783static const struct iw_priv_args prism54_private_args[] = {
2784/*{ cmd, set_args, get_args, name } */
2785 {PRISM54_RESET, 0, 0, "reset"},
2786 {PRISM54_GET_PRISMHDR, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2787 "get_prismhdr"},
2788 {PRISM54_SET_PRISMHDR, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2789 "set_prismhdr"},
2790 {PRISM54_GET_POLICY, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2791 "getPolicy"},
2792 {PRISM54_SET_POLICY, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2793 "setPolicy"},
2794 {PRISM54_GET_MAC, 0, IW_PRIV_TYPE_ADDR | 64, "getMac"},
2795 {PRISM54_ADD_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2796 "addMac"},
2797 {PRISM54_DEL_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2798 "delMac"},
2799 {PRISM54_KICK_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2800 "kickMac"},
2801 {PRISM54_KICK_ALL, 0, 0, "kickAll"},
2802 {PRISM54_GET_WPA, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2803 "get_wpa"},
2804 {PRISM54_SET_WPA, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2805 "set_wpa"},
2806 {PRISM54_DBG_OID, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2807 "dbg_oid"},
2808 {PRISM54_DBG_GET_OID, 0, IW_PRIV_TYPE_BYTE | 256, "dbg_get_oid"},
2809 {PRISM54_DBG_SET_OID, IW_PRIV_TYPE_BYTE | 256, 0, "dbg_set_oid"},
2810 /* --- sub-ioctls handlers --- */
2811 {PRISM54_GET_OID,
2812 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, ""},
2813 {PRISM54_SET_OID_U32,
2814 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2815 {PRISM54_SET_OID_STR,
2816 IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2817 {PRISM54_SET_OID_ADDR,
2818 IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2819 /* --- sub-ioctls definitions --- */
2820 IWPRIV_ADDR(GEN_OID_MACADDRESS, "addr"),
2821 IWPRIV_GET(GEN_OID_LINKSTATE, "linkstate"),
2822 IWPRIV_U32(DOT11_OID_BSSTYPE, "bsstype"),
2823 IWPRIV_ADDR(DOT11_OID_BSSID, "bssid"),
2824 IWPRIV_U32(DOT11_OID_STATE, "state"),
2825 IWPRIV_U32(DOT11_OID_AID, "aid"),
2826
2827 IWPRIV_SSID(DOT11_OID_SSIDOVERRIDE, "ssidoverride"),
2828
2829 IWPRIV_U32(DOT11_OID_MEDIUMLIMIT, "medlimit"),
2830 IWPRIV_U32(DOT11_OID_BEACONPERIOD, "beacon"),
2831 IWPRIV_U32(DOT11_OID_DTIMPERIOD, "dtimperiod"),
2832
2833 IWPRIV_U32(DOT11_OID_AUTHENABLE, "authenable"),
2834 IWPRIV_U32(DOT11_OID_PRIVACYINVOKED, "privinvok"),
2835 IWPRIV_U32(DOT11_OID_EXUNENCRYPTED, "exunencrypt"),
2836
2837 IWPRIV_U32(DOT11_OID_REKEYTHRESHOLD, "rekeythresh"),
2838
2839 IWPRIV_U32(DOT11_OID_MAXTXLIFETIME, "maxtxlife"),
2840 IWPRIV_U32(DOT11_OID_MAXRXLIFETIME, "maxrxlife"),
2841 IWPRIV_U32(DOT11_OID_ALOFT_FIXEDRATE, "fixedrate"),
2842 IWPRIV_U32(DOT11_OID_MAXFRAMEBURST, "frameburst"),
2843 IWPRIV_U32(DOT11_OID_PSM, "psm"),
2844
2845 IWPRIV_U32(DOT11_OID_BRIDGELOCAL, "bridge"),
2846 IWPRIV_U32(DOT11_OID_CLIENTS, "clients"),
2847 IWPRIV_U32(DOT11_OID_CLIENTSASSOCIATED, "clientassoc"),
2848 IWPRIV_U32(DOT11_OID_DOT1XENABLE, "dot1xenable"),
2849 IWPRIV_U32(DOT11_OID_ANTENNARX, "rxant"),
2850 IWPRIV_U32(DOT11_OID_ANTENNATX, "txant"),
2851 IWPRIV_U32(DOT11_OID_ANTENNADIVERSITY, "antdivers"),
2852 IWPRIV_U32(DOT11_OID_EDTHRESHOLD, "edthresh"),
2853 IWPRIV_U32(DOT11_OID_PREAMBLESETTINGS, "preamble"),
2854 IWPRIV_GET(DOT11_OID_RATES, "rates"),
2855 IWPRIV_U32(DOT11_OID_OUTPUTPOWER, ".11outpower"),
2856 IWPRIV_GET(DOT11_OID_SUPPORTEDRATES, "supprates"),
2857 IWPRIV_GET(DOT11_OID_SUPPORTEDFREQUENCIES, "suppfreq"),
2858
2859 IWPRIV_U32(DOT11_OID_NOISEFLOOR, "noisefloor"),
2860 IWPRIV_GET(DOT11_OID_FREQUENCYACTIVITY, "freqactivity"),
2861 IWPRIV_U32(DOT11_OID_NONERPPROTECTION, "nonerpprotec"),
2862 IWPRIV_U32(DOT11_OID_PROFILES, "profile"),
2863 IWPRIV_GET(DOT11_OID_EXTENDEDRATES, "extrates"),
2864 IWPRIV_U32(DOT11_OID_MLMEAUTOLEVEL, "mlmelevel"),
2865
2866 IWPRIV_GET(DOT11_OID_BSSS, "bsss"),
2867 IWPRIV_GET(DOT11_OID_BSSLIST, "bsslist"),
2868 IWPRIV_U32(OID_INL_MODE, "mode"),
2869 IWPRIV_U32(OID_INL_CONFIG, "config"),
2870 IWPRIV_U32(OID_INL_DOT11D_CONFORMANCE, ".11dconform"),
2871 IWPRIV_GET(OID_INL_PHYCAPABILITIES, "phycapa"),
2872 IWPRIV_U32(OID_INL_OUTPUTPOWER, "outpower"),
2873};
2874
2875static const iw_handler prism54_private_handler[] = {
2876 (iw_handler) prism54_reset,
2877 (iw_handler) prism54_get_policy,
2878 (iw_handler) prism54_set_policy,
2879 (iw_handler) prism54_get_mac,
2880 (iw_handler) prism54_add_mac,
2881 (iw_handler) NULL,
2882 (iw_handler) prism54_del_mac,
2883 (iw_handler) NULL,
2884 (iw_handler) prism54_kick_mac,
2885 (iw_handler) NULL,
2886 (iw_handler) prism54_kick_all,
2887 (iw_handler) prism54_get_wpa,
2888 (iw_handler) prism54_set_wpa,
2889 (iw_handler) NULL,
2890 (iw_handler) prism54_debug_oid,
2891 (iw_handler) prism54_debug_get_oid,
2892 (iw_handler) prism54_debug_set_oid,
2893 (iw_handler) prism54_get_oid,
2894 (iw_handler) prism54_set_u32,
2895 (iw_handler) NULL,
2896 (iw_handler) prism54_set_raw,
2897 (iw_handler) NULL,
2898 (iw_handler) prism54_set_raw,
2899 (iw_handler) prism54_get_prismhdr,
2900 (iw_handler) prism54_set_prismhdr,
2901};
2902
2903const struct iw_handler_def prism54_handler_def = {
2904 .num_standard = ARRAY_SIZE(prism54_handler),
2905 .num_private = ARRAY_SIZE(prism54_private_handler),
2906 .num_private_args = ARRAY_SIZE(prism54_private_args),
2907 .standard = (iw_handler *) prism54_handler,
2908 .private = (iw_handler *) prism54_private_handler,
2909 .private_args = (struct iw_priv_args *) prism54_private_args,
2910 .get_wireless_stats = prism54_get_wireless_stats,
2911};