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