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