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