Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[linux-2.6] / drivers / net / wireless / airo.c
1 /*======================================================================
2
3     Aironet driver for 4500 and 4800 series cards
4
5     This code is released under both the GPL version 2 and BSD licenses.
6     Either license may be used.  The respective licenses are found at
7     the end of this file.
8
9     This code was developed by Benjamin Reed <breed@users.sourceforge.net>
10     including portions of which come from the Aironet PC4500
11     Developer's Reference Manual and used with permission.  Copyright
12     (C) 1999 Benjamin Reed.  All Rights Reserved.  Permission to use
13     code in the Developer's manual was granted for this driver by
14     Aironet.  Major code contributions were received from Javier Achirica
15     <achirica@users.sourceforge.net> and Jean Tourrilhes <jt@hpl.hp.com>.
16     Code was also integrated from the Cisco Aironet driver for Linux.
17     Support for MPI350 cards was added by Fabrice Bellet
18     <fabrice@bellet.info>.
19
20 ======================================================================*/
21
22 #include <linux/err.h>
23 #include <linux/init.h>
24
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/proc_fs.h>
28
29 #include <linux/sched.h>
30 #include <linux/ptrace.h>
31 #include <linux/slab.h>
32 #include <linux/string.h>
33 #include <linux/timer.h>
34 #include <linux/interrupt.h>
35 #include <linux/in.h>
36 #include <linux/bitops.h>
37 #include <linux/scatterlist.h>
38 #include <linux/crypto.h>
39 #include <asm/io.h>
40 #include <asm/system.h>
41 #include <asm/unaligned.h>
42
43 #include <linux/netdevice.h>
44 #include <linux/etherdevice.h>
45 #include <linux/skbuff.h>
46 #include <linux/if_arp.h>
47 #include <linux/ioport.h>
48 #include <linux/pci.h>
49 #include <asm/uaccess.h>
50 #include <linux/kthread.h>
51 #include <linux/freezer.h>
52
53 #include <linux/ieee80211.h>
54
55 #include "airo.h"
56
57 #define DRV_NAME "airo"
58
59 #ifdef CONFIG_PCI
60 static struct pci_device_id card_ids[] = {
61         { 0x14b9, 1, PCI_ANY_ID, PCI_ANY_ID, },
62         { 0x14b9, 0x4500, PCI_ANY_ID, PCI_ANY_ID },
63         { 0x14b9, 0x4800, PCI_ANY_ID, PCI_ANY_ID, },
64         { 0x14b9, 0x0340, PCI_ANY_ID, PCI_ANY_ID, },
65         { 0x14b9, 0x0350, PCI_ANY_ID, PCI_ANY_ID, },
66         { 0x14b9, 0x5000, PCI_ANY_ID, PCI_ANY_ID, },
67         { 0x14b9, 0xa504, PCI_ANY_ID, PCI_ANY_ID, },
68         { 0, }
69 };
70 MODULE_DEVICE_TABLE(pci, card_ids);
71
72 static int airo_pci_probe(struct pci_dev *, const struct pci_device_id *);
73 static void airo_pci_remove(struct pci_dev *);
74 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state);
75 static int airo_pci_resume(struct pci_dev *pdev);
76
77 static struct pci_driver airo_driver = {
78         .name     = DRV_NAME,
79         .id_table = card_ids,
80         .probe    = airo_pci_probe,
81         .remove   = __devexit_p(airo_pci_remove),
82         .suspend  = airo_pci_suspend,
83         .resume   = airo_pci_resume,
84 };
85 #endif /* CONFIG_PCI */
86
87 /* Include Wireless Extension definition and check version - Jean II */
88 #include <linux/wireless.h>
89 #define WIRELESS_SPY            /* enable iwspy support */
90 #include <net/iw_handler.h>     /* New driver API */
91
92 #define CISCO_EXT               /* enable Cisco extensions */
93 #ifdef CISCO_EXT
94 #include <linux/delay.h>
95 #endif
96
97 /* Hack to do some power saving */
98 #define POWER_ON_DOWN
99
100 /* As you can see this list is HUGH!
101    I really don't know what a lot of these counts are about, but they
102    are all here for completeness.  If the IGNLABEL macro is put in
103    infront of the label, that statistic will not be included in the list
104    of statistics in the /proc filesystem */
105
106 #define IGNLABEL(comment) NULL
107 static char *statsLabels[] = {
108         "RxOverrun",
109         IGNLABEL("RxPlcpCrcErr"),
110         IGNLABEL("RxPlcpFormatErr"),
111         IGNLABEL("RxPlcpLengthErr"),
112         "RxMacCrcErr",
113         "RxMacCrcOk",
114         "RxWepErr",
115         "RxWepOk",
116         "RetryLong",
117         "RetryShort",
118         "MaxRetries",
119         "NoAck",
120         "NoCts",
121         "RxAck",
122         "RxCts",
123         "TxAck",
124         "TxRts",
125         "TxCts",
126         "TxMc",
127         "TxBc",
128         "TxUcFrags",
129         "TxUcPackets",
130         "TxBeacon",
131         "RxBeacon",
132         "TxSinColl",
133         "TxMulColl",
134         "DefersNo",
135         "DefersProt",
136         "DefersEngy",
137         "DupFram",
138         "RxFragDisc",
139         "TxAged",
140         "RxAged",
141         "LostSync-MaxRetry",
142         "LostSync-MissedBeacons",
143         "LostSync-ArlExceeded",
144         "LostSync-Deauth",
145         "LostSync-Disassoced",
146         "LostSync-TsfTiming",
147         "HostTxMc",
148         "HostTxBc",
149         "HostTxUc",
150         "HostTxFail",
151         "HostRxMc",
152         "HostRxBc",
153         "HostRxUc",
154         "HostRxDiscard",
155         IGNLABEL("HmacTxMc"),
156         IGNLABEL("HmacTxBc"),
157         IGNLABEL("HmacTxUc"),
158         IGNLABEL("HmacTxFail"),
159         IGNLABEL("HmacRxMc"),
160         IGNLABEL("HmacRxBc"),
161         IGNLABEL("HmacRxUc"),
162         IGNLABEL("HmacRxDiscard"),
163         IGNLABEL("HmacRxAccepted"),
164         "SsidMismatch",
165         "ApMismatch",
166         "RatesMismatch",
167         "AuthReject",
168         "AuthTimeout",
169         "AssocReject",
170         "AssocTimeout",
171         IGNLABEL("ReasonOutsideTable"),
172         IGNLABEL("ReasonStatus1"),
173         IGNLABEL("ReasonStatus2"),
174         IGNLABEL("ReasonStatus3"),
175         IGNLABEL("ReasonStatus4"),
176         IGNLABEL("ReasonStatus5"),
177         IGNLABEL("ReasonStatus6"),
178         IGNLABEL("ReasonStatus7"),
179         IGNLABEL("ReasonStatus8"),
180         IGNLABEL("ReasonStatus9"),
181         IGNLABEL("ReasonStatus10"),
182         IGNLABEL("ReasonStatus11"),
183         IGNLABEL("ReasonStatus12"),
184         IGNLABEL("ReasonStatus13"),
185         IGNLABEL("ReasonStatus14"),
186         IGNLABEL("ReasonStatus15"),
187         IGNLABEL("ReasonStatus16"),
188         IGNLABEL("ReasonStatus17"),
189         IGNLABEL("ReasonStatus18"),
190         IGNLABEL("ReasonStatus19"),
191         "RxMan",
192         "TxMan",
193         "RxRefresh",
194         "TxRefresh",
195         "RxPoll",
196         "TxPoll",
197         "HostRetries",
198         "LostSync-HostReq",
199         "HostTxBytes",
200         "HostRxBytes",
201         "ElapsedUsec",
202         "ElapsedSec",
203         "LostSyncBetterAP",
204         "PrivacyMismatch",
205         "Jammed",
206         "DiscRxNotWepped",
207         "PhyEleMismatch",
208         (char*)-1 };
209 #ifndef RUN_AT
210 #define RUN_AT(x) (jiffies+(x))
211 #endif
212
213
214 /* These variables are for insmod, since it seems that the rates
215    can only be set in setup_card.  Rates should be a comma separated
216    (no spaces) list of rates (up to 8). */
217
218 static int rates[8];
219 static int basic_rate;
220 static char *ssids[3];
221
222 static int io[4];
223 static int irq[4];
224
225 static
226 int maxencrypt /* = 0 */; /* The highest rate that the card can encrypt at.
227                        0 means no limit.  For old cards this was 4 */
228
229 static int auto_wep /* = 0 */; /* If set, it tries to figure out the wep mode */
230 static int aux_bap /* = 0 */; /* Checks to see if the aux ports are needed to read
231                     the bap, needed on some older cards and buses. */
232 static int adhoc;
233
234 static int probe = 1;
235
236 static int proc_uid /* = 0 */;
237
238 static int proc_gid /* = 0 */;
239
240 static int airo_perm = 0555;
241
242 static int proc_perm = 0644;
243
244 MODULE_AUTHOR("Benjamin Reed");
245 MODULE_DESCRIPTION("Support for Cisco/Aironet 802.11 wireless ethernet \
246 cards.  Direct support for ISA/PCI/MPI cards and support \
247 for PCMCIA when used with airo_cs.");
248 MODULE_LICENSE("Dual BSD/GPL");
249 MODULE_SUPPORTED_DEVICE("Aironet 4500, 4800 and Cisco 340/350");
250 module_param_array(io, int, NULL, 0);
251 module_param_array(irq, int, NULL, 0);
252 module_param(basic_rate, int, 0);
253 module_param_array(rates, int, NULL, 0);
254 module_param_array(ssids, charp, NULL, 0);
255 module_param(auto_wep, int, 0);
256 MODULE_PARM_DESC(auto_wep, "If non-zero, the driver will keep looping through \
257 the authentication options until an association is made.  The value of \
258 auto_wep is number of the wep keys to check.  A value of 2 will try using \
259 the key at index 0 and index 1.");
260 module_param(aux_bap, int, 0);
261 MODULE_PARM_DESC(aux_bap, "If non-zero, the driver will switch into a mode \
262 than seems to work better for older cards with some older buses.  Before \
263 switching it checks that the switch is needed.");
264 module_param(maxencrypt, int, 0);
265 MODULE_PARM_DESC(maxencrypt, "The maximum speed that the card can do \
266 encryption.  Units are in 512kbs.  Zero (default) means there is no limit. \
267 Older cards used to be limited to 2mbs (4).");
268 module_param(adhoc, int, 0);
269 MODULE_PARM_DESC(adhoc, "If non-zero, the card will start in adhoc mode.");
270 module_param(probe, int, 0);
271 MODULE_PARM_DESC(probe, "If zero, the driver won't start the card.");
272
273 module_param(proc_uid, int, 0);
274 MODULE_PARM_DESC(proc_uid, "The uid that the /proc files will belong to.");
275 module_param(proc_gid, int, 0);
276 MODULE_PARM_DESC(proc_gid, "The gid that the /proc files will belong to.");
277 module_param(airo_perm, int, 0);
278 MODULE_PARM_DESC(airo_perm, "The permission bits of /proc/[driver/]aironet.");
279 module_param(proc_perm, int, 0);
280 MODULE_PARM_DESC(proc_perm, "The permission bits of the files in /proc");
281
282 /* This is a kind of sloppy hack to get this information to OUT4500 and
283    IN4500.  I would be extremely interested in the situation where this
284    doesn't work though!!! */
285 static int do8bitIO /* = 0 */;
286
287 /* Return codes */
288 #define SUCCESS 0
289 #define ERROR -1
290 #define NO_PACKET -2
291
292 /* Commands */
293 #define NOP2            0x0000
294 #define MAC_ENABLE      0x0001
295 #define MAC_DISABLE     0x0002
296 #define CMD_LOSE_SYNC   0x0003 /* Not sure what this does... */
297 #define CMD_SOFTRESET   0x0004
298 #define HOSTSLEEP       0x0005
299 #define CMD_MAGIC_PKT   0x0006
300 #define CMD_SETWAKEMASK 0x0007
301 #define CMD_READCFG     0x0008
302 #define CMD_SETMODE     0x0009
303 #define CMD_ALLOCATETX  0x000a
304 #define CMD_TRANSMIT    0x000b
305 #define CMD_DEALLOCATETX 0x000c
306 #define NOP             0x0010
307 #define CMD_WORKAROUND  0x0011
308 #define CMD_ALLOCATEAUX 0x0020
309 #define CMD_ACCESS      0x0021
310 #define CMD_PCIBAP      0x0022
311 #define CMD_PCIAUX      0x0023
312 #define CMD_ALLOCBUF    0x0028
313 #define CMD_GETTLV      0x0029
314 #define CMD_PUTTLV      0x002a
315 #define CMD_DELTLV      0x002b
316 #define CMD_FINDNEXTTLV 0x002c
317 #define CMD_PSPNODES    0x0030
318 #define CMD_SETCW       0x0031    
319 #define CMD_SETPCF      0x0032    
320 #define CMD_SETPHYREG   0x003e
321 #define CMD_TXTEST      0x003f
322 #define MAC_ENABLETX    0x0101
323 #define CMD_LISTBSS     0x0103
324 #define CMD_SAVECFG     0x0108
325 #define CMD_ENABLEAUX   0x0111
326 #define CMD_WRITERID    0x0121
327 #define CMD_USEPSPNODES 0x0130
328 #define MAC_ENABLERX    0x0201
329
330 /* Command errors */
331 #define ERROR_QUALIF 0x00
332 #define ERROR_ILLCMD 0x01
333 #define ERROR_ILLFMT 0x02
334 #define ERROR_INVFID 0x03
335 #define ERROR_INVRID 0x04
336 #define ERROR_LARGE 0x05
337 #define ERROR_NDISABL 0x06
338 #define ERROR_ALLOCBSY 0x07
339 #define ERROR_NORD 0x0B
340 #define ERROR_NOWR 0x0C
341 #define ERROR_INVFIDTX 0x0D
342 #define ERROR_TESTACT 0x0E
343 #define ERROR_TAGNFND 0x12
344 #define ERROR_DECODE 0x20
345 #define ERROR_DESCUNAV 0x21
346 #define ERROR_BADLEN 0x22
347 #define ERROR_MODE 0x80
348 #define ERROR_HOP 0x81
349 #define ERROR_BINTER 0x82
350 #define ERROR_RXMODE 0x83
351 #define ERROR_MACADDR 0x84
352 #define ERROR_RATES 0x85
353 #define ERROR_ORDER 0x86
354 #define ERROR_SCAN 0x87
355 #define ERROR_AUTH 0x88
356 #define ERROR_PSMODE 0x89
357 #define ERROR_RTYPE 0x8A
358 #define ERROR_DIVER 0x8B
359 #define ERROR_SSID 0x8C
360 #define ERROR_APLIST 0x8D
361 #define ERROR_AUTOWAKE 0x8E
362 #define ERROR_LEAP 0x8F
363
364 /* Registers */
365 #define COMMAND 0x00
366 #define PARAM0 0x02
367 #define PARAM1 0x04
368 #define PARAM2 0x06
369 #define STATUS 0x08
370 #define RESP0 0x0a
371 #define RESP1 0x0c
372 #define RESP2 0x0e
373 #define LINKSTAT 0x10
374 #define SELECT0 0x18
375 #define OFFSET0 0x1c
376 #define RXFID 0x20
377 #define TXALLOCFID 0x22
378 #define TXCOMPLFID 0x24
379 #define DATA0 0x36
380 #define EVSTAT 0x30
381 #define EVINTEN 0x32
382 #define EVACK 0x34
383 #define SWS0 0x28
384 #define SWS1 0x2a
385 #define SWS2 0x2c
386 #define SWS3 0x2e
387 #define AUXPAGE 0x3A
388 #define AUXOFF 0x3C
389 #define AUXDATA 0x3E
390
391 #define FID_TX 1
392 #define FID_RX 2
393 /* Offset into aux memory for descriptors */
394 #define AUX_OFFSET 0x800
395 /* Size of allocated packets */
396 #define PKTSIZE 1840
397 #define RIDSIZE 2048
398 /* Size of the transmit queue */
399 #define MAXTXQ 64
400
401 /* BAP selectors */
402 #define BAP0 0 /* Used for receiving packets */
403 #define BAP1 2 /* Used for xmiting packets and working with RIDS */
404
405 /* Flags */
406 #define COMMAND_BUSY 0x8000
407
408 #define BAP_BUSY 0x8000
409 #define BAP_ERR 0x4000
410 #define BAP_DONE 0x2000
411
412 #define PROMISC 0xffff
413 #define NOPROMISC 0x0000
414
415 #define EV_CMD 0x10
416 #define EV_CLEARCOMMANDBUSY 0x4000
417 #define EV_RX 0x01
418 #define EV_TX 0x02
419 #define EV_TXEXC 0x04
420 #define EV_ALLOC 0x08
421 #define EV_LINK 0x80
422 #define EV_AWAKE 0x100
423 #define EV_TXCPY 0x400
424 #define EV_UNKNOWN 0x800
425 #define EV_MIC 0x1000 /* Message Integrity Check Interrupt */
426 #define EV_AWAKEN 0x2000
427 #define STATUS_INTS (EV_AWAKE|EV_LINK|EV_TXEXC|EV_TX|EV_TXCPY|EV_RX|EV_MIC)
428
429 #ifdef CHECK_UNKNOWN_INTS
430 #define IGNORE_INTS ( EV_CMD | EV_UNKNOWN)
431 #else
432 #define IGNORE_INTS (~STATUS_INTS)
433 #endif
434
435 /* RID TYPES */
436 #define RID_RW 0x20
437
438 /* The RIDs */
439 #define RID_CAPABILITIES 0xFF00
440 #define RID_APINFO     0xFF01
441 #define RID_RADIOINFO  0xFF02
442 #define RID_UNKNOWN3   0xFF03
443 #define RID_RSSI       0xFF04
444 #define RID_CONFIG     0xFF10
445 #define RID_SSID       0xFF11
446 #define RID_APLIST     0xFF12
447 #define RID_DRVNAME    0xFF13
448 #define RID_ETHERENCAP 0xFF14
449 #define RID_WEP_TEMP   0xFF15
450 #define RID_WEP_PERM   0xFF16
451 #define RID_MODULATION 0xFF17
452 #define RID_OPTIONS    0xFF18
453 #define RID_ACTUALCONFIG 0xFF20 /*readonly*/
454 #define RID_FACTORYCONFIG 0xFF21
455 #define RID_UNKNOWN22  0xFF22
456 #define RID_LEAPUSERNAME 0xFF23
457 #define RID_LEAPPASSWORD 0xFF24
458 #define RID_STATUS     0xFF50
459 #define RID_BEACON_HST 0xFF51
460 #define RID_BUSY_HST   0xFF52
461 #define RID_RETRIES_HST 0xFF53
462 #define RID_UNKNOWN54  0xFF54
463 #define RID_UNKNOWN55  0xFF55
464 #define RID_UNKNOWN56  0xFF56
465 #define RID_MIC        0xFF57
466 #define RID_STATS16    0xFF60
467 #define RID_STATS16DELTA 0xFF61
468 #define RID_STATS16DELTACLEAR 0xFF62
469 #define RID_STATS      0xFF68
470 #define RID_STATSDELTA 0xFF69
471 #define RID_STATSDELTACLEAR 0xFF6A
472 #define RID_ECHOTEST_RID 0xFF70
473 #define RID_ECHOTEST_RESULTS 0xFF71
474 #define RID_BSSLISTFIRST 0xFF72
475 #define RID_BSSLISTNEXT  0xFF73
476 #define RID_WPA_BSSLISTFIRST 0xFF74
477 #define RID_WPA_BSSLISTNEXT  0xFF75
478
479 typedef struct {
480         u16 cmd;
481         u16 parm0;
482         u16 parm1;
483         u16 parm2;
484 } Cmd;
485
486 typedef struct {
487         u16 status;
488         u16 rsp0;
489         u16 rsp1;
490         u16 rsp2;
491 } Resp;
492
493 /*
494  * Rids and endian-ness:  The Rids will always be in cpu endian, since
495  * this all the patches from the big-endian guys end up doing that.
496  * so all rid access should use the read/writeXXXRid routines.
497  */
498
499 /* This structure came from an email sent to me from an engineer at
500    aironet for inclusion into this driver */
501 typedef struct WepKeyRid WepKeyRid;
502 struct WepKeyRid {
503         __le16 len;
504         __le16 kindex;
505         u8 mac[ETH_ALEN];
506         __le16 klen;
507         u8 key[16];
508 } __attribute__ ((packed));
509
510 /* These structures are from the Aironet's PC4500 Developers Manual */
511 typedef struct Ssid Ssid;
512 struct Ssid {
513         __le16 len;
514         u8 ssid[32];
515 } __attribute__ ((packed));
516
517 typedef struct SsidRid SsidRid;
518 struct SsidRid {
519         __le16 len;
520         Ssid ssids[3];
521 } __attribute__ ((packed));
522
523 typedef struct ModulationRid ModulationRid;
524 struct ModulationRid {
525         __le16 len;
526         __le16 modulation;
527 #define MOD_DEFAULT cpu_to_le16(0)
528 #define MOD_CCK cpu_to_le16(1)
529 #define MOD_MOK cpu_to_le16(2)
530 } __attribute__ ((packed));
531
532 typedef struct ConfigRid ConfigRid;
533 struct ConfigRid {
534         __le16 len; /* sizeof(ConfigRid) */
535         __le16 opmode; /* operating mode */
536 #define MODE_STA_IBSS cpu_to_le16(0)
537 #define MODE_STA_ESS cpu_to_le16(1)
538 #define MODE_AP cpu_to_le16(2)
539 #define MODE_AP_RPTR cpu_to_le16(3)
540 #define MODE_CFG_MASK cpu_to_le16(0xff)
541 #define MODE_ETHERNET_HOST cpu_to_le16(0<<8) /* rx payloads converted */
542 #define MODE_LLC_HOST cpu_to_le16(1<<8) /* rx payloads left as is */
543 #define MODE_AIRONET_EXTEND cpu_to_le16(1<<9) /* enable Aironet extenstions */
544 #define MODE_AP_INTERFACE cpu_to_le16(1<<10) /* enable ap interface extensions */
545 #define MODE_ANTENNA_ALIGN cpu_to_le16(1<<11) /* enable antenna alignment */
546 #define MODE_ETHER_LLC cpu_to_le16(1<<12) /* enable ethernet LLC */
547 #define MODE_LEAF_NODE cpu_to_le16(1<<13) /* enable leaf node bridge */
548 #define MODE_CF_POLLABLE cpu_to_le16(1<<14) /* enable CF pollable */
549 #define MODE_MIC cpu_to_le16(1<<15) /* enable MIC */
550         __le16 rmode; /* receive mode */
551 #define RXMODE_BC_MC_ADDR cpu_to_le16(0)
552 #define RXMODE_BC_ADDR cpu_to_le16(1) /* ignore multicasts */
553 #define RXMODE_ADDR cpu_to_le16(2) /* ignore multicast and broadcast */
554 #define RXMODE_RFMON cpu_to_le16(3) /* wireless monitor mode */
555 #define RXMODE_RFMON_ANYBSS cpu_to_le16(4)
556 #define RXMODE_LANMON cpu_to_le16(5) /* lan style monitor -- data packets only */
557 #define RXMODE_MASK cpu_to_le16(255)
558 #define RXMODE_DISABLE_802_3_HEADER cpu_to_le16(1<<8) /* disables 802.3 header on rx */
559 #define RXMODE_FULL_MASK (RXMODE_MASK | RXMODE_DISABLE_802_3_HEADER)
560 #define RXMODE_NORMALIZED_RSSI cpu_to_le16(1<<9) /* return normalized RSSI */
561         __le16 fragThresh;
562         __le16 rtsThres;
563         u8 macAddr[ETH_ALEN];
564         u8 rates[8];
565         __le16 shortRetryLimit;
566         __le16 longRetryLimit;
567         __le16 txLifetime; /* in kusec */
568         __le16 rxLifetime; /* in kusec */
569         __le16 stationary;
570         __le16 ordering;
571         __le16 u16deviceType; /* for overriding device type */
572         __le16 cfpRate;
573         __le16 cfpDuration;
574         __le16 _reserved1[3];
575         /*---------- Scanning/Associating ----------*/
576         __le16 scanMode;
577 #define SCANMODE_ACTIVE cpu_to_le16(0)
578 #define SCANMODE_PASSIVE cpu_to_le16(1)
579 #define SCANMODE_AIROSCAN cpu_to_le16(2)
580         __le16 probeDelay; /* in kusec */
581         __le16 probeEnergyTimeout; /* in kusec */
582         __le16 probeResponseTimeout;
583         __le16 beaconListenTimeout;
584         __le16 joinNetTimeout;
585         __le16 authTimeout;
586         __le16 authType;
587 #define AUTH_OPEN cpu_to_le16(0x1)
588 #define AUTH_ENCRYPT cpu_to_le16(0x101)
589 #define AUTH_SHAREDKEY cpu_to_le16(0x102)
590 #define AUTH_ALLOW_UNENCRYPTED cpu_to_le16(0x200)
591         __le16 associationTimeout;
592         __le16 specifiedApTimeout;
593         __le16 offlineScanInterval;
594         __le16 offlineScanDuration;
595         __le16 linkLossDelay;
596         __le16 maxBeaconLostTime;
597         __le16 refreshInterval;
598 #define DISABLE_REFRESH cpu_to_le16(0xFFFF)
599         __le16 _reserved1a[1];
600         /*---------- Power save operation ----------*/
601         __le16 powerSaveMode;
602 #define POWERSAVE_CAM cpu_to_le16(0)
603 #define POWERSAVE_PSP cpu_to_le16(1)
604 #define POWERSAVE_PSPCAM cpu_to_le16(2)
605         __le16 sleepForDtims;
606         __le16 listenInterval;
607         __le16 fastListenInterval;
608         __le16 listenDecay;
609         __le16 fastListenDelay;
610         __le16 _reserved2[2];
611         /*---------- Ap/Ibss config items ----------*/
612         __le16 beaconPeriod;
613         __le16 atimDuration;
614         __le16 hopPeriod;
615         __le16 channelSet;
616         __le16 channel;
617         __le16 dtimPeriod;
618         __le16 bridgeDistance;
619         __le16 radioID;
620         /*---------- Radio configuration ----------*/
621         __le16 radioType;
622 #define RADIOTYPE_DEFAULT cpu_to_le16(0)
623 #define RADIOTYPE_802_11 cpu_to_le16(1)
624 #define RADIOTYPE_LEGACY cpu_to_le16(2)
625         u8 rxDiversity;
626         u8 txDiversity;
627         __le16 txPower;
628 #define TXPOWER_DEFAULT 0
629         __le16 rssiThreshold;
630 #define RSSI_DEFAULT 0
631         __le16 modulation;
632 #define PREAMBLE_AUTO cpu_to_le16(0)
633 #define PREAMBLE_LONG cpu_to_le16(1)
634 #define PREAMBLE_SHORT cpu_to_le16(2)
635         __le16 preamble;
636         __le16 homeProduct;
637         __le16 radioSpecific;
638         /*---------- Aironet Extensions ----------*/
639         u8 nodeName[16];
640         __le16 arlThreshold;
641         __le16 arlDecay;
642         __le16 arlDelay;
643         __le16 _reserved4[1];
644         /*---------- Aironet Extensions ----------*/
645         u8 magicAction;
646 #define MAGIC_ACTION_STSCHG 1
647 #define MAGIC_ACTION_RESUME 2
648 #define MAGIC_IGNORE_MCAST (1<<8)
649 #define MAGIC_IGNORE_BCAST (1<<9)
650 #define MAGIC_SWITCH_TO_PSP (0<<10)
651 #define MAGIC_STAY_IN_CAM (1<<10)
652         u8 magicControl;
653         __le16 autoWake;
654 } __attribute__ ((packed));
655
656 typedef struct StatusRid StatusRid;
657 struct StatusRid {
658         __le16 len;
659         u8 mac[ETH_ALEN];
660         __le16 mode;
661         __le16 errorCode;
662         __le16 sigQuality;
663         __le16 SSIDlen;
664         char SSID[32];
665         char apName[16];
666         u8 bssid[4][ETH_ALEN];
667         __le16 beaconPeriod;
668         __le16 dimPeriod;
669         __le16 atimDuration;
670         __le16 hopPeriod;
671         __le16 channelSet;
672         __le16 channel;
673         __le16 hopsToBackbone;
674         __le16 apTotalLoad;
675         __le16 generatedLoad;
676         __le16 accumulatedArl;
677         __le16 signalQuality;
678         __le16 currentXmitRate;
679         __le16 apDevExtensions;
680         __le16 normalizedSignalStrength;
681         __le16 shortPreamble;
682         u8 apIP[4];
683         u8 noisePercent; /* Noise percent in last second */
684         u8 noisedBm; /* Noise dBm in last second */
685         u8 noiseAvePercent; /* Noise percent in last minute */
686         u8 noiseAvedBm; /* Noise dBm in last minute */
687         u8 noiseMaxPercent; /* Highest noise percent in last minute */
688         u8 noiseMaxdBm; /* Highest noise dbm in last minute */
689         __le16 load;
690         u8 carrier[4];
691         __le16 assocStatus;
692 #define STAT_NOPACKETS 0
693 #define STAT_NOCARRIERSET 10
694 #define STAT_GOTCARRIERSET 11
695 #define STAT_WRONGSSID 20
696 #define STAT_BADCHANNEL 25
697 #define STAT_BADBITRATES 30
698 #define STAT_BADPRIVACY 35
699 #define STAT_APFOUND 40
700 #define STAT_APREJECTED 50
701 #define STAT_AUTHENTICATING 60
702 #define STAT_DEAUTHENTICATED 61
703 #define STAT_AUTHTIMEOUT 62
704 #define STAT_ASSOCIATING 70
705 #define STAT_DEASSOCIATED 71
706 #define STAT_ASSOCTIMEOUT 72
707 #define STAT_NOTAIROAP 73
708 #define STAT_ASSOCIATED 80
709 #define STAT_LEAPING 90
710 #define STAT_LEAPFAILED 91
711 #define STAT_LEAPTIMEDOUT 92
712 #define STAT_LEAPCOMPLETE 93
713 } __attribute__ ((packed));
714
715 typedef struct StatsRid StatsRid;
716 struct StatsRid {
717         __le16 len;
718         __le16 spacer;
719         __le32 vals[100];
720 } __attribute__ ((packed));
721
722 typedef struct APListRid APListRid;
723 struct APListRid {
724         __le16 len;
725         u8 ap[4][ETH_ALEN];
726 } __attribute__ ((packed));
727
728 typedef struct CapabilityRid CapabilityRid;
729 struct CapabilityRid {
730         __le16 len;
731         char oui[3];
732         char zero;
733         __le16 prodNum;
734         char manName[32];
735         char prodName[16];
736         char prodVer[8];
737         char factoryAddr[ETH_ALEN];
738         char aironetAddr[ETH_ALEN];
739         __le16 radioType;
740         __le16 country;
741         char callid[ETH_ALEN];
742         char supportedRates[8];
743         char rxDiversity;
744         char txDiversity;
745         __le16 txPowerLevels[8];
746         __le16 hardVer;
747         __le16 hardCap;
748         __le16 tempRange;
749         __le16 softVer;
750         __le16 softSubVer;
751         __le16 interfaceVer;
752         __le16 softCap;
753         __le16 bootBlockVer;
754         __le16 requiredHard;
755         __le16 extSoftCap;
756 } __attribute__ ((packed));
757
758 /* Only present on firmware >= 5.30.17 */
759 typedef struct BSSListRidExtra BSSListRidExtra;
760 struct BSSListRidExtra {
761   __le16 unknown[4];
762   u8 fixed[12]; /* WLAN management frame */
763   u8 iep[624];
764 } __attribute__ ((packed));
765
766 typedef struct BSSListRid BSSListRid;
767 struct BSSListRid {
768   __le16 len;
769   __le16 index; /* First is 0 and 0xffff means end of list */
770 #define RADIO_FH 1 /* Frequency hopping radio type */
771 #define RADIO_DS 2 /* Direct sequence radio type */
772 #define RADIO_TMA 4 /* Proprietary radio used in old cards (2500) */
773   __le16 radioType;
774   u8 bssid[ETH_ALEN]; /* Mac address of the BSS */
775   u8 zero;
776   u8 ssidLen;
777   u8 ssid[32];
778   __le16 dBm;
779 #define CAP_ESS cpu_to_le16(1<<0)
780 #define CAP_IBSS cpu_to_le16(1<<1)
781 #define CAP_PRIVACY cpu_to_le16(1<<4)
782 #define CAP_SHORTHDR cpu_to_le16(1<<5)
783   __le16 cap;
784   __le16 beaconInterval;
785   u8 rates[8]; /* Same as rates for config rid */
786   struct { /* For frequency hopping only */
787     __le16 dwell;
788     u8 hopSet;
789     u8 hopPattern;
790     u8 hopIndex;
791     u8 fill;
792   } fh;
793   __le16 dsChannel;
794   __le16 atimWindow;
795
796   /* Only present on firmware >= 5.30.17 */
797   BSSListRidExtra extra;
798 } __attribute__ ((packed));
799
800 typedef struct {
801   BSSListRid bss;
802   struct list_head list;
803 } BSSListElement;
804
805 typedef struct tdsRssiEntry tdsRssiEntry;
806 struct tdsRssiEntry {
807   u8 rssipct;
808   u8 rssidBm;
809 } __attribute__ ((packed));
810
811 typedef struct tdsRssiRid tdsRssiRid;
812 struct tdsRssiRid {
813   u16 len;
814   tdsRssiEntry x[256];
815 } __attribute__ ((packed));
816
817 typedef struct MICRid MICRid;
818 struct MICRid {
819         __le16 len;
820         __le16 state;
821         __le16 multicastValid;
822         u8  multicast[16];
823         __le16 unicastValid;
824         u8  unicast[16];
825 } __attribute__ ((packed));
826
827 typedef struct MICBuffer MICBuffer;
828 struct MICBuffer {
829         __be16 typelen;
830
831         union {
832             u8 snap[8];
833             struct {
834                 u8 dsap;
835                 u8 ssap;
836                 u8 control;
837                 u8 orgcode[3];
838                 u8 fieldtype[2];
839             } llc;
840         } u;
841         __be32 mic;
842         __be32 seq;
843 } __attribute__ ((packed));
844
845 typedef struct {
846         u8 da[ETH_ALEN];
847         u8 sa[ETH_ALEN];
848 } etherHead;
849
850 #define TXCTL_TXOK (1<<1) /* report if tx is ok */
851 #define TXCTL_TXEX (1<<2) /* report if tx fails */
852 #define TXCTL_802_3 (0<<3) /* 802.3 packet */
853 #define TXCTL_802_11 (1<<3) /* 802.11 mac packet */
854 #define TXCTL_ETHERNET (0<<4) /* payload has ethertype */
855 #define TXCTL_LLC (1<<4) /* payload is llc */
856 #define TXCTL_RELEASE (0<<5) /* release after completion */
857 #define TXCTL_NORELEASE (1<<5) /* on completion returns to host */
858
859 #define BUSY_FID 0x10000
860
861 #ifdef CISCO_EXT
862 #define AIROMAGIC       0xa55a
863 /* Warning : SIOCDEVPRIVATE may disapear during 2.5.X - Jean II */
864 #ifdef SIOCIWFIRSTPRIV
865 #ifdef SIOCDEVPRIVATE
866 #define AIROOLDIOCTL    SIOCDEVPRIVATE
867 #define AIROOLDIDIFC    AIROOLDIOCTL + 1
868 #endif /* SIOCDEVPRIVATE */
869 #else /* SIOCIWFIRSTPRIV */
870 #define SIOCIWFIRSTPRIV SIOCDEVPRIVATE
871 #endif /* SIOCIWFIRSTPRIV */
872 /* This may be wrong. When using the new SIOCIWFIRSTPRIV range, we probably
873  * should use only "GET" ioctls (last bit set to 1). "SET" ioctls are root
874  * only and don't return the modified struct ifreq to the application which
875  * is usually a problem. - Jean II */
876 #define AIROIOCTL       SIOCIWFIRSTPRIV
877 #define AIROIDIFC       AIROIOCTL + 1
878
879 /* Ioctl constants to be used in airo_ioctl.command */
880
881 #define AIROGCAP                0       // Capability rid
882 #define AIROGCFG                1       // USED A LOT
883 #define AIROGSLIST              2       // System ID list
884 #define AIROGVLIST              3       // List of specified AP's
885 #define AIROGDRVNAM             4       //  NOTUSED
886 #define AIROGEHTENC             5       // NOTUSED
887 #define AIROGWEPKTMP            6
888 #define AIROGWEPKNV             7
889 #define AIROGSTAT               8
890 #define AIROGSTATSC32           9
891 #define AIROGSTATSD32           10
892 #define AIROGMICRID             11
893 #define AIROGMICSTATS           12
894 #define AIROGFLAGS              13
895 #define AIROGID                 14
896 #define AIRORRID                15
897 #define AIRORSWVERSION          17
898
899 /* Leave gap of 40 commands after AIROGSTATSD32 for future */
900
901 #define AIROPCAP                AIROGSTATSD32 + 40
902 #define AIROPVLIST              AIROPCAP      + 1
903 #define AIROPSLIST              AIROPVLIST    + 1
904 #define AIROPCFG                AIROPSLIST    + 1
905 #define AIROPSIDS               AIROPCFG      + 1
906 #define AIROPAPLIST             AIROPSIDS     + 1
907 #define AIROPMACON              AIROPAPLIST   + 1       /* Enable mac  */
908 #define AIROPMACOFF             AIROPMACON    + 1       /* Disable mac */
909 #define AIROPSTCLR              AIROPMACOFF   + 1
910 #define AIROPWEPKEY             AIROPSTCLR    + 1
911 #define AIROPWEPKEYNV           AIROPWEPKEY   + 1
912 #define AIROPLEAPPWD            AIROPWEPKEYNV + 1
913 #define AIROPLEAPUSR            AIROPLEAPPWD  + 1
914
915 /* Flash codes */
916
917 #define AIROFLSHRST            AIROPWEPKEYNV  + 40
918 #define AIROFLSHGCHR           AIROFLSHRST    + 1
919 #define AIROFLSHSTFL           AIROFLSHGCHR   + 1
920 #define AIROFLSHPCHR           AIROFLSHSTFL   + 1
921 #define AIROFLPUTBUF           AIROFLSHPCHR   + 1
922 #define AIRORESTART            AIROFLPUTBUF   + 1
923
924 #define FLASHSIZE       32768
925 #define AUXMEMSIZE      (256 * 1024)
926
927 typedef struct aironet_ioctl {
928         unsigned short command;         // What to do
929         unsigned short len;             // Len of data
930         unsigned short ridnum;          // rid number
931         unsigned char __user *data;     // d-data
932 } aironet_ioctl;
933
934 static char swversion[] = "2.1";
935 #endif /* CISCO_EXT */
936
937 #define NUM_MODULES       2
938 #define MIC_MSGLEN_MAX    2400
939 #define EMMH32_MSGLEN_MAX MIC_MSGLEN_MAX
940 #define AIRO_DEF_MTU      2312
941
942 typedef struct {
943         u32   size;            // size
944         u8    enabled;         // MIC enabled or not
945         u32   rxSuccess;       // successful packets received
946         u32   rxIncorrectMIC;  // pkts dropped due to incorrect MIC comparison
947         u32   rxNotMICed;      // pkts dropped due to not being MIC'd
948         u32   rxMICPlummed;    // pkts dropped due to not having a MIC plummed
949         u32   rxWrongSequence; // pkts dropped due to sequence number violation
950         u32   reserve[32];
951 } mic_statistics;
952
953 typedef struct {
954         u32 coeff[((EMMH32_MSGLEN_MAX)+3)>>2];
955         u64 accum;      // accumulated mic, reduced to u32 in final()
956         int position;   // current position (byte offset) in message
957         union {
958                 u8  d8[4];
959                 __be32 d32;
960         } part; // saves partial message word across update() calls
961 } emmh32_context;
962
963 typedef struct {
964         emmh32_context seed;        // Context - the seed
965         u32              rx;        // Received sequence number
966         u32              tx;        // Tx sequence number
967         u32              window;    // Start of window
968         u8               valid;     // Flag to say if context is valid or not
969         u8               key[16];
970 } miccntx;
971
972 typedef struct {
973         miccntx mCtx;           // Multicast context
974         miccntx uCtx;           // Unicast context
975 } mic_module;
976
977 typedef struct {
978         unsigned int  rid: 16;
979         unsigned int  len: 15;
980         unsigned int  valid: 1;
981         dma_addr_t host_addr;
982 } Rid;
983
984 typedef struct {
985         unsigned int  offset: 15;
986         unsigned int  eoc: 1;
987         unsigned int  len: 15;
988         unsigned int  valid: 1;
989         dma_addr_t host_addr;
990 } TxFid;
991
992 struct rx_hdr {
993         __le16 status, len;
994         u8 rssi[2];
995         u8 rate;
996         u8 freq;
997         __le16 tmp[4];
998 } __attribute__ ((packed));
999
1000 typedef struct {
1001         unsigned int  ctl: 15;
1002         unsigned int  rdy: 1;
1003         unsigned int  len: 15;
1004         unsigned int  valid: 1;
1005         dma_addr_t host_addr;
1006 } RxFid;
1007
1008 /*
1009  * Host receive descriptor
1010  */
1011 typedef struct {
1012         unsigned char __iomem *card_ram_off; /* offset into card memory of the
1013                                                 desc */
1014         RxFid         rx_desc;               /* card receive descriptor */
1015         char          *virtual_host_addr;    /* virtual address of host receive
1016                                                 buffer */
1017         int           pending;
1018 } HostRxDesc;
1019
1020 /*
1021  * Host transmit descriptor
1022  */
1023 typedef struct {
1024         unsigned char __iomem *card_ram_off;         /* offset into card memory of the
1025                                                 desc */
1026         TxFid         tx_desc;               /* card transmit descriptor */
1027         char          *virtual_host_addr;    /* virtual address of host receive
1028                                                 buffer */
1029         int           pending;
1030 } HostTxDesc;
1031
1032 /*
1033  * Host RID descriptor
1034  */
1035 typedef struct {
1036         unsigned char __iomem *card_ram_off;      /* offset into card memory of the
1037                                              descriptor */
1038         Rid           rid_desc;           /* card RID descriptor */
1039         char          *virtual_host_addr; /* virtual address of host receive
1040                                              buffer */
1041 } HostRidDesc;
1042
1043 typedef struct {
1044         u16 sw0;
1045         u16 sw1;
1046         u16 status;
1047         u16 len;
1048 #define HOST_SET (1 << 0)
1049 #define HOST_INT_TX (1 << 1) /* Interrupt on successful TX */
1050 #define HOST_INT_TXERR (1 << 2) /* Interrupt on unseccessful TX */
1051 #define HOST_LCC_PAYLOAD (1 << 4) /* LLC payload, 0 = Ethertype */
1052 #define HOST_DONT_RLSE (1 << 5) /* Don't release buffer when done */
1053 #define HOST_DONT_RETRY (1 << 6) /* Don't retry trasmit */
1054 #define HOST_CLR_AID (1 << 7) /* clear AID failure */
1055 #define HOST_RTS (1 << 9) /* Force RTS use */
1056 #define HOST_SHORT (1 << 10) /* Do short preamble */
1057         u16 ctl;
1058         u16 aid;
1059         u16 retries;
1060         u16 fill;
1061 } TxCtlHdr;
1062
1063 typedef struct {
1064         u16 ctl;
1065         u16 duration;
1066         char addr1[6];
1067         char addr2[6];
1068         char addr3[6];
1069         u16 seq;
1070         char addr4[6];
1071 } WifiHdr;
1072
1073
1074 typedef struct {
1075         TxCtlHdr ctlhdr;
1076         u16 fill1;
1077         u16 fill2;
1078         WifiHdr wifihdr;
1079         u16 gaplen;
1080         u16 status;
1081 } WifiCtlHdr;
1082
1083 static WifiCtlHdr wifictlhdr8023 = {
1084         .ctlhdr = {
1085                 .ctl    = HOST_DONT_RLSE,
1086         }
1087 };
1088
1089 // A few details needed for WEP (Wireless Equivalent Privacy)
1090 #define MAX_KEY_SIZE 13                 // 128 (?) bits
1091 #define MIN_KEY_SIZE  5                 // 40 bits RC4 - WEP
1092 typedef struct wep_key_t {
1093         u16     len;
1094         u8      key[16];        /* 40-bit and 104-bit keys */
1095 } wep_key_t;
1096
1097 /* List of Wireless Handlers (new API) */
1098 static const struct iw_handler_def      airo_handler_def;
1099
1100 static const char version[] = "airo.c 0.6 (Ben Reed & Javier Achirica)";
1101
1102 struct airo_info;
1103
1104 static int get_dec_u16( char *buffer, int *start, int limit );
1105 static void OUT4500( struct airo_info *, u16 register, u16 value );
1106 static unsigned short IN4500( struct airo_info *, u16 register );
1107 static u16 setup_card(struct airo_info*, u8 *mac, int lock);
1108 static int enable_MAC(struct airo_info *ai, int lock);
1109 static void disable_MAC(struct airo_info *ai, int lock);
1110 static void enable_interrupts(struct airo_info*);
1111 static void disable_interrupts(struct airo_info*);
1112 static u16 issuecommand(struct airo_info*, Cmd *pCmd, Resp *pRsp);
1113 static int bap_setup(struct airo_info*, u16 rid, u16 offset, int whichbap);
1114 static int aux_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
1115                         int whichbap);
1116 static int fast_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
1117                          int whichbap);
1118 static int bap_write(struct airo_info*, const __le16 *pu16Src, int bytelen,
1119                      int whichbap);
1120 static int PC4500_accessrid(struct airo_info*, u16 rid, u16 accmd);
1121 static int PC4500_readrid(struct airo_info*, u16 rid, void *pBuf, int len, int lock);
1122 static int PC4500_writerid(struct airo_info*, u16 rid, const void
1123                            *pBuf, int len, int lock);
1124 static int do_writerid( struct airo_info*, u16 rid, const void *rid_data,
1125                         int len, int dummy );
1126 static u16 transmit_allocate(struct airo_info*, int lenPayload, int raw);
1127 static int transmit_802_3_packet(struct airo_info*, int len, char *pPacket);
1128 static int transmit_802_11_packet(struct airo_info*, int len, char *pPacket);
1129
1130 static int mpi_send_packet (struct net_device *dev);
1131 static void mpi_unmap_card(struct pci_dev *pci);
1132 static void mpi_receive_802_3(struct airo_info *ai);
1133 static void mpi_receive_802_11(struct airo_info *ai);
1134 static int waitbusy (struct airo_info *ai);
1135
1136 static irqreturn_t airo_interrupt( int irq, void* dev_id);
1137 static int airo_thread(void *data);
1138 static void timer_func( struct net_device *dev );
1139 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
1140 static struct iw_statistics *airo_get_wireless_stats (struct net_device *dev);
1141 static void airo_read_wireless_stats (struct airo_info *local);
1142 #ifdef CISCO_EXT
1143 static int readrids(struct net_device *dev, aironet_ioctl *comp);
1144 static int writerids(struct net_device *dev, aironet_ioctl *comp);
1145 static int flashcard(struct net_device *dev, aironet_ioctl *comp);
1146 #endif /* CISCO_EXT */
1147 static void micinit(struct airo_info *ai);
1148 static int micsetup(struct airo_info *ai);
1149 static int encapsulate(struct airo_info *ai, etherHead *pPacket, MICBuffer *buffer, int len);
1150 static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *pPacket, u16 payLen);
1151
1152 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi);
1153 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm);
1154
1155 static void airo_networks_free(struct airo_info *ai);
1156
1157 struct airo_info {
1158         struct net_device             *dev;
1159         struct list_head              dev_list;
1160         /* Note, we can have MAX_FIDS outstanding.  FIDs are 16-bits, so we
1161            use the high bit to mark whether it is in use. */
1162 #define MAX_FIDS 6
1163 #define MPI_MAX_FIDS 1
1164         u32                           fids[MAX_FIDS];
1165         ConfigRid config;
1166         char keyindex; // Used with auto wep
1167         char defindex; // Used with auto wep
1168         struct proc_dir_entry *proc_entry;
1169         spinlock_t aux_lock;
1170 #define FLAG_RADIO_OFF  0       /* User disabling of MAC */
1171 #define FLAG_RADIO_DOWN 1       /* ifup/ifdown disabling of MAC */
1172 #define FLAG_RADIO_MASK 0x03
1173 #define FLAG_ENABLED    2
1174 #define FLAG_ADHOC      3       /* Needed by MIC */
1175 #define FLAG_MIC_CAPABLE 4
1176 #define FLAG_UPDATE_MULTI 5
1177 #define FLAG_UPDATE_UNI 6
1178 #define FLAG_802_11     7
1179 #define FLAG_PROMISC    8       /* IFF_PROMISC 0x100 - include/linux/if.h */
1180 #define FLAG_PENDING_XMIT 9
1181 #define FLAG_PENDING_XMIT11 10
1182 #define FLAG_MPI        11
1183 #define FLAG_REGISTERED 12
1184 #define FLAG_COMMIT     13
1185 #define FLAG_RESET      14
1186 #define FLAG_FLASHING   15
1187 #define FLAG_WPA_CAPABLE        16
1188         unsigned long flags;
1189 #define JOB_DIE 0
1190 #define JOB_XMIT        1
1191 #define JOB_XMIT11      2
1192 #define JOB_STATS       3
1193 #define JOB_PROMISC     4
1194 #define JOB_MIC 5
1195 #define JOB_EVENT       6
1196 #define JOB_AUTOWEP     7
1197 #define JOB_WSTATS      8
1198 #define JOB_SCAN_RESULTS  9
1199         unsigned long jobs;
1200         int (*bap_read)(struct airo_info*, __le16 *pu16Dst, int bytelen,
1201                         int whichbap);
1202         unsigned short *flash;
1203         tdsRssiEntry *rssi;
1204         struct task_struct *list_bss_task;
1205         struct task_struct *airo_thread_task;
1206         struct semaphore sem;
1207         wait_queue_head_t thr_wait;
1208         unsigned long expires;
1209         struct {
1210                 struct sk_buff *skb;
1211                 int fid;
1212         } xmit, xmit11;
1213         struct net_device *wifidev;
1214         struct iw_statistics    wstats;         // wireless stats
1215         unsigned long           scan_timeout;   /* Time scan should be read */
1216         struct iw_spy_data      spy_data;
1217         struct iw_public_data   wireless_data;
1218         /* MIC stuff */
1219         struct crypto_cipher    *tfm;
1220         mic_module              mod[2];
1221         mic_statistics          micstats;
1222         HostRxDesc rxfids[MPI_MAX_FIDS]; // rx/tx/config MPI350 descriptors
1223         HostTxDesc txfids[MPI_MAX_FIDS];
1224         HostRidDesc config_desc;
1225         unsigned long ridbus; // phys addr of config_desc
1226         struct sk_buff_head txq;// tx queue used by mpi350 code
1227         struct pci_dev          *pci;
1228         unsigned char           __iomem *pcimem;
1229         unsigned char           __iomem *pciaux;
1230         unsigned char           *shared;
1231         dma_addr_t              shared_dma;
1232         pm_message_t            power;
1233         SsidRid                 *SSID;
1234         APListRid               *APList;
1235 #define PCI_SHARED_LEN          2*MPI_MAX_FIDS*PKTSIZE+RIDSIZE
1236         char                    proc_name[IFNAMSIZ];
1237
1238         int                     wep_capable;
1239         int                     max_wep_idx;
1240
1241         /* WPA-related stuff */
1242         unsigned int bssListFirst;
1243         unsigned int bssListNext;
1244         unsigned int bssListRidLen;
1245
1246         struct list_head network_list;
1247         struct list_head network_free_list;
1248         BSSListElement *networks;
1249 };
1250
1251 static inline int bap_read(struct airo_info *ai, __le16 *pu16Dst, int bytelen,
1252                            int whichbap)
1253 {
1254         return ai->bap_read(ai, pu16Dst, bytelen, whichbap);
1255 }
1256
1257 static int setup_proc_entry( struct net_device *dev,
1258                              struct airo_info *apriv );
1259 static int takedown_proc_entry( struct net_device *dev,
1260                                 struct airo_info *apriv );
1261
1262 static int cmdreset(struct airo_info *ai);
1263 static int setflashmode (struct airo_info *ai);
1264 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime);
1265 static int flashputbuf(struct airo_info *ai);
1266 static int flashrestart(struct airo_info *ai,struct net_device *dev);
1267
1268 #define airo_print(type, name, fmt, args...) \
1269         printk(type DRV_NAME "(%s): " fmt "\n", name, ##args)
1270
1271 #define airo_print_info(name, fmt, args...) \
1272         airo_print(KERN_INFO, name, fmt, ##args)
1273
1274 #define airo_print_dbg(name, fmt, args...) \
1275         airo_print(KERN_DEBUG, name, fmt, ##args)
1276
1277 #define airo_print_warn(name, fmt, args...) \
1278         airo_print(KERN_WARNING, name, fmt, ##args)
1279
1280 #define airo_print_err(name, fmt, args...) \
1281         airo_print(KERN_ERR, name, fmt, ##args)
1282
1283 #define AIRO_FLASH(dev) (((struct airo_info *)dev->ml_priv)->flash)
1284
1285 /***********************************************************************
1286  *                              MIC ROUTINES                           *
1287  ***********************************************************************
1288  */
1289
1290 static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq);
1291 static void MoveWindow(miccntx *context, u32 micSeq);
1292 static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1293                            struct crypto_cipher *tfm);
1294 static void emmh32_init(emmh32_context *context);
1295 static void emmh32_update(emmh32_context *context, u8 *pOctets, int len);
1296 static void emmh32_final(emmh32_context *context, u8 digest[4]);
1297 static int flashpchar(struct airo_info *ai,int byte,int dwelltime);
1298
1299 static void age_mic_context(miccntx *cur, miccntx *old, u8 *key, int key_len,
1300                             struct crypto_cipher *tfm)
1301 {
1302         /* If the current MIC context is valid and its key is the same as
1303          * the MIC register, there's nothing to do.
1304          */
1305         if (cur->valid && (memcmp(cur->key, key, key_len) == 0))
1306                 return;
1307
1308         /* Age current mic Context */
1309         memcpy(old, cur, sizeof(*cur));
1310
1311         /* Initialize new context */
1312         memcpy(cur->key, key, key_len);
1313         cur->window  = 33; /* Window always points to the middle */
1314         cur->rx      = 0;  /* Rx Sequence numbers */
1315         cur->tx      = 0;  /* Tx sequence numbers */
1316         cur->valid   = 1;  /* Key is now valid */
1317
1318         /* Give key to mic seed */
1319         emmh32_setseed(&cur->seed, key, key_len, tfm);
1320 }
1321
1322 /* micinit - Initialize mic seed */
1323
1324 static void micinit(struct airo_info *ai)
1325 {
1326         MICRid mic_rid;
1327
1328         clear_bit(JOB_MIC, &ai->jobs);
1329         PC4500_readrid(ai, RID_MIC, &mic_rid, sizeof(mic_rid), 0);
1330         up(&ai->sem);
1331
1332         ai->micstats.enabled = (le16_to_cpu(mic_rid.state) & 0x00FF) ? 1 : 0;
1333         if (!ai->micstats.enabled) {
1334                 /* So next time we have a valid key and mic is enabled, we will
1335                  * update the sequence number if the key is the same as before.
1336                  */
1337                 ai->mod[0].uCtx.valid = 0;
1338                 ai->mod[0].mCtx.valid = 0;
1339                 return;
1340         }
1341
1342         if (mic_rid.multicastValid) {
1343                 age_mic_context(&ai->mod[0].mCtx, &ai->mod[1].mCtx,
1344                                 mic_rid.multicast, sizeof(mic_rid.multicast),
1345                                 ai->tfm);
1346         }
1347
1348         if (mic_rid.unicastValid) {
1349                 age_mic_context(&ai->mod[0].uCtx, &ai->mod[1].uCtx,
1350                                 mic_rid.unicast, sizeof(mic_rid.unicast),
1351                                 ai->tfm);
1352         }
1353 }
1354
1355 /* micsetup - Get ready for business */
1356
1357 static int micsetup(struct airo_info *ai) {
1358         int i;
1359
1360         if (ai->tfm == NULL)
1361                 ai->tfm = crypto_alloc_cipher("aes", 0, CRYPTO_ALG_ASYNC);
1362
1363         if (IS_ERR(ai->tfm)) {
1364                 airo_print_err(ai->dev->name, "failed to load transform for AES");
1365                 ai->tfm = NULL;
1366                 return ERROR;
1367         }
1368
1369         for (i=0; i < NUM_MODULES; i++) {
1370                 memset(&ai->mod[i].mCtx,0,sizeof(miccntx));
1371                 memset(&ai->mod[i].uCtx,0,sizeof(miccntx));
1372         }
1373         return SUCCESS;
1374 }
1375
1376 static char micsnap[] = {0xAA,0xAA,0x03,0x00,0x40,0x96,0x00,0x02};
1377
1378 /*===========================================================================
1379  * Description: Mic a packet
1380  *    
1381  *      Inputs: etherHead * pointer to an 802.3 frame
1382  *    
1383  *     Returns: BOOLEAN if successful, otherwise false.
1384  *             PacketTxLen will be updated with the mic'd packets size.
1385  *
1386  *    Caveats: It is assumed that the frame buffer will already
1387  *             be big enough to hold the largets mic message possible.
1388  *            (No memory allocation is done here).
1389  *  
1390  *    Author: sbraneky (10/15/01)
1391  *    Merciless hacks by rwilcher (1/14/02)
1392  */
1393
1394 static int encapsulate(struct airo_info *ai ,etherHead *frame, MICBuffer *mic, int payLen)
1395 {
1396         miccntx   *context;
1397
1398         // Determine correct context
1399         // If not adhoc, always use unicast key
1400
1401         if (test_bit(FLAG_ADHOC, &ai->flags) && (frame->da[0] & 0x1))
1402                 context = &ai->mod[0].mCtx;
1403         else
1404                 context = &ai->mod[0].uCtx;
1405   
1406         if (!context->valid)
1407                 return ERROR;
1408
1409         mic->typelen = htons(payLen + 16); //Length of Mic'd packet
1410
1411         memcpy(&mic->u.snap, micsnap, sizeof(micsnap)); // Add Snap
1412
1413         // Add Tx sequence
1414         mic->seq = htonl(context->tx);
1415         context->tx += 2;
1416
1417         emmh32_init(&context->seed); // Mic the packet
1418         emmh32_update(&context->seed,frame->da,ETH_ALEN * 2); // DA,SA
1419         emmh32_update(&context->seed,(u8*)&mic->typelen,10); // Type/Length and Snap
1420         emmh32_update(&context->seed,(u8*)&mic->seq,sizeof(mic->seq)); //SEQ
1421         emmh32_update(&context->seed,frame->da + ETH_ALEN * 2,payLen); //payload
1422         emmh32_final(&context->seed, (u8*)&mic->mic);
1423
1424         /*    New Type/length ?????????? */
1425         mic->typelen = 0; //Let NIC know it could be an oversized packet
1426         return SUCCESS;
1427 }
1428
1429 typedef enum {
1430     NONE,
1431     NOMIC,
1432     NOMICPLUMMED,
1433     SEQUENCE,
1434     INCORRECTMIC,
1435 } mic_error;
1436
1437 /*===========================================================================
1438  *  Description: Decapsulates a MIC'd packet and returns the 802.3 packet
1439  *               (removes the MIC stuff) if packet is a valid packet.
1440  *      
1441  *       Inputs: etherHead  pointer to the 802.3 packet             
1442  *     
1443  *      Returns: BOOLEAN - TRUE if packet should be dropped otherwise FALSE
1444  *     
1445  *      Author: sbraneky (10/15/01)
1446  *    Merciless hacks by rwilcher (1/14/02)
1447  *---------------------------------------------------------------------------
1448  */
1449
1450 static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *eth, u16 payLen)
1451 {
1452         int      i;
1453         u32      micSEQ;
1454         miccntx  *context;
1455         u8       digest[4];
1456         mic_error micError = NONE;
1457
1458         // Check if the packet is a Mic'd packet
1459
1460         if (!ai->micstats.enabled) {
1461                 //No Mic set or Mic OFF but we received a MIC'd packet.
1462                 if (memcmp ((u8*)eth + 14, micsnap, sizeof(micsnap)) == 0) {
1463                         ai->micstats.rxMICPlummed++;
1464                         return ERROR;
1465                 }
1466                 return SUCCESS;
1467         }
1468
1469         if (ntohs(mic->typelen) == 0x888E)
1470                 return SUCCESS;
1471
1472         if (memcmp (mic->u.snap, micsnap, sizeof(micsnap)) != 0) {
1473             // Mic enabled but packet isn't Mic'd
1474                 ai->micstats.rxMICPlummed++;
1475                 return ERROR;
1476         }
1477
1478         micSEQ = ntohl(mic->seq);            //store SEQ as CPU order
1479
1480         //At this point we a have a mic'd packet and mic is enabled
1481         //Now do the mic error checking.
1482
1483         //Receive seq must be odd
1484         if ( (micSEQ & 1) == 0 ) {
1485                 ai->micstats.rxWrongSequence++;
1486                 return ERROR;
1487         }
1488
1489         for (i = 0; i < NUM_MODULES; i++) {
1490                 int mcast = eth->da[0] & 1;
1491                 //Determine proper context 
1492                 context = mcast ? &ai->mod[i].mCtx : &ai->mod[i].uCtx;
1493         
1494                 //Make sure context is valid
1495                 if (!context->valid) {
1496                         if (i == 0)
1497                                 micError = NOMICPLUMMED;
1498                         continue;                
1499                 }
1500                 //DeMic it 
1501
1502                 if (!mic->typelen)
1503                         mic->typelen = htons(payLen + sizeof(MICBuffer) - 2);
1504         
1505                 emmh32_init(&context->seed);
1506                 emmh32_update(&context->seed, eth->da, ETH_ALEN*2); 
1507                 emmh32_update(&context->seed, (u8 *)&mic->typelen, sizeof(mic->typelen)+sizeof(mic->u.snap)); 
1508                 emmh32_update(&context->seed, (u8 *)&mic->seq,sizeof(mic->seq));        
1509                 emmh32_update(&context->seed, eth->da + ETH_ALEN*2,payLen);     
1510                 //Calculate MIC
1511                 emmh32_final(&context->seed, digest);
1512         
1513                 if (memcmp(digest, &mic->mic, 4)) { //Make sure the mics match
1514                   //Invalid Mic
1515                         if (i == 0)
1516                                 micError = INCORRECTMIC;
1517                         continue;
1518                 }
1519
1520                 //Check Sequence number if mics pass
1521                 if (RxSeqValid(ai, context, mcast, micSEQ) == SUCCESS) {
1522                         ai->micstats.rxSuccess++;
1523                         return SUCCESS;
1524                 }
1525                 if (i == 0)
1526                         micError = SEQUENCE;
1527         }
1528
1529         // Update statistics
1530         switch (micError) {
1531                 case NOMICPLUMMED: ai->micstats.rxMICPlummed++;   break;
1532                 case SEQUENCE:    ai->micstats.rxWrongSequence++; break;
1533                 case INCORRECTMIC: ai->micstats.rxIncorrectMIC++; break;
1534                 case NONE:  break;
1535                 case NOMIC: break;
1536         }
1537         return ERROR;
1538 }
1539
1540 /*===========================================================================
1541  * Description:  Checks the Rx Seq number to make sure it is valid
1542  *               and hasn't already been received
1543  *   
1544  *     Inputs: miccntx - mic context to check seq against
1545  *             micSeq  - the Mic seq number
1546  *   
1547  *    Returns: TRUE if valid otherwise FALSE. 
1548  *
1549  *    Author: sbraneky (10/15/01)
1550  *    Merciless hacks by rwilcher (1/14/02)
1551  *---------------------------------------------------------------------------
1552  */
1553
1554 static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq)
1555 {
1556         u32 seq,index;
1557
1558         //Allow for the ap being rebooted - if it is then use the next 
1559         //sequence number of the current sequence number - might go backwards
1560
1561         if (mcast) {
1562                 if (test_bit(FLAG_UPDATE_MULTI, &ai->flags)) {
1563                         clear_bit (FLAG_UPDATE_MULTI, &ai->flags);
1564                         context->window = (micSeq > 33) ? micSeq : 33;
1565                         context->rx     = 0;        // Reset rx
1566                 }
1567         } else if (test_bit(FLAG_UPDATE_UNI, &ai->flags)) {
1568                 clear_bit (FLAG_UPDATE_UNI, &ai->flags);
1569                 context->window = (micSeq > 33) ? micSeq : 33; // Move window
1570                 context->rx     = 0;        // Reset rx
1571         }
1572
1573         //Make sequence number relative to START of window
1574         seq = micSeq - (context->window - 33);
1575
1576         //Too old of a SEQ number to check.
1577         if ((s32)seq < 0)
1578                 return ERROR;
1579     
1580         if ( seq > 64 ) {
1581                 //Window is infinite forward
1582                 MoveWindow(context,micSeq);
1583                 return SUCCESS;
1584         }
1585
1586         // We are in the window. Now check the context rx bit to see if it was already sent
1587         seq >>= 1;         //divide by 2 because we only have odd numbers
1588         index = 1 << seq;  //Get an index number
1589
1590         if (!(context->rx & index)) {
1591                 //micSEQ falls inside the window.
1592                 //Add seqence number to the list of received numbers.
1593                 context->rx |= index;
1594
1595                 MoveWindow(context,micSeq);
1596
1597                 return SUCCESS;
1598         }
1599         return ERROR;
1600 }
1601
1602 static void MoveWindow(miccntx *context, u32 micSeq)
1603 {
1604         u32 shift;
1605
1606         //Move window if seq greater than the middle of the window
1607         if (micSeq > context->window) {
1608                 shift = (micSeq - context->window) >> 1;
1609     
1610                     //Shift out old
1611                 if (shift < 32)
1612                         context->rx >>= shift;
1613                 else
1614                         context->rx = 0;
1615
1616                 context->window = micSeq;      //Move window
1617         }
1618 }
1619
1620 /*==============================================*/
1621 /*========== EMMH ROUTINES  ====================*/
1622 /*==============================================*/
1623
1624 /* mic accumulate */
1625 #define MIC_ACCUM(val)  \
1626         context->accum += (u64)(val) * context->coeff[coeff_position++];
1627
1628 static unsigned char aes_counter[16];
1629
1630 /* expand the key to fill the MMH coefficient array */
1631 static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1632                            struct crypto_cipher *tfm)
1633 {
1634   /* take the keying material, expand if necessary, truncate at 16-bytes */
1635   /* run through AES counter mode to generate context->coeff[] */
1636   
1637         int i,j;
1638         u32 counter;
1639         u8 *cipher, plain[16];
1640
1641         crypto_cipher_setkey(tfm, pkey, 16);
1642         counter = 0;
1643         for (i = 0; i < ARRAY_SIZE(context->coeff); ) {
1644                 aes_counter[15] = (u8)(counter >> 0);
1645                 aes_counter[14] = (u8)(counter >> 8);
1646                 aes_counter[13] = (u8)(counter >> 16);
1647                 aes_counter[12] = (u8)(counter >> 24);
1648                 counter++;
1649                 memcpy (plain, aes_counter, 16);
1650                 crypto_cipher_encrypt_one(tfm, plain, plain);
1651                 cipher = plain;
1652                 for (j = 0; (j < 16) && (i < ARRAY_SIZE(context->coeff)); ) {
1653                         context->coeff[i++] = ntohl(*(__be32 *)&cipher[j]);
1654                         j += 4;
1655                 }
1656         }
1657 }
1658
1659 /* prepare for calculation of a new mic */
1660 static void emmh32_init(emmh32_context *context)
1661 {
1662         /* prepare for new mic calculation */
1663         context->accum = 0;
1664         context->position = 0;
1665 }
1666
1667 /* add some bytes to the mic calculation */
1668 static void emmh32_update(emmh32_context *context, u8 *pOctets, int len)
1669 {
1670         int     coeff_position, byte_position;
1671   
1672         if (len == 0) return;
1673   
1674         coeff_position = context->position >> 2;
1675   
1676         /* deal with partial 32-bit word left over from last update */
1677         byte_position = context->position & 3;
1678         if (byte_position) {
1679                 /* have a partial word in part to deal with */
1680                 do {
1681                         if (len == 0) return;
1682                         context->part.d8[byte_position++] = *pOctets++;
1683                         context->position++;
1684                         len--;
1685                 } while (byte_position < 4);
1686                 MIC_ACCUM(ntohl(context->part.d32));
1687         }
1688
1689         /* deal with full 32-bit words */
1690         while (len >= 4) {
1691                 MIC_ACCUM(ntohl(*(__be32 *)pOctets));
1692                 context->position += 4;
1693                 pOctets += 4;
1694                 len -= 4;
1695         }
1696
1697         /* deal with partial 32-bit word that will be left over from this update */
1698         byte_position = 0;
1699         while (len > 0) {
1700                 context->part.d8[byte_position++] = *pOctets++;
1701                 context->position++;
1702                 len--;
1703         }
1704 }
1705
1706 /* mask used to zero empty bytes for final partial word */
1707 static u32 mask32[4] = { 0x00000000L, 0xFF000000L, 0xFFFF0000L, 0xFFFFFF00L };
1708
1709 /* calculate the mic */
1710 static void emmh32_final(emmh32_context *context, u8 digest[4])
1711 {
1712         int     coeff_position, byte_position;
1713         u32     val;
1714   
1715         u64 sum, utmp;
1716         s64 stmp;
1717
1718         coeff_position = context->position >> 2;
1719   
1720         /* deal with partial 32-bit word left over from last update */
1721         byte_position = context->position & 3;
1722         if (byte_position) {
1723                 /* have a partial word in part to deal with */
1724                 val = ntohl(context->part.d32);
1725                 MIC_ACCUM(val & mask32[byte_position]); /* zero empty bytes */
1726         }
1727
1728         /* reduce the accumulated u64 to a 32-bit MIC */
1729         sum = context->accum;
1730         stmp = (sum  & 0xffffffffLL) - ((sum >> 32)  * 15);
1731         utmp = (stmp & 0xffffffffLL) - ((stmp >> 32) * 15);
1732         sum = utmp & 0xffffffffLL;
1733         if (utmp > 0x10000000fLL)
1734                 sum -= 15;
1735
1736         val = (u32)sum;
1737         digest[0] = (val>>24) & 0xFF;
1738         digest[1] = (val>>16) & 0xFF;
1739         digest[2] = (val>>8) & 0xFF;
1740         digest[3] = val & 0xFF;
1741 }
1742
1743 static int readBSSListRid(struct airo_info *ai, int first,
1744                       BSSListRid *list)
1745 {
1746         Cmd cmd;
1747         Resp rsp;
1748
1749         if (first == 1) {
1750                 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
1751                 memset(&cmd, 0, sizeof(cmd));
1752                 cmd.cmd=CMD_LISTBSS;
1753                 if (down_interruptible(&ai->sem))
1754                         return -ERESTARTSYS;
1755                 ai->list_bss_task = current;
1756                 issuecommand(ai, &cmd, &rsp);
1757                 up(&ai->sem);
1758                 /* Let the command take effect */
1759                 schedule_timeout_uninterruptible(3 * HZ);
1760                 ai->list_bss_task = NULL;
1761         }
1762         return PC4500_readrid(ai, first ? ai->bssListFirst : ai->bssListNext,
1763                             list, ai->bssListRidLen, 1);
1764 }
1765
1766 static int readWepKeyRid(struct airo_info *ai, WepKeyRid *wkr, int temp, int lock)
1767 {
1768         return PC4500_readrid(ai, temp ? RID_WEP_TEMP : RID_WEP_PERM,
1769                                 wkr, sizeof(*wkr), lock);
1770 }
1771
1772 static int writeWepKeyRid(struct airo_info *ai, WepKeyRid *wkr, int perm, int lock)
1773 {
1774         int rc;
1775         rc = PC4500_writerid(ai, RID_WEP_TEMP, wkr, sizeof(*wkr), lock);
1776         if (rc!=SUCCESS)
1777                 airo_print_err(ai->dev->name, "WEP_TEMP set %x", rc);
1778         if (perm) {
1779                 rc = PC4500_writerid(ai, RID_WEP_PERM, wkr, sizeof(*wkr), lock);
1780                 if (rc!=SUCCESS)
1781                         airo_print_err(ai->dev->name, "WEP_PERM set %x", rc);
1782         }
1783         return rc;
1784 }
1785
1786 static int readSsidRid(struct airo_info*ai, SsidRid *ssidr)
1787 {
1788         return PC4500_readrid(ai, RID_SSID, ssidr, sizeof(*ssidr), 1);
1789 }
1790
1791 static int writeSsidRid(struct airo_info*ai, SsidRid *pssidr, int lock)
1792 {
1793         return PC4500_writerid(ai, RID_SSID, pssidr, sizeof(*pssidr), lock);
1794 }
1795
1796 static int readConfigRid(struct airo_info *ai, int lock)
1797 {
1798         int rc;
1799         ConfigRid cfg;
1800
1801         if (ai->config.len)
1802                 return SUCCESS;
1803
1804         rc = PC4500_readrid(ai, RID_ACTUALCONFIG, &cfg, sizeof(cfg), lock);
1805         if (rc != SUCCESS)
1806                 return rc;
1807
1808         ai->config = cfg;
1809         return SUCCESS;
1810 }
1811
1812 static inline void checkThrottle(struct airo_info *ai)
1813 {
1814         int i;
1815 /* Old hardware had a limit on encryption speed */
1816         if (ai->config.authType != AUTH_OPEN && maxencrypt) {
1817                 for(i=0; i<8; i++) {
1818                         if (ai->config.rates[i] > maxencrypt) {
1819                                 ai->config.rates[i] = 0;
1820                         }
1821                 }
1822         }
1823 }
1824
1825 static int writeConfigRid(struct airo_info *ai, int lock)
1826 {
1827         ConfigRid cfgr;
1828
1829         if (!test_bit (FLAG_COMMIT, &ai->flags))
1830                 return SUCCESS;
1831
1832         clear_bit (FLAG_COMMIT, &ai->flags);
1833         clear_bit (FLAG_RESET, &ai->flags);
1834         checkThrottle(ai);
1835         cfgr = ai->config;
1836
1837         if ((cfgr.opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
1838                 set_bit(FLAG_ADHOC, &ai->flags);
1839         else
1840                 clear_bit(FLAG_ADHOC, &ai->flags);
1841
1842         return PC4500_writerid( ai, RID_CONFIG, &cfgr, sizeof(cfgr), lock);
1843 }
1844
1845 static int readStatusRid(struct airo_info *ai, StatusRid *statr, int lock)
1846 {
1847         return PC4500_readrid(ai, RID_STATUS, statr, sizeof(*statr), lock);
1848 }
1849
1850 static int readAPListRid(struct airo_info *ai, APListRid *aplr)
1851 {
1852         return PC4500_readrid(ai, RID_APLIST, aplr, sizeof(*aplr), 1);
1853 }
1854
1855 static int writeAPListRid(struct airo_info *ai, APListRid *aplr, int lock)
1856 {
1857         return PC4500_writerid(ai, RID_APLIST, aplr, sizeof(*aplr), lock);
1858 }
1859
1860 static int readCapabilityRid(struct airo_info *ai, CapabilityRid *capr, int lock)
1861 {
1862         return PC4500_readrid(ai, RID_CAPABILITIES, capr, sizeof(*capr), lock);
1863 }
1864
1865 static int readStatsRid(struct airo_info*ai, StatsRid *sr, int rid, int lock)
1866 {
1867         return PC4500_readrid(ai, rid, sr, sizeof(*sr), lock);
1868 }
1869
1870 static void try_auto_wep(struct airo_info *ai)
1871 {
1872         if (auto_wep && !(ai->flags & FLAG_RADIO_DOWN)) {
1873                 ai->expires = RUN_AT(3*HZ);
1874                 wake_up_interruptible(&ai->thr_wait);
1875         }
1876 }
1877
1878 static int airo_open(struct net_device *dev) {
1879         struct airo_info *ai = dev->ml_priv;
1880         int rc = 0;
1881
1882         if (test_bit(FLAG_FLASHING, &ai->flags))
1883                 return -EIO;
1884
1885         /* Make sure the card is configured.
1886          * Wireless Extensions may postpone config changes until the card
1887          * is open (to pipeline changes and speed-up card setup). If
1888          * those changes are not yet commited, do it now - Jean II */
1889         if (test_bit(FLAG_COMMIT, &ai->flags)) {
1890                 disable_MAC(ai, 1);
1891                 writeConfigRid(ai, 1);
1892         }
1893
1894         if (ai->wifidev != dev) {
1895                 clear_bit(JOB_DIE, &ai->jobs);
1896                 ai->airo_thread_task = kthread_run(airo_thread, dev, dev->name);
1897                 if (IS_ERR(ai->airo_thread_task))
1898                         return (int)PTR_ERR(ai->airo_thread_task);
1899
1900                 rc = request_irq(dev->irq, airo_interrupt, IRQF_SHARED,
1901                         dev->name, dev);
1902                 if (rc) {
1903                         airo_print_err(dev->name,
1904                                 "register interrupt %d failed, rc %d",
1905                                 dev->irq, rc);
1906                         set_bit(JOB_DIE, &ai->jobs);
1907                         kthread_stop(ai->airo_thread_task);
1908                         return rc;
1909                 }
1910
1911                 /* Power on the MAC controller (which may have been disabled) */
1912                 clear_bit(FLAG_RADIO_DOWN, &ai->flags);
1913                 enable_interrupts(ai);
1914
1915                 try_auto_wep(ai);
1916         }
1917         enable_MAC(ai, 1);
1918
1919         netif_start_queue(dev);
1920         return 0;
1921 }
1922
1923 static int mpi_start_xmit(struct sk_buff *skb, struct net_device *dev) {
1924         int npacks, pending;
1925         unsigned long flags;
1926         struct airo_info *ai = dev->ml_priv;
1927
1928         if (!skb) {
1929                 airo_print_err(dev->name, "%s: skb == NULL!",__func__);
1930                 return 0;
1931         }
1932         npacks = skb_queue_len (&ai->txq);
1933
1934         if (npacks >= MAXTXQ - 1) {
1935                 netif_stop_queue (dev);
1936                 if (npacks > MAXTXQ) {
1937                         dev->stats.tx_fifo_errors++;
1938                         return 1;
1939                 }
1940                 skb_queue_tail (&ai->txq, skb);
1941                 return 0;
1942         }
1943
1944         spin_lock_irqsave(&ai->aux_lock, flags);
1945         skb_queue_tail (&ai->txq, skb);
1946         pending = test_bit(FLAG_PENDING_XMIT, &ai->flags);
1947         spin_unlock_irqrestore(&ai->aux_lock,flags);
1948         netif_wake_queue (dev);
1949
1950         if (pending == 0) {
1951                 set_bit(FLAG_PENDING_XMIT, &ai->flags);
1952                 mpi_send_packet (dev);
1953         }
1954         return 0;
1955 }
1956
1957 /*
1958  * @mpi_send_packet
1959  *
1960  * Attempt to transmit a packet. Can be called from interrupt
1961  * or transmit . return number of packets we tried to send
1962  */
1963
1964 static int mpi_send_packet (struct net_device *dev)
1965 {
1966         struct sk_buff *skb;
1967         unsigned char *buffer;
1968         s16 len;
1969         __le16 *payloadLen;
1970         struct airo_info *ai = dev->ml_priv;
1971         u8 *sendbuf;
1972
1973         /* get a packet to send */
1974
1975         if ((skb = skb_dequeue(&ai->txq)) == NULL) {
1976                 airo_print_err(dev->name,
1977                         "%s: Dequeue'd zero in send_packet()",
1978                         __func__);
1979                 return 0;
1980         }
1981
1982         /* check min length*/
1983         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
1984         buffer = skb->data;
1985
1986         ai->txfids[0].tx_desc.offset = 0;
1987         ai->txfids[0].tx_desc.valid = 1;
1988         ai->txfids[0].tx_desc.eoc = 1;
1989         ai->txfids[0].tx_desc.len =len+sizeof(WifiHdr);
1990
1991 /*
1992  * Magic, the cards firmware needs a length count (2 bytes) in the host buffer
1993  * right after  TXFID_HDR.The TXFID_HDR contains the status short so payloadlen
1994  * is immediatly after it. ------------------------------------------------
1995  *                         |TXFIDHDR+STATUS|PAYLOADLEN|802.3HDR|PACKETDATA|
1996  *                         ------------------------------------------------
1997  */
1998
1999         memcpy((char *)ai->txfids[0].virtual_host_addr,
2000                 (char *)&wifictlhdr8023, sizeof(wifictlhdr8023));
2001
2002         payloadLen = (__le16 *)(ai->txfids[0].virtual_host_addr +
2003                 sizeof(wifictlhdr8023));
2004         sendbuf = ai->txfids[0].virtual_host_addr +
2005                 sizeof(wifictlhdr8023) + 2 ;
2006
2007         /*
2008          * Firmware automaticly puts 802 header on so
2009          * we don't need to account for it in the length
2010          */
2011         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
2012                 (ntohs(((__be16 *)buffer)[6]) != 0x888E)) {
2013                 MICBuffer pMic;
2014
2015                 if (encapsulate(ai, (etherHead *)buffer, &pMic, len - sizeof(etherHead)) != SUCCESS)
2016                         return ERROR;
2017
2018                 *payloadLen = cpu_to_le16(len-sizeof(etherHead)+sizeof(pMic));
2019                 ai->txfids[0].tx_desc.len += sizeof(pMic);
2020                 /* copy data into airo dma buffer */
2021                 memcpy (sendbuf, buffer, sizeof(etherHead));
2022                 buffer += sizeof(etherHead);
2023                 sendbuf += sizeof(etherHead);
2024                 memcpy (sendbuf, &pMic, sizeof(pMic));
2025                 sendbuf += sizeof(pMic);
2026                 memcpy (sendbuf, buffer, len - sizeof(etherHead));
2027         } else {
2028                 *payloadLen = cpu_to_le16(len - sizeof(etherHead));
2029
2030                 dev->trans_start = jiffies;
2031
2032                 /* copy data into airo dma buffer */
2033                 memcpy(sendbuf, buffer, len);
2034         }
2035
2036         memcpy_toio(ai->txfids[0].card_ram_off,
2037                 &ai->txfids[0].tx_desc, sizeof(TxFid));
2038
2039         OUT4500(ai, EVACK, 8);
2040
2041         dev_kfree_skb_any(skb);
2042         return 1;
2043 }
2044
2045 static void get_tx_error(struct airo_info *ai, s32 fid)
2046 {
2047         __le16 status;
2048
2049         if (fid < 0)
2050                 status = ((WifiCtlHdr *)ai->txfids[0].virtual_host_addr)->ctlhdr.status;
2051         else {
2052                 if (bap_setup(ai, ai->fids[fid] & 0xffff, 4, BAP0) != SUCCESS)
2053                         return;
2054                 bap_read(ai, &status, 2, BAP0);
2055         }
2056         if (le16_to_cpu(status) & 2) /* Too many retries */
2057                 ai->dev->stats.tx_aborted_errors++;
2058         if (le16_to_cpu(status) & 4) /* Transmit lifetime exceeded */
2059                 ai->dev->stats.tx_heartbeat_errors++;
2060         if (le16_to_cpu(status) & 8) /* Aid fail */
2061                 { }
2062         if (le16_to_cpu(status) & 0x10) /* MAC disabled */
2063                 ai->dev->stats.tx_carrier_errors++;
2064         if (le16_to_cpu(status) & 0x20) /* Association lost */
2065                 { }
2066         /* We produce a TXDROP event only for retry or lifetime
2067          * exceeded, because that's the only status that really mean
2068          * that this particular node went away.
2069          * Other errors means that *we* screwed up. - Jean II */
2070         if ((le16_to_cpu(status) & 2) ||
2071              (le16_to_cpu(status) & 4)) {
2072                 union iwreq_data        wrqu;
2073                 char junk[0x18];
2074
2075                 /* Faster to skip over useless data than to do
2076                  * another bap_setup(). We are at offset 0x6 and
2077                  * need to go to 0x18 and read 6 bytes - Jean II */
2078                 bap_read(ai, (__le16 *) junk, 0x18, BAP0);
2079
2080                 /* Copy 802.11 dest address.
2081                  * We use the 802.11 header because the frame may
2082                  * not be 802.3 or may be mangled...
2083                  * In Ad-Hoc mode, it will be the node address.
2084                  * In managed mode, it will be most likely the AP addr
2085                  * User space will figure out how to convert it to
2086                  * whatever it needs (IP address or else).
2087                  * - Jean II */
2088                 memcpy(wrqu.addr.sa_data, junk + 0x12, ETH_ALEN);
2089                 wrqu.addr.sa_family = ARPHRD_ETHER;
2090
2091                 /* Send event to user space */
2092                 wireless_send_event(ai->dev, IWEVTXDROP, &wrqu, NULL);
2093         }
2094 }
2095
2096 static void airo_end_xmit(struct net_device *dev) {
2097         u16 status;
2098         int i;
2099         struct airo_info *priv = dev->ml_priv;
2100         struct sk_buff *skb = priv->xmit.skb;
2101         int fid = priv->xmit.fid;
2102         u32 *fids = priv->fids;
2103
2104         clear_bit(JOB_XMIT, &priv->jobs);
2105         clear_bit(FLAG_PENDING_XMIT, &priv->flags);
2106         status = transmit_802_3_packet (priv, fids[fid], skb->data);
2107         up(&priv->sem);
2108
2109         i = 0;
2110         if ( status == SUCCESS ) {
2111                 dev->trans_start = jiffies;
2112                 for (; i < MAX_FIDS / 2 && (priv->fids[i] & 0xffff0000); i++);
2113         } else {
2114                 priv->fids[fid] &= 0xffff;
2115                 dev->stats.tx_window_errors++;
2116         }
2117         if (i < MAX_FIDS / 2)
2118                 netif_wake_queue(dev);
2119         dev_kfree_skb(skb);
2120 }
2121
2122 static int airo_start_xmit(struct sk_buff *skb, struct net_device *dev) {
2123         s16 len;
2124         int i, j;
2125         struct airo_info *priv = dev->ml_priv;
2126         u32 *fids = priv->fids;
2127
2128         if ( skb == NULL ) {
2129                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2130                 return 0;
2131         }
2132
2133         /* Find a vacant FID */
2134         for( i = 0; i < MAX_FIDS / 2 && (fids[i] & 0xffff0000); i++ );
2135         for( j = i + 1; j < MAX_FIDS / 2 && (fids[j] & 0xffff0000); j++ );
2136
2137         if ( j >= MAX_FIDS / 2 ) {
2138                 netif_stop_queue(dev);
2139
2140                 if (i == MAX_FIDS / 2) {
2141                         dev->stats.tx_fifo_errors++;
2142                         return 1;
2143                 }
2144         }
2145         /* check min length*/
2146         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2147         /* Mark fid as used & save length for later */
2148         fids[i] |= (len << 16);
2149         priv->xmit.skb = skb;
2150         priv->xmit.fid = i;
2151         if (down_trylock(&priv->sem) != 0) {
2152                 set_bit(FLAG_PENDING_XMIT, &priv->flags);
2153                 netif_stop_queue(dev);
2154                 set_bit(JOB_XMIT, &priv->jobs);
2155                 wake_up_interruptible(&priv->thr_wait);
2156         } else
2157                 airo_end_xmit(dev);
2158         return 0;
2159 }
2160
2161 static void airo_end_xmit11(struct net_device *dev) {
2162         u16 status;
2163         int i;
2164         struct airo_info *priv = dev->ml_priv;
2165         struct sk_buff *skb = priv->xmit11.skb;
2166         int fid = priv->xmit11.fid;
2167         u32 *fids = priv->fids;
2168
2169         clear_bit(JOB_XMIT11, &priv->jobs);
2170         clear_bit(FLAG_PENDING_XMIT11, &priv->flags);
2171         status = transmit_802_11_packet (priv, fids[fid], skb->data);
2172         up(&priv->sem);
2173
2174         i = MAX_FIDS / 2;
2175         if ( status == SUCCESS ) {
2176                 dev->trans_start = jiffies;
2177                 for (; i < MAX_FIDS && (priv->fids[i] & 0xffff0000); i++);
2178         } else {
2179                 priv->fids[fid] &= 0xffff;
2180                 dev->stats.tx_window_errors++;
2181         }
2182         if (i < MAX_FIDS)
2183                 netif_wake_queue(dev);
2184         dev_kfree_skb(skb);
2185 }
2186
2187 static int airo_start_xmit11(struct sk_buff *skb, struct net_device *dev) {
2188         s16 len;
2189         int i, j;
2190         struct airo_info *priv = dev->ml_priv;
2191         u32 *fids = priv->fids;
2192
2193         if (test_bit(FLAG_MPI, &priv->flags)) {
2194                 /* Not implemented yet for MPI350 */
2195                 netif_stop_queue(dev);
2196                 return -ENETDOWN;
2197         }
2198
2199         if ( skb == NULL ) {
2200                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2201                 return 0;
2202         }
2203
2204         /* Find a vacant FID */
2205         for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2206         for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2207
2208         if ( j >= MAX_FIDS ) {
2209                 netif_stop_queue(dev);
2210
2211                 if (i == MAX_FIDS) {
2212                         dev->stats.tx_fifo_errors++;
2213                         return 1;
2214                 }
2215         }
2216         /* check min length*/
2217         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2218         /* Mark fid as used & save length for later */
2219         fids[i] |= (len << 16);
2220         priv->xmit11.skb = skb;
2221         priv->xmit11.fid = i;
2222         if (down_trylock(&priv->sem) != 0) {
2223                 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2224                 netif_stop_queue(dev);
2225                 set_bit(JOB_XMIT11, &priv->jobs);
2226                 wake_up_interruptible(&priv->thr_wait);
2227         } else
2228                 airo_end_xmit11(dev);
2229         return 0;
2230 }
2231
2232 static void airo_read_stats(struct net_device *dev)
2233 {
2234         struct airo_info *ai = dev->ml_priv;
2235         StatsRid stats_rid;
2236         __le32 *vals = stats_rid.vals;
2237
2238         clear_bit(JOB_STATS, &ai->jobs);
2239         if (ai->power.event) {
2240                 up(&ai->sem);
2241                 return;
2242         }
2243         readStatsRid(ai, &stats_rid, RID_STATS, 0);
2244         up(&ai->sem);
2245
2246         dev->stats.rx_packets = le32_to_cpu(vals[43]) + le32_to_cpu(vals[44]) +
2247                                le32_to_cpu(vals[45]);
2248         dev->stats.tx_packets = le32_to_cpu(vals[39]) + le32_to_cpu(vals[40]) +
2249                                le32_to_cpu(vals[41]);
2250         dev->stats.rx_bytes = le32_to_cpu(vals[92]);
2251         dev->stats.tx_bytes = le32_to_cpu(vals[91]);
2252         dev->stats.rx_errors = le32_to_cpu(vals[0]) + le32_to_cpu(vals[2]) +
2253                               le32_to_cpu(vals[3]) + le32_to_cpu(vals[4]);
2254         dev->stats.tx_errors = le32_to_cpu(vals[42]) +
2255                               dev->stats.tx_fifo_errors;
2256         dev->stats.multicast = le32_to_cpu(vals[43]);
2257         dev->stats.collisions = le32_to_cpu(vals[89]);
2258
2259         /* detailed rx_errors: */
2260         dev->stats.rx_length_errors = le32_to_cpu(vals[3]);
2261         dev->stats.rx_crc_errors = le32_to_cpu(vals[4]);
2262         dev->stats.rx_frame_errors = le32_to_cpu(vals[2]);
2263         dev->stats.rx_fifo_errors = le32_to_cpu(vals[0]);
2264 }
2265
2266 static struct net_device_stats *airo_get_stats(struct net_device *dev)
2267 {
2268         struct airo_info *local =  dev->ml_priv;
2269
2270         if (!test_bit(JOB_STATS, &local->jobs)) {
2271                 /* Get stats out of the card if available */
2272                 if (down_trylock(&local->sem) != 0) {
2273                         set_bit(JOB_STATS, &local->jobs);
2274                         wake_up_interruptible(&local->thr_wait);
2275                 } else
2276                         airo_read_stats(dev);
2277         }
2278
2279         return &dev->stats;
2280 }
2281
2282 static void airo_set_promisc(struct airo_info *ai) {
2283         Cmd cmd;
2284         Resp rsp;
2285
2286         memset(&cmd, 0, sizeof(cmd));
2287         cmd.cmd=CMD_SETMODE;
2288         clear_bit(JOB_PROMISC, &ai->jobs);
2289         cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2290         issuecommand(ai, &cmd, &rsp);
2291         up(&ai->sem);
2292 }
2293
2294 static void airo_set_multicast_list(struct net_device *dev) {
2295         struct airo_info *ai = dev->ml_priv;
2296
2297         if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2298                 change_bit(FLAG_PROMISC, &ai->flags);
2299                 if (down_trylock(&ai->sem) != 0) {
2300                         set_bit(JOB_PROMISC, &ai->jobs);
2301                         wake_up_interruptible(&ai->thr_wait);
2302                 } else
2303                         airo_set_promisc(ai);
2304         }
2305
2306         if ((dev->flags&IFF_ALLMULTI)||dev->mc_count>0) {
2307                 /* Turn on multicast.  (Should be already setup...) */
2308         }
2309 }
2310
2311 static int airo_set_mac_address(struct net_device *dev, void *p)
2312 {
2313         struct airo_info *ai = dev->ml_priv;
2314         struct sockaddr *addr = p;
2315
2316         readConfigRid(ai, 1);
2317         memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2318         set_bit (FLAG_COMMIT, &ai->flags);
2319         disable_MAC(ai, 1);
2320         writeConfigRid (ai, 1);
2321         enable_MAC(ai, 1);
2322         memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2323         if (ai->wifidev)
2324                 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2325         return 0;
2326 }
2327
2328 static int airo_change_mtu(struct net_device *dev, int new_mtu)
2329 {
2330         if ((new_mtu < 68) || (new_mtu > 2400))
2331                 return -EINVAL;
2332         dev->mtu = new_mtu;
2333         return 0;
2334 }
2335
2336 static LIST_HEAD(airo_devices);
2337
2338 static void add_airo_dev(struct airo_info *ai)
2339 {
2340         /* Upper layers already keep track of PCI devices,
2341          * so we only need to remember our non-PCI cards. */
2342         if (!ai->pci)
2343                 list_add_tail(&ai->dev_list, &airo_devices);
2344 }
2345
2346 static void del_airo_dev(struct airo_info *ai)
2347 {
2348         if (!ai->pci)
2349                 list_del(&ai->dev_list);
2350 }
2351
2352 static int airo_close(struct net_device *dev) {
2353         struct airo_info *ai = dev->ml_priv;
2354
2355         netif_stop_queue(dev);
2356
2357         if (ai->wifidev != dev) {
2358 #ifdef POWER_ON_DOWN
2359                 /* Shut power to the card. The idea is that the user can save
2360                  * power when he doesn't need the card with "ifconfig down".
2361                  * That's the method that is most friendly towards the network
2362                  * stack (i.e. the network stack won't try to broadcast
2363                  * anything on the interface and routes are gone. Jean II */
2364                 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2365                 disable_MAC(ai, 1);
2366 #endif
2367                 disable_interrupts( ai );
2368
2369                 free_irq(dev->irq, dev);
2370
2371                 set_bit(JOB_DIE, &ai->jobs);
2372                 kthread_stop(ai->airo_thread_task);
2373         }
2374         return 0;
2375 }
2376
2377 void stop_airo_card( struct net_device *dev, int freeres )
2378 {
2379         struct airo_info *ai = dev->ml_priv;
2380
2381         set_bit(FLAG_RADIO_DOWN, &ai->flags);
2382         disable_MAC(ai, 1);
2383         disable_interrupts(ai);
2384         takedown_proc_entry( dev, ai );
2385         if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2386                 unregister_netdev( dev );
2387                 if (ai->wifidev) {
2388                         unregister_netdev(ai->wifidev);
2389                         free_netdev(ai->wifidev);
2390                         ai->wifidev = NULL;
2391                 }
2392                 clear_bit(FLAG_REGISTERED, &ai->flags);
2393         }
2394         /*
2395          * Clean out tx queue
2396          */
2397         if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
2398                 struct sk_buff *skb = NULL;
2399                 for (;(skb = skb_dequeue(&ai->txq));)
2400                         dev_kfree_skb(skb);
2401         }
2402
2403         airo_networks_free (ai);
2404
2405         kfree(ai->flash);
2406         kfree(ai->rssi);
2407         kfree(ai->APList);
2408         kfree(ai->SSID);
2409         if (freeres) {
2410                 /* PCMCIA frees this stuff, so only for PCI and ISA */
2411                 release_region( dev->base_addr, 64 );
2412                 if (test_bit(FLAG_MPI, &ai->flags)) {
2413                         if (ai->pci)
2414                                 mpi_unmap_card(ai->pci);
2415                         if (ai->pcimem)
2416                                 iounmap(ai->pcimem);
2417                         if (ai->pciaux)
2418                                 iounmap(ai->pciaux);
2419                         pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2420                                 ai->shared, ai->shared_dma);
2421                 }
2422         }
2423         crypto_free_cipher(ai->tfm);
2424         del_airo_dev(ai);
2425         free_netdev( dev );
2426 }
2427
2428 EXPORT_SYMBOL(stop_airo_card);
2429
2430 static int wll_header_parse(const struct sk_buff *skb, unsigned char *haddr)
2431 {
2432         memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
2433         return ETH_ALEN;
2434 }
2435
2436 static void mpi_unmap_card(struct pci_dev *pci)
2437 {
2438         unsigned long mem_start = pci_resource_start(pci, 1);
2439         unsigned long mem_len = pci_resource_len(pci, 1);
2440         unsigned long aux_start = pci_resource_start(pci, 2);
2441         unsigned long aux_len = AUXMEMSIZE;
2442
2443         release_mem_region(aux_start, aux_len);
2444         release_mem_region(mem_start, mem_len);
2445 }
2446
2447 /*************************************************************
2448  *  This routine assumes that descriptors have been setup .
2449  *  Run at insmod time or after reset  when the decriptors
2450  *  have been initialized . Returns 0 if all is well nz
2451  *  otherwise . Does not allocate memory but sets up card
2452  *  using previously allocated descriptors.
2453  */
2454 static int mpi_init_descriptors (struct airo_info *ai)
2455 {
2456         Cmd cmd;
2457         Resp rsp;
2458         int i;
2459         int rc = SUCCESS;
2460
2461         /* Alloc  card RX descriptors */
2462         netif_stop_queue(ai->dev);
2463
2464         memset(&rsp,0,sizeof(rsp));
2465         memset(&cmd,0,sizeof(cmd));
2466
2467         cmd.cmd = CMD_ALLOCATEAUX;
2468         cmd.parm0 = FID_RX;
2469         cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2470         cmd.parm2 = MPI_MAX_FIDS;
2471         rc=issuecommand(ai, &cmd, &rsp);
2472         if (rc != SUCCESS) {
2473                 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
2474                 return rc;
2475         }
2476
2477         for (i=0; i<MPI_MAX_FIDS; i++) {
2478                 memcpy_toio(ai->rxfids[i].card_ram_off,
2479                         &ai->rxfids[i].rx_desc, sizeof(RxFid));
2480         }
2481
2482         /* Alloc card TX descriptors */
2483
2484         memset(&rsp,0,sizeof(rsp));
2485         memset(&cmd,0,sizeof(cmd));
2486
2487         cmd.cmd = CMD_ALLOCATEAUX;
2488         cmd.parm0 = FID_TX;
2489         cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2490         cmd.parm2 = MPI_MAX_FIDS;
2491
2492         for (i=0; i<MPI_MAX_FIDS; i++) {
2493                 ai->txfids[i].tx_desc.valid = 1;
2494                 memcpy_toio(ai->txfids[i].card_ram_off,
2495                         &ai->txfids[i].tx_desc, sizeof(TxFid));
2496         }
2497         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2498
2499         rc=issuecommand(ai, &cmd, &rsp);
2500         if (rc != SUCCESS) {
2501                 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
2502                 return rc;
2503         }
2504
2505         /* Alloc card Rid descriptor */
2506         memset(&rsp,0,sizeof(rsp));
2507         memset(&cmd,0,sizeof(cmd));
2508
2509         cmd.cmd = CMD_ALLOCATEAUX;
2510         cmd.parm0 = RID_RW;
2511         cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2512         cmd.parm2 = 1; /* Magic number... */
2513         rc=issuecommand(ai, &cmd, &rsp);
2514         if (rc != SUCCESS) {
2515                 airo_print_err(ai->dev->name, "Couldn't allocate RID");
2516                 return rc;
2517         }
2518
2519         memcpy_toio(ai->config_desc.card_ram_off,
2520                 &ai->config_desc.rid_desc, sizeof(Rid));
2521
2522         return rc;
2523 }
2524
2525 /*
2526  * We are setting up three things here:
2527  * 1) Map AUX memory for descriptors: Rid, TxFid, or RxFid.
2528  * 2) Map PCI memory for issueing commands.
2529  * 3) Allocate memory (shared) to send and receive ethernet frames.
2530  */
2531 static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci)
2532 {
2533         unsigned long mem_start, mem_len, aux_start, aux_len;
2534         int rc = -1;
2535         int i;
2536         dma_addr_t busaddroff;
2537         unsigned char *vpackoff;
2538         unsigned char __iomem *pciaddroff;
2539
2540         mem_start = pci_resource_start(pci, 1);
2541         mem_len = pci_resource_len(pci, 1);
2542         aux_start = pci_resource_start(pci, 2);
2543         aux_len = AUXMEMSIZE;
2544
2545         if (!request_mem_region(mem_start, mem_len, DRV_NAME)) {
2546                 airo_print_err("", "Couldn't get region %x[%x]",
2547                         (int)mem_start, (int)mem_len);
2548                 goto out;
2549         }
2550         if (!request_mem_region(aux_start, aux_len, DRV_NAME)) {
2551                 airo_print_err("", "Couldn't get region %x[%x]",
2552                         (int)aux_start, (int)aux_len);
2553                 goto free_region1;
2554         }
2555
2556         ai->pcimem = ioremap(mem_start, mem_len);
2557         if (!ai->pcimem) {
2558                 airo_print_err("", "Couldn't map region %x[%x]",
2559                         (int)mem_start, (int)mem_len);
2560                 goto free_region2;
2561         }
2562         ai->pciaux = ioremap(aux_start, aux_len);
2563         if (!ai->pciaux) {
2564                 airo_print_err("", "Couldn't map region %x[%x]",
2565                         (int)aux_start, (int)aux_len);
2566                 goto free_memmap;
2567         }
2568
2569         /* Reserve PKTSIZE for each fid and 2K for the Rids */
2570         ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2571         if (!ai->shared) {
2572                 airo_print_err("", "Couldn't alloc_consistent %d",
2573                         PCI_SHARED_LEN);
2574                 goto free_auxmap;
2575         }
2576
2577         /*
2578          * Setup descriptor RX, TX, CONFIG
2579          */
2580         busaddroff = ai->shared_dma;
2581         pciaddroff = ai->pciaux + AUX_OFFSET;
2582         vpackoff   = ai->shared;
2583
2584         /* RX descriptor setup */
2585         for(i = 0; i < MPI_MAX_FIDS; i++) {
2586                 ai->rxfids[i].pending = 0;
2587                 ai->rxfids[i].card_ram_off = pciaddroff;
2588                 ai->rxfids[i].virtual_host_addr = vpackoff;
2589                 ai->rxfids[i].rx_desc.host_addr = busaddroff;
2590                 ai->rxfids[i].rx_desc.valid = 1;
2591                 ai->rxfids[i].rx_desc.len = PKTSIZE;
2592                 ai->rxfids[i].rx_desc.rdy = 0;
2593
2594                 pciaddroff += sizeof(RxFid);
2595                 busaddroff += PKTSIZE;
2596                 vpackoff   += PKTSIZE;
2597         }
2598
2599         /* TX descriptor setup */
2600         for(i = 0; i < MPI_MAX_FIDS; i++) {
2601                 ai->txfids[i].card_ram_off = pciaddroff;
2602                 ai->txfids[i].virtual_host_addr = vpackoff;
2603                 ai->txfids[i].tx_desc.valid = 1;
2604                 ai->txfids[i].tx_desc.host_addr = busaddroff;
2605                 memcpy(ai->txfids[i].virtual_host_addr,
2606                         &wifictlhdr8023, sizeof(wifictlhdr8023));
2607
2608                 pciaddroff += sizeof(TxFid);
2609                 busaddroff += PKTSIZE;
2610                 vpackoff   += PKTSIZE;
2611         }
2612         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2613
2614         /* Rid descriptor setup */
2615         ai->config_desc.card_ram_off = pciaddroff;
2616         ai->config_desc.virtual_host_addr = vpackoff;
2617         ai->config_desc.rid_desc.host_addr = busaddroff;
2618         ai->ridbus = busaddroff;
2619         ai->config_desc.rid_desc.rid = 0;
2620         ai->config_desc.rid_desc.len = RIDSIZE;
2621         ai->config_desc.rid_desc.valid = 1;
2622         pciaddroff += sizeof(Rid);
2623         busaddroff += RIDSIZE;
2624         vpackoff   += RIDSIZE;
2625
2626         /* Tell card about descriptors */
2627         if (mpi_init_descriptors (ai) != SUCCESS)
2628                 goto free_shared;
2629
2630         return 0;
2631  free_shared:
2632         pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2633  free_auxmap:
2634         iounmap(ai->pciaux);
2635  free_memmap:
2636         iounmap(ai->pcimem);
2637  free_region2:
2638         release_mem_region(aux_start, aux_len);
2639  free_region1:
2640         release_mem_region(mem_start, mem_len);
2641  out:
2642         return rc;
2643 }
2644
2645 static const struct header_ops airo_header_ops = {
2646         .parse = wll_header_parse,
2647 };
2648
2649 static const struct net_device_ops airo11_netdev_ops = {
2650         .ndo_open               = airo_open,
2651         .ndo_stop               = airo_close,
2652         .ndo_start_xmit         = airo_start_xmit11,
2653         .ndo_get_stats          = airo_get_stats,
2654         .ndo_set_mac_address    = airo_set_mac_address,
2655         .ndo_do_ioctl           = airo_ioctl,
2656         .ndo_change_mtu         = airo_change_mtu,
2657 };
2658
2659 static void wifi_setup(struct net_device *dev)
2660 {
2661         dev->netdev_ops = &airo11_netdev_ops;
2662         dev->header_ops = &airo_header_ops;
2663         dev->wireless_handlers = &airo_handler_def;
2664
2665         dev->type               = ARPHRD_IEEE80211;
2666         dev->hard_header_len    = ETH_HLEN;
2667         dev->mtu                = AIRO_DEF_MTU;
2668         dev->addr_len           = ETH_ALEN;
2669         dev->tx_queue_len       = 100; 
2670
2671         memset(dev->broadcast,0xFF, ETH_ALEN);
2672
2673         dev->flags              = IFF_BROADCAST|IFF_MULTICAST;
2674 }
2675
2676 static struct net_device *init_wifidev(struct airo_info *ai,
2677                                         struct net_device *ethdev)
2678 {
2679         int err;
2680         struct net_device *dev = alloc_netdev(0, "wifi%d", wifi_setup);
2681         if (!dev)
2682                 return NULL;
2683         dev->ml_priv = ethdev->ml_priv;
2684         dev->irq = ethdev->irq;
2685         dev->base_addr = ethdev->base_addr;
2686         dev->wireless_data = ethdev->wireless_data;
2687         SET_NETDEV_DEV(dev, ethdev->dev.parent);
2688         memcpy(dev->dev_addr, ethdev->dev_addr, dev->addr_len);
2689         err = register_netdev(dev);
2690         if (err<0) {
2691                 free_netdev(dev);
2692                 return NULL;
2693         }
2694         return dev;
2695 }
2696
2697 static int reset_card( struct net_device *dev , int lock) {
2698         struct airo_info *ai = dev->ml_priv;
2699
2700         if (lock && down_interruptible(&ai->sem))
2701                 return -1;
2702         waitbusy (ai);
2703         OUT4500(ai,COMMAND,CMD_SOFTRESET);
2704         msleep(200);
2705         waitbusy (ai);
2706         msleep(200);
2707         if (lock)
2708                 up(&ai->sem);
2709         return 0;
2710 }
2711
2712 #define AIRO_MAX_NETWORK_COUNT  64
2713 static int airo_networks_allocate(struct airo_info *ai)
2714 {
2715         if (ai->networks)
2716                 return 0;
2717
2718         ai->networks =
2719             kzalloc(AIRO_MAX_NETWORK_COUNT * sizeof(BSSListElement),
2720                     GFP_KERNEL);
2721         if (!ai->networks) {
2722                 airo_print_warn("", "Out of memory allocating beacons");
2723                 return -ENOMEM;
2724         }
2725
2726         return 0;
2727 }
2728
2729 static void airo_networks_free(struct airo_info *ai)
2730 {
2731         kfree(ai->networks);
2732         ai->networks = NULL;
2733 }
2734
2735 static void airo_networks_initialize(struct airo_info *ai)
2736 {
2737         int i;
2738
2739         INIT_LIST_HEAD(&ai->network_free_list);
2740         INIT_LIST_HEAD(&ai->network_list);
2741         for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
2742                 list_add_tail(&ai->networks[i].list,
2743                               &ai->network_free_list);
2744 }
2745
2746 static const struct net_device_ops airo_netdev_ops = {
2747         .ndo_open               = airo_open,
2748         .ndo_stop               = airo_close,
2749         .ndo_start_xmit         = airo_start_xmit,
2750         .ndo_get_stats          = airo_get_stats,
2751         .ndo_set_multicast_list = airo_set_multicast_list,
2752         .ndo_set_mac_address    = airo_set_mac_address,
2753         .ndo_do_ioctl           = airo_ioctl,
2754         .ndo_change_mtu         = airo_change_mtu,
2755         .ndo_validate_addr      = eth_validate_addr,
2756 };
2757
2758 static const struct net_device_ops mpi_netdev_ops = {
2759         .ndo_open               = airo_open,
2760         .ndo_stop               = airo_close,
2761         .ndo_start_xmit         = mpi_start_xmit,
2762         .ndo_get_stats          = airo_get_stats,
2763         .ndo_set_multicast_list = airo_set_multicast_list,
2764         .ndo_set_mac_address    = airo_set_mac_address,
2765         .ndo_do_ioctl           = airo_ioctl,
2766         .ndo_change_mtu         = airo_change_mtu,
2767         .ndo_validate_addr      = eth_validate_addr,
2768 };
2769
2770
2771 static struct net_device *_init_airo_card( unsigned short irq, int port,
2772                                            int is_pcmcia, struct pci_dev *pci,
2773                                            struct device *dmdev )
2774 {
2775         struct net_device *dev;
2776         struct airo_info *ai;
2777         int i, rc;
2778         CapabilityRid cap_rid;
2779
2780         /* Create the network device object. */
2781         dev = alloc_netdev(sizeof(*ai), "", ether_setup);
2782         if (!dev) {
2783                 airo_print_err("", "Couldn't alloc_etherdev");
2784                 return NULL;
2785         }
2786
2787         ai = dev->ml_priv = netdev_priv(dev);
2788         ai->wifidev = NULL;
2789         ai->flags = 1 << FLAG_RADIO_DOWN;
2790         ai->jobs = 0;
2791         ai->dev = dev;
2792         if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
2793                 airo_print_dbg("", "Found an MPI350 card");
2794                 set_bit(FLAG_MPI, &ai->flags);
2795         }
2796         spin_lock_init(&ai->aux_lock);
2797         sema_init(&ai->sem, 1);
2798         ai->config.len = 0;
2799         ai->pci = pci;
2800         init_waitqueue_head (&ai->thr_wait);
2801         ai->tfm = NULL;
2802         add_airo_dev(ai);
2803
2804         if (airo_networks_allocate (ai))
2805                 goto err_out_free;
2806         airo_networks_initialize (ai);
2807
2808         skb_queue_head_init (&ai->txq);
2809
2810         /* The Airo-specific entries in the device structure. */
2811         if (test_bit(FLAG_MPI,&ai->flags))
2812                 dev->netdev_ops = &mpi_netdev_ops;
2813         else
2814                 dev->netdev_ops = &airo_netdev_ops;
2815         dev->wireless_handlers = &airo_handler_def;
2816         ai->wireless_data.spy_data = &ai->spy_data;
2817         dev->wireless_data = &ai->wireless_data;
2818         dev->irq = irq;
2819         dev->base_addr = port;
2820
2821         SET_NETDEV_DEV(dev, dmdev);
2822
2823         reset_card (dev, 1);
2824         msleep(400);
2825
2826         if (!is_pcmcia) {
2827                 if (!request_region(dev->base_addr, 64, DRV_NAME)) {
2828                         rc = -EBUSY;
2829                         airo_print_err(dev->name, "Couldn't request region");
2830                         goto err_out_nets;
2831                 }
2832         }
2833
2834         if (test_bit(FLAG_MPI,&ai->flags)) {
2835                 if (mpi_map_card(ai, pci)) {
2836                         airo_print_err("", "Could not map memory");
2837                         goto err_out_res;
2838                 }
2839         }
2840
2841         if (probe) {
2842                 if (setup_card(ai, dev->dev_addr, 1) != SUCCESS) {
2843                         airo_print_err(dev->name, "MAC could not be enabled" );
2844                         rc = -EIO;
2845                         goto err_out_map;
2846                 }
2847         } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2848                 ai->bap_read = fast_bap_read;
2849                 set_bit(FLAG_FLASHING, &ai->flags);
2850         }
2851
2852         strcpy(dev->name, "eth%d");
2853         rc = register_netdev(dev);
2854         if (rc) {
2855                 airo_print_err(dev->name, "Couldn't register_netdev");
2856                 goto err_out_map;
2857         }
2858         ai->wifidev = init_wifidev(ai, dev);
2859         if (!ai->wifidev)
2860                 goto err_out_reg;
2861
2862         rc = readCapabilityRid(ai, &cap_rid, 1);
2863         if (rc != SUCCESS) {
2864                 rc = -EIO;
2865                 goto err_out_wifi;
2866         }
2867         /* WEP capability discovery */
2868         ai->wep_capable = (cap_rid.softCap & cpu_to_le16(0x02)) ? 1 : 0;
2869         ai->max_wep_idx = (cap_rid.softCap & cpu_to_le16(0x80)) ? 3 : 0;
2870
2871         airo_print_info(dev->name, "Firmware version %x.%x.%02x",
2872                         ((le16_to_cpu(cap_rid.softVer) >> 8) & 0xF),
2873                         (le16_to_cpu(cap_rid.softVer) & 0xFF),
2874                         le16_to_cpu(cap_rid.softSubVer));
2875
2876         /* Test for WPA support */
2877         /* Only firmware versions 5.30.17 or better can do WPA */
2878         if (le16_to_cpu(cap_rid.softVer) > 0x530
2879          || (le16_to_cpu(cap_rid.softVer) == 0x530
2880               && le16_to_cpu(cap_rid.softSubVer) >= 17)) {
2881                 airo_print_info(ai->dev->name, "WPA supported.");
2882
2883                 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2884                 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2885                 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2886                 ai->bssListRidLen = sizeof(BSSListRid);
2887         } else {
2888                 airo_print_info(ai->dev->name, "WPA unsupported with firmware "
2889                         "versions older than 5.30.17.");
2890
2891                 ai->bssListFirst = RID_BSSLISTFIRST;
2892                 ai->bssListNext = RID_BSSLISTNEXT;
2893                 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2894         }
2895
2896         set_bit(FLAG_REGISTERED,&ai->flags);
2897         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2898
2899         /* Allocate the transmit buffers */
2900         if (probe && !test_bit(FLAG_MPI,&ai->flags))
2901                 for( i = 0; i < MAX_FIDS; i++ )
2902                         ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2903
2904         if (setup_proc_entry(dev, dev->ml_priv) < 0)
2905                 goto err_out_wifi;
2906
2907         return dev;
2908
2909 err_out_wifi:
2910         unregister_netdev(ai->wifidev);
2911         free_netdev(ai->wifidev);
2912 err_out_reg:
2913         unregister_netdev(dev);
2914 err_out_map:
2915         if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2916                 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2917                 iounmap(ai->pciaux);
2918                 iounmap(ai->pcimem);
2919                 mpi_unmap_card(ai->pci);
2920         }
2921 err_out_res:
2922         if (!is_pcmcia)
2923                 release_region( dev->base_addr, 64 );
2924 err_out_nets:
2925         airo_networks_free(ai);
2926         del_airo_dev(ai);
2927 err_out_free:
2928         free_netdev(dev);
2929         return NULL;
2930 }
2931
2932 struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2933                                   struct device *dmdev)
2934 {
2935         return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2936 }
2937
2938 EXPORT_SYMBOL(init_airo_card);
2939
2940 static int waitbusy (struct airo_info *ai) {
2941         int delay = 0;
2942         while ((IN4500(ai, COMMAND) & COMMAND_BUSY) && (delay < 10000)) {
2943                 udelay (10);
2944                 if ((++delay % 20) == 0)
2945                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2946         }
2947         return delay < 10000;
2948 }
2949
2950 int reset_airo_card( struct net_device *dev )
2951 {
2952         int i;
2953         struct airo_info *ai = dev->ml_priv;
2954
2955         if (reset_card (dev, 1))
2956                 return -1;
2957
2958         if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
2959                 airo_print_err(dev->name, "MAC could not be enabled");
2960                 return -1;
2961         }
2962         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2963         /* Allocate the transmit buffers if needed */
2964         if (!test_bit(FLAG_MPI,&ai->flags))
2965                 for( i = 0; i < MAX_FIDS; i++ )
2966                         ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2967
2968         enable_interrupts( ai );
2969         netif_wake_queue(dev);
2970         return 0;
2971 }
2972
2973 EXPORT_SYMBOL(reset_airo_card);
2974
2975 static void airo_send_event(struct net_device *dev) {
2976         struct airo_info *ai = dev->ml_priv;
2977         union iwreq_data wrqu;
2978         StatusRid status_rid;
2979
2980         clear_bit(JOB_EVENT, &ai->jobs);
2981         PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
2982         up(&ai->sem);
2983         wrqu.data.length = 0;
2984         wrqu.data.flags = 0;
2985         memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
2986         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
2987
2988         /* Send event to user space */
2989         wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
2990 }
2991
2992 static void airo_process_scan_results (struct airo_info *ai) {
2993         union iwreq_data        wrqu;
2994         BSSListRid bss;
2995         int rc;
2996         BSSListElement * loop_net;
2997         BSSListElement * tmp_net;
2998
2999         /* Blow away current list of scan results */
3000         list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
3001                 list_move_tail (&loop_net->list, &ai->network_free_list);
3002                 /* Don't blow away ->list, just BSS data */
3003                 memset (loop_net, 0, sizeof (loop_net->bss));
3004         }
3005
3006         /* Try to read the first entry of the scan result */
3007         rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
3008         if((rc) || (bss.index == cpu_to_le16(0xffff))) {
3009                 /* No scan results */
3010                 goto out;
3011         }
3012
3013         /* Read and parse all entries */
3014         tmp_net = NULL;
3015         while((!rc) && (bss.index != cpu_to_le16(0xffff))) {
3016                 /* Grab a network off the free list */
3017                 if (!list_empty(&ai->network_free_list)) {
3018                         tmp_net = list_entry(ai->network_free_list.next,
3019                                             BSSListElement, list);
3020                         list_del(ai->network_free_list.next);
3021                 }
3022
3023                 if (tmp_net != NULL) {
3024                         memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
3025                         list_add_tail(&tmp_net->list, &ai->network_list);
3026                         tmp_net = NULL;
3027                 }
3028
3029                 /* Read next entry */
3030                 rc = PC4500_readrid(ai, ai->bssListNext,
3031                                     &bss, ai->bssListRidLen, 0);
3032         }
3033
3034 out:
3035         ai->scan_timeout = 0;
3036         clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
3037         up(&ai->sem);
3038
3039         /* Send an empty event to user space.
3040          * We don't send the received data on
3041          * the event because it would require
3042          * us to do complex transcoding, and
3043          * we want to minimise the work done in
3044          * the irq handler. Use a request to
3045          * extract the data - Jean II */
3046         wrqu.data.length = 0;
3047         wrqu.data.flags = 0;
3048         wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3049 }
3050
3051 static int airo_thread(void *data) {
3052         struct net_device *dev = data;
3053         struct airo_info *ai = dev->ml_priv;
3054         int locked;
3055
3056         set_freezable();
3057         while(1) {
3058                 /* make swsusp happy with our thread */
3059                 try_to_freeze();
3060
3061                 if (test_bit(JOB_DIE, &ai->jobs))
3062                         break;
3063
3064                 if (ai->jobs) {
3065                         locked = down_interruptible(&ai->sem);
3066                 } else {
3067                         wait_queue_t wait;
3068
3069                         init_waitqueue_entry(&wait, current);
3070                         add_wait_queue(&ai->thr_wait, &wait);
3071                         for (;;) {
3072                                 set_current_state(TASK_INTERRUPTIBLE);
3073                                 if (ai->jobs)
3074                                         break;
3075                                 if (ai->expires || ai->scan_timeout) {
3076                                         if (ai->scan_timeout &&
3077                                                         time_after_eq(jiffies,ai->scan_timeout)){
3078                                                 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
3079                                                 break;
3080                                         } else if (ai->expires &&
3081                                                         time_after_eq(jiffies,ai->expires)){
3082                                                 set_bit(JOB_AUTOWEP, &ai->jobs);
3083                                                 break;
3084                                         }
3085                                         if (!kthread_should_stop() &&
3086                                             !freezing(current)) {
3087                                                 unsigned long wake_at;
3088                                                 if (!ai->expires || !ai->scan_timeout) {
3089                                                         wake_at = max(ai->expires,
3090                                                                 ai->scan_timeout);
3091                                                 } else {
3092                                                         wake_at = min(ai->expires,
3093                                                                 ai->scan_timeout);
3094                                                 }
3095                                                 schedule_timeout(wake_at - jiffies);
3096                                                 continue;
3097                                         }
3098                                 } else if (!kthread_should_stop() &&
3099                                            !freezing(current)) {
3100                                         schedule();
3101                                         continue;
3102                                 }
3103                                 break;
3104                         }
3105                         current->state = TASK_RUNNING;
3106                         remove_wait_queue(&ai->thr_wait, &wait);
3107                         locked = 1;
3108                 }
3109
3110                 if (locked)
3111                         continue;
3112
3113                 if (test_bit(JOB_DIE, &ai->jobs)) {
3114                         up(&ai->sem);
3115                         break;
3116                 }
3117
3118                 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
3119                         up(&ai->sem);
3120                         continue;
3121                 }
3122
3123                 if (test_bit(JOB_XMIT, &ai->jobs))
3124                         airo_end_xmit(dev);
3125                 else if (test_bit(JOB_XMIT11, &ai->jobs))
3126                         airo_end_xmit11(dev);
3127                 else if (test_bit(JOB_STATS, &ai->jobs))
3128                         airo_read_stats(dev);
3129                 else if (test_bit(JOB_WSTATS, &ai->jobs))
3130                         airo_read_wireless_stats(ai);
3131                 else if (test_bit(JOB_PROMISC, &ai->jobs))
3132                         airo_set_promisc(ai);
3133                 else if (test_bit(JOB_MIC, &ai->jobs))
3134                         micinit(ai);
3135                 else if (test_bit(JOB_EVENT, &ai->jobs))
3136                         airo_send_event(dev);
3137                 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
3138                         timer_func(dev);
3139                 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
3140                         airo_process_scan_results(ai);
3141                 else  /* Shouldn't get here, but we make sure to unlock */
3142                         up(&ai->sem);
3143         }
3144
3145         return 0;
3146 }
3147
3148 static int header_len(__le16 ctl)
3149 {
3150         u16 fc = le16_to_cpu(ctl);
3151         switch (fc & 0xc) {
3152         case 4:
3153                 if ((fc & 0xe0) == 0xc0)
3154                         return 10;      /* one-address control packet */
3155                 return 16;      /* two-address control packet */
3156         case 8:
3157                 if ((fc & 0x300) == 0x300)
3158                         return 30;      /* WDS packet */
3159         }
3160         return 24;
3161 }
3162
3163 static void airo_handle_cisco_mic(struct airo_info *ai)
3164 {
3165         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags)) {
3166                 set_bit(JOB_MIC, &ai->jobs);
3167                 wake_up_interruptible(&ai->thr_wait);
3168         }
3169 }
3170
3171 /* Airo Status codes */
3172 #define STAT_NOBEACON   0x8000 /* Loss of sync - missed beacons */
3173 #define STAT_MAXRETRIES 0x8001 /* Loss of sync - max retries */
3174 #define STAT_MAXARL     0x8002 /* Loss of sync - average retry level exceeded*/
3175 #define STAT_FORCELOSS  0x8003 /* Loss of sync - host request */
3176 #define STAT_TSFSYNC    0x8004 /* Loss of sync - TSF synchronization */
3177 #define STAT_DEAUTH     0x8100 /* low byte is 802.11 reason code */
3178 #define STAT_DISASSOC   0x8200 /* low byte is 802.11 reason code */
3179 #define STAT_ASSOC_FAIL 0x8400 /* low byte is 802.11 reason code */
3180 #define STAT_AUTH_FAIL  0x0300 /* low byte is 802.11 reason code */
3181 #define STAT_ASSOC      0x0400 /* Associated */
3182 #define STAT_REASSOC    0x0600 /* Reassociated?  Only on firmware >= 5.30.17 */
3183
3184 static void airo_print_status(const char *devname, u16 status)
3185 {
3186         u8 reason = status & 0xFF;
3187
3188         switch (status) {
3189         case STAT_NOBEACON:
3190                 airo_print_dbg(devname, "link lost (missed beacons)");
3191                 break;
3192         case STAT_MAXRETRIES:
3193         case STAT_MAXARL:
3194                 airo_print_dbg(devname, "link lost (max retries)");
3195                 break;
3196         case STAT_FORCELOSS:
3197                 airo_print_dbg(devname, "link lost (local choice)");
3198                 break;
3199         case STAT_TSFSYNC:
3200                 airo_print_dbg(devname, "link lost (TSF sync lost)");
3201                 break;
3202         case STAT_DEAUTH:
3203                 airo_print_dbg(devname, "deauthenticated (reason: %d)", reason);
3204                 break;
3205         case STAT_DISASSOC:
3206                 airo_print_dbg(devname, "disassociated (reason: %d)", reason);
3207                 break;
3208         case STAT_ASSOC_FAIL:
3209                 airo_print_dbg(devname, "association failed (reason: %d)",
3210                                reason);
3211                 break;
3212         case STAT_AUTH_FAIL:
3213                 airo_print_dbg(devname, "authentication failed (reason: %d)",
3214                                reason);
3215                 break;
3216         default:
3217                 break;
3218         }
3219 }
3220
3221 static void airo_handle_link(struct airo_info *ai)
3222 {
3223         union iwreq_data wrqu;
3224         int scan_forceloss = 0;
3225         u16 status;
3226
3227         /* Get new status and acknowledge the link change */
3228         status = le16_to_cpu(IN4500(ai, LINKSTAT));
3229         OUT4500(ai, EVACK, EV_LINK);
3230
3231         if ((status == STAT_FORCELOSS) && (ai->scan_timeout > 0))
3232                 scan_forceloss = 1;
3233
3234         airo_print_status(ai->dev->name, status);
3235
3236         if ((status == STAT_ASSOC) || (status == STAT_REASSOC)) {
3237                 if (auto_wep)
3238                         ai->expires = 0;
3239                 if (ai->list_bss_task)
3240                         wake_up_process(ai->list_bss_task);
3241                 set_bit(FLAG_UPDATE_UNI, &ai->flags);
3242                 set_bit(FLAG_UPDATE_MULTI, &ai->flags);
3243
3244                 if (down_trylock(&ai->sem) != 0) {
3245                         set_bit(JOB_EVENT, &ai->jobs);
3246                         wake_up_interruptible(&ai->thr_wait);
3247                 } else
3248                         airo_send_event(ai->dev);
3249         } else if (!scan_forceloss) {
3250                 if (auto_wep && !ai->expires) {
3251                         ai->expires = RUN_AT(3*HZ);
3252                         wake_up_interruptible(&ai->thr_wait);
3253                 }
3254
3255                 /* Send event to user space */
3256                 memset(wrqu.ap_addr.sa_data, '\0', ETH_ALEN);
3257                 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3258                 wireless_send_event(ai->dev, SIOCGIWAP, &wrqu, NULL);
3259         }
3260 }
3261
3262 static void airo_handle_rx(struct airo_info *ai)
3263 {
3264         struct sk_buff *skb = NULL;
3265         __le16 fc, v, *buffer, tmpbuf[4];
3266         u16 len, hdrlen = 0, gap, fid;
3267         struct rx_hdr hdr;
3268         int success = 0;
3269
3270         if (test_bit(FLAG_MPI, &ai->flags)) {
3271                 if (test_bit(FLAG_802_11, &ai->flags))
3272                         mpi_receive_802_11(ai);
3273                 else
3274                         mpi_receive_802_3(ai);
3275                 OUT4500(ai, EVACK, EV_RX);
3276                 return;
3277         }
3278
3279         fid = IN4500(ai, RXFID);
3280
3281         /* Get the packet length */
3282         if (test_bit(FLAG_802_11, &ai->flags)) {
3283                 bap_setup (ai, fid, 4, BAP0);
3284                 bap_read (ai, (__le16*)&hdr, sizeof(hdr), BAP0);
3285                 /* Bad CRC. Ignore packet */
3286                 if (le16_to_cpu(hdr.status) & 2)
3287                         hdr.len = 0;
3288                 if (ai->wifidev == NULL)
3289                         hdr.len = 0;
3290         } else {
3291                 bap_setup(ai, fid, 0x36, BAP0);
3292                 bap_read(ai, &hdr.len, 2, BAP0);
3293         }
3294         len = le16_to_cpu(hdr.len);
3295
3296         if (len > AIRO_DEF_MTU) {
3297                 airo_print_err(ai->dev->name, "Bad size %d", len);
3298                 goto done;
3299         }
3300         if (len == 0)
3301                 goto done;
3302
3303         if (test_bit(FLAG_802_11, &ai->flags)) {
3304                 bap_read(ai, &fc, sizeof (fc), BAP0);
3305                 hdrlen = header_len(fc);
3306         } else
3307                 hdrlen = ETH_ALEN * 2;
3308
3309         skb = dev_alloc_skb(len + hdrlen + 2 + 2);
3310         if (!skb) {
3311                 ai->dev->stats.rx_dropped++;
3312                 goto done;
3313         }
3314
3315         skb_reserve(skb, 2); /* This way the IP header is aligned */
3316         buffer = (__le16 *) skb_put(skb, len + hdrlen);
3317         if (test_bit(FLAG_802_11, &ai->flags)) {
3318                 buffer[0] = fc;
3319                 bap_read(ai, buffer + 1, hdrlen - 2, BAP0);
3320                 if (hdrlen == 24)
3321                         bap_read(ai, tmpbuf, 6, BAP0);
3322
3323                 bap_read(ai, &v, sizeof(v), BAP0);
3324                 gap = le16_to_cpu(v);
3325                 if (gap) {
3326                         if (gap <= 8) {
3327                                 bap_read(ai, tmpbuf, gap, BAP0);
3328                         } else {
3329                                 airo_print_err(ai->dev->name, "gaplen too "
3330                                         "big. Problems will follow...");
3331                         }
3332                 }
3333                 bap_read(ai, buffer + hdrlen/2, len, BAP0);
3334         } else {
3335                 MICBuffer micbuf;
3336
3337                 bap_read(ai, buffer, ETH_ALEN * 2, BAP0);
3338                 if (ai->micstats.enabled) {
3339                         bap_read(ai, (__le16 *) &micbuf, sizeof (micbuf), BAP0);
3340                         if (ntohs(micbuf.typelen) > 0x05DC)
3341                                 bap_setup(ai, fid, 0x44, BAP0);
3342                         else {
3343                                 if (len <= sizeof (micbuf)) {
3344                                         dev_kfree_skb_irq(skb);
3345                                         goto done;
3346                                 }
3347
3348                                 len -= sizeof(micbuf);
3349                                 skb_trim(skb, len + hdrlen);
3350                         }
3351                 }
3352
3353                 bap_read(ai, buffer + ETH_ALEN, len, BAP0);
3354                 if (decapsulate(ai, &micbuf, (etherHead*) buffer, len))
3355                         dev_kfree_skb_irq (skb);
3356                 else
3357                         success = 1;
3358         }
3359
3360 #ifdef WIRELESS_SPY
3361         if (success && (ai->spy_data.spy_number > 0)) {
3362                 char *sa;
3363                 struct iw_quality wstats;
3364
3365                 /* Prepare spy data : addr + qual */
3366                 if (!test_bit(FLAG_802_11, &ai->flags)) {
3367                         sa = (char *) buffer + 6;
3368                         bap_setup(ai, fid, 8, BAP0);
3369                         bap_read(ai, (__le16 *) hdr.rssi, 2, BAP0);
3370                 } else
3371                         sa = (char *) buffer + 10;
3372                 wstats.qual = hdr.rssi[0];
3373                 if (ai->rssi)
3374                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3375                 else
3376                         wstats.level = (hdr.rssi[1] + 321) / 2;
3377                 wstats.noise = ai->wstats.qual.noise;
3378                 wstats.updated =  IW_QUAL_LEVEL_UPDATED
3379                                 | IW_QUAL_QUAL_UPDATED
3380                                 | IW_QUAL_DBM;
3381                 /* Update spy records */
3382                 wireless_spy_update(ai->dev, sa, &wstats);
3383         }
3384 #endif /* WIRELESS_SPY */
3385
3386 done:
3387         OUT4500(ai, EVACK, EV_RX);
3388
3389         if (success) {
3390                 if (test_bit(FLAG_802_11, &ai->flags)) {
3391                         skb_reset_mac_header(skb);
3392                         skb->pkt_type = PACKET_OTHERHOST;
3393                         skb->dev = ai->wifidev;
3394                         skb->protocol = htons(ETH_P_802_2);
3395                 } else
3396                         skb->protocol = eth_type_trans(skb, ai->dev);
3397                 skb->ip_summed = CHECKSUM_NONE;
3398
3399                 netif_rx(skb);
3400         }
3401 }
3402
3403 static void airo_handle_tx(struct airo_info *ai, u16 status)
3404 {
3405         int i, len = 0, index = -1;
3406         u16 fid;
3407
3408         if (test_bit(FLAG_MPI, &ai->flags)) {
3409                 unsigned long flags;
3410
3411                 if (status & EV_TXEXC)
3412                         get_tx_error(ai, -1);
3413
3414                 spin_lock_irqsave(&ai->aux_lock, flags);
3415                 if (!skb_queue_empty(&ai->txq)) {
3416                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3417                         mpi_send_packet(ai->dev);
3418                 } else {
3419                         clear_bit(FLAG_PENDING_XMIT, &ai->flags);
3420                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3421                         netif_wake_queue(ai->dev);
3422                 }
3423                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3424                 return;
3425         }
3426
3427         fid = IN4500(ai, TXCOMPLFID);
3428
3429         for(i = 0; i < MAX_FIDS; i++) {
3430                 if ((ai->fids[i] & 0xffff) == fid) {
3431                         len = ai->fids[i] >> 16;
3432                         index = i;
3433                 }
3434         }
3435
3436         if (index != -1) {
3437                 if (status & EV_TXEXC)
3438                         get_tx_error(ai, index);
3439
3440                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXEXC));
3441
3442                 /* Set up to be used again */
3443                 ai->fids[index] &= 0xffff;
3444                 if (index < MAX_FIDS / 2) {
3445                         if (!test_bit(FLAG_PENDING_XMIT, &ai->flags))
3446                                 netif_wake_queue(ai->dev);
3447                 } else {
3448                         if (!test_bit(FLAG_PENDING_XMIT11, &ai->flags))
3449                                 netif_wake_queue(ai->wifidev);
3450                 }
3451         } else {
3452                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3453                 airo_print_err(ai->dev->name, "Unallocated FID was used to xmit");
3454         }
3455 }
3456
3457 static irqreturn_t airo_interrupt(int irq, void *dev_id)
3458 {
3459         struct net_device *dev = dev_id;
3460         u16 status, savedInterrupts = 0;
3461         struct airo_info *ai = dev->ml_priv;
3462         int handled = 0;
3463
3464         if (!netif_device_present(dev))
3465                 return IRQ_NONE;
3466
3467         for (;;) {
3468                 status = IN4500(ai, EVSTAT);
3469                 if (!(status & STATUS_INTS) || (status == 0xffff))
3470                         break;
3471
3472                 handled = 1;
3473
3474                 if (status & EV_AWAKE) {
3475                         OUT4500(ai, EVACK, EV_AWAKE);
3476                         OUT4500(ai, EVACK, EV_AWAKE);
3477                 }
3478
3479                 if (!savedInterrupts) {
3480                         savedInterrupts = IN4500(ai, EVINTEN);
3481                         OUT4500(ai, EVINTEN, 0);
3482                 }
3483
3484                 if (status & EV_MIC) {
3485                         OUT4500(ai, EVACK, EV_MIC);
3486                         airo_handle_cisco_mic(ai);
3487                 }
3488
3489                 if (status & EV_LINK) {
3490                         /* Link status changed */
3491                         airo_handle_link(ai);
3492                 }
3493
3494                 /* Check to see if there is something to receive */
3495                 if (status & EV_RX)
3496                         airo_handle_rx(ai);
3497
3498                 /* Check to see if a packet has been transmitted */
3499                 if (status & (EV_TX | EV_TXCPY | EV_TXEXC))
3500                         airo_handle_tx(ai, status);
3501
3502                 if ( status & ~STATUS_INTS & ~IGNORE_INTS ) {
3503                         airo_print_warn(ai->dev->name, "Got weird status %x",
3504                                 status & ~STATUS_INTS & ~IGNORE_INTS );
3505                 }
3506         }
3507
3508         if (savedInterrupts)
3509                 OUT4500(ai, EVINTEN, savedInterrupts);
3510
3511         return IRQ_RETVAL(handled);
3512 }
3513
3514 /*
3515  *  Routines to talk to the card
3516  */
3517
3518 /*
3519  *  This was originally written for the 4500, hence the name
3520  *  NOTE:  If use with 8bit mode and SMP bad things will happen!
3521  *         Why would some one do 8 bit IO in an SMP machine?!?
3522  */
3523 static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3524         if (test_bit(FLAG_MPI,&ai->flags))
3525                 reg <<= 1;
3526         if ( !do8bitIO )
3527                 outw( val, ai->dev->base_addr + reg );
3528         else {
3529                 outb( val & 0xff, ai->dev->base_addr + reg );
3530                 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3531         }
3532 }
3533
3534 static u16 IN4500( struct airo_info *ai, u16 reg ) {
3535         unsigned short rc;
3536
3537         if (test_bit(FLAG_MPI,&ai->flags))
3538                 reg <<= 1;
3539         if ( !do8bitIO )
3540                 rc = inw( ai->dev->base_addr + reg );
3541         else {
3542                 rc = inb( ai->dev->base_addr + reg );
3543                 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3544         }
3545         return rc;
3546 }
3547
3548 static int enable_MAC(struct airo_info *ai, int lock)
3549 {
3550         int rc;
3551         Cmd cmd;
3552         Resp rsp;
3553
3554         /* FLAG_RADIO_OFF : Radio disabled via /proc or Wireless Extensions
3555          * FLAG_RADIO_DOWN : Radio disabled via "ifconfig ethX down"
3556          * Note : we could try to use !netif_running(dev) in enable_MAC()
3557          * instead of this flag, but I don't trust it *within* the
3558          * open/close functions, and testing both flags together is
3559          * "cheaper" - Jean II */
3560         if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3561
3562         if (lock && down_interruptible(&ai->sem))
3563                 return -ERESTARTSYS;
3564
3565         if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3566                 memset(&cmd, 0, sizeof(cmd));
3567                 cmd.cmd = MAC_ENABLE;
3568                 rc = issuecommand(ai, &cmd, &rsp);
3569                 if (rc == SUCCESS)
3570                         set_bit(FLAG_ENABLED, &ai->flags);
3571         } else
3572                 rc = SUCCESS;
3573
3574         if (lock)
3575             up(&ai->sem);
3576
3577         if (rc)
3578                 airo_print_err(ai->dev->name, "Cannot enable MAC");
3579         else if ((rsp.status & 0xFF00) != 0) {
3580                 airo_print_err(ai->dev->name, "Bad MAC enable reason=%x, "
3581                         "rid=%x, offset=%d", rsp.rsp0, rsp.rsp1, rsp.rsp2);
3582                 rc = ERROR;
3583         }
3584         return rc;
3585 }
3586
3587 static void disable_MAC( struct airo_info *ai, int lock ) {
3588         Cmd cmd;
3589         Resp rsp;
3590
3591         if (lock && down_interruptible(&ai->sem))
3592                 return;
3593
3594         if (test_bit(FLAG_ENABLED, &ai->flags)) {
3595                 memset(&cmd, 0, sizeof(cmd));
3596                 cmd.cmd = MAC_DISABLE; // disable in case already enabled
3597                 issuecommand(ai, &cmd, &rsp);
3598                 clear_bit(FLAG_ENABLED, &ai->flags);
3599         }
3600         if (lock)
3601                 up(&ai->sem);
3602 }
3603
3604 static void enable_interrupts( struct airo_info *ai ) {
3605         /* Enable the interrupts */
3606         OUT4500( ai, EVINTEN, STATUS_INTS );
3607 }
3608
3609 static void disable_interrupts( struct airo_info *ai ) {
3610         OUT4500( ai, EVINTEN, 0 );
3611 }
3612
3613 static void mpi_receive_802_3(struct airo_info *ai)
3614 {
3615         RxFid rxd;
3616         int len = 0;
3617         struct sk_buff *skb;
3618         char *buffer;
3619         int off = 0;
3620         MICBuffer micbuf;
3621
3622         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3623         /* Make sure we got something */
3624         if (rxd.rdy && rxd.valid == 0) {
3625                 len = rxd.len + 12;
3626                 if (len < 12 || len > 2048)
3627                         goto badrx;
3628
3629                 skb = dev_alloc_skb(len);
3630                 if (!skb) {
3631                         ai->dev->stats.rx_dropped++;
3632                         goto badrx;
3633                 }
3634                 buffer = skb_put(skb,len);
3635                 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3636                 if (ai->micstats.enabled) {
3637                         memcpy(&micbuf,
3638                                 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3639                                 sizeof(micbuf));
3640                         if (ntohs(micbuf.typelen) <= 0x05DC) {
3641                                 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3642                                         goto badmic;
3643
3644                                 off = sizeof(micbuf);
3645                                 skb_trim (skb, len - off);
3646                         }
3647                 }
3648                 memcpy(buffer + ETH_ALEN * 2,
3649                         ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3650                         len - ETH_ALEN * 2 - off);
3651                 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3652 badmic:
3653                         dev_kfree_skb_irq (skb);
3654                         goto badrx;
3655                 }
3656 #ifdef WIRELESS_SPY
3657                 if (ai->spy_data.spy_number > 0) {
3658                         char *sa;
3659                         struct iw_quality wstats;
3660                         /* Prepare spy data : addr + qual */
3661                         sa = buffer + ETH_ALEN;
3662                         wstats.qual = 0; /* XXX Where do I get that info from ??? */
3663                         wstats.level = 0;
3664                         wstats.updated = 0;
3665                         /* Update spy records */
3666                         wireless_spy_update(ai->dev, sa, &wstats);
3667                 }
3668 #endif /* WIRELESS_SPY */
3669
3670                 skb->ip_summed = CHECKSUM_NONE;
3671                 skb->protocol = eth_type_trans(skb, ai->dev);
3672                 netif_rx(skb);
3673         }
3674 badrx:
3675         if (rxd.valid == 0) {
3676                 rxd.valid = 1;
3677                 rxd.rdy = 0;
3678                 rxd.len = PKTSIZE;
3679                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3680         }
3681 }
3682
3683 static void mpi_receive_802_11(struct airo_info *ai)
3684 {
3685         RxFid rxd;
3686         struct sk_buff *skb = NULL;
3687         u16 len, hdrlen = 0;
3688         __le16 fc;
3689         struct rx_hdr hdr;
3690         u16 gap;
3691         u16 *buffer;
3692         char *ptr = ai->rxfids[0].virtual_host_addr + 4;
3693
3694         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3695         memcpy ((char *)&hdr, ptr, sizeof(hdr));
3696         ptr += sizeof(hdr);
3697         /* Bad CRC. Ignore packet */
3698         if (le16_to_cpu(hdr.status) & 2)
3699                 hdr.len = 0;
3700         if (ai->wifidev == NULL)
3701                 hdr.len = 0;
3702         len = le16_to_cpu(hdr.len);
3703         if (len > AIRO_DEF_MTU) {
3704                 airo_print_err(ai->dev->name, "Bad size %d", len);
3705                 goto badrx;
3706         }
3707         if (len == 0)
3708                 goto badrx;
3709
3710         fc = get_unaligned((__le16 *)ptr);
3711         hdrlen = header_len(fc);
3712
3713         skb = dev_alloc_skb( len + hdrlen + 2 );
3714         if ( !skb ) {
3715                 ai->dev->stats.rx_dropped++;
3716                 goto badrx;
3717         }
3718         buffer = (u16*)skb_put (skb, len + hdrlen);
3719         memcpy ((char *)buffer, ptr, hdrlen);
3720         ptr += hdrlen;
3721         if (hdrlen == 24)
3722                 ptr += 6;
3723         gap = get_unaligned_le16(ptr);
3724         ptr += sizeof(__le16);
3725         if (gap) {
3726                 if (gap <= 8)
3727                         ptr += gap;
3728                 else
3729                         airo_print_err(ai->dev->name,
3730                             "gaplen too big. Problems will follow...");
3731         }
3732         memcpy ((char *)buffer + hdrlen, ptr, len);
3733         ptr += len;
3734 #ifdef IW_WIRELESS_SPY    /* defined in iw_handler.h */
3735         if (ai->spy_data.spy_number > 0) {
3736                 char *sa;
3737                 struct iw_quality wstats;
3738                 /* Prepare spy data : addr + qual */
3739                 sa = (char*)buffer + 10;
3740                 wstats.qual = hdr.rssi[0];
3741                 if (ai->rssi)
3742                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3743                 else
3744                         wstats.level = (hdr.rssi[1] + 321) / 2;
3745                 wstats.noise = ai->wstats.qual.noise;
3746                 wstats.updated = IW_QUAL_QUAL_UPDATED
3747                         | IW_QUAL_LEVEL_UPDATED
3748                         | IW_QUAL_DBM;
3749                 /* Update spy records */
3750                 wireless_spy_update(ai->dev, sa, &wstats);
3751         }
3752 #endif /* IW_WIRELESS_SPY */
3753         skb_reset_mac_header(skb);
3754         skb->pkt_type = PACKET_OTHERHOST;
3755         skb->dev = ai->wifidev;
3756         skb->protocol = htons(ETH_P_802_2);
3757         skb->ip_summed = CHECKSUM_NONE;
3758         netif_rx( skb );
3759
3760 badrx:
3761         if (rxd.valid == 0) {
3762                 rxd.valid = 1;
3763                 rxd.rdy = 0;
3764                 rxd.len = PKTSIZE;
3765                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3766         }
3767 }
3768
3769 static u16 setup_card(struct airo_info *ai, u8 *mac, int lock)
3770 {
3771         Cmd cmd;
3772         Resp rsp;
3773         int status;
3774         SsidRid mySsid;
3775         __le16 lastindex;
3776         WepKeyRid wkr;
3777         int rc;
3778
3779         memset( &mySsid, 0, sizeof( mySsid ) );
3780         kfree (ai->flash);
3781         ai->flash = NULL;
3782
3783         /* The NOP is the first step in getting the card going */
3784         cmd.cmd = NOP;
3785         cmd.parm0 = cmd.parm1 = cmd.parm2 = 0;
3786         if (lock && down_interruptible(&ai->sem))
3787                 return ERROR;
3788         if ( issuecommand( ai, &cmd, &rsp ) != SUCCESS ) {
3789                 if (lock)
3790                         up(&ai->sem);
3791                 return ERROR;
3792         }
3793         disable_MAC( ai, 0);
3794
3795         // Let's figure out if we need to use the AUX port
3796         if (!test_bit(FLAG_MPI,&ai->flags)) {
3797                 cmd.cmd = CMD_ENABLEAUX;
3798                 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
3799                         if (lock)
3800                                 up(&ai->sem);
3801                         airo_print_err(ai->dev->name, "Error checking for AUX port");
3802                         return ERROR;
3803                 }
3804                 if (!aux_bap || rsp.status & 0xff00) {
3805                         ai->bap_read = fast_bap_read;
3806                         airo_print_dbg(ai->dev->name, "Doing fast bap_reads");
3807                 } else {
3808                         ai->bap_read = aux_bap_read;
3809                         airo_print_dbg(ai->dev->name, "Doing AUX bap_reads");
3810                 }
3811         }
3812         if (lock)
3813                 up(&ai->sem);
3814         if (ai->config.len == 0) {
3815                 int i;
3816                 tdsRssiRid rssi_rid;
3817                 CapabilityRid cap_rid;
3818
3819                 kfree(ai->APList);
3820                 ai->APList = NULL;
3821                 kfree(ai->SSID);
3822                 ai->SSID = NULL;
3823                 // general configuration (read/modify/write)
3824                 status = readConfigRid(ai, lock);
3825                 if ( status != SUCCESS ) return ERROR;
3826
3827                 status = readCapabilityRid(ai, &cap_rid, lock);
3828                 if ( status != SUCCESS ) return ERROR;
3829
3830                 status = PC4500_readrid(ai,RID_RSSI,&rssi_rid,sizeof(rssi_rid),lock);
3831                 if ( status == SUCCESS ) {
3832                         if (ai->rssi || (ai->rssi = kmalloc(512, GFP_KERNEL)) != NULL)
3833                                 memcpy(ai->rssi, (u8*)&rssi_rid + 2, 512); /* Skip RID length member */
3834                 }
3835                 else {
3836                         kfree(ai->rssi);
3837                         ai->rssi = NULL;
3838                         if (cap_rid.softCap & cpu_to_le16(8))
3839                                 ai->config.rmode |= RXMODE_NORMALIZED_RSSI;
3840                         else
3841                                 airo_print_warn(ai->dev->name, "unknown received signal "
3842                                                 "level scale");
3843                 }
3844                 ai->config.opmode = adhoc ? MODE_STA_IBSS : MODE_STA_ESS;
3845                 ai->config.authType = AUTH_OPEN;
3846                 ai->config.modulation = MOD_CCK;
3847
3848                 if (le16_to_cpu(cap_rid.len) >= sizeof(cap_rid) &&
3849                     (cap_rid.extSoftCap & cpu_to_le16(1)) &&
3850                     micsetup(ai) == SUCCESS) {
3851                         ai->config.opmode |= MODE_MIC;
3852                         set_bit(FLAG_MIC_CAPABLE, &ai->flags);
3853                 }
3854
3855                 /* Save off the MAC */
3856                 for( i = 0; i < ETH_ALEN; i++ ) {
3857                         mac[i] = ai->config.macAddr[i];
3858                 }
3859
3860                 /* Check to see if there are any insmod configured
3861                    rates to add */
3862                 if ( rates[0] ) {
3863                         memset(ai->config.rates,0,sizeof(ai->config.rates));
3864                         for( i = 0; i < 8 && rates[i]; i++ ) {
3865                                 ai->config.rates[i] = rates[i];
3866                         }
3867                 }
3868                 if ( basic_rate > 0 ) {
3869                         for( i = 0; i < 8; i++ ) {
3870                                 if ( ai->config.rates[i] == basic_rate ||
3871                                      !ai->config.rates ) {
3872                                         ai->config.rates[i] = basic_rate | 0x80;
3873                                         break;
3874                                 }
3875                         }
3876                 }
3877                 set_bit (FLAG_COMMIT, &ai->flags);
3878         }
3879
3880         /* Setup the SSIDs if present */
3881         if ( ssids[0] ) {
3882                 int i;
3883                 for( i = 0; i < 3 && ssids[i]; i++ ) {
3884                         size_t len = strlen(ssids[i]);
3885                         if (len > 32)
3886                                 len = 32;
3887                         mySsid.ssids[i].len = cpu_to_le16(len);
3888                         memcpy(mySsid.ssids[i].ssid, ssids[i], len);
3889                 }
3890                 mySsid.len = cpu_to_le16(sizeof(mySsid));
3891         }
3892
3893         status = writeConfigRid(ai, lock);
3894         if ( status != SUCCESS ) return ERROR;
3895
3896         /* Set up the SSID list */
3897         if ( ssids[0] ) {
3898                 status = writeSsidRid(ai, &mySsid, lock);
3899                 if ( status != SUCCESS ) return ERROR;
3900         }
3901
3902         status = enable_MAC(ai, lock);
3903         if (status != SUCCESS)
3904                 return ERROR;
3905
3906         /* Grab the initial wep key, we gotta save it for auto_wep */
3907         rc = readWepKeyRid(ai, &wkr, 1, lock);
3908         if (rc == SUCCESS) do {
3909                 lastindex = wkr.kindex;
3910                 if (wkr.kindex == cpu_to_le16(0xffff)) {
3911                         ai->defindex = wkr.mac[0];
3912                 }
3913                 rc = readWepKeyRid(ai, &wkr, 0, lock);
3914         } while(lastindex != wkr.kindex);
3915
3916         try_auto_wep(ai);
3917
3918         return SUCCESS;
3919 }
3920
3921 static u16 issuecommand(struct airo_info *ai, Cmd *pCmd, Resp *pRsp) {
3922         // Im really paranoid about letting it run forever!
3923         int max_tries = 600000;
3924
3925         if (IN4500(ai, EVSTAT) & EV_CMD)
3926                 OUT4500(ai, EVACK, EV_CMD);
3927
3928         OUT4500(ai, PARAM0, pCmd->parm0);
3929         OUT4500(ai, PARAM1, pCmd->parm1);
3930         OUT4500(ai, PARAM2, pCmd->parm2);
3931         OUT4500(ai, COMMAND, pCmd->cmd);
3932
3933         while (max_tries-- && (IN4500(ai, EVSTAT) & EV_CMD) == 0) {
3934                 if ((IN4500(ai, COMMAND)) == pCmd->cmd)
3935                         // PC4500 didn't notice command, try again
3936                         OUT4500(ai, COMMAND, pCmd->cmd);
3937                 if (!in_atomic() && (max_tries & 255) == 0)
3938                         schedule();
3939         }
3940
3941         if ( max_tries == -1 ) {
3942                 airo_print_err(ai->dev->name,
3943                         "Max tries exceeded when issueing command");
3944                 if (IN4500(ai, COMMAND) & COMMAND_BUSY)
3945                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3946                 return ERROR;
3947         }
3948
3949         // command completed
3950         pRsp->status = IN4500(ai, STATUS);
3951         pRsp->rsp0 = IN4500(ai, RESP0);
3952         pRsp->rsp1 = IN4500(ai, RESP1);
3953         pRsp->rsp2 = IN4500(ai, RESP2);
3954         if ((pRsp->status & 0xff00)!=0 && pCmd->cmd != CMD_SOFTRESET)
3955                 airo_print_err(ai->dev->name,
3956                         "cmd:%x status:%x rsp0:%x rsp1:%x rsp2:%x",
3957                         pCmd->cmd, pRsp->status, pRsp->rsp0, pRsp->rsp1,
3958                         pRsp->rsp2);
3959
3960         // clear stuck command busy if necessary
3961         if (IN4500(ai, COMMAND) & COMMAND_BUSY) {
3962                 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3963         }
3964         // acknowledge processing the status/response
3965         OUT4500(ai, EVACK, EV_CMD);
3966
3967         return SUCCESS;
3968 }
3969
3970 /* Sets up the bap to start exchange data.  whichbap should
3971  * be one of the BAP0 or BAP1 defines.  Locks should be held before
3972  * calling! */
3973 static int bap_setup(struct airo_info *ai, u16 rid, u16 offset, int whichbap )
3974 {
3975         int timeout = 50;
3976         int max_tries = 3;
3977
3978         OUT4500(ai, SELECT0+whichbap, rid);
3979         OUT4500(ai, OFFSET0+whichbap, offset);
3980         while (1) {
3981                 int status = IN4500(ai, OFFSET0+whichbap);
3982                 if (status & BAP_BUSY) {
3983                         /* This isn't really a timeout, but its kinda
3984                            close */
3985                         if (timeout--) {
3986                                 continue;
3987                         }
3988                 } else if ( status & BAP_ERR ) {
3989                         /* invalid rid or offset */
3990                         airo_print_err(ai->dev->name, "BAP error %x %d",
3991                                 status, whichbap );
3992                         return ERROR;
3993                 } else if (status & BAP_DONE) { // success
3994                         return SUCCESS;
3995                 }
3996                 if ( !(max_tries--) ) {
3997                         airo_print_err(ai->dev->name,
3998                                 "BAP setup error too many retries\n");
3999                         return ERROR;
4000                 }
4001                 // -- PC4500 missed it, try again
4002                 OUT4500(ai, SELECT0+whichbap, rid);
4003                 OUT4500(ai, OFFSET0+whichbap, offset);
4004                 timeout = 50;
4005         }
4006 }
4007
4008 /* should only be called by aux_bap_read.  This aux function and the
4009    following use concepts not documented in the developers guide.  I
4010    got them from a patch given to my by Aironet */
4011 static u16 aux_setup(struct airo_info *ai, u16 page,
4012                      u16 offset, u16 *len)
4013 {
4014         u16 next;
4015
4016         OUT4500(ai, AUXPAGE, page);
4017         OUT4500(ai, AUXOFF, 0);
4018         next = IN4500(ai, AUXDATA);
4019         *len = IN4500(ai, AUXDATA)&0xff;
4020         if (offset != 4) OUT4500(ai, AUXOFF, offset);
4021         return next;
4022 }
4023
4024 /* requires call to bap_setup() first */
4025 static int aux_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4026                         int bytelen, int whichbap)
4027 {
4028         u16 len;
4029         u16 page;
4030         u16 offset;
4031         u16 next;
4032         int words;
4033         int i;
4034         unsigned long flags;
4035
4036         spin_lock_irqsave(&ai->aux_lock, flags);
4037         page = IN4500(ai, SWS0+whichbap);
4038         offset = IN4500(ai, SWS2+whichbap);
4039         next = aux_setup(ai, page, offset, &len);
4040         words = (bytelen+1)>>1;
4041
4042         for (i=0; i<words;) {
4043                 int count;
4044                 count = (len>>1) < (words-i) ? (len>>1) : (words-i);
4045                 if ( !do8bitIO )
4046                         insw( ai->dev->base_addr+DATA0+whichbap,
4047                               pu16Dst+i,count );
4048                 else
4049                         insb( ai->dev->base_addr+DATA0+whichbap,
4050                               pu16Dst+i, count << 1 );
4051                 i += count;
4052                 if (i<words) {
4053                         next = aux_setup(ai, next, 4, &len);
4054                 }
4055         }
4056         spin_unlock_irqrestore(&ai->aux_lock, flags);
4057         return SUCCESS;
4058 }
4059
4060
4061 /* requires call to bap_setup() first */
4062 static int fast_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4063                          int bytelen, int whichbap)
4064 {
4065         bytelen = (bytelen + 1) & (~1); // round up to even value
4066         if ( !do8bitIO )
4067                 insw( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen>>1 );
4068         else
4069                 insb( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen );
4070         return SUCCESS;
4071 }
4072
4073 /* requires call to bap_setup() first */
4074 static int bap_write(struct airo_info *ai, const __le16 *pu16Src,
4075                      int bytelen, int whichbap)
4076 {
4077         bytelen = (bytelen + 1) & (~1); // round up to even value
4078         if ( !do8bitIO )
4079                 outsw( ai->dev->base_addr+DATA0+whichbap,
4080                        pu16Src, bytelen>>1 );
4081         else
4082                 outsb( ai->dev->base_addr+DATA0+whichbap, pu16Src, bytelen );
4083         return SUCCESS;
4084 }
4085
4086 static int PC4500_accessrid(struct airo_info *ai, u16 rid, u16 accmd)
4087 {
4088         Cmd cmd; /* for issuing commands */
4089         Resp rsp; /* response from commands */
4090         u16 status;
4091
4092         memset(&cmd, 0, sizeof(cmd));
4093         cmd.cmd = accmd;
4094         cmd.parm0 = rid;
4095         status = issuecommand(ai, &cmd, &rsp);
4096         if (status != 0) return status;
4097         if ( (rsp.status & 0x7F00) != 0) {
4098                 return (accmd << 8) + (rsp.rsp0 & 0xFF);
4099         }
4100         return 0;
4101 }
4102
4103 /*  Note, that we are using BAP1 which is also used by transmit, so
4104  *  we must get a lock. */
4105 static int PC4500_readrid(struct airo_info *ai, u16 rid, void *pBuf, int len, int lock)
4106 {
4107         u16 status;
4108         int rc = SUCCESS;
4109
4110         if (lock) {
4111                 if (down_interruptible(&ai->sem))
4112                         return ERROR;
4113         }
4114         if (test_bit(FLAG_MPI,&ai->flags)) {
4115                 Cmd cmd;
4116                 Resp rsp;
4117
4118                 memset(&cmd, 0, sizeof(cmd));
4119                 memset(&rsp, 0, sizeof(rsp));
4120                 ai->config_desc.rid_desc.valid = 1;
4121                 ai->config_desc.rid_desc.len = RIDSIZE;
4122                 ai->config_desc.rid_desc.rid = 0;
4123                 ai->config_desc.rid_desc.host_addr = ai->ridbus;
4124
4125                 cmd.cmd = CMD_ACCESS;
4126                 cmd.parm0 = rid;
4127
4128                 memcpy_toio(ai->config_desc.card_ram_off,
4129                         &ai->config_desc.rid_desc, sizeof(Rid));
4130
4131                 rc = issuecommand(ai, &cmd, &rsp);
4132
4133                 if (rsp.status & 0x7f00)
4134                         rc = rsp.rsp0;
4135                 if (!rc)
4136                         memcpy(pBuf, ai->config_desc.virtual_host_addr, len);
4137                 goto done;
4138         } else {
4139                 if ((status = PC4500_accessrid(ai, rid, CMD_ACCESS))!=SUCCESS) {
4140                         rc = status;
4141                         goto done;
4142                 }
4143                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4144                         rc = ERROR;
4145                         goto done;
4146                 }
4147                 // read the rid length field
4148                 bap_read(ai, pBuf, 2, BAP1);
4149                 // length for remaining part of rid
4150                 len = min(len, (int)le16_to_cpu(*(__le16*)pBuf)) - 2;
4151
4152                 if ( len <= 2 ) {
4153                         airo_print_err(ai->dev->name,
4154                                 "Rid %x has a length of %d which is too short",
4155                                 (int)rid, (int)len );
4156                         rc = ERROR;
4157                         goto done;
4158                 }
4159                 // read remainder of the rid
4160                 rc = bap_read(ai, ((__le16*)pBuf)+1, len, BAP1);
4161         }
4162 done:
4163         if (lock)
4164                 up(&ai->sem);
4165         return rc;
4166 }
4167
4168 /*  Note, that we are using BAP1 which is also used by transmit, so
4169  *  make sure this isnt called when a transmit is happening */
4170 static int PC4500_writerid(struct airo_info *ai, u16 rid,
4171                            const void *pBuf, int len, int lock)
4172 {
4173         u16 status;
4174         int rc = SUCCESS;
4175
4176         *(__le16*)pBuf = cpu_to_le16((u16)len);
4177
4178         if (lock) {
4179                 if (down_interruptible(&ai->sem))
4180                         return ERROR;
4181         }
4182         if (test_bit(FLAG_MPI,&ai->flags)) {
4183                 Cmd cmd;
4184                 Resp rsp;
4185
4186                 if (test_bit(FLAG_ENABLED, &ai->flags) && (RID_WEP_TEMP != rid))
4187                         airo_print_err(ai->dev->name,
4188                                 "%s: MAC should be disabled (rid=%04x)",
4189                                 __func__, rid);
4190                 memset(&cmd, 0, sizeof(cmd));
4191                 memset(&rsp, 0, sizeof(rsp));
4192
4193                 ai->config_desc.rid_desc.valid = 1;
4194                 ai->config_desc.rid_desc.len = *((u16 *)pBuf);
4195                 ai->config_desc.rid_desc.rid = 0;
4196
4197                 cmd.cmd = CMD_WRITERID;
4198                 cmd.parm0 = rid;
4199
4200                 memcpy_toio(ai->config_desc.card_ram_off,
4201                         &ai->config_desc.rid_desc, sizeof(Rid));
4202
4203                 if (len < 4 || len > 2047) {
4204                         airo_print_err(ai->dev->name, "%s: len=%d", __func__, len);
4205                         rc = -1;
4206                 } else {
4207                         memcpy((char *)ai->config_desc.virtual_host_addr,
4208                                 pBuf, len);
4209
4210                         rc = issuecommand(ai, &cmd, &rsp);
4211                         if ((rc & 0xff00) != 0) {
4212                                 airo_print_err(ai->dev->name, "%s: Write rid Error %d",
4213                                                 __func__, rc);
4214                                 airo_print_err(ai->dev->name, "%s: Cmd=%04x",
4215                                                 __func__, cmd.cmd);
4216                         }
4217
4218                         if ((rsp.status & 0x7f00))
4219                                 rc = rsp.rsp0;
4220                 }
4221         } else {
4222                 // --- first access so that we can write the rid data
4223                 if ( (status = PC4500_accessrid(ai, rid, CMD_ACCESS)) != 0) {
4224                         rc = status;
4225                         goto done;
4226                 }
4227                 // --- now write the rid data
4228                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4229                         rc = ERROR;
4230                         goto done;
4231                 }
4232                 bap_write(ai, pBuf, len, BAP1);
4233                 // ---now commit the rid data
4234                 rc = PC4500_accessrid(ai, rid, 0x100|CMD_ACCESS);
4235         }
4236 done:
4237         if (lock)
4238                 up(&ai->sem);
4239         return rc;
4240 }
4241
4242 /* Allocates a FID to be used for transmitting packets.  We only use
4243    one for now. */
4244 static u16 transmit_allocate(struct airo_info *ai, int lenPayload, int raw)
4245 {
4246         unsigned int loop = 3000;
4247         Cmd cmd;
4248         Resp rsp;
4249         u16 txFid;
4250         __le16 txControl;
4251
4252         cmd.cmd = CMD_ALLOCATETX;
4253         cmd.parm0 = lenPayload;
4254         if (down_interruptible(&ai->sem))
4255                 return ERROR;
4256         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
4257                 txFid = ERROR;
4258                 goto done;
4259         }
4260         if ( (rsp.status & 0xFF00) != 0) {
4261                 txFid = ERROR;
4262                 goto done;
4263         }
4264         /* wait for the allocate event/indication
4265          * It makes me kind of nervous that this can just sit here and spin,
4266          * but in practice it only loops like four times. */
4267         while (((IN4500(ai, EVSTAT) & EV_ALLOC) == 0) && --loop);
4268         if (!loop) {
4269                 txFid = ERROR;
4270                 goto done;
4271         }
4272
4273         // get the allocated fid and acknowledge
4274         txFid = IN4500(ai, TXALLOCFID);
4275         OUT4500(ai, EVACK, EV_ALLOC);
4276
4277         /*  The CARD is pretty cool since it converts the ethernet packet
4278          *  into 802.11.  Also note that we don't release the FID since we
4279          *  will be using the same one over and over again. */
4280         /*  We only have to setup the control once since we are not
4281          *  releasing the fid. */
4282         if (raw)
4283                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_11
4284                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4285         else
4286                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_3
4287                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4288         if (bap_setup(ai, txFid, 0x0008, BAP1) != SUCCESS)
4289                 txFid = ERROR;
4290         else
4291                 bap_write(ai, &txControl, sizeof(txControl), BAP1);
4292
4293 done:
4294         up(&ai->sem);
4295
4296         return txFid;
4297 }
4298
4299 /* In general BAP1 is dedicated to transmiting packets.  However,
4300    since we need a BAP when accessing RIDs, we also use BAP1 for that.
4301    Make sure the BAP1 spinlock is held when this is called. */
4302 static int transmit_802_3_packet(struct airo_info *ai, int len, char *pPacket)
4303 {
4304         __le16 payloadLen;
4305         Cmd cmd;
4306         Resp rsp;
4307         int miclen = 0;
4308         u16 txFid = len;
4309         MICBuffer pMic;
4310
4311         len >>= 16;
4312
4313         if (len <= ETH_ALEN * 2) {
4314                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4315                 return ERROR;
4316         }
4317         len -= ETH_ALEN * 2;
4318
4319         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled && 
4320             (ntohs(((__be16 *)pPacket)[6]) != 0x888E)) {
4321                 if (encapsulate(ai,(etherHead *)pPacket,&pMic,len) != SUCCESS)
4322                         return ERROR;
4323                 miclen = sizeof(pMic);
4324         }
4325         // packet is destination[6], source[6], payload[len-12]
4326         // write the payload length and dst/src/payload
4327         if (bap_setup(ai, txFid, 0x0036, BAP1) != SUCCESS) return ERROR;
4328         /* The hardware addresses aren't counted as part of the payload, so
4329          * we have to subtract the 12 bytes for the addresses off */
4330         payloadLen = cpu_to_le16(len + miclen);
4331         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4332         bap_write(ai, (__le16*)pPacket, sizeof(etherHead), BAP1);
4333         if (miclen)
4334                 bap_write(ai, (__le16*)&pMic, miclen, BAP1);
4335         bap_write(ai, (__le16*)(pPacket + sizeof(etherHead)), len, BAP1);
4336         // issue the transmit command
4337         memset( &cmd, 0, sizeof( cmd ) );
4338         cmd.cmd = CMD_TRANSMIT;
4339         cmd.parm0 = txFid;
4340         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4341         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4342         return SUCCESS;
4343 }
4344
4345 static int transmit_802_11_packet(struct airo_info *ai, int len, char *pPacket)
4346 {
4347         __le16 fc, payloadLen;
4348         Cmd cmd;
4349         Resp rsp;
4350         int hdrlen;
4351         static u8 tail[(30-10) + 2 + 6] = {[30-10] = 6};
4352         /* padding of header to full size + le16 gaplen (6) + gaplen bytes */
4353         u16 txFid = len;
4354         len >>= 16;
4355
4356         fc = *(__le16*)pPacket;
4357         hdrlen = header_len(fc);
4358
4359         if (len < hdrlen) {
4360                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4361                 return ERROR;
4362         }
4363
4364         /* packet is 802.11 header +  payload
4365          * write the payload length and dst/src/payload */
4366         if (bap_setup(ai, txFid, 6, BAP1) != SUCCESS) return ERROR;
4367         /* The 802.11 header aren't counted as part of the payload, so
4368          * we have to subtract the header bytes off */
4369         payloadLen = cpu_to_le16(len-hdrlen);
4370         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4371         if (bap_setup(ai, txFid, 0x0014, BAP1) != SUCCESS) return ERROR;
4372         bap_write(ai, (__le16 *)pPacket, hdrlen, BAP1);
4373         bap_write(ai, (__le16 *)(tail + (hdrlen - 10)), 38 - hdrlen, BAP1);
4374
4375         bap_write(ai, (__le16 *)(pPacket + hdrlen), len - hdrlen, BAP1);
4376         // issue the transmit command
4377         memset( &cmd, 0, sizeof( cmd ) );
4378         cmd.cmd = CMD_TRANSMIT;
4379         cmd.parm0 = txFid;
4380         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4381         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4382         return SUCCESS;
4383 }
4384
4385 /*
4386  *  This is the proc_fs routines.  It is a bit messier than I would
4387  *  like!  Feel free to clean it up!
4388  */
4389
4390 static ssize_t proc_read( struct file *file,
4391                           char __user *buffer,
4392                           size_t len,
4393                           loff_t *offset);
4394
4395 static ssize_t proc_write( struct file *file,
4396                            const char __user *buffer,
4397                            size_t len,
4398                            loff_t *offset );
4399 static int proc_close( struct inode *inode, struct file *file );
4400
4401 static int proc_stats_open( struct inode *inode, struct file *file );
4402 static int proc_statsdelta_open( struct inode *inode, struct file *file );
4403 static int proc_status_open( struct inode *inode, struct file *file );
4404 static int proc_SSID_open( struct inode *inode, struct file *file );
4405 static int proc_APList_open( struct inode *inode, struct file *file );
4406 static int proc_BSSList_open( struct inode *inode, struct file *file );
4407 static int proc_config_open( struct inode *inode, struct file *file );
4408 static int proc_wepkey_open( struct inode *inode, struct file *file );
4409
4410 static const struct file_operations proc_statsdelta_ops = {
4411         .owner          = THIS_MODULE,
4412         .read           = proc_read,
4413         .open           = proc_statsdelta_open,
4414         .release        = proc_close
4415 };
4416
4417 static const struct file_operations proc_stats_ops = {
4418         .owner          = THIS_MODULE,
4419         .read           = proc_read,
4420         .open           = proc_stats_open,
4421         .release        = proc_close
4422 };
4423
4424 static const struct file_operations proc_status_ops = {
4425         .owner          = THIS_MODULE,
4426         .read           = proc_read,
4427         .open           = proc_status_open,
4428         .release        = proc_close
4429 };
4430
4431 static const struct file_operations proc_SSID_ops = {
4432         .owner          = THIS_MODULE,
4433         .read           = proc_read,
4434         .write          = proc_write,
4435         .open           = proc_SSID_open,
4436         .release        = proc_close
4437 };
4438
4439 static const struct file_operations proc_BSSList_ops = {
4440         .owner          = THIS_MODULE,
4441         .read           = proc_read,
4442         .write          = proc_write,
4443         .open           = proc_BSSList_open,
4444         .release        = proc_close
4445 };
4446
4447 static const struct file_operations proc_APList_ops = {
4448         .owner          = THIS_MODULE,
4449         .read           = proc_read,
4450         .write          = proc_write,
4451         .open           = proc_APList_open,
4452         .release        = proc_close
4453 };
4454
4455 static const struct file_operations proc_config_ops = {
4456         .owner          = THIS_MODULE,
4457         .read           = proc_read,
4458         .write          = proc_write,
4459         .open           = proc_config_open,
4460         .release        = proc_close
4461 };
4462
4463 static const struct file_operations proc_wepkey_ops = {
4464         .owner          = THIS_MODULE,
4465         .read           = proc_read,
4466         .write          = proc_write,
4467         .open           = proc_wepkey_open,
4468         .release        = proc_close
4469 };
4470
4471 static struct proc_dir_entry *airo_entry;
4472
4473 struct proc_data {
4474         int release_buffer;
4475         int readlen;
4476         char *rbuffer;
4477         int writelen;
4478         int maxwritelen;
4479         char *wbuffer;
4480         void (*on_close) (struct inode *, struct file *);
4481 };
4482
4483 static int setup_proc_entry( struct net_device *dev,
4484                              struct airo_info *apriv ) {
4485         struct proc_dir_entry *entry;
4486         /* First setup the device directory */
4487         strcpy(apriv->proc_name,dev->name);
4488         apriv->proc_entry = create_proc_entry(apriv->proc_name,
4489                                               S_IFDIR|airo_perm,
4490                                               airo_entry);
4491         if (!apriv->proc_entry)
4492                 goto fail;
4493         apriv->proc_entry->uid = proc_uid;
4494         apriv->proc_entry->gid = proc_gid;
4495
4496         /* Setup the StatsDelta */
4497         entry = proc_create_data("StatsDelta",
4498                                  S_IFREG | (S_IRUGO&proc_perm),
4499                                  apriv->proc_entry, &proc_statsdelta_ops, dev);
4500         if (!entry)
4501                 goto fail_stats_delta;
4502         entry->uid = proc_uid;
4503         entry->gid = proc_gid;
4504
4505         /* Setup the Stats */
4506         entry = proc_create_data("Stats",
4507                                  S_IFREG | (S_IRUGO&proc_perm),
4508                                  apriv->proc_entry, &proc_stats_ops, dev);
4509         if (!entry)
4510                 goto fail_stats;
4511         entry->uid = proc_uid;
4512         entry->gid = proc_gid;
4513
4514         /* Setup the Status */
4515         entry = proc_create_data("Status",
4516                                  S_IFREG | (S_IRUGO&proc_perm),
4517                                  apriv->proc_entry, &proc_status_ops, dev);
4518         if (!entry)
4519                 goto fail_status;
4520         entry->uid = proc_uid;
4521         entry->gid = proc_gid;
4522
4523         /* Setup the Config */
4524         entry = proc_create_data("Config",
4525                                  S_IFREG | proc_perm,
4526                                  apriv->proc_entry, &proc_config_ops, dev);
4527         if (!entry)
4528                 goto fail_config;
4529         entry->uid = proc_uid;
4530         entry->gid = proc_gid;
4531
4532         /* Setup the SSID */
4533         entry = proc_create_data("SSID",
4534                                  S_IFREG | proc_perm,
4535                                  apriv->proc_entry, &proc_SSID_ops, dev);
4536         if (!entry)
4537                 goto fail_ssid;
4538         entry->uid = proc_uid;
4539         entry->gid = proc_gid;
4540
4541         /* Setup the APList */
4542         entry = proc_create_data("APList",
4543                                  S_IFREG | proc_perm,
4544                                  apriv->proc_entry, &proc_APList_ops, dev);
4545         if (!entry)
4546                 goto fail_aplist;
4547         entry->uid = proc_uid;
4548         entry->gid = proc_gid;
4549
4550         /* Setup the BSSList */
4551         entry = proc_create_data("BSSList",
4552                                  S_IFREG | proc_perm,
4553                                  apriv->proc_entry, &proc_BSSList_ops, dev);
4554         if (!entry)
4555                 goto fail_bsslist;
4556         entry->uid = proc_uid;
4557         entry->gid = proc_gid;
4558
4559         /* Setup the WepKey */
4560         entry = proc_create_data("WepKey",
4561                                  S_IFREG | proc_perm,
4562                                  apriv->proc_entry, &proc_wepkey_ops, dev);
4563         if (!entry)
4564                 goto fail_wepkey;
4565         entry->uid = proc_uid;
4566         entry->gid = proc_gid;
4567
4568         return 0;
4569
4570 fail_wepkey:
4571         remove_proc_entry("BSSList", apriv->proc_entry);
4572 fail_bsslist:
4573         remove_proc_entry("APList", apriv->proc_entry);
4574 fail_aplist:
4575         remove_proc_entry("SSID", apriv->proc_entry);
4576 fail_ssid:
4577         remove_proc_entry("Config", apriv->proc_entry);
4578 fail_config:
4579         remove_proc_entry("Status", apriv->proc_entry);
4580 fail_status:
4581         remove_proc_entry("Stats", apriv->proc_entry);
4582 fail_stats:
4583         remove_proc_entry("StatsDelta", apriv->proc_entry);
4584 fail_stats_delta:
4585         remove_proc_entry(apriv->proc_name, airo_entry);
4586 fail:
4587         return -ENOMEM;
4588 }
4589
4590 static int takedown_proc_entry( struct net_device *dev,
4591                                 struct airo_info *apriv ) {
4592         if ( !apriv->proc_entry->namelen ) return 0;
4593         remove_proc_entry("Stats",apriv->proc_entry);
4594         remove_proc_entry("StatsDelta",apriv->proc_entry);
4595         remove_proc_entry("Status",apriv->proc_entry);
4596         remove_proc_entry("Config",apriv->proc_entry);
4597         remove_proc_entry("SSID",apriv->proc_entry);
4598         remove_proc_entry("APList",apriv->proc_entry);
4599         remove_proc_entry("BSSList",apriv->proc_entry);
4600         remove_proc_entry("WepKey",apriv->proc_entry);
4601         remove_proc_entry(apriv->proc_name,airo_entry);
4602         return 0;
4603 }
4604
4605 /*
4606  *  What we want from the proc_fs is to be able to efficiently read
4607  *  and write the configuration.  To do this, we want to read the
4608  *  configuration when the file is opened and write it when the file is
4609  *  closed.  So basically we allocate a read buffer at open and fill it
4610  *  with data, and allocate a write buffer and read it at close.
4611  */
4612
4613 /*
4614  *  The read routine is generic, it relies on the preallocated rbuffer
4615  *  to supply the data.
4616  */
4617 static ssize_t proc_read( struct file *file,
4618                           char __user *buffer,
4619                           size_t len,
4620                           loff_t *offset )
4621 {
4622         struct proc_data *priv = file->private_data;
4623
4624         if (!priv->rbuffer)
4625                 return -EINVAL;
4626
4627         return simple_read_from_buffer(buffer, len, offset, priv->rbuffer,
4628                                         priv->readlen);
4629 }
4630
4631 /*
4632  *  The write routine is generic, it fills in a preallocated rbuffer
4633  *  to supply the data.
4634  */
4635 static ssize_t proc_write( struct file *file,
4636                            const char __user *buffer,
4637                            size_t len,
4638                            loff_t *offset )
4639 {
4640         loff_t pos = *offset;
4641         struct proc_data *priv = (struct proc_data*)file->private_data;
4642
4643         if (!priv->wbuffer)
4644                 return -EINVAL;
4645
4646         if (pos < 0)
4647                 return -EINVAL;
4648         if (pos >= priv->maxwritelen)
4649                 return 0;
4650         if (len > priv->maxwritelen - pos)
4651                 len = priv->maxwritelen - pos;
4652         if (copy_from_user(priv->wbuffer + pos, buffer, len))
4653                 return -EFAULT;
4654         if ( pos + len > priv->writelen )
4655                 priv->writelen = len + file->f_pos;
4656         *offset = pos + len;
4657         return len;
4658 }
4659
4660 static int proc_status_open(struct inode *inode, struct file *file)
4661 {
4662         struct proc_data *data;
4663         struct proc_dir_entry *dp = PDE(inode);
4664         struct net_device *dev = dp->data;
4665         struct airo_info *apriv = dev->ml_priv;
4666         CapabilityRid cap_rid;
4667         StatusRid status_rid;
4668         u16 mode;
4669         int i;
4670
4671         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4672                 return -ENOMEM;
4673         data = (struct proc_data *)file->private_data;
4674         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4675                 kfree (file->private_data);
4676                 return -ENOMEM;
4677         }
4678
4679         readStatusRid(apriv, &status_rid, 1);
4680         readCapabilityRid(apriv, &cap_rid, 1);
4681
4682         mode = le16_to_cpu(status_rid.mode);
4683
4684         i = sprintf(data->rbuffer, "Status: %s%s%s%s%s%s%s%s%s\n",
4685                     mode & 1 ? "CFG ": "",
4686                     mode & 2 ? "ACT ": "",
4687                     mode & 0x10 ? "SYN ": "",
4688                     mode & 0x20 ? "LNK ": "",
4689                     mode & 0x40 ? "LEAP ": "",
4690                     mode & 0x80 ? "PRIV ": "",
4691                     mode & 0x100 ? "KEY ": "",
4692                     mode & 0x200 ? "WEP ": "",
4693                     mode & 0x8000 ? "ERR ": "");
4694         sprintf( data->rbuffer+i, "Mode: %x\n"
4695                  "Signal Strength: %d\n"
4696                  "Signal Quality: %d\n"
4697                  "SSID: %-.*s\n"
4698                  "AP: %-.16s\n"
4699                  "Freq: %d\n"
4700                  "BitRate: %dmbs\n"
4701                  "Driver Version: %s\n"
4702                  "Device: %s\nManufacturer: %s\nFirmware Version: %s\n"
4703                  "Radio type: %x\nCountry: %x\nHardware Version: %x\n"
4704                  "Software Version: %x\nSoftware Subversion: %x\n"
4705                  "Boot block version: %x\n",
4706                  le16_to_cpu(status_rid.mode),
4707                  le16_to_cpu(status_rid.normalizedSignalStrength),
4708                  le16_to_cpu(status_rid.signalQuality),
4709                  le16_to_cpu(status_rid.SSIDlen),
4710                  status_rid.SSID,
4711                  status_rid.apName,
4712                  le16_to_cpu(status_rid.channel),
4713                  le16_to_cpu(status_rid.currentXmitRate) / 2,
4714                  version,
4715                  cap_rid.prodName,
4716                  cap_rid.manName,
4717                  cap_rid.prodVer,
4718                  le16_to_cpu(cap_rid.radioType),
4719                  le16_to_cpu(cap_rid.country),
4720                  le16_to_cpu(cap_rid.hardVer),
4721                  le16_to_cpu(cap_rid.softVer),
4722                  le16_to_cpu(cap_rid.softSubVer),
4723                  le16_to_cpu(cap_rid.bootBlockVer));
4724         data->readlen = strlen( data->rbuffer );
4725         return 0;
4726 }
4727
4728 static int proc_stats_rid_open(struct inode*, struct file*, u16);
4729 static int proc_statsdelta_open( struct inode *inode,
4730                                  struct file *file ) {
4731         if (file->f_mode&FMODE_WRITE) {
4732                 return proc_stats_rid_open(inode, file, RID_STATSDELTACLEAR);
4733         }
4734         return proc_stats_rid_open(inode, file, RID_STATSDELTA);
4735 }
4736
4737 static int proc_stats_open( struct inode *inode, struct file *file ) {
4738         return proc_stats_rid_open(inode, file, RID_STATS);
4739 }
4740
4741 static int proc_stats_rid_open( struct inode *inode,
4742                                 struct file *file,
4743                                 u16 rid )
4744 {
4745         struct proc_data *data;
4746         struct proc_dir_entry *dp = PDE(inode);
4747         struct net_device *dev = dp->data;
4748         struct airo_info *apriv = dev->ml_priv;
4749         StatsRid stats;
4750         int i, j;
4751         __le32 *vals = stats.vals;
4752         int len;
4753
4754         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4755                 return -ENOMEM;
4756         data = (struct proc_data *)file->private_data;
4757         if ((data->rbuffer = kmalloc( 4096, GFP_KERNEL )) == NULL) {
4758                 kfree (file->private_data);
4759                 return -ENOMEM;
4760         }
4761
4762         readStatsRid(apriv, &stats, rid, 1);
4763         len = le16_to_cpu(stats.len);
4764
4765         j = 0;
4766         for(i=0; statsLabels[i]!=(char *)-1 && i*4<len; i++) {
4767                 if (!statsLabels[i]) continue;
4768                 if (j+strlen(statsLabels[i])+16>4096) {
4769                         airo_print_warn(apriv->dev->name,
4770                                "Potentially disasterous buffer overflow averted!");
4771                         break;
4772                 }
4773                 j+=sprintf(data->rbuffer+j, "%s: %u\n", statsLabels[i],
4774                                 le32_to_cpu(vals[i]));
4775         }
4776         if (i*4 >= len) {
4777                 airo_print_warn(apriv->dev->name, "Got a short rid");
4778         }
4779         data->readlen = j;
4780         return 0;
4781 }
4782
4783 static int get_dec_u16( char *buffer, int *start, int limit ) {
4784         u16 value;
4785         int valid = 0;
4786         for( value = 0; buffer[*start] >= '0' &&
4787                      buffer[*start] <= '9' &&
4788                      *start < limit; (*start)++ ) {
4789                 valid = 1;
4790                 value *= 10;
4791                 value += buffer[*start] - '0';
4792         }
4793         if ( !valid ) return -1;
4794         return value;
4795 }
4796
4797 static int airo_config_commit(struct net_device *dev,
4798                               struct iw_request_info *info, void *zwrq,
4799                               char *extra);
4800
4801 static inline int sniffing_mode(struct airo_info *ai)
4802 {
4803         return le16_to_cpu(ai->config.rmode & RXMODE_MASK) >=
4804                 le16_to_cpu(RXMODE_RFMON);
4805 }
4806
4807 static void proc_config_on_close(struct inode *inode, struct file *file)
4808 {
4809         struct proc_data *data = file->private_data;
4810         struct proc_dir_entry *dp = PDE(inode);
4811         struct net_device *dev = dp->data;
4812         struct airo_info *ai = dev->ml_priv;
4813         char *line;
4814
4815         if ( !data->writelen ) return;
4816
4817         readConfigRid(ai, 1);
4818         set_bit (FLAG_COMMIT, &ai->flags);
4819
4820         line = data->wbuffer;
4821         while( line[0] ) {
4822 /*** Mode processing */
4823                 if ( !strncmp( line, "Mode: ", 6 ) ) {
4824                         line += 6;
4825                         if (sniffing_mode(ai))
4826                                 set_bit (FLAG_RESET, &ai->flags);
4827                         ai->config.rmode &= ~RXMODE_FULL_MASK;
4828                         clear_bit (FLAG_802_11, &ai->flags);
4829                         ai->config.opmode &= ~MODE_CFG_MASK;
4830                         ai->config.scanMode = SCANMODE_ACTIVE;
4831                         if ( line[0] == 'a' ) {
4832                                 ai->config.opmode |= MODE_STA_IBSS;
4833                         } else {
4834                                 ai->config.opmode |= MODE_STA_ESS;
4835                                 if ( line[0] == 'r' ) {
4836                                         ai->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
4837                                         ai->config.scanMode = SCANMODE_PASSIVE;
4838                                         set_bit (FLAG_802_11, &ai->flags);
4839                                 } else if ( line[0] == 'y' ) {
4840                                         ai->config.rmode |= RXMODE_RFMON_ANYBSS | RXMODE_DISABLE_802_3_HEADER;
4841                                         ai->config.scanMode = SCANMODE_PASSIVE;
4842                                         set_bit (FLAG_802_11, &ai->flags);
4843                                 } else if ( line[0] == 'l' )
4844                                         ai->config.rmode |= RXMODE_LANMON;
4845                         }
4846                         set_bit (FLAG_COMMIT, &ai->flags);
4847                 }
4848
4849 /*** Radio status */
4850                 else if (!strncmp(line,"Radio: ", 7)) {
4851                         line += 7;
4852                         if (!strncmp(line,"off",3)) {
4853                                 set_bit (FLAG_RADIO_OFF, &ai->flags);
4854                         } else {
4855                                 clear_bit (FLAG_RADIO_OFF, &ai->flags);
4856                         }
4857                 }
4858 /*** NodeName processing */
4859                 else if ( !strncmp( line, "NodeName: ", 10 ) ) {
4860                         int j;
4861
4862                         line += 10;
4863                         memset( ai->config.nodeName, 0, 16 );
4864 /* Do the name, assume a space between the mode and node name */
4865                         for( j = 0; j < 16 && line[j] != '\n'; j++ ) {
4866                                 ai->config.nodeName[j] = line[j];
4867                         }
4868                         set_bit (FLAG_COMMIT, &ai->flags);
4869                 }
4870
4871 /*** PowerMode processing */
4872                 else if ( !strncmp( line, "PowerMode: ", 11 ) ) {
4873                         line += 11;
4874                         if ( !strncmp( line, "PSPCAM", 6 ) ) {
4875                                 ai->config.powerSaveMode = POWERSAVE_PSPCAM;
4876                                 set_bit (FLAG_COMMIT, &ai->flags);
4877                         } else if ( !strncmp( line, "PSP", 3 ) ) {
4878                                 ai->config.powerSaveMode = POWERSAVE_PSP;
4879                                 set_bit (FLAG_COMMIT, &ai->flags);
4880                         } else {
4881                                 ai->config.powerSaveMode = POWERSAVE_CAM;
4882                                 set_bit (FLAG_COMMIT, &ai->flags);
4883                         }
4884                 } else if ( !strncmp( line, "DataRates: ", 11 ) ) {
4885                         int v, i = 0, k = 0; /* i is index into line,
4886                                                 k is index to rates */
4887
4888                         line += 11;
4889                         while((v = get_dec_u16(line, &i, 3))!=-1) {
4890                                 ai->config.rates[k++] = (u8)v;
4891                                 line += i + 1;
4892                                 i = 0;
4893                         }
4894                         set_bit (FLAG_COMMIT, &ai->flags);
4895                 } else if ( !strncmp( line, "Channel: ", 9 ) ) {
4896                         int v, i = 0;
4897                         line += 9;
4898                         v = get_dec_u16(line, &i, i+3);
4899                         if ( v != -1 ) {
4900                                 ai->config.channelSet = cpu_to_le16(v);
4901                                 set_bit (FLAG_COMMIT, &ai->flags);
4902                         }
4903                 } else if ( !strncmp( line, "XmitPower: ", 11 ) ) {
4904                         int v, i = 0;
4905                         line += 11;
4906                         v = get_dec_u16(line, &i, i+3);
4907                         if ( v != -1 ) {
4908                                 ai->config.txPower = cpu_to_le16(v);
4909                                 set_bit (FLAG_COMMIT, &ai->flags);
4910                         }
4911                 } else if ( !strncmp( line, "WEP: ", 5 ) ) {
4912                         line += 5;
4913                         switch( line[0] ) {
4914                         case 's':
4915                                 ai->config.authType = AUTH_SHAREDKEY;
4916                                 break;
4917                         case 'e':
4918                                 ai->config.authType = AUTH_ENCRYPT;
4919                                 break;
4920                         default:
4921                                 ai->config.authType = AUTH_OPEN;
4922                                 break;
4923                         }
4924                         set_bit (FLAG_COMMIT, &ai->flags);
4925                 } else if ( !strncmp( line, "LongRetryLimit: ", 16 ) ) {
4926                         int v, i = 0;
4927
4928                         line += 16;
4929                         v = get_dec_u16(line, &i, 3);
4930                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4931                         ai->config.longRetryLimit = cpu_to_le16(v);
4932                         set_bit (FLAG_COMMIT, &ai->flags);
4933                 } else if ( !strncmp( line, "ShortRetryLimit: ", 17 ) ) {
4934                         int v, i = 0;
4935
4936                         line += 17;
4937                         v = get_dec_u16(line, &i, 3);
4938                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4939                         ai->config.shortRetryLimit = cpu_to_le16(v);
4940                         set_bit (FLAG_COMMIT, &ai->flags);
4941                 } else if ( !strncmp( line, "RTSThreshold: ", 14 ) ) {
4942                         int v, i = 0;
4943
4944                         line += 14;
4945                         v = get_dec_u16(line, &i, 4);
4946                         v = (v<0) ? 0 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4947                         ai->config.rtsThres = cpu_to_le16(v);
4948                         set_bit (FLAG_COMMIT, &ai->flags);
4949                 } else if ( !strncmp( line, "TXMSDULifetime: ", 16 ) ) {
4950                         int v, i = 0;
4951
4952                         line += 16;
4953                         v = get_dec_u16(line, &i, 5);
4954                         v = (v<0) ? 0 : v;
4955                         ai->config.txLifetime = cpu_to_le16(v);
4956                         set_bit (FLAG_COMMIT, &ai->flags);
4957                 } else if ( !strncmp( line, "RXMSDULifetime: ", 16 ) ) {
4958                         int v, i = 0;
4959
4960                         line += 16;
4961                         v = get_dec_u16(line, &i, 5);
4962                         v = (v<0) ? 0 : v;
4963                         ai->config.rxLifetime = cpu_to_le16(v);
4964                         set_bit (FLAG_COMMIT, &ai->flags);
4965                 } else if ( !strncmp( line, "TXDiversity: ", 13 ) ) {
4966                         ai->config.txDiversity =
4967                                 (line[13]=='l') ? 1 :
4968                                 ((line[13]=='r')? 2: 3);
4969                         set_bit (FLAG_COMMIT, &ai->flags);
4970                 } else if ( !strncmp( line, "RXDiversity: ", 13 ) ) {
4971                         ai->config.rxDiversity =
4972                                 (line[13]=='l') ? 1 :
4973                                 ((line[13]=='r')? 2: 3);
4974                         set_bit (FLAG_COMMIT, &ai->flags);
4975                 } else if ( !strncmp( line, "FragThreshold: ", 15 ) ) {
4976                         int v, i = 0;
4977
4978                         line += 15;
4979                         v = get_dec_u16(line, &i, 4);
4980                         v = (v<256) ? 256 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4981                         v = v & 0xfffe; /* Make sure its even */
4982                         ai->config.fragThresh = cpu_to_le16(v);
4983                         set_bit (FLAG_COMMIT, &ai->flags);
4984                 } else if (!strncmp(line, "Modulation: ", 12)) {
4985                         line += 12;
4986                         switch(*line) {
4987                         case 'd':  ai->config.modulation=MOD_DEFAULT; set_bit(FLAG_COMMIT, &ai->flags); break;
4988                         case 'c':  ai->config.modulation=MOD_CCK; set_bit(FLAG_COMMIT, &ai->flags); break;
4989                         case 'm':  ai->config.modulation=MOD_MOK; set_bit(FLAG_COMMIT, &ai->flags); break;
4990                         default: airo_print_warn(ai->dev->name, "Unknown modulation");
4991                         }
4992                 } else if (!strncmp(line, "Preamble: ", 10)) {
4993                         line += 10;
4994                         switch(*line) {
4995                         case 'a': ai->config.preamble=PREAMBLE_AUTO; set_bit(FLAG_COMMIT, &ai->flags); break;
4996                         case 'l': ai->config.preamble=PREAMBLE_LONG; set_bit(FLAG_COMMIT, &ai->flags); break;
4997                         case 's': ai->config.preamble=PREAMBLE_SHORT; set_bit(FLAG_COMMIT, &ai->flags); break;
4998                         default: airo_print_warn(ai->dev->name, "Unknown preamble");
4999                         }
5000                 } else {
5001                         airo_print_warn(ai->dev->name, "Couldn't figure out %s", line);
5002                 }
5003                 while( line[0] && line[0] != '\n' ) line++;
5004                 if ( line[0] ) line++;
5005         }
5006         airo_config_commit(dev, NULL, NULL, NULL);
5007 }
5008
5009 static char *get_rmode(__le16 mode)
5010 {
5011         switch(mode & RXMODE_MASK) {
5012         case RXMODE_RFMON:  return "rfmon";
5013         case RXMODE_RFMON_ANYBSS:  return "yna (any) bss rfmon";
5014         case RXMODE_LANMON:  return "lanmon";
5015         }
5016         return "ESS";
5017 }
5018
5019 static int proc_config_open(struct inode *inode, struct file *file)
5020 {
5021         struct proc_data *data;
5022         struct proc_dir_entry *dp = PDE(inode);
5023         struct net_device *dev = dp->data;
5024         struct airo_info *ai = dev->ml_priv;
5025         int i;
5026         __le16 mode;
5027
5028         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5029                 return -ENOMEM;
5030         data = (struct proc_data *)file->private_data;
5031         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
5032                 kfree (file->private_data);
5033                 return -ENOMEM;
5034         }
5035         if ((data->wbuffer = kzalloc( 2048, GFP_KERNEL )) == NULL) {
5036                 kfree (data->rbuffer);
5037                 kfree (file->private_data);
5038                 return -ENOMEM;
5039         }
5040         data->maxwritelen = 2048;
5041         data->on_close = proc_config_on_close;
5042
5043         readConfigRid(ai, 1);
5044
5045         mode = ai->config.opmode & MODE_CFG_MASK;
5046         i = sprintf( data->rbuffer,
5047                      "Mode: %s\n"
5048                      "Radio: %s\n"
5049                      "NodeName: %-16s\n"
5050                      "PowerMode: %s\n"
5051                      "DataRates: %d %d %d %d %d %d %d %d\n"
5052                      "Channel: %d\n"
5053                      "XmitPower: %d\n",
5054                      mode == MODE_STA_IBSS ? "adhoc" :
5055                      mode == MODE_STA_ESS ? get_rmode(ai->config.rmode):
5056                      mode == MODE_AP ? "AP" :
5057                      mode == MODE_AP_RPTR ? "AP RPTR" : "Error",
5058                      test_bit(FLAG_RADIO_OFF, &ai->flags) ? "off" : "on",
5059                      ai->config.nodeName,
5060                      ai->config.powerSaveMode == POWERSAVE_CAM ? "CAM" :
5061                      ai->config.powerSaveMode == POWERSAVE_PSP ? "PSP" :
5062                      ai->config.powerSaveMode == POWERSAVE_PSPCAM ? "PSPCAM" :
5063                      "Error",
5064                      (int)ai->config.rates[0],
5065                      (int)ai->config.rates[1],
5066                      (int)ai->config.rates[2],
5067                      (int)ai->config.rates[3],
5068                      (int)ai->config.rates[4],
5069                      (int)ai->config.rates[5],
5070                      (int)ai->config.rates[6],
5071                      (int)ai->config.rates[7],
5072                      le16_to_cpu(ai->config.channelSet),
5073                      le16_to_cpu(ai->config.txPower)
5074                 );
5075         sprintf( data->rbuffer + i,
5076                  "LongRetryLimit: %d\n"
5077                  "ShortRetryLimit: %d\n"
5078                  "RTSThreshold: %d\n"
5079                  "TXMSDULifetime: %d\n"
5080                  "RXMSDULifetime: %d\n"
5081                  "TXDiversity: %s\n"
5082                  "RXDiversity: %s\n"
5083                  "FragThreshold: %d\n"
5084                  "WEP: %s\n"
5085                  "Modulation: %s\n"
5086                  "Preamble: %s\n",
5087                  le16_to_cpu(ai->config.longRetryLimit),
5088                  le16_to_cpu(ai->config.shortRetryLimit),
5089                  le16_to_cpu(ai->config.rtsThres),
5090                  le16_to_cpu(ai->config.txLifetime),
5091                  le16_to_cpu(ai->config.rxLifetime),
5092                  ai->config.txDiversity == 1 ? "left" :
5093                  ai->config.txDiversity == 2 ? "right" : "both",
5094                  ai->config.rxDiversity == 1 ? "left" :
5095                  ai->config.rxDiversity == 2 ? "right" : "both",
5096                  le16_to_cpu(ai->config.fragThresh),
5097                  ai->config.authType == AUTH_ENCRYPT ? "encrypt" :
5098                  ai->config.authType == AUTH_SHAREDKEY ? "shared" : "open",
5099                  ai->config.modulation == MOD_DEFAULT ? "default" :
5100                  ai->config.modulation == MOD_CCK ? "cck" :
5101                  ai->config.modulation == MOD_MOK ? "mok" : "error",
5102                  ai->config.preamble == PREAMBLE_AUTO ? "auto" :
5103                  ai->config.preamble == PREAMBLE_LONG ? "long" :
5104                  ai->config.preamble == PREAMBLE_SHORT ? "short" : "error"
5105                 );
5106         data->readlen = strlen( data->rbuffer );
5107         return 0;
5108 }
5109
5110 static void proc_SSID_on_close(struct inode *inode, struct file *file)
5111 {
5112         struct proc_data *data = (struct proc_data *)file->private_data;
5113         struct proc_dir_entry *dp = PDE(inode);
5114         struct net_device *dev = dp->data;
5115         struct airo_info *ai = dev->ml_priv;
5116         SsidRid SSID_rid;
5117         int i;
5118         char *p = data->wbuffer;
5119         char *end = p + data->writelen;
5120
5121         if (!data->writelen)
5122                 return;
5123
5124         *end = '\n'; /* sentinel; we have space for it */
5125
5126         memset(&SSID_rid, 0, sizeof(SSID_rid));
5127
5128         for (i = 0; i < 3 && p < end; i++) {
5129                 int j = 0;
5130                 /* copy up to 32 characters from this line */
5131                 while (*p != '\n' && j < 32)
5132                         SSID_rid.ssids[i].ssid[j++] = *p++;
5133                 if (j == 0)
5134                         break;
5135                 SSID_rid.ssids[i].len = cpu_to_le16(j);
5136                 /* skip to the beginning of the next line */
5137                 while (*p++ != '\n')
5138                         ;
5139         }
5140         if (i)
5141                 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5142         disable_MAC(ai, 1);
5143         writeSsidRid(ai, &SSID_rid, 1);
5144         enable_MAC(ai, 1);
5145 }
5146
5147 static inline u8 hexVal(char c) {
5148         if (c>='0' && c<='9') return c -= '0';
5149         if (c>='a' && c<='f') return c -= 'a'-10;
5150         if (c>='A' && c<='F') return c -= 'A'-10;
5151         return 0;
5152 }
5153
5154 static void proc_APList_on_close( struct inode *inode, struct file *file ) {
5155         struct proc_data *data = (struct proc_data *)file->private_data;
5156         struct proc_dir_entry *dp = PDE(inode);
5157         struct net_device *dev = dp->data;
5158         struct airo_info *ai = dev->ml_priv;
5159         APListRid APList_rid;
5160         int i;
5161
5162         if ( !data->writelen ) return;
5163
5164         memset( &APList_rid, 0, sizeof(APList_rid) );
5165         APList_rid.len = cpu_to_le16(sizeof(APList_rid));
5166
5167         for( i = 0; i < 4 && data->writelen >= (i+1)*6*3; i++ ) {
5168                 int j;
5169                 for( j = 0; j < 6*3 && data->wbuffer[j+i*6*3]; j++ ) {
5170                         switch(j%3) {
5171                         case 0:
5172                                 APList_rid.ap[i][j/3]=
5173                                         hexVal(data->wbuffer[j+i*6*3])<<4;
5174                                 break;
5175                         case 1:
5176                                 APList_rid.ap[i][j/3]|=
5177                                         hexVal(data->wbuffer[j+i*6*3]);
5178                                 break;
5179                         }
5180                 }
5181         }
5182         disable_MAC(ai, 1);
5183         writeAPListRid(ai, &APList_rid, 1);
5184         enable_MAC(ai, 1);
5185 }
5186
5187 /* This function wraps PC4500_writerid with a MAC disable */
5188 static int do_writerid( struct airo_info *ai, u16 rid, const void *rid_data,
5189                         int len, int dummy ) {
5190         int rc;
5191
5192         disable_MAC(ai, 1);
5193         rc = PC4500_writerid(ai, rid, rid_data, len, 1);
5194         enable_MAC(ai, 1);
5195         return rc;
5196 }
5197
5198 /* Returns the WEP key at the specified index, or -1 if that key does
5199  * not exist.  The buffer is assumed to be at least 16 bytes in length.
5200  */
5201 static int get_wep_key(struct airo_info *ai, u16 index, char *buf, u16 buflen)
5202 {
5203         WepKeyRid wkr;
5204         int rc;
5205         __le16 lastindex;
5206
5207         rc = readWepKeyRid(ai, &wkr, 1, 1);
5208         if (rc != SUCCESS)
5209                 return -1;
5210         do {
5211                 lastindex = wkr.kindex;
5212                 if (le16_to_cpu(wkr.kindex) == index) {
5213                         int klen = min_t(int, buflen, le16_to_cpu(wkr.klen));
5214                         memcpy(buf, wkr.key, klen);
5215                         return klen;
5216                 }
5217                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5218                 if (rc != SUCCESS)
5219                         return -1;
5220         } while (lastindex != wkr.kindex);
5221         return -1;
5222 }
5223
5224 static int get_wep_tx_idx(struct airo_info *ai)
5225 {
5226         WepKeyRid wkr;
5227         int rc;
5228         __le16 lastindex;
5229
5230         rc = readWepKeyRid(ai, &wkr, 1, 1);
5231         if (rc != SUCCESS)
5232                 return -1;
5233         do {
5234                 lastindex = wkr.kindex;
5235                 if (wkr.kindex == cpu_to_le16(0xffff))
5236                         return wkr.mac[0];
5237                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5238                 if (rc != SUCCESS)
5239                         return -1;
5240         } while (lastindex != wkr.kindex);
5241         return -1;
5242 }
5243
5244 static int set_wep_key(struct airo_info *ai, u16 index, const char *key,
5245                        u16 keylen, int perm, int lock)
5246 {
5247         static const unsigned char macaddr[ETH_ALEN] = { 0x01, 0, 0, 0, 0, 0 };
5248         WepKeyRid wkr;
5249         int rc;
5250
5251         if (keylen == 0) {
5252                 airo_print_err(ai->dev->name, "%s: key length to set was zero",
5253                                __func__);
5254                 return -1;
5255         }
5256
5257         memset(&wkr, 0, sizeof(wkr));
5258         wkr.len = cpu_to_le16(sizeof(wkr));
5259         wkr.kindex = cpu_to_le16(index);
5260         wkr.klen = cpu_to_le16(keylen);
5261         memcpy(wkr.key, key, keylen);
5262         memcpy(wkr.mac, macaddr, ETH_ALEN);
5263
5264         if (perm) disable_MAC(ai, lock);
5265         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5266         if (perm) enable_MAC(ai, lock);
5267         return rc;
5268 }
5269
5270 static int set_wep_tx_idx(struct airo_info *ai, u16 index, int perm, int lock)
5271 {
5272         WepKeyRid wkr;
5273         int rc;
5274
5275         memset(&wkr, 0, sizeof(wkr));
5276         wkr.len = cpu_to_le16(sizeof(wkr));
5277         wkr.kindex = cpu_to_le16(0xffff);
5278         wkr.mac[0] = (char)index;
5279
5280         if (perm) {
5281                 ai->defindex = (char)index;
5282                 disable_MAC(ai, lock);
5283         }
5284
5285         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5286
5287         if (perm)
5288                 enable_MAC(ai, lock);
5289         return rc;
5290 }
5291
5292 static void proc_wepkey_on_close( struct inode *inode, struct file *file ) {
5293         struct proc_data *data;
5294         struct proc_dir_entry *dp = PDE(inode);
5295         struct net_device *dev = dp->data;
5296         struct airo_info *ai = dev->ml_priv;
5297         int i, rc;
5298         char key[16];
5299         u16 index = 0;
5300         int j = 0;
5301
5302         memset(key, 0, sizeof(key));
5303
5304         data = (struct proc_data *)file->private_data;
5305         if ( !data->writelen ) return;
5306
5307         if (data->wbuffer[0] >= '0' && data->wbuffer[0] <= '3' &&
5308             (data->wbuffer[1] == ' ' || data->wbuffer[1] == '\n')) {
5309                 index = data->wbuffer[0] - '0';
5310                 if (data->wbuffer[1] == '\n') {
5311                         rc = set_wep_tx_idx(ai, index, 1, 1);
5312                         if (rc < 0) {
5313                                 airo_print_err(ai->dev->name, "failed to set "
5314                                                "WEP transmit index to %d: %d.",
5315                                                index, rc);
5316                         }
5317                         return;
5318                 }
5319                 j = 2;
5320         } else {
5321                 airo_print_err(ai->dev->name, "WepKey passed invalid key index");
5322                 return;
5323         }
5324
5325         for( i = 0; i < 16*3 && data->wbuffer[i+j]; i++ ) {
5326                 switch(i%3) {
5327                 case 0:
5328                         key[i/3] = hexVal(data->wbuffer[i+j])<<4;
5329                         break;
5330                 case 1:
5331                         key[i/3] |= hexVal(data->wbuffer[i+j]);
5332                         break;
5333                 }
5334         }
5335
5336         rc = set_wep_key(ai, index, key, i/3, 1, 1);
5337         if (rc < 0) {
5338                 airo_print_err(ai->dev->name, "failed to set WEP key at index "
5339                                "%d: %d.", index, rc);
5340         }
5341 }
5342
5343 static int proc_wepkey_open( struct inode *inode, struct file *file )
5344 {
5345         struct proc_data *data;
5346         struct proc_dir_entry *dp = PDE(inode);
5347         struct net_device *dev = dp->data;
5348         struct airo_info *ai = dev->ml_priv;
5349         char *ptr;
5350         WepKeyRid wkr;
5351         __le16 lastindex;
5352         int j=0;
5353         int rc;
5354
5355         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5356                 return -ENOMEM;
5357         memset(&wkr, 0, sizeof(wkr));
5358         data = (struct proc_data *)file->private_data;
5359         if ((data->rbuffer = kzalloc( 180, GFP_KERNEL )) == NULL) {
5360                 kfree (file->private_data);
5361                 return -ENOMEM;
5362         }
5363         data->writelen = 0;
5364         data->maxwritelen = 80;
5365         if ((data->wbuffer = kzalloc( 80, GFP_KERNEL )) == NULL) {
5366                 kfree (data->rbuffer);
5367                 kfree (file->private_data);
5368                 return -ENOMEM;
5369         }
5370         data->on_close = proc_wepkey_on_close;
5371
5372         ptr = data->rbuffer;
5373         strcpy(ptr, "No wep keys\n");
5374         rc = readWepKeyRid(ai, &wkr, 1, 1);
5375         if (rc == SUCCESS) do {
5376                 lastindex = wkr.kindex;
5377                 if (wkr.kindex == cpu_to_le16(0xffff)) {
5378                         j += sprintf(ptr+j, "Tx key = %d\n",
5379                                      (int)wkr.mac[0]);
5380                 } else {
5381                         j += sprintf(ptr+j, "Key %d set with length = %d\n",
5382                                      le16_to_cpu(wkr.kindex),
5383                                      le16_to_cpu(wkr.klen));
5384                 }
5385                 readWepKeyRid(ai, &wkr, 0, 1);
5386         } while((lastindex != wkr.kindex) && (j < 180-30));
5387
5388         data->readlen = strlen( data->rbuffer );
5389         return 0;
5390 }
5391
5392 static int proc_SSID_open(struct inode *inode, struct file *file)
5393 {
5394         struct proc_data *data;
5395         struct proc_dir_entry *dp = PDE(inode);
5396         struct net_device *dev = dp->data;
5397         struct airo_info *ai = dev->ml_priv;
5398         int i;
5399         char *ptr;
5400         SsidRid SSID_rid;
5401
5402         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5403                 return -ENOMEM;
5404         data = (struct proc_data *)file->private_data;
5405         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5406                 kfree (file->private_data);
5407                 return -ENOMEM;
5408         }
5409         data->writelen = 0;
5410         data->maxwritelen = 33*3;
5411         /* allocate maxwritelen + 1; we'll want a sentinel */
5412         if ((data->wbuffer = kzalloc(33*3 + 1, GFP_KERNEL)) == NULL) {
5413                 kfree (data->rbuffer);
5414                 kfree (file->private_data);
5415                 return -ENOMEM;
5416         }
5417         data->on_close = proc_SSID_on_close;
5418
5419         readSsidRid(ai, &SSID_rid);
5420         ptr = data->rbuffer;
5421         for (i = 0; i < 3; i++) {
5422                 int j;
5423                 size_t len = le16_to_cpu(SSID_rid.ssids[i].len);
5424                 if (!len)
5425                         break;
5426                 if (len > 32)
5427                         len = 32;
5428                 for (j = 0; j < len && SSID_rid.ssids[i].ssid[j]; j++)
5429                         *ptr++ = SSID_rid.ssids[i].ssid[j];
5430                 *ptr++ = '\n';
5431         }
5432         *ptr = '\0';
5433         data->readlen = strlen( data->rbuffer );
5434         return 0;
5435 }
5436
5437 static int proc_APList_open( struct inode *inode, struct file *file ) {
5438         struct proc_data *data;
5439         struct proc_dir_entry *dp = PDE(inode);
5440         struct net_device *dev = dp->data;
5441         struct airo_info *ai = dev->ml_priv;
5442         int i;
5443         char *ptr;
5444         APListRid APList_rid;
5445
5446         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5447                 return -ENOMEM;
5448         data = (struct proc_data *)file->private_data;
5449         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5450                 kfree (file->private_data);
5451                 return -ENOMEM;
5452         }
5453         data->writelen = 0;
5454         data->maxwritelen = 4*6*3;
5455         if ((data->wbuffer = kzalloc( data->maxwritelen, GFP_KERNEL )) == NULL) {
5456                 kfree (data->rbuffer);
5457                 kfree (file->private_data);
5458                 return -ENOMEM;
5459         }
5460         data->on_close = proc_APList_on_close;
5461
5462         readAPListRid(ai, &APList_rid);
5463         ptr = data->rbuffer;
5464         for( i = 0; i < 4; i++ ) {
5465 // We end when we find a zero MAC
5466                 if ( !*(int*)APList_rid.ap[i] &&
5467                      !*(int*)&APList_rid.ap[i][2]) break;
5468                 ptr += sprintf(ptr, "%pM\n", APList_rid.ap[i]);
5469         }
5470         if (i==0) ptr += sprintf(ptr, "Not using specific APs\n");
5471
5472         *ptr = '\0';
5473         data->readlen = strlen( data->rbuffer );
5474         return 0;
5475 }
5476
5477 static int proc_BSSList_open( struct inode *inode, struct file *file ) {
5478         struct proc_data *data;
5479         struct proc_dir_entry *dp = PDE(inode);
5480         struct net_device *dev = dp->data;
5481         struct airo_info *ai = dev->ml_priv;
5482         char *ptr;
5483         BSSListRid BSSList_rid;
5484         int rc;
5485         /* If doLoseSync is not 1, we won't do a Lose Sync */
5486         int doLoseSync = -1;
5487
5488         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5489                 return -ENOMEM;
5490         data = (struct proc_data *)file->private_data;
5491         if ((data->rbuffer = kmalloc( 1024, GFP_KERNEL )) == NULL) {
5492                 kfree (file->private_data);
5493                 return -ENOMEM;
5494         }
5495         data->writelen = 0;
5496         data->maxwritelen = 0;
5497         data->wbuffer = NULL;
5498         data->on_close = NULL;
5499
5500         if (file->f_mode & FMODE_WRITE) {
5501                 if (!(file->f_mode & FMODE_READ)) {
5502                         Cmd cmd;
5503                         Resp rsp;
5504
5505                         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
5506                         memset(&cmd, 0, sizeof(cmd));
5507                         cmd.cmd=CMD_LISTBSS;
5508                         if (down_interruptible(&ai->sem))
5509                                 return -ERESTARTSYS;
5510                         issuecommand(ai, &cmd, &rsp);
5511                         up(&ai->sem);
5512                         data->readlen = 0;
5513                         return 0;
5514                 }
5515                 doLoseSync = 1;
5516         }
5517         ptr = data->rbuffer;
5518         /* There is a race condition here if there are concurrent opens.
5519            Since it is a rare condition, we'll just live with it, otherwise
5520            we have to add a spin lock... */
5521         rc = readBSSListRid(ai, doLoseSync, &BSSList_rid);
5522         while(rc == 0 && BSSList_rid.index != cpu_to_le16(0xffff)) {
5523                 ptr += sprintf(ptr, "%pM %*s rssi = %d",
5524                                BSSList_rid.bssid,
5525                                 (int)BSSList_rid.ssidLen,
5526                                 BSSList_rid.ssid,
5527                                 le16_to_cpu(BSSList_rid.dBm));
5528                 ptr += sprintf(ptr, " channel = %d %s %s %s %s\n",
5529                                 le16_to_cpu(BSSList_rid.dsChannel),
5530                                 BSSList_rid.cap & CAP_ESS ? "ESS" : "",
5531                                 BSSList_rid.cap & CAP_IBSS ? "adhoc" : "",
5532                                 BSSList_rid.cap & CAP_PRIVACY ? "wep" : "",
5533                                 BSSList_rid.cap & CAP_SHORTHDR ? "shorthdr" : "");
5534                 rc = readBSSListRid(ai, 0, &BSSList_rid);
5535         }
5536         *ptr = '\0';
5537         data->readlen = strlen( data->rbuffer );
5538         return 0;
5539 }
5540
5541 static int proc_close( struct inode *inode, struct file *file )
5542 {
5543         struct proc_data *data = file->private_data;
5544
5545         if (data->on_close != NULL)
5546                 data->on_close(inode, file);
5547         kfree(data->rbuffer);
5548         kfree(data->wbuffer);
5549         kfree(data);
5550         return 0;
5551 }
5552
5553 /* Since the card doesn't automatically switch to the right WEP mode,
5554    we will make it do it.  If the card isn't associated, every secs we
5555    will switch WEP modes to see if that will help.  If the card is
5556    associated we will check every minute to see if anything has
5557    changed. */
5558 static void timer_func( struct net_device *dev ) {
5559         struct airo_info *apriv = dev->ml_priv;
5560
5561 /* We don't have a link so try changing the authtype */
5562         readConfigRid(apriv, 0);
5563         disable_MAC(apriv, 0);
5564         switch(apriv->config.authType) {
5565                 case AUTH_ENCRYPT:
5566 /* So drop to OPEN */
5567                         apriv->config.authType = AUTH_OPEN;
5568                         break;
5569                 case AUTH_SHAREDKEY:
5570                         if (apriv->keyindex < auto_wep) {
5571                                 set_wep_tx_idx(apriv, apriv->keyindex, 0, 0);
5572                                 apriv->config.authType = AUTH_SHAREDKEY;
5573                                 apriv->keyindex++;
5574                         } else {
5575                                 /* Drop to ENCRYPT */
5576                                 apriv->keyindex = 0;
5577                                 set_wep_tx_idx(apriv, apriv->defindex, 0, 0);
5578                                 apriv->config.authType = AUTH_ENCRYPT;
5579                         }
5580                         break;
5581                 default:  /* We'll escalate to SHAREDKEY */
5582                         apriv->config.authType = AUTH_SHAREDKEY;
5583         }
5584         set_bit (FLAG_COMMIT, &apriv->flags);
5585         writeConfigRid(apriv, 0);
5586         enable_MAC(apriv, 0);
5587         up(&apriv->sem);
5588
5589 /* Schedule check to see if the change worked */
5590         clear_bit(JOB_AUTOWEP, &apriv->jobs);
5591         apriv->expires = RUN_AT(HZ*3);
5592 }
5593
5594 #ifdef CONFIG_PCI
5595 static int __devinit airo_pci_probe(struct pci_dev *pdev,
5596                                     const struct pci_device_id *pent)
5597 {
5598         struct net_device *dev;
5599
5600         if (pci_enable_device(pdev))
5601                 return -ENODEV;
5602         pci_set_master(pdev);
5603
5604         if (pdev->device == 0x5000 || pdev->device == 0xa504)
5605                         dev = _init_airo_card(pdev->irq, pdev->resource[0].start, 0, pdev, &pdev->dev);
5606         else
5607                         dev = _init_airo_card(pdev->irq, pdev->resource[2].start, 0, pdev, &pdev->dev);
5608         if (!dev) {
5609                 pci_disable_device(pdev);
5610                 return -ENODEV;
5611         }
5612
5613         pci_set_drvdata(pdev, dev);
5614         return 0;
5615 }
5616
5617 static void __devexit airo_pci_remove(struct pci_dev *pdev)
5618 {
5619         struct net_device *dev = pci_get_drvdata(pdev);
5620
5621         airo_print_info(dev->name, "Unregistering...");
5622         stop_airo_card(dev, 1);
5623         pci_disable_device(pdev);
5624         pci_set_drvdata(pdev, NULL);
5625 }
5626
5627 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state)
5628 {
5629         struct net_device *dev = pci_get_drvdata(pdev);
5630         struct airo_info *ai = dev->ml_priv;
5631         Cmd cmd;
5632         Resp rsp;
5633
5634         if (!ai->APList)
5635                 ai->APList = kmalloc(sizeof(APListRid), GFP_KERNEL);
5636         if (!ai->APList)
5637                 return -ENOMEM;
5638         if (!ai->SSID)
5639                 ai->SSID = kmalloc(sizeof(SsidRid), GFP_KERNEL);
5640         if (!ai->SSID)
5641                 return -ENOMEM;
5642         readAPListRid(ai, ai->APList);
5643         readSsidRid(ai, ai->SSID);
5644         memset(&cmd, 0, sizeof(cmd));
5645         /* the lock will be released at the end of the resume callback */
5646         if (down_interruptible(&ai->sem))
5647                 return -EAGAIN;
5648         disable_MAC(ai, 0);
5649         netif_device_detach(dev);
5650         ai->power = state;
5651         cmd.cmd = HOSTSLEEP;
5652         issuecommand(ai, &cmd, &rsp);
5653
5654         pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
5655         pci_save_state(pdev);
5656         return pci_set_power_state(pdev, pci_choose_state(pdev, state));
5657 }
5658
5659 static int airo_pci_resume(struct pci_dev *pdev)
5660 {
5661         struct net_device *dev = pci_get_drvdata(pdev);
5662         struct airo_info *ai = dev->ml_priv;
5663         pci_power_t prev_state = pdev->current_state;
5664
5665         pci_set_power_state(pdev, PCI_D0);
5666         pci_restore_state(pdev);
5667         pci_enable_wake(pdev, PCI_D0, 0);
5668
5669         if (prev_state != PCI_D1) {
5670                 reset_card(dev, 0);
5671                 mpi_init_descriptors(ai);
5672                 setup_card(ai, dev->dev_addr, 0);
5673                 clear_bit(FLAG_RADIO_OFF, &ai->flags);
5674                 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
5675         } else {
5676                 OUT4500(ai, EVACK, EV_AWAKEN);
5677                 OUT4500(ai, EVACK, EV_AWAKEN);
5678                 msleep(100);
5679         }
5680
5681         set_bit(FLAG_COMMIT, &ai->flags);
5682         disable_MAC(ai, 0);
5683         msleep(200);
5684         if (ai->SSID) {
5685                 writeSsidRid(ai, ai->SSID, 0);
5686                 kfree(ai->SSID);
5687                 ai->SSID = NULL;
5688         }
5689         if (ai->APList) {
5690                 writeAPListRid(ai, ai->APList, 0);
5691                 kfree(ai->APList);
5692                 ai->APList = NULL;
5693         }
5694         writeConfigRid(ai, 0);
5695         enable_MAC(ai, 0);
5696         ai->power = PMSG_ON;
5697         netif_device_attach(dev);
5698         netif_wake_queue(dev);
5699         enable_interrupts(ai);
5700         up(&ai->sem);
5701         return 0;
5702 }
5703 #endif
5704
5705 static int __init airo_init_module( void )
5706 {
5707         int i;
5708
5709         airo_entry = create_proc_entry("driver/aironet",
5710                                        S_IFDIR | airo_perm,
5711                                        NULL);
5712
5713         if (airo_entry) {
5714                 airo_entry->uid = proc_uid;
5715                 airo_entry->gid = proc_gid;
5716         }
5717
5718         for (i = 0; i < 4 && io[i] && irq[i]; i++) {
5719                 airo_print_info("", "Trying to configure ISA adapter at irq=%d "
5720                         "io=0x%x", irq[i], io[i] );
5721                 if (init_airo_card( irq[i], io[i], 0, NULL ))
5722                         /* do nothing */ ;
5723         }
5724
5725 #ifdef CONFIG_PCI
5726         airo_print_info("", "Probing for PCI adapters");
5727         i = pci_register_driver(&airo_driver);
5728         airo_print_info("", "Finished probing for PCI adapters");
5729
5730         if (i) {
5731                 remove_proc_entry("driver/aironet", NULL);
5732                 return i;
5733         }
5734 #endif
5735
5736         /* Always exit with success, as we are a library module
5737          * as well as a driver module
5738          */
5739         return 0;
5740 }
5741
5742 static void __exit airo_cleanup_module( void )
5743 {
5744         struct airo_info *ai;
5745         while(!list_empty(&airo_devices)) {
5746                 ai = list_entry(airo_devices.next, struct airo_info, dev_list);
5747                 airo_print_info(ai->dev->name, "Unregistering...");
5748                 stop_airo_card(ai->dev, 1);
5749         }
5750 #ifdef CONFIG_PCI
5751         pci_unregister_driver(&airo_driver);
5752 #endif
5753         remove_proc_entry("driver/aironet", NULL);
5754 }
5755
5756 /*
5757  * Initial Wireless Extension code for Aironet driver by :
5758  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00
5759  * Conversion to new driver API by :
5760  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02
5761  * Javier also did a good amount of work here, adding some new extensions
5762  * and fixing my code. Let's just say that without him this code just
5763  * would not work at all... - Jean II
5764  */
5765
5766 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi)
5767 {
5768         if (!rssi_rid)
5769                 return 0;
5770
5771         return (0x100 - rssi_rid[rssi].rssidBm);
5772 }
5773
5774 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm)
5775 {
5776         int i;
5777
5778         if (!rssi_rid)
5779                 return 0;
5780
5781         for (i = 0; i < 256; i++)
5782                 if (rssi_rid[i].rssidBm == dbm)
5783                         return rssi_rid[i].rssipct;
5784
5785         return 0;
5786 }
5787
5788
5789 static int airo_get_quality (StatusRid *status_rid, CapabilityRid *cap_rid)
5790 {
5791         int quality = 0;
5792         u16 sq;
5793
5794         if ((status_rid->mode & cpu_to_le16(0x3f)) != cpu_to_le16(0x3f))
5795                 return 0;
5796
5797         if (!(cap_rid->hardCap & cpu_to_le16(8)))
5798                 return 0;
5799
5800         sq = le16_to_cpu(status_rid->signalQuality);
5801         if (memcmp(cap_rid->prodName, "350", 3))
5802                 if (sq > 0x20)
5803                         quality = 0;
5804                 else
5805                         quality = 0x20 - sq;
5806         else
5807                 if (sq > 0xb0)
5808                         quality = 0;
5809                 else if (sq < 0x10)
5810                         quality = 0xa0;
5811                 else
5812                         quality = 0xb0 - sq;
5813         return quality;
5814 }
5815
5816 #define airo_get_max_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x20 : 0xa0)
5817 #define airo_get_avg_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x10 : 0x50);
5818
5819 /*------------------------------------------------------------------*/
5820 /*
5821  * Wireless Handler : get protocol name
5822  */
5823 static int airo_get_name(struct net_device *dev,
5824                          struct iw_request_info *info,
5825                          char *cwrq,
5826                          char *extra)
5827 {
5828         strcpy(cwrq, "IEEE 802.11-DS");
5829         return 0;
5830 }
5831
5832 /*------------------------------------------------------------------*/
5833 /*
5834  * Wireless Handler : set frequency
5835  */
5836 static int airo_set_freq(struct net_device *dev,
5837                          struct iw_request_info *info,
5838                          struct iw_freq *fwrq,
5839                          char *extra)
5840 {
5841         struct airo_info *local = dev->ml_priv;
5842         int rc = -EINPROGRESS;          /* Call commit handler */
5843
5844         /* If setting by frequency, convert to a channel */
5845         if(fwrq->e == 1) {
5846                 int f = fwrq->m / 100000;
5847
5848                 /* Hack to fall through... */
5849                 fwrq->e = 0;
5850                 fwrq->m = ieee80211_freq_to_dsss_chan(f);
5851         }
5852         /* Setting by channel number */
5853         if((fwrq->m > 1000) || (fwrq->e > 0))
5854                 rc = -EOPNOTSUPP;
5855         else {
5856                 int channel = fwrq->m;
5857                 /* We should do a better check than that,
5858                  * based on the card capability !!! */
5859                 if((channel < 1) || (channel > 14)) {
5860                         airo_print_dbg(dev->name, "New channel value of %d is invalid!",
5861                                 fwrq->m);
5862                         rc = -EINVAL;
5863                 } else {
5864                         readConfigRid(local, 1);
5865                         /* Yes ! We can set it !!! */
5866                         local->config.channelSet = cpu_to_le16(channel);
5867                         set_bit (FLAG_COMMIT, &local->flags);
5868                 }
5869         }
5870         return rc;
5871 }
5872
5873 /*------------------------------------------------------------------*/
5874 /*
5875  * Wireless Handler : get frequency
5876  */
5877 static int airo_get_freq(struct net_device *dev,
5878                          struct iw_request_info *info,
5879                          struct iw_freq *fwrq,
5880                          char *extra)
5881 {
5882         struct airo_info *local = dev->ml_priv;
5883         StatusRid status_rid;           /* Card status info */
5884         int ch;
5885
5886         readConfigRid(local, 1);
5887         if ((local->config.opmode & MODE_CFG_MASK) == MODE_STA_ESS)
5888                 status_rid.channel = local->config.channelSet;
5889         else
5890                 readStatusRid(local, &status_rid, 1);
5891
5892         ch = le16_to_cpu(status_rid.channel);
5893         if((ch > 0) && (ch < 15)) {
5894                 fwrq->m = ieee80211_dsss_chan_to_freq(ch) * 100000;
5895                 fwrq->e = 1;
5896         } else {
5897                 fwrq->m = ch;
5898                 fwrq->e = 0;
5899         }
5900
5901         return 0;
5902 }
5903
5904 /*------------------------------------------------------------------*/
5905 /*
5906  * Wireless Handler : set ESSID
5907  */
5908 static int airo_set_essid(struct net_device *dev,
5909                           struct iw_request_info *info,
5910                           struct iw_point *dwrq,
5911                           char *extra)
5912 {
5913         struct airo_info *local = dev->ml_priv;
5914         SsidRid SSID_rid;               /* SSIDs */
5915
5916         /* Reload the list of current SSID */
5917         readSsidRid(local, &SSID_rid);
5918
5919         /* Check if we asked for `any' */
5920         if(dwrq->flags == 0) {
5921                 /* Just send an empty SSID list */
5922                 memset(&SSID_rid, 0, sizeof(SSID_rid));
5923         } else {
5924                 int     index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
5925
5926                 /* Check the size of the string */
5927                 if(dwrq->length > IW_ESSID_MAX_SIZE) {
5928                         return -E2BIG ;
5929                 }
5930                 /* Check if index is valid */
5931                 if((index < 0) || (index >= 4)) {
5932                         return -EINVAL;
5933                 }
5934
5935                 /* Set the SSID */
5936                 memset(SSID_rid.ssids[index].ssid, 0,
5937                        sizeof(SSID_rid.ssids[index].ssid));
5938                 memcpy(SSID_rid.ssids[index].ssid, extra, dwrq->length);
5939                 SSID_rid.ssids[index].len = cpu_to_le16(dwrq->length);
5940         }
5941         SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5942         /* Write it to the card */
5943         disable_MAC(local, 1);
5944         writeSsidRid(local, &SSID_rid, 1);
5945         enable_MAC(local, 1);
5946
5947         return 0;
5948 }
5949
5950 /*------------------------------------------------------------------*/
5951 /*
5952  * Wireless Handler : get ESSID
5953  */
5954 static int airo_get_essid(struct net_device *dev,
5955                           struct iw_request_info *info,
5956                           struct iw_point *dwrq,
5957                           char *extra)
5958 {
5959         struct airo_info *local = dev->ml_priv;
5960         StatusRid status_rid;           /* Card status info */
5961
5962         readStatusRid(local, &status_rid, 1);
5963
5964         /* Note : if dwrq->flags != 0, we should
5965          * get the relevant SSID from the SSID list... */
5966
5967         /* Get the current SSID */
5968         memcpy(extra, status_rid.SSID, le16_to_cpu(status_rid.SSIDlen));
5969         /* If none, we may want to get the one that was set */
5970
5971         /* Push it out ! */
5972         dwrq->length = le16_to_cpu(status_rid.SSIDlen);
5973         dwrq->flags = 1; /* active */
5974
5975         return 0;
5976 }
5977
5978 /*------------------------------------------------------------------*/
5979 /*
5980  * Wireless Handler : set AP address
5981  */
5982 static int airo_set_wap(struct net_device *dev,
5983                         struct iw_request_info *info,
5984                         struct sockaddr *awrq,
5985                         char *extra)
5986 {
5987         struct airo_info *local = dev->ml_priv;
5988         Cmd cmd;
5989         Resp rsp;
5990         APListRid APList_rid;
5991         static const u8 any[ETH_ALEN] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
5992         static const u8 off[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
5993
5994         if (awrq->sa_family != ARPHRD_ETHER)
5995                 return -EINVAL;
5996         else if (!memcmp(any, awrq->sa_data, ETH_ALEN) ||
5997                  !memcmp(off, awrq->sa_data, ETH_ALEN)) {
5998                 memset(&cmd, 0, sizeof(cmd));
5999                 cmd.cmd=CMD_LOSE_SYNC;
6000                 if (down_interruptible(&local->sem))
6001                         return -ERESTARTSYS;
6002                 issuecommand(local, &cmd, &rsp);
6003                 up(&local->sem);
6004         } else {
6005                 memset(&APList_rid, 0, sizeof(APList_rid));
6006                 APList_rid.len = cpu_to_le16(sizeof(APList_rid));
6007                 memcpy(APList_rid.ap[0], awrq->sa_data, ETH_ALEN);
6008                 disable_MAC(local, 1);
6009                 writeAPListRid(local, &APList_rid, 1);
6010                 enable_MAC(local, 1);
6011         }
6012         return 0;
6013 }
6014
6015 /*------------------------------------------------------------------*/
6016 /*
6017  * Wireless Handler : get AP address
6018  */
6019 static int airo_get_wap(struct net_device *dev,
6020                         struct iw_request_info *info,
6021                         struct sockaddr *awrq,
6022                         char *extra)
6023 {
6024         struct airo_info *local = dev->ml_priv;
6025         StatusRid status_rid;           /* Card status info */
6026
6027         readStatusRid(local, &status_rid, 1);
6028
6029         /* Tentative. This seems to work, wow, I'm lucky !!! */
6030         memcpy(awrq->sa_data, status_rid.bssid[0], ETH_ALEN);
6031         awrq->sa_family = ARPHRD_ETHER;
6032
6033         return 0;
6034 }
6035
6036 /*------------------------------------------------------------------*/
6037 /*
6038  * Wireless Handler : set Nickname
6039  */
6040 static int airo_set_nick(struct net_device *dev,
6041                          struct iw_request_info *info,
6042                          struct iw_point *dwrq,
6043                          char *extra)
6044 {
6045         struct airo_info *local = dev->ml_priv;
6046
6047         /* Check the size of the string */
6048         if(dwrq->length > 16) {
6049                 return -E2BIG;
6050         }
6051         readConfigRid(local, 1);
6052         memset(local->config.nodeName, 0, sizeof(local->config.nodeName));
6053         memcpy(local->config.nodeName, extra, dwrq->length);
6054         set_bit (FLAG_COMMIT, &local->flags);
6055
6056         return -EINPROGRESS;            /* Call commit handler */
6057 }
6058
6059 /*------------------------------------------------------------------*/
6060 /*
6061  * Wireless Handler : get Nickname
6062  */
6063 static int airo_get_nick(struct net_device *dev,
6064                          struct iw_request_info *info,
6065                          struct iw_point *dwrq,
6066                          char *extra)
6067 {
6068         struct airo_info *local = dev->ml_priv;
6069
6070         readConfigRid(local, 1);
6071         strncpy(extra, local->config.nodeName, 16);
6072         extra[16] = '\0';
6073         dwrq->length = strlen(extra);
6074
6075         return 0;
6076 }
6077
6078 /*------------------------------------------------------------------*/
6079 /*
6080  * Wireless Handler : set Bit-Rate
6081  */
6082 static int airo_set_rate(struct net_device *dev,
6083                          struct iw_request_info *info,
6084                          struct iw_param *vwrq,
6085                          char *extra)
6086 {
6087         struct airo_info *local = dev->ml_priv;
6088         CapabilityRid cap_rid;          /* Card capability info */
6089         u8      brate = 0;
6090         int     i;
6091
6092         /* First : get a valid bit rate value */
6093         readCapabilityRid(local, &cap_rid, 1);
6094
6095         /* Which type of value ? */
6096         if((vwrq->value < 8) && (vwrq->value >= 0)) {
6097                 /* Setting by rate index */
6098                 /* Find value in the magic rate table */
6099                 brate = cap_rid.supportedRates[vwrq->value];
6100         } else {
6101                 /* Setting by frequency value */
6102                 u8      normvalue = (u8) (vwrq->value/500000);
6103
6104                 /* Check if rate is valid */
6105                 for(i = 0 ; i < 8 ; i++) {
6106                         if(normvalue == cap_rid.supportedRates[i]) {
6107                                 brate = normvalue;
6108                                 break;
6109                         }
6110                 }
6111         }
6112         /* -1 designed the max rate (mostly auto mode) */
6113         if(vwrq->value == -1) {
6114                 /* Get the highest available rate */
6115                 for(i = 0 ; i < 8 ; i++) {
6116                         if(cap_rid.supportedRates[i] == 0)
6117                                 break;
6118                 }
6119                 if(i != 0)
6120                         brate = cap_rid.supportedRates[i - 1];
6121         }
6122         /* Check that it is valid */
6123         if(brate == 0) {
6124                 return -EINVAL;
6125         }
6126
6127         readConfigRid(local, 1);
6128         /* Now, check if we want a fixed or auto value */
6129         if(vwrq->fixed == 0) {
6130                 /* Fill all the rates up to this max rate */
6131                 memset(local->config.rates, 0, 8);
6132                 for(i = 0 ; i < 8 ; i++) {
6133                         local->config.rates[i] = cap_rid.supportedRates[i];
6134                         if(local->config.rates[i] == brate)
6135                                 break;
6136                 }
6137         } else {
6138                 /* Fixed mode */
6139                 /* One rate, fixed */
6140                 memset(local->config.rates, 0, 8);
6141                 local->config.rates[0] = brate;
6142         }
6143         set_bit (FLAG_COMMIT, &local->flags);
6144
6145         return -EINPROGRESS;            /* Call commit handler */
6146 }
6147
6148 /*------------------------------------------------------------------*/
6149 /*
6150  * Wireless Handler : get Bit-Rate
6151  */
6152 static int airo_get_rate(struct net_device *dev,
6153                          struct iw_request_info *info,
6154                          struct iw_param *vwrq,
6155                          char *extra)
6156 {
6157         struct airo_info *local = dev->ml_priv;
6158         StatusRid status_rid;           /* Card status info */
6159
6160         readStatusRid(local, &status_rid, 1);
6161
6162         vwrq->value = le16_to_cpu(status_rid.currentXmitRate) * 500000;
6163         /* If more than one rate, set auto */
6164         readConfigRid(local, 1);
6165         vwrq->fixed = (local->config.rates[1] == 0);
6166
6167         return 0;
6168 }
6169
6170 /*------------------------------------------------------------------*/
6171 /*
6172  * Wireless Handler : set RTS threshold
6173  */
6174 static int airo_set_rts(struct net_device *dev,
6175                         struct iw_request_info *info,
6176                         struct iw_param *vwrq,
6177                         char *extra)
6178 {
6179         struct airo_info *local = dev->ml_priv;
6180         int rthr = vwrq->value;
6181
6182         if(vwrq->disabled)
6183                 rthr = AIRO_DEF_MTU;
6184         if((rthr < 0) || (rthr > AIRO_DEF_MTU)) {
6185                 return -EINVAL;
6186         }
6187         readConfigRid(local, 1);
6188         local->config.rtsThres = cpu_to_le16(rthr);
6189         set_bit (FLAG_COMMIT, &local->flags);
6190
6191         return -EINPROGRESS;            /* Call commit handler */
6192 }
6193
6194 /*------------------------------------------------------------------*/
6195 /*
6196  * Wireless Handler : get RTS threshold
6197  */
6198 static int airo_get_rts(struct net_device *dev,
6199                         struct iw_request_info *info,
6200                         struct iw_param *vwrq,
6201                         char *extra)
6202 {
6203         struct airo_info *local = dev->ml_priv;
6204
6205         readConfigRid(local, 1);
6206         vwrq->value = le16_to_cpu(local->config.rtsThres);
6207         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6208         vwrq->fixed = 1;
6209
6210         return 0;
6211 }
6212
6213 /*------------------------------------------------------------------*/
6214 /*
6215  * Wireless Handler : set Fragmentation threshold
6216  */
6217 static int airo_set_frag(struct net_device *dev,
6218                          struct iw_request_info *info,
6219                          struct iw_param *vwrq,
6220                          char *extra)
6221 {
6222         struct airo_info *local = dev->ml_priv;
6223         int fthr = vwrq->value;
6224
6225         if(vwrq->disabled)
6226                 fthr = AIRO_DEF_MTU;
6227         if((fthr < 256) || (fthr > AIRO_DEF_MTU)) {
6228                 return -EINVAL;
6229         }
6230         fthr &= ~0x1;   /* Get an even value - is it really needed ??? */
6231         readConfigRid(local, 1);
6232         local->config.fragThresh = cpu_to_le16(fthr);
6233         set_bit (FLAG_COMMIT, &local->flags);
6234
6235         return -EINPROGRESS;            /* Call commit handler */
6236 }
6237
6238 /*------------------------------------------------------------------*/
6239 /*
6240  * Wireless Handler : get Fragmentation threshold
6241  */
6242 static int airo_get_frag(struct net_device *dev,
6243                          struct iw_request_info *info,
6244                          struct iw_param *vwrq,
6245                          char *extra)
6246 {
6247         struct airo_info *local = dev->ml_priv;
6248
6249         readConfigRid(local, 1);
6250         vwrq->value = le16_to_cpu(local->config.fragThresh);
6251         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6252         vwrq->fixed = 1;
6253
6254         return 0;
6255 }
6256
6257 /*------------------------------------------------------------------*/
6258 /*
6259  * Wireless Handler : set Mode of Operation
6260  */
6261 static int airo_set_mode(struct net_device *dev,
6262                          struct iw_request_info *info,
6263                          __u32 *uwrq,
6264                          char *extra)
6265 {
6266         struct airo_info *local = dev->ml_priv;
6267         int reset = 0;
6268
6269         readConfigRid(local, 1);
6270         if (sniffing_mode(local))
6271                 reset = 1;
6272
6273         switch(*uwrq) {
6274                 case IW_MODE_ADHOC:
6275                         local->config.opmode &= ~MODE_CFG_MASK;
6276                         local->config.opmode |= MODE_STA_IBSS;
6277                         local->config.rmode &= ~RXMODE_FULL_MASK;
6278                         local->config.scanMode = SCANMODE_ACTIVE;
6279                         clear_bit (FLAG_802_11, &local->flags);
6280                         break;
6281                 case IW_MODE_INFRA:
6282                         local->config.opmode &= ~MODE_CFG_MASK;
6283                         local->config.opmode |= MODE_STA_ESS;
6284                         local->config.rmode &= ~RXMODE_FULL_MASK;
6285                         local->config.scanMode = SCANMODE_ACTIVE;
6286                         clear_bit (FLAG_802_11, &local->flags);
6287                         break;
6288                 case IW_MODE_MASTER:
6289                         local->config.opmode &= ~MODE_CFG_MASK;
6290                         local->config.opmode |= MODE_AP;
6291                         local->config.rmode &= ~RXMODE_FULL_MASK;
6292                         local->config.scanMode = SCANMODE_ACTIVE;
6293                         clear_bit (FLAG_802_11, &local->flags);
6294                         break;
6295                 case IW_MODE_REPEAT:
6296                         local->config.opmode &= ~MODE_CFG_MASK;
6297                         local->config.opmode |= MODE_AP_RPTR;
6298                         local->config.rmode &= ~RXMODE_FULL_MASK;
6299                         local->config.scanMode = SCANMODE_ACTIVE;
6300                         clear_bit (FLAG_802_11, &local->flags);
6301                         break;
6302                 case IW_MODE_MONITOR:
6303                         local->config.opmode &= ~MODE_CFG_MASK;
6304                         local->config.opmode |= MODE_STA_ESS;
6305                         local->config.rmode &= ~RXMODE_FULL_MASK;
6306                         local->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
6307                         local->config.scanMode = SCANMODE_PASSIVE;
6308                         set_bit (FLAG_802_11, &local->flags);
6309                         break;
6310                 default:
6311                         return -EINVAL;
6312         }
6313         if (reset)
6314                 set_bit (FLAG_RESET, &local->flags);
6315         set_bit (FLAG_COMMIT, &local->flags);
6316
6317         return -EINPROGRESS;            /* Call commit handler */
6318 }
6319
6320 /*------------------------------------------------------------------*/
6321 /*
6322  * Wireless Handler : get Mode of Operation
6323  */
6324 static int airo_get_mode(struct net_device *dev,
6325                          struct iw_request_info *info,
6326                          __u32 *uwrq,
6327                          char *extra)
6328 {
6329         struct airo_info *local = dev->ml_priv;
6330
6331         readConfigRid(local, 1);
6332         /* If not managed, assume it's ad-hoc */
6333         switch (local->config.opmode & MODE_CFG_MASK) {
6334                 case MODE_STA_ESS:
6335                         *uwrq = IW_MODE_INFRA;
6336                         break;
6337                 case MODE_AP:
6338                         *uwrq = IW_MODE_MASTER;
6339                         break;
6340                 case MODE_AP_RPTR:
6341                         *uwrq = IW_MODE_REPEAT;
6342                         break;
6343                 default:
6344                         *uwrq = IW_MODE_ADHOC;
6345         }
6346
6347         return 0;
6348 }
6349
6350 static inline int valid_index(struct airo_info *ai, int index)
6351 {
6352         return (index >= 0) && (index <= ai->max_wep_idx);
6353 }
6354
6355 /*------------------------------------------------------------------*/
6356 /*
6357  * Wireless Handler : set Encryption Key
6358  */
6359 static int airo_set_encode(struct net_device *dev,
6360                            struct iw_request_info *info,
6361                            struct iw_point *dwrq,
6362                            char *extra)
6363 {
6364         struct airo_info *local = dev->ml_priv;
6365         int perm = (dwrq->flags & IW_ENCODE_TEMP ? 0 : 1);
6366         __le16 currentAuthType = local->config.authType;
6367         int rc = 0;
6368
6369         if (!local->wep_capable)
6370                 return -EOPNOTSUPP;
6371
6372         readConfigRid(local, 1);
6373
6374         /* Basic checking: do we have a key to set ?
6375          * Note : with the new API, it's impossible to get a NULL pointer.
6376          * Therefore, we need to check a key size == 0 instead.
6377          * New version of iwconfig properly set the IW_ENCODE_NOKEY flag
6378          * when no key is present (only change flags), but older versions
6379          * don't do it. - Jean II */
6380         if (dwrq->length > 0) {
6381                 wep_key_t key;
6382                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6383                 int current_index;
6384
6385                 /* Check the size of the key */
6386                 if (dwrq->length > MAX_KEY_SIZE) {
6387                         return -EINVAL;
6388                 }
6389
6390                 current_index = get_wep_tx_idx(local);
6391                 if (current_index < 0)
6392                         current_index = 0;
6393
6394                 /* Check the index (none -> use current) */
6395                 if (!valid_index(local, index))
6396                         index = current_index;
6397
6398                 /* Set the length */
6399                 if (dwrq->length > MIN_KEY_SIZE)
6400                         key.len = MAX_KEY_SIZE;
6401                 else
6402                         if (dwrq->length > 0)
6403                                 key.len = MIN_KEY_SIZE;
6404                         else
6405                                 /* Disable the key */
6406                                 key.len = 0;
6407                 /* Check if the key is not marked as invalid */
6408                 if(!(dwrq->flags & IW_ENCODE_NOKEY)) {
6409                         /* Cleanup */
6410                         memset(key.key, 0, MAX_KEY_SIZE);
6411                         /* Copy the key in the driver */
6412                         memcpy(key.key, extra, dwrq->length);
6413                         /* Send the key to the card */
6414                         rc = set_wep_key(local, index, key.key, key.len, perm, 1);
6415                         if (rc < 0) {
6416                                 airo_print_err(local->dev->name, "failed to set"
6417                                                " WEP key at index %d: %d.",
6418                                                index, rc);
6419                                 return rc;
6420                         }
6421                 }
6422                 /* WE specify that if a valid key is set, encryption
6423                  * should be enabled (user may turn it off later)
6424                  * This is also how "iwconfig ethX key on" works */
6425                 if((index == current_index) && (key.len > 0) &&
6426                    (local->config.authType == AUTH_OPEN)) {
6427                         local->config.authType = AUTH_ENCRYPT;
6428                 }
6429         } else {
6430                 /* Do we want to just set the transmit key index ? */
6431                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6432                 if (valid_index(local, index)) {
6433                         rc = set_wep_tx_idx(local, index, perm, 1);
6434                         if (rc < 0) {
6435                                 airo_print_err(local->dev->name, "failed to set"
6436                                                " WEP transmit index to %d: %d.",
6437                                                index, rc);
6438                                 return rc;
6439                         }
6440                 } else {
6441                         /* Don't complain if only change the mode */
6442                         if (!(dwrq->flags & IW_ENCODE_MODE))
6443                                 return -EINVAL;
6444                 }
6445         }
6446         /* Read the flags */
6447         if(dwrq->flags & IW_ENCODE_DISABLED)
6448                 local->config.authType = AUTH_OPEN;     // disable encryption
6449         if(dwrq->flags & IW_ENCODE_RESTRICTED)
6450                 local->config.authType = AUTH_SHAREDKEY;        // Only Both
6451         if(dwrq->flags & IW_ENCODE_OPEN)
6452                 local->config.authType = AUTH_ENCRYPT;  // Only Wep
6453         /* Commit the changes to flags if needed */
6454         if (local->config.authType != currentAuthType)
6455                 set_bit (FLAG_COMMIT, &local->flags);
6456         return -EINPROGRESS;            /* Call commit handler */
6457 }
6458
6459 /*------------------------------------------------------------------*/
6460 /*
6461  * Wireless Handler : get Encryption Key
6462  */
6463 static int airo_get_encode(struct net_device *dev,
6464                            struct iw_request_info *info,
6465                            struct iw_point *dwrq,
6466                            char *extra)
6467 {
6468         struct airo_info *local = dev->ml_priv;
6469         int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6470         u8 buf[16];
6471
6472         if (!local->wep_capable)
6473                 return -EOPNOTSUPP;
6474
6475         readConfigRid(local, 1);
6476
6477         /* Check encryption mode */
6478         switch(local->config.authType)  {
6479                 case AUTH_ENCRYPT:
6480                         dwrq->flags = IW_ENCODE_OPEN;
6481                         break;
6482                 case AUTH_SHAREDKEY:
6483                         dwrq->flags = IW_ENCODE_RESTRICTED;
6484                         break;
6485                 default:
6486                 case AUTH_OPEN:
6487                         dwrq->flags = IW_ENCODE_DISABLED;
6488                         break;
6489         }
6490         /* We can't return the key, so set the proper flag and return zero */
6491         dwrq->flags |= IW_ENCODE_NOKEY;
6492         memset(extra, 0, 16);
6493
6494         /* Which key do we want ? -1 -> tx index */
6495         if (!valid_index(local, index)) {
6496                 index = get_wep_tx_idx(local);
6497                 if (index < 0)
6498                         index = 0;
6499         }
6500         dwrq->flags |= index + 1;
6501
6502         /* Copy the key to the user buffer */
6503         dwrq->length = get_wep_key(local, index, &buf[0], sizeof(buf));
6504         memcpy(extra, buf, dwrq->length);
6505
6506         return 0;
6507 }
6508
6509 /*------------------------------------------------------------------*/
6510 /*
6511  * Wireless Handler : set extended Encryption parameters
6512  */
6513 static int airo_set_encodeext(struct net_device *dev,
6514                            struct iw_request_info *info,
6515                             union iwreq_data *wrqu,
6516                             char *extra)
6517 {
6518         struct airo_info *local = dev->ml_priv;
6519         struct iw_point *encoding = &wrqu->encoding;
6520         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6521         int perm = ( encoding->flags & IW_ENCODE_TEMP ? 0 : 1 );
6522         __le16 currentAuthType = local->config.authType;
6523         int idx, key_len, alg = ext->alg, set_key = 1, rc;
6524         wep_key_t key;
6525
6526         if (!local->wep_capable)
6527                 return -EOPNOTSUPP;
6528
6529         readConfigRid(local, 1);
6530
6531         /* Determine and validate the key index */
6532         idx = encoding->flags & IW_ENCODE_INDEX;
6533         if (idx) {
6534                 if (!valid_index(local, idx - 1))
6535                         return -EINVAL;
6536                 idx--;
6537         } else {
6538                 idx = get_wep_tx_idx(local);
6539                 if (idx < 0)
6540                         idx = 0;
6541         }
6542
6543         if (encoding->flags & IW_ENCODE_DISABLED)
6544                 alg = IW_ENCODE_ALG_NONE;
6545
6546         if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
6547                 /* Only set transmit key index here, actual
6548                  * key is set below if needed.
6549                  */
6550                 rc = set_wep_tx_idx(local, idx, perm, 1);
6551                 if (rc < 0) {
6552                         airo_print_err(local->dev->name, "failed to set "
6553                                        "WEP transmit index to %d: %d.",
6554                                        idx, rc);
6555                         return rc;
6556                 }
6557                 set_key = ext->key_len > 0 ? 1 : 0;
6558         }
6559
6560         if (set_key) {
6561                 /* Set the requested key first */
6562                 memset(key.key, 0, MAX_KEY_SIZE);
6563                 switch (alg) {
6564                 case IW_ENCODE_ALG_NONE:
6565                         key.len = 0;
6566                         break;
6567                 case IW_ENCODE_ALG_WEP:
6568                         if (ext->key_len > MIN_KEY_SIZE) {
6569                                 key.len = MAX_KEY_SIZE;
6570                         } else if (ext->key_len > 0) {
6571                                 key.len = MIN_KEY_SIZE;
6572                         } else {
6573                                 return -EINVAL;
6574                         }
6575                         key_len = min (ext->key_len, key.len);
6576                         memcpy(key.key, ext->key, key_len);
6577                         break;
6578                 default:
6579                         return -EINVAL;
6580                 }
6581                 /* Send the key to the card */
6582                 rc = set_wep_key(local, idx, key.key, key.len, perm, 1);
6583                 if (rc < 0) {
6584                         airo_print_err(local->dev->name, "failed to set WEP key"
6585                                        " at index %d: %d.", idx, rc);
6586                         return rc;
6587                 }
6588         }
6589
6590         /* Read the flags */
6591         if(encoding->flags & IW_ENCODE_DISABLED)
6592                 local->config.authType = AUTH_OPEN;     // disable encryption
6593         if(encoding->flags & IW_ENCODE_RESTRICTED)
6594                 local->config.authType = AUTH_SHAREDKEY;        // Only Both
6595         if(encoding->flags & IW_ENCODE_OPEN)
6596                 local->config.authType = AUTH_ENCRYPT;  // Only Wep
6597         /* Commit the changes to flags if needed */
6598         if (local->config.authType != currentAuthType)
6599                 set_bit (FLAG_COMMIT, &local->flags);
6600
6601         return -EINPROGRESS;
6602 }
6603
6604
6605 /*------------------------------------------------------------------*/
6606 /*
6607  * Wireless Handler : get extended Encryption parameters
6608  */
6609 static int airo_get_encodeext(struct net_device *dev,
6610                             struct iw_request_info *info,
6611                             union iwreq_data *wrqu,
6612                             char *extra)
6613 {
6614         struct airo_info *local = dev->ml_priv;
6615         struct iw_point *encoding = &wrqu->encoding;
6616         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6617         int idx, max_key_len;
6618         u8 buf[16];
6619
6620         if (!local->wep_capable)
6621                 return -EOPNOTSUPP;
6622
6623         readConfigRid(local, 1);
6624
6625         max_key_len = encoding->length - sizeof(*ext);
6626         if (max_key_len < 0)
6627                 return -EINVAL;
6628
6629         idx = encoding->flags & IW_ENCODE_INDEX;
6630         if (idx) {
6631                 if (!valid_index(local, idx - 1))
6632                         return -EINVAL;
6633                 idx--;
6634         } else {
6635                 idx = get_wep_tx_idx(local);
6636                 if (idx < 0)
6637                         idx = 0;
6638         }
6639
6640         encoding->flags = idx + 1;
6641         memset(ext, 0, sizeof(*ext));
6642
6643         /* Check encryption mode */
6644         switch(local->config.authType) {
6645                 case AUTH_ENCRYPT:
6646                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6647                         break;
6648                 case AUTH_SHAREDKEY:
6649                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6650                         break;
6651                 default:
6652                 case AUTH_OPEN:
6653                         encoding->flags = IW_ENCODE_ALG_NONE | IW_ENCODE_DISABLED;
6654                         break;
6655         }
6656         /* We can't return the key, so set the proper flag and return zero */
6657         encoding->flags |= IW_ENCODE_NOKEY;
6658         memset(extra, 0, 16);
6659         
6660         /* Copy the key to the user buffer */
6661         ext->key_len = get_wep_key(local, idx, &buf[0], sizeof(buf));
6662         memcpy(extra, buf, ext->key_len);
6663
6664         return 0;
6665 }
6666
6667
6668 /*------------------------------------------------------------------*/
6669 /*
6670  * Wireless Handler : set extended authentication parameters
6671  */
6672 static int airo_set_auth(struct net_device *dev,
6673                                struct iw_request_info *info,
6674                                union iwreq_data *wrqu, char *extra)
6675 {
6676         struct airo_info *local = dev->ml_priv;
6677         struct iw_param *param = &wrqu->param;
6678         __le16 currentAuthType = local->config.authType;
6679
6680         switch (param->flags & IW_AUTH_INDEX) {
6681         case IW_AUTH_WPA_VERSION:
6682         case IW_AUTH_CIPHER_PAIRWISE:
6683         case IW_AUTH_CIPHER_GROUP:
6684         case IW_AUTH_KEY_MGMT:
6685         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6686         case IW_AUTH_PRIVACY_INVOKED:
6687                 /*
6688                  * airo does not use these parameters
6689                  */
6690                 break;
6691
6692         case IW_AUTH_DROP_UNENCRYPTED:
6693                 if (param->value) {
6694                         /* Only change auth type if unencrypted */
6695                         if (currentAuthType == AUTH_OPEN)
6696                                 local->config.authType = AUTH_ENCRYPT;
6697                 } else {
6698                         local->config.authType = AUTH_OPEN;
6699                 }
6700
6701                 /* Commit the changes to flags if needed */
6702                 if (local->config.authType != currentAuthType)
6703                         set_bit (FLAG_COMMIT, &local->flags);
6704                 break;
6705
6706         case IW_AUTH_80211_AUTH_ALG: {
6707                         /* FIXME: What about AUTH_OPEN?  This API seems to
6708                          * disallow setting our auth to AUTH_OPEN.
6709                          */
6710                         if (param->value & IW_AUTH_ALG_SHARED_KEY) {
6711                                 local->config.authType = AUTH_SHAREDKEY;
6712                         } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
6713                                 local->config.authType = AUTH_ENCRYPT;
6714                         } else
6715                                 return -EINVAL;
6716                         break;
6717
6718                         /* Commit the changes to flags if needed */
6719                         if (local->config.authType != currentAuthType)
6720                                 set_bit (FLAG_COMMIT, &local->flags);
6721                 }
6722
6723         case IW_AUTH_WPA_ENABLED:
6724                 /* Silently accept disable of WPA */
6725                 if (param->value > 0)
6726                         return -EOPNOTSUPP;
6727                 break;
6728
6729         default:
6730                 return -EOPNOTSUPP;
6731         }
6732         return -EINPROGRESS;
6733 }
6734
6735
6736 /*------------------------------------------------------------------*/
6737 /*
6738  * Wireless Handler : get extended authentication parameters
6739  */
6740 static int airo_get_auth(struct net_device *dev,
6741                                struct iw_request_info *info,
6742                                union iwreq_data *wrqu, char *extra)
6743 {
6744         struct airo_info *local = dev->ml_priv;
6745         struct iw_param *param = &wrqu->param;
6746         __le16 currentAuthType = local->config.authType;
6747
6748         switch (param->flags & IW_AUTH_INDEX) {
6749         case IW_AUTH_DROP_UNENCRYPTED:
6750                 switch (currentAuthType) {
6751                 case AUTH_SHAREDKEY:
6752                 case AUTH_ENCRYPT:
6753                         param->value = 1;
6754                         break;
6755                 default:
6756                         param->value = 0;
6757                         break;
6758                 }
6759                 break;
6760
6761         case IW_AUTH_80211_AUTH_ALG:
6762                 switch (currentAuthType) {
6763                 case AUTH_SHAREDKEY:
6764                         param->value = IW_AUTH_ALG_SHARED_KEY;
6765                         break;
6766                 case AUTH_ENCRYPT:
6767                 default:
6768                         param->value = IW_AUTH_ALG_OPEN_SYSTEM;
6769                         break;
6770                 }
6771                 break;
6772
6773         case IW_AUTH_WPA_ENABLED:
6774                 param->value = 0;
6775                 break;
6776
6777         default:
6778                 return -EOPNOTSUPP;
6779         }
6780         return 0;
6781 }
6782
6783
6784 /*------------------------------------------------------------------*/
6785 /*
6786  * Wireless Handler : set Tx-Power
6787  */
6788 static int airo_set_txpow(struct net_device *dev,
6789                           struct iw_request_info *info,
6790                           struct iw_param *vwrq,
6791                           char *extra)
6792 {
6793         struct airo_info *local = dev->ml_priv;
6794         CapabilityRid cap_rid;          /* Card capability info */
6795         int i;
6796         int rc = -EINVAL;
6797         __le16 v = cpu_to_le16(vwrq->value);
6798
6799         readCapabilityRid(local, &cap_rid, 1);
6800
6801         if (vwrq->disabled) {
6802                 set_bit (FLAG_RADIO_OFF, &local->flags);
6803                 set_bit (FLAG_COMMIT, &local->flags);
6804                 return -EINPROGRESS;            /* Call commit handler */
6805         }
6806         if (vwrq->flags != IW_TXPOW_MWATT) {
6807                 return -EINVAL;
6808         }
6809         clear_bit (FLAG_RADIO_OFF, &local->flags);
6810         for (i = 0; cap_rid.txPowerLevels[i] && (i < 8); i++)
6811                 if (v == cap_rid.txPowerLevels[i]) {
6812                         readConfigRid(local, 1);
6813                         local->config.txPower = v;
6814                         set_bit (FLAG_COMMIT, &local->flags);
6815                         rc = -EINPROGRESS;      /* Call commit handler */
6816                         break;
6817                 }
6818         return rc;
6819 }
6820
6821 /*------------------------------------------------------------------*/
6822 /*
6823  * Wireless Handler : get Tx-Power
6824  */
6825 static int airo_get_txpow(struct net_device *dev,
6826                           struct iw_request_info *info,
6827                           struct iw_param *vwrq,
6828                           char *extra)
6829 {
6830         struct airo_info *local = dev->ml_priv;
6831
6832         readConfigRid(local, 1);
6833         vwrq->value = le16_to_cpu(local->config.txPower);
6834         vwrq->fixed = 1;        /* No power control */
6835         vwrq->disabled = test_bit(FLAG_RADIO_OFF, &local->flags);
6836         vwrq->flags = IW_TXPOW_MWATT;
6837
6838         return 0;
6839 }
6840
6841 /*------------------------------------------------------------------*/
6842 /*
6843  * Wireless Handler : set Retry limits
6844  */
6845 static int airo_set_retry(struct net_device *dev,
6846                           struct iw_request_info *info,
6847                           struct iw_param *vwrq,
6848                           char *extra)
6849 {
6850         struct airo_info *local = dev->ml_priv;
6851         int rc = -EINVAL;
6852
6853         if(vwrq->disabled) {
6854                 return -EINVAL;
6855         }
6856         readConfigRid(local, 1);
6857         if(vwrq->flags & IW_RETRY_LIMIT) {
6858                 __le16 v = cpu_to_le16(vwrq->value);
6859                 if(vwrq->flags & IW_RETRY_LONG)
6860                         local->config.longRetryLimit = v;
6861                 else if (vwrq->flags & IW_RETRY_SHORT)
6862                         local->config.shortRetryLimit = v;
6863                 else {
6864                         /* No modifier : set both */
6865                         local->config.longRetryLimit = v;
6866                         local->config.shortRetryLimit = v;
6867                 }
6868                 set_bit (FLAG_COMMIT, &local->flags);
6869                 rc = -EINPROGRESS;              /* Call commit handler */
6870         }
6871         if(vwrq->flags & IW_RETRY_LIFETIME) {
6872                 local->config.txLifetime = cpu_to_le16(vwrq->value / 1024);
6873                 set_bit (FLAG_COMMIT, &local->flags);
6874                 rc = -EINPROGRESS;              /* Call commit handler */
6875         }
6876         return rc;
6877 }
6878
6879 /*------------------------------------------------------------------*/
6880 /*
6881  * Wireless Handler : get Retry limits
6882  */
6883 static int airo_get_retry(struct net_device *dev,
6884                           struct iw_request_info *info,
6885                           struct iw_param *vwrq,
6886                           char *extra)
6887 {
6888         struct airo_info *local = dev->ml_priv;
6889
6890         vwrq->disabled = 0;      /* Can't be disabled */
6891
6892         readConfigRid(local, 1);
6893         /* Note : by default, display the min retry number */
6894         if((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
6895                 vwrq->flags = IW_RETRY_LIFETIME;
6896                 vwrq->value = le16_to_cpu(local->config.txLifetime) * 1024;
6897         } else if((vwrq->flags & IW_RETRY_LONG)) {
6898                 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
6899                 vwrq->value = le16_to_cpu(local->config.longRetryLimit);
6900         } else {
6901                 vwrq->flags = IW_RETRY_LIMIT;
6902                 vwrq->value = le16_to_cpu(local->config.shortRetryLimit);
6903                 if(local->config.shortRetryLimit != local->config.longRetryLimit)
6904                         vwrq->flags |= IW_RETRY_SHORT;
6905         }
6906
6907         return 0;
6908 }
6909
6910 /*------------------------------------------------------------------*/
6911 /*
6912  * Wireless Handler : get range info
6913  */
6914 static int airo_get_range(struct net_device *dev,
6915                           struct iw_request_info *info,
6916                           struct iw_point *dwrq,
6917                           char *extra)
6918 {
6919         struct airo_info *local = dev->ml_priv;
6920         struct iw_range *range = (struct iw_range *) extra;
6921         CapabilityRid cap_rid;          /* Card capability info */
6922         int             i;
6923         int             k;
6924
6925         readCapabilityRid(local, &cap_rid, 1);
6926
6927         dwrq->length = sizeof(struct iw_range);
6928         memset(range, 0, sizeof(*range));
6929         range->min_nwid = 0x0000;
6930         range->max_nwid = 0x0000;
6931         range->num_channels = 14;
6932         /* Should be based on cap_rid.country to give only
6933          * what the current card support */
6934         k = 0;
6935         for(i = 0; i < 14; i++) {
6936                 range->freq[k].i = i + 1; /* List index */
6937                 range->freq[k].m = ieee80211_dsss_chan_to_freq(i + 1) * 100000;
6938                 range->freq[k++].e = 1; /* Values in MHz -> * 10^5 * 10 */
6939         }
6940         range->num_frequency = k;
6941
6942         range->sensitivity = 65535;
6943
6944         /* Hum... Should put the right values there */
6945         if (local->rssi)
6946                 range->max_qual.qual = 100;     /* % */
6947         else
6948                 range->max_qual.qual = airo_get_max_quality(&cap_rid);
6949         range->max_qual.level = 0x100 - 120;    /* -120 dBm */
6950         range->max_qual.noise = 0x100 - 120;    /* -120 dBm */
6951
6952         /* Experimental measurements - boundary 11/5.5 Mb/s */
6953         /* Note : with or without the (local->rssi), results
6954          * are somewhat different. - Jean II */
6955         if (local->rssi) {
6956                 range->avg_qual.qual = 50;              /* % */
6957                 range->avg_qual.level = 0x100 - 70;     /* -70 dBm */
6958         } else {
6959                 range->avg_qual.qual = airo_get_avg_quality(&cap_rid);
6960                 range->avg_qual.level = 0x100 - 80;     /* -80 dBm */
6961         }
6962         range->avg_qual.noise = 0x100 - 85;             /* -85 dBm */
6963
6964         for(i = 0 ; i < 8 ; i++) {
6965                 range->bitrate[i] = cap_rid.supportedRates[i] * 500000;
6966                 if(range->bitrate[i] == 0)
6967                         break;
6968         }
6969         range->num_bitrates = i;
6970
6971         /* Set an indication of the max TCP throughput
6972          * in bit/s that we can expect using this interface.
6973          * May be use for QoS stuff... Jean II */
6974         if(i > 2)
6975                 range->throughput = 5000 * 1000;
6976         else
6977                 range->throughput = 1500 * 1000;
6978
6979         range->min_rts = 0;
6980         range->max_rts = AIRO_DEF_MTU;
6981         range->min_frag = 256;
6982         range->max_frag = AIRO_DEF_MTU;
6983
6984         if(cap_rid.softCap & cpu_to_le16(2)) {
6985                 // WEP: RC4 40 bits
6986                 range->encoding_size[0] = 5;
6987                 // RC4 ~128 bits
6988                 if (cap_rid.softCap & cpu_to_le16(0x100)) {
6989                         range->encoding_size[1] = 13;
6990                         range->num_encoding_sizes = 2;
6991                 } else
6992                         range->num_encoding_sizes = 1;
6993                 range->max_encoding_tokens =
6994                         cap_rid.softCap & cpu_to_le16(0x80) ? 4 : 1;
6995         } else {
6996                 range->num_encoding_sizes = 0;
6997                 range->max_encoding_tokens = 0;
6998         }
6999         range->min_pmp = 0;
7000         range->max_pmp = 5000000;       /* 5 secs */
7001         range->min_pmt = 0;
7002         range->max_pmt = 65535 * 1024;  /* ??? */
7003         range->pmp_flags = IW_POWER_PERIOD;
7004         range->pmt_flags = IW_POWER_TIMEOUT;
7005         range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
7006
7007         /* Transmit Power - values are in mW */
7008         for(i = 0 ; i < 8 ; i++) {
7009                 range->txpower[i] = le16_to_cpu(cap_rid.txPowerLevels[i]);
7010                 if(range->txpower[i] == 0)
7011                         break;
7012         }
7013         range->num_txpower = i;
7014         range->txpower_capa = IW_TXPOW_MWATT;
7015         range->we_version_source = 19;
7016         range->we_version_compiled = WIRELESS_EXT;
7017         range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
7018         range->retry_flags = IW_RETRY_LIMIT;
7019         range->r_time_flags = IW_RETRY_LIFETIME;
7020         range->min_retry = 1;
7021         range->max_retry = 65535;
7022         range->min_r_time = 1024;
7023         range->max_r_time = 65535 * 1024;
7024
7025         /* Event capability (kernel + driver) */
7026         range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
7027                                 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
7028                                 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
7029                                 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
7030         range->event_capa[1] = IW_EVENT_CAPA_K_1;
7031         range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVTXDROP);
7032         return 0;
7033 }
7034
7035 /*------------------------------------------------------------------*/
7036 /*
7037  * Wireless Handler : set Power Management
7038  */
7039 static int airo_set_power(struct net_device *dev,
7040                           struct iw_request_info *info,
7041                           struct iw_param *vwrq,
7042                           char *extra)
7043 {
7044         struct airo_info *local = dev->ml_priv;
7045
7046         readConfigRid(local, 1);
7047         if (vwrq->disabled) {
7048                 if (sniffing_mode(local))
7049                         return -EINVAL;
7050                 local->config.powerSaveMode = POWERSAVE_CAM;
7051                 local->config.rmode &= ~RXMODE_MASK;
7052                 local->config.rmode |= RXMODE_BC_MC_ADDR;
7053                 set_bit (FLAG_COMMIT, &local->flags);
7054                 return -EINPROGRESS;            /* Call commit handler */
7055         }
7056         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7057                 local->config.fastListenDelay = cpu_to_le16((vwrq->value + 500) / 1024);
7058                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7059                 set_bit (FLAG_COMMIT, &local->flags);
7060         } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
7061                 local->config.fastListenInterval =
7062                 local->config.listenInterval =
7063                         cpu_to_le16((vwrq->value + 500) / 1024);
7064                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7065                 set_bit (FLAG_COMMIT, &local->flags);
7066         }
7067         switch (vwrq->flags & IW_POWER_MODE) {
7068                 case IW_POWER_UNICAST_R:
7069                         if (sniffing_mode(local))
7070                                 return -EINVAL;
7071                         local->config.rmode &= ~RXMODE_MASK;
7072                         local->config.rmode |= RXMODE_ADDR;
7073                         set_bit (FLAG_COMMIT, &local->flags);
7074                         break;
7075                 case IW_POWER_ALL_R:
7076                         if (sniffing_mode(local))
7077                                 return -EINVAL;
7078                         local->config.rmode &= ~RXMODE_MASK;
7079                         local->config.rmode |= RXMODE_BC_MC_ADDR;
7080                         set_bit (FLAG_COMMIT, &local->flags);
7081                 case IW_POWER_ON:
7082                         /* This is broken, fixme ;-) */
7083                         break;
7084                 default:
7085                         return -EINVAL;
7086         }
7087         // Note : we may want to factor local->need_commit here
7088         // Note2 : may also want to factor RXMODE_RFMON test
7089         return -EINPROGRESS;            /* Call commit handler */
7090 }
7091
7092 /*------------------------------------------------------------------*/
7093 /*
7094  * Wireless Handler : get Power Management
7095  */
7096 static int airo_get_power(struct net_device *dev,
7097                           struct iw_request_info *info,
7098                           struct iw_param *vwrq,
7099                           char *extra)
7100 {
7101         struct airo_info *local = dev->ml_priv;
7102         __le16 mode;
7103
7104         readConfigRid(local, 1);
7105         mode = local->config.powerSaveMode;
7106         if ((vwrq->disabled = (mode == POWERSAVE_CAM)))
7107                 return 0;
7108         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7109                 vwrq->value = le16_to_cpu(local->config.fastListenDelay) * 1024;
7110                 vwrq->flags = IW_POWER_TIMEOUT;
7111         } else {
7112                 vwrq->value = le16_to_cpu(local->config.fastListenInterval) * 1024;
7113                 vwrq->flags = IW_POWER_PERIOD;
7114         }
7115         if ((local->config.rmode & RXMODE_MASK) == RXMODE_ADDR)
7116                 vwrq->flags |= IW_POWER_UNICAST_R;
7117         else
7118                 vwrq->flags |= IW_POWER_ALL_R;
7119
7120         return 0;
7121 }
7122
7123 /*------------------------------------------------------------------*/
7124 /*
7125  * Wireless Handler : set Sensitivity
7126  */
7127 static int airo_set_sens(struct net_device *dev,
7128                          struct iw_request_info *info,
7129                          struct iw_param *vwrq,
7130                          char *extra)
7131 {
7132         struct airo_info *local = dev->ml_priv;
7133
7134         readConfigRid(local, 1);
7135         local->config.rssiThreshold =
7136                 cpu_to_le16(vwrq->disabled ? RSSI_DEFAULT : vwrq->value);
7137         set_bit (FLAG_COMMIT, &local->flags);
7138
7139         return -EINPROGRESS;            /* Call commit handler */
7140 }
7141
7142 /*------------------------------------------------------------------*/
7143 /*
7144  * Wireless Handler : get Sensitivity
7145  */
7146 static int airo_get_sens(struct net_device *dev,
7147                          struct iw_request_info *info,
7148                          struct iw_param *vwrq,
7149                          char *extra)
7150 {
7151         struct airo_info *local = dev->ml_priv;
7152
7153         readConfigRid(local, 1);
7154         vwrq->value = le16_to_cpu(local->config.rssiThreshold);
7155         vwrq->disabled = (vwrq->value == 0);
7156         vwrq->fixed = 1;
7157
7158         return 0;
7159 }
7160
7161 /*------------------------------------------------------------------*/
7162 /*
7163  * Wireless Handler : get AP List
7164  * Note : this is deprecated in favor of IWSCAN
7165  */
7166 static int airo_get_aplist(struct net_device *dev,
7167                            struct iw_request_info *info,
7168                            struct iw_point *dwrq,
7169                            char *extra)
7170 {
7171         struct airo_info *local = dev->ml_priv;
7172         struct sockaddr *address = (struct sockaddr *) extra;
7173         struct iw_quality *qual;
7174         BSSListRid BSSList;
7175         int i;
7176         int loseSync = capable(CAP_NET_ADMIN) ? 1: -1;
7177
7178         qual = kmalloc(IW_MAX_AP * sizeof(*qual), GFP_KERNEL);
7179         if (!qual)
7180                 return -ENOMEM;
7181
7182         for (i = 0; i < IW_MAX_AP; i++) {
7183                 u16 dBm;
7184                 if (readBSSListRid(local, loseSync, &BSSList))
7185                         break;
7186                 loseSync = 0;
7187                 memcpy(address[i].sa_data, BSSList.bssid, ETH_ALEN);
7188                 address[i].sa_family = ARPHRD_ETHER;
7189                 dBm = le16_to_cpu(BSSList.dBm);
7190                 if (local->rssi) {
7191                         qual[i].level = 0x100 - dBm;
7192                         qual[i].qual = airo_dbm_to_pct(local->rssi, dBm);
7193                         qual[i].updated = IW_QUAL_QUAL_UPDATED
7194                                         | IW_QUAL_LEVEL_UPDATED
7195                                         | IW_QUAL_DBM;
7196                 } else {
7197                         qual[i].level = (dBm + 321) / 2;
7198                         qual[i].qual = 0;
7199                         qual[i].updated = IW_QUAL_QUAL_INVALID
7200                                         | IW_QUAL_LEVEL_UPDATED
7201                                         | IW_QUAL_DBM;
7202                 }
7203                 qual[i].noise = local->wstats.qual.noise;
7204                 if (BSSList.index == cpu_to_le16(0xffff))
7205                         break;
7206         }
7207         if (!i) {
7208                 StatusRid status_rid;           /* Card status info */
7209                 readStatusRid(local, &status_rid, 1);
7210                 for (i = 0;
7211                      i < min(IW_MAX_AP, 4) &&
7212                              (status_rid.bssid[i][0]
7213                               & status_rid.bssid[i][1]
7214                               & status_rid.bssid[i][2]
7215                               & status_rid.bssid[i][3]
7216                               & status_rid.bssid[i][4]
7217                               & status_rid.bssid[i][5])!=0xff &&
7218                              (status_rid.bssid[i][0]
7219                               | status_rid.bssid[i][1]
7220                               | status_rid.bssid[i][2]
7221                               | status_rid.bssid[i][3]
7222                               | status_rid.bssid[i][4]
7223                               | status_rid.bssid[i][5]);
7224                      i++) {
7225                         memcpy(address[i].sa_data,
7226                                status_rid.bssid[i], ETH_ALEN);
7227                         address[i].sa_family = ARPHRD_ETHER;
7228                 }
7229         } else {
7230                 dwrq->flags = 1; /* Should be define'd */
7231                 memcpy(extra + sizeof(struct sockaddr)*i,
7232                        &qual,  sizeof(struct iw_quality)*i);
7233         }
7234         dwrq->length = i;
7235
7236         kfree(qual);
7237         return 0;
7238 }
7239
7240 /*------------------------------------------------------------------*/
7241 /*
7242  * Wireless Handler : Initiate Scan
7243  */
7244 static int airo_set_scan(struct net_device *dev,
7245                          struct iw_request_info *info,
7246                          struct iw_point *dwrq,
7247                          char *extra)
7248 {
7249         struct airo_info *ai = dev->ml_priv;
7250         Cmd cmd;
7251         Resp rsp;
7252         int wake = 0;
7253
7254         /* Note : you may have realised that, as this is a SET operation,
7255          * this is privileged and therefore a normal user can't
7256          * perform scanning.
7257          * This is not an error, while the device perform scanning,
7258          * traffic doesn't flow, so it's a perfect DoS...
7259          * Jean II */
7260         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
7261
7262         if (down_interruptible(&ai->sem))
7263                 return -ERESTARTSYS;
7264
7265         /* If there's already a scan in progress, don't
7266          * trigger another one. */
7267         if (ai->scan_timeout > 0)
7268                 goto out;
7269
7270         /* Initiate a scan command */
7271         ai->scan_timeout = RUN_AT(3*HZ);
7272         memset(&cmd, 0, sizeof(cmd));
7273         cmd.cmd=CMD_LISTBSS;
7274         issuecommand(ai, &cmd, &rsp);
7275         wake = 1;
7276
7277 out:
7278         up(&ai->sem);
7279         if (wake)
7280                 wake_up_interruptible(&ai->thr_wait);
7281         return 0;
7282 }
7283
7284 /*------------------------------------------------------------------*/
7285 /*
7286  * Translate scan data returned from the card to a card independent
7287  * format that the Wireless Tools will understand - Jean II
7288  */
7289 static inline char *airo_translate_scan(struct net_device *dev,
7290                                         struct iw_request_info *info,
7291                                         char *current_ev,
7292                                         char *end_buf,
7293                                         BSSListRid *bss)
7294 {
7295         struct airo_info *ai = dev->ml_priv;
7296         struct iw_event         iwe;            /* Temporary buffer */
7297         __le16                  capabilities;
7298         char *                  current_val;    /* For rates */
7299         int                     i;
7300         char *          buf;
7301         u16 dBm;
7302
7303         /* First entry *MUST* be the AP MAC address */
7304         iwe.cmd = SIOCGIWAP;
7305         iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
7306         memcpy(iwe.u.ap_addr.sa_data, bss->bssid, ETH_ALEN);
7307         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7308                                           &iwe, IW_EV_ADDR_LEN);
7309
7310         /* Other entries will be displayed in the order we give them */
7311
7312         /* Add the ESSID */
7313         iwe.u.data.length = bss->ssidLen;
7314         if(iwe.u.data.length > 32)
7315                 iwe.u.data.length = 32;
7316         iwe.cmd = SIOCGIWESSID;
7317         iwe.u.data.flags = 1;
7318         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7319                                           &iwe, bss->ssid);
7320
7321         /* Add mode */
7322         iwe.cmd = SIOCGIWMODE;
7323         capabilities = bss->cap;
7324         if(capabilities & (CAP_ESS | CAP_IBSS)) {
7325                 if(capabilities & CAP_ESS)
7326                         iwe.u.mode = IW_MODE_MASTER;
7327                 else
7328                         iwe.u.mode = IW_MODE_ADHOC;
7329                 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7330                                                   &iwe, IW_EV_UINT_LEN);
7331         }
7332
7333         /* Add frequency */
7334         iwe.cmd = SIOCGIWFREQ;
7335         iwe.u.freq.m = le16_to_cpu(bss->dsChannel);
7336         iwe.u.freq.m = ieee80211_dsss_chan_to_freq(iwe.u.freq.m) * 100000;
7337         iwe.u.freq.e = 1;
7338         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7339                                           &iwe, IW_EV_FREQ_LEN);
7340
7341         dBm = le16_to_cpu(bss->dBm);
7342
7343         /* Add quality statistics */
7344         iwe.cmd = IWEVQUAL;
7345         if (ai->rssi) {
7346                 iwe.u.qual.level = 0x100 - dBm;
7347                 iwe.u.qual.qual = airo_dbm_to_pct(ai->rssi, dBm);
7348                 iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED
7349                                 | IW_QUAL_LEVEL_UPDATED
7350                                 | IW_QUAL_DBM;
7351         } else {
7352                 iwe.u.qual.level = (dBm + 321) / 2;
7353                 iwe.u.qual.qual = 0;
7354                 iwe.u.qual.updated = IW_QUAL_QUAL_INVALID
7355                                 | IW_QUAL_LEVEL_UPDATED
7356                                 | IW_QUAL_DBM;
7357         }
7358         iwe.u.qual.noise = ai->wstats.qual.noise;
7359         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7360                                           &iwe, IW_EV_QUAL_LEN);
7361
7362         /* Add encryption capability */
7363         iwe.cmd = SIOCGIWENCODE;
7364         if(capabilities & CAP_PRIVACY)
7365                 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
7366         else
7367                 iwe.u.data.flags = IW_ENCODE_DISABLED;
7368         iwe.u.data.length = 0;
7369         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7370                                           &iwe, bss->ssid);
7371
7372         /* Rate : stuffing multiple values in a single event require a bit
7373          * more of magic - Jean II */
7374         current_val = current_ev + iwe_stream_lcp_len(info);
7375
7376         iwe.cmd = SIOCGIWRATE;
7377         /* Those two flags are ignored... */
7378         iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
7379         /* Max 8 values */
7380         for(i = 0 ; i < 8 ; i++) {
7381                 /* NULL terminated */
7382                 if(bss->rates[i] == 0)
7383                         break;
7384                 /* Bit rate given in 500 kb/s units (+ 0x80) */
7385                 iwe.u.bitrate.value = ((bss->rates[i] & 0x7f) * 500000);
7386                 /* Add new value to event */
7387                 current_val = iwe_stream_add_value(info, current_ev,
7388                                                    current_val, end_buf,
7389                                                    &iwe, IW_EV_PARAM_LEN);
7390         }
7391         /* Check if we added any event */
7392         if ((current_val - current_ev) > iwe_stream_lcp_len(info))
7393                 current_ev = current_val;
7394
7395         /* Beacon interval */
7396         buf = kmalloc(30, GFP_KERNEL);
7397         if (buf) {
7398                 iwe.cmd = IWEVCUSTOM;
7399                 sprintf(buf, "bcn_int=%d", bss->beaconInterval);
7400                 iwe.u.data.length = strlen(buf);
7401                 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7402                                                   &iwe, buf);
7403                 kfree(buf);
7404         }
7405
7406         /* Put WPA/RSN Information Elements into the event stream */
7407         if (test_bit(FLAG_WPA_CAPABLE, &ai->flags)) {
7408                 unsigned int num_null_ies = 0;
7409                 u16 length = sizeof (bss->extra.iep);
7410                 u8 *ie = (void *)&bss->extra.iep;
7411
7412                 while ((length >= 2) && (num_null_ies < 2)) {
7413                         if (2 + ie[1] > length) {
7414                                 /* Invalid element, don't continue parsing IE */
7415                                 break;
7416                         }
7417
7418                         switch (ie[0]) {
7419                         case WLAN_EID_SSID:
7420                                 /* Two zero-length SSID elements
7421                                  * mean we're done parsing elements */
7422                                 if (!ie[1])
7423                                         num_null_ies++;
7424                                 break;
7425
7426                         case WLAN_EID_GENERIC:
7427                                 if (ie[1] >= 4 &&
7428                                     ie[2] == 0x00 &&
7429                                     ie[3] == 0x50 &&
7430                                     ie[4] == 0xf2 &&
7431                                     ie[5] == 0x01) {
7432                                         iwe.cmd = IWEVGENIE;
7433                                         /* 64 is an arbitrary cut-off */
7434                                         iwe.u.data.length = min(ie[1] + 2,
7435                                                                 64);
7436                                         current_ev = iwe_stream_add_point(
7437                                                         info, current_ev,
7438                                                         end_buf, &iwe, ie);
7439                                 }
7440                                 break;
7441
7442                         case WLAN_EID_RSN:
7443                                 iwe.cmd = IWEVGENIE;
7444                                 /* 64 is an arbitrary cut-off */
7445                                 iwe.u.data.length = min(ie[1] + 2, 64);
7446                                 current_ev = iwe_stream_add_point(
7447                                         info, current_ev, end_buf,
7448                                         &iwe, ie);
7449                                 break;
7450
7451                         default:
7452                                 break;
7453                         }
7454
7455                         length -= 2 + ie[1];
7456                         ie += 2 + ie[1];
7457                 }
7458         }
7459         return current_ev;
7460 }
7461
7462 /*------------------------------------------------------------------*/
7463 /*
7464  * Wireless Handler : Read Scan Results
7465  */
7466 static int airo_get_scan(struct net_device *dev,
7467                          struct iw_request_info *info,
7468                          struct iw_point *dwrq,
7469                          char *extra)
7470 {
7471         struct airo_info *ai = dev->ml_priv;
7472         BSSListElement *net;
7473         int err = 0;
7474         char *current_ev = extra;
7475
7476         /* If a scan is in-progress, return -EAGAIN */
7477         if (ai->scan_timeout > 0)
7478                 return -EAGAIN;
7479
7480         if (down_interruptible(&ai->sem))
7481                 return -EAGAIN;
7482
7483         list_for_each_entry (net, &ai->network_list, list) {
7484                 /* Translate to WE format this entry */
7485                 current_ev = airo_translate_scan(dev, info, current_ev,
7486                                                  extra + dwrq->length,
7487                                                  &net->bss);
7488
7489                 /* Check if there is space for one more entry */
7490                 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
7491                         /* Ask user space to try again with a bigger buffer */
7492                         err = -E2BIG;
7493                         goto out;
7494                 }
7495         }
7496
7497         /* Length of data */
7498         dwrq->length = (current_ev - extra);
7499         dwrq->flags = 0;        /* todo */
7500
7501 out:
7502         up(&ai->sem);
7503         return err;
7504 }
7505
7506 /*------------------------------------------------------------------*/
7507 /*
7508  * Commit handler : called after a bunch of SET operations
7509  */
7510 static int airo_config_commit(struct net_device *dev,
7511                               struct iw_request_info *info,     /* NULL */
7512                               void *zwrq,                       /* NULL */
7513                               char *extra)                      /* NULL */
7514 {
7515         struct airo_info *local = dev->ml_priv;
7516
7517         if (!test_bit (FLAG_COMMIT, &local->flags))
7518                 return 0;
7519
7520         /* Some of the "SET" function may have modified some of the
7521          * parameters. It's now time to commit them in the card */
7522         disable_MAC(local, 1);
7523         if (test_bit (FLAG_RESET, &local->flags)) {
7524                 APListRid APList_rid;
7525                 SsidRid SSID_rid;
7526
7527                 readAPListRid(local, &APList_rid);
7528                 readSsidRid(local, &SSID_rid);
7529                 if (test_bit(FLAG_MPI,&local->flags))
7530                         setup_card(local, dev->dev_addr, 1 );
7531                 else
7532                         reset_airo_card(dev);
7533                 disable_MAC(local, 1);
7534                 writeSsidRid(local, &SSID_rid, 1);
7535                 writeAPListRid(local, &APList_rid, 1);
7536         }
7537         if (down_interruptible(&local->sem))
7538                 return -ERESTARTSYS;
7539         writeConfigRid(local, 0);
7540         enable_MAC(local, 0);
7541         if (test_bit (FLAG_RESET, &local->flags))
7542                 airo_set_promisc(local);
7543         else
7544                 up(&local->sem);
7545
7546         return 0;
7547 }
7548
7549 /*------------------------------------------------------------------*/
7550 /*
7551  * Structures to export the Wireless Handlers
7552  */
7553
7554 static const struct iw_priv_args airo_private_args[] = {
7555 /*{ cmd,         set_args,                            get_args, name } */
7556   { AIROIOCTL, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7557     IW_PRIV_TYPE_BYTE | 2047, "airoioctl" },
7558   { AIROIDIFC, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7559     IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "airoidifc" },
7560 };
7561
7562 static const iw_handler         airo_handler[] =
7563 {
7564         (iw_handler) airo_config_commit,        /* SIOCSIWCOMMIT */
7565         (iw_handler) airo_get_name,             /* SIOCGIWNAME */
7566         (iw_handler) NULL,                      /* SIOCSIWNWID */
7567         (iw_handler) NULL,                      /* SIOCGIWNWID */
7568         (iw_handler) airo_set_freq,             /* SIOCSIWFREQ */
7569         (iw_handler) airo_get_freq,             /* SIOCGIWFREQ */
7570         (iw_handler) airo_set_mode,             /* SIOCSIWMODE */
7571         (iw_handler) airo_get_mode,             /* SIOCGIWMODE */
7572         (iw_handler) airo_set_sens,             /* SIOCSIWSENS */
7573         (iw_handler) airo_get_sens,             /* SIOCGIWSENS */
7574         (iw_handler) NULL,                      /* SIOCSIWRANGE */
7575         (iw_handler) airo_get_range,            /* SIOCGIWRANGE */
7576         (iw_handler) NULL,                      /* SIOCSIWPRIV */
7577         (iw_handler) NULL,                      /* SIOCGIWPRIV */
7578         (iw_handler) NULL,                      /* SIOCSIWSTATS */
7579         (iw_handler) NULL,                      /* SIOCGIWSTATS */
7580         iw_handler_set_spy,                     /* SIOCSIWSPY */
7581         iw_handler_get_spy,                     /* SIOCGIWSPY */
7582         iw_handler_set_thrspy,                  /* SIOCSIWTHRSPY */
7583         iw_handler_get_thrspy,                  /* SIOCGIWTHRSPY */
7584         (iw_handler) airo_set_wap,              /* SIOCSIWAP */
7585         (iw_handler) airo_get_wap,              /* SIOCGIWAP */
7586         (iw_handler) NULL,                      /* -- hole -- */
7587         (iw_handler) airo_get_aplist,           /* SIOCGIWAPLIST */
7588         (iw_handler) airo_set_scan,             /* SIOCSIWSCAN */
7589         (iw_handler) airo_get_scan,             /* SIOCGIWSCAN */
7590         (iw_handler) airo_set_essid,            /* SIOCSIWESSID */
7591         (iw_handler) airo_get_essid,            /* SIOCGIWESSID */
7592         (iw_handler) airo_set_nick,             /* SIOCSIWNICKN */
7593         (iw_handler) airo_get_nick,             /* SIOCGIWNICKN */
7594         (iw_handler) NULL,                      /* -- hole -- */
7595         (iw_handler) NULL,                      /* -- hole -- */
7596         (iw_handler) airo_set_rate,             /* SIOCSIWRATE */
7597         (iw_handler) airo_get_rate,             /* SIOCGIWRATE */
7598         (iw_handler) airo_set_rts,              /* SIOCSIWRTS */
7599         (iw_handler) airo_get_rts,              /* SIOCGIWRTS */
7600         (iw_handler) airo_set_frag,             /* SIOCSIWFRAG */
7601         (iw_handler) airo_get_frag,             /* SIOCGIWFRAG */
7602         (iw_handler) airo_set_txpow,            /* SIOCSIWTXPOW */
7603         (iw_handler) airo_get_txpow,            /* SIOCGIWTXPOW */
7604         (iw_handler) airo_set_retry,            /* SIOCSIWRETRY */
7605         (iw_handler) airo_get_retry,            /* SIOCGIWRETRY */
7606         (iw_handler) airo_set_encode,           /* SIOCSIWENCODE */
7607         (iw_handler) airo_get_encode,           /* SIOCGIWENCODE */
7608         (iw_handler) airo_set_power,            /* SIOCSIWPOWER */
7609         (iw_handler) airo_get_power,            /* SIOCGIWPOWER */
7610         (iw_handler) NULL,                      /* -- hole -- */
7611         (iw_handler) NULL,                      /* -- hole -- */
7612         (iw_handler) NULL,                      /* SIOCSIWGENIE */
7613         (iw_handler) NULL,                      /* SIOCGIWGENIE */
7614         (iw_handler) airo_set_auth,             /* SIOCSIWAUTH */
7615         (iw_handler) airo_get_auth,             /* SIOCGIWAUTH */
7616         (iw_handler) airo_set_encodeext,        /* SIOCSIWENCODEEXT */
7617         (iw_handler) airo_get_encodeext,        /* SIOCGIWENCODEEXT */
7618         (iw_handler) NULL,                      /* SIOCSIWPMKSA */
7619 };
7620
7621 /* Note : don't describe AIROIDIFC and AIROOLDIDIFC in here.
7622  * We want to force the use of the ioctl code, because those can't be
7623  * won't work the iw_handler code (because they simultaneously read
7624  * and write data and iw_handler can't do that).
7625  * Note that it's perfectly legal to read/write on a single ioctl command,
7626  * you just can't use iwpriv and need to force it via the ioctl handler.
7627  * Jean II */
7628 static const iw_handler         airo_private_handler[] =
7629 {
7630         NULL,                           /* SIOCIWFIRSTPRIV */
7631 };
7632
7633 static const struct iw_handler_def      airo_handler_def =
7634 {
7635         .num_standard   = ARRAY_SIZE(airo_handler),
7636         .num_private    = ARRAY_SIZE(airo_private_handler),
7637         .num_private_args = ARRAY_SIZE(airo_private_args),
7638         .standard       = airo_handler,
7639         .private        = airo_private_handler,
7640         .private_args   = airo_private_args,
7641         .get_wireless_stats = airo_get_wireless_stats,
7642 };
7643
7644 /*
7645  * This defines the configuration part of the Wireless Extensions
7646  * Note : irq and spinlock protection will occur in the subroutines
7647  *
7648  * TODO :
7649  *      o Check input value more carefully and fill correct values in range
7650  *      o Test and shakeout the bugs (if any)
7651  *
7652  * Jean II
7653  *
7654  * Javier Achirica did a great job of merging code from the unnamed CISCO
7655  * developer that added support for flashing the card.
7656  */
7657 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
7658 {
7659         int rc = 0;
7660         struct airo_info *ai = dev->ml_priv;
7661
7662         if (ai->power.event)
7663                 return 0;
7664
7665         switch (cmd) {
7666 #ifdef CISCO_EXT
7667         case AIROIDIFC:
7668 #ifdef AIROOLDIDIFC
7669         case AIROOLDIDIFC:
7670 #endif
7671         {
7672                 int val = AIROMAGIC;
7673                 aironet_ioctl com;
7674                 if (copy_from_user(&com,rq->ifr_data,sizeof(com)))
7675                         rc = -EFAULT;
7676                 else if (copy_to_user(com.data,(char *)&val,sizeof(val)))
7677                         rc = -EFAULT;
7678         }
7679         break;
7680
7681         case AIROIOCTL:
7682 #ifdef AIROOLDIOCTL
7683         case AIROOLDIOCTL:
7684 #endif
7685                 /* Get the command struct and hand it off for evaluation by
7686                  * the proper subfunction
7687                  */
7688         {
7689                 aironet_ioctl com;
7690                 if (copy_from_user(&com,rq->ifr_data,sizeof(com))) {
7691                         rc = -EFAULT;
7692                         break;
7693                 }
7694
7695                 /* Separate R/W functions bracket legality here
7696                  */
7697                 if ( com.command == AIRORSWVERSION ) {
7698                         if (copy_to_user(com.data, swversion, sizeof(swversion)))
7699                                 rc = -EFAULT;
7700                         else
7701                                 rc = 0;
7702                 }
7703                 else if ( com.command <= AIRORRID)
7704                         rc = readrids(dev,&com);
7705                 else if ( com.command >= AIROPCAP && com.command <= (AIROPLEAPUSR+2) )
7706                         rc = writerids(dev,&com);
7707                 else if ( com.command >= AIROFLSHRST && com.command <= AIRORESTART )
7708                         rc = flashcard(dev,&com);
7709                 else
7710                         rc = -EINVAL;      /* Bad command in ioctl */
7711         }
7712         break;
7713 #endif /* CISCO_EXT */
7714
7715         // All other calls are currently unsupported
7716         default:
7717                 rc = -EOPNOTSUPP;
7718         }
7719         return rc;
7720 }
7721
7722 /*
7723  * Get the Wireless stats out of the driver
7724  * Note : irq and spinlock protection will occur in the subroutines
7725  *
7726  * TODO :
7727  *      o Check if work in Ad-Hoc mode (otherwise, use SPY, as in wvlan_cs)
7728  *
7729  * Jean
7730  */
7731 static void airo_read_wireless_stats(struct airo_info *local)
7732 {
7733         StatusRid status_rid;
7734         StatsRid stats_rid;
7735         CapabilityRid cap_rid;
7736         __le32 *vals = stats_rid.vals;
7737
7738         /* Get stats out of the card */
7739         clear_bit(JOB_WSTATS, &local->jobs);
7740         if (local->power.event) {
7741                 up(&local->sem);
7742                 return;
7743         }
7744         readCapabilityRid(local, &cap_rid, 0);
7745         readStatusRid(local, &status_rid, 0);
7746         readStatsRid(local, &stats_rid, RID_STATS, 0);
7747         up(&local->sem);
7748
7749         /* The status */
7750         local->wstats.status = le16_to_cpu(status_rid.mode);
7751
7752         /* Signal quality and co */
7753         if (local->rssi) {
7754                 local->wstats.qual.level =
7755                         airo_rssi_to_dbm(local->rssi,
7756                                          le16_to_cpu(status_rid.sigQuality));
7757                 /* normalizedSignalStrength appears to be a percentage */
7758                 local->wstats.qual.qual =
7759                         le16_to_cpu(status_rid.normalizedSignalStrength);
7760         } else {
7761                 local->wstats.qual.level =
7762                         (le16_to_cpu(status_rid.normalizedSignalStrength) + 321) / 2;
7763                 local->wstats.qual.qual = airo_get_quality(&status_rid, &cap_rid);
7764         }
7765         if (le16_to_cpu(status_rid.len) >= 124) {
7766                 local->wstats.qual.noise = 0x100 - status_rid.noisedBm;
7767                 local->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
7768         } else {
7769                 local->wstats.qual.noise = 0;
7770                 local->wstats.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID | IW_QUAL_DBM;
7771         }
7772
7773         /* Packets discarded in the wireless adapter due to wireless
7774          * specific problems */
7775         local->wstats.discard.nwid = le32_to_cpu(vals[56]) +
7776                                      le32_to_cpu(vals[57]) +
7777                                      le32_to_cpu(vals[58]); /* SSID Mismatch */
7778         local->wstats.discard.code = le32_to_cpu(vals[6]);/* RxWepErr */
7779         local->wstats.discard.fragment = le32_to_cpu(vals[30]);
7780         local->wstats.discard.retries = le32_to_cpu(vals[10]);
7781         local->wstats.discard.misc = le32_to_cpu(vals[1]) +
7782                                      le32_to_cpu(vals[32]);
7783         local->wstats.miss.beacon = le32_to_cpu(vals[34]);
7784 }
7785
7786 static struct iw_statistics *airo_get_wireless_stats(struct net_device *dev)
7787 {
7788         struct airo_info *local =  dev->ml_priv;
7789
7790         if (!test_bit(JOB_WSTATS, &local->jobs)) {
7791                 /* Get stats out of the card if available */
7792                 if (down_trylock(&local->sem) != 0) {
7793                         set_bit(JOB_WSTATS, &local->jobs);
7794                         wake_up_interruptible(&local->thr_wait);
7795                 } else
7796                         airo_read_wireless_stats(local);
7797         }
7798
7799         return &local->wstats;
7800 }
7801
7802 #ifdef CISCO_EXT
7803 /*
7804  * This just translates from driver IOCTL codes to the command codes to
7805  * feed to the radio's host interface. Things can be added/deleted
7806  * as needed.  This represents the READ side of control I/O to
7807  * the card
7808  */
7809 static int readrids(struct net_device *dev, aironet_ioctl *comp) {
7810         unsigned short ridcode;
7811         unsigned char *iobuf;
7812         int len;
7813         struct airo_info *ai = dev->ml_priv;
7814
7815         if (test_bit(FLAG_FLASHING, &ai->flags))
7816                 return -EIO;
7817
7818         switch(comp->command)
7819         {
7820         case AIROGCAP:      ridcode = RID_CAPABILITIES; break;
7821         case AIROGCFG:      ridcode = RID_CONFIG;
7822                 if (test_bit(FLAG_COMMIT, &ai->flags)) {
7823                         disable_MAC (ai, 1);
7824                         writeConfigRid (ai, 1);
7825                         enable_MAC(ai, 1);
7826                 }
7827                 break;
7828         case AIROGSLIST:    ridcode = RID_SSID;         break;
7829         case AIROGVLIST:    ridcode = RID_APLIST;       break;
7830         case AIROGDRVNAM:   ridcode = RID_DRVNAME;      break;
7831         case AIROGEHTENC:   ridcode = RID_ETHERENCAP;   break;
7832         case AIROGWEPKTMP:  ridcode = RID_WEP_TEMP;
7833                 /* Only super-user can read WEP keys */
7834                 if (!capable(CAP_NET_ADMIN))
7835                         return -EPERM;
7836                 break;
7837         case AIROGWEPKNV:   ridcode = RID_WEP_PERM;
7838                 /* Only super-user can read WEP keys */
7839                 if (!capable(CAP_NET_ADMIN))
7840                         return -EPERM;
7841                 break;
7842         case AIROGSTAT:     ridcode = RID_STATUS;       break;
7843         case AIROGSTATSD32: ridcode = RID_STATSDELTA;   break;
7844         case AIROGSTATSC32: ridcode = RID_STATS;        break;
7845         case AIROGMICSTATS:
7846                 if (copy_to_user(comp->data, &ai->micstats,
7847                                  min((int)comp->len,(int)sizeof(ai->micstats))))
7848                         return -EFAULT;
7849                 return 0;
7850         case AIRORRID:      ridcode = comp->ridnum;     break;
7851         default:
7852                 return -EINVAL;
7853                 break;
7854         }
7855
7856         if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7857                 return -ENOMEM;
7858
7859         PC4500_readrid(ai,ridcode,iobuf,RIDSIZE, 1);
7860         /* get the count of bytes in the rid  docs say 1st 2 bytes is it.
7861          * then return it to the user
7862          * 9/22/2000 Honor user given length
7863          */
7864         len = comp->len;
7865
7866         if (copy_to_user(comp->data, iobuf, min(len, (int)RIDSIZE))) {
7867                 kfree (iobuf);
7868                 return -EFAULT;
7869         }
7870         kfree (iobuf);
7871         return 0;
7872 }
7873
7874 /*
7875  * Danger Will Robinson write the rids here
7876  */
7877
7878 static int writerids(struct net_device *dev, aironet_ioctl *comp) {
7879         struct airo_info *ai = dev->ml_priv;
7880         int  ridcode;
7881         int  enabled;
7882         static int (* writer)(struct airo_info *, u16 rid, const void *, int, int);
7883         unsigned char *iobuf;
7884
7885         /* Only super-user can write RIDs */
7886         if (!capable(CAP_NET_ADMIN))
7887                 return -EPERM;
7888
7889         if (test_bit(FLAG_FLASHING, &ai->flags))
7890                 return -EIO;
7891
7892         ridcode = 0;
7893         writer = do_writerid;
7894
7895         switch(comp->command)
7896         {
7897         case AIROPSIDS:     ridcode = RID_SSID;         break;
7898         case AIROPCAP:      ridcode = RID_CAPABILITIES; break;
7899         case AIROPAPLIST:   ridcode = RID_APLIST;       break;
7900         case AIROPCFG: ai->config.len = 0;
7901                             clear_bit(FLAG_COMMIT, &ai->flags);
7902                             ridcode = RID_CONFIG;       break;
7903         case AIROPWEPKEYNV: ridcode = RID_WEP_PERM;     break;
7904         case AIROPLEAPUSR:  ridcode = RID_LEAPUSERNAME; break;
7905         case AIROPLEAPPWD:  ridcode = RID_LEAPPASSWORD; break;
7906         case AIROPWEPKEY:   ridcode = RID_WEP_TEMP; writer = PC4500_writerid;
7907                 break;
7908         case AIROPLEAPUSR+1: ridcode = 0xFF2A;          break;
7909         case AIROPLEAPUSR+2: ridcode = 0xFF2B;          break;
7910
7911                 /* this is not really a rid but a command given to the card
7912                  * same with MAC off
7913                  */
7914         case AIROPMACON:
7915                 if (enable_MAC(ai, 1) != 0)
7916                         return -EIO;
7917                 return 0;
7918
7919                 /*
7920                  * Evidently this code in the airo driver does not get a symbol
7921                  * as disable_MAC. it's probably so short the compiler does not gen one.
7922                  */
7923         case AIROPMACOFF:
7924                 disable_MAC(ai, 1);
7925                 return 0;
7926
7927                 /* This command merely clears the counts does not actually store any data
7928                  * only reads rid. But as it changes the cards state, I put it in the
7929                  * writerid routines.
7930                  */
7931         case AIROPSTCLR:
7932                 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7933                         return -ENOMEM;
7934
7935                 PC4500_readrid(ai,RID_STATSDELTACLEAR,iobuf,RIDSIZE, 1);
7936
7937                 enabled = ai->micstats.enabled;
7938                 memset(&ai->micstats,0,sizeof(ai->micstats));
7939                 ai->micstats.enabled = enabled;
7940
7941                 if (copy_to_user(comp->data, iobuf,
7942                                  min((int)comp->len, (int)RIDSIZE))) {
7943                         kfree (iobuf);
7944                         return -EFAULT;
7945                 }
7946                 kfree (iobuf);
7947                 return 0;
7948
7949         default:
7950                 return -EOPNOTSUPP;     /* Blarg! */
7951         }
7952         if(comp->len > RIDSIZE)
7953                 return -EINVAL;
7954
7955         if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7956                 return -ENOMEM;
7957
7958         if (copy_from_user(iobuf,comp->data,comp->len)) {
7959                 kfree (iobuf);
7960                 return -EFAULT;
7961         }
7962
7963         if (comp->command == AIROPCFG) {
7964                 ConfigRid *cfg = (ConfigRid *)iobuf;
7965
7966                 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags))
7967                         cfg->opmode |= MODE_MIC;
7968
7969                 if ((cfg->opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
7970                         set_bit (FLAG_ADHOC, &ai->flags);
7971                 else
7972                         clear_bit (FLAG_ADHOC, &ai->flags);
7973         }
7974
7975         if((*writer)(ai, ridcode, iobuf,comp->len,1)) {
7976                 kfree (iobuf);
7977                 return -EIO;
7978         }
7979         kfree (iobuf);
7980         return 0;
7981 }
7982
7983 /*****************************************************************************
7984  * Ancillary flash / mod functions much black magic lurkes here              *
7985  *****************************************************************************
7986  */
7987
7988 /*
7989  * Flash command switch table
7990  */
7991
7992 static int flashcard(struct net_device *dev, aironet_ioctl *comp) {
7993         int z;
7994
7995         /* Only super-user can modify flash */
7996         if (!capable(CAP_NET_ADMIN))
7997                 return -EPERM;
7998
7999         switch(comp->command)
8000         {
8001         case AIROFLSHRST:
8002                 return cmdreset((struct airo_info *)dev->ml_priv);
8003
8004         case AIROFLSHSTFL:
8005                 if (!AIRO_FLASH(dev) &&
8006                     (AIRO_FLASH(dev) = kmalloc(FLASHSIZE, GFP_KERNEL)) == NULL)
8007                         return -ENOMEM;
8008                 return setflashmode((struct airo_info *)dev->ml_priv);
8009
8010         case AIROFLSHGCHR: /* Get char from aux */
8011                 if(comp->len != sizeof(int))
8012                         return -EINVAL;
8013                 if (copy_from_user(&z,comp->data,comp->len))
8014                         return -EFAULT;
8015                 return flashgchar((struct airo_info *)dev->ml_priv, z, 8000);
8016
8017         case AIROFLSHPCHR: /* Send char to card. */
8018                 if(comp->len != sizeof(int))
8019                         return -EINVAL;
8020                 if (copy_from_user(&z,comp->data,comp->len))
8021                         return -EFAULT;
8022                 return flashpchar((struct airo_info *)dev->ml_priv, z, 8000);
8023
8024         case AIROFLPUTBUF: /* Send 32k to card */
8025                 if (!AIRO_FLASH(dev))
8026                         return -ENOMEM;
8027                 if(comp->len > FLASHSIZE)
8028                         return -EINVAL;
8029                 if (copy_from_user(AIRO_FLASH(dev), comp->data, comp->len))
8030                         return -EFAULT;
8031
8032                 flashputbuf((struct airo_info *)dev->ml_priv);
8033                 return 0;
8034
8035         case AIRORESTART:
8036                 if (flashrestart((struct airo_info *)dev->ml_priv, dev))
8037                         return -EIO;
8038                 return 0;
8039         }
8040         return -EINVAL;
8041 }
8042
8043 #define FLASH_COMMAND  0x7e7e
8044
8045 /*
8046  * STEP 1)
8047  * Disable MAC and do soft reset on
8048  * card.
8049  */
8050
8051 static int cmdreset(struct airo_info *ai) {
8052         disable_MAC(ai, 1);
8053
8054         if(!waitbusy (ai)){
8055                 airo_print_info(ai->dev->name, "Waitbusy hang before RESET");
8056                 return -EBUSY;
8057         }
8058
8059         OUT4500(ai,COMMAND,CMD_SOFTRESET);
8060
8061         ssleep(1);                      /* WAS 600 12/7/00 */
8062
8063         if(!waitbusy (ai)){
8064                 airo_print_info(ai->dev->name, "Waitbusy hang AFTER RESET");
8065                 return -EBUSY;
8066         }
8067         return 0;
8068 }
8069
8070 /* STEP 2)
8071  * Put the card in legendary flash
8072  * mode
8073  */
8074
8075 static int setflashmode (struct airo_info *ai) {
8076         set_bit (FLAG_FLASHING, &ai->flags);
8077
8078         OUT4500(ai, SWS0, FLASH_COMMAND);
8079         OUT4500(ai, SWS1, FLASH_COMMAND);
8080         if (probe) {
8081                 OUT4500(ai, SWS0, FLASH_COMMAND);
8082                 OUT4500(ai, COMMAND,0x10);
8083         } else {
8084                 OUT4500(ai, SWS2, FLASH_COMMAND);
8085                 OUT4500(ai, SWS3, FLASH_COMMAND);
8086                 OUT4500(ai, COMMAND,0);
8087         }
8088         msleep(500);            /* 500ms delay */
8089
8090         if(!waitbusy(ai)) {
8091                 clear_bit (FLAG_FLASHING, &ai->flags);
8092                 airo_print_info(ai->dev->name, "Waitbusy hang after setflash mode");
8093                 return -EIO;
8094         }
8095         return 0;
8096 }
8097
8098 /* Put character to SWS0 wait for dwelltime
8099  * x 50us for  echo .
8100  */
8101
8102 static int flashpchar(struct airo_info *ai,int byte,int dwelltime) {
8103         int echo;
8104         int waittime;
8105
8106         byte |= 0x8000;
8107
8108         if(dwelltime == 0 )
8109                 dwelltime = 200;
8110
8111         waittime=dwelltime;
8112
8113         /* Wait for busy bit d15 to go false indicating buffer empty */
8114         while ((IN4500 (ai, SWS0) & 0x8000) && waittime > 0) {
8115                 udelay (50);
8116                 waittime -= 50;
8117         }
8118
8119         /* timeout for busy clear wait */
8120         if(waittime <= 0 ){
8121                 airo_print_info(ai->dev->name, "flash putchar busywait timeout!");
8122                 return -EBUSY;
8123         }
8124
8125         /* Port is clear now write byte and wait for it to echo back */
8126         do {
8127                 OUT4500(ai,SWS0,byte);
8128                 udelay(50);
8129                 dwelltime -= 50;
8130                 echo = IN4500(ai,SWS1);
8131         } while (dwelltime >= 0 && echo != byte);
8132
8133         OUT4500(ai,SWS1,0);
8134
8135         return (echo == byte) ? 0 : -EIO;
8136 }
8137
8138 /*
8139  * Get a character from the card matching matchbyte
8140  * Step 3)
8141  */
8142 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime){
8143         int           rchar;
8144         unsigned char rbyte=0;
8145
8146         do {
8147                 rchar = IN4500(ai,SWS1);
8148
8149                 if(dwelltime && !(0x8000 & rchar)){
8150                         dwelltime -= 10;
8151                         mdelay(10);
8152                         continue;
8153                 }
8154                 rbyte = 0xff & rchar;
8155
8156                 if( (rbyte == matchbyte) && (0x8000 & rchar) ){
8157                         OUT4500(ai,SWS1,0);
8158                         return 0;
8159                 }
8160                 if( rbyte == 0x81 || rbyte == 0x82 || rbyte == 0x83 || rbyte == 0x1a || 0xffff == rchar)
8161                         break;
8162                 OUT4500(ai,SWS1,0);
8163
8164         }while(dwelltime > 0);
8165         return -EIO;
8166 }
8167
8168 /*
8169  * Transfer 32k of firmware data from user buffer to our buffer and
8170  * send to the card
8171  */
8172
8173 static int flashputbuf(struct airo_info *ai){
8174         int            nwords;
8175
8176         /* Write stuff */
8177         if (test_bit(FLAG_MPI,&ai->flags))
8178                 memcpy_toio(ai->pciaux + 0x8000, ai->flash, FLASHSIZE);
8179         else {
8180                 OUT4500(ai,AUXPAGE,0x100);
8181                 OUT4500(ai,AUXOFF,0);
8182
8183                 for(nwords=0;nwords != FLASHSIZE / 2;nwords++){
8184                         OUT4500(ai,AUXDATA,ai->flash[nwords] & 0xffff);
8185                 }
8186         }
8187         OUT4500(ai,SWS0,0x8000);
8188
8189         return 0;
8190 }
8191
8192 /*
8193  *
8194  */
8195 static int flashrestart(struct airo_info *ai,struct net_device *dev){
8196         int    i,status;
8197
8198         ssleep(1);                      /* Added 12/7/00 */
8199         clear_bit (FLAG_FLASHING, &ai->flags);
8200         if (test_bit(FLAG_MPI, &ai->flags)) {
8201                 status = mpi_init_descriptors(ai);
8202                 if (status != SUCCESS)
8203                         return status;
8204         }
8205         status = setup_card(ai, dev->dev_addr, 1);
8206
8207         if (!test_bit(FLAG_MPI,&ai->flags))
8208                 for( i = 0; i < MAX_FIDS; i++ ) {
8209                         ai->fids[i] = transmit_allocate
8210                                 ( ai, AIRO_DEF_MTU, i >= MAX_FIDS / 2 );
8211                 }
8212
8213         ssleep(1);                      /* Added 12/7/00 */
8214         return status;
8215 }
8216 #endif /* CISCO_EXT */
8217
8218 /*
8219     This program is free software; you can redistribute it and/or
8220     modify it under the terms of the GNU General Public License
8221     as published by the Free Software Foundation; either version 2
8222     of the License, or (at your option) any later version.
8223
8224     This program is distributed in the hope that it will be useful,
8225     but WITHOUT ANY WARRANTY; without even the implied warranty of
8226     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
8227     GNU General Public License for more details.
8228
8229     In addition:
8230
8231     Redistribution and use in source and binary forms, with or without
8232     modification, are permitted provided that the following conditions
8233     are met:
8234
8235     1. Redistributions of source code must retain the above copyright
8236        notice, this list of conditions and the following disclaimer.
8237     2. Redistributions in binary form must reproduce the above copyright
8238        notice, this list of conditions and the following disclaimer in the
8239        documentation and/or other materials provided with the distribution.
8240     3. The name of the author may not be used to endorse or promote
8241        products derived from this software without specific prior written
8242        permission.
8243
8244     THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
8245     IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
8246     WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
8247     ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
8248     INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
8249     (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
8250     SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
8251     HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
8252     STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
8253     IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
8254     POSSIBILITY OF SUCH DAMAGE.
8255 */
8256
8257 module_init(airo_init_module);
8258 module_exit(airo_cleanup_module);