]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - drivers/net/wireless/airo.c
projects / mirror_ubuntu-bionic-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net-2.6
[mirror_ubuntu-bionic-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 1;
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 1;
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 return -ENETDOWN;
2197 }
2198
2199 if ( skb == NULL ) {
2200 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2201 return 0;
2202 }
2203
2204 /* Find a vacant FID */
2205 for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2206 for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2207
2208 if ( j >= MAX_FIDS ) {
2209 netif_stop_queue(dev);
2210
2211 if (i == MAX_FIDS) {
2212 dev->stats.tx_fifo_errors++;
2213 return 1;
2214 }
2215 }
2216 /* check min length*/
2217 len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2218 /* Mark fid as used & save length for later */
2219 fids[i] |= (len << 16);
2220 priv->xmit11.skb = skb;
2221 priv->xmit11.fid = i;
2222 if (down_trylock(&priv->sem) != 0) {
2223 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2224 netif_stop_queue(dev);
2225 set_bit(JOB_XMIT11, &priv->jobs);
2226 wake_up_interruptible(&priv->thr_wait);
2227 } else
2228 airo_end_xmit11(dev);
2229 return 0;
2230 }
2231
2232 static void airo_read_stats(struct net_device *dev)
2233 {
2234 struct airo_info *ai = dev->ml_priv;
2235 StatsRid stats_rid;
2236 __le32 *vals = stats_rid.vals;
2237
2238 clear_bit(JOB_STATS, &ai->jobs);
2239 if (ai->power.event) {
2240 up(&ai->sem);
2241 return;
2242 }
2243 readStatsRid(ai, &stats_rid, RID_STATS, 0);
2244 up(&ai->sem);
2245
2246 dev->stats.rx_packets = le32_to_cpu(vals[43]) + le32_to_cpu(vals[44]) +
2247 le32_to_cpu(vals[45]);
2248 dev->stats.tx_packets = le32_to_cpu(vals[39]) + le32_to_cpu(vals[40]) +
2249 le32_to_cpu(vals[41]);
2250 dev->stats.rx_bytes = le32_to_cpu(vals[92]);
2251 dev->stats.tx_bytes = le32_to_cpu(vals[91]);
2252 dev->stats.rx_errors = le32_to_cpu(vals[0]) + le32_to_cpu(vals[2]) +
2253 le32_to_cpu(vals[3]) + le32_to_cpu(vals[4]);
2254 dev->stats.tx_errors = le32_to_cpu(vals[42]) +
2255 dev->stats.tx_fifo_errors;
2256 dev->stats.multicast = le32_to_cpu(vals[43]);
2257 dev->stats.collisions = le32_to_cpu(vals[89]);
2258
2259 /* detailed rx_errors: */
2260 dev->stats.rx_length_errors = le32_to_cpu(vals[3]);
2261 dev->stats.rx_crc_errors = le32_to_cpu(vals[4]);
2262 dev->stats.rx_frame_errors = le32_to_cpu(vals[2]);
2263 dev->stats.rx_fifo_errors = le32_to_cpu(vals[0]);
2264 }
2265
2266 static struct net_device_stats *airo_get_stats(struct net_device *dev)
2267 {
2268 struct airo_info *local = dev->ml_priv;
2269
2270 if (!test_bit(JOB_STATS, &local->jobs)) {
2271 /* Get stats out of the card if available */
2272 if (down_trylock(&local->sem) != 0) {
2273 set_bit(JOB_STATS, &local->jobs);
2274 wake_up_interruptible(&local->thr_wait);
2275 } else
2276 airo_read_stats(dev);
2277 }
2278
2279 return &dev->stats;
2280 }
2281
2282 static void airo_set_promisc(struct airo_info *ai) {
2283 Cmd cmd;
2284 Resp rsp;
2285
2286 memset(&cmd, 0, sizeof(cmd));
2287 cmd.cmd=CMD_SETMODE;
2288 clear_bit(JOB_PROMISC, &ai->jobs);
2289 cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2290 issuecommand(ai, &cmd, &rsp);
2291 up(&ai->sem);
2292 }
2293
2294 static void airo_set_multicast_list(struct net_device *dev) {
2295 struct airo_info *ai = dev->ml_priv;
2296
2297 if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2298 change_bit(FLAG_PROMISC, &ai->flags);
2299 if (down_trylock(&ai->sem) != 0) {
2300 set_bit(JOB_PROMISC, &ai->jobs);
2301 wake_up_interruptible(&ai->thr_wait);
2302 } else
2303 airo_set_promisc(ai);
2304 }
2305
2306 if ((dev->flags&IFF_ALLMULTI)||dev->mc_count>0) {
2307 /* Turn on multicast. (Should be already setup...) */
2308 }
2309 }
2310
2311 static int airo_set_mac_address(struct net_device *dev, void *p)
2312 {
2313 struct airo_info *ai = dev->ml_priv;
2314 struct sockaddr *addr = p;
2315
2316 readConfigRid(ai, 1);
2317 memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2318 set_bit (FLAG_COMMIT, &ai->flags);
2319 disable_MAC(ai, 1);
2320 writeConfigRid (ai, 1);
2321 enable_MAC(ai, 1);
2322 memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2323 if (ai->wifidev)
2324 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2325 return 0;
2326 }
2327
2328 static int airo_change_mtu(struct net_device *dev, int new_mtu)
2329 {
2330 if ((new_mtu < 68) || (new_mtu > 2400))
2331 return -EINVAL;
2332 dev->mtu = new_mtu;
2333 return 0;
2334 }
2335
2336 static LIST_HEAD(airo_devices);
2337
2338 static void add_airo_dev(struct airo_info *ai)
2339 {
2340 /* Upper layers already keep track of PCI devices,
2341 * so we only need to remember our non-PCI cards. */
2342 if (!ai->pci)
2343 list_add_tail(&ai->dev_list, &airo_devices);
2344 }
2345
2346 static void del_airo_dev(struct airo_info *ai)
2347 {
2348 if (!ai->pci)
2349 list_del(&ai->dev_list);
2350 }
2351
2352 static int airo_close(struct net_device *dev) {
2353 struct airo_info *ai = dev->ml_priv;
2354
2355 netif_stop_queue(dev);
2356
2357 if (ai->wifidev != dev) {
2358 #ifdef POWER_ON_DOWN
2359 /* Shut power to the card. The idea is that the user can save
2360 * power when he doesn't need the card with "ifconfig down".
2361 * That's the method that is most friendly towards the network
2362 * stack (i.e. the network stack won't try to broadcast
2363 * anything on the interface and routes are gone. Jean II */
2364 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2365 disable_MAC(ai, 1);
2366 #endif
2367 disable_interrupts( ai );
2368
2369 free_irq(dev->irq, dev);
2370
2371 set_bit(JOB_DIE, &ai->jobs);
2372 kthread_stop(ai->airo_thread_task);
2373 }
2374 return 0;
2375 }
2376
2377 void stop_airo_card( struct net_device *dev, int freeres )
2378 {
2379 struct airo_info *ai = dev->ml_priv;
2380
2381 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2382 disable_MAC(ai, 1);
2383 disable_interrupts(ai);
2384 takedown_proc_entry( dev, ai );
2385 if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2386 unregister_netdev( dev );
2387 if (ai->wifidev) {
2388 unregister_netdev(ai->wifidev);
2389 free_netdev(ai->wifidev);
2390 ai->wifidev = NULL;
2391 }
2392 clear_bit(FLAG_REGISTERED, &ai->flags);
2393 }
2394 /*
2395 * Clean out tx queue
2396 */
2397 if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
2398 struct sk_buff *skb = NULL;
2399 for (;(skb = skb_dequeue(&ai->txq));)
2400 dev_kfree_skb(skb);
2401 }
2402
2403 airo_networks_free (ai);
2404
2405 kfree(ai->flash);
2406 kfree(ai->rssi);
2407 kfree(ai->APList);
2408 kfree(ai->SSID);
2409 if (freeres) {
2410 /* PCMCIA frees this stuff, so only for PCI and ISA */
2411 release_region( dev->base_addr, 64 );
2412 if (test_bit(FLAG_MPI, &ai->flags)) {
2413 if (ai->pci)
2414 mpi_unmap_card(ai->pci);
2415 if (ai->pcimem)
2416 iounmap(ai->pcimem);
2417 if (ai->pciaux)
2418 iounmap(ai->pciaux);
2419 pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2420 ai->shared, ai->shared_dma);
2421 }
2422 }
2423 crypto_free_cipher(ai->tfm);
2424 del_airo_dev(ai);
2425 free_netdev( dev );
2426 }
2427
2428 EXPORT_SYMBOL(stop_airo_card);
2429
2430 static int wll_header_parse(const struct sk_buff *skb, unsigned char *haddr)
2431 {
2432 memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
2433 return ETH_ALEN;
2434 }
2435
2436 static void mpi_unmap_card(struct pci_dev *pci)
2437 {
2438 unsigned long mem_start = pci_resource_start(pci, 1);
2439 unsigned long mem_len = pci_resource_len(pci, 1);
2440 unsigned long aux_start = pci_resource_start(pci, 2);
2441 unsigned long aux_len = AUXMEMSIZE;
2442
2443 release_mem_region(aux_start, aux_len);
2444 release_mem_region(mem_start, mem_len);
2445 }
2446
2447 /*************************************************************
2448 * This routine assumes that descriptors have been setup .
2449 * Run at insmod time or after reset when the decriptors
2450 * have been initialized . Returns 0 if all is well nz
2451 * otherwise . Does not allocate memory but sets up card
2452 * using previously allocated descriptors.
2453 */
2454 static int mpi_init_descriptors (struct airo_info *ai)
2455 {
2456 Cmd cmd;
2457 Resp rsp;
2458 int i;
2459 int rc = SUCCESS;
2460
2461 /* Alloc card RX descriptors */
2462 netif_stop_queue(ai->dev);
2463
2464 memset(&rsp,0,sizeof(rsp));
2465 memset(&cmd,0,sizeof(cmd));
2466
2467 cmd.cmd = CMD_ALLOCATEAUX;
2468 cmd.parm0 = FID_RX;
2469 cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2470 cmd.parm2 = MPI_MAX_FIDS;
2471 rc=issuecommand(ai, &cmd, &rsp);
2472 if (rc != SUCCESS) {
2473 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
2474 return rc;
2475 }
2476
2477 for (i=0; i<MPI_MAX_FIDS; i++) {
2478 memcpy_toio(ai->rxfids[i].card_ram_off,
2479 &ai->rxfids[i].rx_desc, sizeof(RxFid));
2480 }
2481
2482 /* Alloc card TX descriptors */
2483
2484 memset(&rsp,0,sizeof(rsp));
2485 memset(&cmd,0,sizeof(cmd));
2486
2487 cmd.cmd = CMD_ALLOCATEAUX;
2488 cmd.parm0 = FID_TX;
2489 cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2490 cmd.parm2 = MPI_MAX_FIDS;
2491
2492 for (i=0; i<MPI_MAX_FIDS; i++) {
2493 ai->txfids[i].tx_desc.valid = 1;
2494 memcpy_toio(ai->txfids[i].card_ram_off,
2495 &ai->txfids[i].tx_desc, sizeof(TxFid));
2496 }
2497 ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2498
2499 rc=issuecommand(ai, &cmd, &rsp);
2500 if (rc != SUCCESS) {
2501 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
2502 return rc;
2503 }
2504
2505 /* Alloc card Rid descriptor */
2506 memset(&rsp,0,sizeof(rsp));
2507 memset(&cmd,0,sizeof(cmd));
2508
2509 cmd.cmd = CMD_ALLOCATEAUX;
2510 cmd.parm0 = RID_RW;
2511 cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2512 cmd.parm2 = 1; /* Magic number... */
2513 rc=issuecommand(ai, &cmd, &rsp);
2514 if (rc != SUCCESS) {
2515 airo_print_err(ai->dev->name, "Couldn't allocate RID");
2516 return rc;
2517 }
2518
2519 memcpy_toio(ai->config_desc.card_ram_off,
2520 &ai->config_desc.rid_desc, sizeof(Rid));
2521
2522 return rc;
2523 }
2524
2525 /*
2526 * We are setting up three things here:
2527 * 1) Map AUX memory for descriptors: Rid, TxFid, or RxFid.
2528 * 2) Map PCI memory for issueing commands.
2529 * 3) Allocate memory (shared) to send and receive ethernet frames.
2530 */
2531 static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci)
2532 {
2533 unsigned long mem_start, mem_len, aux_start, aux_len;
2534 int rc = -1;
2535 int i;
2536 dma_addr_t busaddroff;
2537 unsigned char *vpackoff;
2538 unsigned char __iomem *pciaddroff;
2539
2540 mem_start = pci_resource_start(pci, 1);
2541 mem_len = pci_resource_len(pci, 1);
2542 aux_start = pci_resource_start(pci, 2);
2543 aux_len = AUXMEMSIZE;
2544
2545 if (!request_mem_region(mem_start, mem_len, DRV_NAME)) {
2546 airo_print_err("", "Couldn't get region %x[%x]",
2547 (int)mem_start, (int)mem_len);
2548 goto out;
2549 }
2550 if (!request_mem_region(aux_start, aux_len, DRV_NAME)) {
2551 airo_print_err("", "Couldn't get region %x[%x]",
2552 (int)aux_start, (int)aux_len);
2553 goto free_region1;
2554 }
2555
2556 ai->pcimem = ioremap(mem_start, mem_len);
2557 if (!ai->pcimem) {
2558 airo_print_err("", "Couldn't map region %x[%x]",
2559 (int)mem_start, (int)mem_len);
2560 goto free_region2;
2561 }
2562 ai->pciaux = ioremap(aux_start, aux_len);
2563 if (!ai->pciaux) {
2564 airo_print_err("", "Couldn't map region %x[%x]",
2565 (int)aux_start, (int)aux_len);
2566 goto free_memmap;
2567 }
2568
2569 /* Reserve PKTSIZE for each fid and 2K for the Rids */
2570 ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2571 if (!ai->shared) {
2572 airo_print_err("", "Couldn't alloc_consistent %d",
2573 PCI_SHARED_LEN);
2574 goto free_auxmap;
2575 }
2576
2577 /*
2578 * Setup descriptor RX, TX, CONFIG
2579 */
2580 busaddroff = ai->shared_dma;
2581 pciaddroff = ai->pciaux + AUX_OFFSET;
2582 vpackoff = ai->shared;
2583
2584 /* RX descriptor setup */
2585 for(i = 0; i < MPI_MAX_FIDS; i++) {
2586 ai->rxfids[i].pending = 0;
2587 ai->rxfids[i].card_ram_off = pciaddroff;
2588 ai->rxfids[i].virtual_host_addr = vpackoff;
2589 ai->rxfids[i].rx_desc.host_addr = busaddroff;
2590 ai->rxfids[i].rx_desc.valid = 1;
2591 ai->rxfids[i].rx_desc.len = PKTSIZE;
2592 ai->rxfids[i].rx_desc.rdy = 0;
2593
2594 pciaddroff += sizeof(RxFid);
2595 busaddroff += PKTSIZE;
2596 vpackoff += PKTSIZE;
2597 }
2598
2599 /* TX descriptor setup */
2600 for(i = 0; i < MPI_MAX_FIDS; i++) {
2601 ai->txfids[i].card_ram_off = pciaddroff;
2602 ai->txfids[i].virtual_host_addr = vpackoff;
2603 ai->txfids[i].tx_desc.valid = 1;
2604 ai->txfids[i].tx_desc.host_addr = busaddroff;
2605 memcpy(ai->txfids[i].virtual_host_addr,
2606 &wifictlhdr8023, sizeof(wifictlhdr8023));
2607
2608 pciaddroff += sizeof(TxFid);
2609 busaddroff += PKTSIZE;
2610 vpackoff += PKTSIZE;
2611 }
2612 ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2613
2614 /* Rid descriptor setup */
2615 ai->config_desc.card_ram_off = pciaddroff;
2616 ai->config_desc.virtual_host_addr = vpackoff;
2617 ai->config_desc.rid_desc.host_addr = busaddroff;
2618 ai->ridbus = busaddroff;
2619 ai->config_desc.rid_desc.rid = 0;
2620 ai->config_desc.rid_desc.len = RIDSIZE;
2621 ai->config_desc.rid_desc.valid = 1;
2622 pciaddroff += sizeof(Rid);
2623 busaddroff += RIDSIZE;
2624 vpackoff += RIDSIZE;
2625
2626 /* Tell card about descriptors */
2627 if (mpi_init_descriptors (ai) != SUCCESS)
2628 goto free_shared;
2629
2630 return 0;
2631 free_shared:
2632 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2633 free_auxmap:
2634 iounmap(ai->pciaux);
2635 free_memmap:
2636 iounmap(ai->pcimem);
2637 free_region2:
2638 release_mem_region(aux_start, aux_len);
2639 free_region1:
2640 release_mem_region(mem_start, mem_len);
2641 out:
2642 return rc;
2643 }
2644
2645 static const struct header_ops airo_header_ops = {
2646 .parse = wll_header_parse,
2647 };
2648
2649 static const struct net_device_ops airo11_netdev_ops = {
2650 .ndo_open = airo_open,
2651 .ndo_stop = airo_close,
2652 .ndo_start_xmit = airo_start_xmit11,
2653 .ndo_get_stats = airo_get_stats,
2654 .ndo_set_mac_address = airo_set_mac_address,
2655 .ndo_do_ioctl = airo_ioctl,
2656 .ndo_change_mtu = airo_change_mtu,
2657 };
2658
2659 static void wifi_setup(struct net_device *dev)
2660 {
2661 dev->netdev_ops = &airo11_netdev_ops;
2662 dev->header_ops = &airo_header_ops;
2663 dev->wireless_handlers = &airo_handler_def;
2664
2665 dev->type = ARPHRD_IEEE80211;
2666 dev->hard_header_len = ETH_HLEN;
2667 dev->mtu = AIRO_DEF_MTU;
2668 dev->addr_len = ETH_ALEN;
2669 dev->tx_queue_len = 100;
2670
2671 memset(dev->broadcast,0xFF, ETH_ALEN);
2672
2673 dev->flags = IFF_BROADCAST|IFF_MULTICAST;
2674 }
2675
2676 static struct net_device *init_wifidev(struct airo_info *ai,
2677 struct net_device *ethdev)
2678 {
2679 int err;
2680 struct net_device *dev = alloc_netdev(0, "wifi%d", wifi_setup);
2681 if (!dev)
2682 return NULL;
2683 dev->ml_priv = ethdev->ml_priv;
2684 dev->irq = ethdev->irq;
2685 dev->base_addr = ethdev->base_addr;
2686 dev->wireless_data = ethdev->wireless_data;
2687 SET_NETDEV_DEV(dev, ethdev->dev.parent);
2688 memcpy(dev->dev_addr, ethdev->dev_addr, dev->addr_len);
2689 err = register_netdev(dev);
2690 if (err<0) {
2691 free_netdev(dev);
2692 return NULL;
2693 }
2694 return dev;
2695 }
2696
2697 static int reset_card( struct net_device *dev , int lock) {
2698 struct airo_info *ai = dev->ml_priv;
2699
2700 if (lock && down_interruptible(&ai->sem))
2701 return -1;
2702 waitbusy (ai);
2703 OUT4500(ai,COMMAND,CMD_SOFTRESET);
2704 msleep(200);
2705 waitbusy (ai);
2706 msleep(200);
2707 if (lock)
2708 up(&ai->sem);
2709 return 0;
2710 }
2711
2712 #define AIRO_MAX_NETWORK_COUNT 64
2713 static int airo_networks_allocate(struct airo_info *ai)
2714 {
2715 if (ai->networks)
2716 return 0;
2717
2718 ai->networks =
2719 kzalloc(AIRO_MAX_NETWORK_COUNT * sizeof(BSSListElement),
2720 GFP_KERNEL);
2721 if (!ai->networks) {
2722 airo_print_warn("", "Out of memory allocating beacons");
2723 return -ENOMEM;
2724 }
2725
2726 return 0;
2727 }
2728
2729 static void airo_networks_free(struct airo_info *ai)
2730 {
2731 kfree(ai->networks);
2732 ai->networks = NULL;
2733 }
2734
2735 static void airo_networks_initialize(struct airo_info *ai)
2736 {
2737 int i;
2738
2739 INIT_LIST_HEAD(&ai->network_free_list);
2740 INIT_LIST_HEAD(&ai->network_list);
2741 for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
2742 list_add_tail(&ai->networks[i].list,
2743 &ai->network_free_list);
2744 }
2745
2746 static const struct net_device_ops airo_netdev_ops = {
2747 .ndo_open = airo_open,
2748 .ndo_stop = airo_close,
2749 .ndo_start_xmit = airo_start_xmit,
2750 .ndo_get_stats = airo_get_stats,
2751 .ndo_set_multicast_list = airo_set_multicast_list,
2752 .ndo_set_mac_address = airo_set_mac_address,
2753 .ndo_do_ioctl = airo_ioctl,
2754 .ndo_change_mtu = airo_change_mtu,
2755 .ndo_validate_addr = eth_validate_addr,
2756 };
2757
2758 static const struct net_device_ops mpi_netdev_ops = {
2759 .ndo_open = airo_open,
2760 .ndo_stop = airo_close,
2761 .ndo_start_xmit = mpi_start_xmit,
2762 .ndo_get_stats = airo_get_stats,
2763 .ndo_set_multicast_list = airo_set_multicast_list,
2764 .ndo_set_mac_address = airo_set_mac_address,
2765 .ndo_do_ioctl = airo_ioctl,
2766 .ndo_change_mtu = airo_change_mtu,
2767 .ndo_validate_addr = eth_validate_addr,
2768 };
2769
2770
2771 static struct net_device *_init_airo_card( unsigned short irq, int port,
2772 int is_pcmcia, struct pci_dev *pci,
2773 struct device *dmdev )
2774 {
2775 struct net_device *dev;
2776 struct airo_info *ai;
2777 int i, rc;
2778 CapabilityRid cap_rid;
2779
2780 /* Create the network device object. */
2781 dev = alloc_netdev(sizeof(*ai), "", ether_setup);
2782 if (!dev) {
2783 airo_print_err("", "Couldn't alloc_etherdev");
2784 return NULL;
2785 }
2786
2787 ai = dev->ml_priv = netdev_priv(dev);
2788 ai->wifidev = NULL;
2789 ai->flags = 1 << FLAG_RADIO_DOWN;
2790 ai->jobs = 0;
2791 ai->dev = dev;
2792 if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
2793 airo_print_dbg("", "Found an MPI350 card");
2794 set_bit(FLAG_MPI, &ai->flags);
2795 }
2796 spin_lock_init(&ai->aux_lock);
2797 sema_init(&ai->sem, 1);
2798 ai->config.len = 0;
2799 ai->pci = pci;
2800 init_waitqueue_head (&ai->thr_wait);
2801 ai->tfm = NULL;
2802 add_airo_dev(ai);
2803
2804 if (airo_networks_allocate (ai))
2805 goto err_out_free;
2806 airo_networks_initialize (ai);
2807
2808 skb_queue_head_init (&ai->txq);
2809
2810 /* The Airo-specific entries in the device structure. */
2811 if (test_bit(FLAG_MPI,&ai->flags))
2812 dev->netdev_ops = &mpi_netdev_ops;
2813 else
2814 dev->netdev_ops = &airo_netdev_ops;
2815 dev->wireless_handlers = &airo_handler_def;
2816 ai->wireless_data.spy_data = &ai->spy_data;
2817 dev->wireless_data = &ai->wireless_data;
2818 dev->irq = irq;
2819 dev->base_addr = port;
2820
2821 SET_NETDEV_DEV(dev, dmdev);
2822
2823 reset_card (dev, 1);
2824 msleep(400);
2825
2826 if (!is_pcmcia) {
2827 if (!request_region(dev->base_addr, 64, DRV_NAME)) {
2828 rc = -EBUSY;
2829 airo_print_err(dev->name, "Couldn't request region");
2830 goto err_out_nets;
2831 }
2832 }
2833
2834 if (test_bit(FLAG_MPI,&ai->flags)) {
2835 if (mpi_map_card(ai, pci)) {
2836 airo_print_err("", "Could not map memory");
2837 goto err_out_res;
2838 }
2839 }
2840
2841 if (probe) {
2842 if (setup_card(ai, dev->dev_addr, 1) != SUCCESS) {
2843 airo_print_err(dev->name, "MAC could not be enabled" );
2844 rc = -EIO;
2845 goto err_out_map;
2846 }
2847 } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2848 ai->bap_read = fast_bap_read;
2849 set_bit(FLAG_FLASHING, &ai->flags);
2850 }
2851
2852 strcpy(dev->name, "eth%d");
2853 rc = register_netdev(dev);
2854 if (rc) {
2855 airo_print_err(dev->name, "Couldn't register_netdev");
2856 goto err_out_map;
2857 }
2858 ai->wifidev = init_wifidev(ai, dev);
2859 if (!ai->wifidev)
2860 goto err_out_reg;
2861
2862 rc = readCapabilityRid(ai, &cap_rid, 1);
2863 if (rc != SUCCESS) {
2864 rc = -EIO;
2865 goto err_out_wifi;
2866 }
2867 /* WEP capability discovery */
2868 ai->wep_capable = (cap_rid.softCap & cpu_to_le16(0x02)) ? 1 : 0;
2869 ai->max_wep_idx = (cap_rid.softCap & cpu_to_le16(0x80)) ? 3 : 0;
2870
2871 airo_print_info(dev->name, "Firmware version %x.%x.%02x",
2872 ((le16_to_cpu(cap_rid.softVer) >> 8) & 0xF),
2873 (le16_to_cpu(cap_rid.softVer) & 0xFF),
2874 le16_to_cpu(cap_rid.softSubVer));
2875
2876 /* Test for WPA support */
2877 /* Only firmware versions 5.30.17 or better can do WPA */
2878 if (le16_to_cpu(cap_rid.softVer) > 0x530
2879 || (le16_to_cpu(cap_rid.softVer) == 0x530
2880 && le16_to_cpu(cap_rid.softSubVer) >= 17)) {
2881 airo_print_info(ai->dev->name, "WPA supported.");
2882
2883 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2884 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2885 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2886 ai->bssListRidLen = sizeof(BSSListRid);
2887 } else {
2888 airo_print_info(ai->dev->name, "WPA unsupported with firmware "
2889 "versions older than 5.30.17.");
2890
2891 ai->bssListFirst = RID_BSSLISTFIRST;
2892 ai->bssListNext = RID_BSSLISTNEXT;
2893 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2894 }
2895
2896 set_bit(FLAG_REGISTERED,&ai->flags);
2897 airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2898
2899 /* Allocate the transmit buffers */
2900 if (probe && !test_bit(FLAG_MPI,&ai->flags))
2901 for( i = 0; i < MAX_FIDS; i++ )
2902 ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2903
2904 if (setup_proc_entry(dev, dev->ml_priv) < 0)
2905 goto err_out_wifi;
2906
2907 return dev;
2908
2909 err_out_wifi:
2910 unregister_netdev(ai->wifidev);
2911 free_netdev(ai->wifidev);
2912 err_out_reg:
2913 unregister_netdev(dev);
2914 err_out_map:
2915 if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2916 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2917 iounmap(ai->pciaux);
2918 iounmap(ai->pcimem);
2919 mpi_unmap_card(ai->pci);
2920 }
2921 err_out_res:
2922 if (!is_pcmcia)
2923 release_region( dev->base_addr, 64 );
2924 err_out_nets:
2925 airo_networks_free(ai);
2926 del_airo_dev(ai);
2927 err_out_free:
2928 free_netdev(dev);
2929 return NULL;
2930 }
2931
2932 struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2933 struct device *dmdev)
2934 {
2935 return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2936 }
2937
2938 EXPORT_SYMBOL(init_airo_card);
2939
2940 static int waitbusy (struct airo_info *ai) {
2941 int delay = 0;
2942 while ((IN4500(ai, COMMAND) & COMMAND_BUSY) && (delay < 10000)) {
2943 udelay (10);
2944 if ((++delay % 20) == 0)
2945 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2946 }
2947 return delay < 10000;
2948 }
2949
2950 int reset_airo_card( struct net_device *dev )
2951 {
2952 int i;
2953 struct airo_info *ai = dev->ml_priv;
2954
2955 if (reset_card (dev, 1))
2956 return -1;
2957
2958 if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
2959 airo_print_err(dev->name, "MAC could not be enabled");
2960 return -1;
2961 }
2962 airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2963 /* Allocate the transmit buffers if needed */
2964 if (!test_bit(FLAG_MPI,&ai->flags))
2965 for( i = 0; i < MAX_FIDS; i++ )
2966 ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2967
2968 enable_interrupts( ai );
2969 netif_wake_queue(dev);
2970 return 0;
2971 }
2972
2973 EXPORT_SYMBOL(reset_airo_card);
2974
2975 static void airo_send_event(struct net_device *dev) {
2976 struct airo_info *ai = dev->ml_priv;
2977 union iwreq_data wrqu;
2978 StatusRid status_rid;
2979
2980 clear_bit(JOB_EVENT, &ai->jobs);
2981 PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
2982 up(&ai->sem);
2983 wrqu.data.length = 0;
2984 wrqu.data.flags = 0;
2985 memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
2986 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
2987
2988 /* Send event to user space */
2989 wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
2990 }
2991
2992 static void airo_process_scan_results (struct airo_info *ai) {
2993 union iwreq_data wrqu;
2994 BSSListRid bss;
2995 int rc;
2996 BSSListElement * loop_net;
2997 BSSListElement * tmp_net;
2998
2999 /* Blow away current list of scan results */
3000 list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
3001 list_move_tail (&loop_net->list, &ai->network_free_list);
3002 /* Don't blow away ->list, just BSS data */
3003 memset (loop_net, 0, sizeof (loop_net->bss));
3004 }
3005
3006 /* Try to read the first entry of the scan result */
3007 rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
3008 if((rc) || (bss.index == cpu_to_le16(0xffff))) {
3009 /* No scan results */
3010 goto out;
3011 }
3012
3013 /* Read and parse all entries */
3014 tmp_net = NULL;
3015 while((!rc) && (bss.index != cpu_to_le16(0xffff))) {
3016 /* Grab a network off the free list */
3017 if (!list_empty(&ai->network_free_list)) {
3018 tmp_net = list_entry(ai->network_free_list.next,
3019 BSSListElement, list);
3020 list_del(ai->network_free_list.next);
3021 }
3022
3023 if (tmp_net != NULL) {
3024 memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
3025 list_add_tail(&tmp_net->list, &ai->network_list);
3026 tmp_net = NULL;
3027 }
3028
3029 /* Read next entry */
3030 rc = PC4500_readrid(ai, ai->bssListNext,
3031 &bss, ai->bssListRidLen, 0);
3032 }
3033
3034 out:
3035 ai->scan_timeout = 0;
3036 clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
3037 up(&ai->sem);
3038
3039 /* Send an empty event to user space.
3040 * We don't send the received data on
3041 * the event because it would require
3042 * us to do complex transcoding, and
3043 * we want to minimise the work done in
3044 * the irq handler. Use a request to
3045 * extract the data - Jean II */
3046 wrqu.data.length = 0;
3047 wrqu.data.flags = 0;
3048 wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3049 }
3050
3051 static int airo_thread(void *data) {
3052 struct net_device *dev = data;
3053 struct airo_info *ai = dev->ml_priv;
3054 int locked;
3055
3056 set_freezable();
3057 while(1) {
3058 /* make swsusp happy with our thread */
3059 try_to_freeze();
3060
3061 if (test_bit(JOB_DIE, &ai->jobs))
3062 break;
3063
3064 if (ai->jobs) {
3065 locked = down_interruptible(&ai->sem);
3066 } else {
3067 wait_queue_t wait;
3068
3069 init_waitqueue_entry(&wait, current);
3070 add_wait_queue(&ai->thr_wait, &wait);
3071 for (;;) {
3072 set_current_state(TASK_INTERRUPTIBLE);
3073 if (ai->jobs)
3074 break;
3075 if (ai->expires || ai->scan_timeout) {
3076 if (ai->scan_timeout &&
3077 time_after_eq(jiffies,ai->scan_timeout)){
3078 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
3079 break;
3080 } else if (ai->expires &&
3081 time_after_eq(jiffies,ai->expires)){
3082 set_bit(JOB_AUTOWEP, &ai->jobs);
3083 break;
3084 }
3085 if (!kthread_should_stop() &&
3086 !freezing(current)) {
3087 unsigned long wake_at;
3088 if (!ai->expires || !ai->scan_timeout) {
3089 wake_at = max(ai->expires,
3090 ai->scan_timeout);
3091 } else {
3092 wake_at = min(ai->expires,
3093 ai->scan_timeout);
3094 }
3095 schedule_timeout(wake_at - jiffies);
3096 continue;
3097 }
3098 } else if (!kthread_should_stop() &&
3099 !freezing(current)) {
3100 schedule();
3101 continue;
3102 }
3103 break;
3104 }
3105 current->state = TASK_RUNNING;
3106 remove_wait_queue(&ai->thr_wait, &wait);
3107 locked = 1;
3108 }
3109
3110 if (locked)
3111 continue;
3112
3113 if (test_bit(JOB_DIE, &ai->jobs)) {
3114 up(&ai->sem);
3115 break;
3116 }
3117
3118 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
3119 up(&ai->sem);
3120 continue;
3121 }
3122
3123 if (test_bit(JOB_XMIT, &ai->jobs))
3124 airo_end_xmit(dev);
3125 else if (test_bit(JOB_XMIT11, &ai->jobs))
3126 airo_end_xmit11(dev);
3127 else if (test_bit(JOB_STATS, &ai->jobs))
3128 airo_read_stats(dev);
3129 else if (test_bit(JOB_WSTATS, &ai->jobs))
3130 airo_read_wireless_stats(ai);
3131 else if (test_bit(JOB_PROMISC, &ai->jobs))
3132 airo_set_promisc(ai);
3133 else if (test_bit(JOB_MIC, &ai->jobs))
3134 micinit(ai);
3135 else if (test_bit(JOB_EVENT, &ai->jobs))
3136 airo_send_event(dev);
3137 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
3138 timer_func(dev);
3139 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
3140 airo_process_scan_results(ai);
3141 else /* Shouldn't get here, but we make sure to unlock */
3142 up(&ai->sem);
3143 }
3144
3145 return 0;
3146 }
3147
3148 static int header_len(__le16 ctl)
3149 {
3150 u16 fc = le16_to_cpu(ctl);
3151 switch (fc & 0xc) {
3152 case 4:
3153 if ((fc & 0xe0) == 0xc0)
3154 return 10; /* one-address control packet */
3155 return 16; /* two-address control packet */
3156 case 8:
3157 if ((fc & 0x300) == 0x300)
3158 return 30; /* WDS packet */
3159 }
3160 return 24;
3161 }
3162
3163 static void airo_handle_cisco_mic(struct airo_info *ai)
3164 {
3165 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags)) {
3166 set_bit(JOB_MIC, &ai->jobs);
3167 wake_up_interruptible(&ai->thr_wait);
3168 }
3169 }
3170
3171 /* Airo Status codes */
3172 #define STAT_NOBEACON 0x8000 /* Loss of sync - missed beacons */
3173 #define STAT_MAXRETRIES 0x8001 /* Loss of sync - max retries */
3174 #define STAT_MAXARL 0x8002 /* Loss of sync - average retry level exceeded*/
3175 #define STAT_FORCELOSS 0x8003 /* Loss of sync - host request */
3176 #define STAT_TSFSYNC 0x8004 /* Loss of sync - TSF synchronization */
3177 #define STAT_DEAUTH 0x8100 /* low byte is 802.11 reason code */
3178 #define STAT_DISASSOC 0x8200 /* low byte is 802.11 reason code */
3179 #define STAT_ASSOC_FAIL 0x8400 /* low byte is 802.11 reason code */
3180 #define STAT_AUTH_FAIL 0x0300 /* low byte is 802.11 reason code */
3181 #define STAT_ASSOC 0x0400 /* Associated */
3182 #define STAT_REASSOC 0x0600 /* Reassociated? Only on firmware >= 5.30.17 */
3183
3184 static void airo_print_status(const char *devname, u16 status)
3185 {
3186 u8 reason = status & 0xFF;
3187
3188 switch (status) {
3189 case STAT_NOBEACON:
3190 airo_print_dbg(devname, "link lost (missed beacons)");
3191 break;
3192 case STAT_MAXRETRIES:
3193 case STAT_MAXARL:
3194 airo_print_dbg(devname, "link lost (max retries)");
3195 break;
3196 case STAT_FORCELOSS:
3197 airo_print_dbg(devname, "link lost (local choice)");
3198 break;
3199 case STAT_TSFSYNC:
3200 airo_print_dbg(devname, "link lost (TSF sync lost)");
3201 break;
3202 case STAT_DEAUTH:
3203 airo_print_dbg(devname, "deauthenticated (reason: %d)", reason);
3204 break;
3205 case STAT_DISASSOC:
3206 airo_print_dbg(devname, "disassociated (reason: %d)", reason);
3207 break;
3208 case STAT_ASSOC_FAIL:
3209 airo_print_dbg(devname, "association failed (reason: %d)",
3210 reason);
3211 break;
3212 case STAT_AUTH_FAIL:
3213 airo_print_dbg(devname, "authentication failed (reason: %d)",
3214 reason);
3215 break;
3216 default:
3217 break;
3218 }
3219 }
3220
3221 static void airo_handle_link(struct airo_info *ai)
3222 {
3223 union iwreq_data wrqu;
3224 int scan_forceloss = 0;
3225 u16 status;
3226
3227 /* Get new status and acknowledge the link change */
3228 status = le16_to_cpu(IN4500(ai, LINKSTAT));
3229 OUT4500(ai, EVACK, EV_LINK);
3230
3231 if ((status == STAT_FORCELOSS) && (ai->scan_timeout > 0))
3232 scan_forceloss = 1;
3233
3234 airo_print_status(ai->dev->name, status);
3235
3236 if ((status == STAT_ASSOC) || (status == STAT_REASSOC)) {
3237 if (auto_wep)
3238 ai->expires = 0;
3239 if (ai->list_bss_task)
3240 wake_up_process(ai->list_bss_task);
3241 set_bit(FLAG_UPDATE_UNI, &ai->flags);
3242 set_bit(FLAG_UPDATE_MULTI, &ai->flags);
3243
3244 if (down_trylock(&ai->sem) != 0) {
3245 set_bit(JOB_EVENT, &ai->jobs);
3246 wake_up_interruptible(&ai->thr_wait);
3247 } else
3248 airo_send_event(ai->dev);
3249 } else if (!scan_forceloss) {
3250 if (auto_wep && !ai->expires) {
3251 ai->expires = RUN_AT(3*HZ);
3252 wake_up_interruptible(&ai->thr_wait);
3253 }
3254
3255 /* Send event to user space */
3256 memset(wrqu.ap_addr.sa_data, '\0', ETH_ALEN);
3257 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3258 wireless_send_event(ai->dev, SIOCGIWAP, &wrqu, NULL);
3259 }
3260 }
3261
3262 static void airo_handle_rx(struct airo_info *ai)
3263 {
3264 struct sk_buff *skb = NULL;
3265 __le16 fc, v, *buffer, tmpbuf[4];
3266 u16 len, hdrlen = 0, gap, fid;
3267 struct rx_hdr hdr;
3268 int success = 0;
3269
3270 if (test_bit(FLAG_MPI, &ai->flags)) {
3271 if (test_bit(FLAG_802_11, &ai->flags))
3272 mpi_receive_802_11(ai);
3273 else
3274 mpi_receive_802_3(ai);
3275 OUT4500(ai, EVACK, EV_RX);
3276 return;
3277 }
3278
3279 fid = IN4500(ai, RXFID);
3280
3281 /* Get the packet length */
3282 if (test_bit(FLAG_802_11, &ai->flags)) {
3283 bap_setup (ai, fid, 4, BAP0);
3284 bap_read (ai, (__le16*)&hdr, sizeof(hdr), BAP0);
3285 /* Bad CRC. Ignore packet */
3286 if (le16_to_cpu(hdr.status) & 2)
3287 hdr.len = 0;
3288 if (ai->wifidev == NULL)
3289 hdr.len = 0;
3290 } else {
3291 bap_setup(ai, fid, 0x36, BAP0);
3292 bap_read(ai, &hdr.len, 2, BAP0);
3293 }
3294 len = le16_to_cpu(hdr.len);
3295
3296 if (len > AIRO_DEF_MTU) {
3297 airo_print_err(ai->dev->name, "Bad size %d", len);
3298 goto done;
3299 }
3300 if (len == 0)
3301 goto done;
3302
3303 if (test_bit(FLAG_802_11, &ai->flags)) {
3304 bap_read(ai, &fc, sizeof (fc), BAP0);
3305 hdrlen = header_len(fc);
3306 } else
3307 hdrlen = ETH_ALEN * 2;
3308
3309 skb = dev_alloc_skb(len + hdrlen + 2 + 2);
3310 if (!skb) {
3311 ai->dev->stats.rx_dropped++;
3312 goto done;
3313 }
3314
3315 skb_reserve(skb, 2); /* This way the IP header is aligned */
3316 buffer = (__le16 *) skb_put(skb, len + hdrlen);
3317 if (test_bit(FLAG_802_11, &ai->flags)) {
3318 buffer[0] = fc;
3319 bap_read(ai, buffer + 1, hdrlen - 2, BAP0);
3320 if (hdrlen == 24)
3321 bap_read(ai, tmpbuf, 6, BAP0);
3322
3323 bap_read(ai, &v, sizeof(v), BAP0);
3324 gap = le16_to_cpu(v);
3325 if (gap) {
3326 if (gap <= 8) {
3327 bap_read(ai, tmpbuf, gap, BAP0);
3328 } else {
3329 airo_print_err(ai->dev->name, "gaplen too "
3330 "big. Problems will follow...");
3331 }
3332 }
3333 bap_read(ai, buffer + hdrlen/2, len, BAP0);
3334 } else {
3335 MICBuffer micbuf;
3336
3337 bap_read(ai, buffer, ETH_ALEN * 2, BAP0);
3338 if (ai->micstats.enabled) {
3339 bap_read(ai, (__le16 *) &micbuf, sizeof (micbuf), BAP0);
3340 if (ntohs(micbuf.typelen) > 0x05DC)
3341 bap_setup(ai, fid, 0x44, BAP0);
3342 else {
3343 if (len <= sizeof (micbuf)) {
3344 dev_kfree_skb_irq(skb);
3345 goto done;
3346 }
3347
3348 len -= sizeof(micbuf);
3349 skb_trim(skb, len + hdrlen);
3350 }
3351 }
3352
3353 bap_read(ai, buffer + ETH_ALEN, len, BAP0);
3354 if (decapsulate(ai, &micbuf, (etherHead*) buffer, len))
3355 dev_kfree_skb_irq (skb);
3356 else
3357 success = 1;
3358 }
3359
3360 #ifdef WIRELESS_SPY
3361 if (success && (ai->spy_data.spy_number > 0)) {
3362 char *sa;
3363 struct iw_quality wstats;
3364
3365 /* Prepare spy data : addr + qual */
3366 if (!test_bit(FLAG_802_11, &ai->flags)) {
3367 sa = (char *) buffer + 6;
3368 bap_setup(ai, fid, 8, BAP0);
3369 bap_read(ai, (__le16 *) hdr.rssi, 2, BAP0);
3370 } else
3371 sa = (char *) buffer + 10;
3372 wstats.qual = hdr.rssi[0];
3373 if (ai->rssi)
3374 wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3375 else
3376 wstats.level = (hdr.rssi[1] + 321) / 2;
3377 wstats.noise = ai->wstats.qual.noise;
3378 wstats.updated = IW_QUAL_LEVEL_UPDATED
3379 | IW_QUAL_QUAL_UPDATED
3380 | IW_QUAL_DBM;
3381 /* Update spy records */
3382 wireless_spy_update(ai->dev, sa, &wstats);
3383 }
3384 #endif /* WIRELESS_SPY */
3385
3386 done:
3387 OUT4500(ai, EVACK, EV_RX);
3388
3389 if (success) {
3390 if (test_bit(FLAG_802_11, &ai->flags)) {
3391 skb_reset_mac_header(skb);
3392 skb->pkt_type = PACKET_OTHERHOST;
3393 skb->dev = ai->wifidev;
3394 skb->protocol = htons(ETH_P_802_2);
3395 } else
3396 skb->protocol = eth_type_trans(skb, ai->dev);
3397 skb->ip_summed = CHECKSUM_NONE;
3398
3399 netif_rx(skb);
3400 }
3401 }
3402
3403 static void airo_handle_tx(struct airo_info *ai, u16 status)
3404 {
3405 int i, len = 0, index = -1;
3406 u16 fid;
3407
3408 if (test_bit(FLAG_MPI, &ai->flags)) {
3409 unsigned long flags;
3410
3411 if (status & EV_TXEXC)
3412 get_tx_error(ai, -1);
3413
3414 spin_lock_irqsave(&ai->aux_lock, flags);
3415 if (!skb_queue_empty(&ai->txq)) {
3416 spin_unlock_irqrestore(&ai->aux_lock,flags);
3417 mpi_send_packet(ai->dev);
3418 } else {
3419 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
3420 spin_unlock_irqrestore(&ai->aux_lock,flags);
3421 netif_wake_queue(ai->dev);
3422 }
3423 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3424 return;
3425 }
3426
3427 fid = IN4500(ai, TXCOMPLFID);
3428
3429 for(i = 0; i < MAX_FIDS; i++) {
3430 if ((ai->fids[i] & 0xffff) == fid) {
3431 len = ai->fids[i] >> 16;
3432 index = i;
3433 }
3434 }
3435
3436 if (index != -1) {
3437 if (status & EV_TXEXC)
3438 get_tx_error(ai, index);
3439
3440 OUT4500(ai, EVACK, status & (EV_TX | EV_TXEXC));
3441
3442 /* Set up to be used again */
3443 ai->fids[index] &= 0xffff;
3444 if (index < MAX_FIDS / 2) {
3445 if (!test_bit(FLAG_PENDING_XMIT, &ai->flags))
3446 netif_wake_queue(ai->dev);
3447 } else {
3448 if (!test_bit(FLAG_PENDING_XMIT11, &ai->flags))
3449 netif_wake_queue(ai->wifidev);
3450 }
3451 } else {
3452 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3453 airo_print_err(ai->dev->name, "Unallocated FID was used to xmit");
3454 }
3455 }
3456
3457 static irqreturn_t airo_interrupt(int irq, void *dev_id)
3458 {
3459 struct net_device *dev = dev_id;
3460 u16 status, savedInterrupts = 0;
3461 struct airo_info *ai = dev->ml_priv;
3462 int handled = 0;
3463
3464 if (!netif_device_present(dev))
3465 return IRQ_NONE;
3466
3467 for (;;) {
3468 status = IN4500(ai, EVSTAT);
3469 if (!(status & STATUS_INTS) || (status == 0xffff))
3470 break;
3471
3472 handled = 1;
3473
3474 if (status & EV_AWAKE) {
3475 OUT4500(ai, EVACK, EV_AWAKE);
3476 OUT4500(ai, EVACK, EV_AWAKE);
3477 }
3478
3479 if (!savedInterrupts) {
3480 savedInterrupts = IN4500(ai, EVINTEN);
3481 OUT4500(ai, EVINTEN, 0);
3482 }
3483
3484 if (status & EV_MIC) {
3485 OUT4500(ai, EVACK, EV_MIC);
3486 airo_handle_cisco_mic(ai);
3487 }
3488
3489 if (status & EV_LINK) {
3490 /* Link status changed */
3491 airo_handle_link(ai);
3492 }
3493
3494 /* Check to see if there is something to receive */
3495 if (status & EV_RX)
3496 airo_handle_rx(ai);
3497
3498 /* Check to see if a packet has been transmitted */
3499 if (status & (EV_TX | EV_TXCPY | EV_TXEXC))
3500 airo_handle_tx(ai, status);
3501
3502 if ( status & ~STATUS_INTS & ~IGNORE_INTS ) {
3503 airo_print_warn(ai->dev->name, "Got weird status %x",
3504 status & ~STATUS_INTS & ~IGNORE_INTS );
3505 }
3506 }
3507
3508 if (savedInterrupts)
3509 OUT4500(ai, EVINTEN, savedInterrupts);
3510
3511 return IRQ_RETVAL(handled);
3512 }
3513
3514 /*
3515 * Routines to talk to the card
3516 */
3517
3518 /*
3519 * This was originally written for the 4500, hence the name
3520 * NOTE: If use with 8bit mode and SMP bad things will happen!
3521 * Why would some one do 8 bit IO in an SMP machine?!?
3522 */
3523 static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3524 if (test_bit(FLAG_MPI,&ai->flags))
3525 reg <<= 1;
3526 if ( !do8bitIO )
3527 outw( val, ai->dev->base_addr + reg );
3528 else {
3529 outb( val & 0xff, ai->dev->base_addr + reg );
3530 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3531 }
3532 }
3533
3534 static u16 IN4500( struct airo_info *ai, u16 reg ) {
3535 unsigned short rc;
3536
3537 if (test_bit(FLAG_MPI,&ai->flags))
3538 reg <<= 1;
3539 if ( !do8bitIO )
3540 rc = inw( ai->dev->base_addr + reg );
3541 else {
3542 rc = inb( ai->dev->base_addr + reg );
3543 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3544 }
3545 return rc;
3546 }
3547
3548 static int enable_MAC(struct airo_info *ai, int lock)
3549 {
3550 int rc;
3551 Cmd cmd;
3552 Resp rsp;
3553
3554 /* FLAG_RADIO_OFF : Radio disabled via /proc or Wireless Extensions
3555 * FLAG_RADIO_DOWN : Radio disabled via "ifconfig ethX down"
3556 * Note : we could try to use !netif_running(dev) in enable_MAC()
3557 * instead of this flag, but I don't trust it *within* the
3558 * open/close functions, and testing both flags together is
3559 * "cheaper" - Jean II */
3560 if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3561
3562 if (lock && down_interruptible(&ai->sem))
3563 return -ERESTARTSYS;
3564
3565 if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3566 memset(&cmd, 0, sizeof(cmd));
3567 cmd.cmd = MAC_ENABLE;
3568 rc = issuecommand(ai, &cmd, &rsp);
3569 if (rc == SUCCESS)
3570 set_bit(FLAG_ENABLED, &ai->flags);
3571 } else
3572 rc = SUCCESS;
3573
3574 if (lock)
3575 up(&ai->sem);
3576
3577 if (rc)
3578 airo_print_err(ai->dev->name, "Cannot enable MAC");
3579 else if ((rsp.status & 0xFF00) != 0) {
3580 airo_print_err(ai->dev->name, "Bad MAC enable reason=%x, "
3581 "rid=%x, offset=%d", rsp.rsp0, rsp.rsp1, rsp.rsp2);
3582 rc = ERROR;
3583 }
3584 return rc;
3585 }
3586
3587 static void disable_MAC( struct airo_info *ai, int lock ) {
3588 Cmd cmd;
3589 Resp rsp;
3590
3591 if (lock && down_interruptible(&ai->sem))
3592 return;
3593
3594 if (test_bit(FLAG_ENABLED, &ai->flags)) {
3595 memset(&cmd, 0, sizeof(cmd));
3596 cmd.cmd = MAC_DISABLE; // disable in case already enabled
3597 issuecommand(ai, &cmd, &rsp);
3598 clear_bit(FLAG_ENABLED, &ai->flags);
3599 }
3600 if (lock)
3601 up(&ai->sem);
3602 }
3603
3604 static void enable_interrupts( struct airo_info *ai ) {
3605 /* Enable the interrupts */
3606 OUT4500( ai, EVINTEN, STATUS_INTS );
3607 }
3608
3609 static void disable_interrupts( struct airo_info *ai ) {
3610 OUT4500( ai, EVINTEN, 0 );
3611 }
3612
3613 static void mpi_receive_802_3(struct airo_info *ai)
3614 {
3615 RxFid rxd;
3616 int len = 0;
3617 struct sk_buff *skb;
3618 char *buffer;
3619 int off = 0;
3620 MICBuffer micbuf;
3621
3622 memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3623 /* Make sure we got something */
3624 if (rxd.rdy && rxd.valid == 0) {
3625 len = rxd.len + 12;
3626 if (len < 12 || len > 2048)
3627 goto badrx;
3628
3629 skb = dev_alloc_skb(len);
3630 if (!skb) {
3631 ai->dev->stats.rx_dropped++;
3632 goto badrx;
3633 }
3634 buffer = skb_put(skb,len);
3635 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3636 if (ai->micstats.enabled) {
3637 memcpy(&micbuf,
3638 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3639 sizeof(micbuf));
3640 if (ntohs(micbuf.typelen) <= 0x05DC) {
3641 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3642 goto badmic;
3643
3644 off = sizeof(micbuf);
3645 skb_trim (skb, len - off);
3646 }
3647 }
3648 memcpy(buffer + ETH_ALEN * 2,
3649 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3650 len - ETH_ALEN * 2 - off);
3651 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3652 badmic:
3653 dev_kfree_skb_irq (skb);
3654 goto badrx;
3655 }
3656 #ifdef WIRELESS_SPY
3657 if (ai->spy_data.spy_number > 0) {
3658 char *sa;
3659 struct iw_quality wstats;
3660 /* Prepare spy data : addr + qual */
3661 sa = buffer + ETH_ALEN;
3662 wstats.qual = 0; /* XXX Where do I get that info from ??? */
3663 wstats.level = 0;
3664 wstats.updated = 0;
3665 /* Update spy records */
3666 wireless_spy_update(ai->dev, sa, &wstats);
3667 }
3668 #endif /* WIRELESS_SPY */
3669
3670 skb->ip_summed = CHECKSUM_NONE;
3671 skb->protocol = eth_type_trans(skb, ai->dev);
3672 netif_rx(skb);
3673 }
3674 badrx:
3675 if (rxd.valid == 0) {
3676 rxd.valid = 1;
3677 rxd.rdy = 0;
3678 rxd.len = PKTSIZE;
3679 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3680 }
3681 }
3682
3683 static void mpi_receive_802_11(struct airo_info *ai)
3684 {
3685 RxFid rxd;
3686 struct sk_buff *skb = NULL;
3687 u16 len, hdrlen = 0;
3688 __le16 fc;
3689 struct rx_hdr hdr;
3690 u16 gap;
3691 u16 *buffer;
3692 char *ptr = ai->rxfids[0].virtual_host_addr + 4;
3693
3694 memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3695 memcpy ((char *)&hdr, ptr, sizeof(hdr));
3696 ptr += sizeof(hdr);
3697 /* Bad CRC. Ignore packet */
3698 if (le16_to_cpu(hdr.status) & 2)
3699 hdr.len = 0;
3700 if (ai->wifidev == NULL)
3701 hdr.len = 0;
3702 len = le16_to_cpu(hdr.len);
3703 if (len > AIRO_DEF_MTU) {
3704 airo_print_err(ai->dev->name, "Bad size %d", len);
3705 goto badrx;
3706 }
3707 if (len == 0)
3708 goto badrx;
3709
3710 fc = get_unaligned((__le16 *)ptr);
3711 hdrlen = header_len(fc);
3712
3713 skb = dev_alloc_skb( len + hdrlen + 2 );
3714 if ( !skb ) {
3715 ai->dev->stats.rx_dropped++;
3716 goto badrx;
3717 }
3718 buffer = (u16*)skb_put (skb, len + hdrlen);
3719 memcpy ((char *)buffer, ptr, hdrlen);
3720 ptr += hdrlen;
3721 if (hdrlen == 24)
3722 ptr += 6;
3723 gap = get_unaligned_le16(ptr);
3724 ptr += sizeof(__le16);
3725 if (gap) {
3726 if (gap <= 8)
3727 ptr += gap;
3728 else
3729 airo_print_err(ai->dev->name,
3730 "gaplen too big. Problems will follow...");
3731 }
3732 memcpy ((char *)buffer + hdrlen, ptr, len);
3733 ptr += len;
3734 #ifdef IW_WIRELESS_SPY /* defined in iw_handler.h */
3735 if (ai->spy_data.spy_number > 0) {
3736 char *sa;
3737 struct iw_quality wstats;
3738 /* Prepare spy data : addr + qual */
3739 sa = (char*)buffer + 10;
3740 wstats.qual = hdr.rssi[0];
3741 if (ai->rssi)
3742 wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3743 else
3744 wstats.level = (hdr.rssi[1] + 321) / 2;
3745 wstats.noise = ai->wstats.qual.noise;
3746 wstats.updated = IW_QUAL_QUAL_UPDATED
3747 | IW_QUAL_LEVEL_UPDATED
3748 | IW_QUAL_DBM;
3749 /* Update spy records */
3750 wireless_spy_update(ai->dev, sa, &wstats);
3751 }
3752 #endif /* IW_WIRELESS_SPY */
3753 skb_reset_mac_header(skb);
3754 skb->pkt_type = PACKET_OTHERHOST;
3755 skb->dev = ai->wifidev;
3756 skb->protocol = htons(ETH_P_802_2);
3757 skb->ip_summed = CHECKSUM_NONE;
3758 netif_rx( skb );
3759
3760 badrx:
3761 if (rxd.valid == 0) {
3762 rxd.valid = 1;
3763 rxd.rdy = 0;
3764 rxd.len = PKTSIZE;
3765 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3766 }
3767 }
3768
3769 static u16 setup_card(struct airo_info *ai, u8 *mac, int lock)
3770 {
3771 Cmd cmd;
3772 Resp rsp;
3773 int status;
3774 SsidRid mySsid;
3775 __le16 lastindex;
3776 WepKeyRid wkr;
3777 int rc;
3778
3779 memset( &mySsid, 0, sizeof( mySsid ) );
3780 kfree (ai->flash);
3781 ai->flash = NULL;
3782
3783 /* The NOP is the first step in getting the card going */
3784 cmd.cmd = NOP;
3785 cmd.parm0 = cmd.parm1 = cmd.parm2 = 0;
3786 if (lock && down_interruptible(&ai->sem))
3787 return ERROR;
3788 if ( issuecommand( ai, &cmd, &rsp ) != SUCCESS ) {
3789 if (lock)
3790 up(&ai->sem);
3791 return ERROR;
3792 }
3793 disable_MAC( ai, 0);
3794
3795 // Let's figure out if we need to use the AUX port
3796 if (!test_bit(FLAG_MPI,&ai->flags)) {
3797 cmd.cmd = CMD_ENABLEAUX;
3798 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
3799 if (lock)
3800 up(&ai->sem);
3801 airo_print_err(ai->dev->name, "Error checking for AUX port");
3802 return ERROR;
3803 }
3804 if (!aux_bap || rsp.status & 0xff00) {
3805 ai->bap_read = fast_bap_read;
3806 airo_print_dbg(ai->dev->name, "Doing fast bap_reads");
3807 } else {
3808 ai->bap_read = aux_bap_read;
3809 airo_print_dbg(ai->dev->name, "Doing AUX bap_reads");
3810 }
3811 }
3812 if (lock)
3813 up(&ai->sem);
3814 if (ai->config.len == 0) {
3815 int i;
3816 tdsRssiRid rssi_rid;
3817 CapabilityRid cap_rid;
3818
3819 kfree(ai->APList);
3820 ai->APList = NULL;
3821 kfree(ai->SSID);
3822 ai->SSID = NULL;
3823 // general configuration (read/modify/write)
3824 status = readConfigRid(ai, lock);
3825 if ( status != SUCCESS ) return ERROR;
3826
3827 status = readCapabilityRid(ai, &cap_rid, lock);
3828 if ( status != SUCCESS ) return ERROR;
3829
3830 status = PC4500_readrid(ai,RID_RSSI,&rssi_rid,sizeof(rssi_rid),lock);
3831 if ( status == SUCCESS ) {
3832 if (ai->rssi || (ai->rssi = kmalloc(512, GFP_KERNEL)) != NULL)
3833 memcpy(ai->rssi, (u8*)&rssi_rid + 2, 512); /* Skip RID length member */
3834 }
3835 else {
3836 kfree(ai->rssi);
3837 ai->rssi = NULL;
3838 if (cap_rid.softCap & cpu_to_le16(8))
3839 ai->config.rmode |= RXMODE_NORMALIZED_RSSI;
3840 else
3841 airo_print_warn(ai->dev->name, "unknown received signal "
3842 "level scale");
3843 }
3844 ai->config.opmode = adhoc ? MODE_STA_IBSS : MODE_STA_ESS;
3845 ai->config.authType = AUTH_OPEN;
3846 ai->config.modulation = MOD_CCK;
3847
3848 if (le16_to_cpu(cap_rid.len) >= sizeof(cap_rid) &&
3849 (cap_rid.extSoftCap & cpu_to_le16(1)) &&
3850 micsetup(ai) == SUCCESS) {
3851 ai->config.opmode |= MODE_MIC;
3852 set_bit(FLAG_MIC_CAPABLE, &ai->flags);
3853 }
3854
3855 /* Save off the MAC */
3856 for( i = 0; i < ETH_ALEN; i++ ) {
3857 mac[i] = ai->config.macAddr[i];
3858 }
3859
3860 /* Check to see if there are any insmod configured
3861 rates to add */
3862 if ( rates[0] ) {
3863 memset(ai->config.rates,0,sizeof(ai->config.rates));
3864 for( i = 0; i < 8 && rates[i]; i++ ) {
3865 ai->config.rates[i] = rates[i];
3866 }
3867 }
3868 if ( basic_rate > 0 ) {
3869 for( i = 0; i < 8; i++ ) {
3870 if ( ai->config.rates[i] == basic_rate ||
3871 !ai->config.rates ) {
3872 ai->config.rates[i] = basic_rate | 0x80;
3873 break;
3874 }
3875 }
3876 }
3877 set_bit (FLAG_COMMIT, &ai->flags);
3878 }
3879
3880 /* Setup the SSIDs if present */
3881 if ( ssids[0] ) {
3882 int i;
3883 for( i = 0; i < 3 && ssids[i]; i++ ) {
3884 size_t len = strlen(ssids[i]);
3885 if (len > 32)
3886 len = 32;
3887 mySsid.ssids[i].len = cpu_to_le16(len);
3888 memcpy(mySsid.ssids[i].ssid, ssids[i], len);
3889 }
3890 mySsid.len = cpu_to_le16(sizeof(mySsid));
3891 }
3892
3893 status = writeConfigRid(ai, lock);
3894 if ( status != SUCCESS ) return ERROR;
3895
3896 /* Set up the SSID list */
3897 if ( ssids[0] ) {
3898 status = writeSsidRid(ai, &mySsid, lock);
3899 if ( status != SUCCESS ) return ERROR;
3900 }
3901
3902 status = enable_MAC(ai, lock);
3903 if (status != SUCCESS)
3904 return ERROR;
3905
3906 /* Grab the initial wep key, we gotta save it for auto_wep */
3907 rc = readWepKeyRid(ai, &wkr, 1, lock);
3908 if (rc == SUCCESS) do {
3909 lastindex = wkr.kindex;
3910 if (wkr.kindex == cpu_to_le16(0xffff)) {
3911 ai->defindex = wkr.mac[0];
3912 }
3913 rc = readWepKeyRid(ai, &wkr, 0, lock);
3914 } while(lastindex != wkr.kindex);
3915
3916 try_auto_wep(ai);
3917
3918 return SUCCESS;
3919 }
3920
3921 static u16 issuecommand(struct airo_info *ai, Cmd *pCmd, Resp *pRsp) {
3922 // Im really paranoid about letting it run forever!
3923 int max_tries = 600000;
3924
3925 if (IN4500(ai, EVSTAT) & EV_CMD)
3926 OUT4500(ai, EVACK, EV_CMD);
3927
3928 OUT4500(ai, PARAM0, pCmd->parm0);
3929 OUT4500(ai, PARAM1, pCmd->parm1);
3930 OUT4500(ai, PARAM2, pCmd->parm2);
3931 OUT4500(ai, COMMAND, pCmd->cmd);
3932
3933 while (max_tries-- && (IN4500(ai, EVSTAT) & EV_CMD) == 0) {
3934 if ((IN4500(ai, COMMAND)) == pCmd->cmd)
3935 // PC4500 didn't notice command, try again
3936 OUT4500(ai, COMMAND, pCmd->cmd);
3937 if (!in_atomic() && (max_tries & 255) == 0)
3938 schedule();
3939 }
3940
3941 if ( max_tries == -1 ) {
3942 airo_print_err(ai->dev->name,
3943 "Max tries exceeded when issueing command");
3944 if (IN4500(ai, COMMAND) & COMMAND_BUSY)
3945 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3946 return ERROR;
3947 }
3948
3949 // command completed
3950 pRsp->status = IN4500(ai, STATUS);
3951 pRsp->rsp0 = IN4500(ai, RESP0);
3952 pRsp->rsp1 = IN4500(ai, RESP1);
3953 pRsp->rsp2 = IN4500(ai, RESP2);
3954 if ((pRsp->status & 0xff00)!=0 && pCmd->cmd != CMD_SOFTRESET)
3955 airo_print_err(ai->dev->name,
3956 "cmd:%x status:%x rsp0:%x rsp1:%x rsp2:%x",
3957 pCmd->cmd, pRsp->status, pRsp->rsp0, pRsp->rsp1,
3958 pRsp->rsp2);
3959
3960 // clear stuck command busy if necessary
3961 if (IN4500(ai, COMMAND) & COMMAND_BUSY) {
3962 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3963 }
3964 // acknowledge processing the status/response
3965 OUT4500(ai, EVACK, EV_CMD);
3966
3967 return SUCCESS;
3968 }
3969
3970 /* Sets up the bap to start exchange data. whichbap should
3971 * be one of the BAP0 or BAP1 defines. Locks should be held before
3972 * calling! */
3973 static int bap_setup(struct airo_info *ai, u16 rid, u16 offset, int whichbap )
3974 {
3975 int timeout = 50;
3976 int max_tries = 3;
3977
3978 OUT4500(ai, SELECT0+whichbap, rid);
3979 OUT4500(ai, OFFSET0+whichbap, offset);
3980 while (1) {
3981 int status = IN4500(ai, OFFSET0+whichbap);
3982 if (status & BAP_BUSY) {
3983 /* This isn't really a timeout, but its kinda
3984 close */
3985 if (timeout--) {
3986 continue;
3987 }
3988 } else if ( status & BAP_ERR ) {
3989 /* invalid rid or offset */
3990 airo_print_err(ai->dev->name, "BAP error %x %d",
3991 status, whichbap );
3992 return ERROR;
3993 } else if (status & BAP_DONE) { // success
3994 return SUCCESS;
3995 }
3996 if ( !(max_tries--) ) {
3997 airo_print_err(ai->dev->name,
3998 "BAP setup error too many retries\n");
3999 return ERROR;
4000 }
4001 // -- PC4500 missed it, try again
4002 OUT4500(ai, SELECT0+whichbap, rid);
4003 OUT4500(ai, OFFSET0+whichbap, offset);
4004 timeout = 50;
4005 }
4006 }
4007
4008 /* should only be called by aux_bap_read. This aux function and the
4009 following use concepts not documented in the developers guide. I
4010 got them from a patch given to my by Aironet */
4011 static u16 aux_setup(struct airo_info *ai, u16 page,
4012 u16 offset, u16 *len)
4013 {
4014 u16 next;
4015
4016 OUT4500(ai, AUXPAGE, page);
4017 OUT4500(ai, AUXOFF, 0);
4018 next = IN4500(ai, AUXDATA);
4019 *len = IN4500(ai, AUXDATA)&0xff;
4020 if (offset != 4) OUT4500(ai, AUXOFF, offset);
4021 return next;
4022 }
4023
4024 /* requires call to bap_setup() first */
4025 static int aux_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4026 int bytelen, int whichbap)
4027 {
4028 u16 len;
4029 u16 page;
4030 u16 offset;
4031 u16 next;
4032 int words;
4033 int i;
4034 unsigned long flags;
4035
4036 spin_lock_irqsave(&ai->aux_lock, flags);
4037 page = IN4500(ai, SWS0+whichbap);
4038 offset = IN4500(ai, SWS2+whichbap);
4039 next = aux_setup(ai, page, offset, &len);
4040 words = (bytelen+1)>>1;
4041
4042 for (i=0; i<words;) {
4043 int count;
4044 count = (len>>1) < (words-i) ? (len>>1) : (words-i);
4045 if ( !do8bitIO )
4046 insw( ai->dev->base_addr+DATA0+whichbap,
4047 pu16Dst+i,count );
4048 else
4049 insb( ai->dev->base_addr+DATA0+whichbap,
4050 pu16Dst+i, count << 1 );
4051 i += count;
4052 if (i<words) {
4053 next = aux_setup(ai, next, 4, &len);
4054 }
4055 }
4056 spin_unlock_irqrestore(&ai->aux_lock, flags);
4057 return SUCCESS;
4058 }
4059
4060
4061 /* requires call to bap_setup() first */
4062 static int fast_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4063 int bytelen, int whichbap)
4064 {
4065 bytelen = (bytelen + 1) & (~1); // round up to even value
4066 if ( !do8bitIO )
4067 insw( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen>>1 );
4068 else
4069 insb( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen );
4070 return SUCCESS;
4071 }
4072
4073 /* requires call to bap_setup() first */
4074 static int bap_write(struct airo_info *ai, const __le16 *pu16Src,
4075 int bytelen, int whichbap)
4076 {
4077 bytelen = (bytelen + 1) & (~1); // round up to even value
4078 if ( !do8bitIO )
4079 outsw( ai->dev->base_addr+DATA0+whichbap,
4080 pu16Src, bytelen>>1 );
4081 else
4082 outsb( ai->dev->base_addr+DATA0+whichbap, pu16Src, bytelen );
4083 return SUCCESS;
4084 }
4085
4086 static int PC4500_accessrid(struct airo_info *ai, u16 rid, u16 accmd)
4087 {
4088 Cmd cmd; /* for issuing commands */
4089 Resp rsp; /* response from commands */
4090 u16 status;
4091
4092 memset(&cmd, 0, sizeof(cmd));
4093 cmd.cmd = accmd;
4094 cmd.parm0 = rid;
4095 status = issuecommand(ai, &cmd, &rsp);
4096 if (status != 0) return status;
4097 if ( (rsp.status & 0x7F00) != 0) {
4098 return (accmd << 8) + (rsp.rsp0 & 0xFF);
4099 }
4100 return 0;
4101 }
4102
4103 /* Note, that we are using BAP1 which is also used by transmit, so
4104 * we must get a lock. */
4105 static int PC4500_readrid(struct airo_info *ai, u16 rid, void *pBuf, int len, int lock)
4106 {
4107 u16 status;
4108 int rc = SUCCESS;
4109
4110 if (lock) {
4111 if (down_interruptible(&ai->sem))
4112 return ERROR;
4113 }
4114 if (test_bit(FLAG_MPI,&ai->flags)) {
4115 Cmd cmd;
4116 Resp rsp;
4117
4118 memset(&cmd, 0, sizeof(cmd));
4119 memset(&rsp, 0, sizeof(rsp));
4120 ai->config_desc.rid_desc.valid = 1;
4121 ai->config_desc.rid_desc.len = RIDSIZE;
4122 ai->config_desc.rid_desc.rid = 0;
4123 ai->config_desc.rid_desc.host_addr = ai->ridbus;
4124
4125 cmd.cmd = CMD_ACCESS;
4126 cmd.parm0 = rid;
4127
4128 memcpy_toio(ai->config_desc.card_ram_off,
4129 &ai->config_desc.rid_desc, sizeof(Rid));
4130
4131 rc = issuecommand(ai, &cmd, &rsp);
4132
4133 if (rsp.status & 0x7f00)
4134 rc = rsp.rsp0;
4135 if (!rc)
4136 memcpy(pBuf, ai->config_desc.virtual_host_addr, len);
4137 goto done;
4138 } else {
4139 if ((status = PC4500_accessrid(ai, rid, CMD_ACCESS))!=SUCCESS) {
4140 rc = status;
4141 goto done;
4142 }
4143 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4144 rc = ERROR;
4145 goto done;
4146 }
4147 // read the rid length field
4148 bap_read(ai, pBuf, 2, BAP1);
4149 // length for remaining part of rid
4150 len = min(len, (int)le16_to_cpu(*(__le16*)pBuf)) - 2;
4151
4152 if ( len <= 2 ) {
4153 airo_print_err(ai->dev->name,
4154 "Rid %x has a length of %d which is too short",
4155 (int)rid, (int)len );
4156 rc = ERROR;
4157 goto done;
4158 }
4159 // read remainder of the rid
4160 rc = bap_read(ai, ((__le16*)pBuf)+1, len, BAP1);
4161 }
4162 done:
4163 if (lock)
4164 up(&ai->sem);
4165 return rc;
4166 }
4167
4168 /* Note, that we are using BAP1 which is also used by transmit, so
4169 * make sure this isnt called when a transmit is happening */
4170 static int PC4500_writerid(struct airo_info *ai, u16 rid,
4171 const void *pBuf, int len, int lock)
4172 {
4173 u16 status;
4174 int rc = SUCCESS;
4175
4176 *(__le16*)pBuf = cpu_to_le16((u16)len);
4177
4178 if (lock) {
4179 if (down_interruptible(&ai->sem))
4180 return ERROR;
4181 }
4182 if (test_bit(FLAG_MPI,&ai->flags)) {
4183 Cmd cmd;
4184 Resp rsp;
4185
4186 if (test_bit(FLAG_ENABLED, &ai->flags) && (RID_WEP_TEMP != rid))
4187 airo_print_err(ai->dev->name,
4188 "%s: MAC should be disabled (rid=%04x)",
4189 __func__, rid);
4190 memset(&cmd, 0, sizeof(cmd));
4191 memset(&rsp, 0, sizeof(rsp));
4192
4193 ai->config_desc.rid_desc.valid = 1;
4194 ai->config_desc.rid_desc.len = *((u16 *)pBuf);
4195 ai->config_desc.rid_desc.rid = 0;
4196
4197 cmd.cmd = CMD_WRITERID;
4198 cmd.parm0 = rid;
4199
4200 memcpy_toio(ai->config_desc.card_ram_off,
4201 &ai->config_desc.rid_desc, sizeof(Rid));
4202
4203 if (len < 4 || len > 2047) {
4204 airo_print_err(ai->dev->name, "%s: len=%d", __func__, len);
4205 rc = -1;
4206 } else {
4207 memcpy((char *)ai->config_desc.virtual_host_addr,
4208 pBuf, len);
4209
4210 rc = issuecommand(ai, &cmd, &rsp);
4211 if ((rc & 0xff00) != 0) {
4212 airo_print_err(ai->dev->name, "%s: Write rid Error %d",
4213 __func__, rc);
4214 airo_print_err(ai->dev->name, "%s: Cmd=%04x",
4215 __func__, cmd.cmd);
4216 }
4217
4218 if ((rsp.status & 0x7f00))
4219 rc = rsp.rsp0;
4220 }
4221 } else {
4222 // --- first access so that we can write the rid data
4223 if ( (status = PC4500_accessrid(ai, rid, CMD_ACCESS)) != 0) {
4224 rc = status;
4225 goto done;
4226 }
4227 // --- now write the rid data
4228 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4229 rc = ERROR;
4230 goto done;
4231 }
4232 bap_write(ai, pBuf, len, BAP1);
4233 // ---now commit the rid data
4234 rc = PC4500_accessrid(ai, rid, 0x100|CMD_ACCESS);
4235 }
4236 done:
4237 if (lock)
4238 up(&ai->sem);
4239 return rc;
4240 }
4241
4242 /* Allocates a FID to be used for transmitting packets. We only use
4243 one for now. */
4244 static u16 transmit_allocate(struct airo_info *ai, int lenPayload, int raw)
4245 {
4246 unsigned int loop = 3000;
4247 Cmd cmd;
4248 Resp rsp;
4249 u16 txFid;
4250 __le16 txControl;
4251
4252 cmd.cmd = CMD_ALLOCATETX;
4253 cmd.parm0 = lenPayload;
4254 if (down_interruptible(&ai->sem))
4255 return ERROR;
4256 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
4257 txFid = ERROR;
4258 goto done;
4259 }
4260 if ( (rsp.status & 0xFF00) != 0) {
4261 txFid = ERROR;
4262 goto done;
4263 }
4264 /* wait for the allocate event/indication
4265 * It makes me kind of nervous that this can just sit here and spin,
4266 * but in practice it only loops like four times. */
4267 while (((IN4500(ai, EVSTAT) & EV_ALLOC) == 0) && --loop);
4268 if (!loop) {
4269 txFid = ERROR;
4270 goto done;
4271 }
4272
4273 // get the allocated fid and acknowledge
4274 txFid = IN4500(ai, TXALLOCFID);
4275 OUT4500(ai, EVACK, EV_ALLOC);
4276
4277 /* The CARD is pretty cool since it converts the ethernet packet
4278 * into 802.11. Also note that we don't release the FID since we
4279 * will be using the same one over and over again. */
4280 /* We only have to setup the control once since we are not
4281 * releasing the fid. */
4282 if (raw)
4283 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_11
4284 | TXCTL_ETHERNET | TXCTL_NORELEASE);
4285 else
4286 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_3
4287 | TXCTL_ETHERNET | TXCTL_NORELEASE);
4288 if (bap_setup(ai, txFid, 0x0008, BAP1) != SUCCESS)
4289 txFid = ERROR;
4290 else
4291 bap_write(ai, &txControl, sizeof(txControl), BAP1);
4292
4293 done:
4294 up(&ai->sem);
4295
4296 return txFid;
4297 }
4298
4299 /* In general BAP1 is dedicated to transmiting packets. However,
4300 since we need a BAP when accessing RIDs, we also use BAP1 for that.
4301 Make sure the BAP1 spinlock is held when this is called. */
4302 static int transmit_802_3_packet(struct airo_info *ai, int len, char *pPacket)
4303 {
4304 __le16 payloadLen;
4305 Cmd cmd;
4306 Resp rsp;
4307 int miclen = 0;
4308 u16 txFid = len;
4309 MICBuffer pMic;
4310
4311 len >>= 16;
4312
4313 if (len <= ETH_ALEN * 2) {
4314 airo_print_warn(ai->dev->name, "Short packet %d", len);
4315 return ERROR;
4316 }
4317 len -= ETH_ALEN * 2;
4318
4319 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
4320 (ntohs(((__be16 *)pPacket)[6]) != 0x888E)) {
4321 if (encapsulate(ai,(etherHead *)pPacket,&pMic,len) != SUCCESS)
4322 return ERROR;
4323 miclen = sizeof(pMic);
4324 }
4325 // packet is destination[6], source[6], payload[len-12]
4326 // write the payload length and dst/src/payload
4327 if (bap_setup(ai, txFid, 0x0036, BAP1) != SUCCESS) return ERROR;
4328 /* The hardware addresses aren't counted as part of the payload, so
4329 * we have to subtract the 12 bytes for the addresses off */
4330 payloadLen = cpu_to_le16(len + miclen);
4331 bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4332 bap_write(ai, (__le16*)pPacket, sizeof(etherHead), BAP1);
4333 if (miclen)
4334 bap_write(ai, (__le16*)&pMic, miclen, BAP1);
4335 bap_write(ai, (__le16*)(pPacket + sizeof(etherHead)), len, BAP1);
4336 // issue the transmit command
4337 memset( &cmd, 0, sizeof( cmd ) );
4338 cmd.cmd = CMD_TRANSMIT;
4339 cmd.parm0 = txFid;
4340 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4341 if ( (rsp.status & 0xFF00) != 0) return ERROR;
4342 return SUCCESS;
4343 }
4344
4345 static int transmit_802_11_packet(struct airo_info *ai, int len, char *pPacket)
4346 {
4347 __le16 fc, payloadLen;
4348 Cmd cmd;
4349 Resp rsp;
4350 int hdrlen;
4351 static u8 tail[(30-10) + 2 + 6] = {[30-10] = 6};
4352 /* padding of header to full size + le16 gaplen (6) + gaplen bytes */
4353 u16 txFid = len;
4354 len >>= 16;
4355
4356 fc = *(__le16*)pPacket;
4357 hdrlen = header_len(fc);
4358
4359 if (len < hdrlen) {
4360 airo_print_warn(ai->dev->name, "Short packet %d", len);
4361 return ERROR;
4362 }
4363
4364 /* packet is 802.11 header + payload
4365 * write the payload length and dst/src/payload */
4366 if (bap_setup(ai, txFid, 6, BAP1) != SUCCESS) return ERROR;
4367 /* The 802.11 header aren't counted as part of the payload, so
4368 * we have to subtract the header bytes off */
4369 payloadLen = cpu_to_le16(len-hdrlen);
4370 bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4371 if (bap_setup(ai, txFid, 0x0014, BAP1) != SUCCESS) return ERROR;
4372 bap_write(ai, (__le16 *)pPacket, hdrlen, BAP1);
4373 bap_write(ai, (__le16 *)(tail + (hdrlen - 10)), 38 - hdrlen, BAP1);
4374
4375 bap_write(ai, (__le16 *)(pPacket + hdrlen), len - hdrlen, BAP1);
4376 // issue the transmit command
4377 memset( &cmd, 0, sizeof( cmd ) );
4378 cmd.cmd = CMD_TRANSMIT;
4379 cmd.parm0 = txFid;
4380 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4381 if ( (rsp.status & 0xFF00) != 0) return ERROR;
4382 return SUCCESS;
4383 }
4384
4385 /*
4386 * This is the proc_fs routines. It is a bit messier than I would
4387 * like! Feel free to clean it up!
4388 */
4389
4390 static ssize_t proc_read( struct file *file,
4391 char __user *buffer,
4392 size_t len,
4393 loff_t *offset);
4394
4395 static ssize_t proc_write( struct file *file,
4396 const char __user *buffer,
4397 size_t len,
4398 loff_t *offset );
4399 static int proc_close( struct inode *inode, struct file *file );
4400
4401 static int proc_stats_open( struct inode *inode, struct file *file );
4402 static int proc_statsdelta_open( struct inode *inode, struct file *file );
4403 static int proc_status_open( struct inode *inode, struct file *file );
4404 static int proc_SSID_open( struct inode *inode, struct file *file );
4405 static int proc_APList_open( struct inode *inode, struct file *file );
4406 static int proc_BSSList_open( struct inode *inode, struct file *file );
4407 static int proc_config_open( struct inode *inode, struct file *file );
4408 static int proc_wepkey_open( struct inode *inode, struct file *file );
4409
4410 static const struct file_operations proc_statsdelta_ops = {
4411 .owner = THIS_MODULE,
4412 .read = proc_read,
4413 .open = proc_statsdelta_open,
4414 .release = proc_close
4415 };
4416
4417 static const struct file_operations proc_stats_ops = {
4418 .owner = THIS_MODULE,
4419 .read = proc_read,
4420 .open = proc_stats_open,
4421 .release = proc_close
4422 };
4423
4424 static const struct file_operations proc_status_ops = {
4425 .owner = THIS_MODULE,
4426 .read = proc_read,
4427 .open = proc_status_open,
4428 .release = proc_close
4429 };
4430
4431 static const struct file_operations proc_SSID_ops = {
4432 .owner = THIS_MODULE,
4433 .read = proc_read,
4434 .write = proc_write,
4435 .open = proc_SSID_open,
4436 .release = proc_close
4437 };
4438
4439 static const struct file_operations proc_BSSList_ops = {
4440 .owner = THIS_MODULE,
4441 .read = proc_read,
4442 .write = proc_write,
4443 .open = proc_BSSList_open,
4444 .release = proc_close
4445 };
4446
4447 static const struct file_operations proc_APList_ops = {
4448 .owner = THIS_MODULE,
4449 .read = proc_read,
4450 .write = proc_write,
4451 .open = proc_APList_open,
4452 .release = proc_close
4453 };
4454
4455 static const struct file_operations proc_config_ops = {
4456 .owner = THIS_MODULE,
4457 .read = proc_read,
4458 .write = proc_write,
4459 .open = proc_config_open,
4460 .release = proc_close
4461 };
4462
4463 static const struct file_operations proc_wepkey_ops = {
4464 .owner = THIS_MODULE,
4465 .read = proc_read,
4466 .write = proc_write,
4467 .open = proc_wepkey_open,
4468 .release = proc_close
4469 };
4470
4471 static struct proc_dir_entry *airo_entry;
4472
4473 struct proc_data {
4474 int release_buffer;
4475 int readlen;
4476 char *rbuffer;
4477 int writelen;
4478 int maxwritelen;
4479 char *wbuffer;
4480 void (*on_close) (struct inode *, struct file *);
4481 };
4482
4483 static int setup_proc_entry( struct net_device *dev,
4484 struct airo_info *apriv ) {
4485 struct proc_dir_entry *entry;
4486 /* First setup the device directory */
4487 strcpy(apriv->proc_name,dev->name);
4488 apriv->proc_entry = create_proc_entry(apriv->proc_name,
4489 S_IFDIR|airo_perm,
4490 airo_entry);
4491 if (!apriv->proc_entry)
4492 goto fail;
4493 apriv->proc_entry->uid = proc_uid;
4494 apriv->proc_entry->gid = proc_gid;
4495
4496 /* Setup the StatsDelta */
4497 entry = proc_create_data("StatsDelta",
4498 S_IFREG | (S_IRUGO&proc_perm),
4499 apriv->proc_entry, &proc_statsdelta_ops, dev);
4500 if (!entry)
4501 goto fail_stats_delta;
4502 entry->uid = proc_uid;
4503 entry->gid = proc_gid;
4504
4505 /* Setup the Stats */
4506 entry = proc_create_data("Stats",
4507 S_IFREG | (S_IRUGO&proc_perm),
4508 apriv->proc_entry, &proc_stats_ops, dev);
4509 if (!entry)
4510 goto fail_stats;
4511 entry->uid = proc_uid;
4512 entry->gid = proc_gid;
4513
4514 /* Setup the Status */
4515 entry = proc_create_data("Status",
4516 S_IFREG | (S_IRUGO&proc_perm),
4517 apriv->proc_entry, &proc_status_ops, dev);
4518 if (!entry)
4519 goto fail_status;
4520 entry->uid = proc_uid;
4521 entry->gid = proc_gid;
4522
4523 /* Setup the Config */
4524 entry = proc_create_data("Config",
4525 S_IFREG | proc_perm,
4526 apriv->proc_entry, &proc_config_ops, dev);
4527 if (!entry)
4528 goto fail_config;
4529 entry->uid = proc_uid;
4530 entry->gid = proc_gid;
4531
4532 /* Setup the SSID */
4533 entry = proc_create_data("SSID",
4534 S_IFREG | proc_perm,
4535 apriv->proc_entry, &proc_SSID_ops, dev);
4536 if (!entry)
4537 goto fail_ssid;
4538 entry->uid = proc_uid;
4539 entry->gid = proc_gid;
4540
4541 /* Setup the APList */
4542 entry = proc_create_data("APList",
4543 S_IFREG | proc_perm,
4544 apriv->proc_entry, &proc_APList_ops, dev);
4545 if (!entry)
4546 goto fail_aplist;
4547 entry->uid = proc_uid;
4548 entry->gid = proc_gid;
4549
4550 /* Setup the BSSList */
4551 entry = proc_create_data("BSSList",
4552 S_IFREG | proc_perm,
4553 apriv->proc_entry, &proc_BSSList_ops, dev);
4554 if (!entry)
4555 goto fail_bsslist;
4556 entry->uid = proc_uid;
4557 entry->gid = proc_gid;
4558
4559 /* Setup the WepKey */
4560 entry = proc_create_data("WepKey",
4561 S_IFREG | proc_perm,
4562 apriv->proc_entry, &proc_wepkey_ops, dev);
4563 if (!entry)
4564 goto fail_wepkey;
4565 entry->uid = proc_uid;
4566 entry->gid = proc_gid;
4567
4568 return 0;
4569
4570 fail_wepkey:
4571 remove_proc_entry("BSSList", apriv->proc_entry);
4572 fail_bsslist:
4573 remove_proc_entry("APList", apriv->proc_entry);
4574 fail_aplist:
4575 remove_proc_entry("SSID", apriv->proc_entry);
4576 fail_ssid:
4577 remove_proc_entry("Config", apriv->proc_entry);
4578 fail_config:
4579 remove_proc_entry("Status", apriv->proc_entry);
4580 fail_status:
4581 remove_proc_entry("Stats", apriv->proc_entry);
4582 fail_stats:
4583 remove_proc_entry("StatsDelta", apriv->proc_entry);
4584 fail_stats_delta:
4585 remove_proc_entry(apriv->proc_name, airo_entry);
4586 fail:
4587 return -ENOMEM;
4588 }
4589
4590 static int takedown_proc_entry( struct net_device *dev,
4591 struct airo_info *apriv ) {
4592 if ( !apriv->proc_entry->namelen ) return 0;
4593 remove_proc_entry("Stats",apriv->proc_entry);
4594 remove_proc_entry("StatsDelta",apriv->proc_entry);
4595 remove_proc_entry("Status",apriv->proc_entry);
4596 remove_proc_entry("Config",apriv->proc_entry);
4597 remove_proc_entry("SSID",apriv->proc_entry);
4598 remove_proc_entry("APList",apriv->proc_entry);
4599 remove_proc_entry("BSSList",apriv->proc_entry);
4600 remove_proc_entry("WepKey",apriv->proc_entry);
4601 remove_proc_entry(apriv->proc_name,airo_entry);
4602 return 0;
4603 }
4604
4605 /*
4606 * What we want from the proc_fs is to be able to efficiently read
4607 * and write the configuration. To do this, we want to read the
4608 * configuration when the file is opened and write it when the file is
4609 * closed. So basically we allocate a read buffer at open and fill it
4610 * with data, and allocate a write buffer and read it at close.
4611 */
4612
4613 /*
4614 * The read routine is generic, it relies on the preallocated rbuffer
4615 * to supply the data.
4616 */
4617 static ssize_t proc_read( struct file *file,
4618 char __user *buffer,
4619 size_t len,
4620 loff_t *offset )
4621 {
4622 struct proc_data *priv = file->private_data;
4623
4624 if (!priv->rbuffer)
4625 return -EINVAL;
4626
4627 return simple_read_from_buffer(buffer, len, offset, priv->rbuffer,
4628 priv->readlen);
4629 }
4630
4631 /*
4632 * The write routine is generic, it fills in a preallocated rbuffer
4633 * to supply the data.
4634 */
4635 static ssize_t proc_write( struct file *file,
4636 const char __user *buffer,
4637 size_t len,
4638 loff_t *offset )
4639 {
4640 loff_t pos = *offset;
4641 struct proc_data *priv = (struct proc_data*)file->private_data;
4642
4643 if (!priv->wbuffer)
4644 return -EINVAL;
4645
4646 if (pos < 0)
4647 return -EINVAL;
4648 if (pos >= priv->maxwritelen)
4649 return 0;
4650 if (len > priv->maxwritelen - pos)
4651 len = priv->maxwritelen - pos;
4652 if (copy_from_user(priv->wbuffer + pos, buffer, len))
4653 return -EFAULT;
4654 if ( pos + len > priv->writelen )
4655 priv->writelen = len + file->f_pos;
4656 *offset = pos + len;
4657 return len;
4658 }
4659
4660 static int proc_status_open(struct inode *inode, struct file *file)
4661 {
4662 struct proc_data *data;
4663 struct proc_dir_entry *dp = PDE(inode);
4664 struct net_device *dev = dp->data;
4665 struct airo_info *apriv = dev->ml_priv;
4666 CapabilityRid cap_rid;
4667 StatusRid status_rid;
4668 u16 mode;
4669 int i;
4670
4671 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4672 return -ENOMEM;
4673 data = (struct proc_data *)file->private_data;
4674 if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4675 kfree (file->private_data);
4676 return -ENOMEM;
4677 }
4678
4679 readStatusRid(apriv, &status_rid, 1);
4680 readCapabilityRid(apriv, &cap_rid, 1);
4681
4682 mode = le16_to_cpu(status_rid.mode);
4683
4684 i = sprintf(data->rbuffer, "Status: %s%s%s%s%s%s%s%s%s\n",
4685 mode & 1 ? "CFG ": "",
4686 mode & 2 ? "ACT ": "",
4687 mode & 0x10 ? "SYN ": "",
4688 mode & 0x20 ? "LNK ": "",
4689 mode & 0x40 ? "LEAP ": "",
4690 mode & 0x80 ? "PRIV ": "",
4691 mode & 0x100 ? "KEY ": "",
4692 mode & 0x200 ? "WEP ": "",
4693 mode & 0x8000 ? "ERR ": "");
4694 sprintf( data->rbuffer+i, "Mode: %x\n"
4695 "Signal Strength: %d\n"
4696 "Signal Quality: %d\n"
4697 "SSID: %-.*s\n"
4698 "AP: %-.16s\n"
4699 "Freq: %d\n"
4700 "BitRate: %dmbs\n"
4701 "Driver Version: %s\n"
4702 "Device: %s\nManufacturer: %s\nFirmware Version: %s\n"
4703 "Radio type: %x\nCountry: %x\nHardware Version: %x\n"
4704 "Software Version: %x\nSoftware Subversion: %x\n"
4705 "Boot block version: %x\n",
4706 le16_to_cpu(status_rid.mode),
4707 le16_to_cpu(status_rid.normalizedSignalStrength),
4708 le16_to_cpu(status_rid.signalQuality),
4709 le16_to_cpu(status_rid.SSIDlen),
4710 status_rid.SSID,
4711 status_rid.apName,
4712 le16_to_cpu(status_rid.channel),
4713 le16_to_cpu(status_rid.currentXmitRate) / 2,
4714 version,
4715 cap_rid.prodName,
4716 cap_rid.manName,
4717 cap_rid.prodVer,
4718 le16_to_cpu(cap_rid.radioType),
4719 le16_to_cpu(cap_rid.country),
4720 le16_to_cpu(cap_rid.hardVer),
4721 le16_to_cpu(cap_rid.softVer),
4722 le16_to_cpu(cap_rid.softSubVer),
4723 le16_to_cpu(cap_rid.bootBlockVer));
4724 data->readlen = strlen( data->rbuffer );
4725 return 0;
4726 }
4727
4728 static int proc_stats_rid_open(struct inode*, struct file*, u16);
4729 static int proc_statsdelta_open( struct inode *inode,
4730 struct file *file ) {
4731 if (file->f_mode&FMODE_WRITE) {
4732 return proc_stats_rid_open(inode, file, RID_STATSDELTACLEAR);
4733 }
4734 return proc_stats_rid_open(inode, file, RID_STATSDELTA);
4735 }
4736
4737 static int proc_stats_open( struct inode *inode, struct file *file ) {
4738 return proc_stats_rid_open(inode, file, RID_STATS);
4739 }
4740
4741 static int proc_stats_rid_open( struct inode *inode,
4742 struct file *file,
4743 u16 rid )
4744 {
4745 struct proc_data *data;
4746 struct proc_dir_entry *dp = PDE(inode);
4747 struct net_device *dev = dp->data;
4748 struct airo_info *apriv = dev->ml_priv;
4749 StatsRid stats;
4750 int i, j;
4751 __le32 *vals = stats.vals;
4752 int len;
4753
4754 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4755 return -ENOMEM;
4756 data = (struct proc_data *)file->private_data;
4757 if ((data->rbuffer = kmalloc( 4096, GFP_KERNEL )) == NULL) {
4758 kfree (file->private_data);
4759 return -ENOMEM;
4760 }
4761
4762 readStatsRid(apriv, &stats, rid, 1);
4763 len = le16_to_cpu(stats.len);
4764
4765 j = 0;
4766 for(i=0; statsLabels[i]!=(char *)-1 && i*4<len; i++) {
4767 if (!statsLabels[i]) continue;
4768 if (j+strlen(statsLabels[i])+16>4096) {
4769 airo_print_warn(apriv->dev->name,
4770 "Potentially disasterous buffer overflow averted!");
4771 break;
4772 }
4773 j+=sprintf(data->rbuffer+j, "%s: %u\n", statsLabels[i],
4774 le32_to_cpu(vals[i]));
4775 }
4776 if (i*4 >= len) {
4777 airo_print_warn(apriv->dev->name, "Got a short rid");
4778 }
4779 data->readlen = j;
4780 return 0;
4781 }
4782
4783 static int get_dec_u16( char *buffer, int *start, int limit ) {
4784 u16 value;
4785 int valid = 0;
4786 for( value = 0; buffer[*start] >= '0' &&
4787 buffer[*start] <= '9' &&
4788 *start < limit; (*start)++ ) {
4789 valid = 1;
4790 value *= 10;
4791 value += buffer[*start] - '0';
4792 }
4793 if ( !valid ) return -1;
4794 return value;
4795 }
4796
4797 static int airo_config_commit(struct net_device *dev,
4798 struct iw_request_info *info, void *zwrq,
4799 char *extra);
4800
4801 static inline int sniffing_mode(struct airo_info *ai)
4802 {
4803 return le16_to_cpu(ai->config.rmode & RXMODE_MASK) >=
4804 le16_to_cpu(RXMODE_RFMON);
4805 }
4806
4807 static void proc_config_on_close(struct inode *inode, struct file *file)
4808 {
4809 struct proc_data *data = file->private_data;
4810 struct proc_dir_entry *dp = PDE(inode);
4811 struct net_device *dev = dp->data;
4812 struct airo_info *ai = dev->ml_priv;
4813 char *line;
4814
4815 if ( !data->writelen ) return;
4816
4817 readConfigRid(ai, 1);
4818 set_bit (FLAG_COMMIT, &ai->flags);
4819
4820 line = data->wbuffer;
4821 while( line[0] ) {
4822 /*** Mode processing */
4823 if ( !strncmp( line, "Mode: ", 6 ) ) {
4824 line += 6;
4825 if (sniffing_mode(ai))
4826 set_bit (FLAG_RESET, &ai->flags);
4827 ai->config.rmode &= ~RXMODE_FULL_MASK;
4828 clear_bit (FLAG_802_11, &ai->flags);
4829 ai->config.opmode &= ~MODE_CFG_MASK;
4830 ai->config.scanMode = SCANMODE_ACTIVE;
4831 if ( line[0] == 'a' ) {
4832 ai->config.opmode |= MODE_STA_IBSS;
4833 } else {
4834 ai->config.opmode |= MODE_STA_ESS;
4835 if ( line[0] == 'r' ) {
4836 ai->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
4837 ai->config.scanMode = SCANMODE_PASSIVE;
4838 set_bit (FLAG_802_11, &ai->flags);
4839 } else if ( line[0] == 'y' ) {
4840 ai->config.rmode |= RXMODE_RFMON_ANYBSS | RXMODE_DISABLE_802_3_HEADER;
4841 ai->config.scanMode = SCANMODE_PASSIVE;
4842 set_bit (FLAG_802_11, &ai->flags);
4843 } else if ( line[0] == 'l' )
4844 ai->config.rmode |= RXMODE_LANMON;
4845 }
4846 set_bit (FLAG_COMMIT, &ai->flags);
4847 }
4848
4849 /*** Radio status */
4850 else if (!strncmp(line,"Radio: ", 7)) {
4851 line += 7;
4852 if (!strncmp(line,"off",3)) {
4853 set_bit (FLAG_RADIO_OFF, &ai->flags);
4854 } else {
4855 clear_bit (FLAG_RADIO_OFF, &ai->flags);
4856 }
4857 }
4858 /*** NodeName processing */
4859 else if ( !strncmp( line, "NodeName: ", 10 ) ) {
4860 int j;
4861
4862 line += 10;
4863 memset( ai->config.nodeName, 0, 16 );
4864 /* Do the name, assume a space between the mode and node name */
4865 for( j = 0; j < 16 && line[j] != '\n'; j++ ) {
4866 ai->config.nodeName[j] = line[j];
4867 }
4868 set_bit (FLAG_COMMIT, &ai->flags);
4869 }
4870
4871 /*** PowerMode processing */
4872 else if ( !strncmp( line, "PowerMode: ", 11 ) ) {
4873 line += 11;
4874 if ( !strncmp( line, "PSPCAM", 6 ) ) {
4875 ai->config.powerSaveMode = POWERSAVE_PSPCAM;
4876 set_bit (FLAG_COMMIT, &ai->flags);
4877 } else if ( !strncmp( line, "PSP", 3 ) ) {
4878 ai->config.powerSaveMode = POWERSAVE_PSP;
4879 set_bit (FLAG_COMMIT, &ai->flags);
4880 } else {
4881 ai->config.powerSaveMode = POWERSAVE_CAM;
4882 set_bit (FLAG_COMMIT, &ai->flags);
4883 }
4884 } else if ( !strncmp( line, "DataRates: ", 11 ) ) {
4885 int v, i = 0, k = 0; /* i is index into line,
4886 k is index to rates */
4887
4888 line += 11;
4889 while((v = get_dec_u16(line, &i, 3))!=-1) {
4890 ai->config.rates[k++] = (u8)v;
4891 line += i + 1;
4892 i = 0;
4893 }
4894 set_bit (FLAG_COMMIT, &ai->flags);
4895 } else if ( !strncmp( line, "Channel: ", 9 ) ) {
4896 int v, i = 0;
4897 line += 9;
4898 v = get_dec_u16(line, &i, i+3);
4899 if ( v != -1 ) {
4900 ai->config.channelSet = cpu_to_le16(v);
4901 set_bit (FLAG_COMMIT, &ai->flags);
4902 }
4903 } else if ( !strncmp( line, "XmitPower: ", 11 ) ) {
4904 int v, i = 0;
4905 line += 11;
4906 v = get_dec_u16(line, &i, i+3);
4907 if ( v != -1 ) {
4908 ai->config.txPower = cpu_to_le16(v);
4909 set_bit (FLAG_COMMIT, &ai->flags);
4910 }
4911 } else if ( !strncmp( line, "WEP: ", 5 ) ) {
4912 line += 5;
4913 switch( line[0] ) {
4914 case 's':
4915 ai->config.authType = AUTH_SHAREDKEY;
4916 break;
4917 case 'e':
4918 ai->config.authType = AUTH_ENCRYPT;
4919 break;
4920 default:
4921 ai->config.authType = AUTH_OPEN;
4922 break;
4923 }
4924 set_bit (FLAG_COMMIT, &ai->flags);
4925 } else if ( !strncmp( line, "LongRetryLimit: ", 16 ) ) {
4926 int v, i = 0;
4927
4928 line += 16;
4929 v = get_dec_u16(line, &i, 3);
4930 v = (v<0) ? 0 : ((v>255) ? 255 : v);
4931 ai->config.longRetryLimit = cpu_to_le16(v);
4932 set_bit (FLAG_COMMIT, &ai->flags);
4933 } else if ( !strncmp( line, "ShortRetryLimit: ", 17 ) ) {
4934 int v, i = 0;
4935
4936 line += 17;
4937 v = get_dec_u16(line, &i, 3);
4938 v = (v<0) ? 0 : ((v>255) ? 255 : v);
4939 ai->config.shortRetryLimit = cpu_to_le16(v);
4940 set_bit (FLAG_COMMIT, &ai->flags);
4941 } else if ( !strncmp( line, "RTSThreshold: ", 14 ) ) {
4942 int v, i = 0;
4943
4944 line += 14;
4945 v = get_dec_u16(line, &i, 4);
4946 v = (v<0) ? 0 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4947 ai->config.rtsThres = cpu_to_le16(v);
4948 set_bit (FLAG_COMMIT, &ai->flags);
4949 } else if ( !strncmp( line, "TXMSDULifetime: ", 16 ) ) {
4950 int v, i = 0;
4951
4952 line += 16;
4953 v = get_dec_u16(line, &i, 5);
4954 v = (v<0) ? 0 : v;
4955 ai->config.txLifetime = cpu_to_le16(v);
4956 set_bit (FLAG_COMMIT, &ai->flags);
4957 } else if ( !strncmp( line, "RXMSDULifetime: ", 16 ) ) {
4958 int v, i = 0;
4959
4960 line += 16;
4961 v = get_dec_u16(line, &i, 5);
4962 v = (v<0) ? 0 : v;
4963 ai->config.rxLifetime = cpu_to_le16(v);
4964 set_bit (FLAG_COMMIT, &ai->flags);
4965 } else if ( !strncmp( line, "TXDiversity: ", 13 ) ) {
4966 ai->config.txDiversity =
4967 (line[13]=='l') ? 1 :
4968 ((line[13]=='r')? 2: 3);
4969 set_bit (FLAG_COMMIT, &ai->flags);
4970 } else if ( !strncmp( line, "RXDiversity: ", 13 ) ) {
4971 ai->config.rxDiversity =
4972 (line[13]=='l') ? 1 :
4973 ((line[13]=='r')? 2: 3);
4974 set_bit (FLAG_COMMIT, &ai->flags);
4975 } else if ( !strncmp( line, "FragThreshold: ", 15 ) ) {
4976 int v, i = 0;
4977
4978 line += 15;
4979 v = get_dec_u16(line, &i, 4);
4980 v = (v<256) ? 256 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4981 v = v & 0xfffe; /* Make sure its even */
4982 ai->config.fragThresh = cpu_to_le16(v);
4983 set_bit (FLAG_COMMIT, &ai->flags);
4984 } else if (!strncmp(line, "Modulation: ", 12)) {
4985 line += 12;
4986 switch(*line) {
4987 case 'd': ai->config.modulation=MOD_DEFAULT; set_bit(FLAG_COMMIT, &ai->flags); break;
4988 case 'c': ai->config.modulation=MOD_CCK; set_bit(FLAG_COMMIT, &ai->flags); break;
4989 case 'm': ai->config.modulation=MOD_MOK; set_bit(FLAG_COMMIT, &ai->flags); break;
4990 default: airo_print_warn(ai->dev->name, "Unknown modulation");
4991 }
4992 } else if (!strncmp(line, "Preamble: ", 10)) {
4993 line += 10;
4994 switch(*line) {
4995 case 'a': ai->config.preamble=PREAMBLE_AUTO; set_bit(FLAG_COMMIT, &ai->flags); break;
4996 case 'l': ai->config.preamble=PREAMBLE_LONG; set_bit(FLAG_COMMIT, &ai->flags); break;
4997 case 's': ai->config.preamble=PREAMBLE_SHORT; set_bit(FLAG_COMMIT, &ai->flags); break;
4998 default: airo_print_warn(ai->dev->name, "Unknown preamble");
4999 }
5000 } else {
5001 airo_print_warn(ai->dev->name, "Couldn't figure out %s", line);
5002 }
5003 while( line[0] && line[0] != '\n' ) line++;
5004 if ( line[0] ) line++;
5005 }
5006 airo_config_commit(dev, NULL, NULL, NULL);
5007 }
5008
5009 static char *get_rmode(__le16 mode)
5010 {
5011 switch(mode & RXMODE_MASK) {
5012 case RXMODE_RFMON: return "rfmon";
5013 case RXMODE_RFMON_ANYBSS: return "yna (any) bss rfmon";
5014 case RXMODE_LANMON: return "lanmon";
5015 }
5016 return "ESS";
5017 }
5018
5019 static int proc_config_open(struct inode *inode, struct file *file)
5020 {
5021 struct proc_data *data;
5022 struct proc_dir_entry *dp = PDE(inode);
5023 struct net_device *dev = dp->data;
5024 struct airo_info *ai = dev->ml_priv;
5025 int i;
5026 __le16 mode;
5027
5028 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5029 return -ENOMEM;
5030 data = (struct proc_data *)file->private_data;
5031 if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
5032 kfree (file->private_data);
5033 return -ENOMEM;
5034 }
5035 if ((data->wbuffer = kzalloc( 2048, GFP_KERNEL )) == NULL) {
5036 kfree (data->rbuffer);
5037 kfree (file->private_data);
5038 return -ENOMEM;
5039 }
5040 data->maxwritelen = 2048;
5041 data->on_close = proc_config_on_close;
5042
5043 readConfigRid(ai, 1);
5044
5045 mode = ai->config.opmode & MODE_CFG_MASK;
5046 i = sprintf( data->rbuffer,
5047 "Mode: %s\n"
5048 "Radio: %s\n"
5049 "NodeName: %-16s\n"
5050 "PowerMode: %s\n"
5051 "DataRates: %d %d %d %d %d %d %d %d\n"
5052 "Channel: %d\n"
5053 "XmitPower: %d\n",
5054 mode == MODE_STA_IBSS ? "adhoc" :
5055 mode == MODE_STA_ESS ? get_rmode(ai->config.rmode):
5056 mode == MODE_AP ? "AP" :
5057 mode == MODE_AP_RPTR ? "AP RPTR" : "Error",
5058 test_bit(FLAG_RADIO_OFF, &ai->flags) ? "off" : "on",
5059 ai->config.nodeName,
5060 ai->config.powerSaveMode == POWERSAVE_CAM ? "CAM" :
5061 ai->config.powerSaveMode == POWERSAVE_PSP ? "PSP" :
5062 ai->config.powerSaveMode == POWERSAVE_PSPCAM ? "PSPCAM" :
5063 "Error",
5064 (int)ai->config.rates[0],
5065 (int)ai->config.rates[1],
5066 (int)ai->config.rates[2],
5067 (int)ai->config.rates[3],
5068 (int)ai->config.rates[4],
5069 (int)ai->config.rates[5],
5070 (int)ai->config.rates[6],
5071 (int)ai->config.rates[7],
5072 le16_to_cpu(ai->config.channelSet),
5073 le16_to_cpu(ai->config.txPower)
5074 );
5075 sprintf( data->rbuffer + i,
5076 "LongRetryLimit: %d\n"
5077 "ShortRetryLimit: %d\n"
5078 "RTSThreshold: %d\n"
5079 "TXMSDULifetime: %d\n"
5080 "RXMSDULifetime: %d\n"
5081 "TXDiversity: %s\n"
5082 "RXDiversity: %s\n"
5083 "FragThreshold: %d\n"
5084 "WEP: %s\n"
5085 "Modulation: %s\n"
5086 "Preamble: %s\n",
5087 le16_to_cpu(ai->config.longRetryLimit),
5088 le16_to_cpu(ai->config.shortRetryLimit),
5089 le16_to_cpu(ai->config.rtsThres),
5090 le16_to_cpu(ai->config.txLifetime),
5091 le16_to_cpu(ai->config.rxLifetime),
5092 ai->config.txDiversity == 1 ? "left" :
5093 ai->config.txDiversity == 2 ? "right" : "both",
5094 ai->config.rxDiversity == 1 ? "left" :
5095 ai->config.rxDiversity == 2 ? "right" : "both",
5096 le16_to_cpu(ai->config.fragThresh),
5097 ai->config.authType == AUTH_ENCRYPT ? "encrypt" :
5098 ai->config.authType == AUTH_SHAREDKEY ? "shared" : "open",
5099 ai->config.modulation == MOD_DEFAULT ? "default" :
5100 ai->config.modulation == MOD_CCK ? "cck" :
5101 ai->config.modulation == MOD_MOK ? "mok" : "error",
5102 ai->config.preamble == PREAMBLE_AUTO ? "auto" :
5103 ai->config.preamble == PREAMBLE_LONG ? "long" :
5104 ai->config.preamble == PREAMBLE_SHORT ? "short" : "error"
5105 );
5106 data->readlen = strlen( data->rbuffer );
5107 return 0;
5108 }
5109
5110 static void proc_SSID_on_close(struct inode *inode, struct file *file)
5111 {
5112 struct proc_data *data = (struct proc_data *)file->private_data;
5113 struct proc_dir_entry *dp = PDE(inode);
5114 struct net_device *dev = dp->data;
5115 struct airo_info *ai = dev->ml_priv;
5116 SsidRid SSID_rid;
5117 int i;
5118 char *p = data->wbuffer;
5119 char *end = p + data->writelen;
5120
5121 if (!data->writelen)
5122 return;
5123
5124 *end = '\n'; /* sentinel; we have space for it */
5125
5126 memset(&SSID_rid, 0, sizeof(SSID_rid));
5127
5128 for (i = 0; i < 3 && p < end; i++) {
5129 int j = 0;
5130 /* copy up to 32 characters from this line */
5131 while (*p != '\n' && j < 32)
5132 SSID_rid.ssids[i].ssid[j++] = *p++;
5133 if (j == 0)
5134 break;
5135 SSID_rid.ssids[i].len = cpu_to_le16(j);
5136 /* skip to the beginning of the next line */
5137 while (*p++ != '\n')
5138 ;
5139 }
5140 if (i)
5141 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5142 disable_MAC(ai, 1);
5143 writeSsidRid(ai, &SSID_rid, 1);
5144 enable_MAC(ai, 1);
5145 }
5146
5147 static inline u8 hexVal(char c) {
5148 if (c>='0' && c<='9') return c -= '0';
5149 if (c>='a' && c<='f') return c -= 'a'-10;
5150 if (c>='A' && c<='F') return c -= 'A'-10;
5151 return 0;
5152 }
5153
5154 static void proc_APList_on_close( struct inode *inode, struct file *file ) {
5155 struct proc_data *data = (struct proc_data *)file->private_data;
5156 struct proc_dir_entry *dp = PDE(inode);
5157 struct net_device *dev = dp->data;
5158 struct airo_info *ai = dev->ml_priv;
5159 APListRid APList_rid;
5160 int i;
5161
5162 if ( !data->writelen ) return;
5163
5164 memset( &APList_rid, 0, sizeof(APList_rid) );
5165 APList_rid.len = cpu_to_le16(sizeof(APList_rid));
5166
5167 for( i = 0; i < 4 && data->writelen >= (i+1)*6*3; i++ ) {
5168 int j;
5169 for( j = 0; j < 6*3 && data->wbuffer[j+i*6*3]; j++ ) {
5170 switch(j%3) {
5171 case 0:
5172 APList_rid.ap[i][j/3]=
5173 hexVal(data->wbuffer[j+i*6*3])<<4;
5174 break;
5175 case 1:
5176 APList_rid.ap[i][j/3]|=
5177 hexVal(data->wbuffer[j+i*6*3]);
5178 break;
5179 }
5180 }
5181 }
5182 disable_MAC(ai, 1);
5183 writeAPListRid(ai, &APList_rid, 1);
5184 enable_MAC(ai, 1);
5185 }
5186
5187 /* This function wraps PC4500_writerid with a MAC disable */
5188 static int do_writerid( struct airo_info *ai, u16 rid, const void *rid_data,
5189 int len, int dummy ) {
5190 int rc;
5191
5192 disable_MAC(ai, 1);
5193 rc = PC4500_writerid(ai, rid, rid_data, len, 1);
5194 enable_MAC(ai, 1);
5195 return rc;
5196 }
5197
5198 /* Returns the WEP key at the specified index, or -1 if that key does
5199 * not exist. The buffer is assumed to be at least 16 bytes in length.
5200 */
5201 static int get_wep_key(struct airo_info *ai, u16 index, char *buf, u16 buflen)
5202 {
5203 WepKeyRid wkr;
5204 int rc;
5205 __le16 lastindex;
5206
5207 rc = readWepKeyRid(ai, &wkr, 1, 1);
5208 if (rc != SUCCESS)
5209 return -1;
5210 do {
5211 lastindex = wkr.kindex;
5212 if (le16_to_cpu(wkr.kindex) == index) {
5213 int klen = min_t(int, buflen, le16_to_cpu(wkr.klen));
5214 memcpy(buf, wkr.key, klen);
5215 return klen;
5216 }
5217 rc = readWepKeyRid(ai, &wkr, 0, 1);
5218 if (rc != SUCCESS)
5219 return -1;
5220 } while (lastindex != wkr.kindex);
5221 return -1;
5222 }
5223
5224 static int get_wep_tx_idx(struct airo_info *ai)
5225 {
5226 WepKeyRid wkr;
5227 int rc;
5228 __le16 lastindex;
5229
5230 rc = readWepKeyRid(ai, &wkr, 1, 1);
5231 if (rc != SUCCESS)
5232 return -1;
5233 do {
5234 lastindex = wkr.kindex;
5235 if (wkr.kindex == cpu_to_le16(0xffff))
5236 return wkr.mac[0];
5237 rc = readWepKeyRid(ai, &wkr, 0, 1);
5238 if (rc != SUCCESS)
5239 return -1;
5240 } while (lastindex != wkr.kindex);
5241 return -1;
5242 }
5243
5244 static int set_wep_key(struct airo_info *ai, u16 index, const char *key,
5245 u16 keylen, int perm, int lock)
5246 {
5247 static const unsigned char macaddr[ETH_ALEN] = { 0x01, 0, 0, 0, 0, 0 };
5248 WepKeyRid wkr;
5249 int rc;
5250
5251 if (keylen == 0) {
5252 airo_print_err(ai->dev->name, "%s: key length to set was zero",
5253 __func__);
5254 return -1;
5255 }
5256
5257 memset(&wkr, 0, sizeof(wkr));
5258 wkr.len = cpu_to_le16(sizeof(wkr));
5259 wkr.kindex = cpu_to_le16(index);
5260 wkr.klen = cpu_to_le16(keylen);
5261 memcpy(wkr.key, key, keylen);
5262 memcpy(wkr.mac, macaddr, ETH_ALEN);
5263
5264 if (perm) disable_MAC(ai, lock);
5265 rc = writeWepKeyRid(ai, &wkr, perm, lock);
5266 if (perm) enable_MAC(ai, lock);
5267 return rc;
5268 }
5269
5270 static int set_wep_tx_idx(struct airo_info *ai, u16 index, int perm, int lock)
5271 {
5272 WepKeyRid wkr;
5273 int rc;
5274
5275 memset(&wkr, 0, sizeof(wkr));
5276 wkr.len = cpu_to_le16(sizeof(wkr));
5277 wkr.kindex = cpu_to_le16(0xffff);
5278 wkr.mac[0] = (char)index;
5279
5280 if (perm) {
5281 ai->defindex = (char)index;
5282 disable_MAC(ai, lock);
5283 }
5284
5285 rc = writeWepKeyRid(ai, &wkr, perm, lock);
5286
5287 if (perm)
5288 enable_MAC(ai, lock);
5289 return rc;
5290 }
5291
5292 static void proc_wepkey_on_close( struct inode *inode, struct file *file ) {
5293 struct proc_data *data;
5294 struct proc_dir_entry *dp = PDE(inode);
5295 struct net_device *dev = dp->data;
5296 struct airo_info *ai = dev->ml_priv;
5297 int i, rc;
5298 char key[16];
5299 u16 index = 0;
5300 int j = 0;
5301
5302 memset(key, 0, sizeof(key));
5303
5304 data = (struct proc_data *)file->private_data;
5305 if ( !data->writelen ) return;
5306
5307 if (data->wbuffer[0] >= '0' && data->wbuffer[0] <= '3' &&
5308 (data->wbuffer[1] == ' ' || data->wbuffer[1] == '\n')) {
5309 index = data->wbuffer[0] - '0';
5310 if (data->wbuffer[1] == '\n') {
5311 rc = set_wep_tx_idx(ai, index, 1, 1);
5312 if (rc < 0) {
5313 airo_print_err(ai->dev->name, "failed to set "
5314 "WEP transmit index to %d: %d.",
5315 index, rc);
5316 }
5317 return;
5318 }
5319 j = 2;
5320 } else {
5321 airo_print_err(ai->dev->name, "WepKey passed invalid key index");
5322 return;
5323 }
5324
5325 for( i = 0; i < 16*3 && data->wbuffer[i+j]; i++ ) {
5326 switch(i%3) {
5327 case 0:
5328 key[i/3] = hexVal(data->wbuffer[i+j])<<4;
5329 break;
5330 case 1:
5331 key[i/3] |= hexVal(data->wbuffer[i+j]);
5332 break;
5333 }
5334 }
5335
5336 rc = set_wep_key(ai, index, key, i/3, 1, 1);
5337 if (rc < 0) {
5338 airo_print_err(ai->dev->name, "failed to set WEP key at index "
5339 "%d: %d.", index, rc);
5340 }
5341 }
5342
5343 static int proc_wepkey_open( struct inode *inode, struct file *file )
5344 {
5345 struct proc_data *data;
5346 struct proc_dir_entry *dp = PDE(inode);
5347 struct net_device *dev = dp->data;
5348 struct airo_info *ai = dev->ml_priv;
5349 char *ptr;
5350 WepKeyRid wkr;
5351 __le16 lastindex;
5352 int j=0;
5353 int rc;
5354
5355 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5356 return -ENOMEM;
5357 memset(&wkr, 0, sizeof(wkr));
5358 data = (struct proc_data *)file->private_data;
5359 if ((data->rbuffer = kzalloc( 180, GFP_KERNEL )) == NULL) {
5360 kfree (file->private_data);
5361 return -ENOMEM;
5362 }
5363 data->writelen = 0;
5364 data->maxwritelen = 80;
5365 if ((data->wbuffer = kzalloc( 80, GFP_KERNEL )) == NULL) {
5366 kfree (data->rbuffer);
5367 kfree (file->private_data);
5368 return -ENOMEM;
5369 }
5370 data->on_close = proc_wepkey_on_close;
5371
5372 ptr = data->rbuffer;
5373 strcpy(ptr, "No wep keys\n");
5374 rc = readWepKeyRid(ai, &wkr, 1, 1);
5375 if (rc == SUCCESS) do {
5376 lastindex = wkr.kindex;
5377 if (wkr.kindex == cpu_to_le16(0xffff)) {
5378 j += sprintf(ptr+j, "Tx key = %d\n",
5379 (int)wkr.mac[0]);
5380 } else {
5381 j += sprintf(ptr+j, "Key %d set with length = %d\n",
5382 le16_to_cpu(wkr.kindex),
5383 le16_to_cpu(wkr.klen));
5384 }
5385 readWepKeyRid(ai, &wkr, 0, 1);
5386 } while((lastindex != wkr.kindex) && (j < 180-30));
5387
5388 data->readlen = strlen( data->rbuffer );
5389 return 0;
5390 }
5391
5392 static int proc_SSID_open(struct inode *inode, struct file *file)
5393 {
5394 struct proc_data *data;
5395 struct proc_dir_entry *dp = PDE(inode);
5396 struct net_device *dev = dp->data;
5397 struct airo_info *ai = dev->ml_priv;
5398 int i;
5399 char *ptr;
5400 SsidRid SSID_rid;
5401
5402 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5403 return -ENOMEM;
5404 data = (struct proc_data *)file->private_data;
5405 if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5406 kfree (file->private_data);
5407 return -ENOMEM;
5408 }
5409 data->writelen = 0;
5410 data->maxwritelen = 33*3;
5411 /* allocate maxwritelen + 1; we'll want a sentinel */
5412 if ((data->wbuffer = kzalloc(33*3 + 1, GFP_KERNEL)) == NULL) {
5413 kfree (data->rbuffer);
5414 kfree (file->private_data);
5415 return -ENOMEM;
5416 }
5417 data->on_close = proc_SSID_on_close;
5418
5419 readSsidRid(ai, &SSID_rid);
5420 ptr = data->rbuffer;
5421 for (i = 0; i < 3; i++) {
5422 int j;
5423 size_t len = le16_to_cpu(SSID_rid.ssids[i].len);
5424 if (!len)
5425 break;
5426 if (len > 32)
5427 len = 32;
5428 for (j = 0; j < len && SSID_rid.ssids[i].ssid[j]; j++)
5429 *ptr++ = SSID_rid.ssids[i].ssid[j];
5430 *ptr++ = '\n';
5431 }
5432 *ptr = '\0';
5433 data->readlen = strlen( data->rbuffer );
5434 return 0;
5435 }
5436
5437 static int proc_APList_open( struct inode *inode, struct file *file ) {
5438 struct proc_data *data;
5439 struct proc_dir_entry *dp = PDE(inode);
5440 struct net_device *dev = dp->data;
5441 struct airo_info *ai = dev->ml_priv;
5442 int i;
5443 char *ptr;
5444 APListRid APList_rid;
5445
5446 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5447 return -ENOMEM;
5448 data = (struct proc_data *)file->private_data;
5449 if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5450 kfree (file->private_data);
5451 return -ENOMEM;
5452 }
5453 data->writelen = 0;
5454 data->maxwritelen = 4*6*3;
5455 if ((data->wbuffer = kzalloc( data->maxwritelen, GFP_KERNEL )) == NULL) {
5456 kfree (data->rbuffer);
5457 kfree (file->private_data);
5458 return -ENOMEM;
5459 }
5460 data->on_close = proc_APList_on_close;
5461
5462 readAPListRid(ai, &APList_rid);
5463 ptr = data->rbuffer;
5464 for( i = 0; i < 4; i++ ) {
5465 // We end when we find a zero MAC
5466 if ( !*(int*)APList_rid.ap[i] &&
5467 !*(int*)&APList_rid.ap[i][2]) break;
5468 ptr += sprintf(ptr, "%pM\n", APList_rid.ap[i]);
5469 }
5470 if (i==0) ptr += sprintf(ptr, "Not using specific APs\n");
5471
5472 *ptr = '\0';
5473 data->readlen = strlen( data->rbuffer );
5474 return 0;
5475 }
5476
5477 static int proc_BSSList_open( struct inode *inode, struct file *file ) {
5478 struct proc_data *data;
5479 struct proc_dir_entry *dp = PDE(inode);
5480 struct net_device *dev = dp->data;
5481 struct airo_info *ai = dev->ml_priv;
5482 char *ptr;
5483 BSSListRid BSSList_rid;
5484 int rc;
5485 /* If doLoseSync is not 1, we won't do a Lose Sync */
5486 int doLoseSync = -1;
5487
5488 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5489 return -ENOMEM;
5490 data = (struct proc_data *)file->private_data;
5491 if ((data->rbuffer = kmalloc( 1024, GFP_KERNEL )) == NULL) {
5492 kfree (file->private_data);
5493 return -ENOMEM;
5494 }
5495 data->writelen = 0;
5496 data->maxwritelen = 0;
5497 data->wbuffer = NULL;
5498 data->on_close = NULL;
5499
5500 if (file->f_mode & FMODE_WRITE) {
5501 if (!(file->f_mode & FMODE_READ)) {
5502 Cmd cmd;
5503 Resp rsp;
5504
5505 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
5506 memset(&cmd, 0, sizeof(cmd));
5507 cmd.cmd=CMD_LISTBSS;
5508 if (down_interruptible(&ai->sem))
5509 return -ERESTARTSYS;
5510 issuecommand(ai, &cmd, &rsp);
5511 up(&ai->sem);
5512 data->readlen = 0;
5513 return 0;
5514 }
5515 doLoseSync = 1;
5516 }
5517 ptr = data->rbuffer;
5518 /* There is a race condition here if there are concurrent opens.
5519 Since it is a rare condition, we'll just live with it, otherwise
5520 we have to add a spin lock... */
5521 rc = readBSSListRid(ai, doLoseSync, &BSSList_rid);
5522 while(rc == 0 && BSSList_rid.index != cpu_to_le16(0xffff)) {
5523 ptr += sprintf(ptr, "%pM %*s rssi = %d",
5524 BSSList_rid.bssid,
5525 (int)BSSList_rid.ssidLen,
5526 BSSList_rid.ssid,
5527 le16_to_cpu(BSSList_rid.dBm));
5528 ptr += sprintf(ptr, " channel = %d %s %s %s %s\n",
5529 le16_to_cpu(BSSList_rid.dsChannel),
5530 BSSList_rid.cap & CAP_ESS ? "ESS" : "",
5531 BSSList_rid.cap & CAP_IBSS ? "adhoc" : "",
5532 BSSList_rid.cap & CAP_PRIVACY ? "wep" : "",
5533 BSSList_rid.cap & CAP_SHORTHDR ? "shorthdr" : "");
5534 rc = readBSSListRid(ai, 0, &BSSList_rid);
5535 }
5536 *ptr = '\0';
5537 data->readlen = strlen( data->rbuffer );
5538 return 0;
5539 }
5540
5541 static int proc_close( struct inode *inode, struct file *file )
5542 {
5543 struct proc_data *data = file->private_data;
5544
5545 if (data->on_close != NULL)
5546 data->on_close(inode, file);
5547 kfree(data->rbuffer);
5548 kfree(data->wbuffer);
5549 kfree(data);
5550 return 0;
5551 }
5552
5553 /* Since the card doesn't automatically switch to the right WEP mode,
5554 we will make it do it. If the card isn't associated, every secs we
5555 will switch WEP modes to see if that will help. If the card is
5556 associated we will check every minute to see if anything has
5557 changed. */
5558 static void timer_func( struct net_device *dev ) {
5559 struct airo_info *apriv = dev->ml_priv;
5560
5561 /* We don't have a link so try changing the authtype */
5562 readConfigRid(apriv, 0);
5563 disable_MAC(apriv, 0);
5564 switch(apriv->config.authType) {
5565 case AUTH_ENCRYPT:
5566 /* So drop to OPEN */
5567 apriv->config.authType = AUTH_OPEN;
5568 break;
5569 case AUTH_SHAREDKEY:
5570 if (apriv->keyindex < auto_wep) {
5571 set_wep_tx_idx(apriv, apriv->keyindex, 0, 0);
5572 apriv->config.authType = AUTH_SHAREDKEY;
5573 apriv->keyindex++;
5574 } else {
5575 /* Drop to ENCRYPT */
5576 apriv->keyindex = 0;
5577 set_wep_tx_idx(apriv, apriv->defindex, 0, 0);
5578 apriv->config.authType = AUTH_ENCRYPT;
5579 }
5580 break;
5581 default: /* We'll escalate to SHAREDKEY */
5582 apriv->config.authType = AUTH_SHAREDKEY;
5583 }
5584 set_bit (FLAG_COMMIT, &apriv->flags);
5585 writeConfigRid(apriv, 0);
5586 enable_MAC(apriv, 0);
5587 up(&apriv->sem);
5588
5589 /* Schedule check to see if the change worked */
5590 clear_bit(JOB_AUTOWEP, &apriv->jobs);
5591 apriv->expires = RUN_AT(HZ*3);
5592 }
5593
5594 #ifdef CONFIG_PCI
5595 static int __devinit airo_pci_probe(struct pci_dev *pdev,
5596 const struct pci_device_id *pent)
5597 {
5598 struct net_device *dev;
5599
5600 if (pci_enable_device(pdev))
5601 return -ENODEV;
5602 pci_set_master(pdev);
5603
5604 if (pdev->device == 0x5000 || pdev->device == 0xa504)
5605 dev = _init_airo_card(pdev->irq, pdev->resource[0].start, 0, pdev, &pdev->dev);
5606 else
5607 dev = _init_airo_card(pdev->irq, pdev->resource[2].start, 0, pdev, &pdev->dev);
5608 if (!dev) {
5609 pci_disable_device(pdev);
5610 return -ENODEV;
5611 }
5612
5613 pci_set_drvdata(pdev, dev);
5614 return 0;
5615 }
5616
5617 static void __devexit airo_pci_remove(struct pci_dev *pdev)
5618 {
5619 struct net_device *dev = pci_get_drvdata(pdev);
5620
5621 airo_print_info(dev->name, "Unregistering...");
5622 stop_airo_card(dev, 1);
5623 pci_disable_device(pdev);
5624 pci_set_drvdata(pdev, NULL);
5625 }
5626
5627 static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state)
5628 {
5629 struct net_device *dev = pci_get_drvdata(pdev);
5630 struct airo_info *ai = dev->ml_priv;
5631 Cmd cmd;
5632 Resp rsp;
5633
5634 if (!ai->APList)
5635 ai->APList = kmalloc(sizeof(APListRid), GFP_KERNEL);
5636 if (!ai->APList)
5637 return -ENOMEM;
5638 if (!ai->SSID)
5639 ai->SSID = kmalloc(sizeof(SsidRid), GFP_KERNEL);
5640 if (!ai->SSID)
5641 return -ENOMEM;
5642 readAPListRid(ai, ai->APList);
5643 readSsidRid(ai, ai->SSID);
5644 memset(&cmd, 0, sizeof(cmd));
5645 /* the lock will be released at the end of the resume callback */
5646 if (down_interruptible(&ai->sem))
5647 return -EAGAIN;
5648 disable_MAC(ai, 0);
5649 netif_device_detach(dev);
5650 ai->power = state;
5651 cmd.cmd = HOSTSLEEP;
5652 issuecommand(ai, &cmd, &rsp);
5653
5654 pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
5655 pci_save_state(pdev);
5656 return pci_set_power_state(pdev, pci_choose_state(pdev, state));
5657 }
5658
5659 static int airo_pci_resume(struct pci_dev *pdev)
5660 {
5661 struct net_device *dev = pci_get_drvdata(pdev);
5662 struct airo_info *ai = dev->ml_priv;
5663 pci_power_t prev_state = pdev->current_state;
5664
5665 pci_set_power_state(pdev, PCI_D0);
5666 pci_restore_state(pdev);
5667 pci_enable_wake(pdev, PCI_D0, 0);
5668
5669 if (prev_state != PCI_D1) {
5670 reset_card(dev, 0);
5671 mpi_init_descriptors(ai);
5672 setup_card(ai, dev->dev_addr, 0);
5673 clear_bit(FLAG_RADIO_OFF, &ai->flags);
5674 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
5675 } else {
5676 OUT4500(ai, EVACK, EV_AWAKEN);
5677 OUT4500(ai, EVACK, EV_AWAKEN);
5678 msleep(100);
5679 }
5680
5681 set_bit(FLAG_COMMIT, &ai->flags);
5682 disable_MAC(ai, 0);
5683 msleep(200);
5684 if (ai->SSID) {
5685 writeSsidRid(ai, ai->SSID, 0);
5686 kfree(ai->SSID);
5687 ai->SSID = NULL;
5688 }
5689 if (ai->APList) {
5690 writeAPListRid(ai, ai->APList, 0);
5691 kfree(ai->APList);
5692 ai->APList = NULL;
5693 }
5694 writeConfigRid(ai, 0);
5695 enable_MAC(ai, 0);
5696 ai->power = PMSG_ON;
5697 netif_device_attach(dev);
5698 netif_wake_queue(dev);
5699 enable_interrupts(ai);
5700 up(&ai->sem);
5701 return 0;
5702 }
5703 #endif
5704
5705 static int __init airo_init_module( void )
5706 {
5707 int i;
5708
5709 airo_entry = create_proc_entry("driver/aironet",
5710 S_IFDIR | airo_perm,
5711 NULL);
5712
5713 if (airo_entry) {
5714 airo_entry->uid = proc_uid;
5715 airo_entry->gid = proc_gid;
5716 }
5717
5718 for (i = 0; i < 4 && io[i] && irq[i]; i++) {
5719 airo_print_info("", "Trying to configure ISA adapter at irq=%d "
5720 "io=0x%x", irq[i], io[i] );
5721 if (init_airo_card( irq[i], io[i], 0, NULL ))
5722 /* do nothing */ ;
5723 }
5724
5725 #ifdef CONFIG_PCI
5726 airo_print_info("", "Probing for PCI adapters");
5727 i = pci_register_driver(&airo_driver);
5728 airo_print_info("", "Finished probing for PCI adapters");
5729
5730 if (i) {
5731 remove_proc_entry("driver/aironet", NULL);
5732 return i;
5733 }
5734 #endif
5735
5736 /* Always exit with success, as we are a library module
5737 * as well as a driver module
5738 */
5739 return 0;
5740 }
5741
5742 static void __exit airo_cleanup_module( void )
5743 {
5744 struct airo_info *ai;
5745 while(!list_empty(&airo_devices)) {
5746 ai = list_entry(airo_devices.next, struct airo_info, dev_list);
5747 airo_print_info(ai->dev->name, "Unregistering...");
5748 stop_airo_card(ai->dev, 1);
5749 }
5750 #ifdef CONFIG_PCI
5751 pci_unregister_driver(&airo_driver);
5752 #endif
5753 remove_proc_entry("driver/aironet", NULL);
5754 }
5755
5756 /*
5757 * Initial Wireless Extension code for Aironet driver by :
5758 * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00
5759 * Conversion to new driver API by :
5760 * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02
5761 * Javier also did a good amount of work here, adding some new extensions
5762 * and fixing my code. Let's just say that without him this code just
5763 * would not work at all... - Jean II
5764 */
5765
5766 static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi)
5767 {
5768 if (!rssi_rid)
5769 return 0;
5770
5771 return (0x100 - rssi_rid[rssi].rssidBm);
5772 }
5773
5774 static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm)
5775 {
5776 int i;
5777
5778 if (!rssi_rid)
5779 return 0;
5780
5781 for (i = 0; i < 256; i++)
5782 if (rssi_rid[i].rssidBm == dbm)
5783 return rssi_rid[i].rssipct;
5784
5785 return 0;
5786 }
5787
5788
5789 static int airo_get_quality (StatusRid *status_rid, CapabilityRid *cap_rid)
5790 {
5791 int quality = 0;
5792 u16 sq;
5793
5794 if ((status_rid->mode & cpu_to_le16(0x3f)) != cpu_to_le16(0x3f))
5795 return 0;
5796
5797 if (!(cap_rid->hardCap & cpu_to_le16(8)))
5798 return 0;
5799
5800 sq = le16_to_cpu(status_rid->signalQuality);
5801 if (memcmp(cap_rid->prodName, "350", 3))
5802 if (sq > 0x20)
5803 quality = 0;
5804 else
5805 quality = 0x20 - sq;
5806 else
5807 if (sq > 0xb0)
5808 quality = 0;
5809 else if (sq < 0x10)
5810 quality = 0xa0;
5811 else
5812 quality = 0xb0 - sq;
5813 return quality;
5814 }
5815
5816 #define airo_get_max_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x20 : 0xa0)
5817 #define airo_get_avg_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x10 : 0x50);
5818
5819 /*------------------------------------------------------------------*/
5820 /*
5821 * Wireless Handler : get protocol name
5822 */
5823 static int airo_get_name(struct net_device *dev,
5824 struct iw_request_info *info,
5825 char *cwrq,
5826 char *extra)
5827 {
5828 strcpy(cwrq, "IEEE 802.11-DS");
5829 return 0;
5830 }
5831
5832 /*------------------------------------------------------------------*/
5833 /*
5834 * Wireless Handler : set frequency
5835 */
5836 static int airo_set_freq(struct net_device *dev,
5837 struct iw_request_info *info,
5838 struct iw_freq *fwrq,
5839 char *extra)
5840 {
5841 struct airo_info *local = dev->ml_priv;
5842 int rc = -EINPROGRESS; /* Call commit handler */
5843
5844 /* If setting by frequency, convert to a channel */
5845 if(fwrq->e == 1) {
5846 int f = fwrq->m / 100000;
5847
5848 /* Hack to fall through... */
5849 fwrq->e = 0;
5850 fwrq->m = ieee80211_freq_to_dsss_chan(f);
5851 }
5852 /* Setting by channel number */
5853 if((fwrq->m > 1000) || (fwrq->e > 0))
5854 rc = -EOPNOTSUPP;
5855 else {
5856 int channel = fwrq->m;
5857 /* We should do a better check than that,
5858 * based on the card capability !!! */
5859 if((channel < 1) || (channel > 14)) {
5860 airo_print_dbg(dev->name, "New channel value of %d is invalid!",
5861 fwrq->m);
5862 rc = -EINVAL;
5863 } else {
5864 readConfigRid(local, 1);
5865 /* Yes ! We can set it !!! */
5866 local->config.channelSet = cpu_to_le16(channel);
5867 set_bit (FLAG_COMMIT, &local->flags);
5868 }
5869 }
5870 return rc;
5871 }
5872
5873 /*------------------------------------------------------------------*/
5874 /*
5875 * Wireless Handler : get frequency
5876 */
5877 static int airo_get_freq(struct net_device *dev,
5878 struct iw_request_info *info,
5879 struct iw_freq *fwrq,
5880 char *extra)
5881 {
5882 struct airo_info *local = dev->ml_priv;
5883 StatusRid status_rid; /* Card status info */
5884 int ch;
5885
5886 readConfigRid(local, 1);
5887 if ((local->config.opmode & MODE_CFG_MASK) == MODE_STA_ESS)
5888 status_rid.channel = local->config.channelSet;
5889 else
5890 readStatusRid(local, &status_rid, 1);
5891
5892 ch = le16_to_cpu(status_rid.channel);
5893 if((ch > 0) && (ch < 15)) {
5894 fwrq->m = ieee80211_dsss_chan_to_freq(ch) * 100000;
5895 fwrq->e = 1;
5896 } else {
5897 fwrq->m = ch;
5898 fwrq->e = 0;
5899 }
5900
5901 return 0;
5902 }
5903
5904 /*------------------------------------------------------------------*/
5905 /*
5906 * Wireless Handler : set ESSID
5907 */
5908 static int airo_set_essid(struct net_device *dev,
5909 struct iw_request_info *info,
5910 struct iw_point *dwrq,
5911 char *extra)
5912 {
5913 struct airo_info *local = dev->ml_priv;
5914 SsidRid SSID_rid; /* SSIDs */
5915
5916 /* Reload the list of current SSID */
5917 readSsidRid(local, &SSID_rid);
5918
5919 /* Check if we asked for `any' */
5920 if(dwrq->flags == 0) {
5921 /* Just send an empty SSID list */
5922 memset(&SSID_rid, 0, sizeof(SSID_rid));
5923 } else {
5924 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
5925
5926 /* Check the size of the string */
5927 if(dwrq->length > IW_ESSID_MAX_SIZE) {
5928 return -E2BIG ;
5929 }
5930 /* Check if index is valid */
5931 if((index < 0) || (index >= 4)) {
5932 return -EINVAL;
5933 }
5934
5935 /* Set the SSID */
5936 memset(SSID_rid.ssids[index].ssid, 0,
5937 sizeof(SSID_rid.ssids[index].ssid));
5938 memcpy(SSID_rid.ssids[index].ssid, extra, dwrq->length);
5939 SSID_rid.ssids[index].len = cpu_to_le16(dwrq->length);
5940 }
5941 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
5942 /* Write it to the card */
5943 disable_MAC(local, 1);
5944 writeSsidRid(local, &SSID_rid, 1);
5945 enable_MAC(local, 1);
5946
5947 return 0;
5948 }
5949
5950 /*------------------------------------------------------------------*/
5951 /*
5952 * Wireless Handler : get ESSID
5953 */
5954 static int airo_get_essid(struct net_device *dev,
5955 struct iw_request_info *info,
5956 struct iw_point *dwrq,
5957 char *extra)
5958 {
5959 struct airo_info *local = dev->ml_priv;
5960 StatusRid status_rid; /* Card status info */
5961
5962 readStatusRid(local, &status_rid, 1);
5963
5964 /* Note : if dwrq->flags != 0, we should
5965 * get the relevant SSID from the SSID list... */
5966
5967 /* Get the current SSID */
5968 memcpy(extra, status_rid.SSID, le16_to_cpu(status_rid.SSIDlen));
5969 /* If none, we may want to get the one that was set */
5970
5971 /* Push it out ! */
5972 dwrq->length = le16_to_cpu(status_rid.SSIDlen);
5973 dwrq->flags = 1; /* active */
5974
5975 return 0;
5976 }
5977
5978 /*------------------------------------------------------------------*/
5979 /*
5980 * Wireless Handler : set AP address
5981 */
5982 static int airo_set_wap(struct net_device *dev,
5983 struct iw_request_info *info,
5984 struct sockaddr *awrq,
5985 char *extra)
5986 {
5987 struct airo_info *local = dev->ml_priv;
5988 Cmd cmd;
5989 Resp rsp;
5990 APListRid APList_rid;
5991 static const u8 any[ETH_ALEN] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
5992 static const u8 off[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
5993
5994 if (awrq->sa_family != ARPHRD_ETHER)
5995 return -EINVAL;
5996 else if (!memcmp(any, awrq->sa_data, ETH_ALEN) ||
5997 !memcmp(off, awrq->sa_data, ETH_ALEN)) {
5998 memset(&cmd, 0, sizeof(cmd));
5999 cmd.cmd=CMD_LOSE_SYNC;
6000 if (down_interruptible(&local->sem))
6001 return -ERESTARTSYS;
6002 issuecommand(local, &cmd, &rsp);
6003 up(&local->sem);
6004 } else {
6005 memset(&APList_rid, 0, sizeof(APList_rid));
6006 APList_rid.len = cpu_to_le16(sizeof(APList_rid));
6007 memcpy(APList_rid.ap[0], awrq->sa_data, ETH_ALEN);
6008 disable_MAC(local, 1);
6009 writeAPListRid(local, &APList_rid, 1);
6010 enable_MAC(local, 1);
6011 }
6012 return 0;
6013 }
6014
6015 /*------------------------------------------------------------------*/
6016 /*
6017 * Wireless Handler : get AP address
6018 */
6019 static int airo_get_wap(struct net_device *dev,
6020 struct iw_request_info *info,
6021 struct sockaddr *awrq,
6022 char *extra)
6023 {
6024 struct airo_info *local = dev->ml_priv;
6025 StatusRid status_rid; /* Card status info */
6026
6027 readStatusRid(local, &status_rid, 1);
6028
6029 /* Tentative. This seems to work, wow, I'm lucky !!! */
6030 memcpy(awrq->sa_data, status_rid.bssid[0], ETH_ALEN);
6031 awrq->sa_family = ARPHRD_ETHER;
6032
6033 return 0;
6034 }
6035
6036 /*------------------------------------------------------------------*/
6037 /*
6038 * Wireless Handler : set Nickname
6039 */
6040 static int airo_set_nick(struct net_device *dev,
6041 struct iw_request_info *info,
6042 struct iw_point *dwrq,
6043 char *extra)
6044 {
6045 struct airo_info *local = dev->ml_priv;
6046
6047 /* Check the size of the string */
6048 if(dwrq->length > 16) {
6049 return -E2BIG;
6050 }
6051 readConfigRid(local, 1);
6052 memset(local->config.nodeName, 0, sizeof(local->config.nodeName));
6053 memcpy(local->config.nodeName, extra, dwrq->length);
6054 set_bit (FLAG_COMMIT, &local->flags);
6055
6056 return -EINPROGRESS; /* Call commit handler */
6057 }
6058
6059 /*------------------------------------------------------------------*/
6060 /*
6061 * Wireless Handler : get Nickname
6062 */
6063 static int airo_get_nick(struct net_device *dev,
6064 struct iw_request_info *info,
6065 struct iw_point *dwrq,
6066 char *extra)
6067 {
6068 struct airo_info *local = dev->ml_priv;
6069
6070 readConfigRid(local, 1);
6071 strncpy(extra, local->config.nodeName, 16);
6072 extra[16] = '\0';
6073 dwrq->length = strlen(extra);
6074
6075 return 0;
6076 }
6077
6078 /*------------------------------------------------------------------*/
6079 /*
6080 * Wireless Handler : set Bit-Rate
6081 */
6082 static int airo_set_rate(struct net_device *dev,
6083 struct iw_request_info *info,
6084 struct iw_param *vwrq,
6085 char *extra)
6086 {
6087 struct airo_info *local = dev->ml_priv;
6088 CapabilityRid cap_rid; /* Card capability info */
6089 u8 brate = 0;
6090 int i;
6091
6092 /* First : get a valid bit rate value */
6093 readCapabilityRid(local, &cap_rid, 1);
6094
6095 /* Which type of value ? */
6096 if((vwrq->value < 8) && (vwrq->value >= 0)) {
6097 /* Setting by rate index */
6098 /* Find value in the magic rate table */
6099 brate = cap_rid.supportedRates[vwrq->value];
6100 } else {
6101 /* Setting by frequency value */
6102 u8 normvalue = (u8) (vwrq->value/500000);
6103
6104 /* Check if rate is valid */
6105 for(i = 0 ; i < 8 ; i++) {
6106 if(normvalue == cap_rid.supportedRates[i]) {
6107 brate = normvalue;
6108 break;
6109 }
6110 }
6111 }
6112 /* -1 designed the max rate (mostly auto mode) */
6113 if(vwrq->value == -1) {
6114 /* Get the highest available rate */
6115 for(i = 0 ; i < 8 ; i++) {
6116 if(cap_rid.supportedRates[i] == 0)
6117 break;
6118 }
6119 if(i != 0)
6120 brate = cap_rid.supportedRates[i - 1];
6121 }
6122 /* Check that it is valid */
6123 if(brate == 0) {
6124 return -EINVAL;
6125 }
6126
6127 readConfigRid(local, 1);
6128 /* Now, check if we want a fixed or auto value */
6129 if(vwrq->fixed == 0) {
6130 /* Fill all the rates up to this max rate */
6131 memset(local->config.rates, 0, 8);
6132 for(i = 0 ; i < 8 ; i++) {
6133 local->config.rates[i] = cap_rid.supportedRates[i];
6134 if(local->config.rates[i] == brate)
6135 break;
6136 }
6137 } else {
6138 /* Fixed mode */
6139 /* One rate, fixed */
6140 memset(local->config.rates, 0, 8);
6141 local->config.rates[0] = brate;
6142 }
6143 set_bit (FLAG_COMMIT, &local->flags);
6144
6145 return -EINPROGRESS; /* Call commit handler */
6146 }
6147
6148 /*------------------------------------------------------------------*/
6149 /*
6150 * Wireless Handler : get Bit-Rate
6151 */
6152 static int airo_get_rate(struct net_device *dev,
6153 struct iw_request_info *info,
6154 struct iw_param *vwrq,
6155 char *extra)
6156 {
6157 struct airo_info *local = dev->ml_priv;
6158 StatusRid status_rid; /* Card status info */
6159
6160 readStatusRid(local, &status_rid, 1);
6161
6162 vwrq->value = le16_to_cpu(status_rid.currentXmitRate) * 500000;
6163 /* If more than one rate, set auto */
6164 readConfigRid(local, 1);
6165 vwrq->fixed = (local->config.rates[1] == 0);
6166
6167 return 0;
6168 }
6169
6170 /*------------------------------------------------------------------*/
6171 /*
6172 * Wireless Handler : set RTS threshold
6173 */
6174 static int airo_set_rts(struct net_device *dev,
6175 struct iw_request_info *info,
6176 struct iw_param *vwrq,
6177 char *extra)
6178 {
6179 struct airo_info *local = dev->ml_priv;
6180 int rthr = vwrq->value;
6181
6182 if(vwrq->disabled)
6183 rthr = AIRO_DEF_MTU;
6184 if((rthr < 0) || (rthr > AIRO_DEF_MTU)) {
6185 return -EINVAL;
6186 }
6187 readConfigRid(local, 1);
6188 local->config.rtsThres = cpu_to_le16(rthr);
6189 set_bit (FLAG_COMMIT, &local->flags);
6190
6191 return -EINPROGRESS; /* Call commit handler */
6192 }
6193
6194 /*------------------------------------------------------------------*/
6195 /*
6196 * Wireless Handler : get RTS threshold
6197 */
6198 static int airo_get_rts(struct net_device *dev,
6199 struct iw_request_info *info,
6200 struct iw_param *vwrq,
6201 char *extra)
6202 {
6203 struct airo_info *local = dev->ml_priv;
6204
6205 readConfigRid(local, 1);
6206 vwrq->value = le16_to_cpu(local->config.rtsThres);
6207 vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6208 vwrq->fixed = 1;
6209
6210 return 0;
6211 }
6212
6213 /*------------------------------------------------------------------*/
6214 /*
6215 * Wireless Handler : set Fragmentation threshold
6216 */
6217 static int airo_set_frag(struct net_device *dev,
6218 struct iw_request_info *info,
6219 struct iw_param *vwrq,
6220 char *extra)
6221 {
6222 struct airo_info *local = dev->ml_priv;
6223 int fthr = vwrq->value;
6224
6225 if(vwrq->disabled)
6226 fthr = AIRO_DEF_MTU;
6227 if((fthr < 256) || (fthr > AIRO_DEF_MTU)) {
6228 return -EINVAL;
6229 }
6230 fthr &= ~0x1; /* Get an even value - is it really needed ??? */
6231 readConfigRid(local, 1);
6232 local->config.fragThresh = cpu_to_le16(fthr);
6233 set_bit (FLAG_COMMIT, &local->flags);
6234
6235 return -EINPROGRESS; /* Call commit handler */
6236 }
6237
6238 /*------------------------------------------------------------------*/
6239 /*
6240 * Wireless Handler : get Fragmentation threshold
6241 */
6242 static int airo_get_frag(struct net_device *dev,
6243 struct iw_request_info *info,
6244 struct iw_param *vwrq,
6245 char *extra)
6246 {
6247 struct airo_info *local = dev->ml_priv;
6248
6249 readConfigRid(local, 1);
6250 vwrq->value = le16_to_cpu(local->config.fragThresh);
6251 vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
6252 vwrq->fixed = 1;
6253
6254 return 0;
6255 }
6256
6257 /*------------------------------------------------------------------*/
6258 /*
6259 * Wireless Handler : set Mode of Operation
6260 */
6261 static int airo_set_mode(struct net_device *dev,
6262 struct iw_request_info *info,
6263 __u32 *uwrq,
6264 char *extra)
6265 {
6266 struct airo_info *local = dev->ml_priv;
6267 int reset = 0;
6268
6269 readConfigRid(local, 1);
6270 if (sniffing_mode(local))
6271 reset = 1;
6272
6273 switch(*uwrq) {
6274 case IW_MODE_ADHOC:
6275 local->config.opmode &= ~MODE_CFG_MASK;
6276 local->config.opmode |= MODE_STA_IBSS;
6277 local->config.rmode &= ~RXMODE_FULL_MASK;
6278 local->config.scanMode = SCANMODE_ACTIVE;
6279 clear_bit (FLAG_802_11, &local->flags);
6280 break;
6281 case IW_MODE_INFRA:
6282 local->config.opmode &= ~MODE_CFG_MASK;
6283 local->config.opmode |= MODE_STA_ESS;
6284 local->config.rmode &= ~RXMODE_FULL_MASK;
6285 local->config.scanMode = SCANMODE_ACTIVE;
6286 clear_bit (FLAG_802_11, &local->flags);
6287 break;
6288 case IW_MODE_MASTER:
6289 local->config.opmode &= ~MODE_CFG_MASK;
6290 local->config.opmode |= MODE_AP;
6291 local->config.rmode &= ~RXMODE_FULL_MASK;
6292 local->config.scanMode = SCANMODE_ACTIVE;
6293 clear_bit (FLAG_802_11, &local->flags);
6294 break;
6295 case IW_MODE_REPEAT:
6296 local->config.opmode &= ~MODE_CFG_MASK;
6297 local->config.opmode |= MODE_AP_RPTR;
6298 local->config.rmode &= ~RXMODE_FULL_MASK;
6299 local->config.scanMode = SCANMODE_ACTIVE;
6300 clear_bit (FLAG_802_11, &local->flags);
6301 break;
6302 case IW_MODE_MONITOR:
6303 local->config.opmode &= ~MODE_CFG_MASK;
6304 local->config.opmode |= MODE_STA_ESS;
6305 local->config.rmode &= ~RXMODE_FULL_MASK;
6306 local->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
6307 local->config.scanMode = SCANMODE_PASSIVE;
6308 set_bit (FLAG_802_11, &local->flags);
6309 break;
6310 default:
6311 return -EINVAL;
6312 }
6313 if (reset)
6314 set_bit (FLAG_RESET, &local->flags);
6315 set_bit (FLAG_COMMIT, &local->flags);
6316
6317 return -EINPROGRESS; /* Call commit handler */
6318 }
6319
6320 /*------------------------------------------------------------------*/
6321 /*
6322 * Wireless Handler : get Mode of Operation
6323 */
6324 static int airo_get_mode(struct net_device *dev,
6325 struct iw_request_info *info,
6326 __u32 *uwrq,
6327 char *extra)
6328 {
6329 struct airo_info *local = dev->ml_priv;
6330
6331 readConfigRid(local, 1);
6332 /* If not managed, assume it's ad-hoc */
6333 switch (local->config.opmode & MODE_CFG_MASK) {
6334 case MODE_STA_ESS:
6335 *uwrq = IW_MODE_INFRA;
6336 break;
6337 case MODE_AP:
6338 *uwrq = IW_MODE_MASTER;
6339 break;
6340 case MODE_AP_RPTR:
6341 *uwrq = IW_MODE_REPEAT;
6342 break;
6343 default:
6344 *uwrq = IW_MODE_ADHOC;
6345 }
6346
6347 return 0;
6348 }
6349
6350 static inline int valid_index(struct airo_info *ai, int index)
6351 {
6352 return (index >= 0) && (index <= ai->max_wep_idx);
6353 }
6354
6355 /*------------------------------------------------------------------*/
6356 /*
6357 * Wireless Handler : set Encryption Key
6358 */
6359 static int airo_set_encode(struct net_device *dev,
6360 struct iw_request_info *info,
6361 struct iw_point *dwrq,
6362 char *extra)
6363 {
6364 struct airo_info *local = dev->ml_priv;
6365 int perm = (dwrq->flags & IW_ENCODE_TEMP ? 0 : 1);
6366 __le16 currentAuthType = local->config.authType;
6367 int rc = 0;
6368
6369 if (!local->wep_capable)
6370 return -EOPNOTSUPP;
6371
6372 readConfigRid(local, 1);
6373
6374 /* Basic checking: do we have a key to set ?
6375 * Note : with the new API, it's impossible to get a NULL pointer.
6376 * Therefore, we need to check a key size == 0 instead.
6377 * New version of iwconfig properly set the IW_ENCODE_NOKEY flag
6378 * when no key is present (only change flags), but older versions
6379 * don't do it. - Jean II */
6380 if (dwrq->length > 0) {
6381 wep_key_t key;
6382 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6383 int current_index;
6384
6385 /* Check the size of the key */
6386 if (dwrq->length > MAX_KEY_SIZE) {
6387 return -EINVAL;
6388 }
6389
6390 current_index = get_wep_tx_idx(local);
6391 if (current_index < 0)
6392 current_index = 0;
6393
6394 /* Check the index (none -> use current) */
6395 if (!valid_index(local, index))
6396 index = current_index;
6397
6398 /* Set the length */
6399 if (dwrq->length > MIN_KEY_SIZE)
6400 key.len = MAX_KEY_SIZE;
6401 else
6402 if (dwrq->length > 0)
6403 key.len = MIN_KEY_SIZE;
6404 else
6405 /* Disable the key */
6406 key.len = 0;
6407 /* Check if the key is not marked as invalid */
6408 if(!(dwrq->flags & IW_ENCODE_NOKEY)) {
6409 /* Cleanup */
6410 memset(key.key, 0, MAX_KEY_SIZE);
6411 /* Copy the key in the driver */
6412 memcpy(key.key, extra, dwrq->length);
6413 /* Send the key to the card */
6414 rc = set_wep_key(local, index, key.key, key.len, perm, 1);
6415 if (rc < 0) {
6416 airo_print_err(local->dev->name, "failed to set"
6417 " WEP key at index %d: %d.",
6418 index, rc);
6419 return rc;
6420 }
6421 }
6422 /* WE specify that if a valid key is set, encryption
6423 * should be enabled (user may turn it off later)
6424 * This is also how "iwconfig ethX key on" works */
6425 if((index == current_index) && (key.len > 0) &&
6426 (local->config.authType == AUTH_OPEN)) {
6427 local->config.authType = AUTH_ENCRYPT;
6428 }
6429 } else {
6430 /* Do we want to just set the transmit key index ? */
6431 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6432 if (valid_index(local, index)) {
6433 rc = set_wep_tx_idx(local, index, perm, 1);
6434 if (rc < 0) {
6435 airo_print_err(local->dev->name, "failed to set"
6436 " WEP transmit index to %d: %d.",
6437 index, rc);
6438 return rc;
6439 }
6440 } else {
6441 /* Don't complain if only change the mode */
6442 if (!(dwrq->flags & IW_ENCODE_MODE))
6443 return -EINVAL;
6444 }
6445 }
6446 /* Read the flags */
6447 if(dwrq->flags & IW_ENCODE_DISABLED)
6448 local->config.authType = AUTH_OPEN; // disable encryption
6449 if(dwrq->flags & IW_ENCODE_RESTRICTED)
6450 local->config.authType = AUTH_SHAREDKEY; // Only Both
6451 if(dwrq->flags & IW_ENCODE_OPEN)
6452 local->config.authType = AUTH_ENCRYPT; // Only Wep
6453 /* Commit the changes to flags if needed */
6454 if (local->config.authType != currentAuthType)
6455 set_bit (FLAG_COMMIT, &local->flags);
6456 return -EINPROGRESS; /* Call commit handler */
6457 }
6458
6459 /*------------------------------------------------------------------*/
6460 /*
6461 * Wireless Handler : get Encryption Key
6462 */
6463 static int airo_get_encode(struct net_device *dev,
6464 struct iw_request_info *info,
6465 struct iw_point *dwrq,
6466 char *extra)
6467 {
6468 struct airo_info *local = dev->ml_priv;
6469 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
6470 u8 buf[16];
6471
6472 if (!local->wep_capable)
6473 return -EOPNOTSUPP;
6474
6475 readConfigRid(local, 1);
6476
6477 /* Check encryption mode */
6478 switch(local->config.authType) {
6479 case AUTH_ENCRYPT:
6480 dwrq->flags = IW_ENCODE_OPEN;
6481 break;
6482 case AUTH_SHAREDKEY:
6483 dwrq->flags = IW_ENCODE_RESTRICTED;
6484 break;
6485 default:
6486 case AUTH_OPEN:
6487 dwrq->flags = IW_ENCODE_DISABLED;
6488 break;
6489 }
6490 /* We can't return the key, so set the proper flag and return zero */
6491 dwrq->flags |= IW_ENCODE_NOKEY;
6492 memset(extra, 0, 16);
6493
6494 /* Which key do we want ? -1 -> tx index */
6495 if (!valid_index(local, index)) {
6496 index = get_wep_tx_idx(local);
6497 if (index < 0)
6498 index = 0;
6499 }
6500 dwrq->flags |= index + 1;
6501
6502 /* Copy the key to the user buffer */
6503 dwrq->length = get_wep_key(local, index, &buf[0], sizeof(buf));
6504 memcpy(extra, buf, dwrq->length);
6505
6506 return 0;
6507 }
6508
6509 /*------------------------------------------------------------------*/
6510 /*
6511 * Wireless Handler : set extended Encryption parameters
6512 */
6513 static int airo_set_encodeext(struct net_device *dev,
6514 struct iw_request_info *info,
6515 union iwreq_data *wrqu,
6516 char *extra)
6517 {
6518 struct airo_info *local = dev->ml_priv;
6519 struct iw_point *encoding = &wrqu->encoding;
6520 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6521 int perm = ( encoding->flags & IW_ENCODE_TEMP ? 0 : 1 );
6522 __le16 currentAuthType = local->config.authType;
6523 int idx, key_len, alg = ext->alg, set_key = 1, rc;
6524 wep_key_t key;
6525
6526 if (!local->wep_capable)
6527 return -EOPNOTSUPP;
6528
6529 readConfigRid(local, 1);
6530
6531 /* Determine and validate the key index */
6532 idx = encoding->flags & IW_ENCODE_INDEX;
6533 if (idx) {
6534 if (!valid_index(local, idx - 1))
6535 return -EINVAL;
6536 idx--;
6537 } else {
6538 idx = get_wep_tx_idx(local);
6539 if (idx < 0)
6540 idx = 0;
6541 }
6542
6543 if (encoding->flags & IW_ENCODE_DISABLED)
6544 alg = IW_ENCODE_ALG_NONE;
6545
6546 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
6547 /* Only set transmit key index here, actual
6548 * key is set below if needed.
6549 */
6550 rc = set_wep_tx_idx(local, idx, perm, 1);
6551 if (rc < 0) {
6552 airo_print_err(local->dev->name, "failed to set "
6553 "WEP transmit index to %d: %d.",
6554 idx, rc);
6555 return rc;
6556 }
6557 set_key = ext->key_len > 0 ? 1 : 0;
6558 }
6559
6560 if (set_key) {
6561 /* Set the requested key first */
6562 memset(key.key, 0, MAX_KEY_SIZE);
6563 switch (alg) {
6564 case IW_ENCODE_ALG_NONE:
6565 key.len = 0;
6566 break;
6567 case IW_ENCODE_ALG_WEP:
6568 if (ext->key_len > MIN_KEY_SIZE) {
6569 key.len = MAX_KEY_SIZE;
6570 } else if (ext->key_len > 0) {
6571 key.len = MIN_KEY_SIZE;
6572 } else {
6573 return -EINVAL;
6574 }
6575 key_len = min (ext->key_len, key.len);
6576 memcpy(key.key, ext->key, key_len);
6577 break;
6578 default:
6579 return -EINVAL;
6580 }
6581 /* Send the key to the card */
6582 rc = set_wep_key(local, idx, key.key, key.len, perm, 1);
6583 if (rc < 0) {
6584 airo_print_err(local->dev->name, "failed to set WEP key"
6585 " at index %d: %d.", idx, rc);
6586 return rc;
6587 }
6588 }
6589
6590 /* Read the flags */
6591 if(encoding->flags & IW_ENCODE_DISABLED)
6592 local->config.authType = AUTH_OPEN; // disable encryption
6593 if(encoding->flags & IW_ENCODE_RESTRICTED)
6594 local->config.authType = AUTH_SHAREDKEY; // Only Both
6595 if(encoding->flags & IW_ENCODE_OPEN)
6596 local->config.authType = AUTH_ENCRYPT; // Only Wep
6597 /* Commit the changes to flags if needed */
6598 if (local->config.authType != currentAuthType)
6599 set_bit (FLAG_COMMIT, &local->flags);
6600
6601 return -EINPROGRESS;
6602 }
6603
6604
6605 /*------------------------------------------------------------------*/
6606 /*
6607 * Wireless Handler : get extended Encryption parameters
6608 */
6609 static int airo_get_encodeext(struct net_device *dev,
6610 struct iw_request_info *info,
6611 union iwreq_data *wrqu,
6612 char *extra)
6613 {
6614 struct airo_info *local = dev->ml_priv;
6615 struct iw_point *encoding = &wrqu->encoding;
6616 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6617 int idx, max_key_len;
6618 u8 buf[16];
6619
6620 if (!local->wep_capable)
6621 return -EOPNOTSUPP;
6622
6623 readConfigRid(local, 1);
6624
6625 max_key_len = encoding->length - sizeof(*ext);
6626 if (max_key_len < 0)
6627 return -EINVAL;
6628
6629 idx = encoding->flags & IW_ENCODE_INDEX;
6630 if (idx) {
6631 if (!valid_index(local, idx - 1))
6632 return -EINVAL;
6633 idx--;
6634 } else {
6635 idx = get_wep_tx_idx(local);
6636 if (idx < 0)
6637 idx = 0;
6638 }
6639
6640 encoding->flags = idx + 1;
6641 memset(ext, 0, sizeof(*ext));
6642
6643 /* Check encryption mode */
6644 switch(local->config.authType) {
6645 case AUTH_ENCRYPT:
6646 encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6647 break;
6648 case AUTH_SHAREDKEY:
6649 encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6650 break;
6651 default:
6652 case AUTH_OPEN:
6653 encoding->flags = IW_ENCODE_ALG_NONE | IW_ENCODE_DISABLED;
6654 break;
6655 }
6656 /* We can't return the key, so set the proper flag and return zero */
6657 encoding->flags |= IW_ENCODE_NOKEY;
6658 memset(extra, 0, 16);
6659
6660 /* Copy the key to the user buffer */
6661 ext->key_len = get_wep_key(local, idx, &buf[0], sizeof(buf));
6662 memcpy(extra, buf, ext->key_len);
6663
6664 return 0;
6665 }
6666
6667
6668 /*------------------------------------------------------------------*/
6669 /*
6670 * Wireless Handler : set extended authentication parameters
6671 */
6672 static int airo_set_auth(struct net_device *dev,
6673 struct iw_request_info *info,
6674 union iwreq_data *wrqu, char *extra)
6675 {
6676 struct airo_info *local = dev->ml_priv;
6677 struct iw_param *param = &wrqu->param;
6678 __le16 currentAuthType = local->config.authType;
6679
6680 switch (param->flags & IW_AUTH_INDEX) {
6681 case IW_AUTH_WPA_VERSION:
6682 case IW_AUTH_CIPHER_PAIRWISE:
6683 case IW_AUTH_CIPHER_GROUP:
6684 case IW_AUTH_KEY_MGMT:
6685 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6686 case IW_AUTH_PRIVACY_INVOKED:
6687 /*
6688 * airo does not use these parameters
6689 */
6690 break;
6691
6692 case IW_AUTH_DROP_UNENCRYPTED:
6693 if (param->value) {
6694 /* Only change auth type if unencrypted */
6695 if (currentAuthType == AUTH_OPEN)
6696 local->config.authType = AUTH_ENCRYPT;
6697 } else {
6698 local->config.authType = AUTH_OPEN;
6699 }
6700
6701 /* Commit the changes to flags if needed */
6702 if (local->config.authType != currentAuthType)
6703 set_bit (FLAG_COMMIT, &local->flags);
6704 break;
6705
6706 case IW_AUTH_80211_AUTH_ALG: {
6707 /* FIXME: What about AUTH_OPEN? This API seems to
6708 * disallow setting our auth to AUTH_OPEN.
6709 */
6710 if (param->value & IW_AUTH_ALG_SHARED_KEY) {
6711 local->config.authType = AUTH_SHAREDKEY;
6712 } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
6713 local->config.authType = AUTH_ENCRYPT;
6714 } else
6715 return -EINVAL;
6716 break;
6717
6718 /* Commit the changes to flags if needed */
6719 if (local->config.authType != currentAuthType)
6720 set_bit (FLAG_COMMIT, &local->flags);
6721 }
6722
6723 case IW_AUTH_WPA_ENABLED:
6724 /* Silently accept disable of WPA */
6725 if (param->value > 0)
6726 return -EOPNOTSUPP;
6727 break;
6728
6729 default:
6730 return -EOPNOTSUPP;
6731 }
6732 return -EINPROGRESS;
6733 }
6734
6735
6736 /*------------------------------------------------------------------*/
6737 /*
6738 * Wireless Handler : get extended authentication parameters
6739 */
6740 static int airo_get_auth(struct net_device *dev,
6741 struct iw_request_info *info,
6742 union iwreq_data *wrqu, char *extra)
6743 {
6744 struct airo_info *local = dev->ml_priv;
6745 struct iw_param *param = &wrqu->param;
6746 __le16 currentAuthType = local->config.authType;
6747
6748 switch (param->flags & IW_AUTH_INDEX) {
6749 case IW_AUTH_DROP_UNENCRYPTED:
6750 switch (currentAuthType) {
6751 case AUTH_SHAREDKEY:
6752 case AUTH_ENCRYPT:
6753 param->value = 1;
6754 break;
6755 default:
6756 param->value = 0;
6757 break;
6758 }
6759 break;
6760
6761 case IW_AUTH_80211_AUTH_ALG:
6762 switch (currentAuthType) {
6763 case AUTH_SHAREDKEY:
6764 param->value = IW_AUTH_ALG_SHARED_KEY;
6765 break;
6766 case AUTH_ENCRYPT:
6767 default:
6768 param->value = IW_AUTH_ALG_OPEN_SYSTEM;
6769 break;
6770 }
6771 break;
6772
6773 case IW_AUTH_WPA_ENABLED:
6774 param->value = 0;
6775 break;
6776
6777 default:
6778 return -EOPNOTSUPP;
6779 }
6780 return 0;
6781 }
6782
6783
6784 /*------------------------------------------------------------------*/
6785 /*
6786 * Wireless Handler : set Tx-Power
6787 */
6788 static int airo_set_txpow(struct net_device *dev,
6789 struct iw_request_info *info,
6790 struct iw_param *vwrq,
6791 char *extra)
6792 {
6793 struct airo_info *local = dev->ml_priv;
6794 CapabilityRid cap_rid; /* Card capability info */
6795 int i;
6796 int rc = -EINVAL;
6797 __le16 v = cpu_to_le16(vwrq->value);
6798
6799 readCapabilityRid(local, &cap_rid, 1);
6800
6801 if (vwrq->disabled) {
6802 set_bit (FLAG_RADIO_OFF, &local->flags);
6803 set_bit (FLAG_COMMIT, &local->flags);
6804 return -EINPROGRESS; /* Call commit handler */
6805 }
6806 if (vwrq->flags != IW_TXPOW_MWATT) {
6807 return -EINVAL;
6808 }
6809 clear_bit (FLAG_RADIO_OFF, &local->flags);
6810 for (i = 0; cap_rid.txPowerLevels[i] && (i < 8); i++)
6811 if (v == cap_rid.txPowerLevels[i]) {
6812 readConfigRid(local, 1);
6813 local->config.txPower = v;
6814 set_bit (FLAG_COMMIT, &local->flags);
6815 rc = -EINPROGRESS; /* Call commit handler */
6816 break;
6817 }
6818 return rc;
6819 }
6820
6821 /*------------------------------------------------------------------*/
6822 /*
6823 * Wireless Handler : get Tx-Power
6824 */
6825 static int airo_get_txpow(struct net_device *dev,
6826 struct iw_request_info *info,
6827 struct iw_param *vwrq,
6828 char *extra)
6829 {
6830 struct airo_info *local = dev->ml_priv;
6831
6832 readConfigRid(local, 1);
6833 vwrq->value = le16_to_cpu(local->config.txPower);
6834 vwrq->fixed = 1; /* No power control */
6835 vwrq->disabled = test_bit(FLAG_RADIO_OFF, &local->flags);
6836 vwrq->flags = IW_TXPOW_MWATT;
6837
6838 return 0;
6839 }
6840
6841 /*------------------------------------------------------------------*/
6842 /*
6843 * Wireless Handler : set Retry limits
6844 */
6845 static int airo_set_retry(struct net_device *dev,
6846 struct iw_request_info *info,
6847 struct iw_param *vwrq,
6848 char *extra)
6849 {
6850 struct airo_info *local = dev->ml_priv;
6851 int rc = -EINVAL;
6852
6853 if(vwrq->disabled) {
6854 return -EINVAL;
6855 }
6856 readConfigRid(local, 1);
6857 if(vwrq->flags & IW_RETRY_LIMIT) {
6858 __le16 v = cpu_to_le16(vwrq->value);
6859 if(vwrq->flags & IW_RETRY_LONG)
6860 local->config.longRetryLimit = v;
6861 else if (vwrq->flags & IW_RETRY_SHORT)
6862 local->config.shortRetryLimit = v;
6863 else {
6864 /* No modifier : set both */
6865 local->config.longRetryLimit = v;
6866 local->config.shortRetryLimit = v;
6867 }
6868 set_bit (FLAG_COMMIT, &local->flags);
6869 rc = -EINPROGRESS; /* Call commit handler */
6870 }
6871 if(vwrq->flags & IW_RETRY_LIFETIME) {
6872 local->config.txLifetime = cpu_to_le16(vwrq->value / 1024);
6873 set_bit (FLAG_COMMIT, &local->flags);
6874 rc = -EINPROGRESS; /* Call commit handler */
6875 }
6876 return rc;
6877 }
6878
6879 /*------------------------------------------------------------------*/
6880 /*
6881 * Wireless Handler : get Retry limits
6882 */
6883 static int airo_get_retry(struct net_device *dev,
6884 struct iw_request_info *info,
6885 struct iw_param *vwrq,
6886 char *extra)
6887 {
6888 struct airo_info *local = dev->ml_priv;
6889
6890 vwrq->disabled = 0; /* Can't be disabled */
6891
6892 readConfigRid(local, 1);
6893 /* Note : by default, display the min retry number */
6894 if((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
6895 vwrq->flags = IW_RETRY_LIFETIME;
6896 vwrq->value = le16_to_cpu(local->config.txLifetime) * 1024;
6897 } else if((vwrq->flags & IW_RETRY_LONG)) {
6898 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
6899 vwrq->value = le16_to_cpu(local->config.longRetryLimit);
6900 } else {
6901 vwrq->flags = IW_RETRY_LIMIT;
6902 vwrq->value = le16_to_cpu(local->config.shortRetryLimit);
6903 if(local->config.shortRetryLimit != local->config.longRetryLimit)
6904 vwrq->flags |= IW_RETRY_SHORT;
6905 }
6906
6907 return 0;
6908 }
6909
6910 /*------------------------------------------------------------------*/
6911 /*
6912 * Wireless Handler : get range info
6913 */
6914 static int airo_get_range(struct net_device *dev,
6915 struct iw_request_info *info,
6916 struct iw_point *dwrq,
6917 char *extra)
6918 {
6919 struct airo_info *local = dev->ml_priv;
6920 struct iw_range *range = (struct iw_range *) extra;
6921 CapabilityRid cap_rid; /* Card capability info */
6922 int i;
6923 int k;
6924
6925 readCapabilityRid(local, &cap_rid, 1);
6926
6927 dwrq->length = sizeof(struct iw_range);
6928 memset(range, 0, sizeof(*range));
6929 range->min_nwid = 0x0000;
6930 range->max_nwid = 0x0000;
6931 range->num_channels = 14;
6932 /* Should be based on cap_rid.country to give only
6933 * what the current card support */
6934 k = 0;
6935 for(i = 0; i < 14; i++) {
6936 range->freq[k].i = i + 1; /* List index */
6937 range->freq[k].m = ieee80211_dsss_chan_to_freq(i + 1) * 100000;
6938 range->freq[k++].e = 1; /* Values in MHz -> * 10^5 * 10 */
6939 }
6940 range->num_frequency = k;
6941
6942 range->sensitivity = 65535;
6943
6944 /* Hum... Should put the right values there */
6945 if (local->rssi)
6946 range->max_qual.qual = 100; /* % */
6947 else
6948 range->max_qual.qual = airo_get_max_quality(&cap_rid);
6949 range->max_qual.level = 0x100 - 120; /* -120 dBm */
6950 range->max_qual.noise = 0x100 - 120; /* -120 dBm */
6951
6952 /* Experimental measurements - boundary 11/5.5 Mb/s */
6953 /* Note : with or without the (local->rssi), results
6954 * are somewhat different. - Jean II */
6955 if (local->rssi) {
6956 range->avg_qual.qual = 50; /* % */
6957 range->avg_qual.level = 0x100 - 70; /* -70 dBm */
6958 } else {
6959 range->avg_qual.qual = airo_get_avg_quality(&cap_rid);
6960 range->avg_qual.level = 0x100 - 80; /* -80 dBm */
6961 }
6962 range->avg_qual.noise = 0x100 - 85; /* -85 dBm */
6963
6964 for(i = 0 ; i < 8 ; i++) {
6965 range->bitrate[i] = cap_rid.supportedRates[i] * 500000;
6966 if(range->bitrate[i] == 0)
6967 break;
6968 }
6969 range->num_bitrates = i;
6970
6971 /* Set an indication of the max TCP throughput
6972 * in bit/s that we can expect using this interface.
6973 * May be use for QoS stuff... Jean II */
6974 if(i > 2)
6975 range->throughput = 5000 * 1000;
6976 else
6977 range->throughput = 1500 * 1000;
6978
6979 range->min_rts = 0;
6980 range->max_rts = AIRO_DEF_MTU;
6981 range->min_frag = 256;
6982 range->max_frag = AIRO_DEF_MTU;
6983
6984 if(cap_rid.softCap & cpu_to_le16(2)) {
6985 // WEP: RC4 40 bits
6986 range->encoding_size[0] = 5;
6987 // RC4 ~128 bits
6988 if (cap_rid.softCap & cpu_to_le16(0x100)) {
6989 range->encoding_size[1] = 13;
6990 range->num_encoding_sizes = 2;
6991 } else
6992 range->num_encoding_sizes = 1;
6993 range->max_encoding_tokens =
6994 cap_rid.softCap & cpu_to_le16(0x80) ? 4 : 1;
6995 } else {
6996 range->num_encoding_sizes = 0;
6997 range->max_encoding_tokens = 0;
6998 }
6999 range->min_pmp = 0;
7000 range->max_pmp = 5000000; /* 5 secs */
7001 range->min_pmt = 0;
7002 range->max_pmt = 65535 * 1024; /* ??? */
7003 range->pmp_flags = IW_POWER_PERIOD;
7004 range->pmt_flags = IW_POWER_TIMEOUT;
7005 range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
7006
7007 /* Transmit Power - values are in mW */
7008 for(i = 0 ; i < 8 ; i++) {
7009 range->txpower[i] = le16_to_cpu(cap_rid.txPowerLevels[i]);
7010 if(range->txpower[i] == 0)
7011 break;
7012 }
7013 range->num_txpower = i;
7014 range->txpower_capa = IW_TXPOW_MWATT;
7015 range->we_version_source = 19;
7016 range->we_version_compiled = WIRELESS_EXT;
7017 range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
7018 range->retry_flags = IW_RETRY_LIMIT;
7019 range->r_time_flags = IW_RETRY_LIFETIME;
7020 range->min_retry = 1;
7021 range->max_retry = 65535;
7022 range->min_r_time = 1024;
7023 range->max_r_time = 65535 * 1024;
7024
7025 /* Event capability (kernel + driver) */
7026 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
7027 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
7028 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
7029 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
7030 range->event_capa[1] = IW_EVENT_CAPA_K_1;
7031 range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVTXDROP);
7032 return 0;
7033 }
7034
7035 /*------------------------------------------------------------------*/
7036 /*
7037 * Wireless Handler : set Power Management
7038 */
7039 static int airo_set_power(struct net_device *dev,
7040 struct iw_request_info *info,
7041 struct iw_param *vwrq,
7042 char *extra)
7043 {
7044 struct airo_info *local = dev->ml_priv;
7045
7046 readConfigRid(local, 1);
7047 if (vwrq->disabled) {
7048 if (sniffing_mode(local))
7049 return -EINVAL;
7050 local->config.powerSaveMode = POWERSAVE_CAM;
7051 local->config.rmode &= ~RXMODE_MASK;
7052 local->config.rmode |= RXMODE_BC_MC_ADDR;
7053 set_bit (FLAG_COMMIT, &local->flags);
7054 return -EINPROGRESS; /* Call commit handler */
7055 }
7056 if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7057 local->config.fastListenDelay = cpu_to_le16((vwrq->value + 500) / 1024);
7058 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7059 set_bit (FLAG_COMMIT, &local->flags);
7060 } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
7061 local->config.fastListenInterval =
7062 local->config.listenInterval =
7063 cpu_to_le16((vwrq->value + 500) / 1024);
7064 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7065 set_bit (FLAG_COMMIT, &local->flags);
7066 }
7067 switch (vwrq->flags & IW_POWER_MODE) {
7068 case IW_POWER_UNICAST_R:
7069 if (sniffing_mode(local))
7070 return -EINVAL;
7071 local->config.rmode &= ~RXMODE_MASK;
7072 local->config.rmode |= RXMODE_ADDR;
7073 set_bit (FLAG_COMMIT, &local->flags);
7074 break;
7075 case IW_POWER_ALL_R:
7076 if (sniffing_mode(local))
7077 return -EINVAL;
7078 local->config.rmode &= ~RXMODE_MASK;
7079 local->config.rmode |= RXMODE_BC_MC_ADDR;
7080 set_bit (FLAG_COMMIT, &local->flags);
7081 case IW_POWER_ON:
7082 /* This is broken, fixme ;-) */
7083 break;
7084 default:
7085 return -EINVAL;
7086 }
7087 // Note : we may want to factor local->need_commit here
7088 // Note2 : may also want to factor RXMODE_RFMON test
7089 return -EINPROGRESS; /* Call commit handler */
7090 }
7091
7092 /*------------------------------------------------------------------*/
7093 /*
7094 * Wireless Handler : get Power Management
7095 */
7096 static int airo_get_power(struct net_device *dev,
7097 struct iw_request_info *info,
7098 struct iw_param *vwrq,
7099 char *extra)
7100 {
7101 struct airo_info *local = dev->ml_priv;
7102 __le16 mode;
7103
7104 readConfigRid(local, 1);
7105 mode = local->config.powerSaveMode;
7106 if ((vwrq->disabled = (mode == POWERSAVE_CAM)))
7107 return 0;
7108 if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
7109 vwrq->value = le16_to_cpu(local->config.fastListenDelay) * 1024;
7110 vwrq->flags = IW_POWER_TIMEOUT;
7111 } else {
7112 vwrq->value = le16_to_cpu(local->config.fastListenInterval) * 1024;
7113 vwrq->flags = IW_POWER_PERIOD;
7114 }
7115 if ((local->config.rmode & RXMODE_MASK) == RXMODE_ADDR)
7116 vwrq->flags |= IW_POWER_UNICAST_R;
7117 else
7118 vwrq->flags |= IW_POWER_ALL_R;
7119
7120 return 0;
7121 }
7122
7123 /*------------------------------------------------------------------*/
7124 /*
7125 * Wireless Handler : set Sensitivity
7126 */
7127 static int airo_set_sens(struct net_device *dev,
7128 struct iw_request_info *info,
7129 struct iw_param *vwrq,
7130 char *extra)
7131 {
7132 struct airo_info *local = dev->ml_priv;
7133
7134 readConfigRid(local, 1);
7135 local->config.rssiThreshold =
7136 cpu_to_le16(vwrq->disabled ? RSSI_DEFAULT : vwrq->value);
7137 set_bit (FLAG_COMMIT, &local->flags);
7138
7139 return -EINPROGRESS; /* Call commit handler */
7140 }
7141
7142 /*------------------------------------------------------------------*/
7143 /*
7144 * Wireless Handler : get Sensitivity
7145 */
7146 static int airo_get_sens(struct net_device *dev,
7147 struct iw_request_info *info,
7148 struct iw_param *vwrq,
7149 char *extra)
7150 {
7151 struct airo_info *local = dev->ml_priv;
7152
7153 readConfigRid(local, 1);
7154 vwrq->value = le16_to_cpu(local->config.rssiThreshold);
7155 vwrq->disabled = (vwrq->value == 0);
7156 vwrq->fixed = 1;
7157
7158 return 0;
7159 }
7160
7161 /*------------------------------------------------------------------*/
7162 /*
7163 * Wireless Handler : get AP List
7164 * Note : this is deprecated in favor of IWSCAN
7165 */
7166 static int airo_get_aplist(struct net_device *dev,
7167 struct iw_request_info *info,
7168 struct iw_point *dwrq,
7169 char *extra)
7170 {
7171 struct airo_info *local = dev->ml_priv;
7172 struct sockaddr *address = (struct sockaddr *) extra;
7173 struct iw_quality *qual;
7174 BSSListRid BSSList;
7175 int i;
7176 int loseSync = capable(CAP_NET_ADMIN) ? 1: -1;
7177
7178 qual = kmalloc(IW_MAX_AP * sizeof(*qual), GFP_KERNEL);
7179 if (!qual)
7180 return -ENOMEM;
7181
7182 for (i = 0; i < IW_MAX_AP; i++) {
7183 u16 dBm;
7184 if (readBSSListRid(local, loseSync, &BSSList))
7185 break;
7186 loseSync = 0;
7187 memcpy(address[i].sa_data, BSSList.bssid, ETH_ALEN);
7188 address[i].sa_family = ARPHRD_ETHER;
7189 dBm = le16_to_cpu(BSSList.dBm);
7190 if (local->rssi) {
7191 qual[i].level = 0x100 - dBm;
7192 qual[i].qual = airo_dbm_to_pct(local->rssi, dBm);
7193 qual[i].updated = IW_QUAL_QUAL_UPDATED
7194 | IW_QUAL_LEVEL_UPDATED
7195 | IW_QUAL_DBM;
7196 } else {
7197 qual[i].level = (dBm + 321) / 2;
7198 qual[i].qual = 0;
7199 qual[i].updated = IW_QUAL_QUAL_INVALID
7200 | IW_QUAL_LEVEL_UPDATED
7201 | IW_QUAL_DBM;
7202 }
7203 qual[i].noise = local->wstats.qual.noise;
7204 if (BSSList.index == cpu_to_le16(0xffff))
7205 break;
7206 }
7207 if (!i) {
7208 StatusRid status_rid; /* Card status info */
7209 readStatusRid(local, &status_rid, 1);
7210 for (i = 0;
7211 i < min(IW_MAX_AP, 4) &&
7212 (status_rid.bssid[i][0]
7213 & status_rid.bssid[i][1]
7214 & status_rid.bssid[i][2]
7215 & status_rid.bssid[i][3]
7216 & status_rid.bssid[i][4]
7217 & status_rid.bssid[i][5])!=0xff &&
7218 (status_rid.bssid[i][0]
7219 | status_rid.bssid[i][1]
7220 | status_rid.bssid[i][2]
7221 | status_rid.bssid[i][3]
7222 | status_rid.bssid[i][4]
7223 | status_rid.bssid[i][5]);
7224 i++) {
7225 memcpy(address[i].sa_data,
7226 status_rid.bssid[i], ETH_ALEN);
7227 address[i].sa_family = ARPHRD_ETHER;
7228 }
7229 } else {
7230 dwrq->flags = 1; /* Should be define'd */
7231 memcpy(extra + sizeof(struct sockaddr)*i,
7232 &qual, sizeof(struct iw_quality)*i);
7233 }
7234 dwrq->length = i;
7235
7236 kfree(qual);
7237 return 0;
7238 }
7239
7240 /*------------------------------------------------------------------*/
7241 /*
7242 * Wireless Handler : Initiate Scan
7243 */
7244 static int airo_set_scan(struct net_device *dev,
7245 struct iw_request_info *info,
7246 struct iw_point *dwrq,
7247 char *extra)
7248 {
7249 struct airo_info *ai = dev->ml_priv;
7250 Cmd cmd;
7251 Resp rsp;
7252 int wake = 0;
7253
7254 /* Note : you may have realised that, as this is a SET operation,
7255 * this is privileged and therefore a normal user can't
7256 * perform scanning.
7257 * This is not an error, while the device perform scanning,
7258 * traffic doesn't flow, so it's a perfect DoS...
7259 * Jean II */
7260 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
7261
7262 if (down_interruptible(&ai->sem))
7263 return -ERESTARTSYS;
7264
7265 /* If there's already a scan in progress, don't
7266 * trigger another one. */
7267 if (ai->scan_timeout > 0)
7268 goto out;
7269
7270 /* Initiate a scan command */
7271 ai->scan_timeout = RUN_AT(3*HZ);
7272 memset(&cmd, 0, sizeof(cmd));
7273 cmd.cmd=CMD_LISTBSS;
7274 issuecommand(ai, &cmd, &rsp);
7275 wake = 1;
7276
7277 out:
7278 up(&ai->sem);
7279 if (wake)
7280 wake_up_interruptible(&ai->thr_wait);
7281 return 0;
7282 }
7283
7284 /*------------------------------------------------------------------*/
7285 /*
7286 * Translate scan data returned from the card to a card independent
7287 * format that the Wireless Tools will understand - Jean II
7288 */
7289 static inline char *airo_translate_scan(struct net_device *dev,
7290 struct iw_request_info *info,
7291 char *current_ev,
7292 char *end_buf,
7293 BSSListRid *bss)
7294 {
7295 struct airo_info *ai = dev->ml_priv;
7296 struct iw_event iwe; /* Temporary buffer */
7297 __le16 capabilities;
7298 char * current_val; /* For rates */
7299 int i;
7300 char * buf;
7301 u16 dBm;
7302
7303 /* First entry *MUST* be the AP MAC address */
7304 iwe.cmd = SIOCGIWAP;
7305 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
7306 memcpy(iwe.u.ap_addr.sa_data, bss->bssid, ETH_ALEN);
7307 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7308 &iwe, IW_EV_ADDR_LEN);
7309
7310 /* Other entries will be displayed in the order we give them */
7311
7312 /* Add the ESSID */
7313 iwe.u.data.length = bss->ssidLen;
7314 if(iwe.u.data.length > 32)
7315 iwe.u.data.length = 32;
7316 iwe.cmd = SIOCGIWESSID;
7317 iwe.u.data.flags = 1;
7318 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7319 &iwe, bss->ssid);
7320
7321 /* Add mode */
7322 iwe.cmd = SIOCGIWMODE;
7323 capabilities = bss->cap;
7324 if(capabilities & (CAP_ESS | CAP_IBSS)) {
7325 if(capabilities & CAP_ESS)
7326 iwe.u.mode = IW_MODE_MASTER;
7327 else
7328 iwe.u.mode = IW_MODE_ADHOC;
7329 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7330 &iwe, IW_EV_UINT_LEN);
7331 }
7332
7333 /* Add frequency */
7334 iwe.cmd = SIOCGIWFREQ;
7335 iwe.u.freq.m = le16_to_cpu(bss->dsChannel);
7336 iwe.u.freq.m = ieee80211_dsss_chan_to_freq(iwe.u.freq.m) * 100000;
7337 iwe.u.freq.e = 1;
7338 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7339 &iwe, IW_EV_FREQ_LEN);
7340
7341 dBm = le16_to_cpu(bss->dBm);
7342
7343 /* Add quality statistics */
7344 iwe.cmd = IWEVQUAL;
7345 if (ai->rssi) {
7346 iwe.u.qual.level = 0x100 - dBm;
7347 iwe.u.qual.qual = airo_dbm_to_pct(ai->rssi, dBm);
7348 iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED
7349 | IW_QUAL_LEVEL_UPDATED
7350 | IW_QUAL_DBM;
7351 } else {
7352 iwe.u.qual.level = (dBm + 321) / 2;
7353 iwe.u.qual.qual = 0;
7354 iwe.u.qual.updated = IW_QUAL_QUAL_INVALID
7355 | IW_QUAL_LEVEL_UPDATED
7356 | IW_QUAL_DBM;
7357 }
7358 iwe.u.qual.noise = ai->wstats.qual.noise;
7359 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7360 &iwe, IW_EV_QUAL_LEN);
7361
7362 /* Add encryption capability */
7363 iwe.cmd = SIOCGIWENCODE;
7364 if(capabilities & CAP_PRIVACY)
7365 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
7366 else
7367 iwe.u.data.flags = IW_ENCODE_DISABLED;
7368 iwe.u.data.length = 0;
7369 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7370 &iwe, bss->ssid);
7371
7372 /* Rate : stuffing multiple values in a single event require a bit
7373 * more of magic - Jean II */
7374 current_val = current_ev + iwe_stream_lcp_len(info);
7375
7376 iwe.cmd = SIOCGIWRATE;
7377 /* Those two flags are ignored... */
7378 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
7379 /* Max 8 values */
7380 for(i = 0 ; i < 8 ; i++) {
7381 /* NULL terminated */
7382 if(bss->rates[i] == 0)
7383 break;
7384 /* Bit rate given in 500 kb/s units (+ 0x80) */
7385 iwe.u.bitrate.value = ((bss->rates[i] & 0x7f) * 500000);
7386 /* Add new value to event */
7387 current_val = iwe_stream_add_value(info, current_ev,
7388 current_val, end_buf,
7389 &iwe, IW_EV_PARAM_LEN);
7390 }
7391 /* Check if we added any event */
7392 if ((current_val - current_ev) > iwe_stream_lcp_len(info))
7393 current_ev = current_val;
7394
7395 /* Beacon interval */
7396 buf = kmalloc(30, GFP_KERNEL);
7397 if (buf) {
7398 iwe.cmd = IWEVCUSTOM;
7399 sprintf(buf, "bcn_int=%d", bss->beaconInterval);
7400 iwe.u.data.length = strlen(buf);
7401 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7402 &iwe, buf);
7403 kfree(buf);
7404 }
7405
7406 /* Put WPA/RSN Information Elements into the event stream */
7407 if (test_bit(FLAG_WPA_CAPABLE, &ai->flags)) {
7408 unsigned int num_null_ies = 0;
7409 u16 length = sizeof (bss->extra.iep);
7410 u8 *ie = (void *)&bss->extra.iep;
7411
7412 while ((length >= 2) && (num_null_ies < 2)) {
7413 if (2 + ie[1] > length) {
7414 /* Invalid element, don't continue parsing IE */
7415 break;
7416 }
7417
7418 switch (ie[0]) {
7419 case WLAN_EID_SSID:
7420 /* Two zero-length SSID elements
7421 * mean we're done parsing elements */
7422 if (!ie[1])
7423 num_null_ies++;
7424 break;
7425
7426 case WLAN_EID_GENERIC:
7427 if (ie[1] >= 4 &&
7428 ie[2] == 0x00 &&
7429 ie[3] == 0x50 &&
7430 ie[4] == 0xf2 &&
7431 ie[5] == 0x01) {
7432 iwe.cmd = IWEVGENIE;
7433 /* 64 is an arbitrary cut-off */
7434 iwe.u.data.length = min(ie[1] + 2,
7435 64);
7436 current_ev = iwe_stream_add_point(
7437 info, current_ev,
7438 end_buf, &iwe, ie);
7439 }
7440 break;
7441
7442 case WLAN_EID_RSN:
7443 iwe.cmd = IWEVGENIE;
7444 /* 64 is an arbitrary cut-off */
7445 iwe.u.data.length = min(ie[1] + 2, 64);
7446 current_ev = iwe_stream_add_point(
7447 info, current_ev, end_buf,
7448 &iwe, ie);
7449 break;
7450
7451 default:
7452 break;
7453 }
7454
7455 length -= 2 + ie[1];
7456 ie += 2 + ie[1];
7457 }
7458 }
7459 return current_ev;
7460 }
7461
7462 /*------------------------------------------------------------------*/
7463 /*
7464 * Wireless Handler : Read Scan Results
7465 */
7466 static int airo_get_scan(struct net_device *dev,
7467 struct iw_request_info *info,
7468 struct iw_point *dwrq,
7469 char *extra)
7470 {
7471 struct airo_info *ai = dev->ml_priv;
7472 BSSListElement *net;
7473 int err = 0;
7474 char *current_ev = extra;
7475
7476 /* If a scan is in-progress, return -EAGAIN */
7477 if (ai->scan_timeout > 0)
7478 return -EAGAIN;
7479
7480 if (down_interruptible(&ai->sem))
7481 return -EAGAIN;
7482
7483 list_for_each_entry (net, &ai->network_list, list) {
7484 /* Translate to WE format this entry */
7485 current_ev = airo_translate_scan(dev, info, current_ev,
7486 extra + dwrq->length,
7487 &net->bss);
7488
7489 /* Check if there is space for one more entry */
7490 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
7491 /* Ask user space to try again with a bigger buffer */
7492 err = -E2BIG;
7493 goto out;
7494 }
7495 }
7496
7497 /* Length of data */
7498 dwrq->length = (current_ev - extra);
7499 dwrq->flags = 0; /* todo */
7500
7501 out:
7502 up(&ai->sem);
7503 return err;
7504 }
7505
7506 /*------------------------------------------------------------------*/
7507 /*
7508 * Commit handler : called after a bunch of SET operations
7509 */
7510 static int airo_config_commit(struct net_device *dev,
7511 struct iw_request_info *info, /* NULL */
7512 void *zwrq, /* NULL */
7513 char *extra) /* NULL */
7514 {
7515 struct airo_info *local = dev->ml_priv;
7516
7517 if (!test_bit (FLAG_COMMIT, &local->flags))
7518 return 0;
7519
7520 /* Some of the "SET" function may have modified some of the
7521 * parameters. It's now time to commit them in the card */
7522 disable_MAC(local, 1);
7523 if (test_bit (FLAG_RESET, &local->flags)) {
7524 APListRid APList_rid;
7525 SsidRid SSID_rid;
7526
7527 readAPListRid(local, &APList_rid);
7528 readSsidRid(local, &SSID_rid);
7529 if (test_bit(FLAG_MPI,&local->flags))
7530 setup_card(local, dev->dev_addr, 1 );
7531 else
7532 reset_airo_card(dev);
7533 disable_MAC(local, 1);
7534 writeSsidRid(local, &SSID_rid, 1);
7535 writeAPListRid(local, &APList_rid, 1);
7536 }
7537 if (down_interruptible(&local->sem))
7538 return -ERESTARTSYS;
7539 writeConfigRid(local, 0);
7540 enable_MAC(local, 0);
7541 if (test_bit (FLAG_RESET, &local->flags))
7542 airo_set_promisc(local);
7543 else
7544 up(&local->sem);
7545
7546 return 0;
7547 }
7548
7549 /*------------------------------------------------------------------*/
7550 /*
7551 * Structures to export the Wireless Handlers
7552 */
7553
7554 static const struct iw_priv_args airo_private_args[] = {
7555 /*{ cmd, set_args, get_args, name } */
7556 { AIROIOCTL, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7557 IW_PRIV_TYPE_BYTE | 2047, "airoioctl" },
7558 { AIROIDIFC, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7559 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "airoidifc" },
7560 };
7561
7562 static const iw_handler airo_handler[] =
7563 {
7564 (iw_handler) airo_config_commit, /* SIOCSIWCOMMIT */
7565 (iw_handler) airo_get_name, /* SIOCGIWNAME */
7566 (iw_handler) NULL, /* SIOCSIWNWID */
7567 (iw_handler) NULL, /* SIOCGIWNWID */
7568 (iw_handler) airo_set_freq, /* SIOCSIWFREQ */
7569 (iw_handler) airo_get_freq, /* SIOCGIWFREQ */
7570 (iw_handler) airo_set_mode, /* SIOCSIWMODE */
7571 (iw_handler) airo_get_mode, /* SIOCGIWMODE */
7572 (iw_handler) airo_set_sens, /* SIOCSIWSENS */
7573 (iw_handler) airo_get_sens, /* SIOCGIWSENS */
7574 (iw_handler) NULL, /* SIOCSIWRANGE */
7575 (iw_handler) airo_get_range, /* SIOCGIWRANGE */
7576 (iw_handler) NULL, /* SIOCSIWPRIV */
7577 (iw_handler) NULL, /* SIOCGIWPRIV */
7578 (iw_handler) NULL, /* SIOCSIWSTATS */
7579 (iw_handler) NULL, /* SIOCGIWSTATS */
7580 iw_handler_set_spy, /* SIOCSIWSPY */
7581 iw_handler_get_spy, /* SIOCGIWSPY */
7582 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
7583 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
7584 (iw_handler) airo_set_wap, /* SIOCSIWAP */
7585 (iw_handler) airo_get_wap, /* SIOCGIWAP */
7586 (iw_handler) NULL, /* -- hole -- */
7587 (iw_handler) airo_get_aplist, /* SIOCGIWAPLIST */
7588 (iw_handler) airo_set_scan, /* SIOCSIWSCAN */
7589 (iw_handler) airo_get_scan, /* SIOCGIWSCAN */
7590 (iw_handler) airo_set_essid, /* SIOCSIWESSID */
7591 (iw_handler) airo_get_essid, /* SIOCGIWESSID */
7592 (iw_handler) airo_set_nick, /* SIOCSIWNICKN */
7593 (iw_handler) airo_get_nick, /* SIOCGIWNICKN */
7594 (iw_handler) NULL, /* -- hole -- */
7595 (iw_handler) NULL, /* -- hole -- */
7596 (iw_handler) airo_set_rate, /* SIOCSIWRATE */
7597 (iw_handler) airo_get_rate, /* SIOCGIWRATE */
7598 (iw_handler) airo_set_rts, /* SIOCSIWRTS */
7599 (iw_handler) airo_get_rts, /* SIOCGIWRTS */
7600 (iw_handler) airo_set_frag, /* SIOCSIWFRAG */
7601 (iw_handler) airo_get_frag, /* SIOCGIWFRAG */
7602 (iw_handler) airo_set_txpow, /* SIOCSIWTXPOW */
7603 (iw_handler) airo_get_txpow, /* SIOCGIWTXPOW */
7604 (iw_handler) airo_set_retry, /* SIOCSIWRETRY */
7605 (iw_handler) airo_get_retry, /* SIOCGIWRETRY */
7606 (iw_handler) airo_set_encode, /* SIOCSIWENCODE */
7607 (iw_handler) airo_get_encode, /* SIOCGIWENCODE */
7608 (iw_handler) airo_set_power, /* SIOCSIWPOWER */
7609 (iw_handler) airo_get_power, /* SIOCGIWPOWER */
7610 (iw_handler) NULL, /* -- hole -- */
7611 (iw_handler) NULL, /* -- hole -- */
7612 (iw_handler) NULL, /* SIOCSIWGENIE */
7613 (iw_handler) NULL, /* SIOCGIWGENIE */
7614 (iw_handler) airo_set_auth, /* SIOCSIWAUTH */
7615 (iw_handler) airo_get_auth, /* SIOCGIWAUTH */
7616 (iw_handler) airo_set_encodeext, /* SIOCSIWENCODEEXT */
7617 (iw_handler) airo_get_encodeext, /* SIOCGIWENCODEEXT */
7618 (iw_handler) NULL, /* SIOCSIWPMKSA */
7619 };
7620
7621 /* Note : don't describe AIROIDIFC and AIROOLDIDIFC in here.
7622 * We want to force the use of the ioctl code, because those can't be
7623 * won't work the iw_handler code (because they simultaneously read
7624 * and write data and iw_handler can't do that).
7625 * Note that it's perfectly legal to read/write on a single ioctl command,
7626 * you just can't use iwpriv and need to force it via the ioctl handler.
7627 * Jean II */
7628 static const iw_handler airo_private_handler[] =
7629 {
7630 NULL, /* SIOCIWFIRSTPRIV */
7631 };
7632
7633 static const struct iw_handler_def airo_handler_def =
7634 {
7635 .num_standard = ARRAY_SIZE(airo_handler),
7636 .num_private = ARRAY_SIZE(airo_private_handler),
7637 .num_private_args = ARRAY_SIZE(airo_private_args),
7638 .standard = airo_handler,
7639 .private = airo_private_handler,
7640 .private_args = airo_private_args,
7641 .get_wireless_stats = airo_get_wireless_stats,
7642 };
7643
7644 /*
7645 * This defines the configuration part of the Wireless Extensions
7646 * Note : irq and spinlock protection will occur in the subroutines
7647 *
7648 * TODO :
7649 * o Check input value more carefully and fill correct values in range
7650 * o Test and shakeout the bugs (if any)
7651 *
7652 * Jean II
7653 *
7654 * Javier Achirica did a great job of merging code from the unnamed CISCO
7655 * developer that added support for flashing the card.
7656 */
7657 static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
7658 {
7659 int rc = 0;
7660 struct airo_info *ai = dev->ml_priv;
7661
7662 if (ai->power.event)
7663 return 0;
7664
7665 switch (cmd) {
7666 #ifdef CISCO_EXT
7667 case AIROIDIFC:
7668 #ifdef AIROOLDIDIFC
7669 case AIROOLDIDIFC:
7670 #endif
7671 {
7672 int val = AIROMAGIC;
7673 aironet_ioctl com;
7674 if (copy_from_user(&com,rq->ifr_data,sizeof(com)))
7675 rc = -EFAULT;
7676 else if (copy_to_user(com.data,(char *)&val,sizeof(val)))
7677 rc = -EFAULT;
7678 }
7679 break;
7680
7681 case AIROIOCTL:
7682 #ifdef AIROOLDIOCTL
7683 case AIROOLDIOCTL:
7684 #endif
7685 /* Get the command struct and hand it off for evaluation by
7686 * the proper subfunction
7687 */
7688 {
7689 aironet_ioctl com;
7690 if (copy_from_user(&com,rq->ifr_data,sizeof(com))) {
7691 rc = -EFAULT;
7692 break;
7693 }
7694
7695 /* Separate R/W functions bracket legality here
7696 */
7697 if ( com.command == AIRORSWVERSION ) {
7698 if (copy_to_user(com.data, swversion, sizeof(swversion)))
7699 rc = -EFAULT;
7700 else
7701 rc = 0;
7702 }
7703 else if ( com.command <= AIRORRID)
7704 rc = readrids(dev,&com);
7705 else if ( com.command >= AIROPCAP && com.command <= (AIROPLEAPUSR+2) )
7706 rc = writerids(dev,&com);
7707 else if ( com.command >= AIROFLSHRST && com.command <= AIRORESTART )
7708 rc = flashcard(dev,&com);
7709 else
7710 rc = -EINVAL; /* Bad command in ioctl */
7711 }
7712 break;
7713 #endif /* CISCO_EXT */
7714
7715 // All other calls are currently unsupported
7716 default:
7717 rc = -EOPNOTSUPP;
7718 }
7719 return rc;
7720 }
7721
7722 /*
7723 * Get the Wireless stats out of the driver
7724 * Note : irq and spinlock protection will occur in the subroutines
7725 *
7726 * TODO :
7727 * o Check if work in Ad-Hoc mode (otherwise, use SPY, as in wvlan_cs)
7728 *
7729 * Jean
7730 */
7731 static void airo_read_wireless_stats(struct airo_info *local)
7732 {
7733 StatusRid status_rid;
7734 StatsRid stats_rid;
7735 CapabilityRid cap_rid;
7736 __le32 *vals = stats_rid.vals;
7737
7738 /* Get stats out of the card */
7739 clear_bit(JOB_WSTATS, &local->jobs);
7740 if (local->power.event) {
7741 up(&local->sem);
7742 return;
7743 }
7744 readCapabilityRid(local, &cap_rid, 0);
7745 readStatusRid(local, &status_rid, 0);
7746 readStatsRid(local, &stats_rid, RID_STATS, 0);
7747 up(&local->sem);
7748
7749 /* The status */
7750 local->wstats.status = le16_to_cpu(status_rid.mode);
7751
7752 /* Signal quality and co */
7753 if (local->rssi) {
7754 local->wstats.qual.level =
7755 airo_rssi_to_dbm(local->rssi,
7756 le16_to_cpu(status_rid.sigQuality));
7757 /* normalizedSignalStrength appears to be a percentage */
7758 local->wstats.qual.qual =
7759 le16_to_cpu(status_rid.normalizedSignalStrength);
7760 } else {
7761 local->wstats.qual.level =
7762 (le16_to_cpu(status_rid.normalizedSignalStrength) + 321) / 2;
7763 local->wstats.qual.qual = airo_get_quality(&status_rid, &cap_rid);
7764 }
7765 if (le16_to_cpu(status_rid.len) >= 124) {
7766 local->wstats.qual.noise = 0x100 - status_rid.noisedBm;
7767 local->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
7768 } else {
7769 local->wstats.qual.noise = 0;
7770 local->wstats.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID | IW_QUAL_DBM;
7771 }
7772
7773 /* Packets discarded in the wireless adapter due to wireless
7774 * specific problems */
7775 local->wstats.discard.nwid = le32_to_cpu(vals[56]) +
7776 le32_to_cpu(vals[57]) +
7777 le32_to_cpu(vals[58]); /* SSID Mismatch */
7778 local->wstats.discard.code = le32_to_cpu(vals[6]);/* RxWepErr */
7779 local->wstats.discard.fragment = le32_to_cpu(vals[30]);
7780 local->wstats.discard.retries = le32_to_cpu(vals[10]);
7781 local->wstats.discard.misc = le32_to_cpu(vals[1]) +
7782 le32_to_cpu(vals[32]);
7783 local->wstats.miss.beacon = le32_to_cpu(vals[34]);
7784 }
7785
7786 static struct iw_statistics *airo_get_wireless_stats(struct net_device *dev)
7787 {
7788 struct airo_info *local = dev->ml_priv;
7789
7790 if (!test_bit(JOB_WSTATS, &local->jobs)) {
7791 /* Get stats out of the card if available */
7792 if (down_trylock(&local->sem) != 0) {
7793 set_bit(JOB_WSTATS, &local->jobs);
7794 wake_up_interruptible(&local->thr_wait);
7795 } else
7796 airo_read_wireless_stats(local);
7797 }
7798
7799 return &local->wstats;
7800 }
7801
7802 #ifdef CISCO_EXT
7803 /*
7804 * This just translates from driver IOCTL codes to the command codes to
7805 * feed to the radio's host interface. Things can be added/deleted
7806 * as needed. This represents the READ side of control I/O to
7807 * the card
7808 */
7809 static int readrids(struct net_device *dev, aironet_ioctl *comp) {
7810 unsigned short ridcode;
7811 unsigned char *iobuf;
7812 int len;
7813 struct airo_info *ai = dev->ml_priv;
7814
7815 if (test_bit(FLAG_FLASHING, &ai->flags))
7816 return -EIO;
7817
7818 switch(comp->command)
7819 {
7820 case AIROGCAP: ridcode = RID_CAPABILITIES; break;
7821 case AIROGCFG: ridcode = RID_CONFIG;
7822 if (test_bit(FLAG_COMMIT, &ai->flags)) {
7823 disable_MAC (ai, 1);
7824 writeConfigRid (ai, 1);
7825 enable_MAC(ai, 1);
7826 }
7827 break;
7828 case AIROGSLIST: ridcode = RID_SSID; break;
7829 case AIROGVLIST: ridcode = RID_APLIST; break;
7830 case AIROGDRVNAM: ridcode = RID_DRVNAME; break;
7831 case AIROGEHTENC: ridcode = RID_ETHERENCAP; break;
7832 case AIROGWEPKTMP: ridcode = RID_WEP_TEMP;
7833 /* Only super-user can read WEP keys */
7834 if (!capable(CAP_NET_ADMIN))
7835 return -EPERM;
7836 break;
7837 case AIROGWEPKNV: ridcode = RID_WEP_PERM;
7838 /* Only super-user can read WEP keys */
7839 if (!capable(CAP_NET_ADMIN))
7840 return -EPERM;
7841 break;
7842 case AIROGSTAT: ridcode = RID_STATUS; break;
7843 case AIROGSTATSD32: ridcode = RID_STATSDELTA; break;
7844 case AIROGSTATSC32: ridcode = RID_STATS; break;
7845 case AIROGMICSTATS:
7846 if (copy_to_user(comp->data, &ai->micstats,
7847 min((int)comp->len,(int)sizeof(ai->micstats))))
7848 return -EFAULT;
7849 return 0;
7850 case AIRORRID: ridcode = comp->ridnum; break;
7851 default:
7852 return -EINVAL;
7853 break;
7854 }
7855
7856 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7857 return -ENOMEM;
7858
7859 PC4500_readrid(ai,ridcode,iobuf,RIDSIZE, 1);
7860 /* get the count of bytes in the rid docs say 1st 2 bytes is it.
7861 * then return it to the user
7862 * 9/22/2000 Honor user given length
7863 */
7864 len = comp->len;
7865
7866 if (copy_to_user(comp->data, iobuf, min(len, (int)RIDSIZE))) {
7867 kfree (iobuf);
7868 return -EFAULT;
7869 }
7870 kfree (iobuf);
7871 return 0;
7872 }
7873
7874 /*
7875 * Danger Will Robinson write the rids here
7876 */
7877
7878 static int writerids(struct net_device *dev, aironet_ioctl *comp) {
7879 struct airo_info *ai = dev->ml_priv;
7880 int ridcode;
7881 int enabled;
7882 static int (* writer)(struct airo_info *, u16 rid, const void *, int, int);
7883 unsigned char *iobuf;
7884
7885 /* Only super-user can write RIDs */
7886 if (!capable(CAP_NET_ADMIN))
7887 return -EPERM;
7888
7889 if (test_bit(FLAG_FLASHING, &ai->flags))
7890 return -EIO;
7891
7892 ridcode = 0;
7893 writer = do_writerid;
7894
7895 switch(comp->command)
7896 {
7897 case AIROPSIDS: ridcode = RID_SSID; break;
7898 case AIROPCAP: ridcode = RID_CAPABILITIES; break;
7899 case AIROPAPLIST: ridcode = RID_APLIST; break;
7900 case AIROPCFG: ai->config.len = 0;
7901 clear_bit(FLAG_COMMIT, &ai->flags);
7902 ridcode = RID_CONFIG; break;
7903 case AIROPWEPKEYNV: ridcode = RID_WEP_PERM; break;
7904 case AIROPLEAPUSR: ridcode = RID_LEAPUSERNAME; break;
7905 case AIROPLEAPPWD: ridcode = RID_LEAPPASSWORD; break;
7906 case AIROPWEPKEY: ridcode = RID_WEP_TEMP; writer = PC4500_writerid;
7907 break;
7908 case AIROPLEAPUSR+1: ridcode = 0xFF2A; break;
7909 case AIROPLEAPUSR+2: ridcode = 0xFF2B; break;
7910
7911 /* this is not really a rid but a command given to the card
7912 * same with MAC off
7913 */
7914 case AIROPMACON:
7915 if (enable_MAC(ai, 1) != 0)
7916 return -EIO;
7917 return 0;
7918
7919 /*
7920 * Evidently this code in the airo driver does not get a symbol
7921 * as disable_MAC. it's probably so short the compiler does not gen one.
7922 */
7923 case AIROPMACOFF:
7924 disable_MAC(ai, 1);
7925 return 0;
7926
7927 /* This command merely clears the counts does not actually store any data
7928 * only reads rid. But as it changes the cards state, I put it in the
7929 * writerid routines.
7930 */
7931 case AIROPSTCLR:
7932 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7933 return -ENOMEM;
7934
7935 PC4500_readrid(ai,RID_STATSDELTACLEAR,iobuf,RIDSIZE, 1);
7936
7937 enabled = ai->micstats.enabled;
7938 memset(&ai->micstats,0,sizeof(ai->micstats));
7939 ai->micstats.enabled = enabled;
7940
7941 if (copy_to_user(comp->data, iobuf,
7942 min((int)comp->len, (int)RIDSIZE))) {
7943 kfree (iobuf);
7944 return -EFAULT;
7945 }
7946 kfree (iobuf);
7947 return 0;
7948
7949 default:
7950 return -EOPNOTSUPP; /* Blarg! */
7951 }
7952 if(comp->len > RIDSIZE)
7953 return -EINVAL;
7954
7955 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7956 return -ENOMEM;
7957
7958 if (copy_from_user(iobuf,comp->data,comp->len)) {
7959 kfree (iobuf);
7960 return -EFAULT;
7961 }
7962
7963 if (comp->command == AIROPCFG) {
7964 ConfigRid *cfg = (ConfigRid *)iobuf;
7965
7966 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags))
7967 cfg->opmode |= MODE_MIC;
7968
7969 if ((cfg->opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
7970 set_bit (FLAG_ADHOC, &ai->flags);
7971 else
7972 clear_bit (FLAG_ADHOC, &ai->flags);
7973 }
7974
7975 if((*writer)(ai, ridcode, iobuf,comp->len,1)) {
7976 kfree (iobuf);
7977 return -EIO;
7978 }
7979 kfree (iobuf);
7980 return 0;
7981 }
7982
7983 /*****************************************************************************
7984 * Ancillary flash / mod functions much black magic lurkes here *
7985 *****************************************************************************
7986 */
7987
7988 /*
7989 * Flash command switch table
7990 */
7991
7992 static int flashcard(struct net_device *dev, aironet_ioctl *comp) {
7993 int z;
7994
7995 /* Only super-user can modify flash */
7996 if (!capable(CAP_NET_ADMIN))
7997 return -EPERM;
7998
7999 switch(comp->command)
8000 {
8001 case AIROFLSHRST:
8002 return cmdreset((struct airo_info *)dev->ml_priv);
8003
8004 case AIROFLSHSTFL:
8005 if (!AIRO_FLASH(dev) &&
8006 (AIRO_FLASH(dev) = kmalloc(FLASHSIZE, GFP_KERNEL)) == NULL)
8007 return -ENOMEM;
8008 return setflashmode((struct airo_info *)dev->ml_priv);
8009
8010 case AIROFLSHGCHR: /* Get char from aux */
8011 if(comp->len != sizeof(int))
8012 return -EINVAL;
8013 if (copy_from_user(&z,comp->data,comp->len))
8014 return -EFAULT;
8015 return flashgchar((struct airo_info *)dev->ml_priv, z, 8000);
8016
8017 case AIROFLSHPCHR: /* Send char to card. */
8018 if(comp->len != sizeof(int))
8019 return -EINVAL;
8020 if (copy_from_user(&z,comp->data,comp->len))
8021 return -EFAULT;
8022 return flashpchar((struct airo_info *)dev->ml_priv, z, 8000);
8023
8024 case AIROFLPUTBUF: /* Send 32k to card */
8025 if (!AIRO_FLASH(dev))
8026 return -ENOMEM;
8027 if(comp->len > FLASHSIZE)
8028 return -EINVAL;
8029 if (copy_from_user(AIRO_FLASH(dev), comp->data, comp->len))
8030 return -EFAULT;
8031
8032 flashputbuf((struct airo_info *)dev->ml_priv);
8033 return 0;
8034
8035 case AIRORESTART:
8036 if (flashrestart((struct airo_info *)dev->ml_priv, dev))
8037 return -EIO;
8038 return 0;
8039 }
8040 return -EINVAL;
8041 }
8042
8043 #define FLASH_COMMAND 0x7e7e
8044
8045 /*
8046 * STEP 1)
8047 * Disable MAC and do soft reset on
8048 * card.
8049 */
8050
8051 static int cmdreset(struct airo_info *ai) {
8052 disable_MAC(ai, 1);
8053
8054 if(!waitbusy (ai)){
8055 airo_print_info(ai->dev->name, "Waitbusy hang before RESET");
8056 return -EBUSY;
8057 }
8058
8059 OUT4500(ai,COMMAND,CMD_SOFTRESET);
8060
8061 ssleep(1); /* WAS 600 12/7/00 */
8062
8063 if(!waitbusy (ai)){
8064 airo_print_info(ai->dev->name, "Waitbusy hang AFTER RESET");
8065 return -EBUSY;
8066 }
8067 return 0;
8068 }
8069
8070 /* STEP 2)
8071 * Put the card in legendary flash
8072 * mode
8073 */
8074
8075 static int setflashmode (struct airo_info *ai) {
8076 set_bit (FLAG_FLASHING, &ai->flags);
8077
8078 OUT4500(ai, SWS0, FLASH_COMMAND);
8079 OUT4500(ai, SWS1, FLASH_COMMAND);
8080 if (probe) {
8081 OUT4500(ai, SWS0, FLASH_COMMAND);
8082 OUT4500(ai, COMMAND,0x10);
8083 } else {
8084 OUT4500(ai, SWS2, FLASH_COMMAND);
8085 OUT4500(ai, SWS3, FLASH_COMMAND);
8086 OUT4500(ai, COMMAND,0);
8087 }
8088 msleep(500); /* 500ms delay */
8089
8090 if(!waitbusy(ai)) {
8091 clear_bit (FLAG_FLASHING, &ai->flags);
8092 airo_print_info(ai->dev->name, "Waitbusy hang after setflash mode");
8093 return -EIO;
8094 }
8095 return 0;
8096 }
8097
8098 /* Put character to SWS0 wait for dwelltime
8099 * x 50us for echo .
8100 */
8101
8102 static int flashpchar(struct airo_info *ai,int byte,int dwelltime) {
8103 int echo;
8104 int waittime;
8105
8106 byte |= 0x8000;
8107
8108 if(dwelltime == 0 )
8109 dwelltime = 200;
8110
8111 waittime=dwelltime;
8112
8113 /* Wait for busy bit d15 to go false indicating buffer empty */
8114 while ((IN4500 (ai, SWS0) & 0x8000) && waittime > 0) {
8115 udelay (50);
8116 waittime -= 50;
8117 }
8118
8119 /* timeout for busy clear wait */
8120 if(waittime <= 0 ){
8121 airo_print_info(ai->dev->name, "flash putchar busywait timeout!");
8122 return -EBUSY;
8123 }
8124
8125 /* Port is clear now write byte and wait for it to echo back */
8126 do {
8127 OUT4500(ai,SWS0,byte);
8128 udelay(50);
8129 dwelltime -= 50;
8130 echo = IN4500(ai,SWS1);
8131 } while (dwelltime >= 0 && echo != byte);
8132
8133 OUT4500(ai,SWS1,0);
8134
8135 return (echo == byte) ? 0 : -EIO;
8136 }
8137
8138 /*
8139 * Get a character from the card matching matchbyte
8140 * Step 3)
8141 */
8142 static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime){
8143 int rchar;
8144 unsigned char rbyte=0;
8145
8146 do {
8147 rchar = IN4500(ai,SWS1);
8148
8149 if(dwelltime && !(0x8000 & rchar)){
8150 dwelltime -= 10;
8151 mdelay(10);
8152 continue;
8153 }
8154 rbyte = 0xff & rchar;
8155
8156 if( (rbyte == matchbyte) && (0x8000 & rchar) ){
8157 OUT4500(ai,SWS1,0);
8158 return 0;
8159 }
8160 if( rbyte == 0x81 || rbyte == 0x82 || rbyte == 0x83 || rbyte == 0x1a || 0xffff == rchar)
8161 break;
8162 OUT4500(ai,SWS1,0);
8163
8164 }while(dwelltime > 0);
8165 return -EIO;
8166 }
8167
8168 /*
8169 * Transfer 32k of firmware data from user buffer to our buffer and
8170 * send to the card
8171 */
8172
8173 static int flashputbuf(struct airo_info *ai){
8174 int nwords;
8175
8176 /* Write stuff */
8177 if (test_bit(FLAG_MPI,&ai->flags))
8178 memcpy_toio(ai->pciaux + 0x8000, ai->flash, FLASHSIZE);
8179 else {
8180 OUT4500(ai,AUXPAGE,0x100);
8181 OUT4500(ai,AUXOFF,0);
8182
8183 for(nwords=0;nwords != FLASHSIZE / 2;nwords++){
8184 OUT4500(ai,AUXDATA,ai->flash[nwords] & 0xffff);
8185 }
8186 }
8187 OUT4500(ai,SWS0,0x8000);
8188
8189 return 0;
8190 }
8191
8192 /*
8193 *
8194 */
8195 static int flashrestart(struct airo_info *ai,struct net_device *dev){
8196 int i,status;
8197
8198 ssleep(1); /* Added 12/7/00 */
8199 clear_bit (FLAG_FLASHING, &ai->flags);
8200 if (test_bit(FLAG_MPI, &ai->flags)) {
8201 status = mpi_init_descriptors(ai);
8202 if (status != SUCCESS)
8203 return status;
8204 }
8205 status = setup_card(ai, dev->dev_addr, 1);
8206
8207 if (!test_bit(FLAG_MPI,&ai->flags))
8208 for( i = 0; i < MAX_FIDS; i++ ) {
8209 ai->fids[i] = transmit_allocate
8210 ( ai, AIRO_DEF_MTU, i >= MAX_FIDS / 2 );
8211 }
8212
8213 ssleep(1); /* Added 12/7/00 */
8214 return status;
8215 }
8216 #endif /* CISCO_EXT */
8217
8218 /*
8219 This program is free software; you can redistribute it and/or
8220 modify it under the terms of the GNU General Public License
8221 as published by the Free Software Foundation; either version 2
8222 of the License, or (at your option) any later version.
8223
8224 This program is distributed in the hope that it will be useful,
8225 but WITHOUT ANY WARRANTY; without even the implied warranty of
8226 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
8227 GNU General Public License for more details.
8228
8229 In addition:
8230
8231 Redistribution and use in source and binary forms, with or without
8232 modification, are permitted provided that the following conditions
8233 are met:
8234
8235 1. Redistributions of source code must retain the above copyright
8236 notice, this list of conditions and the following disclaimer.
8237 2. Redistributions in binary form must reproduce the above copyright
8238 notice, this list of conditions and the following disclaimer in the
8239 documentation and/or other materials provided with the distribution.
8240 3. The name of the author may not be used to endorse or promote
8241 products derived from this software without specific prior written
8242 permission.
8243
8244 THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
8245 IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
8246 WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
8247 ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
8248 INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
8249 (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
8250 SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
8251 HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
8252 STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
8253 IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
8254 POSSIBILITY OF SUCH DAMAGE.
8255 */
8256
8257 module_init(airo_init_module);
8258 module_exit(airo_cleanup_module);
ubuntu-bionic-kernel mirror