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