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