iwlwifi: mvm: disallow new TDLS stations when appropriate
[cascardo/linux.git] / 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 <linux/io.h>
40 #include <asm/unaligned.h>
41
42 #include <linux/netdevice.h>
43 #include <linux/etherdevice.h>
44 #include <linux/skbuff.h>
45 #include <linux/if_arp.h>
46 #include <linux/ioport.h>
47 #include <linux/pci.h>
48 #include <linux/uaccess.h>
49 #include <linux/kthread.h>
50 #include <linux/freezer.h>
51
52 #include <net/cfg80211.h>
53 #include <net/iw_handler.h>
54
55 #include "airo.h"
56
57 #define DRV_NAME "airo"
58
59 #ifdef CONFIG_PCI
60 static DEFINE_PCI_DEVICE_TABLE(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   = 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
91 #define CISCO_EXT               /* enable Cisco extensions */
92 #ifdef CISCO_EXT
93 #include <linux/delay.h>
94 #endif
95
96 /* Hack to do some power saving */
97 #define POWER_ON_DOWN
98
99 /* As you can see this list is HUGH!
100    I really don't know what a lot of these counts are about, but they
101    are all here for completeness.  If the IGNLABEL macro is put in
102    infront of the label, that statistic will not be included in the list
103    of statistics in the /proc filesystem */
104
105 #define IGNLABEL(comment) NULL
106 static const char *statsLabels[] = {
107         "RxOverrun",
108         IGNLABEL("RxPlcpCrcErr"),
109         IGNLABEL("RxPlcpFormatErr"),
110         IGNLABEL("RxPlcpLengthErr"),
111         "RxMacCrcErr",
112         "RxMacCrcOk",
113         "RxWepErr",
114         "RxWepOk",
115         "RetryLong",
116         "RetryShort",
117         "MaxRetries",
118         "NoAck",
119         "NoCts",
120         "RxAck",
121         "RxCts",
122         "TxAck",
123         "TxRts",
124         "TxCts",
125         "TxMc",
126         "TxBc",
127         "TxUcFrags",
128         "TxUcPackets",
129         "TxBeacon",
130         "RxBeacon",
131         "TxSinColl",
132         "TxMulColl",
133         "DefersNo",
134         "DefersProt",
135         "DefersEngy",
136         "DupFram",
137         "RxFragDisc",
138         "TxAged",
139         "RxAged",
140         "LostSync-MaxRetry",
141         "LostSync-MissedBeacons",
142         "LostSync-ArlExceeded",
143         "LostSync-Deauth",
144         "LostSync-Disassoced",
145         "LostSync-TsfTiming",
146         "HostTxMc",
147         "HostTxBc",
148         "HostTxUc",
149         "HostTxFail",
150         "HostRxMc",
151         "HostRxBc",
152         "HostRxUc",
153         "HostRxDiscard",
154         IGNLABEL("HmacTxMc"),
155         IGNLABEL("HmacTxBc"),
156         IGNLABEL("HmacTxUc"),
157         IGNLABEL("HmacTxFail"),
158         IGNLABEL("HmacRxMc"),
159         IGNLABEL("HmacRxBc"),
160         IGNLABEL("HmacRxUc"),
161         IGNLABEL("HmacRxDiscard"),
162         IGNLABEL("HmacRxAccepted"),
163         "SsidMismatch",
164         "ApMismatch",
165         "RatesMismatch",
166         "AuthReject",
167         "AuthTimeout",
168         "AssocReject",
169         "AssocTimeout",
170         IGNLABEL("ReasonOutsideTable"),
171         IGNLABEL("ReasonStatus1"),
172         IGNLABEL("ReasonStatus2"),
173         IGNLABEL("ReasonStatus3"),
174         IGNLABEL("ReasonStatus4"),
175         IGNLABEL("ReasonStatus5"),
176         IGNLABEL("ReasonStatus6"),
177         IGNLABEL("ReasonStatus7"),
178         IGNLABEL("ReasonStatus8"),
179         IGNLABEL("ReasonStatus9"),
180         IGNLABEL("ReasonStatus10"),
181         IGNLABEL("ReasonStatus11"),
182         IGNLABEL("ReasonStatus12"),
183         IGNLABEL("ReasonStatus13"),
184         IGNLABEL("ReasonStatus14"),
185         IGNLABEL("ReasonStatus15"),
186         IGNLABEL("ReasonStatus16"),
187         IGNLABEL("ReasonStatus17"),
188         IGNLABEL("ReasonStatus18"),
189         IGNLABEL("ReasonStatus19"),
190         "RxMan",
191         "TxMan",
192         "RxRefresh",
193         "TxRefresh",
194         "RxPoll",
195         "TxPoll",
196         "HostRetries",
197         "LostSync-HostReq",
198         "HostTxBytes",
199         "HostRxBytes",
200         "ElapsedUsec",
201         "ElapsedSec",
202         "LostSyncBetterAP",
203         "PrivacyMismatch",
204         "Jammed",
205         "DiscRxNotWepped",
206         "PhyEleMismatch",
207         (char*)-1 };
208 #ifndef RUN_AT
209 #define RUN_AT(x) (jiffies+(x))
210 #endif
211
212
213 /* These variables are for insmod, since it seems that the rates
214    can only be set in setup_card.  Rates should be a comma separated
215    (no spaces) list of rates (up to 8). */
216
217 static int rates[8];
218 static char *ssids[3];
219
220 static int io[4];
221 static int irq[4];
222
223 static
224 int maxencrypt /* = 0 */; /* The highest rate that the card can encrypt at.
225                        0 means no limit.  For old cards this was 4 */
226
227 static int auto_wep /* = 0 */; /* If set, it tries to figure out the wep mode */
228 static int aux_bap /* = 0 */; /* Checks to see if the aux ports are needed to read
229                     the bap, needed on some older cards and buses. */
230 static int adhoc;
231
232 static int probe = 1;
233
234 static kuid_t proc_kuid;
235 static int proc_uid /* = 0 */;
236
237 static kgid_t proc_kgid;
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 cards.  "
246                    "Direct support for ISA/PCI/MPI cards and support for PCMCIA when used with airo_cs.");
247 MODULE_LICENSE("Dual BSD/GPL");
248 MODULE_SUPPORTED_DEVICE("Aironet 4500, 4800 and Cisco 340/350");
249 module_param_array(io, int, NULL, 0);
250 module_param_array(irq, int, NULL, 0);
251 module_param_array(rates, int, NULL, 0);
252 module_param_array(ssids, charp, NULL, 0);
253 module_param(auto_wep, int, 0);
254 MODULE_PARM_DESC(auto_wep,
255                  "If non-zero, the driver will keep looping through the authentication options until an association is made.  "
256                  "The value of auto_wep is number of the wep keys to check.  "
257                  "A value of 2 will try using the key at index 0 and index 1.");
258 module_param(aux_bap, int, 0);
259 MODULE_PARM_DESC(aux_bap,
260                  "If non-zero, the driver will switch into a mode that seems to work better for older cards with some older buses.  "
261                  "Before switching it checks that the switch is needed.");
262 module_param(maxencrypt, int, 0);
263 MODULE_PARM_DESC(maxencrypt,
264                  "The maximum speed that the card can do encryption.  "
265                  "Units are in 512kbs.  "
266                  "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 } __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 } __packed;
516
517 typedef struct SsidRid SsidRid;
518 struct SsidRid {
519         __le16 len;
520         Ssid ssids[3];
521 } __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 } __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 } __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 } __packed;
714
715 typedef struct StatsRid StatsRid;
716 struct StatsRid {
717         __le16 len;
718         __le16 spacer;
719         __le32 vals[100];
720 } __packed;
721
722 typedef struct APListRid APListRid;
723 struct APListRid {
724         __le16 len;
725         u8 ap[4][ETH_ALEN];
726 } __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 } __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 } __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 } __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 } __packed;
810
811 typedef struct tdsRssiRid tdsRssiRid;
812 struct tdsRssiRid {
813   u16 len;
814   tdsRssiEntry x[256];
815 } __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 } __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 } __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 const 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 } __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 const u8 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,(u8*)(frame + 1),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, (u8 *)(eth + 1),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 && !test_bit(FLAG_RADIO_DOWN, &ai->flags)) {
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 committed, 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, "%s",
1897                                                    dev->name);
1898                 if (IS_ERR(ai->airo_thread_task))
1899                         return (int)PTR_ERR(ai->airo_thread_task);
1900
1901                 rc = request_irq(dev->irq, airo_interrupt, IRQF_SHARED,
1902                         dev->name, dev);
1903                 if (rc) {
1904                         airo_print_err(dev->name,
1905                                 "register interrupt %d failed, rc %d",
1906                                 dev->irq, rc);
1907                         set_bit(JOB_DIE, &ai->jobs);
1908                         kthread_stop(ai->airo_thread_task);
1909                         return rc;
1910                 }
1911
1912                 /* Power on the MAC controller (which may have been disabled) */
1913                 clear_bit(FLAG_RADIO_DOWN, &ai->flags);
1914                 enable_interrupts(ai);
1915
1916                 try_auto_wep(ai);
1917         }
1918         enable_MAC(ai, 1);
1919
1920         netif_start_queue(dev);
1921         return 0;
1922 }
1923
1924 static netdev_tx_t mpi_start_xmit(struct sk_buff *skb,
1925                                         struct net_device *dev)
1926 {
1927         int npacks, pending;
1928         unsigned long flags;
1929         struct airo_info *ai = dev->ml_priv;
1930
1931         if (!skb) {
1932                 airo_print_err(dev->name, "%s: skb == NULL!",__func__);
1933                 return NETDEV_TX_OK;
1934         }
1935         npacks = skb_queue_len (&ai->txq);
1936
1937         if (npacks >= MAXTXQ - 1) {
1938                 netif_stop_queue (dev);
1939                 if (npacks > MAXTXQ) {
1940                         dev->stats.tx_fifo_errors++;
1941                         return NETDEV_TX_BUSY;
1942                 }
1943                 skb_queue_tail (&ai->txq, skb);
1944                 return NETDEV_TX_OK;
1945         }
1946
1947         spin_lock_irqsave(&ai->aux_lock, flags);
1948         skb_queue_tail (&ai->txq, skb);
1949         pending = test_bit(FLAG_PENDING_XMIT, &ai->flags);
1950         spin_unlock_irqrestore(&ai->aux_lock,flags);
1951         netif_wake_queue (dev);
1952
1953         if (pending == 0) {
1954                 set_bit(FLAG_PENDING_XMIT, &ai->flags);
1955                 mpi_send_packet (dev);
1956         }
1957         return NETDEV_TX_OK;
1958 }
1959
1960 /*
1961  * @mpi_send_packet
1962  *
1963  * Attempt to transmit a packet. Can be called from interrupt
1964  * or transmit . return number of packets we tried to send
1965  */
1966
1967 static int mpi_send_packet (struct net_device *dev)
1968 {
1969         struct sk_buff *skb;
1970         unsigned char *buffer;
1971         s16 len;
1972         __le16 *payloadLen;
1973         struct airo_info *ai = dev->ml_priv;
1974         u8 *sendbuf;
1975
1976         /* get a packet to send */
1977
1978         if ((skb = skb_dequeue(&ai->txq)) == NULL) {
1979                 airo_print_err(dev->name,
1980                         "%s: Dequeue'd zero in send_packet()",
1981                         __func__);
1982                 return 0;
1983         }
1984
1985         /* check min length*/
1986         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
1987         buffer = skb->data;
1988
1989         ai->txfids[0].tx_desc.offset = 0;
1990         ai->txfids[0].tx_desc.valid = 1;
1991         ai->txfids[0].tx_desc.eoc = 1;
1992         ai->txfids[0].tx_desc.len =len+sizeof(WifiHdr);
1993
1994 /*
1995  * Magic, the cards firmware needs a length count (2 bytes) in the host buffer
1996  * right after  TXFID_HDR.The TXFID_HDR contains the status short so payloadlen
1997  * is immediately after it. ------------------------------------------------
1998  *                         |TXFIDHDR+STATUS|PAYLOADLEN|802.3HDR|PACKETDATA|
1999  *                         ------------------------------------------------
2000  */
2001
2002         memcpy(ai->txfids[0].virtual_host_addr,
2003                 (char *)&wifictlhdr8023, sizeof(wifictlhdr8023));
2004
2005         payloadLen = (__le16 *)(ai->txfids[0].virtual_host_addr +
2006                 sizeof(wifictlhdr8023));
2007         sendbuf = ai->txfids[0].virtual_host_addr +
2008                 sizeof(wifictlhdr8023) + 2 ;
2009
2010         /*
2011          * Firmware automatically puts 802 header on so
2012          * we don't need to account for it in the length
2013          */
2014         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
2015                 (ntohs(((__be16 *)buffer)[6]) != 0x888E)) {
2016                 MICBuffer pMic;
2017
2018                 if (encapsulate(ai, (etherHead *)buffer, &pMic, len - sizeof(etherHead)) != SUCCESS)
2019                         return ERROR;
2020
2021                 *payloadLen = cpu_to_le16(len-sizeof(etherHead)+sizeof(pMic));
2022                 ai->txfids[0].tx_desc.len += sizeof(pMic);
2023                 /* copy data into airo dma buffer */
2024                 memcpy (sendbuf, buffer, sizeof(etherHead));
2025                 buffer += sizeof(etherHead);
2026                 sendbuf += sizeof(etherHead);
2027                 memcpy (sendbuf, &pMic, sizeof(pMic));
2028                 sendbuf += sizeof(pMic);
2029                 memcpy (sendbuf, buffer, len - sizeof(etherHead));
2030         } else {
2031                 *payloadLen = cpu_to_le16(len - sizeof(etherHead));
2032
2033                 dev->trans_start = jiffies;
2034
2035                 /* copy data into airo dma buffer */
2036                 memcpy(sendbuf, buffer, len);
2037         }
2038
2039         memcpy_toio(ai->txfids[0].card_ram_off,
2040                 &ai->txfids[0].tx_desc, sizeof(TxFid));
2041
2042         OUT4500(ai, EVACK, 8);
2043
2044         dev_kfree_skb_any(skb);
2045         return 1;
2046 }
2047
2048 static void get_tx_error(struct airo_info *ai, s32 fid)
2049 {
2050         __le16 status;
2051
2052         if (fid < 0)
2053                 status = ((WifiCtlHdr *)ai->txfids[0].virtual_host_addr)->ctlhdr.status;
2054         else {
2055                 if (bap_setup(ai, ai->fids[fid] & 0xffff, 4, BAP0) != SUCCESS)
2056                         return;
2057                 bap_read(ai, &status, 2, BAP0);
2058         }
2059         if (le16_to_cpu(status) & 2) /* Too many retries */
2060                 ai->dev->stats.tx_aborted_errors++;
2061         if (le16_to_cpu(status) & 4) /* Transmit lifetime exceeded */
2062                 ai->dev->stats.tx_heartbeat_errors++;
2063         if (le16_to_cpu(status) & 8) /* Aid fail */
2064                 { }
2065         if (le16_to_cpu(status) & 0x10) /* MAC disabled */
2066                 ai->dev->stats.tx_carrier_errors++;
2067         if (le16_to_cpu(status) & 0x20) /* Association lost */
2068                 { }
2069         /* We produce a TXDROP event only for retry or lifetime
2070          * exceeded, because that's the only status that really mean
2071          * that this particular node went away.
2072          * Other errors means that *we* screwed up. - Jean II */
2073         if ((le16_to_cpu(status) & 2) ||
2074              (le16_to_cpu(status) & 4)) {
2075                 union iwreq_data        wrqu;
2076                 char junk[0x18];
2077
2078                 /* Faster to skip over useless data than to do
2079                  * another bap_setup(). We are at offset 0x6 and
2080                  * need to go to 0x18 and read 6 bytes - Jean II */
2081                 bap_read(ai, (__le16 *) junk, 0x18, BAP0);
2082
2083                 /* Copy 802.11 dest address.
2084                  * We use the 802.11 header because the frame may
2085                  * not be 802.3 or may be mangled...
2086                  * In Ad-Hoc mode, it will be the node address.
2087                  * In managed mode, it will be most likely the AP addr
2088                  * User space will figure out how to convert it to
2089                  * whatever it needs (IP address or else).
2090                  * - Jean II */
2091                 memcpy(wrqu.addr.sa_data, junk + 0x12, ETH_ALEN);
2092                 wrqu.addr.sa_family = ARPHRD_ETHER;
2093
2094                 /* Send event to user space */
2095                 wireless_send_event(ai->dev, IWEVTXDROP, &wrqu, NULL);
2096         }
2097 }
2098
2099 static void airo_end_xmit(struct net_device *dev) {
2100         u16 status;
2101         int i;
2102         struct airo_info *priv = dev->ml_priv;
2103         struct sk_buff *skb = priv->xmit.skb;
2104         int fid = priv->xmit.fid;
2105         u32 *fids = priv->fids;
2106
2107         clear_bit(JOB_XMIT, &priv->jobs);
2108         clear_bit(FLAG_PENDING_XMIT, &priv->flags);
2109         status = transmit_802_3_packet (priv, fids[fid], skb->data);
2110         up(&priv->sem);
2111
2112         i = 0;
2113         if ( status == SUCCESS ) {
2114                 dev->trans_start = jiffies;
2115                 for (; i < MAX_FIDS / 2 && (priv->fids[i] & 0xffff0000); i++);
2116         } else {
2117                 priv->fids[fid] &= 0xffff;
2118                 dev->stats.tx_window_errors++;
2119         }
2120         if (i < MAX_FIDS / 2)
2121                 netif_wake_queue(dev);
2122         dev_kfree_skb(skb);
2123 }
2124
2125 static netdev_tx_t airo_start_xmit(struct sk_buff *skb,
2126                                          struct net_device *dev)
2127 {
2128         s16 len;
2129         int i, j;
2130         struct airo_info *priv = dev->ml_priv;
2131         u32 *fids = priv->fids;
2132
2133         if ( skb == NULL ) {
2134                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2135                 return NETDEV_TX_OK;
2136         }
2137
2138         /* Find a vacant FID */
2139         for( i = 0; i < MAX_FIDS / 2 && (fids[i] & 0xffff0000); i++ );
2140         for( j = i + 1; j < MAX_FIDS / 2 && (fids[j] & 0xffff0000); j++ );
2141
2142         if ( j >= MAX_FIDS / 2 ) {
2143                 netif_stop_queue(dev);
2144
2145                 if (i == MAX_FIDS / 2) {
2146                         dev->stats.tx_fifo_errors++;
2147                         return NETDEV_TX_BUSY;
2148                 }
2149         }
2150         /* check min length*/
2151         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2152         /* Mark fid as used & save length for later */
2153         fids[i] |= (len << 16);
2154         priv->xmit.skb = skb;
2155         priv->xmit.fid = i;
2156         if (down_trylock(&priv->sem) != 0) {
2157                 set_bit(FLAG_PENDING_XMIT, &priv->flags);
2158                 netif_stop_queue(dev);
2159                 set_bit(JOB_XMIT, &priv->jobs);
2160                 wake_up_interruptible(&priv->thr_wait);
2161         } else
2162                 airo_end_xmit(dev);
2163         return NETDEV_TX_OK;
2164 }
2165
2166 static void airo_end_xmit11(struct net_device *dev) {
2167         u16 status;
2168         int i;
2169         struct airo_info *priv = dev->ml_priv;
2170         struct sk_buff *skb = priv->xmit11.skb;
2171         int fid = priv->xmit11.fid;
2172         u32 *fids = priv->fids;
2173
2174         clear_bit(JOB_XMIT11, &priv->jobs);
2175         clear_bit(FLAG_PENDING_XMIT11, &priv->flags);
2176         status = transmit_802_11_packet (priv, fids[fid], skb->data);
2177         up(&priv->sem);
2178
2179         i = MAX_FIDS / 2;
2180         if ( status == SUCCESS ) {
2181                 dev->trans_start = jiffies;
2182                 for (; i < MAX_FIDS && (priv->fids[i] & 0xffff0000); i++);
2183         } else {
2184                 priv->fids[fid] &= 0xffff;
2185                 dev->stats.tx_window_errors++;
2186         }
2187         if (i < MAX_FIDS)
2188                 netif_wake_queue(dev);
2189         dev_kfree_skb(skb);
2190 }
2191
2192 static netdev_tx_t airo_start_xmit11(struct sk_buff *skb,
2193                                            struct net_device *dev)
2194 {
2195         s16 len;
2196         int i, j;
2197         struct airo_info *priv = dev->ml_priv;
2198         u32 *fids = priv->fids;
2199
2200         if (test_bit(FLAG_MPI, &priv->flags)) {
2201                 /* Not implemented yet for MPI350 */
2202                 netif_stop_queue(dev);
2203                 dev_kfree_skb_any(skb);
2204                 return NETDEV_TX_OK;
2205         }
2206
2207         if ( skb == NULL ) {
2208                 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2209                 return NETDEV_TX_OK;
2210         }
2211
2212         /* Find a vacant FID */
2213         for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2214         for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2215
2216         if ( j >= MAX_FIDS ) {
2217                 netif_stop_queue(dev);
2218
2219                 if (i == MAX_FIDS) {
2220                         dev->stats.tx_fifo_errors++;
2221                         return NETDEV_TX_BUSY;
2222                 }
2223         }
2224         /* check min length*/
2225         len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2226         /* Mark fid as used & save length for later */
2227         fids[i] |= (len << 16);
2228         priv->xmit11.skb = skb;
2229         priv->xmit11.fid = i;
2230         if (down_trylock(&priv->sem) != 0) {
2231                 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2232                 netif_stop_queue(dev);
2233                 set_bit(JOB_XMIT11, &priv->jobs);
2234                 wake_up_interruptible(&priv->thr_wait);
2235         } else
2236                 airo_end_xmit11(dev);
2237         return NETDEV_TX_OK;
2238 }
2239
2240 static void airo_read_stats(struct net_device *dev)
2241 {
2242         struct airo_info *ai = dev->ml_priv;
2243         StatsRid stats_rid;
2244         __le32 *vals = stats_rid.vals;
2245
2246         clear_bit(JOB_STATS, &ai->jobs);
2247         if (ai->power.event) {
2248                 up(&ai->sem);
2249                 return;
2250         }
2251         readStatsRid(ai, &stats_rid, RID_STATS, 0);
2252         up(&ai->sem);
2253
2254         dev->stats.rx_packets = le32_to_cpu(vals[43]) + le32_to_cpu(vals[44]) +
2255                                le32_to_cpu(vals[45]);
2256         dev->stats.tx_packets = le32_to_cpu(vals[39]) + le32_to_cpu(vals[40]) +
2257                                le32_to_cpu(vals[41]);
2258         dev->stats.rx_bytes = le32_to_cpu(vals[92]);
2259         dev->stats.tx_bytes = le32_to_cpu(vals[91]);
2260         dev->stats.rx_errors = le32_to_cpu(vals[0]) + le32_to_cpu(vals[2]) +
2261                               le32_to_cpu(vals[3]) + le32_to_cpu(vals[4]);
2262         dev->stats.tx_errors = le32_to_cpu(vals[42]) +
2263                               dev->stats.tx_fifo_errors;
2264         dev->stats.multicast = le32_to_cpu(vals[43]);
2265         dev->stats.collisions = le32_to_cpu(vals[89]);
2266
2267         /* detailed rx_errors: */
2268         dev->stats.rx_length_errors = le32_to_cpu(vals[3]);
2269         dev->stats.rx_crc_errors = le32_to_cpu(vals[4]);
2270         dev->stats.rx_frame_errors = le32_to_cpu(vals[2]);
2271         dev->stats.rx_fifo_errors = le32_to_cpu(vals[0]);
2272 }
2273
2274 static struct net_device_stats *airo_get_stats(struct net_device *dev)
2275 {
2276         struct airo_info *local =  dev->ml_priv;
2277
2278         if (!test_bit(JOB_STATS, &local->jobs)) {
2279                 /* Get stats out of the card if available */
2280                 if (down_trylock(&local->sem) != 0) {
2281                         set_bit(JOB_STATS, &local->jobs);
2282                         wake_up_interruptible(&local->thr_wait);
2283                 } else
2284                         airo_read_stats(dev);
2285         }
2286
2287         return &dev->stats;
2288 }
2289
2290 static void airo_set_promisc(struct airo_info *ai) {
2291         Cmd cmd;
2292         Resp rsp;
2293
2294         memset(&cmd, 0, sizeof(cmd));
2295         cmd.cmd=CMD_SETMODE;
2296         clear_bit(JOB_PROMISC, &ai->jobs);
2297         cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2298         issuecommand(ai, &cmd, &rsp);
2299         up(&ai->sem);
2300 }
2301
2302 static void airo_set_multicast_list(struct net_device *dev) {
2303         struct airo_info *ai = dev->ml_priv;
2304
2305         if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2306                 change_bit(FLAG_PROMISC, &ai->flags);
2307                 if (down_trylock(&ai->sem) != 0) {
2308                         set_bit(JOB_PROMISC, &ai->jobs);
2309                         wake_up_interruptible(&ai->thr_wait);
2310                 } else
2311                         airo_set_promisc(ai);
2312         }
2313
2314         if ((dev->flags&IFF_ALLMULTI) || !netdev_mc_empty(dev)) {
2315                 /* Turn on multicast.  (Should be already setup...) */
2316         }
2317 }
2318
2319 static int airo_set_mac_address(struct net_device *dev, void *p)
2320 {
2321         struct airo_info *ai = dev->ml_priv;
2322         struct sockaddr *addr = p;
2323
2324         readConfigRid(ai, 1);
2325         memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2326         set_bit (FLAG_COMMIT, &ai->flags);
2327         disable_MAC(ai, 1);
2328         writeConfigRid (ai, 1);
2329         enable_MAC(ai, 1);
2330         memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2331         if (ai->wifidev)
2332                 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2333         return 0;
2334 }
2335
2336 static int airo_change_mtu(struct net_device *dev, int new_mtu)
2337 {
2338         if ((new_mtu < 68) || (new_mtu > 2400))
2339                 return -EINVAL;
2340         dev->mtu = new_mtu;
2341         return 0;
2342 }
2343
2344 static LIST_HEAD(airo_devices);
2345
2346 static void add_airo_dev(struct airo_info *ai)
2347 {
2348         /* Upper layers already keep track of PCI devices,
2349          * so we only need to remember our non-PCI cards. */
2350         if (!ai->pci)
2351                 list_add_tail(&ai->dev_list, &airo_devices);
2352 }
2353
2354 static void del_airo_dev(struct airo_info *ai)
2355 {
2356         if (!ai->pci)
2357                 list_del(&ai->dev_list);
2358 }
2359
2360 static int airo_close(struct net_device *dev) {
2361         struct airo_info *ai = dev->ml_priv;
2362
2363         netif_stop_queue(dev);
2364
2365         if (ai->wifidev != dev) {
2366 #ifdef POWER_ON_DOWN
2367                 /* Shut power to the card. The idea is that the user can save
2368                  * power when he doesn't need the card with "ifconfig down".
2369                  * That's the method that is most friendly towards the network
2370                  * stack (i.e. the network stack won't try to broadcast
2371                  * anything on the interface and routes are gone. Jean II */
2372                 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2373                 disable_MAC(ai, 1);
2374 #endif
2375                 disable_interrupts( ai );
2376
2377                 free_irq(dev->irq, dev);
2378
2379                 set_bit(JOB_DIE, &ai->jobs);
2380                 kthread_stop(ai->airo_thread_task);
2381         }
2382         return 0;
2383 }
2384
2385 void stop_airo_card( struct net_device *dev, int freeres )
2386 {
2387         struct airo_info *ai = dev->ml_priv;
2388
2389         set_bit(FLAG_RADIO_DOWN, &ai->flags);
2390         disable_MAC(ai, 1);
2391         disable_interrupts(ai);
2392         takedown_proc_entry( dev, ai );
2393         if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2394                 unregister_netdev( dev );
2395                 if (ai->wifidev) {
2396                         unregister_netdev(ai->wifidev);
2397                         free_netdev(ai->wifidev);
2398                         ai->wifidev = NULL;
2399                 }
2400                 clear_bit(FLAG_REGISTERED, &ai->flags);
2401         }
2402         /*
2403          * Clean out tx queue
2404          */
2405         if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
2406                 struct sk_buff *skb = NULL;
2407                 for (;(skb = skb_dequeue(&ai->txq));)
2408                         dev_kfree_skb(skb);
2409         }
2410
2411         airo_networks_free (ai);
2412
2413         kfree(ai->flash);
2414         kfree(ai->rssi);
2415         kfree(ai->APList);
2416         kfree(ai->SSID);
2417         if (freeres) {
2418                 /* PCMCIA frees this stuff, so only for PCI and ISA */
2419                 release_region( dev->base_addr, 64 );
2420                 if (test_bit(FLAG_MPI, &ai->flags)) {
2421                         if (ai->pci)
2422                                 mpi_unmap_card(ai->pci);
2423                         if (ai->pcimem)
2424                                 iounmap(ai->pcimem);
2425                         if (ai->pciaux)
2426                                 iounmap(ai->pciaux);
2427                         pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2428                                 ai->shared, ai->shared_dma);
2429                 }
2430         }
2431         crypto_free_cipher(ai->tfm);
2432         del_airo_dev(ai);
2433         free_netdev( dev );
2434 }
2435
2436 EXPORT_SYMBOL(stop_airo_card);
2437
2438 static int wll_header_parse(const struct sk_buff *skb, unsigned char *haddr)
2439 {
2440         memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
2441         return ETH_ALEN;
2442 }
2443
2444 static void mpi_unmap_card(struct pci_dev *pci)
2445 {
2446         unsigned long mem_start = pci_resource_start(pci, 1);
2447         unsigned long mem_len = pci_resource_len(pci, 1);
2448         unsigned long aux_start = pci_resource_start(pci, 2);
2449         unsigned long aux_len = AUXMEMSIZE;
2450
2451         release_mem_region(aux_start, aux_len);
2452         release_mem_region(mem_start, mem_len);
2453 }
2454
2455 /*************************************************************
2456  *  This routine assumes that descriptors have been setup .
2457  *  Run at insmod time or after reset  when the decriptors
2458  *  have been initialized . Returns 0 if all is well nz
2459  *  otherwise . Does not allocate memory but sets up card
2460  *  using previously allocated descriptors.
2461  */
2462 static int mpi_init_descriptors (struct airo_info *ai)
2463 {
2464         Cmd cmd;
2465         Resp rsp;
2466         int i;
2467         int rc = SUCCESS;
2468
2469         /* Alloc  card RX descriptors */
2470         netif_stop_queue(ai->dev);
2471
2472         memset(&rsp,0,sizeof(rsp));
2473         memset(&cmd,0,sizeof(cmd));
2474
2475         cmd.cmd = CMD_ALLOCATEAUX;
2476         cmd.parm0 = FID_RX;
2477         cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2478         cmd.parm2 = MPI_MAX_FIDS;
2479         rc=issuecommand(ai, &cmd, &rsp);
2480         if (rc != SUCCESS) {
2481                 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
2482                 return rc;
2483         }
2484
2485         for (i=0; i<MPI_MAX_FIDS; i++) {
2486                 memcpy_toio(ai->rxfids[i].card_ram_off,
2487                         &ai->rxfids[i].rx_desc, sizeof(RxFid));
2488         }
2489
2490         /* Alloc card TX descriptors */
2491
2492         memset(&rsp,0,sizeof(rsp));
2493         memset(&cmd,0,sizeof(cmd));
2494
2495         cmd.cmd = CMD_ALLOCATEAUX;
2496         cmd.parm0 = FID_TX;
2497         cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2498         cmd.parm2 = MPI_MAX_FIDS;
2499
2500         for (i=0; i<MPI_MAX_FIDS; i++) {
2501                 ai->txfids[i].tx_desc.valid = 1;
2502                 memcpy_toio(ai->txfids[i].card_ram_off,
2503                         &ai->txfids[i].tx_desc, sizeof(TxFid));
2504         }
2505         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2506
2507         rc=issuecommand(ai, &cmd, &rsp);
2508         if (rc != SUCCESS) {
2509                 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
2510                 return rc;
2511         }
2512
2513         /* Alloc card Rid descriptor */
2514         memset(&rsp,0,sizeof(rsp));
2515         memset(&cmd,0,sizeof(cmd));
2516
2517         cmd.cmd = CMD_ALLOCATEAUX;
2518         cmd.parm0 = RID_RW;
2519         cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2520         cmd.parm2 = 1; /* Magic number... */
2521         rc=issuecommand(ai, &cmd, &rsp);
2522         if (rc != SUCCESS) {
2523                 airo_print_err(ai->dev->name, "Couldn't allocate RID");
2524                 return rc;
2525         }
2526
2527         memcpy_toio(ai->config_desc.card_ram_off,
2528                 &ai->config_desc.rid_desc, sizeof(Rid));
2529
2530         return rc;
2531 }
2532
2533 /*
2534  * We are setting up three things here:
2535  * 1) Map AUX memory for descriptors: Rid, TxFid, or RxFid.
2536  * 2) Map PCI memory for issuing commands.
2537  * 3) Allocate memory (shared) to send and receive ethernet frames.
2538  */
2539 static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci)
2540 {
2541         unsigned long mem_start, mem_len, aux_start, aux_len;
2542         int rc = -1;
2543         int i;
2544         dma_addr_t busaddroff;
2545         unsigned char *vpackoff;
2546         unsigned char __iomem *pciaddroff;
2547
2548         mem_start = pci_resource_start(pci, 1);
2549         mem_len = pci_resource_len(pci, 1);
2550         aux_start = pci_resource_start(pci, 2);
2551         aux_len = AUXMEMSIZE;
2552
2553         if (!request_mem_region(mem_start, mem_len, DRV_NAME)) {
2554                 airo_print_err("", "Couldn't get region %x[%x]",
2555                         (int)mem_start, (int)mem_len);
2556                 goto out;
2557         }
2558         if (!request_mem_region(aux_start, aux_len, DRV_NAME)) {
2559                 airo_print_err("", "Couldn't get region %x[%x]",
2560                         (int)aux_start, (int)aux_len);
2561                 goto free_region1;
2562         }
2563
2564         ai->pcimem = ioremap(mem_start, mem_len);
2565         if (!ai->pcimem) {
2566                 airo_print_err("", "Couldn't map region %x[%x]",
2567                         (int)mem_start, (int)mem_len);
2568                 goto free_region2;
2569         }
2570         ai->pciaux = ioremap(aux_start, aux_len);
2571         if (!ai->pciaux) {
2572                 airo_print_err("", "Couldn't map region %x[%x]",
2573                         (int)aux_start, (int)aux_len);
2574                 goto free_memmap;
2575         }
2576
2577         /* Reserve PKTSIZE for each fid and 2K for the Rids */
2578         ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2579         if (!ai->shared) {
2580                 airo_print_err("", "Couldn't alloc_consistent %d",
2581                         PCI_SHARED_LEN);
2582                 goto free_auxmap;
2583         }
2584
2585         /*
2586          * Setup descriptor RX, TX, CONFIG
2587          */
2588         busaddroff = ai->shared_dma;
2589         pciaddroff = ai->pciaux + AUX_OFFSET;
2590         vpackoff   = ai->shared;
2591
2592         /* RX descriptor setup */
2593         for(i = 0; i < MPI_MAX_FIDS; i++) {
2594                 ai->rxfids[i].pending = 0;
2595                 ai->rxfids[i].card_ram_off = pciaddroff;
2596                 ai->rxfids[i].virtual_host_addr = vpackoff;
2597                 ai->rxfids[i].rx_desc.host_addr = busaddroff;
2598                 ai->rxfids[i].rx_desc.valid = 1;
2599                 ai->rxfids[i].rx_desc.len = PKTSIZE;
2600                 ai->rxfids[i].rx_desc.rdy = 0;
2601
2602                 pciaddroff += sizeof(RxFid);
2603                 busaddroff += PKTSIZE;
2604                 vpackoff   += PKTSIZE;
2605         }
2606
2607         /* TX descriptor setup */
2608         for(i = 0; i < MPI_MAX_FIDS; i++) {
2609                 ai->txfids[i].card_ram_off = pciaddroff;
2610                 ai->txfids[i].virtual_host_addr = vpackoff;
2611                 ai->txfids[i].tx_desc.valid = 1;
2612                 ai->txfids[i].tx_desc.host_addr = busaddroff;
2613                 memcpy(ai->txfids[i].virtual_host_addr,
2614                         &wifictlhdr8023, sizeof(wifictlhdr8023));
2615
2616                 pciaddroff += sizeof(TxFid);
2617                 busaddroff += PKTSIZE;
2618                 vpackoff   += PKTSIZE;
2619         }
2620         ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2621
2622         /* Rid descriptor setup */
2623         ai->config_desc.card_ram_off = pciaddroff;
2624         ai->config_desc.virtual_host_addr = vpackoff;
2625         ai->config_desc.rid_desc.host_addr = busaddroff;
2626         ai->ridbus = busaddroff;
2627         ai->config_desc.rid_desc.rid = 0;
2628         ai->config_desc.rid_desc.len = RIDSIZE;
2629         ai->config_desc.rid_desc.valid = 1;
2630         pciaddroff += sizeof(Rid);
2631         busaddroff += RIDSIZE;
2632         vpackoff   += RIDSIZE;
2633
2634         /* Tell card about descriptors */
2635         if (mpi_init_descriptors (ai) != SUCCESS)
2636                 goto free_shared;
2637
2638         return 0;
2639  free_shared:
2640         pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2641  free_auxmap:
2642         iounmap(ai->pciaux);
2643  free_memmap:
2644         iounmap(ai->pcimem);
2645  free_region2:
2646         release_mem_region(aux_start, aux_len);
2647  free_region1:
2648         release_mem_region(mem_start, mem_len);
2649  out:
2650         return rc;
2651 }
2652
2653 static const struct header_ops airo_header_ops = {
2654         .parse = wll_header_parse,
2655 };
2656
2657 static const struct net_device_ops airo11_netdev_ops = {
2658         .ndo_open               = airo_open,
2659         .ndo_stop               = airo_close,
2660         .ndo_start_xmit         = airo_start_xmit11,
2661         .ndo_get_stats          = airo_get_stats,
2662         .ndo_set_mac_address    = airo_set_mac_address,
2663         .ndo_do_ioctl           = airo_ioctl,
2664         .ndo_change_mtu         = airo_change_mtu,
2665 };
2666
2667 static void wifi_setup(struct net_device *dev)
2668 {
2669         dev->netdev_ops = &airo11_netdev_ops;
2670         dev->header_ops = &airo_header_ops;
2671         dev->wireless_handlers = &airo_handler_def;
2672
2673         dev->type               = ARPHRD_IEEE80211;
2674         dev->hard_header_len    = ETH_HLEN;
2675         dev->mtu                = AIRO_DEF_MTU;
2676         dev->addr_len           = ETH_ALEN;
2677         dev->tx_queue_len       = 100; 
2678
2679         memset(dev->broadcast,0xFF, ETH_ALEN);
2680
2681         dev->flags              = IFF_BROADCAST|IFF_MULTICAST;
2682 }
2683
2684 static struct net_device *init_wifidev(struct airo_info *ai,
2685                                         struct net_device *ethdev)
2686 {
2687         int err;
2688         struct net_device *dev = alloc_netdev(0, "wifi%d", wifi_setup);
2689         if (!dev)
2690                 return NULL;
2691         dev->ml_priv = ethdev->ml_priv;
2692         dev->irq = ethdev->irq;
2693         dev->base_addr = ethdev->base_addr;
2694         dev->wireless_data = ethdev->wireless_data;
2695         SET_NETDEV_DEV(dev, ethdev->dev.parent);
2696         eth_hw_addr_inherit(dev, ethdev);
2697         err = register_netdev(dev);
2698         if (err<0) {
2699                 free_netdev(dev);
2700                 return NULL;
2701         }
2702         return dev;
2703 }
2704
2705 static int reset_card( struct net_device *dev , int lock) {
2706         struct airo_info *ai = dev->ml_priv;
2707
2708         if (lock && down_interruptible(&ai->sem))
2709                 return -1;
2710         waitbusy (ai);
2711         OUT4500(ai,COMMAND,CMD_SOFTRESET);
2712         msleep(200);
2713         waitbusy (ai);
2714         msleep(200);
2715         if (lock)
2716                 up(&ai->sem);
2717         return 0;
2718 }
2719
2720 #define AIRO_MAX_NETWORK_COUNT  64
2721 static int airo_networks_allocate(struct airo_info *ai)
2722 {
2723         if (ai->networks)
2724                 return 0;
2725
2726         ai->networks = kcalloc(AIRO_MAX_NETWORK_COUNT, sizeof(BSSListElement),
2727                                GFP_KERNEL);
2728         if (!ai->networks) {
2729                 airo_print_warn("", "Out of memory allocating beacons");
2730                 return -ENOMEM;
2731         }
2732
2733         return 0;
2734 }
2735
2736 static void airo_networks_free(struct airo_info *ai)
2737 {
2738         kfree(ai->networks);
2739         ai->networks = NULL;
2740 }
2741
2742 static void airo_networks_initialize(struct airo_info *ai)
2743 {
2744         int i;
2745
2746         INIT_LIST_HEAD(&ai->network_free_list);
2747         INIT_LIST_HEAD(&ai->network_list);
2748         for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
2749                 list_add_tail(&ai->networks[i].list,
2750                               &ai->network_free_list);
2751 }
2752
2753 static const struct net_device_ops airo_netdev_ops = {
2754         .ndo_open               = airo_open,
2755         .ndo_stop               = airo_close,
2756         .ndo_start_xmit         = airo_start_xmit,
2757         .ndo_get_stats          = airo_get_stats,
2758         .ndo_set_rx_mode        = airo_set_multicast_list,
2759         .ndo_set_mac_address    = airo_set_mac_address,
2760         .ndo_do_ioctl           = airo_ioctl,
2761         .ndo_change_mtu         = airo_change_mtu,
2762         .ndo_validate_addr      = eth_validate_addr,
2763 };
2764
2765 static const struct net_device_ops mpi_netdev_ops = {
2766         .ndo_open               = airo_open,
2767         .ndo_stop               = airo_close,
2768         .ndo_start_xmit         = mpi_start_xmit,
2769         .ndo_get_stats          = airo_get_stats,
2770         .ndo_set_rx_mode        = airo_set_multicast_list,
2771         .ndo_set_mac_address    = airo_set_mac_address,
2772         .ndo_do_ioctl           = airo_ioctl,
2773         .ndo_change_mtu         = airo_change_mtu,
2774         .ndo_validate_addr      = eth_validate_addr,
2775 };
2776
2777
2778 static struct net_device *_init_airo_card( unsigned short irq, int port,
2779                                            int is_pcmcia, struct pci_dev *pci,
2780                                            struct device *dmdev )
2781 {
2782         struct net_device *dev;
2783         struct airo_info *ai;
2784         int i, rc;
2785         CapabilityRid cap_rid;
2786
2787         /* Create the network device object. */
2788         dev = alloc_netdev(sizeof(*ai), "", ether_setup);
2789         if (!dev) {
2790                 airo_print_err("", "Couldn't alloc_etherdev");
2791                 return NULL;
2792         }
2793
2794         ai = dev->ml_priv = netdev_priv(dev);
2795         ai->wifidev = NULL;
2796         ai->flags = 1 << FLAG_RADIO_DOWN;
2797         ai->jobs = 0;
2798         ai->dev = dev;
2799         if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
2800                 airo_print_dbg("", "Found an MPI350 card");
2801                 set_bit(FLAG_MPI, &ai->flags);
2802         }
2803         spin_lock_init(&ai->aux_lock);
2804         sema_init(&ai->sem, 1);
2805         ai->config.len = 0;
2806         ai->pci = pci;
2807         init_waitqueue_head (&ai->thr_wait);
2808         ai->tfm = NULL;
2809         add_airo_dev(ai);
2810
2811         if (airo_networks_allocate (ai))
2812                 goto err_out_free;
2813         airo_networks_initialize (ai);
2814
2815         skb_queue_head_init (&ai->txq);
2816
2817         /* The Airo-specific entries in the device structure. */
2818         if (test_bit(FLAG_MPI,&ai->flags))
2819                 dev->netdev_ops = &mpi_netdev_ops;
2820         else
2821                 dev->netdev_ops = &airo_netdev_ops;
2822         dev->wireless_handlers = &airo_handler_def;
2823         ai->wireless_data.spy_data = &ai->spy_data;
2824         dev->wireless_data = &ai->wireless_data;
2825         dev->irq = irq;
2826         dev->base_addr = port;
2827         dev->priv_flags &= ~IFF_TX_SKB_SHARING;
2828
2829         SET_NETDEV_DEV(dev, dmdev);
2830
2831         reset_card (dev, 1);
2832         msleep(400);
2833
2834         if (!is_pcmcia) {
2835                 if (!request_region(dev->base_addr, 64, DRV_NAME)) {
2836                         rc = -EBUSY;
2837                         airo_print_err(dev->name, "Couldn't request region");
2838                         goto err_out_nets;
2839                 }
2840         }
2841
2842         if (test_bit(FLAG_MPI,&ai->flags)) {
2843                 if (mpi_map_card(ai, pci)) {
2844                         airo_print_err("", "Could not map memory");
2845                         goto err_out_res;
2846                 }
2847         }
2848
2849         if (probe) {
2850                 if (setup_card(ai, dev->dev_addr, 1) != SUCCESS) {
2851                         airo_print_err(dev->name, "MAC could not be enabled" );
2852                         rc = -EIO;
2853                         goto err_out_map;
2854                 }
2855         } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2856                 ai->bap_read = fast_bap_read;
2857                 set_bit(FLAG_FLASHING, &ai->flags);
2858         }
2859
2860         strcpy(dev->name, "eth%d");
2861         rc = register_netdev(dev);
2862         if (rc) {
2863                 airo_print_err(dev->name, "Couldn't register_netdev");
2864                 goto err_out_map;
2865         }
2866         ai->wifidev = init_wifidev(ai, dev);
2867         if (!ai->wifidev)
2868                 goto err_out_reg;
2869
2870         rc = readCapabilityRid(ai, &cap_rid, 1);
2871         if (rc != SUCCESS) {
2872                 rc = -EIO;
2873                 goto err_out_wifi;
2874         }
2875         /* WEP capability discovery */
2876         ai->wep_capable = (cap_rid.softCap & cpu_to_le16(0x02)) ? 1 : 0;
2877         ai->max_wep_idx = (cap_rid.softCap & cpu_to_le16(0x80)) ? 3 : 0;
2878
2879         airo_print_info(dev->name, "Firmware version %x.%x.%02d",
2880                         ((le16_to_cpu(cap_rid.softVer) >> 8) & 0xF),
2881                         (le16_to_cpu(cap_rid.softVer) & 0xFF),
2882                         le16_to_cpu(cap_rid.softSubVer));
2883
2884         /* Test for WPA support */
2885         /* Only firmware versions 5.30.17 or better can do WPA */
2886         if (le16_to_cpu(cap_rid.softVer) > 0x530
2887          || (le16_to_cpu(cap_rid.softVer) == 0x530
2888               && le16_to_cpu(cap_rid.softSubVer) >= 17)) {
2889                 airo_print_info(ai->dev->name, "WPA supported.");
2890
2891                 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2892                 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2893                 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2894                 ai->bssListRidLen = sizeof(BSSListRid);
2895         } else {
2896                 airo_print_info(ai->dev->name, "WPA unsupported with firmware "
2897                         "versions older than 5.30.17.");
2898
2899                 ai->bssListFirst = RID_BSSLISTFIRST;
2900                 ai->bssListNext = RID_BSSLISTNEXT;
2901                 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2902         }
2903
2904         set_bit(FLAG_REGISTERED,&ai->flags);
2905         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2906
2907         /* Allocate the transmit buffers */
2908         if (probe && !test_bit(FLAG_MPI,&ai->flags))
2909                 for( i = 0; i < MAX_FIDS; i++ )
2910                         ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2911
2912         if (setup_proc_entry(dev, dev->ml_priv) < 0)
2913                 goto err_out_wifi;
2914
2915         return dev;
2916
2917 err_out_wifi:
2918         unregister_netdev(ai->wifidev);
2919         free_netdev(ai->wifidev);
2920 err_out_reg:
2921         unregister_netdev(dev);
2922 err_out_map:
2923         if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2924                 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2925                 iounmap(ai->pciaux);
2926                 iounmap(ai->pcimem);
2927                 mpi_unmap_card(ai->pci);
2928         }
2929 err_out_res:
2930         if (!is_pcmcia)
2931                 release_region( dev->base_addr, 64 );
2932 err_out_nets:
2933         airo_networks_free(ai);
2934 err_out_free:
2935         del_airo_dev(ai);
2936         free_netdev(dev);
2937         return NULL;
2938 }
2939
2940 struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2941                                   struct device *dmdev)
2942 {
2943         return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2944 }
2945
2946 EXPORT_SYMBOL(init_airo_card);
2947
2948 static int waitbusy (struct airo_info *ai) {
2949         int delay = 0;
2950         while ((IN4500(ai, COMMAND) & COMMAND_BUSY) && (delay < 10000)) {
2951                 udelay (10);
2952                 if ((++delay % 20) == 0)
2953                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2954         }
2955         return delay < 10000;
2956 }
2957
2958 int reset_airo_card( struct net_device *dev )
2959 {
2960         int i;
2961         struct airo_info *ai = dev->ml_priv;
2962
2963         if (reset_card (dev, 1))
2964                 return -1;
2965
2966         if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
2967                 airo_print_err(dev->name, "MAC could not be enabled");
2968                 return -1;
2969         }
2970         airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2971         /* Allocate the transmit buffers if needed */
2972         if (!test_bit(FLAG_MPI,&ai->flags))
2973                 for( i = 0; i < MAX_FIDS; i++ )
2974                         ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2975
2976         enable_interrupts( ai );
2977         netif_wake_queue(dev);
2978         return 0;
2979 }
2980
2981 EXPORT_SYMBOL(reset_airo_card);
2982
2983 static void airo_send_event(struct net_device *dev) {
2984         struct airo_info *ai = dev->ml_priv;
2985         union iwreq_data wrqu;
2986         StatusRid status_rid;
2987
2988         clear_bit(JOB_EVENT, &ai->jobs);
2989         PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
2990         up(&ai->sem);
2991         wrqu.data.length = 0;
2992         wrqu.data.flags = 0;
2993         memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
2994         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
2995
2996         /* Send event to user space */
2997         wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
2998 }
2999
3000 static void airo_process_scan_results (struct airo_info *ai) {
3001         union iwreq_data        wrqu;
3002         BSSListRid bss;
3003         int rc;
3004         BSSListElement * loop_net;
3005         BSSListElement * tmp_net;
3006
3007         /* Blow away current list of scan results */
3008         list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
3009                 list_move_tail (&loop_net->list, &ai->network_free_list);
3010                 /* Don't blow away ->list, just BSS data */
3011                 memset (loop_net, 0, sizeof (loop_net->bss));
3012         }
3013
3014         /* Try to read the first entry of the scan result */
3015         rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
3016         if((rc) || (bss.index == cpu_to_le16(0xffff))) {
3017                 /* No scan results */
3018                 goto out;
3019         }
3020
3021         /* Read and parse all entries */
3022         tmp_net = NULL;
3023         while((!rc) && (bss.index != cpu_to_le16(0xffff))) {
3024                 /* Grab a network off the free list */
3025                 if (!list_empty(&ai->network_free_list)) {
3026                         tmp_net = list_entry(ai->network_free_list.next,
3027                                             BSSListElement, list);
3028                         list_del(ai->network_free_list.next);
3029                 }
3030
3031                 if (tmp_net != NULL) {
3032                         memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
3033                         list_add_tail(&tmp_net->list, &ai->network_list);
3034                         tmp_net = NULL;
3035                 }
3036
3037                 /* Read next entry */
3038                 rc = PC4500_readrid(ai, ai->bssListNext,
3039                                     &bss, ai->bssListRidLen, 0);
3040         }
3041
3042 out:
3043         ai->scan_timeout = 0;
3044         clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
3045         up(&ai->sem);
3046
3047         /* Send an empty event to user space.
3048          * We don't send the received data on
3049          * the event because it would require
3050          * us to do complex transcoding, and
3051          * we want to minimise the work done in
3052          * the irq handler. Use a request to
3053          * extract the data - Jean II */
3054         wrqu.data.length = 0;
3055         wrqu.data.flags = 0;
3056         wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3057 }
3058
3059 static int airo_thread(void *data) {
3060         struct net_device *dev = data;
3061         struct airo_info *ai = dev->ml_priv;
3062         int locked;
3063
3064         set_freezable();
3065         while(1) {
3066                 /* make swsusp happy with our thread */
3067                 try_to_freeze();
3068
3069                 if (test_bit(JOB_DIE, &ai->jobs))
3070                         break;
3071
3072                 if (ai->jobs) {
3073                         locked = down_interruptible(&ai->sem);
3074                 } else {
3075                         wait_queue_t wait;
3076
3077                         init_waitqueue_entry(&wait, current);
3078                         add_wait_queue(&ai->thr_wait, &wait);
3079                         for (;;) {
3080                                 set_current_state(TASK_INTERRUPTIBLE);
3081                                 if (ai->jobs)
3082                                         break;
3083                                 if (ai->expires || ai->scan_timeout) {
3084                                         if (ai->scan_timeout &&
3085                                                         time_after_eq(jiffies,ai->scan_timeout)){
3086                                                 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
3087                                                 break;
3088                                         } else if (ai->expires &&
3089                                                         time_after_eq(jiffies,ai->expires)){
3090                                                 set_bit(JOB_AUTOWEP, &ai->jobs);
3091                                                 break;
3092                                         }
3093                                         if (!kthread_should_stop() &&
3094                                             !freezing(current)) {
3095                                                 unsigned long wake_at;
3096                                                 if (!ai->expires || !ai->scan_timeout) {
3097                                                         wake_at = max(ai->expires,
3098                                                                 ai->scan_timeout);
3099                                                 } else {
3100                                                         wake_at = min(ai->expires,
3101                                                                 ai->scan_timeout);
3102                                                 }
3103                                                 schedule_timeout(wake_at - jiffies);
3104                                                 continue;
3105                                         }
3106                                 } else if (!kthread_should_stop() &&
3107                                            !freezing(current)) {
3108                                         schedule();
3109                                         continue;
3110                                 }
3111                                 break;
3112                         }
3113                         current->state = TASK_RUNNING;
3114                         remove_wait_queue(&ai->thr_wait, &wait);
3115                         locked = 1;
3116                 }
3117
3118                 if (locked)
3119                         continue;
3120
3121                 if (test_bit(JOB_DIE, &ai->jobs)) {
3122                         up(&ai->sem);
3123                         break;
3124                 }
3125
3126                 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
3127                         up(&ai->sem);
3128                         continue;
3129                 }
3130
3131                 if (test_bit(JOB_XMIT, &ai->jobs))
3132                         airo_end_xmit(dev);
3133                 else if (test_bit(JOB_XMIT11, &ai->jobs))
3134                         airo_end_xmit11(dev);
3135                 else if (test_bit(JOB_STATS, &ai->jobs))
3136                         airo_read_stats(dev);
3137                 else if (test_bit(JOB_WSTATS, &ai->jobs))
3138                         airo_read_wireless_stats(ai);
3139                 else if (test_bit(JOB_PROMISC, &ai->jobs))
3140                         airo_set_promisc(ai);
3141                 else if (test_bit(JOB_MIC, &ai->jobs))
3142                         micinit(ai);
3143                 else if (test_bit(JOB_EVENT, &ai->jobs))
3144                         airo_send_event(dev);
3145                 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
3146                         timer_func(dev);
3147                 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
3148                         airo_process_scan_results(ai);
3149                 else  /* Shouldn't get here, but we make sure to unlock */
3150                         up(&ai->sem);
3151         }
3152
3153         return 0;
3154 }
3155
3156 static int header_len(__le16 ctl)
3157 {
3158         u16 fc = le16_to_cpu(ctl);
3159         switch (fc & 0xc) {
3160         case 4:
3161                 if ((fc & 0xe0) == 0xc0)
3162                         return 10;      /* one-address control packet */
3163                 return 16;      /* two-address control packet */
3164         case 8:
3165                 if ((fc & 0x300) == 0x300)
3166                         return 30;      /* WDS packet */
3167         }
3168         return 24;
3169 }
3170
3171 static void airo_handle_cisco_mic(struct airo_info *ai)
3172 {
3173         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags)) {
3174                 set_bit(JOB_MIC, &ai->jobs);
3175                 wake_up_interruptible(&ai->thr_wait);
3176         }
3177 }
3178
3179 /* Airo Status codes */
3180 #define STAT_NOBEACON   0x8000 /* Loss of sync - missed beacons */
3181 #define STAT_MAXRETRIES 0x8001 /* Loss of sync - max retries */
3182 #define STAT_MAXARL     0x8002 /* Loss of sync - average retry level exceeded*/
3183 #define STAT_FORCELOSS  0x8003 /* Loss of sync - host request */
3184 #define STAT_TSFSYNC    0x8004 /* Loss of sync - TSF synchronization */
3185 #define STAT_DEAUTH     0x8100 /* low byte is 802.11 reason code */
3186 #define STAT_DISASSOC   0x8200 /* low byte is 802.11 reason code */
3187 #define STAT_ASSOC_FAIL 0x8400 /* low byte is 802.11 reason code */
3188 #define STAT_AUTH_FAIL  0x0300 /* low byte is 802.11 reason code */
3189 #define STAT_ASSOC      0x0400 /* Associated */
3190 #define STAT_REASSOC    0x0600 /* Reassociated?  Only on firmware >= 5.30.17 */
3191
3192 static void airo_print_status(const char *devname, u16 status)
3193 {
3194         u8 reason = status & 0xFF;
3195
3196         switch (status & 0xFF00) {
3197         case STAT_NOBEACON:
3198                 switch (status) {
3199                 case STAT_NOBEACON:
3200                         airo_print_dbg(devname, "link lost (missed beacons)");
3201                         break;
3202                 case STAT_MAXRETRIES:
3203                 case STAT_MAXARL:
3204                         airo_print_dbg(devname, "link lost (max retries)");
3205                         break;
3206                 case STAT_FORCELOSS:
3207                         airo_print_dbg(devname, "link lost (local choice)");
3208                         break;
3209                 case STAT_TSFSYNC:
3210                         airo_print_dbg(devname, "link lost (TSF sync lost)");
3211                         break;
3212                 default:
3213                         airo_print_dbg(devname, "unknow status %x\n", status);
3214                         break;
3215                 }
3216                 break;
3217         case STAT_DEAUTH:
3218                 airo_print_dbg(devname, "deauthenticated (reason: %d)", reason);
3219                 break;
3220         case STAT_DISASSOC:
3221                 airo_print_dbg(devname, "disassociated (reason: %d)", reason);
3222                 break;
3223         case STAT_ASSOC_FAIL:
3224                 airo_print_dbg(devname, "association failed (reason: %d)",
3225                                reason);
3226                 break;
3227         case STAT_AUTH_FAIL:
3228                 airo_print_dbg(devname, "authentication failed (reason: %d)",
3229                                reason);
3230                 break;
3231         case STAT_ASSOC:
3232         case STAT_REASSOC:
3233                 break;
3234         default:
3235                 airo_print_dbg(devname, "unknow status %x\n", status);
3236                 break;
3237         }
3238 }
3239
3240 static void airo_handle_link(struct airo_info *ai)
3241 {
3242         union iwreq_data wrqu;
3243         int scan_forceloss = 0;
3244         u16 status;
3245
3246         /* Get new status and acknowledge the link change */
3247         status = le16_to_cpu(IN4500(ai, LINKSTAT));
3248         OUT4500(ai, EVACK, EV_LINK);
3249
3250         if ((status == STAT_FORCELOSS) && (ai->scan_timeout > 0))
3251                 scan_forceloss = 1;
3252
3253         airo_print_status(ai->dev->name, status);
3254
3255         if ((status == STAT_ASSOC) || (status == STAT_REASSOC)) {
3256                 if (auto_wep)
3257                         ai->expires = 0;
3258                 if (ai->list_bss_task)
3259                         wake_up_process(ai->list_bss_task);
3260                 set_bit(FLAG_UPDATE_UNI, &ai->flags);
3261                 set_bit(FLAG_UPDATE_MULTI, &ai->flags);
3262
3263                 if (down_trylock(&ai->sem) != 0) {
3264                         set_bit(JOB_EVENT, &ai->jobs);
3265                         wake_up_interruptible(&ai->thr_wait);
3266                 } else
3267                         airo_send_event(ai->dev);
3268         } else if (!scan_forceloss) {
3269                 if (auto_wep && !ai->expires) {
3270                         ai->expires = RUN_AT(3*HZ);
3271                         wake_up_interruptible(&ai->thr_wait);
3272                 }
3273
3274                 /* Send event to user space */
3275                 memset(wrqu.ap_addr.sa_data, '\0', ETH_ALEN);
3276                 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3277                 wireless_send_event(ai->dev, SIOCGIWAP, &wrqu, NULL);
3278         }
3279 }
3280
3281 static void airo_handle_rx(struct airo_info *ai)
3282 {
3283         struct sk_buff *skb = NULL;
3284         __le16 fc, v, *buffer, tmpbuf[4];
3285         u16 len, hdrlen = 0, gap, fid;
3286         struct rx_hdr hdr;
3287         int success = 0;
3288
3289         if (test_bit(FLAG_MPI, &ai->flags)) {
3290                 if (test_bit(FLAG_802_11, &ai->flags))
3291                         mpi_receive_802_11(ai);
3292                 else
3293                         mpi_receive_802_3(ai);
3294                 OUT4500(ai, EVACK, EV_RX);
3295                 return;
3296         }
3297
3298         fid = IN4500(ai, RXFID);
3299
3300         /* Get the packet length */
3301         if (test_bit(FLAG_802_11, &ai->flags)) {
3302                 bap_setup (ai, fid, 4, BAP0);
3303                 bap_read (ai, (__le16*)&hdr, sizeof(hdr), BAP0);
3304                 /* Bad CRC. Ignore packet */
3305                 if (le16_to_cpu(hdr.status) & 2)
3306                         hdr.len = 0;
3307                 if (ai->wifidev == NULL)
3308                         hdr.len = 0;
3309         } else {
3310                 bap_setup(ai, fid, 0x36, BAP0);
3311                 bap_read(ai, &hdr.len, 2, BAP0);
3312         }
3313         len = le16_to_cpu(hdr.len);
3314
3315         if (len > AIRO_DEF_MTU) {
3316                 airo_print_err(ai->dev->name, "Bad size %d", len);
3317                 goto done;
3318         }
3319         if (len == 0)
3320                 goto done;
3321
3322         if (test_bit(FLAG_802_11, &ai->flags)) {
3323                 bap_read(ai, &fc, sizeof (fc), BAP0);
3324                 hdrlen = header_len(fc);
3325         } else
3326                 hdrlen = ETH_ALEN * 2;
3327
3328         skb = dev_alloc_skb(len + hdrlen + 2 + 2);
3329         if (!skb) {
3330                 ai->dev->stats.rx_dropped++;
3331                 goto done;
3332         }
3333
3334         skb_reserve(skb, 2); /* This way the IP header is aligned */
3335         buffer = (__le16 *) skb_put(skb, len + hdrlen);
3336         if (test_bit(FLAG_802_11, &ai->flags)) {
3337                 buffer[0] = fc;
3338                 bap_read(ai, buffer + 1, hdrlen - 2, BAP0);
3339                 if (hdrlen == 24)
3340                         bap_read(ai, tmpbuf, 6, BAP0);
3341
3342                 bap_read(ai, &v, sizeof(v), BAP0);
3343                 gap = le16_to_cpu(v);
3344                 if (gap) {
3345                         if (gap <= 8) {
3346                                 bap_read(ai, tmpbuf, gap, BAP0);
3347                         } else {
3348                                 airo_print_err(ai->dev->name, "gaplen too "
3349                                         "big. Problems will follow...");
3350                         }
3351                 }
3352                 bap_read(ai, buffer + hdrlen/2, len, BAP0);
3353         } else {
3354                 MICBuffer micbuf;
3355
3356                 bap_read(ai, buffer, ETH_ALEN * 2, BAP0);
3357                 if (ai->micstats.enabled) {
3358                         bap_read(ai, (__le16 *) &micbuf, sizeof (micbuf), BAP0);
3359                         if (ntohs(micbuf.typelen) > 0x05DC)
3360                                 bap_setup(ai, fid, 0x44, BAP0);
3361                         else {
3362                                 if (len <= sizeof (micbuf)) {
3363                                         dev_kfree_skb_irq(skb);
3364                                         goto done;
3365                                 }
3366
3367                                 len -= sizeof(micbuf);
3368                                 skb_trim(skb, len + hdrlen);
3369                         }
3370                 }
3371
3372                 bap_read(ai, buffer + ETH_ALEN, len, BAP0);
3373                 if (decapsulate(ai, &micbuf, (etherHead*) buffer, len))
3374                         dev_kfree_skb_irq (skb);
3375                 else
3376                         success = 1;
3377         }
3378
3379 #ifdef WIRELESS_SPY
3380         if (success && (ai->spy_data.spy_number > 0)) {
3381                 char *sa;
3382                 struct iw_quality wstats;
3383
3384                 /* Prepare spy data : addr + qual */
3385                 if (!test_bit(FLAG_802_11, &ai->flags)) {
3386                         sa = (char *) buffer + 6;
3387                         bap_setup(ai, fid, 8, BAP0);
3388                         bap_read(ai, (__le16 *) hdr.rssi, 2, BAP0);
3389                 } else
3390                         sa = (char *) buffer + 10;
3391                 wstats.qual = hdr.rssi[0];
3392                 if (ai->rssi)
3393                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3394                 else
3395                         wstats.level = (hdr.rssi[1] + 321) / 2;
3396                 wstats.noise = ai->wstats.qual.noise;
3397                 wstats.updated =  IW_QUAL_LEVEL_UPDATED
3398                                 | IW_QUAL_QUAL_UPDATED
3399                                 | IW_QUAL_DBM;
3400                 /* Update spy records */
3401                 wireless_spy_update(ai->dev, sa, &wstats);
3402         }
3403 #endif /* WIRELESS_SPY */
3404
3405 done:
3406         OUT4500(ai, EVACK, EV_RX);
3407
3408         if (success) {
3409                 if (test_bit(FLAG_802_11, &ai->flags)) {
3410                         skb_reset_mac_header(skb);
3411                         skb->pkt_type = PACKET_OTHERHOST;
3412                         skb->dev = ai->wifidev;
3413                         skb->protocol = htons(ETH_P_802_2);
3414                 } else
3415                         skb->protocol = eth_type_trans(skb, ai->dev);
3416                 skb->ip_summed = CHECKSUM_NONE;
3417
3418                 netif_rx(skb);
3419         }
3420 }
3421
3422 static void airo_handle_tx(struct airo_info *ai, u16 status)
3423 {
3424         int i, len = 0, index = -1;
3425         u16 fid;
3426
3427         if (test_bit(FLAG_MPI, &ai->flags)) {
3428                 unsigned long flags;
3429
3430                 if (status & EV_TXEXC)
3431                         get_tx_error(ai, -1);
3432
3433                 spin_lock_irqsave(&ai->aux_lock, flags);
3434                 if (!skb_queue_empty(&ai->txq)) {
3435                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3436                         mpi_send_packet(ai->dev);
3437                 } else {
3438                         clear_bit(FLAG_PENDING_XMIT, &ai->flags);
3439                         spin_unlock_irqrestore(&ai->aux_lock,flags);
3440                         netif_wake_queue(ai->dev);
3441                 }
3442                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3443                 return;
3444         }
3445
3446         fid = IN4500(ai, TXCOMPLFID);
3447
3448         for(i = 0; i < MAX_FIDS; i++) {
3449                 if ((ai->fids[i] & 0xffff) == fid) {
3450                         len = ai->fids[i] >> 16;
3451                         index = i;
3452                 }
3453         }
3454
3455         if (index != -1) {
3456                 if (status & EV_TXEXC)
3457                         get_tx_error(ai, index);
3458
3459                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXEXC));
3460
3461                 /* Set up to be used again */
3462                 ai->fids[index] &= 0xffff;
3463                 if (index < MAX_FIDS / 2) {
3464                         if (!test_bit(FLAG_PENDING_XMIT, &ai->flags))
3465                                 netif_wake_queue(ai->dev);
3466                 } else {
3467                         if (!test_bit(FLAG_PENDING_XMIT11, &ai->flags))
3468                                 netif_wake_queue(ai->wifidev);
3469                 }
3470         } else {
3471                 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3472                 airo_print_err(ai->dev->name, "Unallocated FID was used to xmit");
3473         }
3474 }
3475
3476 static irqreturn_t airo_interrupt(int irq, void *dev_id)
3477 {
3478         struct net_device *dev = dev_id;
3479         u16 status, savedInterrupts = 0;
3480         struct airo_info *ai = dev->ml_priv;
3481         int handled = 0;
3482
3483         if (!netif_device_present(dev))
3484                 return IRQ_NONE;
3485
3486         for (;;) {
3487                 status = IN4500(ai, EVSTAT);
3488                 if (!(status & STATUS_INTS) || (status == 0xffff))
3489                         break;
3490
3491                 handled = 1;
3492
3493                 if (status & EV_AWAKE) {
3494                         OUT4500(ai, EVACK, EV_AWAKE);
3495                         OUT4500(ai, EVACK, EV_AWAKE);
3496                 }
3497
3498                 if (!savedInterrupts) {
3499                         savedInterrupts = IN4500(ai, EVINTEN);
3500                         OUT4500(ai, EVINTEN, 0);
3501                 }
3502
3503                 if (status & EV_MIC) {
3504                         OUT4500(ai, EVACK, EV_MIC);
3505                         airo_handle_cisco_mic(ai);
3506                 }
3507
3508                 if (status & EV_LINK) {
3509                         /* Link status changed */
3510                         airo_handle_link(ai);
3511                 }
3512
3513                 /* Check to see if there is something to receive */
3514                 if (status & EV_RX)
3515                         airo_handle_rx(ai);
3516
3517                 /* Check to see if a packet has been transmitted */
3518                 if (status & (EV_TX | EV_TXCPY | EV_TXEXC))
3519                         airo_handle_tx(ai, status);
3520
3521                 if ( status & ~STATUS_INTS & ~IGNORE_INTS ) {
3522                         airo_print_warn(ai->dev->name, "Got weird status %x",
3523                                 status & ~STATUS_INTS & ~IGNORE_INTS );
3524                 }
3525         }
3526
3527         if (savedInterrupts)
3528                 OUT4500(ai, EVINTEN, savedInterrupts);
3529
3530         return IRQ_RETVAL(handled);
3531 }
3532
3533 /*
3534  *  Routines to talk to the card
3535  */
3536
3537 /*
3538  *  This was originally written for the 4500, hence the name
3539  *  NOTE:  If use with 8bit mode and SMP bad things will happen!
3540  *         Why would some one do 8 bit IO in an SMP machine?!?
3541  */
3542 static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3543         if (test_bit(FLAG_MPI,&ai->flags))
3544                 reg <<= 1;
3545         if ( !do8bitIO )
3546                 outw( val, ai->dev->base_addr + reg );
3547         else {
3548                 outb( val & 0xff, ai->dev->base_addr + reg );
3549                 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3550         }
3551 }
3552
3553 static u16 IN4500( struct airo_info *ai, u16 reg ) {
3554         unsigned short rc;
3555
3556         if (test_bit(FLAG_MPI,&ai->flags))
3557                 reg <<= 1;
3558         if ( !do8bitIO )
3559                 rc = inw( ai->dev->base_addr + reg );
3560         else {
3561                 rc = inb( ai->dev->base_addr + reg );
3562                 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3563         }
3564         return rc;
3565 }
3566
3567 static int enable_MAC(struct airo_info *ai, int lock)
3568 {
3569         int rc;
3570         Cmd cmd;
3571         Resp rsp;
3572
3573         /* FLAG_RADIO_OFF : Radio disabled via /proc or Wireless Extensions
3574          * FLAG_RADIO_DOWN : Radio disabled via "ifconfig ethX down"
3575          * Note : we could try to use !netif_running(dev) in enable_MAC()
3576          * instead of this flag, but I don't trust it *within* the
3577          * open/close functions, and testing both flags together is
3578          * "cheaper" - Jean II */
3579         if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3580
3581         if (lock && down_interruptible(&ai->sem))
3582                 return -ERESTARTSYS;
3583
3584         if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3585                 memset(&cmd, 0, sizeof(cmd));
3586                 cmd.cmd = MAC_ENABLE;
3587                 rc = issuecommand(ai, &cmd, &rsp);
3588                 if (rc == SUCCESS)
3589                         set_bit(FLAG_ENABLED, &ai->flags);
3590         } else
3591                 rc = SUCCESS;
3592
3593         if (lock)
3594             up(&ai->sem);
3595
3596         if (rc)
3597                 airo_print_err(ai->dev->name, "Cannot enable MAC");
3598         else if ((rsp.status & 0xFF00) != 0) {
3599                 airo_print_err(ai->dev->name, "Bad MAC enable reason=%x, "
3600                         "rid=%x, offset=%d", rsp.rsp0, rsp.rsp1, rsp.rsp2);
3601                 rc = ERROR;
3602         }
3603         return rc;
3604 }
3605
3606 static void disable_MAC( struct airo_info *ai, int lock ) {
3607         Cmd cmd;
3608         Resp rsp;
3609
3610         if (lock && down_interruptible(&ai->sem))
3611                 return;
3612
3613         if (test_bit(FLAG_ENABLED, &ai->flags)) {
3614                 memset(&cmd, 0, sizeof(cmd));
3615                 cmd.cmd = MAC_DISABLE; // disable in case already enabled
3616                 issuecommand(ai, &cmd, &rsp);
3617                 clear_bit(FLAG_ENABLED, &ai->flags);
3618         }
3619         if (lock)
3620                 up(&ai->sem);
3621 }
3622
3623 static void enable_interrupts( struct airo_info *ai ) {
3624         /* Enable the interrupts */
3625         OUT4500( ai, EVINTEN, STATUS_INTS );
3626 }
3627
3628 static void disable_interrupts( struct airo_info *ai ) {
3629         OUT4500( ai, EVINTEN, 0 );
3630 }
3631
3632 static void mpi_receive_802_3(struct airo_info *ai)
3633 {
3634         RxFid rxd;
3635         int len = 0;
3636         struct sk_buff *skb;
3637         char *buffer;
3638         int off = 0;
3639         MICBuffer micbuf;
3640
3641         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3642         /* Make sure we got something */
3643         if (rxd.rdy && rxd.valid == 0) {
3644                 len = rxd.len + 12;
3645                 if (len < 12 || len > 2048)
3646                         goto badrx;
3647
3648                 skb = dev_alloc_skb(len);
3649                 if (!skb) {
3650                         ai->dev->stats.rx_dropped++;
3651                         goto badrx;
3652                 }
3653                 buffer = skb_put(skb,len);
3654                 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3655                 if (ai->micstats.enabled) {
3656                         memcpy(&micbuf,
3657                                 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3658                                 sizeof(micbuf));
3659                         if (ntohs(micbuf.typelen) <= 0x05DC) {
3660                                 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3661                                         goto badmic;
3662
3663                                 off = sizeof(micbuf);
3664                                 skb_trim (skb, len - off);
3665                         }
3666                 }
3667                 memcpy(buffer + ETH_ALEN * 2,
3668                         ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3669                         len - ETH_ALEN * 2 - off);
3670                 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3671 badmic:
3672                         dev_kfree_skb_irq (skb);
3673                         goto badrx;
3674                 }
3675 #ifdef WIRELESS_SPY
3676                 if (ai->spy_data.spy_number > 0) {
3677                         char *sa;
3678                         struct iw_quality wstats;
3679                         /* Prepare spy data : addr + qual */
3680                         sa = buffer + ETH_ALEN;
3681                         wstats.qual = 0; /* XXX Where do I get that info from ??? */
3682                         wstats.level = 0;
3683                         wstats.updated = 0;
3684                         /* Update spy records */
3685                         wireless_spy_update(ai->dev, sa, &wstats);
3686                 }
3687 #endif /* WIRELESS_SPY */
3688
3689                 skb->ip_summed = CHECKSUM_NONE;
3690                 skb->protocol = eth_type_trans(skb, ai->dev);
3691                 netif_rx(skb);
3692         }
3693 badrx:
3694         if (rxd.valid == 0) {
3695                 rxd.valid = 1;
3696                 rxd.rdy = 0;
3697                 rxd.len = PKTSIZE;
3698                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3699         }
3700 }
3701
3702 static void mpi_receive_802_11(struct airo_info *ai)
3703 {
3704         RxFid rxd;
3705         struct sk_buff *skb = NULL;
3706         u16 len, hdrlen = 0;
3707         __le16 fc;
3708         struct rx_hdr hdr;
3709         u16 gap;
3710         u16 *buffer;
3711         char *ptr = ai->rxfids[0].virtual_host_addr + 4;
3712
3713         memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3714         memcpy ((char *)&hdr, ptr, sizeof(hdr));
3715         ptr += sizeof(hdr);
3716         /* Bad CRC. Ignore packet */
3717         if (le16_to_cpu(hdr.status) & 2)
3718                 hdr.len = 0;
3719         if (ai->wifidev == NULL)
3720                 hdr.len = 0;
3721         len = le16_to_cpu(hdr.len);
3722         if (len > AIRO_DEF_MTU) {
3723                 airo_print_err(ai->dev->name, "Bad size %d", len);
3724                 goto badrx;
3725         }
3726         if (len == 0)
3727                 goto badrx;
3728
3729         fc = get_unaligned((__le16 *)ptr);
3730         hdrlen = header_len(fc);
3731
3732         skb = dev_alloc_skb( len + hdrlen + 2 );
3733         if ( !skb ) {
3734                 ai->dev->stats.rx_dropped++;
3735                 goto badrx;
3736         }
3737         buffer = (u16*)skb_put (skb, len + hdrlen);
3738         memcpy ((char *)buffer, ptr, hdrlen);
3739         ptr += hdrlen;
3740         if (hdrlen == 24)
3741                 ptr += 6;
3742         gap = get_unaligned_le16(ptr);
3743         ptr += sizeof(__le16);
3744         if (gap) {
3745                 if (gap <= 8)
3746                         ptr += gap;
3747                 else
3748                         airo_print_err(ai->dev->name,
3749                             "gaplen too big. Problems will follow...");
3750         }
3751         memcpy ((char *)buffer + hdrlen, ptr, len);
3752         ptr += len;
3753 #ifdef IW_WIRELESS_SPY    /* defined in iw_handler.h */
3754         if (ai->spy_data.spy_number > 0) {
3755                 char *sa;
3756                 struct iw_quality wstats;
3757                 /* Prepare spy data : addr + qual */
3758                 sa = (char*)buffer + 10;
3759                 wstats.qual = hdr.rssi[0];
3760                 if (ai->rssi)
3761                         wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3762                 else
3763                         wstats.level = (hdr.rssi[1] + 321) / 2;
3764                 wstats.noise = ai->wstats.qual.noise;
3765                 wstats.updated = IW_QUAL_QUAL_UPDATED
3766                         | IW_QUAL_LEVEL_UPDATED
3767                         | IW_QUAL_DBM;
3768                 /* Update spy records */
3769                 wireless_spy_update(ai->dev, sa, &wstats);
3770         }
3771 #endif /* IW_WIRELESS_SPY */
3772         skb_reset_mac_header(skb);
3773         skb->pkt_type = PACKET_OTHERHOST;
3774         skb->dev = ai->wifidev;
3775         skb->protocol = htons(ETH_P_802_2);
3776         skb->ip_summed = CHECKSUM_NONE;
3777         netif_rx( skb );
3778
3779 badrx:
3780         if (rxd.valid == 0) {
3781                 rxd.valid = 1;
3782                 rxd.rdy = 0;
3783                 rxd.len = PKTSIZE;
3784                 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3785         }
3786 }
3787
3788 static u16 setup_card(struct airo_info *ai, u8 *mac, int lock)
3789 {
3790         Cmd cmd;
3791         Resp rsp;
3792         int status;
3793         SsidRid mySsid;
3794         __le16 lastindex;
3795         WepKeyRid wkr;
3796         int rc;
3797
3798         memset( &mySsid, 0, sizeof( mySsid ) );
3799         kfree (ai->flash);
3800         ai->flash = NULL;
3801
3802         /* The NOP is the first step in getting the card going */
3803         cmd.cmd = NOP;
3804         cmd.parm0 = cmd.parm1 = cmd.parm2 = 0;
3805         if (lock && down_interruptible(&ai->sem))
3806                 return ERROR;
3807         if ( issuecommand( ai, &cmd, &rsp ) != SUCCESS ) {
3808                 if (lock)
3809                         up(&ai->sem);
3810                 return ERROR;
3811         }
3812         disable_MAC( ai, 0);
3813
3814         // Let's figure out if we need to use the AUX port
3815         if (!test_bit(FLAG_MPI,&ai->flags)) {
3816                 cmd.cmd = CMD_ENABLEAUX;
3817                 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
3818                         if (lock)
3819                                 up(&ai->sem);
3820                         airo_print_err(ai->dev->name, "Error checking for AUX port");
3821                         return ERROR;
3822                 }
3823                 if (!aux_bap || rsp.status & 0xff00) {
3824                         ai->bap_read = fast_bap_read;
3825                         airo_print_dbg(ai->dev->name, "Doing fast bap_reads");
3826                 } else {
3827                         ai->bap_read = aux_bap_read;
3828                         airo_print_dbg(ai->dev->name, "Doing AUX bap_reads");
3829                 }
3830         }
3831         if (lock)
3832                 up(&ai->sem);
3833         if (ai->config.len == 0) {
3834                 int i;
3835                 tdsRssiRid rssi_rid;
3836                 CapabilityRid cap_rid;
3837
3838                 kfree(ai->APList);
3839                 ai->APList = NULL;
3840                 kfree(ai->SSID);
3841                 ai->SSID = NULL;
3842                 // general configuration (read/modify/write)
3843                 status = readConfigRid(ai, lock);
3844                 if ( status != SUCCESS ) return ERROR;
3845
3846                 status = readCapabilityRid(ai, &cap_rid, lock);
3847                 if ( status != SUCCESS ) return ERROR;
3848
3849                 status = PC4500_readrid(ai,RID_RSSI,&rssi_rid,sizeof(rssi_rid),lock);
3850                 if ( status == SUCCESS ) {
3851                         if (ai->rssi || (ai->rssi = kmalloc(512, GFP_KERNEL)) != NULL)
3852                                 memcpy(ai->rssi, (u8*)&rssi_rid + 2, 512); /* Skip RID length member */
3853                 }
3854                 else {
3855                         kfree(ai->rssi);
3856                         ai->rssi = NULL;
3857                         if (cap_rid.softCap & cpu_to_le16(8))
3858                                 ai->config.rmode |= RXMODE_NORMALIZED_RSSI;
3859                         else
3860                                 airo_print_warn(ai->dev->name, "unknown received signal "
3861                                                 "level scale");
3862                 }
3863                 ai->config.opmode = adhoc ? MODE_STA_IBSS : MODE_STA_ESS;
3864                 ai->config.authType = AUTH_OPEN;
3865                 ai->config.modulation = MOD_CCK;
3866
3867                 if (le16_to_cpu(cap_rid.len) >= sizeof(cap_rid) &&
3868                     (cap_rid.extSoftCap & cpu_to_le16(1)) &&
3869                     micsetup(ai) == SUCCESS) {
3870                         ai->config.opmode |= MODE_MIC;
3871                         set_bit(FLAG_MIC_CAPABLE, &ai->flags);
3872                 }
3873
3874                 /* Save off the MAC */
3875                 for( i = 0; i < ETH_ALEN; i++ ) {
3876                         mac[i] = ai->config.macAddr[i];
3877                 }
3878
3879                 /* Check to see if there are any insmod configured
3880                    rates to add */
3881                 if ( rates[0] ) {
3882                         memset(ai->config.rates,0,sizeof(ai->config.rates));
3883                         for( i = 0; i < 8 && rates[i]; i++ ) {
3884                                 ai->config.rates[i] = rates[i];
3885                         }
3886                 }
3887                 set_bit (FLAG_COMMIT, &ai->flags);
3888         }
3889
3890         /* Setup the SSIDs if present */
3891         if ( ssids[0] ) {
3892                 int i;
3893                 for( i = 0; i < 3 && ssids[i]; i++ ) {
3894                         size_t len = strlen(ssids[i]);
3895                         if (len > 32)
3896                                 len = 32;
3897                         mySsid.ssids[i].len = cpu_to_le16(len);
3898                         memcpy(mySsid.ssids[i].ssid, ssids[i], len);
3899                 }
3900                 mySsid.len = cpu_to_le16(sizeof(mySsid));
3901         }
3902
3903         status = writeConfigRid(ai, lock);
3904         if ( status != SUCCESS ) return ERROR;
3905
3906         /* Set up the SSID list */
3907         if ( ssids[0] ) {
3908                 status = writeSsidRid(ai, &mySsid, lock);
3909                 if ( status != SUCCESS ) return ERROR;
3910         }
3911
3912         status = enable_MAC(ai, lock);
3913         if (status != SUCCESS)
3914                 return ERROR;
3915
3916         /* Grab the initial wep key, we gotta save it for auto_wep */
3917         rc = readWepKeyRid(ai, &wkr, 1, lock);
3918         if (rc == SUCCESS) do {
3919                 lastindex = wkr.kindex;
3920                 if (wkr.kindex == cpu_to_le16(0xffff)) {
3921                         ai->defindex = wkr.mac[0];
3922                 }
3923                 rc = readWepKeyRid(ai, &wkr, 0, lock);
3924         } while(lastindex != wkr.kindex);
3925
3926         try_auto_wep(ai);
3927
3928         return SUCCESS;
3929 }
3930
3931 static u16 issuecommand(struct airo_info *ai, Cmd *pCmd, Resp *pRsp) {
3932         // Im really paranoid about letting it run forever!
3933         int max_tries = 600000;
3934
3935         if (IN4500(ai, EVSTAT) & EV_CMD)
3936                 OUT4500(ai, EVACK, EV_CMD);
3937
3938         OUT4500(ai, PARAM0, pCmd->parm0);
3939         OUT4500(ai, PARAM1, pCmd->parm1);
3940         OUT4500(ai, PARAM2, pCmd->parm2);
3941         OUT4500(ai, COMMAND, pCmd->cmd);
3942
3943         while (max_tries-- && (IN4500(ai, EVSTAT) & EV_CMD) == 0) {
3944                 if ((IN4500(ai, COMMAND)) == pCmd->cmd)
3945                         // PC4500 didn't notice command, try again
3946                         OUT4500(ai, COMMAND, pCmd->cmd);
3947                 if (!in_atomic() && (max_tries & 255) == 0)
3948                         schedule();
3949         }
3950
3951         if ( max_tries == -1 ) {
3952                 airo_print_err(ai->dev->name,
3953                         "Max tries exceeded when issuing command");
3954                 if (IN4500(ai, COMMAND) & COMMAND_BUSY)
3955                         OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3956                 return ERROR;
3957         }
3958
3959         // command completed
3960         pRsp->status = IN4500(ai, STATUS);
3961         pRsp->rsp0 = IN4500(ai, RESP0);
3962         pRsp->rsp1 = IN4500(ai, RESP1);
3963         pRsp->rsp2 = IN4500(ai, RESP2);
3964         if ((pRsp->status & 0xff00)!=0 && pCmd->cmd != CMD_SOFTRESET)
3965                 airo_print_err(ai->dev->name,
3966                         "cmd:%x status:%x rsp0:%x rsp1:%x rsp2:%x",
3967                         pCmd->cmd, pRsp->status, pRsp->rsp0, pRsp->rsp1,
3968                         pRsp->rsp2);
3969
3970         // clear stuck command busy if necessary
3971         if (IN4500(ai, COMMAND) & COMMAND_BUSY) {
3972                 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3973         }
3974         // acknowledge processing the status/response
3975         OUT4500(ai, EVACK, EV_CMD);
3976
3977         return SUCCESS;
3978 }
3979
3980 /* Sets up the bap to start exchange data.  whichbap should
3981  * be one of the BAP0 or BAP1 defines.  Locks should be held before
3982  * calling! */
3983 static int bap_setup(struct airo_info *ai, u16 rid, u16 offset, int whichbap )
3984 {
3985         int timeout = 50;
3986         int max_tries = 3;
3987
3988         OUT4500(ai, SELECT0+whichbap, rid);
3989         OUT4500(ai, OFFSET0+whichbap, offset);
3990         while (1) {
3991                 int status = IN4500(ai, OFFSET0+whichbap);
3992                 if (status & BAP_BUSY) {
3993                         /* This isn't really a timeout, but its kinda
3994                            close */
3995                         if (timeout--) {
3996                                 continue;
3997                         }
3998                 } else if ( status & BAP_ERR ) {
3999                         /* invalid rid or offset */
4000                         airo_print_err(ai->dev->name, "BAP error %x %d",
4001                                 status, whichbap );
4002                         return ERROR;
4003                 } else if (status & BAP_DONE) { // success
4004                         return SUCCESS;
4005                 }
4006                 if ( !(max_tries--) ) {
4007                         airo_print_err(ai->dev->name,
4008                                 "BAP setup error too many retries\n");
4009                         return ERROR;
4010                 }
4011                 // -- PC4500 missed it, try again
4012                 OUT4500(ai, SELECT0+whichbap, rid);
4013                 OUT4500(ai, OFFSET0+whichbap, offset);
4014                 timeout = 50;
4015         }
4016 }
4017
4018 /* should only be called by aux_bap_read.  This aux function and the
4019    following use concepts not documented in the developers guide.  I
4020    got them from a patch given to my by Aironet */
4021 static u16 aux_setup(struct airo_info *ai, u16 page,
4022                      u16 offset, u16 *len)
4023 {
4024         u16 next;
4025
4026         OUT4500(ai, AUXPAGE, page);
4027         OUT4500(ai, AUXOFF, 0);
4028         next = IN4500(ai, AUXDATA);
4029         *len = IN4500(ai, AUXDATA)&0xff;
4030         if (offset != 4) OUT4500(ai, AUXOFF, offset);
4031         return next;
4032 }
4033
4034 /* requires call to bap_setup() first */
4035 static int aux_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4036                         int bytelen, int whichbap)
4037 {
4038         u16 len;
4039         u16 page;
4040         u16 offset;
4041         u16 next;
4042         int words;
4043         int i;
4044         unsigned long flags;
4045
4046         spin_lock_irqsave(&ai->aux_lock, flags);
4047         page = IN4500(ai, SWS0+whichbap);
4048         offset = IN4500(ai, SWS2+whichbap);
4049         next = aux_setup(ai, page, offset, &len);
4050         words = (bytelen+1)>>1;
4051
4052         for (i=0; i<words;) {
4053                 int count;
4054                 count = (len>>1) < (words-i) ? (len>>1) : (words-i);
4055                 if ( !do8bitIO )
4056                         insw( ai->dev->base_addr+DATA0+whichbap,
4057                               pu16Dst+i,count );
4058                 else
4059                         insb( ai->dev->base_addr+DATA0+whichbap,
4060                               pu16Dst+i, count << 1 );
4061                 i += count;
4062                 if (i<words) {
4063                         next = aux_setup(ai, next, 4, &len);
4064                 }
4065         }
4066         spin_unlock_irqrestore(&ai->aux_lock, flags);
4067         return SUCCESS;
4068 }
4069
4070
4071 /* requires call to bap_setup() first */
4072 static int fast_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4073                          int bytelen, int whichbap)
4074 {
4075         bytelen = (bytelen + 1) & (~1); // round up to even value
4076         if ( !do8bitIO )
4077                 insw( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen>>1 );
4078         else
4079                 insb( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen );
4080         return SUCCESS;
4081 }
4082
4083 /* requires call to bap_setup() first */
4084 static int bap_write(struct airo_info *ai, const __le16 *pu16Src,
4085                      int bytelen, int whichbap)
4086 {
4087         bytelen = (bytelen + 1) & (~1); // round up to even value
4088         if ( !do8bitIO )
4089                 outsw( ai->dev->base_addr+DATA0+whichbap,
4090                        pu16Src, bytelen>>1 );
4091         else
4092                 outsb( ai->dev->base_addr+DATA0+whichbap, pu16Src, bytelen );
4093         return SUCCESS;
4094 }
4095
4096 static int PC4500_accessrid(struct airo_info *ai, u16 rid, u16 accmd)
4097 {
4098         Cmd cmd; /* for issuing commands */
4099         Resp rsp; /* response from commands */
4100         u16 status;
4101
4102         memset(&cmd, 0, sizeof(cmd));
4103         cmd.cmd = accmd;
4104         cmd.parm0 = rid;
4105         status = issuecommand(ai, &cmd, &rsp);
4106         if (status != 0) return status;
4107         if ( (rsp.status & 0x7F00) != 0) {
4108                 return (accmd << 8) + (rsp.rsp0 & 0xFF);
4109         }
4110         return 0;
4111 }
4112
4113 /*  Note, that we are using BAP1 which is also used by transmit, so
4114  *  we must get a lock. */
4115 static int PC4500_readrid(struct airo_info *ai, u16 rid, void *pBuf, int len, int lock)
4116 {
4117         u16 status;
4118         int rc = SUCCESS;
4119
4120         if (lock) {
4121                 if (down_interruptible(&ai->sem))
4122                         return ERROR;
4123         }
4124         if (test_bit(FLAG_MPI,&ai->flags)) {
4125                 Cmd cmd;
4126                 Resp rsp;
4127
4128                 memset(&cmd, 0, sizeof(cmd));
4129                 memset(&rsp, 0, sizeof(rsp));
4130                 ai->config_desc.rid_desc.valid = 1;
4131                 ai->config_desc.rid_desc.len = RIDSIZE;
4132                 ai->config_desc.rid_desc.rid = 0;
4133                 ai->config_desc.rid_desc.host_addr = ai->ridbus;
4134
4135                 cmd.cmd = CMD_ACCESS;
4136                 cmd.parm0 = rid;
4137
4138                 memcpy_toio(ai->config_desc.card_ram_off,
4139                         &ai->config_desc.rid_desc, sizeof(Rid));
4140
4141                 rc = issuecommand(ai, &cmd, &rsp);
4142
4143                 if (rsp.status & 0x7f00)
4144                         rc = rsp.rsp0;
4145                 if (!rc)
4146                         memcpy(pBuf, ai->config_desc.virtual_host_addr, len);
4147                 goto done;
4148         } else {
4149                 if ((status = PC4500_accessrid(ai, rid, CMD_ACCESS))!=SUCCESS) {
4150                         rc = status;
4151                         goto done;
4152                 }
4153                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4154                         rc = ERROR;
4155                         goto done;
4156                 }
4157                 // read the rid length field
4158                 bap_read(ai, pBuf, 2, BAP1);
4159                 // length for remaining part of rid
4160                 len = min(len, (int)le16_to_cpu(*(__le16*)pBuf)) - 2;
4161
4162                 if ( len <= 2 ) {
4163                         airo_print_err(ai->dev->name,
4164                                 "Rid %x has a length of %d which is too short",
4165                                 (int)rid, (int)len );
4166                         rc = ERROR;
4167                         goto done;
4168                 }
4169                 // read remainder of the rid
4170                 rc = bap_read(ai, ((__le16*)pBuf)+1, len, BAP1);
4171         }
4172 done:
4173         if (lock)
4174                 up(&ai->sem);
4175         return rc;
4176 }
4177
4178 /*  Note, that we are using BAP1 which is also used by transmit, so
4179  *  make sure this isn't called when a transmit is happening */
4180 static int PC4500_writerid(struct airo_info *ai, u16 rid,
4181                            const void *pBuf, int len, int lock)
4182 {
4183         u16 status;
4184         int rc = SUCCESS;
4185
4186         *(__le16*)pBuf = cpu_to_le16((u16)len);
4187
4188         if (lock) {
4189                 if (down_interruptible(&ai->sem))
4190                         return ERROR;
4191         }
4192         if (test_bit(FLAG_MPI,&ai->flags)) {
4193                 Cmd cmd;
4194                 Resp rsp;
4195
4196                 if (test_bit(FLAG_ENABLED, &ai->flags) && (RID_WEP_TEMP != rid))
4197                         airo_print_err(ai->dev->name,
4198                                 "%s: MAC should be disabled (rid=%04x)",
4199                                 __func__, rid);
4200                 memset(&cmd, 0, sizeof(cmd));
4201                 memset(&rsp, 0, sizeof(rsp));
4202
4203                 ai->config_desc.rid_desc.valid = 1;
4204                 ai->config_desc.rid_desc.len = *((u16 *)pBuf);
4205                 ai->config_desc.rid_desc.rid = 0;
4206
4207                 cmd.cmd = CMD_WRITERID;
4208                 cmd.parm0 = rid;
4209
4210                 memcpy_toio(ai->config_desc.card_ram_off,
4211                         &ai->config_desc.rid_desc, sizeof(Rid));
4212
4213                 if (len < 4 || len > 2047) {
4214                         airo_print_err(ai->dev->name, "%s: len=%d", __func__, len);
4215                         rc = -1;
4216                 } else {
4217                         memcpy(ai->config_desc.virtual_host_addr,
4218                                 pBuf, len);
4219
4220                         rc = issuecommand(ai, &cmd, &rsp);
4221                         if ((rc & 0xff00) != 0) {
4222                                 airo_print_err(ai->dev->name, "%s: Write rid Error %d",
4223                                                 __func__, rc);
4224                                 airo_print_err(ai->dev->name, "%s: Cmd=%04x",
4225                                                 __func__, cmd.cmd);
4226                         }
4227
4228                         if ((rsp.status & 0x7f00))
4229                                 rc = rsp.rsp0;
4230                 }
4231         } else {
4232                 // --- first access so that we can write the rid data
4233                 if ( (status = PC4500_accessrid(ai, rid, CMD_ACCESS)) != 0) {
4234                         rc = status;
4235                         goto done;
4236                 }
4237                 // --- now write the rid data
4238                 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4239                         rc = ERROR;
4240                         goto done;
4241                 }
4242                 bap_write(ai, pBuf, len, BAP1);
4243                 // ---now commit the rid data
4244                 rc = PC4500_accessrid(ai, rid, 0x100|CMD_ACCESS);
4245         }
4246 done:
4247         if (lock)
4248                 up(&ai->sem);
4249         return rc;
4250 }
4251
4252 /* Allocates a FID to be used for transmitting packets.  We only use
4253    one for now. */
4254 static u16 transmit_allocate(struct airo_info *ai, int lenPayload, int raw)
4255 {
4256         unsigned int loop = 3000;
4257         Cmd cmd;
4258         Resp rsp;
4259         u16 txFid;
4260         __le16 txControl;
4261
4262         cmd.cmd = CMD_ALLOCATETX;
4263         cmd.parm0 = lenPayload;
4264         if (down_interruptible(&ai->sem))
4265                 return ERROR;
4266         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
4267                 txFid = ERROR;
4268                 goto done;
4269         }
4270         if ( (rsp.status & 0xFF00) != 0) {
4271                 txFid = ERROR;
4272                 goto done;
4273         }
4274         /* wait for the allocate event/indication
4275          * It makes me kind of nervous that this can just sit here and spin,
4276          * but in practice it only loops like four times. */
4277         while (((IN4500(ai, EVSTAT) & EV_ALLOC) == 0) && --loop);
4278         if (!loop) {
4279                 txFid = ERROR;
4280                 goto done;
4281         }
4282
4283         // get the allocated fid and acknowledge
4284         txFid = IN4500(ai, TXALLOCFID);
4285         OUT4500(ai, EVACK, EV_ALLOC);
4286
4287         /*  The CARD is pretty cool since it converts the ethernet packet
4288          *  into 802.11.  Also note that we don't release the FID since we
4289          *  will be using the same one over and over again. */
4290         /*  We only have to setup the control once since we are not
4291          *  releasing the fid. */
4292         if (raw)
4293                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_11
4294                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4295         else
4296                 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_3
4297                         | TXCTL_ETHERNET | TXCTL_NORELEASE);
4298         if (bap_setup(ai, txFid, 0x0008, BAP1) != SUCCESS)
4299                 txFid = ERROR;
4300         else
4301                 bap_write(ai, &txControl, sizeof(txControl), BAP1);
4302
4303 done:
4304         up(&ai->sem);
4305
4306         return txFid;
4307 }
4308
4309 /* In general BAP1 is dedicated to transmiting packets.  However,
4310    since we need a BAP when accessing RIDs, we also use BAP1 for that.
4311    Make sure the BAP1 spinlock is held when this is called. */
4312 static int transmit_802_3_packet(struct airo_info *ai, int len, char *pPacket)
4313 {
4314         __le16 payloadLen;
4315         Cmd cmd;
4316         Resp rsp;
4317         int miclen = 0;
4318         u16 txFid = len;
4319         MICBuffer pMic;
4320
4321         len >>= 16;
4322
4323         if (len <= ETH_ALEN * 2) {
4324                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4325                 return ERROR;
4326         }
4327         len -= ETH_ALEN * 2;
4328
4329         if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled && 
4330             (ntohs(((__be16 *)pPacket)[6]) != 0x888E)) {
4331                 if (encapsulate(ai,(etherHead *)pPacket,&pMic,len) != SUCCESS)
4332                         return ERROR;
4333                 miclen = sizeof(pMic);
4334         }
4335         // packet is destination[6], source[6], payload[len-12]
4336         // write the payload length and dst/src/payload
4337         if (bap_setup(ai, txFid, 0x0036, BAP1) != SUCCESS) return ERROR;
4338         /* The hardware addresses aren't counted as part of the payload, so
4339          * we have to subtract the 12 bytes for the addresses off */
4340         payloadLen = cpu_to_le16(len + miclen);
4341         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4342         bap_write(ai, (__le16*)pPacket, sizeof(etherHead), BAP1);
4343         if (miclen)
4344                 bap_write(ai, (__le16*)&pMic, miclen, BAP1);
4345         bap_write(ai, (__le16*)(pPacket + sizeof(etherHead)), len, BAP1);
4346         // issue the transmit command
4347         memset( &cmd, 0, sizeof( cmd ) );
4348         cmd.cmd = CMD_TRANSMIT;
4349         cmd.parm0 = txFid;
4350         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4351         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4352         return SUCCESS;
4353 }
4354
4355 static int transmit_802_11_packet(struct airo_info *ai, int len, char *pPacket)
4356 {
4357         __le16 fc, payloadLen;
4358         Cmd cmd;
4359         Resp rsp;
4360         int hdrlen;
4361         static u8 tail[(30-10) + 2 + 6] = {[30-10] = 6};
4362         /* padding of header to full size + le16 gaplen (6) + gaplen bytes */
4363         u16 txFid = len;
4364         len >>= 16;
4365
4366         fc = *(__le16*)pPacket;
4367         hdrlen = header_len(fc);
4368
4369         if (len < hdrlen) {
4370                 airo_print_warn(ai->dev->name, "Short packet %d", len);
4371                 return ERROR;
4372         }
4373
4374         /* packet is 802.11 header +  payload
4375          * write the payload length and dst/src/payload */
4376         if (bap_setup(ai, txFid, 6, BAP1) != SUCCESS) return ERROR;
4377         /* The 802.11 header aren't counted as part of the payload, so
4378          * we have to subtract the header bytes off */
4379         payloadLen = cpu_to_le16(len-hdrlen);
4380         bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4381         if (bap_setup(ai, txFid, 0x0014, BAP1) != SUCCESS) return ERROR;
4382         bap_write(ai, (__le16 *)pPacket, hdrlen, BAP1);
4383         bap_write(ai, (__le16 *)(tail + (hdrlen - 10)), 38 - hdrlen, BAP1);
4384
4385         bap_write(ai, (__le16 *)(pPacket + hdrlen), len - hdrlen, BAP1);
4386         // issue the transmit command
4387         memset( &cmd, 0, sizeof( cmd ) );
4388         cmd.cmd = CMD_TRANSMIT;
4389         cmd.parm0 = txFid;
4390         if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4391         if ( (rsp.status & 0xFF00) != 0) return ERROR;
4392         return SUCCESS;
4393 }
4394
4395 /*
4396  *  This is the proc_fs routines.  It is a bit messier than I would
4397  *  like!  Feel free to clean it up!
4398  */
4399
4400 static ssize_t proc_read( struct file *file,
4401                           char __user *buffer,
4402                           size_t len,
4403                           loff_t *offset);
4404
4405 static ssize_t proc_write( struct file *file,
4406                            const char __user *buffer,
4407                            size_t len,
4408                            loff_t *offset );
4409 static int proc_close( struct inode *inode, struct file *file );
4410
4411 static int proc_stats_open( struct inode *inode, struct file *file );
4412 static int proc_statsdelta_open( struct inode *inode, struct file *file );
4413 static int proc_status_open( struct inode *inode, struct file *file );
4414 static int proc_SSID_open( struct inode *inode, struct file *file );
4415 static int proc_APList_open( struct inode *inode, struct file *file );
4416 static int proc_BSSList_open( struct inode *inode, struct file *file );
4417 static int proc_config_open( struct inode *inode, struct file *file );
4418 static int proc_wepkey_open( struct inode *inode, struct file *file );
4419
4420 static const struct file_operations proc_statsdelta_ops = {
4421         .owner          = THIS_MODULE,
4422         .read           = proc_read,
4423         .open           = proc_statsdelta_open,
4424         .release        = proc_close,
4425         .llseek         = default_llseek,
4426 };
4427
4428 static const struct file_operations proc_stats_ops = {
4429         .owner          = THIS_MODULE,
4430         .read           = proc_read,
4431         .open           = proc_stats_open,
4432         .release        = proc_close,
4433         .llseek         = default_llseek,
4434 };
4435
4436 static const struct file_operations proc_status_ops = {
4437         .owner          = THIS_MODULE,
4438         .read           = proc_read,
4439         .open           = proc_status_open,
4440         .release        = proc_close,
4441         .llseek         = default_llseek,
4442 };
4443
4444 static const struct file_operations proc_SSID_ops = {
4445         .owner          = THIS_MODULE,
4446         .read           = proc_read,
4447         .write          = proc_write,
4448         .open           = proc_SSID_open,
4449         .release        = proc_close,
4450         .llseek         = default_llseek,
4451 };
4452
4453 static const struct file_operations proc_BSSList_ops = {
4454         .owner          = THIS_MODULE,
4455         .read           = proc_read,
4456         .write          = proc_write,
4457         .open           = proc_BSSList_open,
4458         .release        = proc_close,
4459         .llseek         = default_llseek,
4460 };
4461
4462 static const struct file_operations proc_APList_ops = {
4463         .owner          = THIS_MODULE,
4464         .read           = proc_read,
4465         .write          = proc_write,
4466         .open           = proc_APList_open,
4467         .release        = proc_close,
4468         .llseek         = default_llseek,
4469 };
4470
4471 static const struct file_operations proc_config_ops = {
4472         .owner          = THIS_MODULE,
4473         .read           = proc_read,
4474         .write          = proc_write,
4475         .open           = proc_config_open,
4476         .release        = proc_close,
4477         .llseek         = default_llseek,
4478 };
4479
4480 static const struct file_operations proc_wepkey_ops = {
4481         .owner          = THIS_MODULE,
4482         .read           = proc_read,
4483         .write          = proc_write,
4484         .open           = proc_wepkey_open,
4485         .release        = proc_close,
4486         .llseek         = default_llseek,
4487 };
4488
4489 static struct proc_dir_entry *airo_entry;
4490
4491 struct proc_data {
4492         int release_buffer;
4493         int readlen;
4494         char *rbuffer;
4495         int writelen;
4496         int maxwritelen;
4497         char *wbuffer;
4498         void (*on_close) (struct inode *, struct file *);
4499 };
4500
4501 static int setup_proc_entry( struct net_device *dev,
4502                              struct airo_info *apriv ) {
4503         struct proc_dir_entry *entry;
4504
4505         /* First setup the device directory */
4506         strcpy(apriv->proc_name,dev->name);
4507         apriv->proc_entry = proc_mkdir_mode(apriv->proc_name, airo_perm,
4508                                             airo_entry);
4509         if (!apriv->proc_entry)
4510                 return -ENOMEM;
4511         proc_set_user(apriv->proc_entry, proc_kuid, proc_kgid);
4512
4513         /* Setup the StatsDelta */
4514         entry = proc_create_data("StatsDelta", S_IRUGO & proc_perm,
4515                                  apriv->proc_entry, &proc_statsdelta_ops, dev);
4516         if (!entry)
4517                 goto fail;
4518         proc_set_user(entry, proc_kuid, proc_kgid);
4519
4520         /* Setup the Stats */
4521         entry = proc_create_data("Stats", S_IRUGO & proc_perm,
4522                                  apriv->proc_entry, &proc_stats_ops, dev);
4523         if (!entry)
4524                 goto fail;
4525         proc_set_user(entry, proc_kuid, proc_kgid);
4526
4527         /* Setup the Status */
4528         entry = proc_create_data("Status", S_IRUGO & proc_perm,
4529                                  apriv->proc_entry, &proc_status_ops, dev);
4530         if (!entry)
4531                 goto fail;
4532         proc_set_user(entry, proc_kuid, proc_kgid);
4533
4534         /* Setup the Config */
4535         entry = proc_create_data("Config", proc_perm,
4536                                  apriv->proc_entry, &proc_config_ops, dev);
4537         if (!entry)
4538                 goto fail;
4539         proc_set_user(entry, proc_kuid, proc_kgid);
4540
4541         /* Setup the SSID */
4542         entry = proc_create_data("SSID", proc_perm,
4543                                  apriv->proc_entry, &proc_SSID_ops, dev);
4544         if (!entry)
4545                 goto fail;
4546         proc_set_user(entry, proc_kuid, proc_kgid);
4547
4548         /* Setup the APList */
4549         entry = proc_create_data("APList", proc_perm,
4550                                  apriv->proc_entry, &proc_APList_ops, dev);
4551         if (!entry)
4552                 goto fail;
4553         proc_set_user(entry, proc_kuid, proc_kgid);
4554
4555         /* Setup the BSSList */
4556         entry = proc_create_data("BSSList", proc_perm,
4557                                  apriv->proc_entry, &proc_BSSList_ops, dev);
4558         if (!entry)
4559                 goto fail;
4560         proc_set_user(entry, proc_kuid, proc_kgid);
4561
4562         /* Setup the WepKey */
4563         entry = proc_create_data("WepKey", proc_perm,
4564                                  apriv->proc_entry, &proc_wepkey_ops, dev);
4565         if (!entry)
4566                 goto fail;
4567         proc_set_user(entry, proc_kuid, proc_kgid);
4568         return 0;
4569
4570 fail:
4571         remove_proc_subtree(apriv->proc_name, airo_entry);
4572         return -ENOMEM;
4573 }
4574
4575 static int takedown_proc_entry( struct net_device *dev,
4576                                 struct airo_info *apriv )
4577 {
4578         remove_proc_subtree(apriv->proc_name, airo_entry);
4579         return 0;
4580 }
4581
4582 /*
4583  *  What we want from the proc_fs is to be able to efficiently read
4584  *  and write the configuration.  To do this, we want to read the
4585  *  configuration when the file is opened and write it when the file is
4586  *  closed.  So basically we allocate a read buffer at open and fill it
4587  *  with data, and allocate a write buffer and read it at close.
4588  */
4589
4590 /*
4591  *  The read routine is generic, it relies on the preallocated rbuffer
4592  *  to supply the data.
4593  */
4594 static ssize_t proc_read( struct file *file,
4595                           char __user *buffer,
4596                           size_t len,
4597                           loff_t *offset )
4598 {
4599         struct proc_data *priv = file->private_data;
4600
4601         if (!priv->rbuffer)
4602                 return -EINVAL;
4603
4604         return simple_read_from_buffer(buffer, len, offset, priv->rbuffer,
4605                                         priv->readlen);
4606 }
4607
4608 /*
4609  *  The write routine is generic, it fills in a preallocated rbuffer
4610  *  to supply the data.
4611  */
4612 static ssize_t proc_write( struct file *file,
4613                            const char __user *buffer,
4614                            size_t len,
4615                            loff_t *offset )
4616 {
4617         ssize_t ret;
4618         struct proc_data *priv = file->private_data;
4619
4620         if (!priv->wbuffer)
4621                 return -EINVAL;
4622
4623         ret = simple_write_to_buffer(priv->wbuffer, priv->maxwritelen, offset,
4624                                         buffer, len);
4625         if (ret > 0)
4626                 priv->writelen = max_t(int, priv->writelen, *offset);
4627
4628         return ret;
4629 }
4630
4631 static int proc_status_open(struct inode *inode, struct file *file)
4632 {
4633         struct proc_data *data;
4634         struct net_device *dev = PDE_DATA(inode);
4635         struct airo_info *apriv = dev->ml_priv;
4636         CapabilityRid cap_rid;
4637         StatusRid status_rid;
4638         u16 mode;
4639         int i;
4640
4641         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4642                 return -ENOMEM;
4643         data = file->private_data;
4644         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4645                 kfree (file->private_data);
4646                 return -ENOMEM;
4647         }
4648
4649         readStatusRid(apriv, &status_rid, 1);
4650         readCapabilityRid(apriv, &cap_rid, 1);
4651
4652         mode = le16_to_cpu(status_rid.mode);
4653
4654         i = sprintf(data->rbuffer, "Status: %s%s%s%s%s%s%s%s%s\n",
4655                     mode & 1 ? "CFG ": "",
4656                     mode & 2 ? "ACT ": "",
4657                     mode & 0x10 ? "SYN ": "",
4658                     mode & 0x20 ? "LNK ": "",
4659                     mode & 0x40 ? "LEAP ": "",
4660                     mode & 0x80 ? "PRIV ": "",
4661                     mode & 0x100 ? "KEY ": "",
4662                     mode & 0x200 ? "WEP ": "",
4663                     mode & 0x8000 ? "ERR ": "");
4664         sprintf( data->rbuffer+i, "Mode: %x\n"
4665                  "Signal Strength: %d\n"
4666                  "Signal Quality: %d\n"
4667                  "SSID: %-.*s\n"
4668                  "AP: %-.16s\n"
4669                  "Freq: %d\n"
4670                  "BitRate: %dmbs\n"
4671                  "Driver Version: %s\n"
4672                  "Device: %s\nManufacturer: %s\nFirmware Version: %s\n"
4673                  "Radio type: %x\nCountry: %x\nHardware Version: %x\n"
4674                  "Software Version: %x\nSoftware Subversion: %x\n"
4675                  "Boot block version: %x\n",
4676                  le16_to_cpu(status_rid.mode),
4677                  le16_to_cpu(status_rid.normalizedSignalStrength),
4678                  le16_to_cpu(status_rid.signalQuality),
4679                  le16_to_cpu(status_rid.SSIDlen),
4680                  status_rid.SSID,
4681                  status_rid.apName,
4682                  le16_to_cpu(status_rid.channel),
4683                  le16_to_cpu(status_rid.currentXmitRate) / 2,
4684                  version,
4685                  cap_rid.prodName,
4686                  cap_rid.manName,
4687                  cap_rid.prodVer,
4688                  le16_to_cpu(cap_rid.radioType),
4689                  le16_to_cpu(cap_rid.country),
4690                  le16_to_cpu(cap_rid.hardVer),
4691                  le16_to_cpu(cap_rid.softVer),
4692                  le16_to_cpu(cap_rid.softSubVer),
4693                  le16_to_cpu(cap_rid.bootBlockVer));
4694         data->readlen = strlen( data->rbuffer );
4695         return 0;
4696 }
4697
4698 static int proc_stats_rid_open(struct inode*, struct file*, u16);
4699 static int proc_statsdelta_open( struct inode *inode,
4700                                  struct file *file ) {
4701         if (file->f_mode&FMODE_WRITE) {
4702                 return proc_stats_rid_open(inode, file, RID_STATSDELTACLEAR);
4703         }
4704         return proc_stats_rid_open(inode, file, RID_STATSDELTA);
4705 }
4706
4707 static int proc_stats_open( struct inode *inode, struct file *file ) {
4708         return proc_stats_rid_open(inode, file, RID_STATS);
4709 }
4710
4711 static int proc_stats_rid_open( struct inode *inode,
4712                                 struct file *file,
4713                                 u16 rid )
4714 {
4715         struct proc_data *data;
4716         struct net_device *dev = PDE_DATA(inode);
4717         struct airo_info *apriv = dev->ml_priv;
4718         StatsRid stats;
4719         int i, j;
4720         __le32 *vals = stats.vals;
4721         int len;
4722
4723         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4724                 return -ENOMEM;
4725         data = file->private_data;
4726         if ((data->rbuffer = kmalloc( 4096, GFP_KERNEL )) == NULL) {
4727                 kfree (file->private_data);
4728                 return -ENOMEM;
4729         }
4730
4731         readStatsRid(apriv, &stats, rid, 1);
4732         len = le16_to_cpu(stats.len);
4733
4734         j = 0;
4735         for(i=0; statsLabels[i]!=(char *)-1 && i*4<len; i++) {
4736                 if (!statsLabels[i]) continue;
4737                 if (j+strlen(statsLabels[i])+16>4096) {
4738                         airo_print_warn(apriv->dev->name,
4739                                "Potentially disastrous buffer overflow averted!");
4740                         break;
4741                 }
4742                 j+=sprintf(data->rbuffer+j, "%s: %u\n", statsLabels[i],
4743                                 le32_to_cpu(vals[i]));
4744         }
4745         if (i*4 >= len) {
4746                 airo_print_warn(apriv->dev->name, "Got a short rid");
4747         }
4748         data->readlen = j;
4749         return 0;
4750 }
4751
4752 static int get_dec_u16( char *buffer, int *start, int limit ) {
4753         u16 value;
4754         int valid = 0;
4755         for (value = 0; *start < limit && buffer[*start] >= '0' &&
4756                         buffer[*start] <= '9'; (*start)++) {
4757                 valid = 1;
4758                 value *= 10;
4759                 value += buffer[*start] - '0';
4760         }
4761         if ( !valid ) return -1;
4762         return value;
4763 }
4764
4765 static int airo_config_commit(struct net_device *dev,
4766                               struct iw_request_info *info, void *zwrq,
4767                               char *extra);
4768
4769 static inline int sniffing_mode(struct airo_info *ai)
4770 {
4771         return (le16_to_cpu(ai->config.rmode) & le16_to_cpu(RXMODE_MASK)) >=
4772                 le16_to_cpu(RXMODE_RFMON);
4773 }
4774
4775 static void proc_config_on_close(struct inode *inode, struct file *file)
4776 {
4777         struct proc_data *data = file->private_data;
4778         struct net_device *dev = PDE_DATA(inode);
4779         struct airo_info *ai = dev->ml_priv;
4780         char *line;
4781
4782         if ( !data->writelen ) return;
4783
4784         readConfigRid(ai, 1);
4785         set_bit (FLAG_COMMIT, &ai->flags);
4786
4787         line = data->wbuffer;
4788         while( line[0] ) {
4789 /*** Mode processing */
4790                 if ( !strncmp( line, "Mode: ", 6 ) ) {
4791                         line += 6;
4792                         if (sniffing_mode(ai))
4793                                 set_bit (FLAG_RESET, &ai->flags);
4794                         ai->config.rmode &= ~RXMODE_FULL_MASK;
4795                         clear_bit (FLAG_802_11, &ai->flags);
4796                         ai->config.opmode &= ~MODE_CFG_MASK;
4797                         ai->config.scanMode = SCANMODE_ACTIVE;
4798                         if ( line[0] == 'a' ) {
4799                                 ai->config.opmode |= MODE_STA_IBSS;
4800                         } else {
4801                                 ai->config.opmode |= MODE_STA_ESS;
4802                                 if ( line[0] == 'r' ) {
4803                                         ai->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
4804                                         ai->config.scanMode = SCANMODE_PASSIVE;
4805                                         set_bit (FLAG_802_11, &ai->flags);
4806                                 } else if ( line[0] == 'y' ) {
4807                                         ai->config.rmode |= RXMODE_RFMON_ANYBSS | RXMODE_DISABLE_802_3_HEADER;
4808                                         ai->config.scanMode = SCANMODE_PASSIVE;
4809                                         set_bit (FLAG_802_11, &ai->flags);
4810                                 } else if ( line[0] == 'l' )
4811                                         ai->config.rmode |= RXMODE_LANMON;
4812                         }
4813                         set_bit (FLAG_COMMIT, &ai->flags);
4814                 }
4815
4816 /*** Radio status */
4817                 else if (!strncmp(line,"Radio: ", 7)) {
4818                         line += 7;
4819                         if (!strncmp(line,"off",3)) {
4820                                 set_bit (FLAG_RADIO_OFF, &ai->flags);
4821                         } else {
4822                                 clear_bit (FLAG_RADIO_OFF, &ai->flags);
4823                         }
4824                 }
4825 /*** NodeName processing */
4826                 else if ( !strncmp( line, "NodeName: ", 10 ) ) {
4827                         int j;
4828
4829                         line += 10;
4830                         memset( ai->config.nodeName, 0, 16 );
4831 /* Do the name, assume a space between the mode and node name */
4832                         for( j = 0; j < 16 && line[j] != '\n'; j++ ) {
4833                                 ai->config.nodeName[j] = line[j];
4834                         }
4835                         set_bit (FLAG_COMMIT, &ai->flags);
4836                 }
4837
4838 /*** PowerMode processing */
4839                 else if ( !strncmp( line, "PowerMode: ", 11 ) ) {
4840                         line += 11;
4841                         if ( !strncmp( line, "PSPCAM", 6 ) ) {
4842                                 ai->config.powerSaveMode = POWERSAVE_PSPCAM;
4843                                 set_bit (FLAG_COMMIT, &ai->flags);
4844                         } else if ( !strncmp( line, "PSP", 3 ) ) {
4845                                 ai->config.powerSaveMode = POWERSAVE_PSP;
4846                                 set_bit (FLAG_COMMIT, &ai->flags);
4847                         } else {
4848                                 ai->config.powerSaveMode = POWERSAVE_CAM;
4849                                 set_bit (FLAG_COMMIT, &ai->flags);
4850                         }
4851                 } else if ( !strncmp( line, "DataRates: ", 11 ) ) {
4852                         int v, i = 0, k = 0; /* i is index into line,
4853                                                 k is index to rates */
4854
4855                         line += 11;
4856                         while((v = get_dec_u16(line, &i, 3))!=-1) {
4857                                 ai->config.rates[k++] = (u8)v;
4858                                 line += i + 1;
4859                                 i = 0;
4860                         }
4861                         set_bit (FLAG_COMMIT, &ai->flags);
4862                 } else if ( !strncmp( line, "Channel: ", 9 ) ) {
4863                         int v, i = 0;
4864                         line += 9;
4865                         v = get_dec_u16(line, &i, i+3);
4866                         if ( v != -1 ) {
4867                                 ai->config.channelSet = cpu_to_le16(v);
4868                                 set_bit (FLAG_COMMIT, &ai->flags);
4869                         }
4870                 } else if ( !strncmp( line, "XmitPower: ", 11 ) ) {
4871                         int v, i = 0;
4872                         line += 11;
4873                         v = get_dec_u16(line, &i, i+3);
4874                         if ( v != -1 ) {
4875                                 ai->config.txPower = cpu_to_le16(v);
4876                                 set_bit (FLAG_COMMIT, &ai->flags);
4877                         }
4878                 } else if ( !strncmp( line, "WEP: ", 5 ) ) {
4879                         line += 5;
4880                         switch( line[0] ) {
4881                         case 's':
4882                                 ai->config.authType = AUTH_SHAREDKEY;
4883                                 break;
4884                         case 'e':
4885                                 ai->config.authType = AUTH_ENCRYPT;
4886                                 break;
4887                         default:
4888                                 ai->config.authType = AUTH_OPEN;
4889                                 break;
4890                         }
4891                         set_bit (FLAG_COMMIT, &ai->flags);
4892                 } else if ( !strncmp( line, "LongRetryLimit: ", 16 ) ) {
4893                         int v, i = 0;
4894
4895                         line += 16;
4896                         v = get_dec_u16(line, &i, 3);
4897                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4898                         ai->config.longRetryLimit = cpu_to_le16(v);
4899                         set_bit (FLAG_COMMIT, &ai->flags);
4900                 } else if ( !strncmp( line, "ShortRetryLimit: ", 17 ) ) {
4901                         int v, i = 0;
4902
4903                         line += 17;
4904                         v = get_dec_u16(line, &i, 3);
4905                         v = (v<0) ? 0 : ((v>255) ? 255 : v);
4906                         ai->config.shortRetryLimit = cpu_to_le16(v);
4907                         set_bit (FLAG_COMMIT, &ai->flags);
4908                 } else if ( !strncmp( line, "RTSThreshold: ", 14 ) ) {
4909                         int v, i = 0;
4910
4911                         line += 14;
4912                         v = get_dec_u16(line, &i, 4);
4913                         v = (v<0) ? 0 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4914                         ai->config.rtsThres = cpu_to_le16(v);
4915                         set_bit (FLAG_COMMIT, &ai->flags);
4916                 } else if ( !strncmp( line, "TXMSDULifetime: ", 16 ) ) {
4917                         int v, i = 0;
4918
4919                         line += 16;
4920                         v = get_dec_u16(line, &i, 5);
4921                         v = (v<0) ? 0 : v;
4922                         ai->config.txLifetime = cpu_to_le16(v);
4923                         set_bit (FLAG_COMMIT, &ai->flags);
4924                 } else if ( !strncmp( line, "RXMSDULifetime: ", 16 ) ) {
4925                         int v, i = 0;
4926
4927                         line += 16;
4928                         v = get_dec_u16(line, &i, 5);
4929                         v = (v<0) ? 0 : v;
4930                         ai->config.rxLifetime = cpu_to_le16(v);
4931                         set_bit (FLAG_COMMIT, &ai->flags);
4932                 } else if ( !strncmp( line, "TXDiversity: ", 13 ) ) {
4933                         ai->config.txDiversity =
4934                                 (line[13]=='l') ? 1 :
4935                                 ((line[13]=='r')? 2: 3);
4936                         set_bit (FLAG_COMMIT, &ai->flags);
4937                 } else if ( !strncmp( line, "RXDiversity: ", 13 ) ) {
4938                         ai->config.rxDiversity =
4939                                 (line[13]=='l') ? 1 :
4940                                 ((line[13]=='r')? 2: 3);
4941                         set_bit (FLAG_COMMIT, &ai->flags);
4942                 } else if ( !strncmp( line, "FragThreshold: ", 15 ) ) {
4943                         int v, i = 0;
4944
4945                         line += 15;
4946                         v = get_dec_u16(line, &i, 4);
4947                         v = (v<256) ? 256 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4948                         v = v & 0xfffe; /* Make sure its even */
4949                         ai->config.fragThresh = cpu_to_le16(v);
4950                         set_bit (FLAG_COMMIT, &ai->flags);
4951                 } else if (!strncmp(line, "Modulation: ", 12)) {
4952                         line += 12;
4953                         switch(*line) {
4954                         case 'd':  ai->config.modulation=MOD_DEFAULT; set_bit(FLAG_COMMIT, &ai->flags); break;
4955                         case 'c':  ai->config.modulation=MOD_CCK; set_bit(FLAG_COMMIT, &ai->flags); break;
4956                         case 'm':  ai->config.modulation=MOD_MOK; set_bit(FLAG_COMMIT, &ai->flags); break;
4957                         default: airo_print_warn(ai->dev->name, "Unknown modulation");
4958                         }
4959                 } else if (!strncmp(line, "Preamble: ", 10)) {
4960                         line += 10;
4961                         switch(*line) {
4962                         case 'a': ai->config.preamble=PREAMBLE_AUTO; set_bit(FLAG_COMMIT, &ai->flags); break;
4963                         case 'l': ai->config.preamble=PREAMBLE_LONG; set_bit(FLAG_COMMIT, &ai->flags); break;
4964                         case 's': ai->config.preamble=PREAMBLE_SHORT; set_bit(FLAG_COMMIT, &ai->flags); break;
4965                         default: airo_print_warn(ai->dev->name, "Unknown preamble");
4966                         }
4967                 } else {
4968                         airo_print_warn(ai->dev->name, "Couldn't figure out %s", line);
4969                 }
4970                 while( line[0] && line[0] != '\n' ) line++;
4971                 if ( line[0] ) line++;
4972         }
4973         airo_config_commit(dev, NULL, NULL, NULL);
4974 }
4975
4976 static const char *get_rmode(__le16 mode)
4977 {
4978         switch(mode & RXMODE_MASK) {
4979         case RXMODE_RFMON:  return "rfmon";
4980         case RXMODE_RFMON_ANYBSS:  return "yna (any) bss rfmon";
4981         case RXMODE_LANMON:  return "lanmon";
4982         }
4983         return "ESS";
4984 }
4985
4986 static int proc_config_open(struct inode *inode, struct file *file)
4987 {
4988         struct proc_data *data;
4989         struct net_device *dev = PDE_DATA(inode);
4990         struct airo_info *ai = dev->ml_priv;
4991         int i;
4992         __le16 mode;
4993
4994         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4995                 return -ENOMEM;
4996         data = file->private_data;
4997         if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4998                 kfree (file->private_data);
4999                 return -ENOMEM;
5000         }
5001         if ((data->wbuffer = kzalloc( 2048, GFP_KERNEL )) == NULL) {
5002                 kfree (data->rbuffer);
5003                 kfree (file->private_data);
5004                 return -ENOMEM;
5005         }
5006         data->maxwritelen = 2048;
5007         data->on_close = proc_config_on_close;
5008
5009         readConfigRid(ai, 1);
5010
5011         mode = ai->config.opmode & MODE_CFG_MASK;
5012         i = sprintf( data->rbuffer,
5013                      "Mode: %s\n"
5014                      "Radio: %s\n"
5015                      "NodeName: %-16s\n"
5016                      "PowerMode: %s\n"
5017                      "DataRates: %d %d %d %d %d %d %d %d\n"
5018                      "Channel: %d\n"
5019                      "XmitPower: %d\n",
5020                      mode == MODE_STA_IBSS ? "adhoc" :
5021                      mode == MODE_STA_ESS ? get_rmode(ai->config.rmode):
5022                      mode == MODE_AP ? "AP" :
5023                      mode == MODE_AP_RPTR ? "AP RPTR" : "Error",
5024                      test_bit(FLAG_RADIO_OFF, &ai->flags) ? "off" : "on",
5025                      ai->config.nodeName,
5026                      ai->config.powerSaveMode == POWERSAVE_CAM ? "CAM" :
5027                      ai->config.powerSaveMode == POWERSAVE_PSP ? "PSP" :
5028                      ai->config.powerSaveMode == POWERSAVE_PSPCAM ? "PSPCAM" :
5029                      "Error",
5030                      (int)ai->config.rates[0],
5031                      (int)ai->config.rates[1],
5032                      (int)ai->config.rates[2],
5033                      (int)ai->config.rates[3],
5034                      (int)ai->config.rates[4],
5035                      (int)ai->config.rates[5],
5036                      (int)ai->config.rates[6],
5037                      (int)ai->config.rates[7],
5038                      le16_to_cpu(ai->config.channelSet),
5039                      le16_to_cpu(ai->config.txPower)
5040                 );
5041         sprintf( data->rbuffer + i,
5042                  "LongRetryLimit: %d\n"
5043                  "ShortRetryLimit: %d\n"
5044                  "RTSThreshold: %d\n"
5045                  "TXMSDULifetime: %d\n"
5046                  "RXMSDULifetime: %d\n"
5047                  "TXDiversity: %s\n"
5048                  "RXDiversity: %s\n"
5049                  "FragThreshold: %d\n"
5050                  "WEP: %s\n"
5051                  "Modulation: %s\n"
5052                  "Preamble: %s\n",
5053                  le16_to_cpu(ai->config.longRetryLimit),
5054                  le16_to_cpu(ai->config.shortRetryLimit),
5055                  le16_to_cpu(ai->config.rtsThres),
5056                  le16_to_cpu(ai->config.txLifetime),
5057                  le16_to_cpu(ai->config.rxLifetime),
5058                  ai->config.txDiversity == 1 ? "left" :
5059                  ai->config.txDiversity == 2 ? "right" : "both",
5060                  ai->config.rxDiversity == 1 ? "left" :
5061                  ai->config.rxDiversity == 2 ? "right" : "both",
5062                  le16_to_cpu(ai->config.fragThresh),
5063                  ai->config.authType == AUTH_ENCRYPT ? "encrypt" :
5064                  ai->config.authType == AUTH_SHAREDKEY ? "shared" : "open",
5065                  ai->config.modulation == MOD_DEFAULT ? "default" :
5066                  ai->config.modulation == MOD_CCK ? "cck" :
5067                  ai->config.modulation == MOD_MOK ? "mok" : "error",
5068                  ai->config.preamble == PREAMBLE_AUTO ? "auto" :
5069                  ai->config.preamble == PREAMBLE_LONG ? "long" :
5070                  ai->config.preamble == PREAMBLE_SHORT ? "short" : "error"
5071                 );
5072         data->readlen = strlen( data->rbuffer );
5073         return 0;
5074 }
5075
5076 static void proc_SSID_on_close(struct inode *inode, struct file *file)
5077 {
5078         struct proc_data *data = file->private_data;
5079         struct net_device *dev = PDE_DATA(inode);
5080         struct airo_info *ai = dev->ml_priv;
5081         SsidRid SSID_rid;
5082         int i;
5083         char *p = data->wbuffer;
5084         char *end = p + data->writelen;
5085
5086         if (!data->writelen)
5087                 return;
5088
5089         *end = '\n'; /* sentinel; we have space for it */
5090
5091         memset(&SSID_rid, 0, sizeof(SSID_rid));
5092
5093         for (i = 0; i < 3 && p < end; i++) {
5094                 int j = 0;
5095                 /* copy up to 32 characters from this line */
5096                 while (*p != '\n' && j < 32)
5097                         SSID_rid.ssids[i].ssid[j++] = *p++;
5098                 if (j == 0)
5099                         break;
5100                 SSID_rid.ssids[i].len = cpu_to_le16(j);
5101                 /* skip to the beginning of the next line */
5102                 while (*p++ != '\n')
5103                         ;
5104         }
5105         if (i)
5106                 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5107         disable_MAC(ai, 1);
5108         writeSsidRid(ai, &SSID_rid, 1);
5109         enable_MAC(ai, 1);
5110 }
5111
5112 static void proc_APList_on_close( struct inode *inode, struct file *file ) {
5113         struct proc_data *data = file->private_data;
5114         struct net_device *dev = PDE_DATA(inode);
5115         struct airo_info *ai = dev->ml_priv;
5116         APListRid APList_rid;
5117         int i;
5118
5119         if ( !data->writelen ) return;
5120
5121         memset( &APList_rid, 0, sizeof(APList_rid) );
5122         APList_rid.len = cpu_to_le16(sizeof(APList_rid));
5123
5124         for( i = 0; i < 4 && data->writelen >= (i+1)*6*3; i++ ) {
5125                 int j;
5126                 for( j = 0; j < 6*3 && data->wbuffer[j+i*6*3]; j++ ) {
5127                         switch(j%3) {
5128                         case 0:
5129                                 APList_rid.ap[i][j/3]=
5130                                         hex_to_bin(data->wbuffer[j+i*6*3])<<4;
5131                                 break;
5132                         case 1:
5133                                 APList_rid.ap[i][j/3]|=
5134                                         hex_to_bin(data->wbuffer[j+i*6*3]);
5135                                 break;
5136                         }
5137                 }
5138         }
5139         disable_MAC(ai, 1);
5140         writeAPListRid(ai, &APList_rid, 1);
5141         enable_MAC(ai, 1);
5142 }
5143
5144 /* This function wraps PC4500_writerid with a MAC disable */
5145 static int do_writerid( struct airo_info *ai, u16 rid, const void *rid_data,
5146                         int len, int dummy ) {
5147         int rc;
5148
5149         disable_MAC(ai, 1);
5150         rc = PC4500_writerid(ai, rid, rid_data, len, 1);
5151         enable_MAC(ai, 1);
5152         return rc;
5153 }
5154
5155 /* Returns the WEP key at the specified index, or -1 if that key does
5156  * not exist.  The buffer is assumed to be at least 16 bytes in length.
5157  */
5158 static int get_wep_key(struct airo_info *ai, u16 index, char *buf, u16 buflen)
5159 {
5160         WepKeyRid wkr;
5161         int rc;
5162         __le16 lastindex;
5163
5164         rc = readWepKeyRid(ai, &wkr, 1, 1);
5165         if (rc != SUCCESS)
5166                 return -1;
5167         do {
5168                 lastindex = wkr.kindex;
5169                 if (le16_to_cpu(wkr.kindex) == index) {
5170                         int klen = min_t(int, buflen, le16_to_cpu(wkr.klen));
5171                         memcpy(buf, wkr.key, klen);
5172                         return klen;
5173                 }
5174                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5175                 if (rc != SUCCESS)
5176                         return -1;
5177         } while (lastindex != wkr.kindex);
5178         return -1;
5179 }
5180
5181 static int get_wep_tx_idx(struct airo_info *ai)
5182 {
5183         WepKeyRid wkr;
5184         int rc;
5185         __le16 lastindex;
5186
5187         rc = readWepKeyRid(ai, &wkr, 1, 1);
5188         if (rc != SUCCESS)
5189                 return -1;
5190         do {
5191                 lastindex = wkr.kindex;
5192                 if (wkr.kindex == cpu_to_le16(0xffff))
5193                         return wkr.mac[0];
5194                 rc = readWepKeyRid(ai, &wkr, 0, 1);
5195                 if (rc != SUCCESS)
5196                         return -1;
5197         } while (lastindex != wkr.kindex);
5198         return -1;
5199 }
5200
5201 static int set_wep_key(struct airo_info *ai, u16 index, const char *key,
5202                        u16 keylen, int perm, int lock)
5203 {
5204         static const unsigned char macaddr[ETH_ALEN] = { 0x01, 0, 0, 0, 0, 0 };
5205         WepKeyRid wkr;
5206         int rc;
5207
5208         if (WARN_ON(keylen == 0))
5209                 return -1;
5210
5211         memset(&wkr, 0, sizeof(wkr));
5212         wkr.len = cpu_to_le16(sizeof(wkr));
5213         wkr.kindex = cpu_to_le16(index);
5214         wkr.klen = cpu_to_le16(keylen);
5215         memcpy(wkr.key, key, keylen);
5216         memcpy(wkr.mac, macaddr, ETH_ALEN);
5217
5218         if (perm) disable_MAC(ai, lock);
5219         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5220         if (perm) enable_MAC(ai, lock);
5221         return rc;
5222 }
5223
5224 static int set_wep_tx_idx(struct airo_info *ai, u16 index, int perm, int lock)
5225 {
5226         WepKeyRid wkr;
5227         int rc;
5228
5229         memset(&wkr, 0, sizeof(wkr));
5230         wkr.len = cpu_to_le16(sizeof(wkr));
5231         wkr.kindex = cpu_to_le16(0xffff);
5232         wkr.mac[0] = (char)index;
5233
5234         if (perm) {
5235                 ai->defindex = (char)index;
5236                 disable_MAC(ai, lock);
5237         }
5238
5239         rc = writeWepKeyRid(ai, &wkr, perm, lock);
5240
5241         if (perm)
5242                 enable_MAC(ai, lock);
5243         return rc;
5244 }
5245
5246 static void proc_wepkey_on_close( struct inode *inode, struct file *file ) {
5247         struct proc_data *data;
5248         struct net_device *dev = PDE_DATA(inode);
5249         struct airo_info *ai = dev->ml_priv;
5250         int i, rc;
5251         char key[16];
5252         u16 index = 0;
5253         int j = 0;
5254
5255         memset(key, 0, sizeof(key));
5256
5257         data = file->private_data;
5258         if ( !data->writelen ) return;
5259
5260         if (data->wbuffer[0] >= '0' && data->wbuffer[0] <= '3' &&
5261             (data->wbuffer[1] == ' ' || data->wbuffer[1] == '\n')) {
5262                 index = data->wbuffer[0] - '0';
5263                 if (data->wbuffer[1] == '\n') {
5264                         rc = set_wep_tx_idx(ai, index, 1, 1);
5265                         if (rc < 0) {
5266                                 airo_print_err(ai->dev->name, "failed to set "
5267                                                "WEP transmit index to %d: %d.",
5268                                                index, rc);
5269                         }
5270                         return;
5271                 }
5272                 j = 2;
5273         } else {
5274                 airo_print_err(ai->dev->name, "WepKey passed invalid key index");
5275                 return;
5276         }
5277
5278         for( i = 0; i < 16*3 && data->wbuffer[i+j]; i++ ) {
5279                 switch(i%3) {
5280                 case 0:
5281                         key[i/3] = hex_to_bin(data->wbuffer[i+j])<<4;
5282                         break;
5283                 case 1:
5284                         key[i/3] |= hex_to_bin(data->wbuffer[i+j]);
5285                         break;
5286                 }
5287         }
5288
5289         rc = set_wep_key(ai, index, key, i/3, 1, 1);
5290         if (rc < 0) {
5291                 airo_print_err(ai->dev->name, "failed to set WEP key at index "
5292                                "%d: %d.", index, rc);
5293         }
5294 }
5295
5296 static int proc_wepkey_open( struct inode *inode, struct file *file )
5297 {
5298         struct proc_data *data;
5299         struct net_device *dev = PDE_DATA(inode);
5300         struct airo_info *ai = dev->ml_priv;
5301         char *ptr;
5302         WepKeyRid wkr;
5303         __le16 lastindex;
5304         int j=0;
5305         int rc;
5306
5307         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5308                 return -ENOMEM;
5309         memset(&wkr, 0, sizeof(wkr));
5310         data = file->private_data;
5311         if ((data->rbuffer = kzalloc( 180, GFP_KERNEL )) == NULL) {
5312                 kfree (file->private_data);
5313                 return -ENOMEM;
5314         }
5315         data->writelen = 0;
5316         data->maxwritelen = 80;
5317         if ((data->wbuffer = kzalloc( 80, GFP_KERNEL )) == NULL) {
5318                 kfree (data->rbuffer);
5319                 kfree (file->private_data);
5320                 return -ENOMEM;
5321         }
5322         data->on_close = proc_wepkey_on_close;
5323
5324         ptr = data->rbuffer;
5325         strcpy(ptr, "No wep keys\n");
5326         rc = readWepKeyRid(ai, &wkr, 1, 1);
5327         if (rc == SUCCESS) do {
5328                 lastindex = wkr.kindex;
5329                 if (wkr.kindex == cpu_to_le16(0xffff)) {
5330                         j += sprintf(ptr+j, "Tx key = %d\n",
5331                                      (int)wkr.mac[0]);
5332                 } else {
5333                         j += sprintf(ptr+j, "Key %d set with length = %d\n",
5334                                      le16_to_cpu(wkr.kindex),
5335                                      le16_to_cpu(wkr.klen));
5336                 }
5337                 readWepKeyRid(ai, &wkr, 0, 1);
5338         } while((lastindex != wkr.kindex) && (j < 180-30));
5339
5340         data->readlen = strlen( data->rbuffer );
5341         return 0;
5342 }
5343
5344 static int proc_SSID_open(struct inode *inode, struct file *file)
5345 {
5346         struct proc_data *data;
5347         struct net_device *dev = PDE_DATA(inode);
5348         struct airo_info *ai = dev->ml_priv;
5349         int i;
5350         char *ptr;
5351         SsidRid SSID_rid;
5352
5353         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5354                 return -ENOMEM;
5355         data = file->private_data;
5356         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5357                 kfree (file->private_data);
5358                 return -ENOMEM;
5359         }
5360         data->writelen = 0;
5361         data->maxwritelen = 33*3;
5362         /* allocate maxwritelen + 1; we'll want a sentinel */
5363         if ((data->wbuffer = kzalloc(33*3 + 1, GFP_KERNEL)) == NULL) {
5364                 kfree (data->rbuffer);
5365                 kfree (file->private_data);
5366                 return -ENOMEM;
5367         }
5368         data->on_close = proc_SSID_on_close;
5369
5370         readSsidRid(ai, &SSID_rid);
5371         ptr = data->rbuffer;
5372         for (i = 0; i < 3; i++) {
5373                 int j;
5374                 size_t len = le16_to_cpu(SSID_rid.ssids[i].len);
5375                 if (!len)
5376                         break;
5377                 if (len > 32)
5378                         len = 32;
5379                 for (j = 0; j < len && SSID_rid.ssids[i].ssid[j]; j++)
5380                         *ptr++ = SSID_rid.ssids[i].ssid[j];
5381                 *ptr++ = '\n';
5382         }
5383         *ptr = '\0';
5384         data->readlen = strlen( data->rbuffer );
5385         return 0;
5386 }
5387
5388 static int proc_APList_open( struct inode *inode, struct file *file ) {
5389         struct proc_data *data;
5390         struct net_device *dev = PDE_DATA(inode);
5391         struct airo_info *ai = dev->ml_priv;
5392         int i;
5393         char *ptr;
5394         APListRid APList_rid;
5395
5396         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5397                 return -ENOMEM;
5398         data = file->private_data;
5399         if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5400                 kfree (file->private_data);
5401                 return -ENOMEM;
5402         }
5403         data->writelen = 0;
5404         data->maxwritelen = 4*6*3;
5405         if ((data->wbuffer = kzalloc( data->maxwritelen, GFP_KERNEL )) == NULL) {
5406                 kfree (data->rbuffer);
5407                 kfree (file->private_data);
5408                 return -ENOMEM;
5409         }
5410         data->on_close = proc_APList_on_close;
5411
5412         readAPListRid(ai, &APList_rid);
5413         ptr = data->rbuffer;
5414         for( i = 0; i < 4; i++ ) {
5415 // We end when we find a zero MAC
5416                 if ( !*(int*)APList_rid.ap[i] &&
5417                      !*(int*)&APList_rid.ap[i][2]) break;
5418                 ptr += sprintf(ptr, "%pM\n", APList_rid.ap[i]);
5419         }
5420         if (i==0) ptr += sprintf(ptr, "Not using specific APs\n");
5421
5422         *ptr = '\0';
5423         data->readlen = strlen( data->rbuffer );
5424         return 0;
5425 }
5426
5427 static int proc_BSSList_open( struct inode *inode, struct file *file ) {
5428         struct proc_data *data;
5429         struct net_device *dev = PDE_DATA(inode);
5430         struct airo_info *ai = dev->ml_priv;
5431         char *ptr;
5432         BSSListRid BSSList_rid;
5433         int rc;
5434         /* If doLoseSync is not 1, we won't do a Lose Sync */
5435         int doLoseSync = -1;
5436
5437         if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5438                 return -ENOMEM;
5439         data = file->private_data;
5440         if ((data->rbuffer = kmalloc( 1024, GFP_KERNEL )) == NULL) {
5441                 kfree (file->private_data);
5442                 return -ENOMEM;
5443         }
5444         data->writelen = 0;
5445         data->maxwritelen = 0;
5446         data->wbuffer = NULL;
5447         data->on_close = NULL;
5448
5449         if (file->f_mode & FMODE_WRITE) {
5450                 if (!(file->f_mode & FMODE_READ)) {
5451                         Cmd cmd;
5452                         Resp rsp;
5453
5454                         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
5455                         memset(&cmd, 0, sizeof(cmd));
5456                         cmd.cmd=CMD_LISTBSS;
5457                         if (down_interruptible(&ai->sem))
5458                                 return -ERESTARTSYS;
5459                         issuecommand(ai, &cmd, &rsp);
5460                         up(&ai->sem);
5461                         data->readlen = 0;
5462                         return 0;
5463                 }
5464                 doLoseSync = 1;
5465         }
5466         ptr = data->rbuffer;
5467         /* There is a race condition here if there are concurrent opens.
5468            Since it is a rare condition, we'll just live with it, otherwise
5469            we have to add a spin lock... */
5470         rc = readBSSListRid(ai, doLoseSync, &BSSList_rid);
5471         while(rc == 0 && BSSList_rid.index != cpu_to_le16(0xffff)) {
5472                 ptr += sprintf(ptr, "%pM %*s rssi = %d",
5473                                BSSList_rid.bssid,
5474                                 (int)BSSList_rid.ssidLen,
5475                                 BSSList_rid.ssid,
5476                                 le16_to_cpu(BSSList_rid.dBm));
5477                 ptr += sprintf(ptr, " channel = %d %s %s %s %s\n",
5478                                 le16_to_cpu(BSSList_rid.dsChannel),
5479                                 BSSList_rid.cap & CAP_ESS ? "ESS" : "",
5480                                 BSSList_rid.cap & CAP_IBSS ? "adhoc" : "",
5481                                 BSSList_rid.cap & CAP_PRIVACY ? "wep" : "",
5482                                 BSSList_rid.cap & CAP_SHORTHDR ? "shorthdr" : "");
5483                 rc = readBSSListRid(ai, 0, &BSSList_rid);
5484         }
5485         *ptr = '\0';
5486         data->readlen = strlen( data->rbuffer );
5487         return 0;
5488 }
5489
5490 static int proc_close( struct inode *inode, struct file *file )
5491 {
5492         struct proc_data *data = file->private_data;
5493
5494         if (data->on_close != NULL)
5495                 data->on_close(inode, file);
5496         kfree(data->rbuffer);
5497         kfree(data->wbuffer);
5498         kfree(data);
5499         return 0;
5500 }
5501
5502 /* Since the card doesn't automatically switch to the right WEP mode,
5503    we will make it do it.  If the card isn't associated, every secs we
5504    will switch WEP modes to see if that will help.  If the card is
5505    associated we will check every minute to see if anything has
5506    changed. */
5507 static void timer_func( struct net_device *dev ) {
5508         struct airo_info *apriv = dev->ml_priv;
5509
5510 /* We don't have a link so try changing the authtype */
5511         readConfigRid(apriv, 0);
5512         disable_MAC(apriv, 0);
5513         switch(apriv->config.authType) {
5514                 case AUTH_ENCRYPT:
5515 /* So drop to OPEN */
5516                         apriv->config.authType = AUTH_OPEN;
5517                         break;
5518                 case AUTH_SHAREDKEY:
5519                         if (apriv->keyindex < auto_wep) {
5520                                 set_wep_tx_idx(apriv, apriv->keyindex, 0, 0);
5521                                 apriv->config.authType = AUTH_SHAREDKEY;
5522                                 apriv->keyindex++;
5523                         } else {
5524                                 /* Drop to ENCRYPT */
5525                                 apriv->keyindex = 0;
5526                                 set_wep_tx_idx(apriv, apriv->defindex, 0, 0);
5527                                 apriv->config.authType = AUTH_ENCRYPT;
5528                         }
5529                         break;
5530                 default:  /* We'll escalate to SHAREDKEY */
5531                         apriv->config.authType = AUTH_SHAREDKEY;
5532         }
5533         set_bit (FLAG_COMMIT, &apriv->flags);
5534         writeConfigRid(apriv, 0);
5535         enable_MAC(apriv, 0);
5536         up(&apriv->sem);
5537
5538 /* Schedule check to see if the change worked */
5539         clear_bit(JOB_AUTOWEP, &apriv->jobs);
5540         apriv->expires = RUN_AT(HZ*3);
5541 }
5542
5543 #ifdef CONFIG_PCI
5544 static int airo_pci_probe(struct pci_dev *pdev,
5545                                     const struct pci_device_id *pent)
5546 {
5547         struct net_device *dev;
5548
5549         if (pci_enable_device(pdev))
5550                 return -ENODEV;
5551         pci_set_master(pdev);
5552
5553         if (pdev->device == 0x5000 || pdev->device == 0xa504)
5554                         dev = _init_airo_card(pdev->irq, pdev->resource[0].start, 0, pdev, &pdev->dev);
5555         else
5556                         dev = _init_airo_card(pdev->irq, pdev->resource[2].start, 0, pdev, &pdev->dev);
5557         if (!dev) {
5558                 pci_disable_device(pdev);
5559                 return -ENODEV;
5560         }
5561
5562         pci_set_drvdata(pdev, dev);
5563         return 0;
5564 }
5565
5566 static void airo_pci_remove(struct pci_dev *pdev)
5567 {
5568         struct net_device *dev = pci_get_drvdata(pdev);
5569
5570         airo_print_info(dev->name, "Unregistering...");
5571         stop_airo_card(dev, 1);
5572         pci_disable_device(pdev);
5573 }
5574
5575 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state)
5576 {
5577         struct net_device *dev = pci_get_drvdata(pdev);
5578         struct airo_info *ai = dev->ml_priv;
5579         Cmd cmd;
5580         Resp rsp;
5581
5582         if (!ai->APList)
5583                 ai->APList = kmalloc(sizeof(APListRid), GFP_KERNEL);
5584         if (!ai->APList)
5585                 return -ENOMEM;
5586         if (!ai->SSID)
5587                 ai->SSID = kmalloc(sizeof(SsidRid), GFP_KERNEL);
5588         if (!ai->SSID)
5589                 return -ENOMEM;
5590         readAPListRid(ai, ai->APList);
5591         readSsidRid(ai, ai->SSID);
5592         memset(&cmd, 0, sizeof(cmd));
5593         /* the lock will be released at the end of the resume callback */
5594         if (down_interruptible(&ai->sem))
5595                 return -EAGAIN;
5596         disable_MAC(ai, 0);
5597         netif_device_detach(dev);
5598         ai->power = state;
5599         cmd.cmd = HOSTSLEEP;
5600         issuecommand(ai, &cmd, &rsp);
5601
5602         pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
5603         pci_save_state(pdev);
5604         pci_set_power_state(pdev, pci_choose_state(pdev, state));
5605         return 0;
5606 }
5607
5608 static int airo_pci_resume(struct pci_dev *pdev)
5609 {
5610         struct net_device *dev = pci_get_drvdata(pdev);
5611         struct airo_info *ai = dev->ml_priv;
5612         pci_power_t prev_state = pdev->current_state;
5613
5614         pci_set_power_state(pdev, PCI_D0);
5615         pci_restore_state(pdev);
5616         pci_enable_wake(pdev, PCI_D0, 0);
5617
5618         if (prev_state != PCI_D1) {
5619                 reset_card(dev, 0);
5620                 mpi_init_descriptors(ai);
5621                 setup_card(ai, dev->dev_addr, 0);
5622                 clear_bit(FLAG_RADIO_OFF, &ai->flags);
5623                 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
5624         } else {
5625                 OUT4500(ai, EVACK, EV_AWAKEN);
5626                 OUT4500(ai, EVACK, EV_AWAKEN);
5627                 msleep(100);
5628         }
5629
5630         set_bit(FLAG_COMMIT, &ai->flags);
5631         disable_MAC(ai, 0);
5632         msleep(200);
5633         if (ai->SSID) {
5634                 writeSsidRid(ai, ai->SSID, 0);
5635                 kfree(ai->SSID);
5636                 ai->SSID = NULL;
5637         }
5638         if (ai->APList) {
5639                 writeAPListRid(ai, ai->APList, 0);
5640                 kfree(ai->APList);
5641                 ai->APList = NULL;
5642         }
5643         writeConfigRid(ai, 0);
5644         enable_MAC(ai, 0);
5645         ai->power = PMSG_ON;
5646         netif_device_attach(dev);
5647         netif_wake_queue(dev);
5648         enable_interrupts(ai);
5649         up(&ai->sem);
5650         return 0;
5651 }
5652 #endif
5653
5654 static int __init airo_init_module( void )
5655 {
5656         int i;
5657
5658         proc_kuid = make_kuid(&init_user_ns, proc_uid);
5659         proc_kgid = make_kgid(&init_user_ns, proc_gid);
5660         if (!uid_valid(proc_kuid) || !gid_valid(proc_kgid))
5661                 return -EINVAL;
5662
5663         airo_entry = proc_mkdir_mode("driver/aironet", airo_perm, NULL);
5664
5665         if (airo_entry)
5666                 proc_set_user(airo_entry, proc_kuid, proc_kgid);
5667
5668         for (i = 0; i < 4 && io[i] && irq[i]; i++) {
5669                 airo_print_info("", "Trying to configure ISA adapter at irq=%d "
5670                         "io=0x%x", irq[i], io[i] );
5671                 if (init_airo_card( irq[i], io[i], 0, NULL ))
5672                         /* do nothing */ ;
5673         }
5674
5675 #ifdef CONFIG_PCI
5676         airo_print_info("", "Probing for PCI adapters");
5677         i = pci_register_driver(&airo_driver);
5678         airo_print_info("", "Finished probing for PCI adapters");
5679
5680         if (i) {
5681                 remove_proc_entry("driver/aironet", NULL);
5682                 return i;
5683         }
5684 #endif
5685
5686         /* Always exit with success, as we are a library module
5687          * as well as a driver module
5688          */
5689         return 0;
5690 }
5691
5692 static void __exit airo_cleanup_module( void )
5693 {
5694         struct airo_info *ai;
5695         while(!list_empty(&airo_devices)) {
5696                 ai = list_entry(airo_devices.next, struct airo_info, dev_list);
5697                 airo_print_info(ai->dev->name, "Unregistering...");
5698                 stop_airo_card(ai->dev, 1);
5699         }
5700 #ifdef CONFIG_PCI
5701         pci_unregister_driver(&airo_driver);
5702 #endif
5703         remove_proc_entry("driver/aironet", NULL);
5704 }
5705
5706 /*
5707  * Initial Wireless Extension code for Aironet driver by :
5708  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00
5709  * Conversion to new driver API by :
5710  *      Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02
5711  * Javier also did a good amount of work here, adding some new extensions
5712  * and fixing my code. Let's just say that without him this code just
5713  * would not work at all... - Jean II
5714  */
5715
5716 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi)
5717 {
5718         if (!rssi_rid)
5719                 return 0;
5720
5721         return (0x100 - rssi_rid[rssi].rssidBm);
5722 }
5723
5724 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm)
5725 {
5726         int i;
5727
5728         if (!rssi_rid)
5729                 return 0;
5730
5731         for (i = 0; i < 256; i++)
5732                 if (rssi_rid[i].rssidBm == dbm)
5733                         return rssi_rid[i].rssipct;
5734
5735         return 0;
5736 }
5737
5738
5739 static int airo_get_quality (StatusRid *status_rid, CapabilityRid *cap_rid)
5740 {
5741         int quality = 0;
5742         u16 sq;
5743
5744         if ((status_rid->mode & cpu_to_le16(0x3f)) != cpu_to_le16(0x3f))
5745                 return 0;
5746
5747         if (!(cap_rid->hardCap & cpu_to_le16(8)))
5748                 return 0;
5749
5750         sq = le16_to_cpu(status_rid->signalQuality);
5751         if (memcmp(cap_rid->prodName, "350", 3))
5752                 if (sq > 0x20)
5753                         quality = 0;
5754                 else
5755                         quality = 0x20 - sq;
5756         else
5757                 if (sq > 0xb0)
5758                         quality = 0;
5759                 else if (sq < 0x10)
5760                         quality = 0xa0;
5761                 else
5762                         quality = 0xb0 - sq;
5763         return quality;
5764 }
5765
5766 #define airo_get_max_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x20 : 0xa0)
5767 #define airo_get_avg_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x10 : 0x50);
5768
5769 /*------------------------------------------------------------------*/
5770 /*
5771  * Wireless Handler : get protocol name
5772  */
5773 static int airo_get_name(struct net_device *dev,
5774                          struct iw_request_info *info,
5775                          char *cwrq,
5776                          char *extra)
5777 {
5778         strcpy(cwrq, "IEEE 802.11-DS");
5779         return 0;
5780 }
5781
5782 /*------------------------------------------------------------------*/
5783 /*
5784  * Wireless Handler : set frequency
5785  */
5786 static int airo_set_freq(struct net_device *dev,
5787                          struct iw_request_info *info,
5788                          struct iw_freq *fwrq,
5789                          char *extra)
5790 {
5791         struct airo_info *local = dev->ml_priv;
5792         int rc = -EINPROGRESS;          /* Call commit handler */
5793
5794         /* If setting by frequency, convert to a channel */
5795         if(fwrq->e == 1) {
5796                 int f = fwrq->m / 100000;
5797
5798                 /* Hack to fall through... */
5799                 fwrq->e = 0;
5800                 fwrq->m = ieee80211_frequency_to_channel(f);
5801         }
5802         /* Setting by channel number */
5803         if((fwrq->m > 1000) || (fwrq->e > 0))
5804                 rc = -EOPNOTSUPP;
5805         else {
5806                 int channel = fwrq->m;
5807                 /* We should do a better check than that,
5808                  * based on the card capability !!! */
5809                 if((channel < 1) || (channel > 14)) {
5810                         airo_print_dbg(dev->name, "New channel value of %d is invalid!",
5811                                 fwrq->m);
5812                         rc = -EINVAL;
5813                 } else {
5814                         readConfigRid(local, 1);
5815                         /* Yes ! We can set it !!! */
5816                         local->config.channelSet = cpu_to_le16(channel);
5817                         set_bit (FLAG_COMMIT, &local->flags);
5818                 }
5819         }
5820         return rc;
5821 }
5822
5823 /*------------------------------------------------------------------*/
5824 /*
5825  * Wireless Handler : get frequency
5826  */
5827 static int airo_get_freq(struct net_device *dev,
5828                          struct iw_request_info *info,
5829                          struct iw_freq *fwrq,
5830                          char *extra)
5831 {
5832         struct airo_info *local = dev->ml_priv;
5833         StatusRid status_rid;           /* Card status info */
5834         int ch;
5835
5836         readConfigRid(local, 1);
5837         if ((local->config.opmode & MODE_CFG_MASK) == MODE_STA_ESS)
5838                 status_rid.channel = local->config.channelSet;
5839         else
5840                 readStatusRid(local, &status_rid, 1);
5841
5842         ch = le16_to_cpu(status_rid.channel);
5843         if((ch > 0) && (ch < 15)) {
5844                 fwrq->m = 100000 *
5845                         ieee80211_channel_to_frequency(ch, IEEE80211_BAND_2GHZ);
5846                 fwrq->e = 1;
5847         } else {
5848                 fwrq->m = ch;
5849                 fwrq->e = 0;
5850         }
5851
5852         return 0;
5853 }
5854
5855 /*------------------------------------------------------------------*/
5856 /*
5857  * Wireless Handler : set ESSID
5858  */
5859 static int airo_set_essid(struct net_device *dev,
5860                           struct iw_request_info *info,
5861                           struct iw_point *dwrq,
5862                           char *extra)
5863 {
5864         struct airo_info *local = dev->ml_priv;
5865         SsidRid SSID_rid;               /* SSIDs */
5866
5867         /* Reload the list of current SSID */
5868         readSsidRid(local, &SSID_rid);
5869
5870         /* Check if we asked for `any' */
5871         if (dwrq->flags == 0) {
5872                 /* Just send an empty SSID list */
5873                 memset(&SSID_rid, 0, sizeof(SSID_rid));
5874         } else {
5875                 unsigned index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
5876
5877                 /* Check the size of the string */
5878                 if (dwrq->length > IW_ESSID_MAX_SIZE)
5879                         return -E2BIG ;
5880
5881                 /* Check if index is valid */
5882                 if (index >= ARRAY_SIZE(SSID_rid.ssids))
5883                         return -EINVAL;
5884
5885                 /* Set the SSID */
5886                 memset(SSID_rid.ssids[index].ssid, 0,
5887                        sizeof(SSID_rid.ssids[index].ssid));
5888                 memcpy(SSID_rid.ssids[index].ssid, extra, dwrq->length);
5889                 SSID_rid.ssids[index].len = cpu_to_le16(dwrq->length);
5890         }
5891         SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5892         /* Write it to the card */
5893         disable_MAC(local, 1);
5894         writeSsidRid(local, &SSID_rid, 1);
5895         enable_MAC(local, 1);
5896
5897         return 0;
5898 }
5899
5900 /*------------------------------------------------------------------*/
5901 /*
5902  * Wireless Handler : get ESSID
5903  */
5904 static int airo_get_essid(struct net_device *dev,
5905                           struct iw_request_info *info,
5906                           struct iw_point *dwrq,
5907                           char *extra)
5908 {
5909         struct airo_info *local = dev->ml_priv;
5910         StatusRid status_rid;           /* Card status info */
5911
5912         readStatusRid(local, &status_rid, 1);
5913
5914         /* Note : if dwrq->flags != 0, we should
5915          * get the relevant SSID from the SSID list... */
5916
5917         /* Get the current SSID */
5918         memcpy(extra, status_rid.SSID, le16_to_cpu(status_rid.SSIDlen));
5919         /* If none, we may want to get the one that was set */
5920
5921         /* Push it out ! */
5922         dwrq->length = le16_to_cpu(status_rid.SSIDlen);
5923         dwrq->flags = 1; /* active */
5924
5925         return 0;
5926 }
5927
5928 /*------------------------------------------------------------------*/
5929 /*
5930  * Wireless Handler : set AP address
5931  */
5932 static int airo_set_wap(struct net_device *dev,
5933                         struct iw_request_info *info,
5934                         struct sockaddr *awrq,
5935                         char *extra)
5936 {
5937         struct airo_info *local = dev->ml_priv;
5938         Cmd cmd;
5939         Resp rsp;
5940         APListRid APList_rid;
5941
5942         if (awrq->sa_family != ARPHRD_ETHER)
5943                 return -EINVAL;
5944         else if (is_broadcast_ether_addr(awrq->sa_data) ||
5945                  is_zero_ether_addr(awrq->sa_data)) {
5946                 memset(&cmd, 0, sizeof(cmd));
5947                 cmd.cmd=CMD_LOSE_SYNC;
5948                 if (down_interruptible(&local->sem))
5949                         return -ERESTARTSYS;
5950                 issuecommand(local, &cmd, &rsp);
5951                 up(&local->sem);
5952         } else {
5953                 memset(&APList_rid, 0, sizeof(APList_rid));
5954                 APList_rid.len = cpu_to_le16(sizeof(APList_rid));
5955                 memcpy(APList_rid.ap[0], awrq->sa_data, ETH_ALEN);
5956                 disable_MAC(local, 1);
5957                 writeAPListRid(local, &APList_rid, 1);
5958                 enable_MAC(local, 1);
5959         }
5960         return 0;
5961 }
5962
5963 /*------------------------------------------------------------------*/
5964 /*
5965  * Wireless Handler : get AP address
5966  */
5967 static int airo_get_wap(struct net_device *dev,
5968                         struct iw_request_info *info,
5969                         struct sockaddr *awrq,
5970                         char *extra)
5971 {
5972         struct airo_info *local = dev->ml_priv;
5973         StatusRid status_rid;           /* Card status info */
5974
5975         readStatusRid(local, &status_rid, 1);
5976
5977         /* Tentative. This seems to work, wow, I'm lucky !!! */
5978         memcpy(awrq->sa_data, status_rid.bssid[0], ETH_ALEN);
5979         awrq->sa_family = ARPHRD_ETHER;
5980
5981         return 0;
5982 }
5983
5984 /*------------------------------------------------------------------*/
5985 /*
5986  * Wireless Handler : set Nickname
5987  */
5988 static int airo_set_nick(struct net_device *dev,
5989                          struct iw_request_info *info,
5990                          struct iw_point *dwrq,
5991                          char *extra)
5992 {
5993         struct airo_info *local = dev->ml_priv;
5994
5995         /* Check the size of the string */
5996         if(dwrq->length > 16) {
5997                 return -E2BIG;
5998         }
5999         readConfigRid(local, 1);
6000         memset(local->config.nodeName, 0, sizeof(local->config.nodeName));
6001         memcpy(local->config.nodeName, extra, dwrq->length);
6002         set_bit (FLAG_COMMIT, &local->flags);
6003
6004         return -EINPROGRESS;            /* Call commit handler */
6005 }
6006
6007 /*------------------------------------------------------------------*/
6008 /*
6009  * Wireless Handler : get Nickname
6010  */
6011 static int airo_get_nick(struct net_device *dev,
6012                          struct iw_request_info *info,
6013                          struct iw_point *dwrq,
6014                          char *extra)
6015 {
6016         struct airo_info *local = dev->ml_priv;
6017
6018         readConfigRid(local, 1);
6019         strncpy(extra, local->config.nodeName, 16);
6020         extra[16] = '\0';
6021         dwrq->length = strlen(extra);
6022
6023         return 0;
6024 }
6025
6026 /*------------------------------------------------------------------*/
6027 /*
6028  * Wireless Handler : set Bit-Rate
6029  */
6030 static int airo_set_rate(struct net_device *dev,
6031                          struct iw_request_info *info,
6032                          struct iw_param *vwrq,
6033                          char *extra)
6034 {
6035         struct airo_info *local = dev->ml_priv;
6036         CapabilityRid cap_rid;          /* Card capability info */
6037         u8      brate = 0;
6038         int     i;
6039
6040         /* First : get a valid bit rate value */
6041         readCapabilityRid(local, &cap_rid, 1);
6042
6043         /* Which type of value ? */
6044         if((vwrq->value < 8) && (vwrq->value >= 0)) {
6045                 /* Setting by rate index */
6046                 /* Find value in the magic rate table */
6047                 brate = cap_rid.supportedRates[vwrq->value];
6048         } else {
6049                 /* Setting by frequency value */
6050                 u8      normvalue = (u8) (vwrq->value/500000);
6051
6052                 /* Check if rate is valid */
6053                 for(i = 0 ; i < 8 ; i++) {
6054                         if(normvalue == cap_rid.supportedRates[i]) {
6055                                 brate = normvalue;
6056                                 break;
6057                         }
6058                 }
6059         }
6060         /* -1 designed the max rate (mostly auto mode) */
6061         if(vwrq->value == -1) {
6062                 /* Get the highest available rate */
6063                 for(i = 0 ; i < 8 ; i++) {
6064                         if(cap_rid.supportedRates[i] == 0)
6065                                 break;
6066                 }
6067                 if(i != 0)
6068                         brate = cap_rid.supportedRates[i - 1];
6069         }
6070         /* Check that it is valid */
6071         if(brate == 0) {
6072                 return -EINVAL;
6073         }
6074
6075         readConfigRid(local, 1);
6076         /* Now, check if we want a fixed or auto value */
6077         if(vwrq->fixed == 0) {
6078                 /* Fill all the rates up to this max rate */
6079                 memset(local->config.rates, 0, 8);
6080                 for(i = 0 ; i < 8 ; i++) {
6081                         local->config.rates[i] = cap_rid.supportedRates[i];
6082                         if(local->config.rates[i] == brate)
6083                                 break;
6084                 }
6085         } else {
6086                 /* Fixed mode */
6087                 /* One rate, fixed */
6088                 memset(local->config.rates, 0, 8);
6089                 local->config.rates[0] = brate;
6090         }
6091         set_bit (FLAG_COMMIT, &local->flags);
6092
6093         return -EINPROGRESS;            /* Call commit handler */
6094 }
6095
6096 /*------------------------------------------------------------------*/
6097 /*
6098  * Wireless Handler : get Bit-Rate
6099  */
6100 static int airo_get_rate(struct net_device *dev,
6101                          struct iw_request_info *info,
6102                          struct iw_param *vwrq,
6103                          char *extra)
6104 {
6105         struct airo_info *local = dev->ml_priv;
6106         StatusRid status_rid;           /* Card status info */
6107
6108         readStatusRid(local, &status_rid, 1);
6109
6110         vwrq->value = le16_to_cpu(status_rid.currentXmitRate) * 500000;
6111         /* If more than one rate, set auto */
6112         readConfigRid(local, 1);
6113         vwrq->fixed = (local->config.rates[1] == 0);
6114
6115         return 0;
6116 }
6117
6118 /*------------------------------------------------------------------*/
6119 /*
6120  * Wireless Handler : set RTS threshold
6121  */
6122 static int airo_set_rts(struct net_device *dev,
6123                         struct iw_request_info *info,
6124                         struct iw_param *vwrq,
6125                         char *extra)
6126 {
6127         struct airo_info *local = dev->ml_priv;
6128         int rthr = vwrq->value;
6129
6130         if(vwrq->disabled)
6131                 rthr = AIRO_DEF_MTU;
6132         if((rthr < 0) || (rthr > AIRO_DEF_MTU)) {
6133                 return -EINVAL;
6134         }
6135         readConfigRid(local, 1);
6136         local->config.rtsThres = cpu_to_le16(rthr);
6137         set_bit (FLAG_COMMIT, &local->flags);
6138
6139         return -EINPROGRESS;            /* Call commit handler */
6140 }
6141
6142 /*------------------------------------------------------------------*/
6143 /*
6144  * Wireless Handler : get RTS threshold
6145  */
6146 static int airo_get_rts(struct net_device *dev,
6147                         struct iw_request_info *info,
6148                         struct iw_param *vwrq,
6149                         char *extra)
6150 {
6151         struct airo_info *local = dev->ml_priv;
6152
6153         readConfigRid(local, 1);
6154         vwrq->value = le16_to_cpu(local->config.rtsThres);
6155         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6156         vwrq->fixed = 1;
6157
6158         return 0;
6159 }
6160
6161 /*------------------------------------------------------------------*/
6162 /*
6163  * Wireless Handler : set Fragmentation threshold
6164  */
6165 static int airo_set_frag(struct net_device *dev,
6166                          struct iw_request_info *info,
6167                          struct iw_param *vwrq,
6168                          char *extra)
6169 {
6170         struct airo_info *local = dev->ml_priv;
6171         int fthr = vwrq->value;
6172
6173         if(vwrq->disabled)
6174                 fthr = AIRO_DEF_MTU;
6175         if((fthr < 256) || (fthr > AIRO_DEF_MTU)) {
6176                 return -EINVAL;
6177         }
6178         fthr &= ~0x1;   /* Get an even value - is it really needed ??? */
6179         readConfigRid(local, 1);
6180         local->config.fragThresh = cpu_to_le16(fthr);
6181         set_bit (FLAG_COMMIT, &local->flags);
6182
6183         return -EINPROGRESS;            /* Call commit handler */
6184 }
6185
6186 /*------------------------------------------------------------------*/
6187 /*
6188  * Wireless Handler : get Fragmentation threshold
6189  */
6190 static int airo_get_frag(struct net_device *dev,
6191                          struct iw_request_info *info,
6192                          struct iw_param *vwrq,
6193                          char *extra)
6194 {
6195         struct airo_info *local = dev->ml_priv;
6196
6197         readConfigRid(local, 1);
6198         vwrq->value = le16_to_cpu(local->config.fragThresh);
6199         vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6200         vwrq->fixed = 1;
6201
6202         return 0;
6203 }
6204
6205 /*------------------------------------------------------------------*/
6206 /*
6207  * Wireless Handler : set Mode of Operation
6208  */
6209 static int airo_set_mode(struct net_device *dev,
6210                          struct iw_request_info *info,
6211                          __u32 *uwrq,
6212                          char *extra)
6213 {
6214         struct airo_info *local = dev->ml_priv;
6215         int reset = 0;
6216
6217         readConfigRid(local, 1);
6218         if (sniffing_mode(local))
6219                 reset = 1;
6220
6221         switch(*uwrq) {
6222                 case IW_MODE_ADHOC:
6223                         local->config.opmode &= ~MODE_CFG_MASK;
6224                         local->config.opmode |= MODE_STA_IBSS;
6225                         local->config.rmode &= ~RXMODE_FULL_MASK;
6226                         local->config.scanMode = SCANMODE_ACTIVE;
6227                         clear_bit (FLAG_802_11, &local->flags);
6228                         break;
6229                 case IW_MODE_INFRA:
6230                         local->config.opmode &= ~MODE_CFG_MASK;
6231                         local->config.opmode |= MODE_STA_ESS;
6232                         local->config.rmode &= ~RXMODE_FULL_MASK;
6233                         local->config.scanMode = SCANMODE_ACTIVE;
6234                         clear_bit (FLAG_802_11, &local->flags);
6235                         break;
6236                 case IW_MODE_MASTER:
6237                         local->config.opmode &= ~MODE_CFG_MASK;
6238                         local->config.opmode |= MODE_AP;
6239                         local->config.rmode &= ~RXMODE_FULL_MASK;
6240                         local->config.scanMode = SCANMODE_ACTIVE;
6241                         clear_bit (FLAG_802_11, &local->flags);
6242                         break;
6243                 case IW_MODE_REPEAT:
6244                         local->config.opmode &= ~MODE_CFG_MASK;
6245                         local->config.opmode |= MODE_AP_RPTR;
6246                         local->config.rmode &= ~RXMODE_FULL_MASK;
6247                         local->config.scanMode = SCANMODE_ACTIVE;
6248                         clear_bit (FLAG_802_11, &local->flags);
6249                         break;
6250                 case IW_MODE_MONITOR:
6251                         local->config.opmode &= ~MODE_CFG_MASK;
6252                         local->config.opmode |= MODE_STA_ESS;
6253                         local->config.rmode &= ~RXMODE_FULL_MASK;
6254                         local->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
6255                         local->config.scanMode = SCANMODE_PASSIVE;
6256                         set_bit (FLAG_802_11, &local->flags);
6257                         break;
6258                 default:
6259                         return -EINVAL;
6260         }
6261         if (reset)
6262                 set_bit (FLAG_RESET, &local->flags);
6263         set_bit (FLAG_COMMIT, &local->flags);
6264
6265         return -EINPROGRESS;            /* Call commit handler */
6266 }
6267
6268 /*------------------------------------------------------------------*/
6269 /*
6270  * Wireless Handler : get Mode of Operation
6271  */
6272 static int airo_get_mode(struct net_device *dev,
6273                          struct iw_request_info *info,
6274                          __u32 *uwrq,
6275                          char *extra)
6276 {
6277         struct airo_info *local = dev->ml_priv;
6278
6279         readConfigRid(local, 1);
6280         /* If not managed, assume it's ad-hoc */
6281         switch (local->config.opmode & MODE_CFG_MASK) {
6282                 case MODE_STA_ESS:
6283                         *uwrq = IW_MODE_INFRA;
6284                         break;
6285                 case MODE_AP:
6286                         *uwrq = IW_MODE_MASTER;
6287                         break;
6288                 case MODE_AP_RPTR:
6289                         *uwrq = IW_MODE_REPEAT;
6290                         break;
6291                 default:
6292                         *uwrq = IW_MODE_ADHOC;
6293         }
6294
6295         return 0;
6296 }
6297
6298 static inline int valid_index(struct airo_info *ai, int index)
6299 {
6300         return (index >= 0) && (index <= ai->max_wep_idx);
6301 }
6302
6303 /*------------------------------------------------------------------*/
6304 /*
6305  * Wireless Handler : set Encryption Key
6306  */
6307 static int airo_set_encode(struct net_device *dev,
6308                            struct iw_request_info *info,
6309                            struct iw_point *dwrq,
6310                            char *extra)
6311 {
6312         struct airo_info *local = dev->ml_priv;
6313         int perm = (dwrq->flags & IW_ENCODE_TEMP ? 0 : 1);
6314         __le16 currentAuthType = local->config.authType;
6315         int rc = 0;
6316
6317         if (!local->wep_capable)
6318                 return -EOPNOTSUPP;
6319
6320         readConfigRid(local, 1);
6321
6322         /* Basic checking: do we have a key to set ?
6323          * Note : with the new API, it's impossible to get a NULL pointer.
6324          * Therefore, we need to check a key size == 0 instead.
6325          * New version of iwconfig properly set the IW_ENCODE_NOKEY flag
6326          * when no key is present (only change flags), but older versions
6327          * don't do it. - Jean II */
6328         if (dwrq->length > 0) {
6329                 wep_key_t key;
6330                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6331                 int current_index;
6332
6333                 /* Check the size of the key */
6334                 if (dwrq->length > MAX_KEY_SIZE) {
6335                         return -EINVAL;
6336                 }
6337
6338                 current_index = get_wep_tx_idx(local);
6339                 if (current_index < 0)
6340                         current_index = 0;
6341
6342                 /* Check the index (none -> use current) */
6343                 if (!valid_index(local, index))
6344                         index = current_index;
6345
6346                 /* Set the length */
6347                 if (dwrq->length > MIN_KEY_SIZE)
6348                         key.len = MAX_KEY_SIZE;
6349                 else
6350                         key.len = MIN_KEY_SIZE;
6351                 /* Check if the key is not marked as invalid */
6352                 if(!(dwrq->flags & IW_ENCODE_NOKEY)) {
6353                         /* Cleanup */
6354                         memset(key.key, 0, MAX_KEY_SIZE);
6355                         /* Copy the key in the driver */
6356                         memcpy(key.key, extra, dwrq->length);
6357                         /* Send the key to the card */
6358                         rc = set_wep_key(local, index, key.key, key.len, perm, 1);
6359                         if (rc < 0) {
6360                                 airo_print_err(local->dev->name, "failed to set"
6361                                                " WEP key at index %d: %d.",
6362                                                index, rc);
6363                                 return rc;
6364                         }
6365                 }
6366                 /* WE specify that if a valid key is set, encryption
6367                  * should be enabled (user may turn it off later)
6368                  * This is also how "iwconfig ethX key on" works */
6369                 if((index == current_index) && (key.len > 0) &&
6370                    (local->config.authType == AUTH_OPEN)) {
6371                         local->config.authType = AUTH_ENCRYPT;
6372                 }
6373         } else {
6374                 /* Do we want to just set the transmit key index ? */
6375                 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6376                 if (valid_index(local, index)) {
6377                         rc = set_wep_tx_idx(local, index, perm, 1);
6378                         if (rc < 0) {
6379                                 airo_print_err(local->dev->name, "failed to set"
6380                                                " WEP transmit index to %d: %d.",
6381                                                index, rc);
6382                                 return rc;
6383                         }
6384                 } else {
6385                         /* Don't complain if only change the mode */
6386                         if (!(dwrq->flags & IW_ENCODE_MODE))
6387                                 return -EINVAL;
6388                 }
6389         }
6390         /* Read the flags */
6391         if(dwrq->flags & IW_ENCODE_DISABLED)
6392                 local->config.authType = AUTH_OPEN;     // disable encryption
6393         if(dwrq->flags & IW_ENCODE_RESTRICTED)
6394                 local->config.authType = AUTH_SHAREDKEY;        // Only Both
6395         if(dwrq->flags & IW_ENCODE_OPEN)
6396                 local->config.authType = AUTH_ENCRYPT;  // Only Wep
6397         /* Commit the changes to flags if needed */
6398         if (local->config.authType != currentAuthType)
6399                 set_bit (FLAG_COMMIT, &local->flags);
6400         return -EINPROGRESS;            /* Call commit handler */
6401 }
6402
6403 /*------------------------------------------------------------------*/
6404 /*
6405  * Wireless Handler : get Encryption Key
6406  */
6407 static int airo_get_encode(struct net_device *dev,
6408                            struct iw_request_info *info,
6409                            struct iw_point *dwrq,
6410                            char *extra)
6411 {
6412         struct airo_info *local = dev->ml_priv;
6413         int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6414         int wep_key_len;
6415         u8 buf[16];
6416
6417         if (!local->wep_capable)
6418                 return -EOPNOTSUPP;
6419
6420         readConfigRid(local, 1);
6421
6422         /* Check encryption mode */
6423         switch(local->config.authType)  {
6424                 case AUTH_ENCRYPT:
6425                         dwrq->flags = IW_ENCODE_OPEN;
6426                         break;
6427                 case AUTH_SHAREDKEY:
6428                         dwrq->flags = IW_ENCODE_RESTRICTED;
6429                         break;
6430                 default:
6431                 case AUTH_OPEN:
6432                         dwrq->flags = IW_ENCODE_DISABLED;
6433                         break;
6434         }
6435         /* We can't return the key, so set the proper flag and return zero */
6436         dwrq->flags |= IW_ENCODE_NOKEY;
6437         memset(extra, 0, 16);
6438
6439         /* Which key do we want ? -1 -> tx index */
6440         if (!valid_index(local, index)) {
6441                 index = get_wep_tx_idx(local);
6442                 if (index < 0)
6443                         index = 0;
6444         }
6445         dwrq->flags |= index + 1;
6446
6447         /* Copy the key to the user buffer */
6448         wep_key_len = get_wep_key(local, index, &buf[0], sizeof(buf));
6449         if (wep_key_len < 0) {
6450                 dwrq->length = 0;
6451         } else {
6452                 dwrq->length = wep_key_len;
6453                 memcpy(extra, buf, dwrq->length);
6454         }
6455
6456         return 0;
6457 }
6458
6459 /*------------------------------------------------------------------*/
6460 /*
6461  * Wireless Handler : set extended Encryption parameters
6462  */
6463 static int airo_set_encodeext(struct net_device *dev,
6464                            struct iw_request_info *info,
6465                             union iwreq_data *wrqu,
6466                             char *extra)
6467 {
6468         struct airo_info *local = dev->ml_priv;
6469         struct iw_point *encoding = &wrqu->encoding;
6470         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6471         int perm = ( encoding->flags & IW_ENCODE_TEMP ? 0 : 1 );
6472         __le16 currentAuthType = local->config.authType;
6473         int idx, key_len, alg = ext->alg, set_key = 1, rc;
6474         wep_key_t key;
6475
6476         if (!local->wep_capable)
6477                 return -EOPNOTSUPP;
6478
6479         readConfigRid(local, 1);
6480
6481         /* Determine and validate the key index */
6482         idx = encoding->flags & IW_ENCODE_INDEX;
6483         if (idx) {
6484                 if (!valid_index(local, idx - 1))
6485                         return -EINVAL;
6486                 idx--;
6487         } else {
6488                 idx = get_wep_tx_idx(local);
6489                 if (idx < 0)
6490                         idx = 0;
6491         }
6492
6493         if (encoding->flags & IW_ENCODE_DISABLED)
6494                 alg = IW_ENCODE_ALG_NONE;
6495
6496         if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
6497                 /* Only set transmit key index here, actual
6498                  * key is set below if needed.
6499                  */
6500                 rc = set_wep_tx_idx(local, idx, perm, 1);
6501                 if (rc < 0) {
6502                         airo_print_err(local->dev->name, "failed to set "
6503                                        "WEP transmit index to %d: %d.",
6504                                        idx, rc);
6505                         return rc;
6506                 }
6507                 set_key = ext->key_len > 0 ? 1 : 0;
6508         }
6509
6510         if (set_key) {
6511                 /* Set the requested key first */
6512                 memset(key.key, 0, MAX_KEY_SIZE);
6513                 switch (alg) {
6514                 case IW_ENCODE_ALG_NONE:
6515                         key.len = 0;
6516                         break;
6517                 case IW_ENCODE_ALG_WEP:
6518                         if (ext->key_len > MIN_KEY_SIZE) {
6519                                 key.len = MAX_KEY_SIZE;
6520                         } else if (ext->key_len > 0) {
6521                                 key.len = MIN_KEY_SIZE;
6522                         } else {
6523                                 return -EINVAL;
6524                         }
6525                         key_len = min (ext->key_len, key.len);
6526                         memcpy(key.key, ext->key, key_len);
6527                         break;
6528                 default:
6529                         return -EINVAL;
6530                 }
6531                 if (key.len == 0) {
6532                         rc = set_wep_tx_idx(local, idx, perm, 1);
6533                         if (rc < 0) {
6534                                 airo_print_err(local->dev->name,
6535                                                "failed to set WEP transmit index to %d: %d.",
6536                                                idx, rc);
6537                                 return rc;
6538                         }
6539                 } else {
6540                         rc = set_wep_key(local, idx, key.key, key.len, perm, 1);
6541                         if (rc < 0) {
6542                                 airo_print_err(local->dev->name,
6543                                                "failed to set WEP key at index %d: %d.",
6544                                                idx, rc);
6545                                 return rc;
6546                         }
6547                 }
6548         }
6549
6550         /* Read the flags */
6551         if(encoding->flags & IW_ENCODE_DISABLED)
6552                 local->config.authType = AUTH_OPEN;     // disable encryption
6553         if(encoding->flags & IW_ENCODE_RESTRICTED)
6554                 local->config.authType = AUTH_SHAREDKEY;        // Only Both
6555         if(encoding->flags & IW_ENCODE_OPEN)
6556                 local->config.authType = AUTH_ENCRYPT;  // Only Wep
6557         /* Commit the changes to flags if needed */
6558         if (local->config.authType != currentAuthType)
6559                 set_bit (FLAG_COMMIT, &local->flags);
6560
6561         return -EINPROGRESS;
6562 }
6563
6564
6565 /*------------------------------------------------------------------*/
6566 /*
6567  * Wireless Handler : get extended Encryption parameters
6568  */
6569 static int airo_get_encodeext(struct net_device *dev,
6570                             struct iw_request_info *info,
6571                             union iwreq_data *wrqu,
6572                             char *extra)
6573 {
6574         struct airo_info *local = dev->ml_priv;
6575         struct iw_point *encoding = &wrqu->encoding;
6576         struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6577         int idx, max_key_len, wep_key_len;
6578         u8 buf[16];
6579
6580         if (!local->wep_capable)
6581                 return -EOPNOTSUPP;
6582
6583         readConfigRid(local, 1);
6584
6585         max_key_len = encoding->length - sizeof(*ext);
6586         if (max_key_len < 0)
6587                 return -EINVAL;
6588
6589         idx = encoding->flags & IW_ENCODE_INDEX;
6590         if (idx) {
6591                 if (!valid_index(local, idx - 1))
6592                         return -EINVAL;
6593                 idx--;
6594         } else {
6595                 idx = get_wep_tx_idx(local);
6596                 if (idx < 0)
6597                         idx = 0;
6598         }
6599
6600         encoding->flags = idx + 1;
6601         memset(ext, 0, sizeof(*ext));
6602
6603         /* Check encryption mode */
6604         switch(local->config.authType) {
6605                 case AUTH_ENCRYPT:
6606                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6607                         break;
6608                 case AUTH_SHAREDKEY:
6609                         encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6610                         break;
6611                 default:
6612                 case AUTH_OPEN:
6613                         encoding->flags = IW_ENCODE_ALG_NONE | IW_ENCODE_DISABLED;
6614                         break;
6615         }
6616         /* We can't return the key, so set the proper flag and return zero */
6617         encoding->flags |= IW_ENCODE_NOKEY;
6618         memset(extra, 0, 16);
6619         
6620         /* Copy the key to the user buffer */
6621         wep_key_len = get_wep_key(local, idx, &buf[0], sizeof(buf));
6622         if (wep_key_len < 0) {
6623                 ext->key_len = 0;
6624         } else {
6625                 ext->key_len = wep_key_len;
6626                 memcpy(extra, buf, ext->key_len);
6627         }
6628
6629         return 0;
6630 }
6631
6632
6633 /*------------------------------------------------------------------*/
6634 /*
6635  * Wireless Handler : set extended authentication parameters
6636  */
6637 static int airo_set_auth(struct net_device *dev,
6638                                struct iw_request_info *info,
6639                                union iwreq_data *wrqu, char *extra)
6640 {
6641         struct airo_info *local = dev->ml_priv;
6642         struct iw_param *param = &wrqu->param;
6643         __le16 currentAuthType = local->config.authType;
6644
6645         switch (param->flags & IW_AUTH_INDEX) {
6646         case IW_AUTH_WPA_VERSION:
6647         case IW_AUTH_CIPHER_PAIRWISE:
6648         case IW_AUTH_CIPHER_GROUP:
6649         case IW_AUTH_KEY_MGMT:
6650         case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6651         case IW_AUTH_PRIVACY_INVOKED:
6652                 /*
6653                  * airo does not use these parameters
6654                  */
6655                 break;
6656
6657         case IW_AUTH_DROP_UNENCRYPTED:
6658                 if (param->value) {
6659                         /* Only change auth type if unencrypted */
6660                         if (currentAuthType == AUTH_OPEN)
6661                                 local->config.authType = AUTH_ENCRYPT;
6662                 } else {
6663                         local->config.authType = AUTH_OPEN;
6664                 }
6665
6666                 /* Commit the changes to flags if needed */
6667                 if (local->config.authType != currentAuthType)
6668                         set_bit (FLAG_COMMIT, &local->flags);
6669                 break;
6670
6671         case IW_AUTH_80211_AUTH_ALG: {
6672                         /* FIXME: What about AUTH_OPEN?  This API seems to
6673                          * disallow setting our auth to AUTH_OPEN.
6674                          */
6675                         if (param->value & IW_AUTH_ALG_SHARED_KEY) {
6676                                 local->config.authType = AUTH_SHAREDKEY;
6677                         } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
6678                                 local->config.authType = AUTH_ENCRYPT;
6679                         } else
6680                                 return -EINVAL;
6681
6682                         /* Commit the changes to flags if needed */
6683                         if (local->config.authType != currentAuthType)
6684                                 set_bit (FLAG_COMMIT, &local->flags);
6685                         break;
6686                 }
6687
6688         case IW_AUTH_WPA_ENABLED:
6689                 /* Silently accept disable of WPA */
6690                 if (param->value > 0)
6691                         return -EOPNOTSUPP;
6692                 break;
6693
6694         default:
6695                 return -EOPNOTSUPP;
6696         }
6697         return -EINPROGRESS;
6698 }
6699
6700
6701 /*------------------------------------------------------------------*/
6702 /*
6703  * Wireless Handler : get extended authentication parameters
6704  */
6705 static int airo_get_auth(struct net_device *dev,
6706                                struct iw_request_info *info,
6707                                union iwreq_data *wrqu, char *extra)
6708 {
6709         struct airo_info *local = dev->ml_priv;
6710         struct iw_param *param = &wrqu->param;
6711         __le16 currentAuthType = local->config.authType;
6712
6713         switch (param->flags & IW_AUTH_INDEX) {
6714         case IW_AUTH_DROP_UNENCRYPTED:
6715                 switch (currentAuthType) {
6716                 case AUTH_SHAREDKEY:
6717                 case AUTH_ENCRYPT:
6718                         param->value = 1;
6719                         break;
6720                 default:
6721                         param->value = 0;
6722                         break;
6723                 }
6724                 break;
6725
6726         case IW_AUTH_80211_AUTH_ALG:
6727                 switch (currentAuthType) {
6728                 case AUTH_SHAREDKEY:
6729                         param->value = IW_AUTH_ALG_SHARED_KEY;
6730                         break;
6731                 case AUTH_ENCRYPT:
6732                 default:
6733                         param->value = IW_AUTH_ALG_OPEN_SYSTEM;
6734                         break;
6735                 }
6736                 break;
6737
6738         case IW_AUTH_WPA_ENABLED:
6739                 param->value = 0;
6740                 break;
6741
6742         default:
6743                 return -EOPNOTSUPP;
6744         }
6745         return 0;
6746 }
6747
6748
6749 /*------------------------------------------------------------------*/
6750 /*
6751  * Wireless Handler : set Tx-Power
6752  */
6753 static int airo_set_txpow(struct net_device *dev,
6754                           struct iw_request_info *info,
6755                           struct iw_param *vwrq,
6756                           char *extra)
6757 {
6758         struct airo_info *local = dev->ml_priv;
6759         CapabilityRid cap_rid;          /* Card capability info */
6760         int i;
6761         int rc = -EINVAL;
6762         __le16 v = cpu_to_le16(vwrq->value);
6763
6764         readCapabilityRid(local, &cap_rid, 1);
6765
6766         if (vwrq->disabled) {
6767                 set_bit (FLAG_RADIO_OFF, &local->flags);
6768                 set_bit (FLAG_COMMIT, &local->flags);
6769                 return -EINPROGRESS;            /* Call commit handler */
6770         }
6771         if (vwrq->flags != IW_TXPOW_MWATT) {
6772                 return -EINVAL;
6773         }
6774         clear_bit (FLAG_RADIO_OFF, &local->flags);
6775         for (i = 0; i < 8 && cap_rid.txPowerLevels[i]; i++)
6776                 if (v == cap_rid.txPowerLevels[i]) {
6777                         readConfigRid(local, 1);
6778                         local->config.txPower = v;
6779                         set_bit (FLAG_COMMIT, &local->flags);
6780                         rc = -EINPROGRESS;      /* Call commit handler */
6781                         break;
6782                 }
6783         return rc;
6784 }
6785
6786 /*------------------------------------------------------------------*/
6787 /*
6788  * Wireless Handler : get Tx-Power
6789  */
6790 static int airo_get_txpow(struct net_device *dev,
6791                           struct iw_request_info *info,
6792                           struct iw_param *vwrq,
6793                           char *extra)
6794 {
6795         struct airo_info *local = dev->ml_priv;
6796
6797         readConfigRid(local, 1);
6798         vwrq->value = le16_to_cpu(local->config.txPower);
6799         vwrq->fixed = 1;        /* No power control */
6800         vwrq->disabled = test_bit(FLAG_RADIO_OFF, &local->flags);
6801         vwrq->flags = IW_TXPOW_MWATT;
6802
6803         return 0;
6804 }
6805
6806 /*------------------------------------------------------------------*/
6807 /*
6808  * Wireless Handler : set Retry limits
6809  */
6810 static int airo_set_retry(struct net_device *dev,
6811                           struct iw_request_info *info,
6812                           struct iw_param *vwrq,
6813                           char *extra)
6814 {
6815         struct airo_info *local = dev->ml_priv;
6816         int rc = -EINVAL;
6817
6818         if(vwrq->disabled) {
6819                 return -EINVAL;
6820         }
6821         readConfigRid(local, 1);
6822         if(vwrq->flags & IW_RETRY_LIMIT) {
6823                 __le16 v = cpu_to_le16(vwrq->value);
6824                 if(vwrq->flags & IW_RETRY_LONG)
6825                         local->config.longRetryLimit = v;
6826                 else if (vwrq->flags & IW_RETRY_SHORT)
6827                         local->config.shortRetryLimit = v;
6828                 else {
6829                         /* No modifier : set both */
6830                         local->config.longRetryLimit = v;
6831                         local->config.shortRetryLimit = v;
6832                 }
6833                 set_bit (FLAG_COMMIT, &local->flags);
6834                 rc = -EINPROGRESS;              /* Call commit handler */
6835         }
6836         if(vwrq->flags & IW_RETRY_LIFETIME) {
6837                 local->config.txLifetime = cpu_to_le16(vwrq->value / 1024);
6838                 set_bit (FLAG_COMMIT, &local->flags);
6839                 rc = -EINPROGRESS;              /* Call commit handler */
6840         }
6841         return rc;
6842 }
6843
6844 /*------------------------------------------------------------------*/
6845 /*
6846  * Wireless Handler : get Retry limits
6847  */
6848 static int airo_get_retry(struct net_device *dev,
6849                           struct iw_request_info *info,
6850                           struct iw_param *vwrq,
6851                           char *extra)
6852 {
6853         struct airo_info *local = dev->ml_priv;
6854
6855         vwrq->disabled = 0;      /* Can't be disabled */
6856
6857         readConfigRid(local, 1);
6858         /* Note : by default, display the min retry number */
6859         if((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
6860                 vwrq->flags = IW_RETRY_LIFETIME;
6861                 vwrq->value = le16_to_cpu(local->config.txLifetime) * 1024;
6862         } else if((vwrq->flags & IW_RETRY_LONG)) {
6863                 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
6864                 vwrq->value = le16_to_cpu(local->config.longRetryLimit);
6865         } else {
6866                 vwrq->flags = IW_RETRY_LIMIT;
6867                 vwrq->value = le16_to_cpu(local->config.shortRetryLimit);
6868                 if(local->config.shortRetryLimit != local->config.longRetryLimit)
6869                         vwrq->flags |= IW_RETRY_SHORT;
6870         }
6871
6872         return 0;
6873 }
6874
6875 /*------------------------------------------------------------------*/
6876 /*
6877  * Wireless Handler : get range info
6878  */
6879 static int airo_get_range(struct net_device *dev,
6880                           struct iw_request_info *info,
6881                           struct iw_point *dwrq,
6882                           char *extra)
6883 {
6884         struct airo_info *local = dev->ml_priv;
6885         struct iw_range *range = (struct iw_range *) extra;
6886         CapabilityRid cap_rid;          /* Card capability info */
6887         int             i;
6888         int             k;
6889
6890         readCapabilityRid(local, &cap_rid, 1);
6891
6892         dwrq->length = sizeof(struct iw_range);
6893         memset(range, 0, sizeof(*range));
6894         range->min_nwid = 0x0000;
6895         range->max_nwid = 0x0000;
6896         range->num_channels = 14;
6897         /* Should be based on cap_rid.country to give only
6898          * what the current card support */
6899         k = 0;
6900         for(i = 0; i < 14; i++) {
6901                 range->freq[k].i = i + 1; /* List index */
6902                 range->freq[k].m = 100000 *
6903                      ieee80211_channel_to_frequency(i + 1, IEEE80211_BAND_2GHZ);
6904                 range->freq[k++].e = 1; /* Values in MHz -> * 10^5 * 10 */
6905         }
6906         range->num_frequency = k;
6907
6908         range->sensitivity = 65535;
6909
6910         /* Hum... Should put the right values there */
6911         if (local->rssi)
6912                 range->max_qual.qual = 100;     /* % */
6913         else
6914                 range->max_qual.qual = airo_get_max_quality(&cap_rid);
6915         range->max_qual.level = 0x100 - 120;    /* -120 dBm */
6916         range->max_qual.noise = 0x100 - 120;    /* -120 dBm */
6917
6918         /* Experimental measurements - boundary 11/5.5 Mb/s */
6919         /* Note : with or without the (local->rssi), results
6920          * are somewhat different. - Jean II */
6921         if (local->rssi) {
6922                 range->avg_qual.qual = 50;              /* % */
6923                 range->avg_qual.level = 0x100 - 70;     /* -70 dBm */
6924         } else {
6925                 range->avg_qual.qual = airo_get_avg_quality(&cap_rid);
6926                 range->avg_qual.level = 0x100 - 80;     /* -80 dBm */
6927         }
6928         range->avg_qual.noise = 0x100 - 85;             /* -85 dBm */
6929
6930         for(i = 0 ; i < 8 ; i++) {
6931                 range->bitrate[i] = cap_rid.supportedRates[i] * 500000;
6932                 if(range->bitrate[i] == 0)
6933                         break;
6934         }
6935         range->num_bitrates = i;
6936
6937         /* Set an indication of the max TCP throughput
6938          * in bit/s that we can expect using this interface.
6939          * May be use for QoS stuff... Jean II */
6940         if(i > 2)
6941                 range->throughput = 5000 * 1000;
6942         else
6943                 range->throughput = 1500 * 1000;
6944
6945         range->min_rts = 0;
6946         range->max_rts = AIRO_DEF_MTU;
6947         range->min_frag = 256;
6948         range->max_frag = AIRO_DEF_MTU;
6949
6950         if(cap_rid.softCap & cpu_to_le16(2)) {
6951                 // WEP: RC4 40 bits
6952                 range->encoding_size[0] = 5;
6953                 // RC4 ~128 bits
6954                 if (cap_rid.softCap & cpu_to_le16(0x100)) {
6955                         range->encoding_size[1] = 13;
6956                         range->num_encoding_sizes = 2;
6957                 } else
6958                         range->num_encoding_sizes = 1;
6959                 range->max_encoding_tokens =
6960                         cap_rid.softCap & cpu_to_le16(0x80) ? 4 : 1;
6961         } else {
6962                 range->num_encoding_sizes = 0;
6963                 range->max_encoding_tokens = 0;
6964         }
6965         range->min_pmp = 0;
6966         range->max_pmp = 5000000;       /* 5 secs */
6967         range->min_pmt = 0;
6968         range->max_pmt = 65535 * 1024;  /* ??? */
6969         range->pmp_flags = IW_POWER_PERIOD;
6970         range->pmt_flags = IW_POWER_TIMEOUT;
6971         range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
6972
6973         /* Transmit Power - values are in mW */
6974         for(i = 0 ; i < 8 ; i++) {
6975                 range->txpower[i] = le16_to_cpu(cap_rid.txPowerLevels[i]);
6976                 if(range->txpower[i] == 0)
6977                         break;
6978         }
6979         range->num_txpower = i;
6980         range->txpower_capa = IW_TXPOW_MWATT;
6981         range->we_version_source = 19;
6982         range->we_version_compiled = WIRELESS_EXT;
6983         range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
6984         range->retry_flags = IW_RETRY_LIMIT;
6985         range->r_time_flags = IW_RETRY_LIFETIME;
6986         range->min_retry = 1;
6987         range->max_retry = 65535;
6988         range->min_r_time = 1024;
6989         range->max_r_time = 65535 * 1024;
6990
6991         /* Event capability (kernel + driver) */
6992         range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
6993                                 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
6994                                 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
6995                                 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
6996         range->event_capa[1] = IW_EVENT_CAPA_K_1;
6997         range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVTXDROP);
6998         return 0;
6999 }
7000
7001 /*------------------------------------------------------------------*/
7002 /*
7003  * Wireless Handler : set Power Management
7004  */
7005 static int airo_set_power(struct net_device *dev,
7006                           struct iw_request_info *info,
7007                           struct iw_param *vwrq,
7008                           char *extra)
7009 {
7010         struct airo_info *local = dev->ml_priv;
7011
7012         readConfigRid(local, 1);
7013         if (vwrq->disabled) {
7014                 if (sniffing_mode(local))
7015                         return -EINVAL;
7016                 local->config.powerSaveMode = POWERSAVE_CAM;
7017                 local->config.rmode &= ~RXMODE_MASK;
7018                 local->config.rmode |= RXMODE_BC_MC_ADDR;
7019                 set_bit (FLAG_COMMIT, &local->flags);
7020                 return -EINPROGRESS;            /* Call commit handler */
7021         }
7022         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7023                 local->config.fastListenDelay = cpu_to_le16((vwrq->value + 500) / 1024);
7024                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7025                 set_bit (FLAG_COMMIT, &local->flags);
7026         } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
7027                 local->config.fastListenInterval =
7028                 local->config.listenInterval =
7029                         cpu_to_le16((vwrq->value + 500) / 1024);
7030                 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7031                 set_bit (FLAG_COMMIT, &local->flags);
7032         }
7033         switch (vwrq->flags & IW_POWER_MODE) {
7034                 case IW_POWER_UNICAST_R:
7035                         if (sniffing_mode(local))
7036                                 return -EINVAL;
7037                         local->config.rmode &= ~RXMODE_MASK;
7038                         local->config.rmode |= RXMODE_ADDR;
7039                         set_bit (FLAG_COMMIT, &local->flags);
7040                         break;
7041                 case IW_POWER_ALL_R:
7042                         if (sniffing_mode(local))
7043                                 return -EINVAL;
7044                         local->config.rmode &= ~RXMODE_MASK;
7045                         local->config.rmode |= RXMODE_BC_MC_ADDR;
7046                         set_bit (FLAG_COMMIT, &local->flags);
7047                 case IW_POWER_ON:
7048                         /* This is broken, fixme ;-) */
7049                         break;
7050                 default:
7051                         return -EINVAL;
7052         }
7053         // Note : we may want to factor local->need_commit here
7054         // Note2 : may also want to factor RXMODE_RFMON test
7055         return -EINPROGRESS;            /* Call commit handler */
7056 }
7057
7058 /*------------------------------------------------------------------*/
7059 /*
7060  * Wireless Handler : get Power Management
7061  */
7062 static int airo_get_power(struct net_device *dev,
7063                           struct iw_request_info *info,
7064                           struct iw_param *vwrq,
7065                           char *extra)
7066 {
7067         struct airo_info *local = dev->ml_priv;
7068         __le16 mode;
7069
7070         readConfigRid(local, 1);
7071         mode = local->config.powerSaveMode;
7072         if ((vwrq->disabled = (mode == POWERSAVE_CAM)))
7073                 return 0;
7074         if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7075                 vwrq->value = le16_to_cpu(local->config.fastListenDelay) * 1024;
7076                 vwrq->flags = IW_POWER_TIMEOUT;
7077         } else {
7078                 vwrq->value = le16_to_cpu(local->config.fastListenInterval) * 1024;
7079                 vwrq->flags = IW_POWER_PERIOD;
7080         }
7081         if ((local->config.rmode & RXMODE_MASK) == RXMODE_ADDR)
7082                 vwrq->flags |= IW_POWER_UNICAST_R;
7083         else
7084                 vwrq->flags |= IW_POWER_ALL_R;
7085
7086         return 0;
7087 }
7088
7089 /*------------------------------------------------------------------*/
7090 /*
7091  * Wireless Handler : set Sensitivity
7092  */
7093 static int airo_set_sens(struct net_device *dev,
7094                          struct iw_request_info *info,
7095                          struct iw_param *vwrq,
7096                          char *extra)
7097 {
7098         struct airo_info *local = dev->ml_priv;
7099
7100         readConfigRid(local, 1);
7101         local->config.rssiThreshold =
7102                 cpu_to_le16(vwrq->disabled ? RSSI_DEFAULT : vwrq->value);
7103         set_bit (FLAG_COMMIT, &local->flags);
7104
7105         return -EINPROGRESS;            /* Call commit handler */
7106 }
7107
7108 /*------------------------------------------------------------------*/
7109 /*
7110  * Wireless Handler : get Sensitivity
7111  */
7112 static int airo_get_sens(struct net_device *dev,
7113                          struct iw_request_info *info,
7114                          struct iw_param *vwrq,
7115                          char *extra)
7116 {
7117         struct airo_info *local = dev->ml_priv;
7118
7119         readConfigRid(local, 1);
7120         vwrq->value = le16_to_cpu(local->config.rssiThreshold);
7121         vwrq->disabled = (vwrq->value == 0);
7122         vwrq->fixed = 1;
7123
7124         return 0;
7125 }
7126
7127 /*------------------------------------------------------------------*/
7128 /*
7129  * Wireless Handler : get AP List
7130  * Note : this is deprecated in favor of IWSCAN
7131  */
7132 static int airo_get_aplist(struct net_device *dev,
7133                            struct iw_request_info *info,
7134                            struct iw_point *dwrq,
7135                            char *extra)
7136 {
7137         struct airo_info *local = dev->ml_priv;
7138         struct sockaddr *address = (struct sockaddr *) extra;
7139         struct iw_quality *qual;
7140         BSSListRid BSSList;
7141         int i;
7142         int loseSync = capable(CAP_NET_ADMIN) ? 1: -1;
7143
7144         qual = kmalloc(IW_MAX_AP * sizeof(*qual), GFP_KERNEL);
7145         if (!qual)
7146                 return -ENOMEM;
7147
7148         for (i = 0; i < IW_MAX_AP; i++) {
7149                 u16 dBm;
7150                 if (readBSSListRid(local, loseSync, &BSSList))
7151                         break;
7152                 loseSync = 0;
7153                 memcpy(address[i].sa_data, BSSList.bssid, ETH_ALEN);
7154                 address[i].sa_family = ARPHRD_ETHER;
7155                 dBm = le16_to_cpu(BSSList.dBm);
7156                 if (local->rssi) {
7157                         qual[i].level = 0x100 - dBm;
7158                         qual[i].qual = airo_dbm_to_pct(local->rssi, dBm);
7159                         qual[i].updated = IW_QUAL_QUAL_UPDATED
7160                                         | IW_QUAL_LEVEL_UPDATED
7161                                         | IW_QUAL_DBM;
7162                 } else {
7163                         qual[i].level = (dBm + 321) / 2;
7164                         qual[i].qual = 0;
7165                         qual[i].updated = IW_QUAL_QUAL_INVALID
7166                                         | IW_QUAL_LEVEL_UPDATED
7167                                         | IW_QUAL_DBM;
7168                 }
7169                 qual[i].noise = local->wstats.qual.noise;
7170                 if (BSSList.index == cpu_to_le16(0xffff))
7171                         break;
7172         }
7173         if (!i) {
7174                 StatusRid status_rid;           /* Card status info */
7175                 readStatusRid(local, &status_rid, 1);
7176                 for (i = 0;
7177                      i < min(IW_MAX_AP, 4) &&
7178                              (status_rid.bssid[i][0]
7179                               & status_rid.bssid[i][1]
7180                               & status_rid.bssid[i][2]
7181                               & status_rid.bssid[i][3]
7182                               & status_rid.bssid[i][4]
7183                               & status_rid.bssid[i][5])!=0xff &&
7184                              (status_rid.bssid[i][0]
7185                               | status_rid.bssid[i][1]
7186                               | status_rid.bssid[i][2]
7187                               | status_rid.bssid[i][3]
7188                               | status_rid.bssid[i][4]
7189                               | status_rid.bssid[i][5]);
7190                      i++) {
7191                         memcpy(address[i].sa_data,
7192                                status_rid.bssid[i], ETH_ALEN);
7193                         address[i].sa_family = ARPHRD_ETHER;
7194                 }
7195         } else {
7196                 dwrq->flags = 1; /* Should be define'd */
7197                 memcpy(extra + sizeof(struct sockaddr) * i, qual,
7198                        sizeof(struct iw_quality) * i);
7199         }
7200         dwrq->length = i;
7201
7202         kfree(qual);
7203         return 0;
7204 }
7205
7206 /*------------------------------------------------------------------*/
7207 /*
7208  * Wireless Handler : Initiate Scan
7209  */
7210 static int airo_set_scan(struct net_device *dev,
7211                          struct iw_request_info *info,
7212                          struct iw_point *dwrq,
7213                          char *extra)
7214 {
7215         struct airo_info *ai = dev->ml_priv;
7216         Cmd cmd;
7217         Resp rsp;
7218         int wake = 0;
7219
7220         /* Note : you may have realised that, as this is a SET operation,
7221          * this is privileged and therefore a normal user can't
7222          * perform scanning.
7223          * This is not an error, while the device perform scanning,
7224          * traffic doesn't flow, so it's a perfect DoS...
7225          * Jean II */
7226         if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
7227
7228         if (down_interruptible(&ai->sem))
7229                 return -ERESTARTSYS;
7230
7231         /* If there's already a scan in progress, don't
7232          * trigger another one. */
7233         if (ai->scan_timeout > 0)
7234                 goto out;
7235
7236         /* Initiate a scan command */
7237         ai->scan_timeout = RUN_AT(3*HZ);
7238         memset(&cmd, 0, sizeof(cmd));
7239         cmd.cmd=CMD_LISTBSS;
7240         issuecommand(ai, &cmd, &rsp);
7241         wake = 1;
7242
7243 out:
7244         up(&ai->sem);
7245         if (wake)
7246                 wake_up_interruptible(&ai->thr_wait);
7247         return 0;
7248 }
7249
7250 /*------------------------------------------------------------------*/
7251 /*
7252  * Translate scan data returned from the card to a card independent
7253  * format that the Wireless Tools will understand - Jean II
7254  */
7255 static inline char *airo_translate_scan(struct net_device *dev,
7256                                         struct iw_request_info *info,
7257                                         char *current_ev,
7258                                         char *end_buf,
7259                                         BSSListRid *bss)
7260 {
7261         struct airo_info *ai = dev->ml_priv;
7262         struct iw_event         iwe;            /* Temporary buffer */
7263         __le16                  capabilities;
7264         char *                  current_val;    /* For rates */
7265         int                     i;
7266         char *          buf;
7267         u16 dBm;
7268
7269         /* First entry *MUST* be the AP MAC address */
7270         iwe.cmd = SIOCGIWAP;
7271         iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
7272         memcpy(iwe.u.ap_addr.sa_data, bss->bssid, ETH_ALEN);
7273         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7274                                           &iwe, IW_EV_ADDR_LEN);
7275
7276         /* Other entries will be displayed in the order we give them */
7277
7278         /* Add the ESSID */
7279         iwe.u.data.length = bss->ssidLen;
7280         if(iwe.u.data.length > 32)
7281                 iwe.u.data.length = 32;
7282         iwe.cmd = SIOCGIWESSID;
7283         iwe.u.data.flags = 1;
7284         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7285                                           &iwe, bss->ssid);
7286
7287         /* Add mode */
7288         iwe.cmd = SIOCGIWMODE;
7289         capabilities = bss->cap;
7290         if(capabilities & (CAP_ESS | CAP_IBSS)) {
7291                 if(capabilities & CAP_ESS)
7292                         iwe.u.mode = IW_MODE_MASTER;
7293                 else
7294                         iwe.u.mode = IW_MODE_ADHOC;
7295                 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7296                                                   &iwe, IW_EV_UINT_LEN);
7297         }
7298
7299         /* Add frequency */
7300         iwe.cmd = SIOCGIWFREQ;
7301         iwe.u.freq.m = le16_to_cpu(bss->dsChannel);
7302         iwe.u.freq.m = 100000 *
7303               ieee80211_channel_to_frequency(iwe.u.freq.m, IEEE80211_BAND_2GHZ);
7304         iwe.u.freq.e = 1;
7305         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7306                                           &iwe, IW_EV_FREQ_LEN);
7307
7308         dBm = le16_to_cpu(bss->dBm);
7309
7310         /* Add quality statistics */
7311         iwe.cmd = IWEVQUAL;
7312         if (ai->rssi) {
7313                 iwe.u.qual.level = 0x100 - dBm;
7314                 iwe.u.qual.qual = airo_dbm_to_pct(ai->rssi, dBm);
7315                 iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED
7316                                 | IW_QUAL_LEVEL_UPDATED
7317                                 | IW_QUAL_DBM;
7318         } else {
7319                 iwe.u.qual.level = (dBm + 321) / 2;
7320                 iwe.u.qual.qual = 0;
7321                 iwe.u.qual.updated = IW_QUAL_QUAL_INVALID
7322                                 | IW_QUAL_LEVEL_UPDATED
7323                                 | IW_QUAL_DBM;
7324         }
7325         iwe.u.qual.noise = ai->wstats.qual.noise;
7326         current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7327                                           &iwe, IW_EV_QUAL_LEN);
7328
7329         /* Add encryption capability */
7330         iwe.cmd = SIOCGIWENCODE;
7331         if(capabilities & CAP_PRIVACY)
7332                 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
7333         else
7334                 iwe.u.data.flags = IW_ENCODE_DISABLED;
7335         iwe.u.data.length = 0;
7336         current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7337                                           &iwe, bss->ssid);
7338
7339         /* Rate : stuffing multiple values in a single event require a bit
7340          * more of magic - Jean II */
7341         current_val = current_ev + iwe_stream_lcp_len(info);
7342
7343         iwe.cmd = SIOCGIWRATE;
7344         /* Those two flags are ignored... */
7345         iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
7346         /* Max 8 values */
7347         for(i = 0 ; i < 8 ; i++) {
7348                 /* NULL terminated */
7349                 if(bss->rates[i] == 0)
7350                         break;
7351                 /* Bit rate given in 500 kb/s units (+ 0x80) */
7352                 iwe.u.bitrate.value = ((bss->rates[i] & 0x7f) * 500000);
7353                 /* Add new value to event */
7354                 current_val = iwe_stream_add_value(info, current_ev,
7355                                                    current_val, end_buf,
7356                                                    &iwe, IW_EV_PARAM_LEN);
7357         }
7358         /* Check if we added any event */
7359         if ((current_val - current_ev) > iwe_stream_lcp_len(info))
7360                 current_ev = current_val;
7361
7362         /* Beacon interval */
7363         buf = kmalloc(30, GFP_KERNEL);
7364         if (buf) {
7365                 iwe.cmd = IWEVCUSTOM;
7366                 sprintf(buf, "bcn_int=%d", bss->beaconInterval);
7367                 iwe.u.data.length = strlen(buf);
7368                 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7369                                                   &iwe, buf);
7370                 kfree(buf);
7371         }
7372
7373         /* Put WPA/RSN Information Elements into the event stream */
7374         if (test_bit(FLAG_WPA_CAPABLE, &ai->flags)) {
7375                 unsigned int num_null_ies = 0;
7376                 u16 length = sizeof (bss->extra.iep);
7377                 u8 *ie = (void *)&bss->extra.iep;
7378
7379                 while ((length >= 2) && (num_null_ies < 2)) {
7380                         if (2 + ie[1] > length) {
7381                                 /* Invalid element, don't continue parsing IE */
7382                                 break;
7383                         }
7384
7385                         switch (ie[0]) {
7386                         case WLAN_EID_SSID:
7387                                 /* Two zero-length SSID elements
7388                                  * mean we're done parsing elements */
7389                                 if (!ie[1])
7390                                         num_null_ies++;
7391                                 break;
7392
7393                         case WLAN_EID_VENDOR_SPECIFIC:
7394                                 if (ie[1] >= 4 &&
7395                                     ie[2] == 0x00 &&
7396                                     ie[3] == 0x50 &&
7397                                     ie[4] == 0xf2 &&
7398                                     ie[5] == 0x01) {
7399                                         iwe.cmd = IWEVGENIE;
7400                                         /* 64 is an arbitrary cut-off */
7401                                         iwe.u.data.length = min(ie[1] + 2,
7402                                                                 64);
7403                                         current_ev = iwe_stream_add_point(
7404                                                         info, current_ev,
7405                                                         end_buf, &iwe, ie);
7406                                 }
7407                                 break;
7408
7409                         case WLAN_EID_RSN:
7410                                 iwe.cmd = IWEVGENIE;
7411                                 /* 64 is an arbitrary cut-off */
7412                                 iwe.u.data.length = min(ie[1] + 2, 64);
7413                                 current_ev = iwe_stream_add_point(
7414                                         info, current_ev, end_buf,
7415                                         &iwe, ie);
7416                                 break;
7417
7418                         default:
7419                                 break;
7420                         }
7421
7422                         length -= 2 + ie[1];
7423                         ie += 2 + ie[1];
7424                 }
7425         }
7426         return current_ev;
7427 }
7428
7429 /*------------------------------------------------------------------*/
7430 /*
7431  * Wireless Handler : Read Scan Results
7432  */
7433 static int airo_get_scan(struct net_device *dev,
7434                          struct iw_request_info *info,
7435                          struct iw_point *dwrq,
7436                          char *extra)
7437 {
7438         struct airo_info *ai = dev->ml_priv;
7439         BSSListElement *net;
7440         int err = 0;
7441         char *current_ev = extra;
7442
7443         /* If a scan is in-progress, return -EAGAIN */
7444         if (ai->scan_timeout > 0)
7445                 return -EAGAIN;
7446
7447         if (down_interruptible(&ai->sem))
7448                 return -EAGAIN;
7449
7450         list_for_each_entry (net, &ai->network_list, list) {
7451                 /* Translate to WE format this entry */
7452                 current_ev = airo_translate_scan(dev, info, current_ev,
7453                                                  extra + dwrq->length,
7454                                                  &net->bss);
7455
7456                 /* Check if there is space for one more entry */
7457                 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
7458                         /* Ask user space to try again with a bigger buffer */
7459                         err = -E2BIG;
7460                         goto out;
7461                 }
7462         }
7463
7464         /* Length of data */
7465         dwrq->length = (current_ev - extra);
7466         dwrq->flags = 0;        /* todo */
7467
7468 out:
7469         up(&ai->sem);
7470         return err;
7471 }
7472
7473 /*------------------------------------------------------------------*/
7474 /*
7475  * Commit handler : called after a bunch of SET operations
7476  */
7477 static int airo_config_commit(struct net_device *dev,
7478                               struct iw_request_info *info,     /* NULL */
7479                               void *zwrq,                       /* NULL */
7480                               char *extra)                      /* NULL */
7481 {
7482         struct airo_info *local = dev->ml_priv;
7483
7484         if (!test_bit (FLAG_COMMIT, &local->flags))
7485                 return 0;
7486
7487         /* Some of the "SET" function may have modified some of the
7488          * parameters. It's now time to commit them in the card */
7489         disable_MAC(local, 1);
7490         if (test_bit (FLAG_RESET, &local->flags)) {
7491                 APListRid APList_rid;
7492                 SsidRid SSID_rid;
7493
7494                 readAPListRid(local, &APList_rid);
7495                 readSsidRid(local, &SSID_rid);
7496                 if (test_bit(FLAG_MPI,&local->flags))
7497                         setup_card(local, dev->dev_addr, 1 );
7498                 else
7499                         reset_airo_card(dev);
7500                 disable_MAC(local, 1);
7501                 writeSsidRid(local, &SSID_rid, 1);
7502                 writeAPListRid(local, &APList_rid, 1);
7503         }
7504         if (down_interruptible(&local->sem))
7505                 return -ERESTARTSYS;
7506         writeConfigRid(local, 0);
7507         enable_MAC(local, 0);
7508         if (test_bit (FLAG_RESET, &local->flags))
7509                 airo_set_promisc(local);
7510         else
7511                 up(&local->sem);
7512
7513         return 0;
7514 }
7515
7516 /*------------------------------------------------------------------*/
7517 /*
7518  * Structures to export the Wireless Handlers
7519  */
7520
7521 static const struct iw_priv_args airo_private_args[] = {
7522 /*{ cmd,         set_args,                            get_args, name } */
7523   { AIROIOCTL, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7524     IW_PRIV_TYPE_BYTE | 2047, "airoioctl" },
7525   { AIROIDIFC, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7526     IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "airoidifc" },
7527 };
7528
7529 static const iw_handler         airo_handler[] =
7530 {
7531         (iw_handler) airo_config_commit,        /* SIOCSIWCOMMIT */
7532         (iw_handler) airo_get_name,             /* SIOCGIWNAME */
7533         (iw_handler) NULL,                      /* SIOCSIWNWID */
7534         (iw_handler) NULL,                      /* SIOCGIWNWID */
7535         (iw_handler) airo_set_freq,             /* SIOCSIWFREQ */
7536         (iw_handler) airo_get_freq,             /* SIOCGIWFREQ */
7537         (iw_handler) airo_set_mode,             /* SIOCSIWMODE */
7538         (iw_handler) airo_get_mode,             /* SIOCGIWMODE */
7539         (iw_handler) airo_set_sens,             /* SIOCSIWSENS */
7540         (iw_handler) airo_get_sens,             /* SIOCGIWSENS */
7541         (iw_handler) NULL,                      /* SIOCSIWRANGE */
7542         (iw_handler) airo_get_range,            /* SIOCGIWRANGE */
7543         (iw_handler) NULL,                      /* SIOCSIWPRIV */
7544         (iw_handler) NULL,                      /* SIOCGIWPRIV */
7545         (iw_handler) NULL,                      /* SIOCSIWSTATS */
7546         (iw_handler) NULL,                      /* SIOCGIWSTATS */
7547         iw_handler_set_spy,                     /* SIOCSIWSPY */
7548         iw_handler_get_spy,                     /* SIOCGIWSPY */
7549         iw_handler_set_thrspy,                  /* SIOCSIWTHRSPY */
7550         iw_handler_get_thrspy,                  /* SIOCGIWTHRSPY */
7551         (iw_handler) airo_set_wap,              /* SIOCSIWAP */
7552         (iw_handler) airo_get_wap,              /* SIOCGIWAP */
7553         (iw_handler) NULL,                      /* -- hole -- */
7554         (iw_handler) airo_get_aplist,           /* SIOCGIWAPLIST */
7555         (iw_handler) airo_set_scan,             /* SIOCSIWSCAN */
7556         (iw_handler) airo_get_scan,             /* SIOCGIWSCAN */
7557         (iw_handler) airo_set_essid,            /* SIOCSIWESSID */
7558         (iw_handler) airo_get_essid,            /* SIOCGIWESSID */
7559         (iw_handler) airo_set_nick,             /* SIOCSIWNICKN */
7560         (iw_handler) airo_get_nick,             /* SIOCGIWNICKN */
7561         (iw_handler) NULL,                      /* -- hole -- */
7562         (iw_handler) NULL,                      /* -- hole -- */
7563         (iw_handler) airo_set_rate,             /* SIOCSIWRATE */
7564         (iw_handler) airo_get_rate,             /* SIOCGIWRATE */
7565         (iw_handler) airo_set_rts,              /* SIOCSIWRTS */
7566         (iw_handler) airo_get_rts,              /* SIOCGIWRTS */
7567         (iw_handler) airo_set_frag,             /* SIOCSIWFRAG */
7568         (iw_handler) airo_get_frag,             /* SIOCGIWFRAG */
7569         (iw_handler) airo_set_txpow,            /* SIOCSIWTXPOW */
7570         (iw_handler) airo_get_txpow,            /* SIOCGIWTXPOW */
7571         (iw_handler) airo_set_retry,            /* SIOCSIWRETRY */
7572         (iw_handler) airo_get_retry,            /* SIOCGIWRETRY */
7573         (iw_handler) airo_set_encode,           /* SIOCSIWENCODE */
7574         (iw_handler) airo_get_encode,           /* SIOCGIWENCODE */
7575         (iw_handler) airo_set_power,            /* SIOCSIWPOWER */
7576         (iw_handler) airo_get_power,            /* SIOCGIWPOWER */
7577         (iw_handler) NULL,                      /* -- hole -- */
7578         (iw_handler) NULL,                      /* -- hole -- */
7579         (iw_handler) NULL,                      /* SIOCSIWGENIE */
7580         (iw_handler) NULL,                      /* SIOCGIWGENIE */
7581         (iw_handler) airo_set_auth,             /* SIOCSIWAUTH */
7582         (iw_handler) airo_get_auth,             /* SIOCGIWAUTH */
7583         (iw_handler) airo_set_encodeext,        /* SIOCSIWENCODEEXT */
7584         (iw_handler) airo_get_encodeext,        /* SIOCGIWENCODEEXT */
7585         (iw_handler) NULL,                      /* SIOCSIWPMKSA */
7586 };
7587
7588 /* Note : don't describe AIROIDIFC and AIROOLDIDIFC in here.
7589  * We want to force the use of the ioctl code, because those can't be
7590  * won't work the iw_handler code (because they simultaneously read
7591  * and write data and iw_handler can't do that).
7592  * Note that it's perfectly legal to read/write on a single ioctl command,
7593  * you just can't use iwpriv and need to force it via the ioctl handler.
7594  * Jean II */
7595 static const iw_handler         airo_private_handler[] =
7596 {
7597         NULL,                           /* SIOCIWFIRSTPRIV */
7598 };
7599
7600 static const struct iw_handler_def      airo_handler_def =
7601 {
7602         .num_standard   = ARRAY_SIZE(airo_handler),
7603         .num_private    = ARRAY_SIZE(airo_private_handler),
7604         .num_private_args = ARRAY_SIZE(airo_private_args),
7605         .standard       = airo_handler,
7606         .private        = airo_private_handler,
7607         .private_args   = airo_private_args,
7608         .get_wireless_stats = airo_get_wireless_stats,
7609 };
7610
7611 /*
7612  * This defines the configuration part of the Wireless Extensions
7613  * Note : irq and spinlock protection will occur in the subroutines
7614  *
7615  * TODO :
7616  *      o Check input value more carefully and fill correct values in range
7617  *      o Test and shakeout the bugs (if any)
7618  *
7619  * Jean II
7620  *
7621  * Javier Achirica did a great job of merging code from the unnamed CISCO
7622  * developer that added support for flashing the card.
7623  */
7624 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
7625 {
7626         int rc = 0;
7627         struct airo_info *ai = dev->ml_priv;
7628
7629         if (ai->power.event)
7630                 return 0;
7631
7632         switch (cmd) {
7633 #ifdef CISCO_EXT
7634         case AIROIDIFC:
7635 #ifdef AIROOLDIDIFC
7636         case AIROOLDIDIFC:
7637 #endif
7638         {
7639                 int val = AIROMAGIC;
7640                 aironet_ioctl com;
7641                 if (copy_from_user(&com,rq->ifr_data,sizeof(com)))
7642                         rc = -EFAULT;
7643                 else if (copy_to_user(com.data,(char *)&val,sizeof(val)))
7644                         rc = -EFAULT;
7645         }
7646         break;
7647
7648         case AIROIOCTL:
7649 #ifdef AIROOLDIOCTL
7650         case AIROOLDIOCTL:
7651 #endif
7652                 /* Get the command struct and hand it off for evaluation by
7653                  * the proper subfunction
7654                  */
7655         {
7656                 aironet_ioctl com;
7657                 if (copy_from_user(&com,rq->ifr_data,sizeof(com))) {
7658                         rc = -EFAULT;
7659                         break;
7660                 }
7661
7662                 /* Separate R/W functions bracket legality here
7663                  */
7664                 if ( com.command == AIRORSWVERSION ) {
7665                         if (copy_to_user(com.data, swversion, sizeof(swversion)))
7666                                 rc = -EFAULT;
7667                         else
7668                                 rc = 0;
7669                 }
7670                 else if ( com.command <= AIRORRID)
7671                         rc = readrids(dev,&com);
7672                 else if ( com.command >= AIROPCAP && com.command <= (AIROPLEAPUSR+2) )
7673                         rc = writerids(dev,&com);
7674                 else if ( com.command >= AIROFLSHRST && com.command <= AIRORESTART )
7675                         rc = flashcard(dev,&com);
7676                 else
7677                         rc = -EINVAL;      /* Bad command in ioctl */
7678         }
7679         break;
7680 #endif /* CISCO_EXT */
7681
7682         // All other calls are currently unsupported
7683         default:
7684                 rc = -EOPNOTSUPP;
7685         }
7686         return rc;
7687 }
7688
7689 /*
7690  * Get the Wireless stats out of the driver
7691  * Note : irq and spinlock protection will occur in the subroutines
7692  *
7693  * TODO :
7694  *      o Check if work in Ad-Hoc mode (otherwise, use SPY, as in wvlan_cs)
7695  *
7696  * Jean
7697  */
7698 static void airo_read_wireless_stats(struct airo_info *local)
7699 {
7700         StatusRid status_rid;
7701         StatsRid stats_rid;
7702         CapabilityRid cap_rid;
7703         __le32 *vals = stats_rid.vals;
7704
7705         /* Get stats out of the card */
7706         clear_bit(JOB_WSTATS, &local->jobs);
7707         if (local->power.event) {
7708                 up(&local->sem);
7709                 return;
7710         }
7711         readCapabilityRid(local, &cap_rid, 0);
7712         readStatusRid(local, &status_rid, 0);
7713         readStatsRid(local, &stats_rid, RID_STATS, 0);
7714         up(&local->sem);
7715
7716         /* The status */
7717         local->wstats.status = le16_to_cpu(status_rid.mode);
7718
7719         /* Signal quality and co */
7720         if (local->rssi) {
7721                 local->wstats.qual.level =
7722                         airo_rssi_to_dbm(local->rssi,
7723                                          le16_to_cpu(status_rid.sigQuality));
7724                 /* normalizedSignalStrength appears to be a percentage */
7725                 local->wstats.qual.qual =
7726                         le16_to_cpu(status_rid.normalizedSignalStrength);
7727         } else {
7728                 local->wstats.qual.level =
7729                         (le16_to_cpu(status_rid.normalizedSignalStrength) + 321) / 2;
7730                 local->wstats.qual.qual = airo_get_quality(&status_rid, &cap_rid);
7731         }
7732         if (le16_to_cpu(status_rid.len) >= 124) {
7733                 local->wstats.qual.noise = 0x100 - status_rid.noisedBm;
7734                 local->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
7735         } else {
7736                 local->wstats.qual.noise = 0;
7737                 local->wstats.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID | IW_QUAL_DBM;
7738         }
7739
7740         /* Packets discarded in the wireless adapter due to wireless
7741          * specific problems */
7742         local->wstats.discard.nwid = le32_to_cpu(vals[56]) +
7743                                      le32_to_cpu(vals[57]) +
7744                                      le32_to_cpu(vals[58]); /* SSID Mismatch */
7745         local->wstats.discard.code = le32_to_cpu(vals[6]);/* RxWepErr */
7746         local->wstats.discard.fragment = le32_to_cpu(vals[30]);
7747         local->wstats.discard.retries = le32_to_cpu(vals[10]);
7748         local->wstats.discard.misc = le32_to_cpu(vals[1]) +
7749                                      le32_to_cpu(vals[32]);
7750         local->wstats.miss.beacon = le32_to_cpu(vals[34]);
7751 }
7752
7753 static struct iw_statistics *airo_get_wireless_stats(struct net_device *dev)
7754 {
7755         struct airo_info *local =  dev->ml_priv;
7756
7757         if (!test_bit(JOB_WSTATS, &local->jobs)) {
7758                 /* Get stats out of the card if available */
7759                 if (down_trylock(&local->sem) != 0) {
7760                         set_bit(JOB_WSTATS, &local->jobs);
7761                         wake_up_interruptible(&local->thr_wait);
7762                 } else
7763                         airo_read_wireless_stats(local);
7764         }
7765
7766         return &local->wstats;
7767 }
7768
7769 #ifdef CISCO_EXT
7770 /*
7771  * This just translates from driver IOCTL codes to the command codes to
7772  * feed to the radio's host interface. Things can be added/deleted
7773  * as needed.  This represents the READ side of control I/O to
7774  * the card
7775  */
7776 static int readrids(struct net_device *dev, aironet_ioctl *comp) {
7777         unsigned short ridcode;
7778         unsigned char *iobuf;
7779         int len;
7780         struct airo_info *ai = dev->ml_priv;
7781
7782         if (test_bit(FLAG_FLASHING, &ai->flags))
7783                 return -EIO;
7784
7785         switch(comp->command)
7786         {
7787         case AIROGCAP:      ridcode = RID_CAPABILITIES; break;
7788         case AIROGCFG:      ridcode = RID_CONFIG;
7789                 if (test_bit(FLAG_COMMIT, &ai->flags)) {
7790                         disable_MAC (ai, 1);
7791                         writeConfigRid (ai, 1);
7792                         enable_MAC(ai, 1);
7793                 }
7794                 break;
7795         case AIROGSLIST:    ridcode = RID_SSID;         break;
7796         case AIROGVLIST:    ridcode = RID_APLIST;       break;
7797         case AIROGDRVNAM:   ridcode = RID_DRVNAME;      break;
7798         case AIROGEHTENC:   ridcode = RID_ETHERENCAP;   break;
7799         case AIROGWEPKTMP:  ridcode = RID_WEP_TEMP;
7800                 /* Only super-user can read WEP keys */
7801                 if (!capable(CAP_NET_ADMIN))
7802                         return -EPERM;
7803                 break;
7804         case AIROGWEPKNV:   ridcode = RID_WEP_PERM;
7805                 /* Only super-user can read WEP keys */
7806                 if (!capable(CAP_NET_ADMIN))
7807                         return -EPERM;
7808                 break;
7809         case AIROGSTAT:     ridcode = RID_STATUS;       break;
7810         case AIROGSTATSD32: ridcode = RID_STATSDELTA;   break;
7811         case AIROGSTATSC32: ridcode = RID_STATS;        break;
7812         case AIROGMICSTATS:
7813                 if (copy_to_user(comp->data, &ai->micstats,
7814                                  min((int)comp->len,(int)sizeof(ai->micstats))))
7815                         return -EFAULT;
7816                 return 0;
7817         case AIRORRID:      ridcode = comp->ridnum;     break;
7818         default:
7819                 return -EINVAL;
7820                 break;
7821         }
7822
7823         if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7824                 return -ENOMEM;
7825
7826         PC4500_readrid(ai,ridcode,iobuf,RIDSIZE, 1);
7827         /* get the count of bytes in the rid  docs say 1st 2 bytes is it.
7828          * then return it to the user
7829          * 9/22/2000 Honor user given length
7830          */
7831         len = comp->len;
7832
7833         if (copy_to_user(comp->data, iobuf, min(len, (int)RIDSIZE))) {
7834                 kfree (iobuf);
7835                 return -EFAULT;
7836         }
7837         kfree (iobuf);
7838         return 0;
7839 }
7840
7841 /*
7842  * Danger Will Robinson write the rids here
7843  */
7844
7845 static int writerids(struct net_device *dev, aironet_ioctl *comp) {
7846         struct airo_info *ai = dev->ml_priv;
7847         int  ridcode;
7848         int  enabled;
7849         static int (* writer)(struct airo_info *, u16 rid, const void *, int, int);
7850         unsigned char *iobuf;
7851
7852         /* Only super-user can write RIDs */
7853         if (!capable(CAP_NET_ADMIN))
7854                 return -EPERM;
7855
7856         if (test_bit(FLAG_FLASHING, &ai->flags))
7857                 return -EIO;
7858
7859         ridcode = 0;
7860         writer = do_writerid;
7861
7862         switch(comp->command)
7863         {
7864         case AIROPSIDS:     ridcode = RID_SSID;         break;
7865         case AIROPCAP:      ridcode = RID_CAPABILITIES; break;
7866         case AIROPAPLIST:   ridcode = RID_APLIST;       break;
7867         case AIROPCFG: ai->config.len = 0;
7868                             clear_bit(FLAG_COMMIT, &ai->flags);
7869                             ridcode = RID_CONFIG;       break;
7870         case AIROPWEPKEYNV: ridcode = RID_WEP_PERM;     break;
7871         case AIROPLEAPUSR:  ridcode = RID_LEAPUSERNAME; break;
7872         case AIROPLEAPPWD:  ridcode = RID_LEAPPASSWORD; break;
7873         case AIROPWEPKEY:   ridcode = RID_WEP_TEMP; writer = PC4500_writerid;
7874                 break;
7875         case AIROPLEAPUSR+1: ridcode = 0xFF2A;          break;
7876         case AIROPLEAPUSR+2: ridcode = 0xFF2B;          break;
7877
7878                 /* this is not really a rid but a command given to the card
7879                  * same with MAC off
7880                  */
7881         case AIROPMACON:
7882                 if (enable_MAC(ai, 1) != 0)
7883                         return -EIO;
7884                 return 0;
7885
7886                 /*
7887                  * Evidently this code in the airo driver does not get a symbol
7888                  * as disable_MAC. it's probably so short the compiler does not gen one.
7889                  */
7890         case AIROPMACOFF:
7891                 disable_MAC(ai, 1);
7892                 return 0;
7893
7894                 /* This command merely clears the counts does not actually store any data
7895                  * only reads rid. But as it changes the cards state, I put it in the
7896                  * writerid routines.
7897                  */
7898         case AIROPSTCLR:
7899                 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7900                         return -ENOMEM;
7901
7902                 PC4500_readrid(ai,RID_STATSDELTACLEAR,iobuf,RIDSIZE, 1);
7903
7904                 enabled = ai->micstats.enabled;
7905                 memset(&ai->micstats,0,sizeof(ai->micstats));
7906                 ai->micstats.enabled = enabled;
7907
7908                 if (copy_to_user(comp->data, iobuf,
7909                                  min((int)comp->len, (int)RIDSIZE))) {
7910                         kfree (iobuf);
7911                         return -EFAULT;
7912                 }
7913                 kfree (iobuf);
7914                 return 0;
7915
7916         default:
7917                 return -EOPNOTSUPP;     /* Blarg! */
7918         }
7919         if(comp->len > RIDSIZE)
7920                 return -EINVAL;
7921
7922         if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7923                 return -ENOMEM;
7924
7925         if (copy_from_user(iobuf,comp->data,comp->len)) {
7926                 kfree (iobuf);
7927                 return -EFAULT;
7928         }
7929
7930         if (comp->command == AIROPCFG) {
7931                 ConfigRid *cfg = (ConfigRid *)iobuf;
7932
7933                 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags))
7934                         cfg->opmode |= MODE_MIC;
7935
7936                 if ((cfg->opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
7937                         set_bit (FLAG_ADHOC, &ai->flags);
7938                 else
7939                         clear_bit (FLAG_ADHOC, &ai->flags);
7940         }
7941
7942         if((*writer)(ai, ridcode, iobuf,comp->len,1)) {
7943                 kfree (iobuf);
7944                 return -EIO;
7945         }
7946         kfree (iobuf);
7947         return 0;
7948 }
7949
7950 /*****************************************************************************
7951  * Ancillary flash / mod functions much black magic lurkes here              *
7952  *****************************************************************************
7953  */
7954
7955 /*
7956  * Flash command switch table
7957  */
7958
7959 static int flashcard(struct net_device *dev, aironet_ioctl *comp) {
7960         int z;
7961
7962         /* Only super-user can modify flash */
7963         if (!capable(CAP_NET_ADMIN))
7964                 return -EPERM;
7965
7966         switch(comp->command)
7967         {
7968         case AIROFLSHRST:
7969                 return cmdreset((struct airo_info *)dev->ml_priv);
7970
7971         case AIROFLSHSTFL:
7972                 if (!AIRO_FLASH(dev) &&
7973                     (AIRO_FLASH(dev) = kmalloc(FLASHSIZE, GFP_KERNEL)) == NULL)
7974                         return -ENOMEM;
7975                 return setflashmode((struct airo_info *)dev->ml_priv);
7976
7977         case AIROFLSHGCHR: /* Get char from aux */
7978                 if(comp->len != sizeof(int))
7979                         return -EINVAL;
7980                 if (copy_from_user(&z,comp->data,comp->len))
7981                         return -EFAULT;
7982                 return flashgchar((struct airo_info *)dev->ml_priv, z, 8000);
7983
7984         case AIROFLSHPCHR: /* Send char to card. */
7985                 if(comp->len != sizeof(int))
7986                         return -EINVAL;
7987                 if (copy_from_user(&z,comp->data,comp->len))
7988                         return -EFAULT;
7989                 return flashpchar((struct airo_info *)dev->ml_priv, z, 8000);
7990
7991         case AIROFLPUTBUF: /* Send 32k to card */
7992                 if (!AIRO_FLASH(dev))
7993                         return -ENOMEM;
7994                 if(comp->len > FLASHSIZE)
7995                         return -EINVAL;
7996                 if (copy_from_user(AIRO_FLASH(dev), comp->data, comp->len))
7997                         return -EFAULT;
7998
7999                 flashputbuf((struct airo_info *)dev->ml_priv);
8000                 return 0;
8001
8002         case AIRORESTART:
8003                 if (flashrestart((struct airo_info *)dev->ml_priv, dev))
8004                         return -EIO;
8005                 return 0;
8006         }
8007         return -EINVAL;
8008 }
8009
8010 #define FLASH_COMMAND  0x7e7e
8011
8012 /*
8013  * STEP 1)
8014  * Disable MAC and do soft reset on
8015  * card.
8016  */
8017
8018 static int cmdreset(struct airo_info *ai) {
8019         disable_MAC(ai, 1);
8020
8021         if(!waitbusy (ai)){
8022                 airo_print_info(ai->dev->name, "Waitbusy hang before RESET");
8023                 return -EBUSY;
8024         }
8025
8026         OUT4500(ai,COMMAND,CMD_SOFTRESET);
8027
8028         ssleep(1);                      /* WAS 600 12/7/00 */
8029
8030         if(!waitbusy (ai)){
8031                 airo_print_info(ai->dev->name, "Waitbusy hang AFTER RESET");
8032                 return -EBUSY;
8033         }
8034         return 0;
8035 }
8036
8037 /* STEP 2)
8038  * Put the card in legendary flash
8039  * mode
8040  */
8041
8042 static int setflashmode (struct airo_info *ai) {
8043         set_bit (FLAG_FLASHING, &ai->flags);
8044
8045         OUT4500(ai, SWS0, FLASH_COMMAND);
8046         OUT4500(ai, SWS1, FLASH_COMMAND);
8047         if (probe) {
8048                 OUT4500(ai, SWS0, FLASH_COMMAND);
8049                 OUT4500(ai, COMMAND,0x10);
8050         } else {
8051                 OUT4500(ai, SWS2, FLASH_COMMAND);
8052                 OUT4500(ai, SWS3, FLASH_COMMAND);
8053                 OUT4500(ai, COMMAND,0);
8054         }
8055         msleep(500);            /* 500ms delay */
8056
8057         if(!waitbusy(ai)) {
8058                 clear_bit (FLAG_FLASHING, &ai->flags);
8059                 airo_print_info(ai->dev->name, "Waitbusy hang after setflash mode");
8060                 return -EIO;
8061         }
8062         return 0;
8063 }
8064
8065 /* Put character to SWS0 wait for dwelltime
8066  * x 50us for  echo .
8067  */
8068
8069 static int flashpchar(struct airo_info *ai,int byte,int dwelltime) {
8070         int echo;
8071         int waittime;
8072
8073         byte |= 0x8000;
8074
8075         if(dwelltime == 0 )
8076                 dwelltime = 200;
8077
8078         waittime=dwelltime;
8079
8080         /* Wait for busy bit d15 to go false indicating buffer empty */
8081         while ((IN4500 (ai, SWS0) & 0x8000) && waittime > 0) {
8082                 udelay (50);
8083                 waittime -= 50;
8084         }
8085
8086         /* timeout for busy clear wait */
8087         if(waittime <= 0 ){
8088                 airo_print_info(ai->dev->name, "flash putchar busywait timeout!");
8089                 return -EBUSY;
8090         }
8091
8092         /* Port is clear now write byte and wait for it to echo back */
8093         do {
8094                 OUT4500(ai,SWS0,byte);
8095                 udelay(50);
8096                 dwelltime -= 50;
8097                 echo = IN4500(ai,SWS1);
8098         } while (dwelltime >= 0 && echo != byte);
8099
8100         OUT4500(ai,SWS1,0);
8101
8102         return (echo == byte) ? 0 : -EIO;
8103 }
8104
8105 /*
8106  * Get a character from the card matching matchbyte
8107  * Step 3)
8108  */
8109 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime){
8110         int           rchar;
8111         unsigned char rbyte=0;
8112
8113         do {
8114                 rchar = IN4500(ai,SWS1);
8115
8116                 if(dwelltime && !(0x8000 & rchar)){
8117                         dwelltime -= 10;
8118                         mdelay(10);
8119                         continue;
8120                 }
8121                 rbyte = 0xff & rchar;
8122
8123                 if( (rbyte == matchbyte) && (0x8000 & rchar) ){
8124                         OUT4500(ai,SWS1,0);
8125                         return 0;
8126                 }
8127                 if( rbyte == 0x81 || rbyte == 0x82 || rbyte == 0x83 || rbyte == 0x1a || 0xffff == rchar)
8128                         break;
8129                 OUT4500(ai,SWS1,0);
8130
8131         }while(dwelltime > 0);
8132         return -EIO;
8133 }
8134
8135 /*
8136  * Transfer 32k of firmware data from user buffer to our buffer and
8137  * send to the card
8138  */
8139
8140 static int flashputbuf(struct airo_info *ai){
8141         int            nwords;
8142
8143         /* Write stuff */
8144         if (test_bit(FLAG_MPI,&ai->flags))
8145                 memcpy_toio(ai->pciaux + 0x8000, ai->flash, FLASHSIZE);
8146         else {
8147                 OUT4500(ai,AUXPAGE,0x100);
8148                 OUT4500(ai,AUXOFF,0);
8149
8150                 for(nwords=0;nwords != FLASHSIZE / 2;nwords++){
8151                         OUT4500(ai,AUXDATA,ai->flash[nwords] & 0xffff);
8152                 }
8153         }
8154         OUT4500(ai,SWS0,0x8000);
8155
8156         return 0;
8157 }
8158
8159 /*
8160  *
8161  */
8162 static int flashrestart(struct airo_info *ai,struct net_device *dev){
8163         int    i,status;
8164
8165         ssleep(1);                      /* Added 12/7/00 */
8166         clear_bit (FLAG_FLASHING, &ai->flags);
8167         if (test_bit(FLAG_MPI, &ai->flags)) {
8168                 status = mpi_init_descriptors(ai);
8169                 if (status != SUCCESS)
8170                         return status;
8171         }
8172         status = setup_card(ai, dev->dev_addr, 1);
8173
8174         if (!test_bit(FLAG_MPI,&ai->flags))
8175                 for( i = 0; i < MAX_FIDS; i++ ) {
8176                         ai->fids[i] = transmit_allocate
8177                                 ( ai, AIRO_DEF_MTU, i >= MAX_FIDS / 2 );
8178                 }
8179
8180         ssleep(1);                      /* Added 12/7/00 */
8181         return status;
8182 }
8183 #endif /* CISCO_EXT */
8184
8185 /*
8186     This program is free software; you can redistribute it and/or
8187     modify it under the terms of the GNU General Public License
8188     as published by the Free Software Foundation; either version 2
8189     of the License, or (at your option) any later version.
8190
8191     This program is distributed in the hope that it will be useful,
8192     but WITHOUT ANY WARRANTY; without even the implied warranty of
8193     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
8194     GNU General Public License for more details.
8195
8196     In addition:
8197
8198     Redistribution and use in source and binary forms, with or without
8199     modification, are permitted provided that the following conditions
8200     are met:
8201
8202     1. Redistributions of source code must retain the above copyright
8203        notice, this list of conditions and the following disclaimer.
8204     2. Redistributions in binary form must reproduce the above copyright
8205        notice, this list of conditions and the following disclaimer in the
8206        documentation and/or other materials provided with the distribution.
8207     3. The name of the author may not be used to endorse or promote
8208        products derived from this software without specific prior written
8209        permission.
8210
8211     THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
8212     IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
8213     WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
8214     ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
8215     INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
8216     (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
8217     SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
8218     HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
8219     STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
8220     IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
8221     POSSIBILITY OF SUCH DAMAGE.
8222 */
8223
8224 module_init(airo_init_module);
8225 module_exit(airo_cleanup_module);