]> git.karo-electronics.de Git - mv-sheeva.git/blob - drivers/net/wireless/orinoco/hw.c
Merge branch 'x86-fpu-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git...
[mv-sheeva.git] / drivers / net / wireless / orinoco / hw.c
1 /* Encapsulate basic setting changes and retrieval on Hermes hardware
2  *
3  * See copyright notice in main.c
4  */
5 #include <linux/kernel.h>
6 #include <linux/if_arp.h>
7 #include <linux/ieee80211.h>
8 #include <linux/wireless.h>
9
10 #include "hermes.h"
11 #include "hermes_rid.h"
12 #include "orinoco.h"
13
14 #include "hw.h"
15
16 /********************************************************************/
17 /* Data tables                                                      */
18 /********************************************************************/
19
20 /* This tables gives the actual meanings of the bitrate IDs returned
21  * by the firmware. */
22 static const struct {
23         int bitrate; /* in 100s of kilobits */
24         int automatic;
25         u16 agere_txratectrl;
26         u16 intersil_txratectrl;
27 } bitrate_table[] = {
28         {110, 1,  3, 15}, /* Entry 0 is the default */
29         {10,  0,  1,  1},
30         {10,  1,  1,  1},
31         {20,  0,  2,  2},
32         {20,  1,  6,  3},
33         {55,  0,  4,  4},
34         {55,  1,  7,  7},
35         {110, 0,  5,  8},
36 };
37 #define BITRATE_TABLE_SIZE ARRAY_SIZE(bitrate_table)
38
39 int orinoco_get_bitratemode(int bitrate, int automatic)
40 {
41         int ratemode = -1;
42         int i;
43
44         if ((bitrate != 10) && (bitrate != 20) &&
45             (bitrate != 55) && (bitrate != 110))
46                 return ratemode;
47
48         for (i = 0; i < BITRATE_TABLE_SIZE; i++) {
49                 if ((bitrate_table[i].bitrate == bitrate) &&
50                     (bitrate_table[i].automatic == automatic)) {
51                         ratemode = i;
52                         break;
53                 }
54         }
55         return ratemode;
56 }
57
58 void orinoco_get_ratemode_cfg(int ratemode, int *bitrate, int *automatic)
59 {
60         BUG_ON((ratemode < 0) || (ratemode >= BITRATE_TABLE_SIZE));
61
62         *bitrate = bitrate_table[ratemode].bitrate * 100000;
63         *automatic = bitrate_table[ratemode].automatic;
64 }
65
66 /* Get tsc from the firmware */
67 int orinoco_hw_get_tkip_iv(struct orinoco_private *priv, int key, u8 *tsc)
68 {
69         hermes_t *hw = &priv->hw;
70         int err = 0;
71         u8 tsc_arr[4][IW_ENCODE_SEQ_MAX_SIZE];
72
73         if ((key < 0) || (key > 4))
74                 return -EINVAL;
75
76         err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_CURRENT_TKIP_IV,
77                               sizeof(tsc_arr), NULL, &tsc_arr);
78         if (!err)
79                 memcpy(tsc, &tsc_arr[key][0], sizeof(tsc_arr[0]));
80
81         return err;
82 }
83
84 int __orinoco_hw_set_bitrate(struct orinoco_private *priv)
85 {
86         hermes_t *hw = &priv->hw;
87         int ratemode = priv->bitratemode;
88         int err = 0;
89
90         if (ratemode >= BITRATE_TABLE_SIZE) {
91                 printk(KERN_ERR "%s: BUG: Invalid bitrate mode %d\n",
92                        priv->ndev->name, ratemode);
93                 return -EINVAL;
94         }
95
96         switch (priv->firmware_type) {
97         case FIRMWARE_TYPE_AGERE:
98                 err = hermes_write_wordrec(hw, USER_BAP,
99                                 HERMES_RID_CNFTXRATECONTROL,
100                                 bitrate_table[ratemode].agere_txratectrl);
101                 break;
102         case FIRMWARE_TYPE_INTERSIL:
103         case FIRMWARE_TYPE_SYMBOL:
104                 err = hermes_write_wordrec(hw, USER_BAP,
105                                 HERMES_RID_CNFTXRATECONTROL,
106                                 bitrate_table[ratemode].intersil_txratectrl);
107                 break;
108         default:
109                 BUG();
110         }
111
112         return err;
113 }
114
115 int orinoco_hw_get_act_bitrate(struct orinoco_private *priv, int *bitrate)
116 {
117         hermes_t *hw = &priv->hw;
118         int i;
119         int err = 0;
120         u16 val;
121
122         err = hermes_read_wordrec(hw, USER_BAP,
123                                   HERMES_RID_CURRENTTXRATE, &val);
124         if (err)
125                 return err;
126
127         switch (priv->firmware_type) {
128         case FIRMWARE_TYPE_AGERE: /* Lucent style rate */
129                 /* Note : in Lucent firmware, the return value of
130                  * HERMES_RID_CURRENTTXRATE is the bitrate in Mb/s,
131                  * and therefore is totally different from the
132                  * encoding of HERMES_RID_CNFTXRATECONTROL.
133                  * Don't forget that 6Mb/s is really 5.5Mb/s */
134                 if (val == 6)
135                         *bitrate = 5500000;
136                 else
137                         *bitrate = val * 1000000;
138                 break;
139         case FIRMWARE_TYPE_INTERSIL: /* Intersil style rate */
140         case FIRMWARE_TYPE_SYMBOL: /* Symbol style rate */
141                 for (i = 0; i < BITRATE_TABLE_SIZE; i++)
142                         if (bitrate_table[i].intersil_txratectrl == val)
143                                 break;
144
145                 if (i >= BITRATE_TABLE_SIZE)
146                         printk(KERN_INFO "%s: Unable to determine current bitrate (0x%04hx)\n",
147                                priv->ndev->name, val);
148
149                 *bitrate = bitrate_table[i].bitrate * 100000;
150                 break;
151         default:
152                 BUG();
153         }
154
155         return err;
156 }
157
158 /* Set fixed AP address */
159 int __orinoco_hw_set_wap(struct orinoco_private *priv)
160 {
161         int roaming_flag;
162         int err = 0;
163         hermes_t *hw = &priv->hw;
164
165         switch (priv->firmware_type) {
166         case FIRMWARE_TYPE_AGERE:
167                 /* not supported */
168                 break;
169         case FIRMWARE_TYPE_INTERSIL:
170                 if (priv->bssid_fixed)
171                         roaming_flag = 2;
172                 else
173                         roaming_flag = 1;
174
175                 err = hermes_write_wordrec(hw, USER_BAP,
176                                            HERMES_RID_CNFROAMINGMODE,
177                                            roaming_flag);
178                 break;
179         case FIRMWARE_TYPE_SYMBOL:
180                 err = HERMES_WRITE_RECORD(hw, USER_BAP,
181                                           HERMES_RID_CNFMANDATORYBSSID_SYMBOL,
182                                           &priv->desired_bssid);
183                 break;
184         }
185         return err;
186 }
187
188 /* Change the WEP keys and/or the current keys.  Can be called
189  * either from __orinoco_hw_setup_enc() or directly from
190  * orinoco_ioctl_setiwencode().  In the later case the association
191  * with the AP is not broken (if the firmware can handle it),
192  * which is needed for 802.1x implementations. */
193 int __orinoco_hw_setup_wepkeys(struct orinoco_private *priv)
194 {
195         hermes_t *hw = &priv->hw;
196         int err = 0;
197
198         switch (priv->firmware_type) {
199         case FIRMWARE_TYPE_AGERE:
200                 err = HERMES_WRITE_RECORD(hw, USER_BAP,
201                                           HERMES_RID_CNFWEPKEYS_AGERE,
202                                           &priv->keys);
203                 if (err)
204                         return err;
205                 err = hermes_write_wordrec(hw, USER_BAP,
206                                            HERMES_RID_CNFTXKEY_AGERE,
207                                            priv->tx_key);
208                 if (err)
209                         return err;
210                 break;
211         case FIRMWARE_TYPE_INTERSIL:
212         case FIRMWARE_TYPE_SYMBOL:
213                 {
214                         int keylen;
215                         int i;
216
217                         /* Force uniform key length to work around
218                          * firmware bugs */
219                         keylen = le16_to_cpu(priv->keys[priv->tx_key].len);
220
221                         if (keylen > LARGE_KEY_SIZE) {
222                                 printk(KERN_ERR "%s: BUG: Key %d has oversize length %d.\n",
223                                        priv->ndev->name, priv->tx_key, keylen);
224                                 return -E2BIG;
225                         }
226
227                         /* Write all 4 keys */
228                         for (i = 0; i < ORINOCO_MAX_KEYS; i++) {
229                                 err = hermes_write_ltv(hw, USER_BAP,
230                                                 HERMES_RID_CNFDEFAULTKEY0 + i,
231                                                 HERMES_BYTES_TO_RECLEN(keylen),
232                                                 priv->keys[i].data);
233                                 if (err)
234                                         return err;
235                         }
236
237                         /* Write the index of the key used in transmission */
238                         err = hermes_write_wordrec(hw, USER_BAP,
239                                                 HERMES_RID_CNFWEPDEFAULTKEYID,
240                                                 priv->tx_key);
241                         if (err)
242                                 return err;
243                 }
244                 break;
245         }
246
247         return 0;
248 }
249
250 int __orinoco_hw_setup_enc(struct orinoco_private *priv)
251 {
252         hermes_t *hw = &priv->hw;
253         int err = 0;
254         int master_wep_flag;
255         int auth_flag;
256         int enc_flag;
257
258         /* Setup WEP keys for WEP and WPA */
259         if (priv->encode_alg)
260                 __orinoco_hw_setup_wepkeys(priv);
261
262         if (priv->wep_restrict)
263                 auth_flag = HERMES_AUTH_SHARED_KEY;
264         else
265                 auth_flag = HERMES_AUTH_OPEN;
266
267         if (priv->wpa_enabled)
268                 enc_flag = 2;
269         else if (priv->encode_alg == IW_ENCODE_ALG_WEP)
270                 enc_flag = 1;
271         else
272                 enc_flag = 0;
273
274         switch (priv->firmware_type) {
275         case FIRMWARE_TYPE_AGERE: /* Agere style WEP */
276                 if (priv->encode_alg == IW_ENCODE_ALG_WEP) {
277                         /* Enable the shared-key authentication. */
278                         err = hermes_write_wordrec(hw, USER_BAP,
279                                         HERMES_RID_CNFAUTHENTICATION_AGERE,
280                                         auth_flag);
281                 }
282                 err = hermes_write_wordrec(hw, USER_BAP,
283                                            HERMES_RID_CNFWEPENABLED_AGERE,
284                                            enc_flag);
285                 if (err)
286                         return err;
287
288                 if (priv->has_wpa) {
289                         /* Set WPA key management */
290                         err = hermes_write_wordrec(hw, USER_BAP,
291                                   HERMES_RID_CNFSETWPAAUTHMGMTSUITE_AGERE,
292                                   priv->key_mgmt);
293                         if (err)
294                                 return err;
295                 }
296
297                 break;
298
299         case FIRMWARE_TYPE_INTERSIL: /* Intersil style WEP */
300         case FIRMWARE_TYPE_SYMBOL: /* Symbol style WEP */
301                 if (priv->encode_alg == IW_ENCODE_ALG_WEP) {
302                         if (priv->wep_restrict ||
303                             (priv->firmware_type == FIRMWARE_TYPE_SYMBOL))
304                                 master_wep_flag = HERMES_WEP_PRIVACY_INVOKED |
305                                                   HERMES_WEP_EXCL_UNENCRYPTED;
306                         else
307                                 master_wep_flag = HERMES_WEP_PRIVACY_INVOKED;
308
309                         err = hermes_write_wordrec(hw, USER_BAP,
310                                                    HERMES_RID_CNFAUTHENTICATION,
311                                                    auth_flag);
312                         if (err)
313                                 return err;
314                 } else
315                         master_wep_flag = 0;
316
317                 if (priv->iw_mode == IW_MODE_MONITOR)
318                         master_wep_flag |= HERMES_WEP_HOST_DECRYPT;
319
320                 /* Master WEP setting : on/off */
321                 err = hermes_write_wordrec(hw, USER_BAP,
322                                            HERMES_RID_CNFWEPFLAGS_INTERSIL,
323                                            master_wep_flag);
324                 if (err)
325                         return err;
326
327                 break;
328         }
329
330         return 0;
331 }
332
333 /* key must be 32 bytes, including the tx and rx MIC keys.
334  * rsc must be 8 bytes
335  * tsc must be 8 bytes or NULL
336  */
337 int __orinoco_hw_set_tkip_key(hermes_t *hw, int key_idx, int set_tx,
338                               u8 *key, u8 *rsc, u8 *tsc)
339 {
340         struct {
341                 __le16 idx;
342                 u8 rsc[IW_ENCODE_SEQ_MAX_SIZE];
343                 u8 key[TKIP_KEYLEN];
344                 u8 tx_mic[MIC_KEYLEN];
345                 u8 rx_mic[MIC_KEYLEN];
346                 u8 tsc[IW_ENCODE_SEQ_MAX_SIZE];
347         } __attribute__ ((packed)) buf;
348         int ret;
349         int err;
350         int k;
351         u16 xmitting;
352
353         key_idx &= 0x3;
354
355         if (set_tx)
356                 key_idx |= 0x8000;
357
358         buf.idx = cpu_to_le16(key_idx);
359         memcpy(buf.key, key,
360                sizeof(buf.key) + sizeof(buf.tx_mic) + sizeof(buf.rx_mic));
361
362         if (rsc == NULL)
363                 memset(buf.rsc, 0, sizeof(buf.rsc));
364         else
365                 memcpy(buf.rsc, rsc, sizeof(buf.rsc));
366
367         if (tsc == NULL) {
368                 memset(buf.tsc, 0, sizeof(buf.tsc));
369                 buf.tsc[4] = 0x10;
370         } else {
371                 memcpy(buf.tsc, tsc, sizeof(buf.tsc));
372         }
373
374         /* Wait upto 100ms for tx queue to empty */
375         for (k = 100; k > 0; k--) {
376                 udelay(1000);
377                 ret = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_TXQUEUEEMPTY,
378                                           &xmitting);
379                 if (ret || !xmitting)
380                         break;
381         }
382
383         if (k == 0)
384                 ret = -ETIMEDOUT;
385
386         err = HERMES_WRITE_RECORD(hw, USER_BAP,
387                                   HERMES_RID_CNFADDDEFAULTTKIPKEY_AGERE,
388                                   &buf);
389
390         return ret ? ret : err;
391 }
392
393 int orinoco_clear_tkip_key(struct orinoco_private *priv, int key_idx)
394 {
395         hermes_t *hw = &priv->hw;
396         int err;
397
398         memset(&priv->tkip_key[key_idx], 0, sizeof(priv->tkip_key[key_idx]));
399         err = hermes_write_wordrec(hw, USER_BAP,
400                                    HERMES_RID_CNFREMDEFAULTTKIPKEY_AGERE,
401                                    key_idx);
402         if (err)
403                 printk(KERN_WARNING "%s: Error %d clearing TKIP key %d\n",
404                        priv->ndev->name, err, key_idx);
405         return err;
406 }
407
408 int __orinoco_hw_set_multicast_list(struct orinoco_private *priv,
409                                     struct dev_addr_list *mc_list,
410                                     int mc_count, int promisc)
411 {
412         hermes_t *hw = &priv->hw;
413         int err = 0;
414
415         if (promisc != priv->promiscuous) {
416                 err = hermes_write_wordrec(hw, USER_BAP,
417                                            HERMES_RID_CNFPROMISCUOUSMODE,
418                                            promisc);
419                 if (err) {
420                         printk(KERN_ERR "%s: Error %d setting PROMISCUOUSMODE to 1.\n",
421                                priv->ndev->name, err);
422                 } else
423                         priv->promiscuous = promisc;
424         }
425
426         /* If we're not in promiscuous mode, then we need to set the
427          * group address if either we want to multicast, or if we were
428          * multicasting and want to stop */
429         if (!promisc && (mc_count || priv->mc_count)) {
430                 struct dev_mc_list *p = mc_list;
431                 struct hermes_multicast mclist;
432                 int i;
433
434                 for (i = 0; i < mc_count; i++) {
435                         /* paranoia: is list shorter than mc_count? */
436                         BUG_ON(!p);
437                         /* paranoia: bad address size in list? */
438                         BUG_ON(p->dmi_addrlen != ETH_ALEN);
439
440                         memcpy(mclist.addr[i], p->dmi_addr, ETH_ALEN);
441                         p = p->next;
442                 }
443
444                 if (p)
445                         printk(KERN_WARNING "%s: Multicast list is "
446                                "longer than mc_count\n", priv->ndev->name);
447
448                 err = hermes_write_ltv(hw, USER_BAP,
449                                    HERMES_RID_CNFGROUPADDRESSES,
450                                    HERMES_BYTES_TO_RECLEN(mc_count * ETH_ALEN),
451                                    &mclist);
452                 if (err)
453                         printk(KERN_ERR "%s: Error %d setting multicast list.\n",
454                                priv->ndev->name, err);
455                 else
456                         priv->mc_count = mc_count;
457         }
458         return err;
459 }
460
461 /* Return : < 0 -> error code ; >= 0 -> length */
462 int orinoco_hw_get_essid(struct orinoco_private *priv, int *active,
463                          char buf[IW_ESSID_MAX_SIZE+1])
464 {
465         hermes_t *hw = &priv->hw;
466         int err = 0;
467         struct hermes_idstring essidbuf;
468         char *p = (char *)(&essidbuf.val);
469         int len;
470         unsigned long flags;
471
472         if (orinoco_lock(priv, &flags) != 0)
473                 return -EBUSY;
474
475         if (strlen(priv->desired_essid) > 0) {
476                 /* We read the desired SSID from the hardware rather
477                    than from priv->desired_essid, just in case the
478                    firmware is allowed to change it on us. I'm not
479                    sure about this */
480                 /* My guess is that the OWNSSID should always be whatever
481                  * we set to the card, whereas CURRENT_SSID is the one that
482                  * may change... - Jean II */
483                 u16 rid;
484
485                 *active = 1;
486
487                 rid = (priv->port_type == 3) ? HERMES_RID_CNFOWNSSID :
488                         HERMES_RID_CNFDESIREDSSID;
489
490                 err = hermes_read_ltv(hw, USER_BAP, rid, sizeof(essidbuf),
491                                       NULL, &essidbuf);
492                 if (err)
493                         goto fail_unlock;
494         } else {
495                 *active = 0;
496
497                 err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_CURRENTSSID,
498                                       sizeof(essidbuf), NULL, &essidbuf);
499                 if (err)
500                         goto fail_unlock;
501         }
502
503         len = le16_to_cpu(essidbuf.len);
504         BUG_ON(len > IW_ESSID_MAX_SIZE);
505
506         memset(buf, 0, IW_ESSID_MAX_SIZE);
507         memcpy(buf, p, len);
508         err = len;
509
510  fail_unlock:
511         orinoco_unlock(priv, &flags);
512
513         return err;
514 }
515
516 int orinoco_hw_get_freq(struct orinoco_private *priv)
517 {
518         hermes_t *hw = &priv->hw;
519         int err = 0;
520         u16 channel;
521         int freq = 0;
522         unsigned long flags;
523
524         if (orinoco_lock(priv, &flags) != 0)
525                 return -EBUSY;
526
527         err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CURRENTCHANNEL,
528                                   &channel);
529         if (err)
530                 goto out;
531
532         /* Intersil firmware 1.3.5 returns 0 when the interface is down */
533         if (channel == 0) {
534                 err = -EBUSY;
535                 goto out;
536         }
537
538         if ((channel < 1) || (channel > NUM_CHANNELS)) {
539                 printk(KERN_WARNING "%s: Channel out of range (%d)!\n",
540                        priv->ndev->name, channel);
541                 err = -EBUSY;
542                 goto out;
543
544         }
545         freq = ieee80211_dsss_chan_to_freq(channel);
546
547  out:
548         orinoco_unlock(priv, &flags);
549
550         if (err > 0)
551                 err = -EBUSY;
552         return err ? err : freq;
553 }
554
555 int orinoco_hw_get_bitratelist(struct orinoco_private *priv,
556                                int *numrates, s32 *rates, int max)
557 {
558         hermes_t *hw = &priv->hw;
559         struct hermes_idstring list;
560         unsigned char *p = (unsigned char *)&list.val;
561         int err = 0;
562         int num;
563         int i;
564         unsigned long flags;
565
566         if (orinoco_lock(priv, &flags) != 0)
567                 return -EBUSY;
568
569         err = hermes_read_ltv(hw, USER_BAP, HERMES_RID_SUPPORTEDDATARATES,
570                               sizeof(list), NULL, &list);
571         orinoco_unlock(priv, &flags);
572
573         if (err)
574                 return err;
575
576         num = le16_to_cpu(list.len);
577         *numrates = num;
578         num = min(num, max);
579
580         for (i = 0; i < num; i++)
581                 rates[i] = (p[i] & 0x7f) * 500000; /* convert to bps */
582
583         return 0;
584 }