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