Merge branch 'master' into for-davem
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / net / wireless / orinoco / wext.c
bloba1006bf430cc661240a710af9a466559e9acb51a
1 /* Wireless extensions support.
3 * See copyright notice in main.c
4 */
5 #include <linux/slab.h>
6 #include <linux/kernel.h>
7 #include <linux/if_arp.h>
8 #include <linux/wireless.h>
9 #include <linux/ieee80211.h>
10 #include <net/iw_handler.h>
11 #include <net/cfg80211.h>
13 #include "hermes.h"
14 #include "hermes_rid.h"
15 #include "orinoco.h"
17 #include "hw.h"
18 #include "mic.h"
19 #include "scan.h"
20 #include "main.h"
22 #include "wext.h"
24 #define MAX_RID_LEN 1024
26 /* Helper routine to record keys
27 * It is called under orinoco_lock so it may not sleep */
28 static int orinoco_set_key(struct orinoco_private *priv, int index,
29 enum orinoco_alg alg, const u8 *key, int key_len,
30 const u8 *seq, int seq_len)
32 kzfree(priv->keys[index].key);
33 kzfree(priv->keys[index].seq);
35 if (key_len) {
36 priv->keys[index].key = kzalloc(key_len, GFP_ATOMIC);
37 if (!priv->keys[index].key)
38 goto nomem;
39 } else
40 priv->keys[index].key = NULL;
42 if (seq_len) {
43 priv->keys[index].seq = kzalloc(seq_len, GFP_ATOMIC);
44 if (!priv->keys[index].seq)
45 goto free_key;
46 } else
47 priv->keys[index].seq = NULL;
49 priv->keys[index].key_len = key_len;
50 priv->keys[index].seq_len = seq_len;
52 if (key_len)
53 memcpy(priv->keys[index].key, key, key_len);
54 if (seq_len)
55 memcpy(priv->keys[index].seq, seq, seq_len);
57 switch (alg) {
58 case ORINOCO_ALG_TKIP:
59 priv->keys[index].cipher = WLAN_CIPHER_SUITE_TKIP;
60 break;
62 case ORINOCO_ALG_WEP:
63 priv->keys[index].cipher = (key_len > SMALL_KEY_SIZE) ?
64 WLAN_CIPHER_SUITE_WEP104 : WLAN_CIPHER_SUITE_WEP40;
65 break;
67 case ORINOCO_ALG_NONE:
68 default:
69 priv->keys[index].cipher = 0;
70 break;
73 return 0;
75 free_key:
76 kfree(priv->keys[index].key);
77 priv->keys[index].key = NULL;
79 nomem:
80 priv->keys[index].key_len = 0;
81 priv->keys[index].seq_len = 0;
82 priv->keys[index].cipher = 0;
84 return -ENOMEM;
87 static struct iw_statistics *orinoco_get_wireless_stats(struct net_device *dev)
89 struct orinoco_private *priv = ndev_priv(dev);
90 hermes_t *hw = &priv->hw;
91 struct iw_statistics *wstats = &priv->wstats;
92 int err;
93 unsigned long flags;
95 if (!netif_device_present(dev)) {
96 printk(KERN_WARNING "%s: get_wireless_stats() called while device not present\n",
97 dev->name);
98 return NULL; /* FIXME: Can we do better than this? */
101 /* If busy, return the old stats. Returning NULL may cause
102 * the interface to disappear from /proc/net/wireless */
103 if (orinoco_lock(priv, &flags) != 0)
104 return wstats;
106 /* We can't really wait for the tallies inquiry command to
107 * complete, so we just use the previous results and trigger
108 * a new tallies inquiry command for next time - Jean II */
109 /* FIXME: Really we should wait for the inquiry to come back -
110 * as it is the stats we give don't make a whole lot of sense.
111 * Unfortunately, it's not clear how to do that within the
112 * wireless extensions framework: I think we're in user
113 * context, but a lock seems to be held by the time we get in
114 * here so we're not safe to sleep here. */
115 hermes_inquire(hw, HERMES_INQ_TALLIES);
117 if (priv->iw_mode == NL80211_IFTYPE_ADHOC) {
118 memset(&wstats->qual, 0, sizeof(wstats->qual));
119 /* If a spy address is defined, we report stats of the
120 * first spy address - Jean II */
121 if (SPY_NUMBER(priv)) {
122 wstats->qual.qual = priv->spy_data.spy_stat[0].qual;
123 wstats->qual.level = priv->spy_data.spy_stat[0].level;
124 wstats->qual.noise = priv->spy_data.spy_stat[0].noise;
125 wstats->qual.updated =
126 priv->spy_data.spy_stat[0].updated;
128 } else {
129 struct {
130 __le16 qual, signal, noise, unused;
131 } __attribute__ ((packed)) cq;
133 err = HERMES_READ_RECORD(hw, USER_BAP,
134 HERMES_RID_COMMSQUALITY, &cq);
136 if (!err) {
137 wstats->qual.qual = (int)le16_to_cpu(cq.qual);
138 wstats->qual.level = (int)le16_to_cpu(cq.signal) - 0x95;
139 wstats->qual.noise = (int)le16_to_cpu(cq.noise) - 0x95;
140 wstats->qual.updated =
141 IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
145 orinoco_unlock(priv, &flags);
146 return wstats;
149 /********************************************************************/
150 /* Wireless extensions */
151 /********************************************************************/
153 static int orinoco_ioctl_setwap(struct net_device *dev,
154 struct iw_request_info *info,
155 struct sockaddr *ap_addr,
156 char *extra)
158 struct orinoco_private *priv = ndev_priv(dev);
159 int err = -EINPROGRESS; /* Call commit handler */
160 unsigned long flags;
161 static const u8 off_addr[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
162 static const u8 any_addr[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
164 if (orinoco_lock(priv, &flags) != 0)
165 return -EBUSY;
167 /* Enable automatic roaming - no sanity checks are needed */
168 if (memcmp(&ap_addr->sa_data, off_addr, ETH_ALEN) == 0 ||
169 memcmp(&ap_addr->sa_data, any_addr, ETH_ALEN) == 0) {
170 priv->bssid_fixed = 0;
171 memset(priv->desired_bssid, 0, ETH_ALEN);
173 /* "off" means keep existing connection */
174 if (ap_addr->sa_data[0] == 0) {
175 __orinoco_hw_set_wap(priv);
176 err = 0;
178 goto out;
181 if (priv->firmware_type == FIRMWARE_TYPE_AGERE) {
182 printk(KERN_WARNING "%s: Lucent/Agere firmware doesn't "
183 "support manual roaming\n",
184 dev->name);
185 err = -EOPNOTSUPP;
186 goto out;
189 if (priv->iw_mode != NL80211_IFTYPE_STATION) {
190 printk(KERN_WARNING "%s: Manual roaming supported only in "
191 "managed mode\n", dev->name);
192 err = -EOPNOTSUPP;
193 goto out;
196 /* Intersil firmware hangs without Desired ESSID */
197 if (priv->firmware_type == FIRMWARE_TYPE_INTERSIL &&
198 strlen(priv->desired_essid) == 0) {
199 printk(KERN_WARNING "%s: Desired ESSID must be set for "
200 "manual roaming\n", dev->name);
201 err = -EOPNOTSUPP;
202 goto out;
205 /* Finally, enable manual roaming */
206 priv->bssid_fixed = 1;
207 memcpy(priv->desired_bssid, &ap_addr->sa_data, ETH_ALEN);
209 out:
210 orinoco_unlock(priv, &flags);
211 return err;
214 static int orinoco_ioctl_getwap(struct net_device *dev,
215 struct iw_request_info *info,
216 struct sockaddr *ap_addr,
217 char *extra)
219 struct orinoco_private *priv = ndev_priv(dev);
221 int err = 0;
222 unsigned long flags;
224 if (orinoco_lock(priv, &flags) != 0)
225 return -EBUSY;
227 ap_addr->sa_family = ARPHRD_ETHER;
228 err = orinoco_hw_get_current_bssid(priv, ap_addr->sa_data);
230 orinoco_unlock(priv, &flags);
232 return err;
235 static int orinoco_ioctl_setiwencode(struct net_device *dev,
236 struct iw_request_info *info,
237 struct iw_point *erq,
238 char *keybuf)
240 struct orinoco_private *priv = ndev_priv(dev);
241 int index = (erq->flags & IW_ENCODE_INDEX) - 1;
242 int setindex = priv->tx_key;
243 enum orinoco_alg encode_alg = priv->encode_alg;
244 int restricted = priv->wep_restrict;
245 int err = -EINPROGRESS; /* Call commit handler */
246 unsigned long flags;
248 if (!priv->has_wep)
249 return -EOPNOTSUPP;
251 if (erq->pointer) {
252 /* We actually have a key to set - check its length */
253 if (erq->length > LARGE_KEY_SIZE)
254 return -E2BIG;
256 if ((erq->length > SMALL_KEY_SIZE) && !priv->has_big_wep)
257 return -E2BIG;
260 if (orinoco_lock(priv, &flags) != 0)
261 return -EBUSY;
263 /* Clear any TKIP key we have */
264 if ((priv->has_wpa) && (priv->encode_alg == ORINOCO_ALG_TKIP))
265 (void) orinoco_clear_tkip_key(priv, setindex);
267 if (erq->length > 0) {
268 if ((index < 0) || (index >= ORINOCO_MAX_KEYS))
269 index = priv->tx_key;
271 /* Switch on WEP if off */
272 if (encode_alg != ORINOCO_ALG_WEP) {
273 setindex = index;
274 encode_alg = ORINOCO_ALG_WEP;
276 } else {
277 /* Important note : if the user do "iwconfig eth0 enc off",
278 * we will arrive there with an index of -1. This is valid
279 * but need to be taken care off... Jean II */
280 if ((index < 0) || (index >= ORINOCO_MAX_KEYS)) {
281 if ((index != -1) || (erq->flags == 0)) {
282 err = -EINVAL;
283 goto out;
285 } else {
286 /* Set the index : Check that the key is valid */
287 if (priv->keys[index].key_len == 0) {
288 err = -EINVAL;
289 goto out;
291 setindex = index;
295 if (erq->flags & IW_ENCODE_DISABLED)
296 encode_alg = ORINOCO_ALG_NONE;
297 if (erq->flags & IW_ENCODE_OPEN)
298 restricted = 0;
299 if (erq->flags & IW_ENCODE_RESTRICTED)
300 restricted = 1;
302 if (erq->pointer && erq->length > 0) {
303 err = orinoco_set_key(priv, index, ORINOCO_ALG_WEP, keybuf,
304 erq->length, NULL, 0);
306 priv->tx_key = setindex;
308 /* Try fast key change if connected and only keys are changed */
309 if ((priv->encode_alg == encode_alg) &&
310 (priv->wep_restrict == restricted) &&
311 netif_carrier_ok(dev)) {
312 err = __orinoco_hw_setup_wepkeys(priv);
313 /* No need to commit if successful */
314 goto out;
317 priv->encode_alg = encode_alg;
318 priv->wep_restrict = restricted;
320 out:
321 orinoco_unlock(priv, &flags);
323 return err;
326 static int orinoco_ioctl_getiwencode(struct net_device *dev,
327 struct iw_request_info *info,
328 struct iw_point *erq,
329 char *keybuf)
331 struct orinoco_private *priv = ndev_priv(dev);
332 int index = (erq->flags & IW_ENCODE_INDEX) - 1;
333 unsigned long flags;
335 if (!priv->has_wep)
336 return -EOPNOTSUPP;
338 if (orinoco_lock(priv, &flags) != 0)
339 return -EBUSY;
341 if ((index < 0) || (index >= ORINOCO_MAX_KEYS))
342 index = priv->tx_key;
344 erq->flags = 0;
345 if (!priv->encode_alg)
346 erq->flags |= IW_ENCODE_DISABLED;
347 erq->flags |= index + 1;
349 if (priv->wep_restrict)
350 erq->flags |= IW_ENCODE_RESTRICTED;
351 else
352 erq->flags |= IW_ENCODE_OPEN;
354 erq->length = priv->keys[index].key_len;
356 memcpy(keybuf, priv->keys[index].key, erq->length);
358 orinoco_unlock(priv, &flags);
359 return 0;
362 static int orinoco_ioctl_setessid(struct net_device *dev,
363 struct iw_request_info *info,
364 struct iw_point *erq,
365 char *essidbuf)
367 struct orinoco_private *priv = ndev_priv(dev);
368 unsigned long flags;
370 /* Note : ESSID is ignored in Ad-Hoc demo mode, but we can set it
371 * anyway... - Jean II */
373 /* Hum... Should not use Wireless Extension constant (may change),
374 * should use our own... - Jean II */
375 if (erq->length > IW_ESSID_MAX_SIZE)
376 return -E2BIG;
378 if (orinoco_lock(priv, &flags) != 0)
379 return -EBUSY;
381 /* NULL the string (for NULL termination & ESSID = ANY) - Jean II */
382 memset(priv->desired_essid, 0, sizeof(priv->desired_essid));
384 /* If not ANY, get the new ESSID */
385 if (erq->flags)
386 memcpy(priv->desired_essid, essidbuf, erq->length);
388 orinoco_unlock(priv, &flags);
390 return -EINPROGRESS; /* Call commit handler */
393 static int orinoco_ioctl_getessid(struct net_device *dev,
394 struct iw_request_info *info,
395 struct iw_point *erq,
396 char *essidbuf)
398 struct orinoco_private *priv = ndev_priv(dev);
399 int active;
400 int err = 0;
401 unsigned long flags;
403 if (netif_running(dev)) {
404 err = orinoco_hw_get_essid(priv, &active, essidbuf);
405 if (err < 0)
406 return err;
407 erq->length = err;
408 } else {
409 if (orinoco_lock(priv, &flags) != 0)
410 return -EBUSY;
411 memcpy(essidbuf, priv->desired_essid, IW_ESSID_MAX_SIZE);
412 erq->length = strlen(priv->desired_essid);
413 orinoco_unlock(priv, &flags);
416 erq->flags = 1;
418 return 0;
421 static int orinoco_ioctl_setfreq(struct net_device *dev,
422 struct iw_request_info *info,
423 struct iw_freq *frq,
424 char *extra)
426 struct orinoco_private *priv = ndev_priv(dev);
427 int chan = -1;
428 unsigned long flags;
429 int err = -EINPROGRESS; /* Call commit handler */
431 /* In infrastructure mode the AP sets the channel */
432 if (priv->iw_mode == NL80211_IFTYPE_STATION)
433 return -EBUSY;
435 if ((frq->e == 0) && (frq->m <= 1000)) {
436 /* Setting by channel number */
437 chan = frq->m;
438 } else {
439 /* Setting by frequency */
440 int denom = 1;
441 int i;
443 /* Calculate denominator to rescale to MHz */
444 for (i = 0; i < (6 - frq->e); i++)
445 denom *= 10;
447 chan = ieee80211_freq_to_dsss_chan(frq->m / denom);
450 if ((chan < 1) || (chan > NUM_CHANNELS) ||
451 !(priv->channel_mask & (1 << (chan-1))))
452 return -EINVAL;
454 if (orinoco_lock(priv, &flags) != 0)
455 return -EBUSY;
457 priv->channel = chan;
458 if (priv->iw_mode == NL80211_IFTYPE_MONITOR) {
459 /* Fast channel change - no commit if successful */
460 hermes_t *hw = &priv->hw;
461 err = hermes_docmd_wait(hw, HERMES_CMD_TEST |
462 HERMES_TEST_SET_CHANNEL,
463 chan, NULL);
465 orinoco_unlock(priv, &flags);
467 return err;
470 static int orinoco_ioctl_getfreq(struct net_device *dev,
471 struct iw_request_info *info,
472 struct iw_freq *frq,
473 char *extra)
475 struct orinoco_private *priv = ndev_priv(dev);
476 int tmp;
478 /* Locking done in there */
479 tmp = orinoco_hw_get_freq(priv);
480 if (tmp < 0)
481 return tmp;
483 frq->m = tmp * 100000;
484 frq->e = 1;
486 return 0;
489 static int orinoco_ioctl_getsens(struct net_device *dev,
490 struct iw_request_info *info,
491 struct iw_param *srq,
492 char *extra)
494 struct orinoco_private *priv = ndev_priv(dev);
495 hermes_t *hw = &priv->hw;
496 u16 val;
497 int err;
498 unsigned long flags;
500 if (!priv->has_sensitivity)
501 return -EOPNOTSUPP;
503 if (orinoco_lock(priv, &flags) != 0)
504 return -EBUSY;
505 err = hermes_read_wordrec(hw, USER_BAP,
506 HERMES_RID_CNFSYSTEMSCALE, &val);
507 orinoco_unlock(priv, &flags);
509 if (err)
510 return err;
512 srq->value = val;
513 srq->fixed = 0; /* auto */
515 return 0;
518 static int orinoco_ioctl_setsens(struct net_device *dev,
519 struct iw_request_info *info,
520 struct iw_param *srq,
521 char *extra)
523 struct orinoco_private *priv = ndev_priv(dev);
524 int val = srq->value;
525 unsigned long flags;
527 if (!priv->has_sensitivity)
528 return -EOPNOTSUPP;
530 if ((val < 1) || (val > 3))
531 return -EINVAL;
533 if (orinoco_lock(priv, &flags) != 0)
534 return -EBUSY;
535 priv->ap_density = val;
536 orinoco_unlock(priv, &flags);
538 return -EINPROGRESS; /* Call commit handler */
541 static int orinoco_ioctl_setrate(struct net_device *dev,
542 struct iw_request_info *info,
543 struct iw_param *rrq,
544 char *extra)
546 struct orinoco_private *priv = ndev_priv(dev);
547 int ratemode;
548 int bitrate; /* 100s of kilobits */
549 unsigned long flags;
551 /* As the user space doesn't know our highest rate, it uses -1
552 * to ask us to set the highest rate. Test it using "iwconfig
553 * ethX rate auto" - Jean II */
554 if (rrq->value == -1)
555 bitrate = 110;
556 else {
557 if (rrq->value % 100000)
558 return -EINVAL;
559 bitrate = rrq->value / 100000;
562 ratemode = orinoco_get_bitratemode(bitrate, !rrq->fixed);
564 if (ratemode == -1)
565 return -EINVAL;
567 if (orinoco_lock(priv, &flags) != 0)
568 return -EBUSY;
569 priv->bitratemode = ratemode;
570 orinoco_unlock(priv, &flags);
572 return -EINPROGRESS;
575 static int orinoco_ioctl_getrate(struct net_device *dev,
576 struct iw_request_info *info,
577 struct iw_param *rrq,
578 char *extra)
580 struct orinoco_private *priv = ndev_priv(dev);
581 int err = 0;
582 int bitrate, automatic;
583 unsigned long flags;
585 if (orinoco_lock(priv, &flags) != 0)
586 return -EBUSY;
588 orinoco_get_ratemode_cfg(priv->bitratemode, &bitrate, &automatic);
590 /* If the interface is running we try to find more about the
591 current mode */
592 if (netif_running(dev))
593 err = orinoco_hw_get_act_bitrate(priv, &bitrate);
595 orinoco_unlock(priv, &flags);
597 rrq->value = bitrate;
598 rrq->fixed = !automatic;
599 rrq->disabled = 0;
601 return err;
604 static int orinoco_ioctl_setpower(struct net_device *dev,
605 struct iw_request_info *info,
606 struct iw_param *prq,
607 char *extra)
609 struct orinoco_private *priv = ndev_priv(dev);
610 int err = -EINPROGRESS; /* Call commit handler */
611 unsigned long flags;
613 if (orinoco_lock(priv, &flags) != 0)
614 return -EBUSY;
616 if (prq->disabled) {
617 priv->pm_on = 0;
618 } else {
619 switch (prq->flags & IW_POWER_MODE) {
620 case IW_POWER_UNICAST_R:
621 priv->pm_mcast = 0;
622 priv->pm_on = 1;
623 break;
624 case IW_POWER_ALL_R:
625 priv->pm_mcast = 1;
626 priv->pm_on = 1;
627 break;
628 case IW_POWER_ON:
629 /* No flags : but we may have a value - Jean II */
630 break;
631 default:
632 err = -EINVAL;
633 goto out;
636 if (prq->flags & IW_POWER_TIMEOUT) {
637 priv->pm_on = 1;
638 priv->pm_timeout = prq->value / 1000;
640 if (prq->flags & IW_POWER_PERIOD) {
641 priv->pm_on = 1;
642 priv->pm_period = prq->value / 1000;
644 /* It's valid to not have a value if we are just toggling
645 * the flags... Jean II */
646 if (!priv->pm_on) {
647 err = -EINVAL;
648 goto out;
652 out:
653 orinoco_unlock(priv, &flags);
655 return err;
658 static int orinoco_ioctl_getpower(struct net_device *dev,
659 struct iw_request_info *info,
660 struct iw_param *prq,
661 char *extra)
663 struct orinoco_private *priv = ndev_priv(dev);
664 hermes_t *hw = &priv->hw;
665 int err = 0;
666 u16 enable, period, timeout, mcast;
667 unsigned long flags;
669 if (orinoco_lock(priv, &flags) != 0)
670 return -EBUSY;
672 err = hermes_read_wordrec(hw, USER_BAP,
673 HERMES_RID_CNFPMENABLED, &enable);
674 if (err)
675 goto out;
677 err = hermes_read_wordrec(hw, USER_BAP,
678 HERMES_RID_CNFMAXSLEEPDURATION, &period);
679 if (err)
680 goto out;
682 err = hermes_read_wordrec(hw, USER_BAP,
683 HERMES_RID_CNFPMHOLDOVERDURATION, &timeout);
684 if (err)
685 goto out;
687 err = hermes_read_wordrec(hw, USER_BAP,
688 HERMES_RID_CNFMULTICASTRECEIVE, &mcast);
689 if (err)
690 goto out;
692 prq->disabled = !enable;
693 /* Note : by default, display the period */
694 if ((prq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
695 prq->flags = IW_POWER_TIMEOUT;
696 prq->value = timeout * 1000;
697 } else {
698 prq->flags = IW_POWER_PERIOD;
699 prq->value = period * 1000;
701 if (mcast)
702 prq->flags |= IW_POWER_ALL_R;
703 else
704 prq->flags |= IW_POWER_UNICAST_R;
706 out:
707 orinoco_unlock(priv, &flags);
709 return err;
712 static int orinoco_ioctl_set_encodeext(struct net_device *dev,
713 struct iw_request_info *info,
714 union iwreq_data *wrqu,
715 char *extra)
717 struct orinoco_private *priv = ndev_priv(dev);
718 struct iw_point *encoding = &wrqu->encoding;
719 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
720 int idx, alg = ext->alg, set_key = 1;
721 unsigned long flags;
722 int err = -EINVAL;
724 if (orinoco_lock(priv, &flags) != 0)
725 return -EBUSY;
727 /* Determine and validate the key index */
728 idx = encoding->flags & IW_ENCODE_INDEX;
729 if (idx) {
730 if ((idx < 1) || (idx > 4))
731 goto out;
732 idx--;
733 } else
734 idx = priv->tx_key;
736 if (encoding->flags & IW_ENCODE_DISABLED)
737 alg = IW_ENCODE_ALG_NONE;
739 if (priv->has_wpa && (alg != IW_ENCODE_ALG_TKIP)) {
740 /* Clear any TKIP TX key we had */
741 (void) orinoco_clear_tkip_key(priv, priv->tx_key);
744 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
745 priv->tx_key = idx;
746 set_key = ((alg == IW_ENCODE_ALG_TKIP) ||
747 (ext->key_len > 0)) ? 1 : 0;
750 if (set_key) {
751 /* Set the requested key first */
752 switch (alg) {
753 case IW_ENCODE_ALG_NONE:
754 priv->encode_alg = ORINOCO_ALG_NONE;
755 err = orinoco_set_key(priv, idx, ORINOCO_ALG_NONE,
756 NULL, 0, NULL, 0);
757 break;
759 case IW_ENCODE_ALG_WEP:
760 if (ext->key_len <= 0)
761 goto out;
763 priv->encode_alg = ORINOCO_ALG_WEP;
764 err = orinoco_set_key(priv, idx, ORINOCO_ALG_WEP,
765 ext->key, ext->key_len, NULL, 0);
766 break;
768 case IW_ENCODE_ALG_TKIP:
770 u8 *tkip_iv = NULL;
772 if (!priv->has_wpa ||
773 (ext->key_len > sizeof(struct orinoco_tkip_key)))
774 goto out;
776 priv->encode_alg = ORINOCO_ALG_TKIP;
778 if (ext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID)
779 tkip_iv = &ext->rx_seq[0];
781 err = orinoco_set_key(priv, idx, ORINOCO_ALG_TKIP,
782 ext->key, ext->key_len, tkip_iv,
783 ORINOCO_SEQ_LEN);
785 err = __orinoco_hw_set_tkip_key(priv, idx,
786 ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY,
787 priv->keys[idx].key,
788 tkip_iv, ORINOCO_SEQ_LEN, NULL, 0);
789 if (err)
790 printk(KERN_ERR "%s: Error %d setting TKIP key"
791 "\n", dev->name, err);
793 goto out;
795 default:
796 goto out;
799 err = -EINPROGRESS;
800 out:
801 orinoco_unlock(priv, &flags);
803 return err;
806 static int orinoco_ioctl_get_encodeext(struct net_device *dev,
807 struct iw_request_info *info,
808 union iwreq_data *wrqu,
809 char *extra)
811 struct orinoco_private *priv = ndev_priv(dev);
812 struct iw_point *encoding = &wrqu->encoding;
813 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
814 int idx, max_key_len;
815 unsigned long flags;
816 int err;
818 if (orinoco_lock(priv, &flags) != 0)
819 return -EBUSY;
821 err = -EINVAL;
822 max_key_len = encoding->length - sizeof(*ext);
823 if (max_key_len < 0)
824 goto out;
826 idx = encoding->flags & IW_ENCODE_INDEX;
827 if (idx) {
828 if ((idx < 1) || (idx > 4))
829 goto out;
830 idx--;
831 } else
832 idx = priv->tx_key;
834 encoding->flags = idx + 1;
835 memset(ext, 0, sizeof(*ext));
837 switch (priv->encode_alg) {
838 case ORINOCO_ALG_NONE:
839 ext->alg = IW_ENCODE_ALG_NONE;
840 ext->key_len = 0;
841 encoding->flags |= IW_ENCODE_DISABLED;
842 break;
843 case ORINOCO_ALG_WEP:
844 ext->alg = IW_ENCODE_ALG_WEP;
845 ext->key_len = min(priv->keys[idx].key_len, max_key_len);
846 memcpy(ext->key, priv->keys[idx].key, ext->key_len);
847 encoding->flags |= IW_ENCODE_ENABLED;
848 break;
849 case ORINOCO_ALG_TKIP:
850 ext->alg = IW_ENCODE_ALG_TKIP;
851 ext->key_len = min(priv->keys[idx].key_len, max_key_len);
852 memcpy(ext->key, priv->keys[idx].key, ext->key_len);
853 encoding->flags |= IW_ENCODE_ENABLED;
854 break;
857 err = 0;
858 out:
859 orinoco_unlock(priv, &flags);
861 return err;
864 static int orinoco_ioctl_set_auth(struct net_device *dev,
865 struct iw_request_info *info,
866 union iwreq_data *wrqu, char *extra)
868 struct orinoco_private *priv = ndev_priv(dev);
869 hermes_t *hw = &priv->hw;
870 struct iw_param *param = &wrqu->param;
871 unsigned long flags;
872 int ret = -EINPROGRESS;
874 if (orinoco_lock(priv, &flags) != 0)
875 return -EBUSY;
877 switch (param->flags & IW_AUTH_INDEX) {
878 case IW_AUTH_WPA_VERSION:
879 case IW_AUTH_CIPHER_PAIRWISE:
880 case IW_AUTH_CIPHER_GROUP:
881 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
882 case IW_AUTH_PRIVACY_INVOKED:
883 case IW_AUTH_DROP_UNENCRYPTED:
885 * orinoco does not use these parameters
887 break;
889 case IW_AUTH_KEY_MGMT:
890 /* wl_lkm implies value 2 == PSK for Hermes I
891 * which ties in with WEXT
892 * no other hints tho :(
894 priv->key_mgmt = param->value;
895 break;
897 case IW_AUTH_TKIP_COUNTERMEASURES:
898 /* When countermeasures are enabled, shut down the
899 * card; when disabled, re-enable the card. This must
900 * take effect immediately.
902 * TODO: Make sure that the EAPOL message is getting
903 * out before card disabled
905 if (param->value) {
906 priv->tkip_cm_active = 1;
907 ret = hermes_enable_port(hw, 0);
908 } else {
909 priv->tkip_cm_active = 0;
910 ret = hermes_disable_port(hw, 0);
912 break;
914 case IW_AUTH_80211_AUTH_ALG:
915 if (param->value & IW_AUTH_ALG_SHARED_KEY)
916 priv->wep_restrict = 1;
917 else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM)
918 priv->wep_restrict = 0;
919 else
920 ret = -EINVAL;
921 break;
923 case IW_AUTH_WPA_ENABLED:
924 if (priv->has_wpa) {
925 priv->wpa_enabled = param->value ? 1 : 0;
926 } else {
927 if (param->value)
928 ret = -EOPNOTSUPP;
929 /* else silently accept disable of WPA */
930 priv->wpa_enabled = 0;
932 break;
934 default:
935 ret = -EOPNOTSUPP;
938 orinoco_unlock(priv, &flags);
939 return ret;
942 static int orinoco_ioctl_get_auth(struct net_device *dev,
943 struct iw_request_info *info,
944 union iwreq_data *wrqu, char *extra)
946 struct orinoco_private *priv = ndev_priv(dev);
947 struct iw_param *param = &wrqu->param;
948 unsigned long flags;
949 int ret = 0;
951 if (orinoco_lock(priv, &flags) != 0)
952 return -EBUSY;
954 switch (param->flags & IW_AUTH_INDEX) {
955 case IW_AUTH_KEY_MGMT:
956 param->value = priv->key_mgmt;
957 break;
959 case IW_AUTH_TKIP_COUNTERMEASURES:
960 param->value = priv->tkip_cm_active;
961 break;
963 case IW_AUTH_80211_AUTH_ALG:
964 if (priv->wep_restrict)
965 param->value = IW_AUTH_ALG_SHARED_KEY;
966 else
967 param->value = IW_AUTH_ALG_OPEN_SYSTEM;
968 break;
970 case IW_AUTH_WPA_ENABLED:
971 param->value = priv->wpa_enabled;
972 break;
974 default:
975 ret = -EOPNOTSUPP;
978 orinoco_unlock(priv, &flags);
979 return ret;
982 static int orinoco_ioctl_set_genie(struct net_device *dev,
983 struct iw_request_info *info,
984 union iwreq_data *wrqu, char *extra)
986 struct orinoco_private *priv = ndev_priv(dev);
987 u8 *buf;
988 unsigned long flags;
990 /* cut off at IEEE80211_MAX_DATA_LEN */
991 if ((wrqu->data.length > IEEE80211_MAX_DATA_LEN) ||
992 (wrqu->data.length && (extra == NULL)))
993 return -EINVAL;
995 if (wrqu->data.length) {
996 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
997 if (buf == NULL)
998 return -ENOMEM;
1000 memcpy(buf, extra, wrqu->data.length);
1001 } else
1002 buf = NULL;
1004 if (orinoco_lock(priv, &flags) != 0) {
1005 kfree(buf);
1006 return -EBUSY;
1009 kfree(priv->wpa_ie);
1010 priv->wpa_ie = buf;
1011 priv->wpa_ie_len = wrqu->data.length;
1013 if (priv->wpa_ie) {
1014 /* Looks like wl_lkm wants to check the auth alg, and
1015 * somehow pass it to the firmware.
1016 * Instead it just calls the key mgmt rid
1017 * - we do this in set auth.
1021 orinoco_unlock(priv, &flags);
1022 return 0;
1025 static int orinoco_ioctl_get_genie(struct net_device *dev,
1026 struct iw_request_info *info,
1027 union iwreq_data *wrqu, char *extra)
1029 struct orinoco_private *priv = ndev_priv(dev);
1030 unsigned long flags;
1031 int err = 0;
1033 if (orinoco_lock(priv, &flags) != 0)
1034 return -EBUSY;
1036 if ((priv->wpa_ie_len == 0) || (priv->wpa_ie == NULL)) {
1037 wrqu->data.length = 0;
1038 goto out;
1041 if (wrqu->data.length < priv->wpa_ie_len) {
1042 err = -E2BIG;
1043 goto out;
1046 wrqu->data.length = priv->wpa_ie_len;
1047 memcpy(extra, priv->wpa_ie, priv->wpa_ie_len);
1049 out:
1050 orinoco_unlock(priv, &flags);
1051 return err;
1054 static int orinoco_ioctl_set_mlme(struct net_device *dev,
1055 struct iw_request_info *info,
1056 union iwreq_data *wrqu, char *extra)
1058 struct orinoco_private *priv = ndev_priv(dev);
1059 struct iw_mlme *mlme = (struct iw_mlme *)extra;
1060 unsigned long flags;
1061 int ret = 0;
1063 if (orinoco_lock(priv, &flags) != 0)
1064 return -EBUSY;
1066 switch (mlme->cmd) {
1067 case IW_MLME_DEAUTH:
1068 /* silently ignore */
1069 break;
1071 case IW_MLME_DISASSOC:
1073 ret = orinoco_hw_disassociate(priv, mlme->addr.sa_data,
1074 mlme->reason_code);
1075 break;
1077 default:
1078 ret = -EOPNOTSUPP;
1081 orinoco_unlock(priv, &flags);
1082 return ret;
1085 static int orinoco_ioctl_reset(struct net_device *dev,
1086 struct iw_request_info *info,
1087 void *wrqu,
1088 char *extra)
1090 struct orinoco_private *priv = ndev_priv(dev);
1092 if (!capable(CAP_NET_ADMIN))
1093 return -EPERM;
1095 if (info->cmd == (SIOCIWFIRSTPRIV + 0x1)) {
1096 printk(KERN_DEBUG "%s: Forcing reset!\n", dev->name);
1098 /* Firmware reset */
1099 orinoco_reset(&priv->reset_work);
1100 } else {
1101 printk(KERN_DEBUG "%s: Force scheduling reset!\n", dev->name);
1103 schedule_work(&priv->reset_work);
1106 return 0;
1109 static int orinoco_ioctl_setibssport(struct net_device *dev,
1110 struct iw_request_info *info,
1111 void *wrqu,
1112 char *extra)
1115 struct orinoco_private *priv = ndev_priv(dev);
1116 int val = *((int *) extra);
1117 unsigned long flags;
1119 if (orinoco_lock(priv, &flags) != 0)
1120 return -EBUSY;
1122 priv->ibss_port = val;
1124 /* Actually update the mode we are using */
1125 set_port_type(priv);
1127 orinoco_unlock(priv, &flags);
1128 return -EINPROGRESS; /* Call commit handler */
1131 static int orinoco_ioctl_getibssport(struct net_device *dev,
1132 struct iw_request_info *info,
1133 void *wrqu,
1134 char *extra)
1136 struct orinoco_private *priv = ndev_priv(dev);
1137 int *val = (int *) extra;
1139 *val = priv->ibss_port;
1140 return 0;
1143 static int orinoco_ioctl_setport3(struct net_device *dev,
1144 struct iw_request_info *info,
1145 void *wrqu,
1146 char *extra)
1148 struct orinoco_private *priv = ndev_priv(dev);
1149 int val = *((int *) extra);
1150 int err = 0;
1151 unsigned long flags;
1153 if (orinoco_lock(priv, &flags) != 0)
1154 return -EBUSY;
1156 switch (val) {
1157 case 0: /* Try to do IEEE ad-hoc mode */
1158 if (!priv->has_ibss) {
1159 err = -EINVAL;
1160 break;
1162 priv->prefer_port3 = 0;
1164 break;
1166 case 1: /* Try to do Lucent proprietary ad-hoc mode */
1167 if (!priv->has_port3) {
1168 err = -EINVAL;
1169 break;
1171 priv->prefer_port3 = 1;
1172 break;
1174 default:
1175 err = -EINVAL;
1178 if (!err) {
1179 /* Actually update the mode we are using */
1180 set_port_type(priv);
1181 err = -EINPROGRESS;
1184 orinoco_unlock(priv, &flags);
1186 return err;
1189 static int orinoco_ioctl_getport3(struct net_device *dev,
1190 struct iw_request_info *info,
1191 void *wrqu,
1192 char *extra)
1194 struct orinoco_private *priv = ndev_priv(dev);
1195 int *val = (int *) extra;
1197 *val = priv->prefer_port3;
1198 return 0;
1201 static int orinoco_ioctl_setpreamble(struct net_device *dev,
1202 struct iw_request_info *info,
1203 void *wrqu,
1204 char *extra)
1206 struct orinoco_private *priv = ndev_priv(dev);
1207 unsigned long flags;
1208 int val;
1210 if (!priv->has_preamble)
1211 return -EOPNOTSUPP;
1213 /* 802.11b has recently defined some short preamble.
1214 * Basically, the Phy header has been reduced in size.
1215 * This increase performance, especially at high rates
1216 * (the preamble is transmitted at 1Mb/s), unfortunately
1217 * this give compatibility troubles... - Jean II */
1218 val = *((int *) extra);
1220 if (orinoco_lock(priv, &flags) != 0)
1221 return -EBUSY;
1223 if (val)
1224 priv->preamble = 1;
1225 else
1226 priv->preamble = 0;
1228 orinoco_unlock(priv, &flags);
1230 return -EINPROGRESS; /* Call commit handler */
1233 static int orinoco_ioctl_getpreamble(struct net_device *dev,
1234 struct iw_request_info *info,
1235 void *wrqu,
1236 char *extra)
1238 struct orinoco_private *priv = ndev_priv(dev);
1239 int *val = (int *) extra;
1241 if (!priv->has_preamble)
1242 return -EOPNOTSUPP;
1244 *val = priv->preamble;
1245 return 0;
1248 /* ioctl interface to hermes_read_ltv()
1249 * To use with iwpriv, pass the RID as the token argument, e.g.
1250 * iwpriv get_rid [0xfc00]
1251 * At least Wireless Tools 25 is required to use iwpriv.
1252 * For Wireless Tools 25 and 26 append "dummy" are the end. */
1253 static int orinoco_ioctl_getrid(struct net_device *dev,
1254 struct iw_request_info *info,
1255 struct iw_point *data,
1256 char *extra)
1258 struct orinoco_private *priv = ndev_priv(dev);
1259 hermes_t *hw = &priv->hw;
1260 int rid = data->flags;
1261 u16 length;
1262 int err;
1263 unsigned long flags;
1265 /* It's a "get" function, but we don't want users to access the
1266 * WEP key and other raw firmware data */
1267 if (!capable(CAP_NET_ADMIN))
1268 return -EPERM;
1270 if (rid < 0xfc00 || rid > 0xffff)
1271 return -EINVAL;
1273 if (orinoco_lock(priv, &flags) != 0)
1274 return -EBUSY;
1276 err = hermes_read_ltv(hw, USER_BAP, rid, MAX_RID_LEN, &length,
1277 extra);
1278 if (err)
1279 goto out;
1281 data->length = min_t(u16, HERMES_RECLEN_TO_BYTES(length),
1282 MAX_RID_LEN);
1284 out:
1285 orinoco_unlock(priv, &flags);
1286 return err;
1290 /* Commit handler, called after set operations */
1291 static int orinoco_ioctl_commit(struct net_device *dev,
1292 struct iw_request_info *info,
1293 void *wrqu,
1294 char *extra)
1296 struct orinoco_private *priv = ndev_priv(dev);
1297 unsigned long flags;
1298 int err = 0;
1300 if (!priv->open)
1301 return 0;
1303 if (orinoco_lock(priv, &flags) != 0)
1304 return err;
1306 err = orinoco_commit(priv);
1308 orinoco_unlock(priv, &flags);
1309 return err;
1312 static const struct iw_priv_args orinoco_privtab[] = {
1313 { SIOCIWFIRSTPRIV + 0x0, 0, 0, "force_reset" },
1314 { SIOCIWFIRSTPRIV + 0x1, 0, 0, "card_reset" },
1315 { SIOCIWFIRSTPRIV + 0x2, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1316 0, "set_port3" },
1317 { SIOCIWFIRSTPRIV + 0x3, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1318 "get_port3" },
1319 { SIOCIWFIRSTPRIV + 0x4, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1320 0, "set_preamble" },
1321 { SIOCIWFIRSTPRIV + 0x5, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1322 "get_preamble" },
1323 { SIOCIWFIRSTPRIV + 0x6, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1324 0, "set_ibssport" },
1325 { SIOCIWFIRSTPRIV + 0x7, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
1326 "get_ibssport" },
1327 { SIOCIWFIRSTPRIV + 0x9, 0, IW_PRIV_TYPE_BYTE | MAX_RID_LEN,
1328 "get_rid" },
1333 * Structures to export the Wireless Handlers
1336 static const iw_handler orinoco_handler[] = {
1337 IW_HANDLER(SIOCSIWCOMMIT, (iw_handler)orinoco_ioctl_commit),
1338 IW_HANDLER(SIOCGIWNAME, (iw_handler)cfg80211_wext_giwname),
1339 IW_HANDLER(SIOCSIWFREQ, (iw_handler)orinoco_ioctl_setfreq),
1340 IW_HANDLER(SIOCGIWFREQ, (iw_handler)orinoco_ioctl_getfreq),
1341 IW_HANDLER(SIOCSIWMODE, (iw_handler)cfg80211_wext_siwmode),
1342 IW_HANDLER(SIOCGIWMODE, (iw_handler)cfg80211_wext_giwmode),
1343 IW_HANDLER(SIOCSIWSENS, (iw_handler)orinoco_ioctl_setsens),
1344 IW_HANDLER(SIOCGIWSENS, (iw_handler)orinoco_ioctl_getsens),
1345 IW_HANDLER(SIOCGIWRANGE, (iw_handler)cfg80211_wext_giwrange),
1346 IW_HANDLER(SIOCSIWSPY, iw_handler_set_spy),
1347 IW_HANDLER(SIOCGIWSPY, iw_handler_get_spy),
1348 IW_HANDLER(SIOCSIWTHRSPY, iw_handler_set_thrspy),
1349 IW_HANDLER(SIOCGIWTHRSPY, iw_handler_get_thrspy),
1350 IW_HANDLER(SIOCSIWAP, (iw_handler)orinoco_ioctl_setwap),
1351 IW_HANDLER(SIOCGIWAP, (iw_handler)orinoco_ioctl_getwap),
1352 IW_HANDLER(SIOCSIWSCAN, (iw_handler)cfg80211_wext_siwscan),
1353 IW_HANDLER(SIOCGIWSCAN, (iw_handler)cfg80211_wext_giwscan),
1354 IW_HANDLER(SIOCSIWESSID, (iw_handler)orinoco_ioctl_setessid),
1355 IW_HANDLER(SIOCGIWESSID, (iw_handler)orinoco_ioctl_getessid),
1356 IW_HANDLER(SIOCSIWRATE, (iw_handler)orinoco_ioctl_setrate),
1357 IW_HANDLER(SIOCGIWRATE, (iw_handler)orinoco_ioctl_getrate),
1358 IW_HANDLER(SIOCSIWRTS, (iw_handler)cfg80211_wext_siwrts),
1359 IW_HANDLER(SIOCGIWRTS, (iw_handler)cfg80211_wext_giwrts),
1360 IW_HANDLER(SIOCSIWFRAG, (iw_handler)cfg80211_wext_siwfrag),
1361 IW_HANDLER(SIOCGIWFRAG, (iw_handler)cfg80211_wext_giwfrag),
1362 IW_HANDLER(SIOCGIWRETRY, (iw_handler)cfg80211_wext_giwretry),
1363 IW_HANDLER(SIOCSIWENCODE, (iw_handler)orinoco_ioctl_setiwencode),
1364 IW_HANDLER(SIOCGIWENCODE, (iw_handler)orinoco_ioctl_getiwencode),
1365 IW_HANDLER(SIOCSIWPOWER, (iw_handler)orinoco_ioctl_setpower),
1366 IW_HANDLER(SIOCGIWPOWER, (iw_handler)orinoco_ioctl_getpower),
1367 IW_HANDLER(SIOCSIWGENIE, orinoco_ioctl_set_genie),
1368 IW_HANDLER(SIOCGIWGENIE, orinoco_ioctl_get_genie),
1369 IW_HANDLER(SIOCSIWMLME, orinoco_ioctl_set_mlme),
1370 IW_HANDLER(SIOCSIWAUTH, orinoco_ioctl_set_auth),
1371 IW_HANDLER(SIOCGIWAUTH, orinoco_ioctl_get_auth),
1372 IW_HANDLER(SIOCSIWENCODEEXT, orinoco_ioctl_set_encodeext),
1373 IW_HANDLER(SIOCGIWENCODEEXT, orinoco_ioctl_get_encodeext),
1378 Added typecasting since we no longer use iwreq_data -- Moustafa
1380 static const iw_handler orinoco_private_handler[] = {
1381 [0] = (iw_handler)orinoco_ioctl_reset,
1382 [1] = (iw_handler)orinoco_ioctl_reset,
1383 [2] = (iw_handler)orinoco_ioctl_setport3,
1384 [3] = (iw_handler)orinoco_ioctl_getport3,
1385 [4] = (iw_handler)orinoco_ioctl_setpreamble,
1386 [5] = (iw_handler)orinoco_ioctl_getpreamble,
1387 [6] = (iw_handler)orinoco_ioctl_setibssport,
1388 [7] = (iw_handler)orinoco_ioctl_getibssport,
1389 [9] = (iw_handler)orinoco_ioctl_getrid,
1392 const struct iw_handler_def orinoco_handler_def = {
1393 .num_standard = ARRAY_SIZE(orinoco_handler),
1394 .num_private = ARRAY_SIZE(orinoco_private_handler),
1395 .num_private_args = ARRAY_SIZE(orinoco_privtab),
1396 .standard = orinoco_handler,
1397 .private = orinoco_private_handler,
1398 .private_args = orinoco_privtab,
1399 .get_wireless_stats = orinoco_get_wireless_stats,