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