Version:  2.0.40 2.2.26 2.4.37 3.0 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16

Linux/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] >= '' &&
4756                         buffer[*start] <= '9'; (*start)++) {
4757                 valid = 1;
4758                 value *= 10;
4759                 value += buffer[*start] - '';
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] >= '' && data->wbuffer[0] <= '3' &&
5261             (data->wbuffer[1] == ' ' || data->wbuffer[1] == '\n')) {
5262                 index = data->wbuffer[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-><