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