1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/err.h>
23#include <linux/init.h>
24
25#include <linux/kernel.h>
26#include <linux/module.h>
27#include <linux/proc_fs.h>
28
29#include <linux/sched.h>
30#include <linux/ptrace.h>
31#include <linux/slab.h>
32#include <linux/string.h>
33#include <linux/timer.h>
34#include <linux/interrupt.h>
35#include <linux/in.h>
36#include <linux/bitops.h>
37#include <linux/scatterlist.h>
38#include <linux/crypto.h>
39#include <asm/io.h>
40#include <asm/system.h>
41#include <asm/unaligned.h>
42
43#include <linux/netdevice.h>
44#include <linux/etherdevice.h>
45#include <linux/skbuff.h>
46#include <linux/if_arp.h>
47#include <linux/ioport.h>
48#include <linux/pci.h>
49#include <asm/uaccess.h>
50#include <linux/kthread.h>
51#include <linux/freezer.h>
52
53#include <linux/ieee80211.h>
54
55#include "airo.h"
56
57#define DRV_NAME "airo"
58
59#ifdef CONFIG_PCI
60static 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};
70MODULE_DEVICE_TABLE(pci, card_ids);
71
72static int airo_pci_probe(struct pci_dev *, const struct pci_device_id *);
73static void airo_pci_remove(struct pci_dev *);
74static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state);
75static int airo_pci_resume(struct pci_dev *pdev);
76
77static struct pci_driver airo_driver = {
78 .name = DRV_NAME,
79 .id_table = card_ids,
80 .probe = airo_pci_probe,
81 .remove = __devexit_p(airo_pci_remove),
82 .suspend = airo_pci_suspend,
83 .resume = airo_pci_resume,
84};
85#endif
86
87
88#include <linux/wireless.h>
89#define WIRELESS_SPY
90#include <net/iw_handler.h>
91
92#define CISCO_EXT
93#ifdef CISCO_EXT
94#include <linux/delay.h>
95#endif
96
97
98#define POWER_ON_DOWN
99
100
101
102
103
104
105
106#define IGNLABEL(comment) NULL
107static char *statsLabels[] = {
108 "RxOverrun",
109 IGNLABEL("RxPlcpCrcErr"),
110 IGNLABEL("RxPlcpFormatErr"),
111 IGNLABEL("RxPlcpLengthErr"),
112 "RxMacCrcErr",
113 "RxMacCrcOk",
114 "RxWepErr",
115 "RxWepOk",
116 "RetryLong",
117 "RetryShort",
118 "MaxRetries",
119 "NoAck",
120 "NoCts",
121 "RxAck",
122 "RxCts",
123 "TxAck",
124 "TxRts",
125 "TxCts",
126 "TxMc",
127 "TxBc",
128 "TxUcFrags",
129 "TxUcPackets",
130 "TxBeacon",
131 "RxBeacon",
132 "TxSinColl",
133 "TxMulColl",
134 "DefersNo",
135 "DefersProt",
136 "DefersEngy",
137 "DupFram",
138 "RxFragDisc",
139 "TxAged",
140 "RxAged",
141 "LostSync-MaxRetry",
142 "LostSync-MissedBeacons",
143 "LostSync-ArlExceeded",
144 "LostSync-Deauth",
145 "LostSync-Disassoced",
146 "LostSync-TsfTiming",
147 "HostTxMc",
148 "HostTxBc",
149 "HostTxUc",
150 "HostTxFail",
151 "HostRxMc",
152 "HostRxBc",
153 "HostRxUc",
154 "HostRxDiscard",
155 IGNLABEL("HmacTxMc"),
156 IGNLABEL("HmacTxBc"),
157 IGNLABEL("HmacTxUc"),
158 IGNLABEL("HmacTxFail"),
159 IGNLABEL("HmacRxMc"),
160 IGNLABEL("HmacRxBc"),
161 IGNLABEL("HmacRxUc"),
162 IGNLABEL("HmacRxDiscard"),
163 IGNLABEL("HmacRxAccepted"),
164 "SsidMismatch",
165 "ApMismatch",
166 "RatesMismatch",
167 "AuthReject",
168 "AuthTimeout",
169 "AssocReject",
170 "AssocTimeout",
171 IGNLABEL("ReasonOutsideTable"),
172 IGNLABEL("ReasonStatus1"),
173 IGNLABEL("ReasonStatus2"),
174 IGNLABEL("ReasonStatus3"),
175 IGNLABEL("ReasonStatus4"),
176 IGNLABEL("ReasonStatus5"),
177 IGNLABEL("ReasonStatus6"),
178 IGNLABEL("ReasonStatus7"),
179 IGNLABEL("ReasonStatus8"),
180 IGNLABEL("ReasonStatus9"),
181 IGNLABEL("ReasonStatus10"),
182 IGNLABEL("ReasonStatus11"),
183 IGNLABEL("ReasonStatus12"),
184 IGNLABEL("ReasonStatus13"),
185 IGNLABEL("ReasonStatus14"),
186 IGNLABEL("ReasonStatus15"),
187 IGNLABEL("ReasonStatus16"),
188 IGNLABEL("ReasonStatus17"),
189 IGNLABEL("ReasonStatus18"),
190 IGNLABEL("ReasonStatus19"),
191 "RxMan",
192 "TxMan",
193 "RxRefresh",
194 "TxRefresh",
195 "RxPoll",
196 "TxPoll",
197 "HostRetries",
198 "LostSync-HostReq",
199 "HostTxBytes",
200 "HostRxBytes",
201 "ElapsedUsec",
202 "ElapsedSec",
203 "LostSyncBetterAP",
204 "PrivacyMismatch",
205 "Jammed",
206 "DiscRxNotWepped",
207 "PhyEleMismatch",
208 (char*)-1 };
209#ifndef RUN_AT
210#define RUN_AT(x) (jiffies+(x))
211#endif
212
213
214
215
216
217
218static int rates[8];
219static int basic_rate;
220static char *ssids[3];
221
222static int io[4];
223static int irq[4];
224
225static
226int maxencrypt ;
227
228
229static int auto_wep ;
230static int aux_bap ;
231
232static int adhoc;
233
234static int probe = 1;
235
236static int proc_uid ;
237
238static int proc_gid ;
239
240static int airo_perm = 0555;
241
242static int proc_perm = 0644;
243
244MODULE_AUTHOR("Benjamin Reed");
245MODULE_DESCRIPTION("Support for Cisco/Aironet 802.11 wireless ethernet \
246cards. Direct support for ISA/PCI/MPI cards and support \
247for PCMCIA when used with airo_cs.");
248MODULE_LICENSE("Dual BSD/GPL");
249MODULE_SUPPORTED_DEVICE("Aironet 4500, 4800 and Cisco 340/350");
250module_param_array(io, int, NULL, 0);
251module_param_array(irq, int, NULL, 0);
252module_param(basic_rate, int, 0);
253module_param_array(rates, int, NULL, 0);
254module_param_array(ssids, charp, NULL, 0);
255module_param(auto_wep, int, 0);
256MODULE_PARM_DESC(auto_wep, "If non-zero, the driver will keep looping through \
257the authentication options until an association is made. The value of \
258auto_wep is number of the wep keys to check. A value of 2 will try using \
259the key at index 0 and index 1.");
260module_param(aux_bap, int, 0);
261MODULE_PARM_DESC(aux_bap, "If non-zero, the driver will switch into a mode \
262than seems to work better for older cards with some older buses. Before \
263switching it checks that the switch is needed.");
264module_param(maxencrypt, int, 0);
265MODULE_PARM_DESC(maxencrypt, "The maximum speed that the card can do \
266encryption. Units are in 512kbs. Zero (default) means there is no limit. \
267Older cards used to be limited to 2mbs (4).");
268module_param(adhoc, int, 0);
269MODULE_PARM_DESC(adhoc, "If non-zero, the card will start in adhoc mode.");
270module_param(probe, int, 0);
271MODULE_PARM_DESC(probe, "If zero, the driver won't start the card.");
272
273module_param(proc_uid, int, 0);
274MODULE_PARM_DESC(proc_uid, "The uid that the /proc files will belong to.");
275module_param(proc_gid, int, 0);
276MODULE_PARM_DESC(proc_gid, "The gid that the /proc files will belong to.");
277module_param(airo_perm, int, 0);
278MODULE_PARM_DESC(airo_perm, "The permission bits of /proc/[driver/]aironet.");
279module_param(proc_perm, int, 0);
280MODULE_PARM_DESC(proc_perm, "The permission bits of the files in /proc");
281
282
283
284
285static int do8bitIO ;
286
287
288#define SUCCESS 0
289#define ERROR -1
290#define NO_PACKET -2
291
292
293#define NOP2 0x0000
294#define MAC_ENABLE 0x0001
295#define MAC_DISABLE 0x0002
296#define CMD_LOSE_SYNC 0x0003
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
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
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
394#define AUX_OFFSET 0x800
395
396#define PKTSIZE 1840
397#define RIDSIZE 2048
398
399#define MAXTXQ 64
400
401
402#define BAP0 0
403#define BAP1 2
404
405
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
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
436#define RID_RW 0x20
437
438
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
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
479typedef struct {
480 u16 cmd;
481 u16 parm0;
482 u16 parm1;
483 u16 parm2;
484} Cmd;
485
486typedef struct {
487 u16 status;
488 u16 rsp0;
489 u16 rsp1;
490 u16 rsp2;
491} Resp;
492
493
494
495
496
497
498
499
500
501typedef struct WepKeyRid WepKeyRid;
502struct WepKeyRid {
503 __le16 len;
504 __le16 kindex;
505 u8 mac[ETH_ALEN];
506 __le16 klen;
507 u8 key[16];
508} __attribute__ ((packed));
509
510
511typedef struct Ssid Ssid;
512struct Ssid {
513 __le16 len;
514 u8 ssid[32];
515} __attribute__ ((packed));
516
517typedef struct SsidRid SsidRid;
518struct SsidRid {
519 __le16 len;
520 Ssid ssids[3];
521} __attribute__ ((packed));
522
523typedef struct ModulationRid ModulationRid;
524struct ModulationRid {
525 __le16 len;
526 __le16 modulation;
527#define MOD_DEFAULT cpu_to_le16(0)
528#define MOD_CCK cpu_to_le16(1)
529#define MOD_MOK cpu_to_le16(2)
530} __attribute__ ((packed));
531
532typedef struct ConfigRid ConfigRid;
533struct ConfigRid {
534 __le16 len;
535 __le16 opmode;
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)
542#define MODE_LLC_HOST cpu_to_le16(1<<8)
543#define MODE_AIRONET_EXTEND cpu_to_le16(1<<9)
544#define MODE_AP_INTERFACE cpu_to_le16(1<<10)
545#define MODE_ANTENNA_ALIGN cpu_to_le16(1<<11)
546#define MODE_ETHER_LLC cpu_to_le16(1<<12)
547#define MODE_LEAF_NODE cpu_to_le16(1<<13)
548#define MODE_CF_POLLABLE cpu_to_le16(1<<14)
549#define MODE_MIC cpu_to_le16(1<<15)
550 __le16 rmode;
551#define RXMODE_BC_MC_ADDR cpu_to_le16(0)
552#define RXMODE_BC_ADDR cpu_to_le16(1)
553#define RXMODE_ADDR cpu_to_le16(2)
554#define RXMODE_RFMON cpu_to_le16(3)
555#define RXMODE_RFMON_ANYBSS cpu_to_le16(4)
556#define RXMODE_LANMON cpu_to_le16(5)
557#define RXMODE_MASK cpu_to_le16(255)
558#define RXMODE_DISABLE_802_3_HEADER cpu_to_le16(1<<8)
559#define RXMODE_FULL_MASK (RXMODE_MASK | RXMODE_DISABLE_802_3_HEADER)
560#define RXMODE_NORMALIZED_RSSI cpu_to_le16(1<<9)
561 __le16 fragThresh;
562 __le16 rtsThres;
563 u8 macAddr[ETH_ALEN];
564 u8 rates[8];
565 __le16 shortRetryLimit;
566 __le16 longRetryLimit;
567 __le16 txLifetime;
568 __le16 rxLifetime;
569 __le16 stationary;
570 __le16 ordering;
571 __le16 u16deviceType;
572 __le16 cfpRate;
573 __le16 cfpDuration;
574 __le16 _reserved1[3];
575
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;
581 __le16 probeEnergyTimeout;
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
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
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
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
639 u8 nodeName[16];
640 __le16 arlThreshold;
641 __le16 arlDecay;
642 __le16 arlDelay;
643 __le16 _reserved4[1];
644
645 u8 magicAction;
646#define MAGIC_ACTION_STSCHG 1
647#define MAGIC_ACTION_RESUME 2
648#define MAGIC_IGNORE_MCAST (1<<8)
649#define MAGIC_IGNORE_BCAST (1<<9)
650#define MAGIC_SWITCH_TO_PSP (0<<10)
651#define MAGIC_STAY_IN_CAM (1<<10)
652 u8 magicControl;
653 __le16 autoWake;
654} __attribute__ ((packed));
655
656typedef struct StatusRid StatusRid;
657struct 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;
684 u8 noisedBm;
685 u8 noiseAvePercent;
686 u8 noiseAvedBm;
687 u8 noiseMaxPercent;
688 u8 noiseMaxdBm;
689 __le16 load;
690 u8 carrier[4];
691 __le16 assocStatus;
692#define STAT_NOPACKETS 0
693#define STAT_NOCARRIERSET 10
694#define STAT_GOTCARRIERSET 11
695#define STAT_WRONGSSID 20
696#define STAT_BADCHANNEL 25
697#define STAT_BADBITRATES 30
698#define STAT_BADPRIVACY 35
699#define STAT_APFOUND 40
700#define STAT_APREJECTED 50
701#define STAT_AUTHENTICATING 60
702#define STAT_DEAUTHENTICATED 61
703#define STAT_AUTHTIMEOUT 62
704#define STAT_ASSOCIATING 70
705#define STAT_DEASSOCIATED 71
706#define STAT_ASSOCTIMEOUT 72
707#define STAT_NOTAIROAP 73
708#define STAT_ASSOCIATED 80
709#define STAT_LEAPING 90
710#define STAT_LEAPFAILED 91
711#define STAT_LEAPTIMEDOUT 92
712#define STAT_LEAPCOMPLETE 93
713} __attribute__ ((packed));
714
715typedef struct StatsRid StatsRid;
716struct StatsRid {
717 __le16 len;
718 __le16 spacer;
719 __le32 vals[100];
720} __attribute__ ((packed));
721
722typedef struct APListRid APListRid;
723struct APListRid {
724 __le16 len;
725 u8 ap[4][ETH_ALEN];
726} __attribute__ ((packed));
727
728typedef struct CapabilityRid CapabilityRid;
729struct CapabilityRid {
730 __le16 len;
731 char oui[3];
732 char zero;
733 __le16 prodNum;
734 char manName[32];
735 char prodName[16];
736 char prodVer[8];
737 char factoryAddr[ETH_ALEN];
738 char aironetAddr[ETH_ALEN];
739 __le16 radioType;
740 __le16 country;
741 char callid[ETH_ALEN];
742 char supportedRates[8];
743 char rxDiversity;
744 char txDiversity;
745 __le16 txPowerLevels[8];
746 __le16 hardVer;
747 __le16 hardCap;
748 __le16 tempRange;
749 __le16 softVer;
750 __le16 softSubVer;
751 __le16 interfaceVer;
752 __le16 softCap;
753 __le16 bootBlockVer;
754 __le16 requiredHard;
755 __le16 extSoftCap;
756} __attribute__ ((packed));
757
758
759typedef struct BSSListRidExtra BSSListRidExtra;
760struct BSSListRidExtra {
761 __le16 unknown[4];
762 u8 fixed[12];
763 u8 iep[624];
764} __attribute__ ((packed));
765
766typedef struct BSSListRid BSSListRid;
767struct BSSListRid {
768 __le16 len;
769 __le16 index;
770#define RADIO_FH 1
771#define RADIO_DS 2
772#define RADIO_TMA 4
773 __le16 radioType;
774 u8 bssid[ETH_ALEN];
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];
786 struct {
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
797 BSSListRidExtra extra;
798} __attribute__ ((packed));
799
800typedef struct {
801 BSSListRid bss;
802 struct list_head list;
803} BSSListElement;
804
805typedef struct tdsRssiEntry tdsRssiEntry;
806struct tdsRssiEntry {
807 u8 rssipct;
808 u8 rssidBm;
809} __attribute__ ((packed));
810
811typedef struct tdsRssiRid tdsRssiRid;
812struct tdsRssiRid {
813 u16 len;
814 tdsRssiEntry x[256];
815} __attribute__ ((packed));
816
817typedef struct MICRid MICRid;
818struct MICRid {
819 __le16 len;
820 __le16 state;
821 __le16 multicastValid;
822 u8 multicast[16];
823 __le16 unicastValid;
824 u8 unicast[16];
825} __attribute__ ((packed));
826
827typedef struct MICBuffer MICBuffer;
828struct MICBuffer {
829 __be16 typelen;
830
831 union {
832 u8 snap[8];
833 struct {
834 u8 dsap;
835 u8 ssap;
836 u8 control;
837 u8 orgcode[3];
838 u8 fieldtype[2];
839 } llc;
840 } u;
841 __be32 mic;
842 __be32 seq;
843} __attribute__ ((packed));
844
845typedef struct {
846 u8 da[ETH_ALEN];
847 u8 sa[ETH_ALEN];
848} etherHead;
849
850#define TXCTL_TXOK (1<<1)
851#define TXCTL_TXEX (1<<2)
852#define TXCTL_802_3 (0<<3)
853#define TXCTL_802_11 (1<<3)
854#define TXCTL_ETHERNET (0<<4)
855#define TXCTL_LLC (1<<4)
856#define TXCTL_RELEASE (0<<5)
857#define TXCTL_NORELEASE (1<<5)
858
859#define BUSY_FID 0x10000
860
861#ifdef CISCO_EXT
862#define AIROMAGIC 0xa55a
863
864#ifdef SIOCIWFIRSTPRIV
865#ifdef SIOCDEVPRIVATE
866#define AIROOLDIOCTL SIOCDEVPRIVATE
867#define AIROOLDIDIFC AIROOLDIOCTL + 1
868#endif
869#else
870#define SIOCIWFIRSTPRIV SIOCDEVPRIVATE
871#endif
872
873
874
875
876#define AIROIOCTL SIOCIWFIRSTPRIV
877#define AIROIDIFC AIROIOCTL + 1
878
879
880
881#define AIROGCAP 0
882#define AIROGCFG 1
883#define AIROGSLIST 2
884#define AIROGVLIST 3
885#define AIROGDRVNAM 4
886#define AIROGEHTENC 5
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
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
908#define AIROPMACOFF AIROPMACON + 1
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
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
927typedef struct aironet_ioctl {
928 unsigned short command;
929 unsigned short len;
930 unsigned short ridnum;
931 unsigned char __user *data;
932} aironet_ioctl;
933
934static char swversion[] = "2.1";
935#endif
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
942typedef struct {
943 u32 size;
944 u8 enabled;
945 u32 rxSuccess;
946 u32 rxIncorrectMIC;
947 u32 rxNotMICed;
948 u32 rxMICPlummed;
949 u32 rxWrongSequence;
950 u32 reserve[32];
951} mic_statistics;
952
953typedef struct {
954 u32 coeff[((EMMH32_MSGLEN_MAX)+3)>>2];
955 u64 accum;
956 int position;
957 union {
958 u8 d8[4];
959 __be32 d32;
960 } part;
961} emmh32_context;
962
963typedef struct {
964 emmh32_context seed;
965 u32 rx;
966 u32 tx;
967 u32 window;
968 u8 valid;
969 u8 key[16];
970} miccntx;
971
972typedef struct {
973 miccntx mCtx;
974 miccntx uCtx;
975} mic_module;
976
977typedef 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
984typedef 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
992struct rx_hdr {
993 __le16 status, len;
994 u8 rssi[2];
995 u8 rate;
996 u8 freq;
997 __le16 tmp[4];
998} __attribute__ ((packed));
999
1000typedef 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
1010
1011typedef struct {
1012 unsigned char __iomem *card_ram_off;
1013
1014 RxFid rx_desc;
1015 char *virtual_host_addr;
1016
1017 int pending;
1018} HostRxDesc;
1019
1020
1021
1022
1023typedef struct {
1024 unsigned char __iomem *card_ram_off;
1025
1026 TxFid tx_desc;
1027 char *virtual_host_addr;
1028
1029 int pending;
1030} HostTxDesc;
1031
1032
1033
1034
1035typedef struct {
1036 unsigned char __iomem *card_ram_off;
1037
1038 Rid rid_desc;
1039 char *virtual_host_addr;
1040
1041} HostRidDesc;
1042
1043typedef 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)
1050#define HOST_INT_TXERR (1 << 2)
1051#define HOST_LCC_PAYLOAD (1 << 4)
1052#define HOST_DONT_RLSE (1 << 5)
1053#define HOST_DONT_RETRY (1 << 6)
1054#define HOST_CLR_AID (1 << 7)
1055#define HOST_RTS (1 << 9)
1056#define HOST_SHORT (1 << 10)
1057 u16 ctl;
1058 u16 aid;
1059 u16 retries;
1060 u16 fill;
1061} TxCtlHdr;
1062
1063typedef 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
1074typedef struct {
1075 TxCtlHdr ctlhdr;
1076 u16 fill1;
1077 u16 fill2;
1078 WifiHdr wifihdr;
1079 u16 gaplen;
1080 u16 status;
1081} WifiCtlHdr;
1082
1083static WifiCtlHdr wifictlhdr8023 = {
1084 .ctlhdr = {
1085 .ctl = HOST_DONT_RLSE,
1086 }
1087};
1088
1089
1090#define MAX_KEY_SIZE 13
1091#define MIN_KEY_SIZE 5
1092typedef struct wep_key_t {
1093 u16 len;
1094 u8 key[16];
1095} wep_key_t;
1096
1097
1098static const struct iw_handler_def airo_handler_def;
1099
1100static const char version[] = "airo.c 0.6 (Ben Reed & Javier Achirica)";
1101
1102struct airo_info;
1103
1104static int get_dec_u16( char *buffer, int *start, int limit );
1105static void OUT4500( struct airo_info *, u16 register, u16 value );
1106static unsigned short IN4500( struct airo_info *, u16 register );
1107static u16 setup_card(struct airo_info*, u8 *mac, int lock);
1108static int enable_MAC(struct airo_info *ai, int lock);
1109static void disable_MAC(struct airo_info *ai, int lock);
1110static void enable_interrupts(struct airo_info*);
1111static void disable_interrupts(struct airo_info*);
1112static u16 issuecommand(struct airo_info*, Cmd *pCmd, Resp *pRsp);
1113static int bap_setup(struct airo_info*, u16 rid, u16 offset, int whichbap);
1114static int aux_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
1115 int whichbap);
1116static int fast_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
1117 int whichbap);
1118static int bap_write(struct airo_info*, const __le16 *pu16Src, int bytelen,
1119 int whichbap);
1120static int PC4500_accessrid(struct airo_info*, u16 rid, u16 accmd);
1121static int PC4500_readrid(struct airo_info*, u16 rid, void *pBuf, int len, int lock);
1122static int PC4500_writerid(struct airo_info*, u16 rid, const void
1123 *pBuf, int len, int lock);
1124static int do_writerid( struct airo_info*, u16 rid, const void *rid_data,
1125 int len, int dummy );
1126static u16 transmit_allocate(struct airo_info*, int lenPayload, int raw);
1127static int transmit_802_3_packet(struct airo_info*, int len, char *pPacket);
1128static int transmit_802_11_packet(struct airo_info*, int len, char *pPacket);
1129
1130static int mpi_send_packet (struct net_device *dev);
1131static void mpi_unmap_card(struct pci_dev *pci);
1132static void mpi_receive_802_3(struct airo_info *ai);
1133static void mpi_receive_802_11(struct airo_info *ai);
1134static int waitbusy (struct airo_info *ai);
1135
1136static irqreturn_t airo_interrupt( int irq, void* dev_id);
1137static int airo_thread(void *data);
1138static void timer_func( struct net_device *dev );
1139static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
1140static struct iw_statistics *airo_get_wireless_stats (struct net_device *dev);
1141static void airo_read_wireless_stats (struct airo_info *local);
1142#ifdef CISCO_EXT
1143static int readrids(struct net_device *dev, aironet_ioctl *comp);
1144static int writerids(struct net_device *dev, aironet_ioctl *comp);
1145static int flashcard(struct net_device *dev, aironet_ioctl *comp);
1146#endif
1147static void micinit(struct airo_info *ai);
1148static int micsetup(struct airo_info *ai);
1149static int encapsulate(struct airo_info *ai, etherHead *pPacket, MICBuffer *buffer, int len);
1150static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *pPacket, u16 payLen);
1151
1152static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi);
1153static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm);
1154
1155static void airo_networks_free(struct airo_info *ai);
1156
1157struct airo_info {
1158 struct net_device *dev;
1159 struct list_head dev_list;
1160
1161
1162#define MAX_FIDS 6
1163#define MPI_MAX_FIDS 1
1164 u32 fids[MAX_FIDS];
1165 ConfigRid config;
1166 char keyindex;
1167 char defindex;
1168 struct proc_dir_entry *proc_entry;
1169 spinlock_t aux_lock;
1170#define FLAG_RADIO_OFF 0
1171#define FLAG_RADIO_DOWN 1
1172#define FLAG_RADIO_MASK 0x03
1173#define FLAG_ENABLED 2
1174#define FLAG_ADHOC 3
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
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;
1215 unsigned long scan_timeout;
1216 struct iw_spy_data spy_data;
1217 struct iw_public_data wireless_data;
1218
1219 struct crypto_cipher *tfm;
1220 mic_module mod[2];
1221 mic_statistics micstats;
1222 HostRxDesc rxfids[MPI_MAX_FIDS];
1223 HostTxDesc txfids[MPI_MAX_FIDS];
1224 HostRidDesc config_desc;
1225 unsigned long ridbus;
1226 struct sk_buff_head txq;
1227 struct pci_dev *pci;
1228 unsigned char __iomem *pcimem;
1229 unsigned char __iomem *pciaux;
1230 unsigned char *shared;
1231 dma_addr_t shared_dma;
1232 pm_message_t power;
1233 SsidRid *SSID;
1234 APListRid *APList;
1235#define PCI_SHARED_LEN 2*MPI_MAX_FIDS*PKTSIZE+RIDSIZE
1236 char proc_name[IFNAMSIZ];
1237
1238 int wep_capable;
1239 int max_wep_idx;
1240
1241
1242 unsigned int bssListFirst;
1243 unsigned int bssListNext;
1244 unsigned int bssListRidLen;
1245
1246 struct list_head network_list;
1247 struct list_head network_free_list;
1248 BSSListElement *networks;
1249};
1250
1251static inline int bap_read(struct airo_info *ai, __le16 *pu16Dst, int bytelen,
1252 int whichbap)
1253{
1254 return ai->bap_read(ai, pu16Dst, bytelen, whichbap);
1255}
1256
1257static int setup_proc_entry( struct net_device *dev,
1258 struct airo_info *apriv );
1259static int takedown_proc_entry( struct net_device *dev,
1260 struct airo_info *apriv );
1261
1262static int cmdreset(struct airo_info *ai);
1263static int setflashmode (struct airo_info *ai);
1264static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime);
1265static int flashputbuf(struct airo_info *ai);
1266static int flashrestart(struct airo_info *ai,struct net_device *dev);
1267
1268#define airo_print(type, name, fmt, args...) \
1269 printk(type DRV_NAME "(%s): " fmt "\n", name, ##args)
1270
1271#define airo_print_info(name, fmt, args...) \
1272 airo_print(KERN_INFO, name, fmt, ##args)
1273
1274#define airo_print_dbg(name, fmt, args...) \
1275 airo_print(KERN_DEBUG, name, fmt, ##args)
1276
1277#define airo_print_warn(name, fmt, args...) \
1278 airo_print(KERN_WARNING, name, fmt, ##args)
1279
1280#define airo_print_err(name, fmt, args...) \
1281 airo_print(KERN_ERR, name, fmt, ##args)
1282
1283#define AIRO_FLASH(dev) (((struct airo_info *)dev->ml_priv)->flash)
1284
1285
1286
1287
1288
1289
1290static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq);
1291static void MoveWindow(miccntx *context, u32 micSeq);
1292static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1293 struct crypto_cipher *tfm);
1294static void emmh32_init(emmh32_context *context);
1295static void emmh32_update(emmh32_context *context, u8 *pOctets, int len);
1296static void emmh32_final(emmh32_context *context, u8 digest[4]);
1297static int flashpchar(struct airo_info *ai,int byte,int dwelltime);
1298
1299static void age_mic_context(miccntx *cur, miccntx *old, u8 *key, int key_len,
1300 struct crypto_cipher *tfm)
1301{
1302
1303
1304
1305 if (cur->valid && (memcmp(cur->key, key, key_len) == 0))
1306 return;
1307
1308
1309 memcpy(old, cur, sizeof(*cur));
1310
1311
1312 memcpy(cur->key, key, key_len);
1313 cur->window = 33;
1314 cur->rx = 0;
1315 cur->tx = 0;
1316 cur->valid = 1;
1317
1318
1319 emmh32_setseed(&cur->seed, key, key_len, tfm);
1320}
1321
1322
1323
1324static void micinit(struct airo_info *ai)
1325{
1326 MICRid mic_rid;
1327
1328 clear_bit(JOB_MIC, &ai->jobs);
1329 PC4500_readrid(ai, RID_MIC, &mic_rid, sizeof(mic_rid), 0);
1330 up(&ai->sem);
1331
1332 ai->micstats.enabled = (le16_to_cpu(mic_rid.state) & 0x00FF) ? 1 : 0;
1333 if (!ai->micstats.enabled) {
1334
1335
1336
1337 ai->mod[0].uCtx.valid = 0;
1338 ai->mod[0].mCtx.valid = 0;
1339 return;
1340 }
1341
1342 if (mic_rid.multicastValid) {
1343 age_mic_context(&ai->mod[0].mCtx, &ai->mod[1].mCtx,
1344 mic_rid.multicast, sizeof(mic_rid.multicast),
1345 ai->tfm);
1346 }
1347
1348 if (mic_rid.unicastValid) {
1349 age_mic_context(&ai->mod[0].uCtx, &ai->mod[1].uCtx,
1350 mic_rid.unicast, sizeof(mic_rid.unicast),
1351 ai->tfm);
1352 }
1353}
1354
1355
1356
1357static int micsetup(struct airo_info *ai) {
1358 int i;
1359
1360 if (ai->tfm == NULL)
1361 ai->tfm = crypto_alloc_cipher("aes", 0, CRYPTO_ALG_ASYNC);
1362
1363 if (IS_ERR(ai->tfm)) {
1364 airo_print_err(ai->dev->name, "failed to load transform for AES");
1365 ai->tfm = NULL;
1366 return ERROR;
1367 }
1368
1369 for (i=0; i < NUM_MODULES; i++) {
1370 memset(&ai->mod[i].mCtx,0,sizeof(miccntx));
1371 memset(&ai->mod[i].uCtx,0,sizeof(miccntx));
1372 }
1373 return SUCCESS;
1374}
1375
1376static char micsnap[] = {0xAA,0xAA,0x03,0x00,0x40,0x96,0x00,0x02};
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
1391
1392
1393
1394static int encapsulate(struct airo_info *ai ,etherHead *frame, MICBuffer *mic, int payLen)
1395{
1396 miccntx *context;
1397
1398
1399
1400
1401 if (test_bit(FLAG_ADHOC, &ai->flags) && (frame->da[0] & 0x1))
1402 context = &ai->mod[0].mCtx;
1403 else
1404 context = &ai->mod[0].uCtx;
1405
1406 if (!context->valid)
1407 return ERROR;
1408
1409 mic->typelen = htons(payLen + 16);
1410
1411 memcpy(&mic->u.snap, micsnap, sizeof(micsnap));
1412
1413
1414 mic->seq = htonl(context->tx);
1415 context->tx += 2;
1416
1417 emmh32_init(&context->seed);
1418 emmh32_update(&context->seed,frame->da,ETH_ALEN * 2);
1419 emmh32_update(&context->seed,(u8*)&mic->typelen,10);
1420 emmh32_update(&context->seed,(u8*)&mic->seq,sizeof(mic->seq));
1421 emmh32_update(&context->seed,frame->da + ETH_ALEN * 2,payLen);
1422 emmh32_final(&context->seed, (u8*)&mic->mic);
1423
1424
1425 mic->typelen = 0;
1426 return SUCCESS;
1427}
1428
1429typedef enum {
1430 NONE,
1431 NOMIC,
1432 NOMICPLUMMED,
1433 SEQUENCE,
1434 INCORRECTMIC,
1435} mic_error;
1436
1437
1438
1439
1440
1441
1442
1443
1444
1445
1446
1447
1448
1449
1450static int decapsulate(struct airo_info *ai, MICBuffer *mic, etherHead *eth, u16 payLen)
1451{
1452 int i;
1453 u32 micSEQ;
1454 miccntx *context;
1455 u8 digest[4];
1456 mic_error micError = NONE;
1457
1458
1459
1460 if (!ai->micstats.enabled) {
1461
1462 if (memcmp ((u8*)eth + 14, micsnap, sizeof(micsnap)) == 0) {
1463 ai->micstats.rxMICPlummed++;
1464 return ERROR;
1465 }
1466 return SUCCESS;
1467 }
1468
1469 if (ntohs(mic->typelen) == 0x888E)
1470 return SUCCESS;
1471
1472 if (memcmp (mic->u.snap, micsnap, sizeof(micsnap)) != 0) {
1473
1474 ai->micstats.rxMICPlummed++;
1475 return ERROR;
1476 }
1477
1478 micSEQ = ntohl(mic->seq);
1479
1480
1481
1482
1483
1484 if ( (micSEQ & 1) == 0 ) {
1485 ai->micstats.rxWrongSequence++;
1486 return ERROR;
1487 }
1488
1489 for (i = 0; i < NUM_MODULES; i++) {
1490 int mcast = eth->da[0] & 1;
1491
1492 context = mcast ? &ai->mod[i].mCtx : &ai->mod[i].uCtx;
1493
1494
1495 if (!context->valid) {
1496 if (i == 0)
1497 micError = NOMICPLUMMED;
1498 continue;
1499 }
1500
1501
1502 if (!mic->typelen)
1503 mic->typelen = htons(payLen + sizeof(MICBuffer) - 2);
1504
1505 emmh32_init(&context->seed);
1506 emmh32_update(&context->seed, eth->da, ETH_ALEN*2);
1507 emmh32_update(&context->seed, (u8 *)&mic->typelen, sizeof(mic->typelen)+sizeof(mic->u.snap));
1508 emmh32_update(&context->seed, (u8 *)&mic->seq,sizeof(mic->seq));
1509 emmh32_update(&context->seed, eth->da + ETH_ALEN*2,payLen);
1510
1511 emmh32_final(&context->seed, digest);
1512
1513 if (memcmp(digest, &mic->mic, 4)) {
1514
1515 if (i == 0)
1516 micError = INCORRECTMIC;
1517 continue;
1518 }
1519
1520
1521 if (RxSeqValid(ai, context, mcast, micSEQ) == SUCCESS) {
1522 ai->micstats.rxSuccess++;
1523 return SUCCESS;
1524 }
1525 if (i == 0)
1526 micError = SEQUENCE;
1527 }
1528
1529
1530 switch (micError) {
1531 case NOMICPLUMMED: ai->micstats.rxMICPlummed++; break;
1532 case SEQUENCE: ai->micstats.rxWrongSequence++; break;
1533 case INCORRECTMIC: ai->micstats.rxIncorrectMIC++; break;
1534 case NONE: break;
1535 case NOMIC: break;
1536 }
1537 return ERROR;
1538}
1539
1540
1541
1542
1543
1544
1545
1546
1547
1548
1549
1550
1551
1552
1553
1554static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq)
1555{
1556 u32 seq,index;
1557
1558
1559
1560
1561 if (mcast) {
1562 if (test_bit(FLAG_UPDATE_MULTI, &ai->flags)) {
1563 clear_bit (FLAG_UPDATE_MULTI, &ai->flags);
1564 context->window = (micSeq > 33) ? micSeq : 33;
1565 context->rx = 0;
1566 }
1567 } else if (test_bit(FLAG_UPDATE_UNI, &ai->flags)) {
1568 clear_bit (FLAG_UPDATE_UNI, &ai->flags);
1569 context->window = (micSeq > 33) ? micSeq : 33;
1570 context->rx = 0;
1571 }
1572
1573
1574 seq = micSeq - (context->window - 33);
1575
1576
1577 if ((s32)seq < 0)
1578 return ERROR;
1579
1580 if ( seq > 64 ) {
1581
1582 MoveWindow(context,micSeq);
1583 return SUCCESS;
1584 }
1585
1586
1587 seq >>= 1;
1588 index = 1 << seq;
1589
1590 if (!(context->rx & index)) {
1591
1592
1593 context->rx |= index;
1594
1595 MoveWindow(context,micSeq);
1596
1597 return SUCCESS;
1598 }
1599 return ERROR;
1600}
1601
1602static void MoveWindow(miccntx *context, u32 micSeq)
1603{
1604 u32 shift;
1605
1606
1607 if (micSeq > context->window) {
1608 shift = (micSeq - context->window) >> 1;
1609
1610
1611 if (shift < 32)
1612 context->rx >>= shift;
1613 else
1614 context->rx = 0;
1615
1616 context->window = micSeq;
1617 }
1618}
1619
1620
1621
1622
1623
1624
1625#define MIC_ACCUM(val) \
1626 context->accum += (u64)(val) * context->coeff[coeff_position++];
1627
1628static unsigned char aes_counter[16];
1629
1630
1631static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1632 struct crypto_cipher *tfm)
1633{
1634
1635
1636
1637 int i,j;
1638 u32 counter;
1639 u8 *cipher, plain[16];
1640
1641 crypto_cipher_setkey(tfm, pkey, 16);
1642 counter = 0;
1643 for (i = 0; i < ARRAY_SIZE(context->coeff); ) {
1644 aes_counter[15] = (u8)(counter >> 0);
1645 aes_counter[14] = (u8)(counter >> 8);
1646 aes_counter[13] = (u8)(counter >> 16);
1647 aes_counter[12] = (u8)(counter >> 24);
1648 counter++;
1649 memcpy (plain, aes_counter, 16);
1650 crypto_cipher_encrypt_one(tfm, plain, plain);
1651 cipher = plain;
1652 for (j = 0; (j < 16) && (i < ARRAY_SIZE(context->coeff)); ) {
1653 context->coeff[i++] = ntohl(*(__be32 *)&cipher[j]);
1654 j += 4;
1655 }
1656 }
1657}
1658
1659
1660static void emmh32_init(emmh32_context *context)
1661{
1662
1663 context->accum = 0;
1664 context->position = 0;
1665}
1666
1667
1668static void emmh32_update(emmh32_context *context, u8 *pOctets, int len)
1669{
1670 int coeff_position, byte_position;
1671
1672 if (len == 0) return;
1673
1674 coeff_position = context->position >> 2;
1675
1676
1677 byte_position = context->position & 3;
1678 if (byte_position) {
1679
1680 do {
1681 if (len == 0) return;
1682 context->part.d8[byte_position++] = *pOctets++;
1683 context->position++;
1684 len--;
1685 } while (byte_position < 4);
1686 MIC_ACCUM(ntohl(context->part.d32));
1687 }
1688
1689
1690 while (len >= 4) {
1691 MIC_ACCUM(ntohl(*(__be32 *)pOctets));
1692 context->position += 4;
1693 pOctets += 4;
1694 len -= 4;
1695 }
1696
1697
1698 byte_position = 0;
1699 while (len > 0) {
1700 context->part.d8[byte_position++] = *pOctets++;
1701 context->position++;
1702 len--;
1703 }
1704}
1705
1706
1707static u32 mask32[4] = { 0x00000000L, 0xFF000000L, 0xFFFF0000L, 0xFFFFFF00L };
1708
1709
1710static void emmh32_final(emmh32_context *context, u8 digest[4])
1711{
1712 int coeff_position, byte_position;
1713 u32 val;
1714
1715 u64 sum, utmp;
1716 s64 stmp;
1717
1718 coeff_position = context->position >> 2;
1719
1720
1721 byte_position = context->position & 3;
1722 if (byte_position) {
1723
1724 val = ntohl(context->part.d32);
1725 MIC_ACCUM(val & mask32[byte_position]);
1726 }
1727
1728
1729 sum = context->accum;
1730 stmp = (sum & 0xffffffffLL) - ((sum >> 32) * 15);
1731 utmp = (stmp & 0xffffffffLL) - ((stmp >> 32) * 15);
1732 sum = utmp & 0xffffffffLL;
1733 if (utmp > 0x10000000fLL)
1734 sum -= 15;
1735
1736 val = (u32)sum;
1737 digest[0] = (val>>24) & 0xFF;
1738 digest[1] = (val>>16) & 0xFF;
1739 digest[2] = (val>>8) & 0xFF;
1740 digest[3] = val & 0xFF;
1741}
1742
1743static int readBSSListRid(struct airo_info *ai, int first,
1744 BSSListRid *list)
1745{
1746 Cmd cmd;
1747 Resp rsp;
1748
1749 if (first == 1) {
1750 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
1751 memset(&cmd, 0, sizeof(cmd));
1752 cmd.cmd=CMD_LISTBSS;
1753 if (down_interruptible(&ai->sem))
1754 return -ERESTARTSYS;
1755 ai->list_bss_task = current;
1756 issuecommand(ai, &cmd, &rsp);
1757 up(&ai->sem);
1758
1759 schedule_timeout_uninterruptible(3 * HZ);
1760 ai->list_bss_task = NULL;
1761 }
1762 return PC4500_readrid(ai, first ? ai->bssListFirst : ai->bssListNext,
1763 list, ai->bssListRidLen, 1);
1764}
1765
1766static int readWepKeyRid(struct airo_info *ai, WepKeyRid *wkr, int temp, int lock)
1767{
1768 return PC4500_readrid(ai, temp ? RID_WEP_TEMP : RID_WEP_PERM,
1769 wkr, sizeof(*wkr), lock);
1770}
1771
1772static int writeWepKeyRid(struct airo_info *ai, WepKeyRid *wkr, int perm, int lock)
1773{
1774 int rc;
1775 rc = PC4500_writerid(ai, RID_WEP_TEMP, wkr, sizeof(*wkr), lock);
1776 if (rc!=SUCCESS)
1777 airo_print_err(ai->dev->name, "WEP_TEMP set %x", rc);
1778 if (perm) {
1779 rc = PC4500_writerid(ai, RID_WEP_PERM, wkr, sizeof(*wkr), lock);
1780 if (rc!=SUCCESS)
1781 airo_print_err(ai->dev->name, "WEP_PERM set %x", rc);
1782 }
1783 return rc;
1784}
1785
1786static int readSsidRid(struct airo_info*ai, SsidRid *ssidr)
1787{
1788 return PC4500_readrid(ai, RID_SSID, ssidr, sizeof(*ssidr), 1);
1789}
1790
1791static int writeSsidRid(struct airo_info*ai, SsidRid *pssidr, int lock)
1792{
1793 return PC4500_writerid(ai, RID_SSID, pssidr, sizeof(*pssidr), lock);
1794}
1795
1796static int readConfigRid(struct airo_info *ai, int lock)
1797{
1798 int rc;
1799 ConfigRid cfg;
1800
1801 if (ai->config.len)
1802 return SUCCESS;
1803
1804 rc = PC4500_readrid(ai, RID_ACTUALCONFIG, &cfg, sizeof(cfg), lock);
1805 if (rc != SUCCESS)
1806 return rc;
1807
1808 ai->config = cfg;
1809 return SUCCESS;
1810}
1811
1812static inline void checkThrottle(struct airo_info *ai)
1813{
1814 int i;
1815
1816 if (ai->config.authType != AUTH_OPEN && maxencrypt) {
1817 for(i=0; i<8; i++) {
1818 if (ai->config.rates[i] > maxencrypt) {
1819 ai->config.rates[i] = 0;
1820 }
1821 }
1822 }
1823}
1824
1825static int writeConfigRid(struct airo_info *ai, int lock)
1826{
1827 ConfigRid cfgr;
1828
1829 if (!test_bit (FLAG_COMMIT, &ai->flags))
1830 return SUCCESS;
1831
1832 clear_bit (FLAG_COMMIT, &ai->flags);
1833 clear_bit (FLAG_RESET, &ai->flags);
1834 checkThrottle(ai);
1835 cfgr = ai->config;
1836
1837 if ((cfgr.opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
1838 set_bit(FLAG_ADHOC, &ai->flags);
1839 else
1840 clear_bit(FLAG_ADHOC, &ai->flags);
1841
1842 return PC4500_writerid( ai, RID_CONFIG, &cfgr, sizeof(cfgr), lock);
1843}
1844
1845static int readStatusRid(struct airo_info *ai, StatusRid *statr, int lock)
1846{
1847 return PC4500_readrid(ai, RID_STATUS, statr, sizeof(*statr), lock);
1848}
1849
1850static int readAPListRid(struct airo_info *ai, APListRid *aplr)
1851{
1852 return PC4500_readrid(ai, RID_APLIST, aplr, sizeof(*aplr), 1);
1853}
1854
1855static int writeAPListRid(struct airo_info *ai, APListRid *aplr, int lock)
1856{
1857 return PC4500_writerid(ai, RID_APLIST, aplr, sizeof(*aplr), lock);
1858}
1859
1860static int readCapabilityRid(struct airo_info *ai, CapabilityRid *capr, int lock)
1861{
1862 return PC4500_readrid(ai, RID_CAPABILITIES, capr, sizeof(*capr), lock);
1863}
1864
1865static int readStatsRid(struct airo_info*ai, StatsRid *sr, int rid, int lock)
1866{
1867 return PC4500_readrid(ai, rid, sr, sizeof(*sr), lock);
1868}
1869
1870static void try_auto_wep(struct airo_info *ai)
1871{
1872 if (auto_wep && !(ai->flags & FLAG_RADIO_DOWN)) {
1873 ai->expires = RUN_AT(3*HZ);
1874 wake_up_interruptible(&ai->thr_wait);
1875 }
1876}
1877
1878static int airo_open(struct net_device *dev) {
1879 struct airo_info *ai = dev->ml_priv;
1880 int rc = 0;
1881
1882 if (test_bit(FLAG_FLASHING, &ai->flags))
1883 return -EIO;
1884
1885
1886
1887
1888
1889 if (test_bit(FLAG_COMMIT, &ai->flags)) {
1890 disable_MAC(ai, 1);
1891 writeConfigRid(ai, 1);
1892 }
1893
1894 if (ai->wifidev != dev) {
1895 clear_bit(JOB_DIE, &ai->jobs);
1896 ai->airo_thread_task = kthread_run(airo_thread, dev, dev->name);
1897 if (IS_ERR(ai->airo_thread_task))
1898 return (int)PTR_ERR(ai->airo_thread_task);
1899
1900 rc = request_irq(dev->irq, airo_interrupt, IRQF_SHARED,
1901 dev->name, dev);
1902 if (rc) {
1903 airo_print_err(dev->name,
1904 "register interrupt %d failed, rc %d",
1905 dev->irq, rc);
1906 set_bit(JOB_DIE, &ai->jobs);
1907 kthread_stop(ai->airo_thread_task);
1908 return rc;
1909 }
1910
1911
1912 clear_bit(FLAG_RADIO_DOWN, &ai->flags);
1913 enable_interrupts(ai);
1914
1915 try_auto_wep(ai);
1916 }
1917 enable_MAC(ai, 1);
1918
1919 netif_start_queue(dev);
1920 return 0;
1921}
1922
1923static int mpi_start_xmit(struct sk_buff *skb, struct net_device *dev) {
1924 int npacks, pending;
1925 unsigned long flags;
1926 struct airo_info *ai = dev->ml_priv;
1927
1928 if (!skb) {
1929 airo_print_err(dev->name, "%s: skb == NULL!",__func__);
1930 return 0;
1931 }
1932 npacks = skb_queue_len (&ai->txq);
1933
1934 if (npacks >= MAXTXQ - 1) {
1935 netif_stop_queue (dev);
1936 if (npacks > MAXTXQ) {
1937 dev->stats.tx_fifo_errors++;
1938 return NETDEV_TX_BUSY;
1939 }
1940 skb_queue_tail (&ai->txq, skb);
1941 return 0;
1942 }
1943
1944 spin_lock_irqsave(&ai->aux_lock, flags);
1945 skb_queue_tail (&ai->txq, skb);
1946 pending = test_bit(FLAG_PENDING_XMIT, &ai->flags);
1947 spin_unlock_irqrestore(&ai->aux_lock,flags);
1948 netif_wake_queue (dev);
1949
1950 if (pending == 0) {
1951 set_bit(FLAG_PENDING_XMIT, &ai->flags);
1952 mpi_send_packet (dev);
1953 }
1954 return 0;
1955}
1956
1957
1958
1959
1960
1961
1962
1963
1964static int mpi_send_packet (struct net_device *dev)
1965{
1966 struct sk_buff *skb;
1967 unsigned char *buffer;
1968 s16 len;
1969 __le16 *payloadLen;
1970 struct airo_info *ai = dev->ml_priv;
1971 u8 *sendbuf;
1972
1973
1974
1975 if ((skb = skb_dequeue(&ai->txq)) == NULL) {
1976 airo_print_err(dev->name,
1977 "%s: Dequeue'd zero in send_packet()",
1978 __func__);
1979 return 0;
1980 }
1981
1982
1983 len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
1984 buffer = skb->data;
1985
1986 ai->txfids[0].tx_desc.offset = 0;
1987 ai->txfids[0].tx_desc.valid = 1;
1988 ai->txfids[0].tx_desc.eoc = 1;
1989 ai->txfids[0].tx_desc.len =len+sizeof(WifiHdr);
1990
1991
1992
1993
1994
1995
1996
1997
1998
1999 memcpy((char *)ai->txfids[0].virtual_host_addr,
2000 (char *)&wifictlhdr8023, sizeof(wifictlhdr8023));
2001
2002 payloadLen = (__le16 *)(ai->txfids[0].virtual_host_addr +
2003 sizeof(wifictlhdr8023));
2004 sendbuf = ai->txfids[0].virtual_host_addr +
2005 sizeof(wifictlhdr8023) + 2 ;
2006
2007
2008
2009
2010
2011 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
2012 (ntohs(((__be16 *)buffer)[6]) != 0x888E)) {
2013 MICBuffer pMic;
2014
2015 if (encapsulate(ai, (etherHead *)buffer, &pMic, len - sizeof(etherHead)) != SUCCESS)
2016 return ERROR;
2017
2018 *payloadLen = cpu_to_le16(len-sizeof(etherHead)+sizeof(pMic));
2019 ai->txfids[0].tx_desc.len += sizeof(pMic);
2020
2021 memcpy (sendbuf, buffer, sizeof(etherHead));
2022 buffer += sizeof(etherHead);
2023 sendbuf += sizeof(etherHead);
2024 memcpy (sendbuf, &pMic, sizeof(pMic));
2025 sendbuf += sizeof(pMic);
2026 memcpy (sendbuf, buffer, len - sizeof(etherHead));
2027 } else {
2028 *payloadLen = cpu_to_le16(len - sizeof(etherHead));
2029
2030 dev->trans_start = jiffies;
2031
2032
2033 memcpy(sendbuf, buffer, len);
2034 }
2035
2036 memcpy_toio(ai->txfids[0].card_ram_off,
2037 &ai->txfids[0].tx_desc, sizeof(TxFid));
2038
2039 OUT4500(ai, EVACK, 8);
2040
2041 dev_kfree_skb_any(skb);
2042 return 1;
2043}
2044
2045static void get_tx_error(struct airo_info *ai, s32 fid)
2046{
2047 __le16 status;
2048
2049 if (fid < 0)
2050 status = ((WifiCtlHdr *)ai->txfids[0].virtual_host_addr)->ctlhdr.status;
2051 else {
2052 if (bap_setup(ai, ai->fids[fid] & 0xffff, 4, BAP0) != SUCCESS)
2053 return;
2054 bap_read(ai, &status, 2, BAP0);
2055 }
2056 if (le16_to_cpu(status) & 2)
2057 ai->dev->stats.tx_aborted_errors++;
2058 if (le16_to_cpu(status) & 4)
2059 ai->dev->stats.tx_heartbeat_errors++;
2060 if (le16_to_cpu(status) & 8)
2061 { }
2062 if (le16_to_cpu(status) & 0x10)
2063 ai->dev->stats.tx_carrier_errors++;
2064 if (le16_to_cpu(status) & 0x20)
2065 { }
2066
2067
2068
2069
2070 if ((le16_to_cpu(status) & 2) ||
2071 (le16_to_cpu(status) & 4)) {
2072 union iwreq_data wrqu;
2073 char junk[0x18];
2074
2075
2076
2077
2078 bap_read(ai, (__le16 *) junk, 0x18, BAP0);
2079
2080
2081
2082
2083
2084
2085
2086
2087
2088 memcpy(wrqu.addr.sa_data, junk + 0x12, ETH_ALEN);
2089 wrqu.addr.sa_family = ARPHRD_ETHER;
2090
2091
2092 wireless_send_event(ai->dev, IWEVTXDROP, &wrqu, NULL);
2093 }
2094}
2095
2096static void airo_end_xmit(struct net_device *dev) {
2097 u16 status;
2098 int i;
2099 struct airo_info *priv = dev->ml_priv;
2100 struct sk_buff *skb = priv->xmit.skb;
2101 int fid = priv->xmit.fid;
2102 u32 *fids = priv->fids;
2103
2104 clear_bit(JOB_XMIT, &priv->jobs);
2105 clear_bit(FLAG_PENDING_XMIT, &priv->flags);
2106 status = transmit_802_3_packet (priv, fids[fid], skb->data);
2107 up(&priv->sem);
2108
2109 i = 0;
2110 if ( status == SUCCESS ) {
2111 dev->trans_start = jiffies;
2112 for (; i < MAX_FIDS / 2 && (priv->fids[i] & 0xffff0000); i++);
2113 } else {
2114 priv->fids[fid] &= 0xffff;
2115 dev->stats.tx_window_errors++;
2116 }
2117 if (i < MAX_FIDS / 2)
2118 netif_wake_queue(dev);
2119 dev_kfree_skb(skb);
2120}
2121
2122static int airo_start_xmit(struct sk_buff *skb, struct net_device *dev) {
2123 s16 len;
2124 int i, j;
2125 struct airo_info *priv = dev->ml_priv;
2126 u32 *fids = priv->fids;
2127
2128 if ( skb == NULL ) {
2129 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2130 return 0;
2131 }
2132
2133
2134 for( i = 0; i < MAX_FIDS / 2 && (fids[i] & 0xffff0000); i++ );
2135 for( j = i + 1; j < MAX_FIDS / 2 && (fids[j] & 0xffff0000); j++ );
2136
2137 if ( j >= MAX_FIDS / 2 ) {
2138 netif_stop_queue(dev);
2139
2140 if (i == MAX_FIDS / 2) {
2141 dev->stats.tx_fifo_errors++;
2142 return NETDEV_TX_BUSY;
2143 }
2144 }
2145
2146 len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2147
2148 fids[i] |= (len << 16);
2149 priv->xmit.skb = skb;
2150 priv->xmit.fid = i;
2151 if (down_trylock(&priv->sem) != 0) {
2152 set_bit(FLAG_PENDING_XMIT, &priv->flags);
2153 netif_stop_queue(dev);
2154 set_bit(JOB_XMIT, &priv->jobs);
2155 wake_up_interruptible(&priv->thr_wait);
2156 } else
2157 airo_end_xmit(dev);
2158 return 0;
2159}
2160
2161static void airo_end_xmit11(struct net_device *dev) {
2162 u16 status;
2163 int i;
2164 struct airo_info *priv = dev->ml_priv;
2165 struct sk_buff *skb = priv->xmit11.skb;
2166 int fid = priv->xmit11.fid;
2167 u32 *fids = priv->fids;
2168
2169 clear_bit(JOB_XMIT11, &priv->jobs);
2170 clear_bit(FLAG_PENDING_XMIT11, &priv->flags);
2171 status = transmit_802_11_packet (priv, fids[fid], skb->data);
2172 up(&priv->sem);
2173
2174 i = MAX_FIDS / 2;
2175 if ( status == SUCCESS ) {
2176 dev->trans_start = jiffies;
2177 for (; i < MAX_FIDS && (priv->fids[i] & 0xffff0000); i++);
2178 } else {
2179 priv->fids[fid] &= 0xffff;
2180 dev->stats.tx_window_errors++;
2181 }
2182 if (i < MAX_FIDS)
2183 netif_wake_queue(dev);
2184 dev_kfree_skb(skb);
2185}
2186
2187static int airo_start_xmit11(struct sk_buff *skb, struct net_device *dev) {
2188 s16 len;
2189 int i, j;
2190 struct airo_info *priv = dev->ml_priv;
2191 u32 *fids = priv->fids;
2192
2193 if (test_bit(FLAG_MPI, &priv->flags)) {
2194
2195 netif_stop_queue(dev);
2196 dev_kfree_skb_any(skb);
2197 return NETDEV_TX_OK;
2198 }
2199
2200 if ( skb == NULL ) {
2201 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
2202 return 0;
2203 }
2204
2205
2206 for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2207 for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2208
2209 if ( j >= MAX_FIDS ) {
2210 netif_stop_queue(dev);
2211
2212 if (i == MAX_FIDS) {
2213 dev->stats.tx_fifo_errors++;
2214 return NETDEV_TX_BUSY;
2215 }
2216 }
2217
2218 len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2219
2220 fids[i] |= (len << 16);
2221 priv->xmit11.skb = skb;
2222 priv->xmit11.fid = i;
2223 if (down_trylock(&priv->sem) != 0) {
2224 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2225 netif_stop_queue(dev);
2226 set_bit(JOB_XMIT11, &priv->jobs);
2227 wake_up_interruptible(&priv->thr_wait);
2228 } else
2229 airo_end_xmit11(dev);
2230 return 0;
2231}
2232
2233static void airo_read_stats(struct net_device *dev)
2234{
2235 struct airo_info *ai = dev->ml_priv;
2236 StatsRid stats_rid;
2237 __le32 *vals = stats_rid.vals;
2238
2239 clear_bit(JOB_STATS, &ai->jobs);
2240 if (ai->power.event) {
2241 up(&ai->sem);
2242 return;
2243 }
2244 readStatsRid(ai, &stats_rid, RID_STATS, 0);
2245 up(&ai->sem);
2246
2247 dev->stats.rx_packets = le32_to_cpu(vals[43]) + le32_to_cpu(vals[44]) +
2248 le32_to_cpu(vals[45]);
2249 dev->stats.tx_packets = le32_to_cpu(vals[39]) + le32_to_cpu(vals[40]) +
2250 le32_to_cpu(vals[41]);
2251 dev->stats.rx_bytes = le32_to_cpu(vals[92]);
2252 dev->stats.tx_bytes = le32_to_cpu(vals[91]);
2253 dev->stats.rx_errors = le32_to_cpu(vals[0]) + le32_to_cpu(vals[2]) +
2254 le32_to_cpu(vals[3]) + le32_to_cpu(vals[4]);
2255 dev->stats.tx_errors = le32_to_cpu(vals[42]) +
2256 dev->stats.tx_fifo_errors;
2257 dev->stats.multicast = le32_to_cpu(vals[43]);
2258 dev->stats.collisions = le32_to_cpu(vals[89]);
2259
2260
2261 dev->stats.rx_length_errors = le32_to_cpu(vals[3]);
2262 dev->stats.rx_crc_errors = le32_to_cpu(vals[4]);
2263 dev->stats.rx_frame_errors = le32_to_cpu(vals[2]);
2264 dev->stats.rx_fifo_errors = le32_to_cpu(vals[0]);
2265}
2266
2267static struct net_device_stats *airo_get_stats(struct net_device *dev)
2268{
2269 struct airo_info *local = dev->ml_priv;
2270
2271 if (!test_bit(JOB_STATS, &local->jobs)) {
2272
2273 if (down_trylock(&local->sem) != 0) {
2274 set_bit(JOB_STATS, &local->jobs);
2275 wake_up_interruptible(&local->thr_wait);
2276 } else
2277 airo_read_stats(dev);
2278 }
2279
2280 return &dev->stats;
2281}
2282
2283static void airo_set_promisc(struct airo_info *ai) {
2284 Cmd cmd;
2285 Resp rsp;
2286
2287 memset(&cmd, 0, sizeof(cmd));
2288 cmd.cmd=CMD_SETMODE;
2289 clear_bit(JOB_PROMISC, &ai->jobs);
2290 cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2291 issuecommand(ai, &cmd, &rsp);
2292 up(&ai->sem);
2293}
2294
2295static void airo_set_multicast_list(struct net_device *dev) {
2296 struct airo_info *ai = dev->ml_priv;
2297
2298 if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2299 change_bit(FLAG_PROMISC, &ai->flags);
2300 if (down_trylock(&ai->sem) != 0) {
2301 set_bit(JOB_PROMISC, &ai->jobs);
2302 wake_up_interruptible(&ai->thr_wait);
2303 } else
2304 airo_set_promisc(ai);
2305 }
2306
2307 if ((dev->flags&IFF_ALLMULTI)||dev->mc_count>0) {
2308
2309 }
2310}
2311
2312static int airo_set_mac_address(struct net_device *dev, void *p)
2313{
2314 struct airo_info *ai = dev->ml_priv;
2315 struct sockaddr *addr = p;
2316
2317 readConfigRid(ai, 1);
2318 memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2319 set_bit (FLAG_COMMIT, &ai->flags);
2320 disable_MAC(ai, 1);
2321 writeConfigRid (ai, 1);
2322 enable_MAC(ai, 1);
2323 memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2324 if (ai->wifidev)
2325 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2326 return 0;
2327}
2328
2329static int airo_change_mtu(struct net_device *dev, int new_mtu)
2330{
2331 if ((new_mtu < 68) || (new_mtu > 2400))
2332 return -EINVAL;
2333 dev->mtu = new_mtu;
2334 return 0;
2335}
2336
2337static LIST_HEAD(airo_devices);
2338
2339static void add_airo_dev(struct airo_info *ai)
2340{
2341
2342
2343 if (!ai->pci)
2344 list_add_tail(&ai->dev_list, &airo_devices);
2345}
2346
2347static void del_airo_dev(struct airo_info *ai)
2348{
2349 if (!ai->pci)
2350 list_del(&ai->dev_list);
2351}
2352
2353static int airo_close(struct net_device *dev) {
2354 struct airo_info *ai = dev->ml_priv;
2355
2356 netif_stop_queue(dev);
2357
2358 if (ai->wifidev != dev) {
2359#ifdef POWER_ON_DOWN
2360
2361
2362
2363
2364
2365 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2366 disable_MAC(ai, 1);
2367#endif
2368 disable_interrupts( ai );
2369
2370 free_irq(dev->irq, dev);
2371
2372 set_bit(JOB_DIE, &ai->jobs);
2373 kthread_stop(ai->airo_thread_task);
2374 }
2375 return 0;
2376}
2377
2378void stop_airo_card( struct net_device *dev, int freeres )
2379{
2380 struct airo_info *ai = dev->ml_priv;
2381
2382 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2383 disable_MAC(ai, 1);
2384 disable_interrupts(ai);
2385 takedown_proc_entry( dev, ai );
2386 if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2387 unregister_netdev( dev );
2388 if (ai->wifidev) {
2389 unregister_netdev(ai->wifidev);
2390 free_netdev(ai->wifidev);
2391 ai->wifidev = NULL;
2392 }
2393 clear_bit(FLAG_REGISTERED, &ai->flags);
2394 }
2395
2396
2397
2398 if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
2399 struct sk_buff *skb = NULL;
2400 for (;(skb = skb_dequeue(&ai->txq));)
2401 dev_kfree_skb(skb);
2402 }
2403
2404 airo_networks_free (ai);
2405
2406 kfree(ai->flash);
2407 kfree(ai->rssi);
2408 kfree(ai->APList);
2409 kfree(ai->SSID);
2410 if (freeres) {
2411
2412 release_region( dev->base_addr, 64 );
2413 if (test_bit(FLAG_MPI, &ai->flags)) {
2414 if (ai->pci)
2415 mpi_unmap_card(ai->pci);
2416 if (ai->pcimem)
2417 iounmap(ai->pcimem);
2418 if (ai->pciaux)
2419 iounmap(ai->pciaux);
2420 pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2421 ai->shared, ai->shared_dma);
2422 }
2423 }
2424 crypto_free_cipher(ai->tfm);
2425 del_airo_dev(ai);
2426 free_netdev( dev );
2427}
2428
2429EXPORT_SYMBOL(stop_airo_card);
2430
2431static int wll_header_parse(const struct sk_buff *skb, unsigned char *haddr)
2432{
2433 memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
2434 return ETH_ALEN;
2435}
2436
2437static void mpi_unmap_card(struct pci_dev *pci)
2438{
2439 unsigned long mem_start = pci_resource_start(pci, 1);
2440 unsigned long mem_len = pci_resource_len(pci, 1);
2441 unsigned long aux_start = pci_resource_start(pci, 2);
2442 unsigned long aux_len = AUXMEMSIZE;
2443
2444 release_mem_region(aux_start, aux_len);
2445 release_mem_region(mem_start, mem_len);
2446}
2447
2448
2449
2450
2451
2452
2453
2454
2455static int mpi_init_descriptors (struct airo_info *ai)
2456{
2457 Cmd cmd;
2458 Resp rsp;
2459 int i;
2460 int rc = SUCCESS;
2461
2462
2463 netif_stop_queue(ai->dev);
2464
2465 memset(&rsp,0,sizeof(rsp));
2466 memset(&cmd,0,sizeof(cmd));
2467
2468 cmd.cmd = CMD_ALLOCATEAUX;
2469 cmd.parm0 = FID_RX;
2470 cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2471 cmd.parm2 = MPI_MAX_FIDS;
2472 rc=issuecommand(ai, &cmd, &rsp);
2473 if (rc != SUCCESS) {
2474 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
2475 return rc;
2476 }
2477
2478 for (i=0; i<MPI_MAX_FIDS; i++) {
2479 memcpy_toio(ai->rxfids[i].card_ram_off,
2480 &ai->rxfids[i].rx_desc, sizeof(RxFid));
2481 }
2482
2483
2484
2485 memset(&rsp,0,sizeof(rsp));
2486 memset(&cmd,0,sizeof(cmd));
2487
2488 cmd.cmd = CMD_ALLOCATEAUX;
2489 cmd.parm0 = FID_TX;
2490 cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2491 cmd.parm2 = MPI_MAX_FIDS;
2492
2493 for (i=0; i<MPI_MAX_FIDS; i++) {
2494 ai->txfids[i].tx_desc.valid = 1;
2495 memcpy_toio(ai->txfids[i].card_ram_off,
2496 &ai->txfids[i].tx_desc, sizeof(TxFid));
2497 }
2498 ai->txfids[i-1].tx_desc.eoc = 1;
2499
2500 rc=issuecommand(ai, &cmd, &rsp);
2501 if (rc != SUCCESS) {
2502 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
2503 return rc;
2504 }
2505
2506
2507 memset(&rsp,0,sizeof(rsp));
2508 memset(&cmd,0,sizeof(cmd));
2509
2510 cmd.cmd = CMD_ALLOCATEAUX;
2511 cmd.parm0 = RID_RW;
2512 cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2513 cmd.parm2 = 1;
2514 rc=issuecommand(ai, &cmd, &rsp);
2515 if (rc != SUCCESS) {
2516 airo_print_err(ai->dev->name, "Couldn't allocate RID");
2517 return rc;
2518 }
2519
2520 memcpy_toio(ai->config_desc.card_ram_off,
2521 &ai->config_desc.rid_desc, sizeof(Rid));
2522
2523 return rc;
2524}
2525
2526
2527
2528
2529
2530
2531
2532static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci)
2533{
2534 unsigned long mem_start, mem_len, aux_start, aux_len;
2535 int rc = -1;
2536 int i;
2537 dma_addr_t busaddroff;
2538 unsigned char *vpackoff;
2539 unsigned char __iomem *pciaddroff;
2540
2541 mem_start = pci_resource_start(pci, 1);
2542 mem_len = pci_resource_len(pci, 1);
2543 aux_start = pci_resource_start(pci, 2);
2544 aux_len = AUXMEMSIZE;
2545
2546 if (!request_mem_region(mem_start, mem_len, DRV_NAME)) {
2547 airo_print_err("", "Couldn't get region %x[%x]",
2548 (int)mem_start, (int)mem_len);
2549 goto out;
2550 }
2551 if (!request_mem_region(aux_start, aux_len, DRV_NAME)) {
2552 airo_print_err("", "Couldn't get region %x[%x]",
2553 (int)aux_start, (int)aux_len);
2554 goto free_region1;
2555 }
2556
2557 ai->pcimem = ioremap(mem_start, mem_len);
2558 if (!ai->pcimem) {
2559 airo_print_err("", "Couldn't map region %x[%x]",
2560 (int)mem_start, (int)mem_len);
2561 goto free_region2;
2562 }
2563 ai->pciaux = ioremap(aux_start, aux_len);
2564 if (!ai->pciaux) {
2565 airo_print_err("", "Couldn't map region %x[%x]",
2566 (int)aux_start, (int)aux_len);
2567 goto free_memmap;
2568 }
2569
2570
2571 ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2572 if (!ai->shared) {
2573 airo_print_err("", "Couldn't alloc_consistent %d",
2574 PCI_SHARED_LEN);
2575 goto free_auxmap;
2576 }
2577
2578
2579
2580
2581 busaddroff = ai->shared_dma;
2582 pciaddroff = ai->pciaux + AUX_OFFSET;
2583 vpackoff = ai->shared;
2584
2585
2586 for(i = 0; i < MPI_MAX_FIDS; i++) {
2587 ai->rxfids[i].pending = 0;
2588 ai->rxfids[i].card_ram_off = pciaddroff;
2589 ai->rxfids[i].virtual_host_addr = vpackoff;
2590 ai->rxfids[i].rx_desc.host_addr = busaddroff;
2591 ai->rxfids[i].rx_desc.valid = 1;
2592 ai->rxfids[i].rx_desc.len = PKTSIZE;
2593 ai->rxfids[i].rx_desc.rdy = 0;
2594
2595 pciaddroff += sizeof(RxFid);
2596 busaddroff += PKTSIZE;
2597 vpackoff += PKTSIZE;
2598 }
2599
2600
2601 for(i = 0; i < MPI_MAX_FIDS; i++) {
2602 ai->txfids[i].card_ram_off = pciaddroff;
2603 ai->txfids[i].virtual_host_addr = vpackoff;
2604 ai->txfids[i].tx_desc.valid = 1;
2605 ai->txfids[i].tx_desc.host_addr = busaddroff;
2606 memcpy(ai->txfids[i].virtual_host_addr,
2607 &wifictlhdr8023, sizeof(wifictlhdr8023));
2608
2609 pciaddroff += sizeof(TxFid);
2610 busaddroff += PKTSIZE;
2611 vpackoff += PKTSIZE;
2612 }
2613 ai->txfids[i-1].tx_desc.eoc = 1;
2614
2615
2616 ai->config_desc.card_ram_off = pciaddroff;
2617 ai->config_desc.virtual_host_addr = vpackoff;
2618 ai->config_desc.rid_desc.host_addr = busaddroff;
2619 ai->ridbus = busaddroff;
2620 ai->config_desc.rid_desc.rid = 0;
2621 ai->config_desc.rid_desc.len = RIDSIZE;
2622 ai->config_desc.rid_desc.valid = 1;
2623 pciaddroff += sizeof(Rid);
2624 busaddroff += RIDSIZE;
2625 vpackoff += RIDSIZE;
2626
2627
2628 if (mpi_init_descriptors (ai) != SUCCESS)
2629 goto free_shared;
2630
2631 return 0;
2632 free_shared:
2633 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2634 free_auxmap:
2635 iounmap(ai->pciaux);
2636 free_memmap:
2637 iounmap(ai->pcimem);
2638 free_region2:
2639 release_mem_region(aux_start, aux_len);
2640 free_region1:
2641 release_mem_region(mem_start, mem_len);
2642 out:
2643 return rc;
2644}
2645
2646static const struct header_ops airo_header_ops = {
2647 .parse = wll_header_parse,
2648};
2649
2650static const struct net_device_ops airo11_netdev_ops = {
2651 .ndo_open = airo_open,
2652 .ndo_stop = airo_close,
2653 .ndo_start_xmit = airo_start_xmit11,
2654 .ndo_get_stats = airo_get_stats,
2655 .ndo_set_mac_address = airo_set_mac_address,
2656 .ndo_do_ioctl = airo_ioctl,
2657 .ndo_change_mtu = airo_change_mtu,
2658};
2659
2660static void wifi_setup(struct net_device *dev)
2661{
2662 dev->netdev_ops = &airo11_netdev_ops;
2663 dev->header_ops = &airo_header_ops;
2664 dev->wireless_handlers = &airo_handler_def;
2665
2666 dev->type = ARPHRD_IEEE80211;
2667 dev->hard_header_len = ETH_HLEN;
2668 dev->mtu = AIRO_DEF_MTU;
2669 dev->addr_len = ETH_ALEN;
2670 dev->tx_queue_len = 100;
2671
2672 memset(dev->broadcast,0xFF, ETH_ALEN);
2673
2674 dev->flags = IFF_BROADCAST|IFF_MULTICAST;
2675}
2676
2677static struct net_device *init_wifidev(struct airo_info *ai,
2678 struct net_device *ethdev)
2679{
2680 int err;
2681 struct net_device *dev = alloc_netdev(0, "wifi%d", wifi_setup);
2682 if (!dev)
2683 return NULL;
2684 dev->ml_priv = ethdev->ml_priv;
2685 dev->irq = ethdev->irq;
2686 dev->base_addr = ethdev->base_addr;
2687 dev->wireless_data = ethdev->wireless_data;
2688 SET_NETDEV_DEV(dev, ethdev->dev.parent);
2689 memcpy(dev->dev_addr, ethdev->dev_addr, dev->addr_len);
2690 err = register_netdev(dev);
2691 if (err<0) {
2692 free_netdev(dev);
2693 return NULL;
2694 }
2695 return dev;
2696}
2697
2698static int reset_card( struct net_device *dev , int lock) {
2699 struct airo_info *ai = dev->ml_priv;
2700
2701 if (lock && down_interruptible(&ai->sem))
2702 return -1;
2703 waitbusy (ai);
2704 OUT4500(ai,COMMAND,CMD_SOFTRESET);
2705 msleep(200);
2706 waitbusy (ai);
2707 msleep(200);
2708 if (lock)
2709 up(&ai->sem);
2710 return 0;
2711}
2712
2713#define AIRO_MAX_NETWORK_COUNT 64
2714static int airo_networks_allocate(struct airo_info *ai)
2715{
2716 if (ai->networks)
2717 return 0;
2718
2719 ai->networks =
2720 kzalloc(AIRO_MAX_NETWORK_COUNT * sizeof(BSSListElement),
2721 GFP_KERNEL);
2722 if (!ai->networks) {
2723 airo_print_warn("", "Out of memory allocating beacons");
2724 return -ENOMEM;
2725 }
2726
2727 return 0;
2728}
2729
2730static void airo_networks_free(struct airo_info *ai)
2731{
2732 kfree(ai->networks);
2733 ai->networks = NULL;
2734}
2735
2736static void airo_networks_initialize(struct airo_info *ai)
2737{
2738 int i;
2739
2740 INIT_LIST_HEAD(&ai->network_free_list);
2741 INIT_LIST_HEAD(&ai->network_list);
2742 for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
2743 list_add_tail(&ai->networks[i].list,
2744 &ai->network_free_list);
2745}
2746
2747static const struct net_device_ops airo_netdev_ops = {
2748 .ndo_open = airo_open,
2749 .ndo_stop = airo_close,
2750 .ndo_start_xmit = airo_start_xmit,
2751 .ndo_get_stats = airo_get_stats,
2752 .ndo_set_multicast_list = airo_set_multicast_list,
2753 .ndo_set_mac_address = airo_set_mac_address,
2754 .ndo_do_ioctl = airo_ioctl,
2755 .ndo_change_mtu = airo_change_mtu,
2756 .ndo_validate_addr = eth_validate_addr,
2757};
2758
2759static const struct net_device_ops mpi_netdev_ops = {
2760 .ndo_open = airo_open,
2761 .ndo_stop = airo_close,
2762 .ndo_start_xmit = mpi_start_xmit,
2763 .ndo_get_stats = airo_get_stats,
2764 .ndo_set_multicast_list = airo_set_multicast_list,
2765 .ndo_set_mac_address = airo_set_mac_address,
2766 .ndo_do_ioctl = airo_ioctl,
2767 .ndo_change_mtu = airo_change_mtu,
2768 .ndo_validate_addr = eth_validate_addr,
2769};
2770
2771
2772static struct net_device *_init_airo_card( unsigned short irq, int port,
2773 int is_pcmcia, struct pci_dev *pci,
2774 struct device *dmdev )
2775{
2776 struct net_device *dev;
2777 struct airo_info *ai;
2778 int i, rc;
2779 CapabilityRid cap_rid;
2780
2781
2782 dev = alloc_netdev(sizeof(*ai), "", ether_setup);
2783 if (!dev) {
2784 airo_print_err("", "Couldn't alloc_etherdev");
2785 return NULL;
2786 }
2787
2788 ai = dev->ml_priv = netdev_priv(dev);
2789 ai->wifidev = NULL;
2790 ai->flags = 1 << FLAG_RADIO_DOWN;
2791 ai->jobs = 0;
2792 ai->dev = dev;
2793 if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
2794 airo_print_dbg("", "Found an MPI350 card");
2795 set_bit(FLAG_MPI, &ai->flags);
2796 }
2797 spin_lock_init(&ai->aux_lock);
2798 sema_init(&ai->sem, 1);
2799 ai->config.len = 0;
2800 ai->pci = pci;
2801 init_waitqueue_head (&ai->thr_wait);
2802 ai->tfm = NULL;
2803 add_airo_dev(ai);
2804
2805 if (airo_networks_allocate (ai))
2806 goto err_out_free;
2807 airo_networks_initialize (ai);
2808
2809 skb_queue_head_init (&ai->txq);
2810
2811
2812 if (test_bit(FLAG_MPI,&ai->flags))
2813 dev->netdev_ops = &mpi_netdev_ops;
2814 else
2815 dev->netdev_ops = &airo_netdev_ops;
2816 dev->wireless_handlers = &airo_handler_def;
2817 ai->wireless_data.spy_data = &ai->spy_data;
2818 dev->wireless_data = &ai->wireless_data;
2819 dev->irq = irq;
2820 dev->base_addr = port;
2821
2822 SET_NETDEV_DEV(dev, dmdev);
2823
2824 reset_card (dev, 1);
2825 msleep(400);
2826
2827 if (!is_pcmcia) {
2828 if (!request_region(dev->base_addr, 64, DRV_NAME)) {
2829 rc = -EBUSY;
2830 airo_print_err(dev->name, "Couldn't request region");
2831 goto err_out_nets;
2832 }
2833 }
2834
2835 if (test_bit(FLAG_MPI,&ai->flags)) {
2836 if (mpi_map_card(ai, pci)) {
2837 airo_print_err("", "Could not map memory");
2838 goto err_out_res;
2839 }
2840 }
2841
2842 if (probe) {
2843 if (setup_card(ai, dev->dev_addr, 1) != SUCCESS) {
2844 airo_print_err(dev->name, "MAC could not be enabled" );
2845 rc = -EIO;
2846 goto err_out_map;
2847 }
2848 } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2849 ai->bap_read = fast_bap_read;
2850 set_bit(FLAG_FLASHING, &ai->flags);
2851 }
2852
2853 strcpy(dev->name, "eth%d");
2854 rc = register_netdev(dev);
2855 if (rc) {
2856 airo_print_err(dev->name, "Couldn't register_netdev");
2857 goto err_out_map;
2858 }
2859 ai->wifidev = init_wifidev(ai, dev);
2860 if (!ai->wifidev)
2861 goto err_out_reg;
2862
2863 rc = readCapabilityRid(ai, &cap_rid, 1);
2864 if (rc != SUCCESS) {
2865 rc = -EIO;
2866 goto err_out_wifi;
2867 }
2868
2869 ai->wep_capable = (cap_rid.softCap & cpu_to_le16(0x02)) ? 1 : 0;
2870 ai->max_wep_idx = (cap_rid.softCap & cpu_to_le16(0x80)) ? 3 : 0;
2871
2872 airo_print_info(dev->name, "Firmware version %x.%x.%02x",
2873 ((le16_to_cpu(cap_rid.softVer) >> 8) & 0xF),
2874 (le16_to_cpu(cap_rid.softVer) & 0xFF),
2875 le16_to_cpu(cap_rid.softSubVer));
2876
2877
2878
2879 if (le16_to_cpu(cap_rid.softVer) > 0x530
2880 || (le16_to_cpu(cap_rid.softVer) == 0x530
2881 && le16_to_cpu(cap_rid.softSubVer) >= 17)) {
2882 airo_print_info(ai->dev->name, "WPA supported.");
2883
2884 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2885 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2886 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2887 ai->bssListRidLen = sizeof(BSSListRid);
2888 } else {
2889 airo_print_info(ai->dev->name, "WPA unsupported with firmware "
2890 "versions older than 5.30.17.");
2891
2892 ai->bssListFirst = RID_BSSLISTFIRST;
2893 ai->bssListNext = RID_BSSLISTNEXT;
2894 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2895 }
2896
2897 set_bit(FLAG_REGISTERED,&ai->flags);
2898 airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2899
2900
2901 if (probe && !test_bit(FLAG_MPI,&ai->flags))
2902 for( i = 0; i < MAX_FIDS; i++ )
2903 ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2904
2905 if (setup_proc_entry(dev, dev->ml_priv) < 0)
2906 goto err_out_wifi;
2907
2908 return dev;
2909
2910err_out_wifi:
2911 unregister_netdev(ai->wifidev);
2912 free_netdev(ai->wifidev);
2913err_out_reg:
2914 unregister_netdev(dev);
2915err_out_map:
2916 if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2917 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2918 iounmap(ai->pciaux);
2919 iounmap(ai->pcimem);
2920 mpi_unmap_card(ai->pci);
2921 }
2922err_out_res:
2923 if (!is_pcmcia)
2924 release_region( dev->base_addr, 64 );
2925err_out_nets:
2926 airo_networks_free(ai);
2927 del_airo_dev(ai);
2928err_out_free:
2929 free_netdev(dev);
2930 return NULL;
2931}
2932
2933struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2934 struct device *dmdev)
2935{
2936 return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2937}
2938
2939EXPORT_SYMBOL(init_airo_card);
2940
2941static int waitbusy (struct airo_info *ai) {
2942 int delay = 0;
2943 while ((IN4500(ai, COMMAND) & COMMAND_BUSY) && (delay < 10000)) {
2944 udelay (10);
2945 if ((++delay % 20) == 0)
2946 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2947 }
2948 return delay < 10000;
2949}
2950
2951int reset_airo_card( struct net_device *dev )
2952{
2953 int i;
2954 struct airo_info *ai = dev->ml_priv;
2955
2956 if (reset_card (dev, 1))
2957 return -1;
2958
2959 if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
2960 airo_print_err(dev->name, "MAC could not be enabled");
2961 return -1;
2962 }
2963 airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
2964
2965 if (!test_bit(FLAG_MPI,&ai->flags))
2966 for( i = 0; i < MAX_FIDS; i++ )
2967 ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
2968
2969 enable_interrupts( ai );
2970 netif_wake_queue(dev);
2971 return 0;
2972}
2973
2974EXPORT_SYMBOL(reset_airo_card);
2975
2976static void airo_send_event(struct net_device *dev) {
2977 struct airo_info *ai = dev->ml_priv;
2978 union iwreq_data wrqu;
2979 StatusRid status_rid;
2980
2981 clear_bit(JOB_EVENT, &ai->jobs);
2982 PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
2983 up(&ai->sem);
2984 wrqu.data.length = 0;
2985 wrqu.data.flags = 0;
2986 memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
2987 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
2988
2989
2990 wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
2991}
2992
2993static void airo_process_scan_results (struct airo_info *ai) {
2994 union iwreq_data wrqu;
2995 BSSListRid bss;
2996 int rc;
2997 BSSListElement * loop_net;
2998 BSSListElement * tmp_net;
2999
3000
3001 list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
3002 list_move_tail (&loop_net->list, &ai->network_free_list);
3003
3004 memset (loop_net, 0, sizeof (loop_net->bss));
3005 }
3006
3007
3008 rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
3009 if((rc) || (bss.index == cpu_to_le16(0xffff))) {
3010
3011 goto out;
3012 }
3013
3014
3015 tmp_net = NULL;
3016 while((!rc) && (bss.index != cpu_to_le16(0xffff))) {
3017
3018 if (!list_empty(&ai->network_free_list)) {
3019 tmp_net = list_entry(ai->network_free_list.next,
3020 BSSListElement, list);
3021 list_del(ai->network_free_list.next);
3022 }
3023
3024 if (tmp_net != NULL) {
3025 memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
3026 list_add_tail(&tmp_net->list, &ai->network_list);
3027 tmp_net = NULL;
3028 }
3029
3030
3031 rc = PC4500_readrid(ai, ai->bssListNext,
3032 &bss, ai->bssListRidLen, 0);
3033 }
3034
3035out:
3036 ai->scan_timeout = 0;
3037 clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
3038 up(&ai->sem);
3039
3040
3041
3042
3043
3044
3045
3046
3047 wrqu.data.length = 0;
3048 wrqu.data.flags = 0;
3049 wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3050}
3051
3052static int airo_thread(void *data) {
3053 struct net_device *dev = data;
3054 struct airo_info *ai = dev->ml_priv;
3055 int locked;
3056
3057 set_freezable();
3058 while(1) {
3059
3060 try_to_freeze();
3061
3062 if (test_bit(JOB_DIE, &ai->jobs))
3063 break;
3064
3065 if (ai->jobs) {
3066 locked = down_interruptible(&ai->sem);
3067 } else {
3068 wait_queue_t wait;
3069
3070 init_waitqueue_entry(&wait, current);
3071 add_wait_queue(&ai->thr_wait, &wait);
3072 for (;;) {
3073 set_current_state(TASK_INTERRUPTIBLE);
3074 if (ai->jobs)
3075 break;
3076 if (ai->expires || ai->scan_timeout) {
3077 if (ai->scan_timeout &&
3078 time_after_eq(jiffies,ai->scan_timeout)){
3079 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
3080 break;
3081 } else if (ai->expires &&
3082 time_after_eq(jiffies,ai->expires)){
3083 set_bit(JOB_AUTOWEP, &ai->jobs);
3084 break;
3085 }
3086 if (!kthread_should_stop() &&
3087 !freezing(current)) {
3088 unsigned long wake_at;
3089 if (!ai->expires || !ai->scan_timeout) {
3090 wake_at = max(ai->expires,
3091 ai->scan_timeout);
3092 } else {
3093 wake_at = min(ai->expires,
3094 ai->scan_timeout);
3095 }
3096 schedule_timeout(wake_at - jiffies);
3097 continue;
3098 }
3099 } else if (!kthread_should_stop() &&
3100 !freezing(current)) {
3101 schedule();
3102 continue;
3103 }
3104 break;
3105 }
3106 current->state = TASK_RUNNING;
3107 remove_wait_queue(&ai->thr_wait, &wait);
3108 locked = 1;
3109 }
3110
3111 if (locked)
3112 continue;
3113
3114 if (test_bit(JOB_DIE, &ai->jobs)) {
3115 up(&ai->sem);
3116 break;
3117 }
3118
3119 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
3120 up(&ai->sem);
3121 continue;
3122 }
3123
3124 if (test_bit(JOB_XMIT, &ai->jobs))
3125 airo_end_xmit(dev);
3126 else if (test_bit(JOB_XMIT11, &ai->jobs))
3127 airo_end_xmit11(dev);
3128 else if (test_bit(JOB_STATS, &ai->jobs))
3129 airo_read_stats(dev);
3130 else if (test_bit(JOB_WSTATS, &ai->jobs))
3131 airo_read_wireless_stats(ai);
3132 else if (test_bit(JOB_PROMISC, &ai->jobs))
3133 airo_set_promisc(ai);
3134 else if (test_bit(JOB_MIC, &ai->jobs))
3135 micinit(ai);
3136 else if (test_bit(JOB_EVENT, &ai->jobs))
3137 airo_send_event(dev);
3138 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
3139 timer_func(dev);
3140 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
3141 airo_process_scan_results(ai);
3142 else
3143 up(&ai->sem);
3144 }
3145
3146 return 0;
3147}
3148
3149static int header_len(__le16 ctl)
3150{
3151 u16 fc = le16_to_cpu(ctl);
3152 switch (fc & 0xc) {
3153 case 4:
3154 if ((fc & 0xe0) == 0xc0)
3155 return 10;
3156 return 16;
3157 case 8:
3158 if ((fc & 0x300) == 0x300)
3159 return 30;
3160 }
3161 return 24;
3162}
3163
3164static void airo_handle_cisco_mic(struct airo_info *ai)
3165{
3166 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags)) {
3167 set_bit(JOB_MIC, &ai->jobs);
3168 wake_up_interruptible(&ai->thr_wait);
3169 }
3170}
3171
3172
3173#define STAT_NOBEACON 0x8000
3174#define STAT_MAXRETRIES 0x8001
3175#define STAT_MAXARL 0x8002
3176#define STAT_FORCELOSS 0x8003
3177#define STAT_TSFSYNC 0x8004
3178#define STAT_DEAUTH 0x8100
3179#define STAT_DISASSOC 0x8200
3180#define STAT_ASSOC_FAIL 0x8400
3181#define STAT_AUTH_FAIL 0x0300
3182#define STAT_ASSOC 0x0400
3183#define STAT_REASSOC 0x0600
3184
3185static void airo_print_status(const char *devname, u16 status)
3186{
3187 u8 reason = status & 0xFF;
3188
3189 switch (status) {
3190 case STAT_NOBEACON:
3191 airo_print_dbg(devname, "link lost (missed beacons)");
3192 break;
3193 case STAT_MAXRETRIES:
3194 case STAT_MAXARL:
3195 airo_print_dbg(devname, "link lost (max retries)");
3196 break;
3197 case STAT_FORCELOSS:
3198 airo_print_dbg(devname, "link lost (local choice)");
3199 break;
3200 case STAT_TSFSYNC:
3201 airo_print_dbg(devname, "link lost (TSF sync lost)");
3202 break;
3203 case STAT_DEAUTH:
3204 airo_print_dbg(devname, "deauthenticated (reason: %d)", reason);
3205 break;
3206 case STAT_DISASSOC:
3207 airo_print_dbg(devname, "disassociated (reason: %d)", reason);
3208 break;
3209 case STAT_ASSOC_FAIL:
3210 airo_print_dbg(devname, "association failed (reason: %d)",
3211 reason);
3212 break;
3213 case STAT_AUTH_FAIL:
3214 airo_print_dbg(devname, "authentication failed (reason: %d)",
3215 reason);
3216 break;
3217 default:
3218 break;
3219 }
3220}
3221
3222static void airo_handle_link(struct airo_info *ai)
3223{
3224 union iwreq_data wrqu;
3225 int scan_forceloss = 0;
3226 u16 status;
3227
3228
3229 status = le16_to_cpu(IN4500(ai, LINKSTAT));
3230 OUT4500(ai, EVACK, EV_LINK);
3231
3232 if ((status == STAT_FORCELOSS) && (ai->scan_timeout > 0))
3233 scan_forceloss = 1;
3234
3235 airo_print_status(ai->dev->name, status);
3236
3237 if ((status == STAT_ASSOC) || (status == STAT_REASSOC)) {
3238 if (auto_wep)
3239 ai->expires = 0;
3240 if (ai->list_bss_task)
3241 wake_up_process(ai->list_bss_task);
3242 set_bit(FLAG_UPDATE_UNI, &ai->flags);
3243 set_bit(FLAG_UPDATE_MULTI, &ai->flags);
3244
3245 if (down_trylock(&ai->sem) != 0) {
3246 set_bit(JOB_EVENT, &ai->jobs);
3247 wake_up_interruptible(&ai->thr_wait);
3248 } else
3249 airo_send_event(ai->dev);
3250 } else if (!scan_forceloss) {
3251 if (auto_wep && !ai->expires) {
3252 ai->expires = RUN_AT(3*HZ);
3253 wake_up_interruptible(&ai->thr_wait);
3254 }
3255
3256
3257 memset(wrqu.ap_addr.sa_data, '\0', ETH_ALEN);
3258 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3259 wireless_send_event(ai->dev, SIOCGIWAP, &wrqu, NULL);
3260 }
3261}
3262
3263static void airo_handle_rx(struct airo_info *ai)
3264{
3265 struct sk_buff *skb = NULL;
3266 __le16 fc, v, *buffer, tmpbuf[4];
3267 u16 len, hdrlen = 0, gap, fid;
3268 struct rx_hdr hdr;
3269 int success = 0;
3270
3271 if (test_bit(FLAG_MPI, &ai->flags)) {
3272 if (test_bit(FLAG_802_11, &ai->flags))
3273 mpi_receive_802_11(ai);
3274 else
3275 mpi_receive_802_3(ai);
3276 OUT4500(ai, EVACK, EV_RX);
3277 return;
3278 }
3279
3280 fid = IN4500(ai, RXFID);
3281
3282
3283 if (test_bit(FLAG_802_11, &ai->flags)) {
3284 bap_setup (ai, fid, 4, BAP0);
3285 bap_read (ai, (__le16*)&hdr, sizeof(hdr), BAP0);
3286
3287 if (le16_to_cpu(hdr.status) & 2)
3288 hdr.len = 0;
3289 if (ai->wifidev == NULL)
3290 hdr.len = 0;
3291 } else {
3292 bap_setup(ai, fid, 0x36, BAP0);
3293 bap_read(ai, &hdr.len, 2, BAP0);
3294 }
3295 len = le16_to_cpu(hdr.len);
3296
3297 if (len > AIRO_DEF_MTU) {
3298 airo_print_err(ai->dev->name, "Bad size %d", len);
3299 goto done;
3300 }
3301 if (len == 0)
3302 goto done;
3303
3304 if (test_bit(FLAG_802_11, &ai->flags)) {
3305 bap_read(ai, &fc, sizeof (fc), BAP0);
3306 hdrlen = header_len(fc);
3307 } else
3308 hdrlen = ETH_ALEN * 2;
3309
3310 skb = dev_alloc_skb(len + hdrlen + 2 + 2);
3311 if (!skb) {
3312 ai->dev->stats.rx_dropped++;
3313 goto done;
3314 }
3315
3316 skb_reserve(skb, 2);
3317 buffer = (__le16 *) skb_put(skb, len + hdrlen);
3318 if (test_bit(FLAG_802_11, &ai->flags)) {
3319 buffer[0] = fc;
3320 bap_read(ai, buffer + 1, hdrlen - 2, BAP0);
3321 if (hdrlen == 24)
3322 bap_read(ai, tmpbuf, 6, BAP0);
3323
3324 bap_read(ai, &v, sizeof(v), BAP0);
3325 gap = le16_to_cpu(v);
3326 if (gap) {
3327 if (gap <= 8) {
3328 bap_read(ai, tmpbuf, gap, BAP0);
3329 } else {
3330 airo_print_err(ai->dev->name, "gaplen too "
3331 "big. Problems will follow...");
3332 }
3333 }
3334 bap_read(ai, buffer + hdrlen/2, len, BAP0);
3335 } else {
3336 MICBuffer micbuf;
3337
3338 bap_read(ai, buffer, ETH_ALEN * 2, BAP0);
3339 if (ai->micstats.enabled) {
3340 bap_read(ai, (__le16 *) &micbuf, sizeof (micbuf), BAP0);
3341 if (ntohs(micbuf.typelen) > 0x05DC)
3342 bap_setup(ai, fid, 0x44, BAP0);
3343 else {
3344 if (len <= sizeof (micbuf)) {
3345 dev_kfree_skb_irq(skb);
3346 goto done;
3347 }
3348
3349 len -= sizeof(micbuf);
3350 skb_trim(skb, len + hdrlen);
3351 }
3352 }
3353
3354 bap_read(ai, buffer + ETH_ALEN, len, BAP0);
3355 if (decapsulate(ai, &micbuf, (etherHead*) buffer, len))
3356 dev_kfree_skb_irq (skb);
3357 else
3358 success = 1;
3359 }
3360
3361#ifdef WIRELESS_SPY
3362 if (success && (ai->spy_data.spy_number > 0)) {
3363 char *sa;
3364 struct iw_quality wstats;
3365
3366
3367 if (!test_bit(FLAG_802_11, &ai->flags)) {
3368 sa = (char *) buffer + 6;
3369 bap_setup(ai, fid, 8, BAP0);
3370 bap_read(ai, (__le16 *) hdr.rssi, 2, BAP0);
3371 } else
3372 sa = (char *) buffer + 10;
3373 wstats.qual = hdr.rssi[0];
3374 if (ai->rssi)
3375 wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3376 else
3377 wstats.level = (hdr.rssi[1] + 321) / 2;
3378 wstats.noise = ai->wstats.qual.noise;
3379 wstats.updated = IW_QUAL_LEVEL_UPDATED
3380 | IW_QUAL_QUAL_UPDATED
3381 | IW_QUAL_DBM;
3382
3383 wireless_spy_update(ai->dev, sa, &wstats);
3384 }
3385#endif
3386
3387done:
3388 OUT4500(ai, EVACK, EV_RX);
3389
3390 if (success) {
3391 if (test_bit(FLAG_802_11, &ai->flags)) {
3392 skb_reset_mac_header(skb);
3393 skb->pkt_type = PACKET_OTHERHOST;
3394 skb->dev = ai->wifidev;
3395 skb->protocol = htons(ETH_P_802_2);
3396 } else
3397 skb->protocol = eth_type_trans(skb, ai->dev);
3398 skb->ip_summed = CHECKSUM_NONE;
3399
3400 netif_rx(skb);
3401 }
3402}
3403
3404static void airo_handle_tx(struct airo_info *ai, u16 status)
3405{
3406 int i, len = 0, index = -1;
3407 u16 fid;
3408
3409 if (test_bit(FLAG_MPI, &ai->flags)) {
3410 unsigned long flags;
3411
3412 if (status & EV_TXEXC)
3413 get_tx_error(ai, -1);
3414
3415 spin_lock_irqsave(&ai->aux_lock, flags);
3416 if (!skb_queue_empty(&ai->txq)) {
3417 spin_unlock_irqrestore(&ai->aux_lock,flags);
3418 mpi_send_packet(ai->dev);
3419 } else {
3420 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
3421 spin_unlock_irqrestore(&ai->aux_lock,flags);
3422 netif_wake_queue(ai->dev);
3423 }
3424 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3425 return;
3426 }
3427
3428 fid = IN4500(ai, TXCOMPLFID);
3429
3430 for(i = 0; i < MAX_FIDS; i++) {
3431 if ((ai->fids[i] & 0xffff) == fid) {
3432 len = ai->fids[i] >> 16;
3433 index = i;
3434 }
3435 }
3436
3437 if (index != -1) {
3438 if (status & EV_TXEXC)
3439 get_tx_error(ai, index);
3440
3441 OUT4500(ai, EVACK, status & (EV_TX | EV_TXEXC));
3442
3443
3444 ai->fids[index] &= 0xffff;
3445 if (index < MAX_FIDS / 2) {
3446 if (!test_bit(FLAG_PENDING_XMIT, &ai->flags))
3447 netif_wake_queue(ai->dev);
3448 } else {
3449 if (!test_bit(FLAG_PENDING_XMIT11, &ai->flags))
3450 netif_wake_queue(ai->wifidev);
3451 }
3452 } else {
3453 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3454 airo_print_err(ai->dev->name, "Unallocated FID was used to xmit");
3455 }
3456}
3457
3458static irqreturn_t airo_interrupt(int irq, void *dev_id)
3459{
3460 struct net_device *dev = dev_id;
3461 u16 status, savedInterrupts = 0;
3462 struct airo_info *ai = dev->ml_priv;
3463 int handled = 0;
3464
3465 if (!netif_device_present(dev))
3466 return IRQ_NONE;
3467
3468 for (;;) {
3469 status = IN4500(ai, EVSTAT);
3470 if (!(status & STATUS_INTS) || (status == 0xffff))
3471 break;
3472
3473 handled = 1;
3474
3475 if (status & EV_AWAKE) {
3476 OUT4500(ai, EVACK, EV_AWAKE);
3477 OUT4500(ai, EVACK, EV_AWAKE);
3478 }
3479
3480 if (!savedInterrupts) {
3481 savedInterrupts = IN4500(ai, EVINTEN);
3482 OUT4500(ai, EVINTEN, 0);
3483 }
3484
3485 if (status & EV_MIC) {
3486 OUT4500(ai, EVACK, EV_MIC);
3487 airo_handle_cisco_mic(ai);
3488 }
3489
3490 if (status & EV_LINK) {
3491
3492 airo_handle_link(ai);
3493 }
3494
3495
3496 if (status & EV_RX)
3497 airo_handle_rx(ai);
3498
3499
3500 if (status & (EV_TX | EV_TXCPY | EV_TXEXC))
3501 airo_handle_tx(ai, status);
3502
3503 if ( status & ~STATUS_INTS & ~IGNORE_INTS ) {
3504 airo_print_warn(ai->dev->name, "Got weird status %x",
3505 status & ~STATUS_INTS & ~IGNORE_INTS );
3506 }
3507 }
3508
3509 if (savedInterrupts)
3510 OUT4500(ai, EVINTEN, savedInterrupts);
3511
3512 return IRQ_RETVAL(handled);
3513}
3514
3515
3516
3517
3518
3519
3520
3521
3522
3523
3524static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3525 if (test_bit(FLAG_MPI,&ai->flags))
3526 reg <<= 1;
3527 if ( !do8bitIO )
3528 outw( val, ai->dev->base_addr + reg );
3529 else {
3530 outb( val & 0xff, ai->dev->base_addr + reg );
3531 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3532 }
3533}
3534
3535static u16 IN4500( struct airo_info *ai, u16 reg ) {
3536 unsigned short rc;
3537
3538 if (test_bit(FLAG_MPI,&ai->flags))
3539 reg <<= 1;
3540 if ( !do8bitIO )
3541 rc = inw( ai->dev->base_addr + reg );
3542 else {
3543 rc = inb( ai->dev->base_addr + reg );
3544 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3545 }
3546 return rc;
3547}
3548
3549static int enable_MAC(struct airo_info *ai, int lock)
3550{
3551 int rc;
3552 Cmd cmd;
3553 Resp rsp;
3554
3555
3556
3557
3558
3559
3560
3561 if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3562
3563 if (lock && down_interruptible(&ai->sem))
3564 return -ERESTARTSYS;
3565
3566 if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3567 memset(&cmd, 0, sizeof(cmd));
3568 cmd.cmd = MAC_ENABLE;
3569 rc = issuecommand(ai, &cmd, &rsp);
3570 if (rc == SUCCESS)
3571 set_bit(FLAG_ENABLED, &ai->flags);
3572 } else
3573 rc = SUCCESS;
3574
3575 if (lock)
3576 up(&ai->sem);
3577
3578 if (rc)
3579 airo_print_err(ai->dev->name, "Cannot enable MAC");
3580 else if ((rsp.status & 0xFF00) != 0) {
3581 airo_print_err(ai->dev->name, "Bad MAC enable reason=%x, "
3582 "rid=%x, offset=%d", rsp.rsp0, rsp.rsp1, rsp.rsp2);
3583 rc = ERROR;
3584 }
3585 return rc;
3586}
3587
3588static void disable_MAC( struct airo_info *ai, int lock ) {
3589 Cmd cmd;
3590 Resp rsp;
3591
3592 if (lock && down_interruptible(&ai->sem))
3593 return;
3594
3595 if (test_bit(FLAG_ENABLED, &ai->flags)) {
3596 memset(&cmd, 0, sizeof(cmd));
3597 cmd.cmd = MAC_DISABLE;
3598 issuecommand(ai, &cmd, &rsp);
3599 clear_bit(FLAG_ENABLED, &ai->flags);
3600 }
3601 if (lock)
3602 up(&ai->sem);
3603}
3604
3605static void enable_interrupts( struct airo_info *ai ) {
3606
3607 OUT4500( ai, EVINTEN, STATUS_INTS );
3608}
3609
3610static void disable_interrupts( struct airo_info *ai ) {
3611 OUT4500( ai, EVINTEN, 0 );
3612}
3613
3614static void mpi_receive_802_3(struct airo_info *ai)
3615{
3616 RxFid rxd;
3617 int len = 0;
3618 struct sk_buff *skb;
3619 char *buffer;
3620 int off = 0;
3621 MICBuffer micbuf;
3622
3623 memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3624
3625 if (rxd.rdy && rxd.valid == 0) {
3626 len = rxd.len + 12;
3627 if (len < 12 || len > 2048)
3628 goto badrx;
3629
3630 skb = dev_alloc_skb(len);
3631 if (!skb) {
3632 ai->dev->stats.rx_dropped++;
3633 goto badrx;
3634 }
3635 buffer = skb_put(skb,len);
3636 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3637 if (ai->micstats.enabled) {
3638 memcpy(&micbuf,
3639 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3640 sizeof(micbuf));
3641 if (ntohs(micbuf.typelen) <= 0x05DC) {
3642 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3643 goto badmic;
3644
3645 off = sizeof(micbuf);
3646 skb_trim (skb, len - off);
3647 }
3648 }
3649 memcpy(buffer + ETH_ALEN * 2,
3650 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3651 len - ETH_ALEN * 2 - off);
3652 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3653badmic:
3654 dev_kfree_skb_irq (skb);
3655 goto badrx;
3656 }
3657#ifdef WIRELESS_SPY
3658 if (ai->spy_data.spy_number > 0) {
3659 char *sa;
3660 struct iw_quality wstats;
3661
3662 sa = buffer + ETH_ALEN;
3663 wstats.qual = 0;
3664 wstats.level = 0;
3665 wstats.updated = 0;
3666
3667 wireless_spy_update(ai->dev, sa, &wstats);
3668 }
3669#endif
3670
3671 skb->ip_summed = CHECKSUM_NONE;
3672 skb->protocol = eth_type_trans(skb, ai->dev);
3673 netif_rx(skb);
3674 }
3675badrx:
3676 if (rxd.valid == 0) {
3677 rxd.valid = 1;
3678 rxd.rdy = 0;
3679 rxd.len = PKTSIZE;
3680 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3681 }
3682}
3683
3684static void mpi_receive_802_11(struct airo_info *ai)
3685{
3686 RxFid rxd;
3687 struct sk_buff *skb = NULL;
3688 u16 len, hdrlen = 0;
3689 __le16 fc;
3690 struct rx_hdr hdr;
3691 u16 gap;
3692 u16 *buffer;
3693 char *ptr = ai->rxfids[0].virtual_host_addr + 4;
3694
3695 memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3696 memcpy ((char *)&hdr, ptr, sizeof(hdr));
3697 ptr += sizeof(hdr);
3698
3699 if (le16_to_cpu(hdr.status) & 2)
3700 hdr.len = 0;
3701 if (ai->wifidev == NULL)
3702 hdr.len = 0;
3703 len = le16_to_cpu(hdr.len);
3704 if (len > AIRO_DEF_MTU) {
3705 airo_print_err(ai->dev->name, "Bad size %d", len);
3706 goto badrx;
3707 }
3708 if (len == 0)
3709 goto badrx;
3710
3711 fc = get_unaligned((__le16 *)ptr);
3712 hdrlen = header_len(fc);
3713
3714 skb = dev_alloc_skb( len + hdrlen + 2 );
3715 if ( !skb ) {
3716 ai->dev->stats.rx_dropped++;
3717 goto badrx;
3718 }
3719 buffer = (u16*)skb_put (skb, len + hdrlen);
3720 memcpy ((char *)buffer, ptr, hdrlen);
3721 ptr += hdrlen;
3722 if (hdrlen == 24)
3723 ptr += 6;
3724 gap = get_unaligned_le16(ptr);
3725 ptr += sizeof(__le16);
3726 if (gap) {
3727 if (gap <= 8)
3728 ptr += gap;
3729 else
3730 airo_print_err(ai->dev->name,
3731 "gaplen too big. Problems will follow...");
3732 }
3733 memcpy ((char *)buffer + hdrlen, ptr, len);
3734 ptr += len;
3735#ifdef IW_WIRELESS_SPY
3736 if (ai->spy_data.spy_number > 0) {
3737 char *sa;
3738 struct iw_quality wstats;
3739
3740 sa = (char*)buffer + 10;
3741 wstats.qual = hdr.rssi[0];
3742 if (ai->rssi)
3743 wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3744 else
3745 wstats.level = (hdr.rssi[1] + 321) / 2;
3746 wstats.noise = ai->wstats.qual.noise;
3747 wstats.updated = IW_QUAL_QUAL_UPDATED
3748 | IW_QUAL_LEVEL_UPDATED
3749 | IW_QUAL_DBM;
3750
3751 wireless_spy_update(ai->dev, sa, &wstats);
3752 }
3753#endif
3754 skb_reset_mac_header(skb);
3755 skb->pkt_type = PACKET_OTHERHOST;
3756 skb->dev = ai->wifidev;
3757 skb->protocol = htons(ETH_P_802_2);
3758 skb->ip_summed = CHECKSUM_NONE;
3759 netif_rx( skb );
3760
3761badrx:
3762 if (rxd.valid == 0) {
3763 rxd.valid = 1;
3764 rxd.rdy = 0;
3765 rxd.len = PKTSIZE;
3766 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3767 }
3768}
3769
3770static u16 setup_card(struct airo_info *ai, u8 *mac, int lock)
3771{
3772 Cmd cmd;
3773 Resp rsp;
3774 int status;
3775 SsidRid mySsid;
3776 __le16 lastindex;
3777 WepKeyRid wkr;
3778 int rc;
3779
3780 memset( &mySsid, 0, sizeof( mySsid ) );
3781 kfree (ai->flash);
3782 ai->flash = NULL;
3783
3784
3785 cmd.cmd = NOP;
3786 cmd.parm0 = cmd.parm1 = cmd.parm2 = 0;
3787 if (lock && down_interruptible(&ai->sem))
3788 return ERROR;
3789 if ( issuecommand( ai, &cmd, &rsp ) != SUCCESS ) {
3790 if (lock)
3791 up(&ai->sem);
3792 return ERROR;
3793 }
3794 disable_MAC( ai, 0);
3795
3796
3797 if (!test_bit(FLAG_MPI,&ai->flags)) {
3798 cmd.cmd = CMD_ENABLEAUX;
3799 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
3800 if (lock)
3801 up(&ai->sem);
3802 airo_print_err(ai->dev->name, "Error checking for AUX port");
3803 return ERROR;
3804 }
3805 if (!aux_bap || rsp.status & 0xff00) {
3806 ai->bap_read = fast_bap_read;
3807 airo_print_dbg(ai->dev->name, "Doing fast bap_reads");
3808 } else {
3809 ai->bap_read = aux_bap_read;
3810 airo_print_dbg(ai->dev->name, "Doing AUX bap_reads");
3811 }
3812 }
3813 if (lock)
3814 up(&ai->sem);
3815 if (ai->config.len == 0) {
3816 int i;
3817 tdsRssiRid rssi_rid;
3818 CapabilityRid cap_rid;
3819
3820 kfree(ai->APList);
3821 ai->APList = NULL;
3822 kfree(ai->SSID);
3823 ai->SSID = NULL;
3824
3825 status = readConfigRid(ai, lock);
3826 if ( status != SUCCESS ) return ERROR;
3827
3828 status = readCapabilityRid(ai, &cap_rid, lock);
3829 if ( status != SUCCESS ) return ERROR;
3830
3831 status = PC4500_readrid(ai,RID_RSSI,&rssi_rid,sizeof(rssi_rid),lock);
3832 if ( status == SUCCESS ) {
3833 if (ai->rssi || (ai->rssi = kmalloc(512, GFP_KERNEL)) != NULL)
3834 memcpy(ai->rssi, (u8*)&rssi_rid + 2, 512);
3835 }
3836 else {
3837 kfree(ai->rssi);
3838 ai->rssi = NULL;
3839 if (cap_rid.softCap & cpu_to_le16(8))
3840 ai->config.rmode |= RXMODE_NORMALIZED_RSSI;
3841 else
3842 airo_print_warn(ai->dev->name, "unknown received signal "
3843 "level scale");
3844 }
3845 ai->config.opmode = adhoc ? MODE_STA_IBSS : MODE_STA_ESS;
3846 ai->config.authType = AUTH_OPEN;
3847 ai->config.modulation = MOD_CCK;
3848
3849 if (le16_to_cpu(cap_rid.len) >= sizeof(cap_rid) &&
3850 (cap_rid.extSoftCap & cpu_to_le16(1)) &&
3851 micsetup(ai) == SUCCESS) {
3852 ai->config.opmode |= MODE_MIC;
3853 set_bit(FLAG_MIC_CAPABLE, &ai->flags);
3854 }
3855
3856
3857 for( i = 0; i < ETH_ALEN; i++ ) {
3858 mac[i] = ai->config.macAddr[i];
3859 }
3860
3861
3862
3863 if ( rates[0] ) {
3864 memset(ai->config.rates,0,sizeof(ai->config.rates));
3865 for( i = 0; i < 8 && rates[i]; i++ ) {
3866 ai->config.rates[i] = rates[i];
3867 }
3868 }
3869 if ( basic_rate > 0 ) {
3870 for( i = 0; i < 8; i++ ) {
3871 if ( ai->config.rates[i] == basic_rate ||
3872 !ai->config.rates ) {
3873 ai->config.rates[i] = basic_rate | 0x80;
3874 break;
3875 }
3876 }
3877 }
3878 set_bit (FLAG_COMMIT, &ai->flags);
3879 }
3880
3881
3882 if ( ssids[0] ) {
3883 int i;
3884 for( i = 0; i < 3 && ssids[i]; i++ ) {
3885 size_t len = strlen(ssids[i]);
3886 if (len > 32)
3887 len = 32;
3888 mySsid.ssids[i].len = cpu_to_le16(len);
3889 memcpy(mySsid.ssids[i].ssid, ssids[i], len);
3890 }
3891 mySsid.len = cpu_to_le16(sizeof(mySsid));
3892 }
3893
3894 status = writeConfigRid(ai, lock);
3895 if ( status != SUCCESS ) return ERROR;
3896
3897
3898 if ( ssids[0] ) {
3899 status = writeSsidRid(ai, &mySsid, lock);
3900 if ( status != SUCCESS ) return ERROR;
3901 }
3902
3903 status = enable_MAC(ai, lock);
3904 if (status != SUCCESS)
3905 return ERROR;
3906
3907
3908 rc = readWepKeyRid(ai, &wkr, 1, lock);
3909 if (rc == SUCCESS) do {
3910 lastindex = wkr.kindex;
3911 if (wkr.kindex == cpu_to_le16(0xffff)) {
3912 ai->defindex = wkr.mac[0];
3913 }
3914 rc = readWepKeyRid(ai, &wkr, 0, lock);
3915 } while(lastindex != wkr.kindex);
3916
3917 try_auto_wep(ai);
3918
3919 return SUCCESS;
3920}
3921
3922static u16 issuecommand(struct airo_info *ai, Cmd *pCmd, Resp *pRsp) {
3923
3924 int max_tries = 600000;
3925
3926 if (IN4500(ai, EVSTAT) & EV_CMD)
3927 OUT4500(ai, EVACK, EV_CMD);
3928
3929 OUT4500(ai, PARAM0, pCmd->parm0);
3930 OUT4500(ai, PARAM1, pCmd->parm1);
3931 OUT4500(ai, PARAM2, pCmd->parm2);
3932 OUT4500(ai, COMMAND, pCmd->cmd);
3933
3934 while (max_tries-- && (IN4500(ai, EVSTAT) & EV_CMD) == 0) {
3935 if ((IN4500(ai, COMMAND)) == pCmd->cmd)
3936
3937 OUT4500(ai, COMMAND, pCmd->cmd);
3938 if (!in_atomic() && (max_tries & 255) == 0)
3939 schedule();
3940 }
3941
3942 if ( max_tries == -1 ) {
3943 airo_print_err(ai->dev->name,
3944 "Max tries exceeded when issueing command");
3945 if (IN4500(ai, COMMAND) & COMMAND_BUSY)
3946 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3947 return ERROR;
3948 }
3949
3950
3951 pRsp->status = IN4500(ai, STATUS);
3952 pRsp->rsp0 = IN4500(ai, RESP0);
3953 pRsp->rsp1 = IN4500(ai, RESP1);
3954 pRsp->rsp2 = IN4500(ai, RESP2);
3955 if ((pRsp->status & 0xff00)!=0 && pCmd->cmd != CMD_SOFTRESET)
3956 airo_print_err(ai->dev->name,
3957 "cmd:%x status:%x rsp0:%x rsp1:%x rsp2:%x",
3958 pCmd->cmd, pRsp->status, pRsp->rsp0, pRsp->rsp1,
3959 pRsp->rsp2);
3960
3961
3962 if (IN4500(ai, COMMAND) & COMMAND_BUSY) {
3963 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3964 }
3965
3966 OUT4500(ai, EVACK, EV_CMD);
3967
3968 return SUCCESS;
3969}
3970
3971
3972
3973
3974static int bap_setup(struct airo_info *ai, u16 rid, u16 offset, int whichbap )
3975{
3976 int timeout = 50;
3977 int max_tries = 3;
3978
3979 OUT4500(ai, SELECT0+whichbap, rid);
3980 OUT4500(ai, OFFSET0+whichbap, offset);
3981 while (1) {
3982 int status = IN4500(ai, OFFSET0+whichbap);
3983 if (status & BAP_BUSY) {
3984
3985
3986 if (timeout--) {
3987 continue;
3988 }
3989 } else if ( status & BAP_ERR ) {
3990
3991 airo_print_err(ai->dev->name, "BAP error %x %d",
3992 status, whichbap );
3993 return ERROR;
3994 } else if (status & BAP_DONE) {
3995 return SUCCESS;
3996 }
3997 if ( !(max_tries--) ) {
3998 airo_print_err(ai->dev->name,
3999 "BAP setup error too many retries\n");
4000 return ERROR;
4001 }
4002
4003 OUT4500(ai, SELECT0+whichbap, rid);
4004 OUT4500(ai, OFFSET0+whichbap, offset);
4005 timeout = 50;
4006 }
4007}
4008
4009
4010
4011
4012static u16 aux_setup(struct airo_info *ai, u16 page,
4013 u16 offset, u16 *len)
4014{
4015 u16 next;
4016
4017 OUT4500(ai, AUXPAGE, page);
4018 OUT4500(ai, AUXOFF, 0);
4019 next = IN4500(ai, AUXDATA);
4020 *len = IN4500(ai, AUXDATA)&0xff;
4021 if (offset != 4) OUT4500(ai, AUXOFF, offset);
4022 return next;
4023}
4024
4025
4026static int aux_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4027 int bytelen, int whichbap)
4028{
4029 u16 len;
4030 u16 page;
4031 u16 offset;
4032 u16 next;
4033 int words;
4034 int i;
4035 unsigned long flags;
4036
4037 spin_lock_irqsave(&ai->aux_lock, flags);
4038 page = IN4500(ai, SWS0+whichbap);
4039 offset = IN4500(ai, SWS2+whichbap);
4040 next = aux_setup(ai, page, offset, &len);
4041 words = (bytelen+1)>>1;
4042
4043 for (i=0; i<words;) {
4044 int count;
4045 count = (len>>1) < (words-i) ? (len>>1) : (words-i);
4046 if ( !do8bitIO )
4047 insw( ai->dev->base_addr+DATA0+whichbap,
4048 pu16Dst+i,count );
4049 else
4050 insb( ai->dev->base_addr+DATA0+whichbap,
4051 pu16Dst+i, count << 1 );
4052 i += count;
4053 if (i<words) {
4054 next = aux_setup(ai, next, 4, &len);
4055 }
4056 }
4057 spin_unlock_irqrestore(&ai->aux_lock, flags);
4058 return SUCCESS;
4059}
4060
4061
4062
4063static int fast_bap_read(struct airo_info *ai, __le16 *pu16Dst,
4064 int bytelen, int whichbap)
4065{
4066 bytelen = (bytelen + 1) & (~1);
4067 if ( !do8bitIO )
4068 insw( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen>>1 );
4069 else
4070 insb( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen );
4071 return SUCCESS;
4072}
4073
4074
4075static int bap_write(struct airo_info *ai, const __le16 *pu16Src,
4076 int bytelen, int whichbap)
4077{
4078 bytelen = (bytelen + 1) & (~1);
4079 if ( !do8bitIO )
4080 outsw( ai->dev->base_addr+DATA0+whichbap,
4081 pu16Src, bytelen>>1 );
4082 else
4083 outsb( ai->dev->base_addr+DATA0+whichbap, pu16Src, bytelen );
4084 return SUCCESS;
4085}
4086
4087static int PC4500_accessrid(struct airo_info *ai, u16 rid, u16 accmd)
4088{
4089 Cmd cmd;
4090 Resp rsp;
4091 u16 status;
4092
4093 memset(&cmd, 0, sizeof(cmd));
4094 cmd.cmd = accmd;
4095 cmd.parm0 = rid;
4096 status = issuecommand(ai, &cmd, &rsp);
4097 if (status != 0) return status;
4098 if ( (rsp.status & 0x7F00) != 0) {
4099 return (accmd << 8) + (rsp.rsp0 & 0xFF);
4100 }
4101 return 0;
4102}
4103
4104
4105
4106static int PC4500_readrid(struct airo_info *ai, u16 rid, void *pBuf, int len, int lock)
4107{
4108 u16 status;
4109 int rc = SUCCESS;
4110
4111 if (lock) {
4112 if (down_interruptible(&ai->sem))
4113 return ERROR;
4114 }
4115 if (test_bit(FLAG_MPI,&ai->flags)) {
4116 Cmd cmd;
4117 Resp rsp;
4118
4119 memset(&cmd, 0, sizeof(cmd));
4120 memset(&rsp, 0, sizeof(rsp));
4121 ai->config_desc.rid_desc.valid = 1;
4122 ai->config_desc.rid_desc.len = RIDSIZE;
4123 ai->config_desc.rid_desc.rid = 0;
4124 ai->config_desc.rid_desc.host_addr = ai->ridbus;
4125
4126 cmd.cmd = CMD_ACCESS;
4127 cmd.parm0 = rid;
4128
4129 memcpy_toio(ai->config_desc.card_ram_off,
4130 &ai->config_desc.rid_desc, sizeof(Rid));
4131
4132 rc = issuecommand(ai, &cmd, &rsp);
4133
4134 if (rsp.status & 0x7f00)
4135 rc = rsp.rsp0;
4136 if (!rc)
4137 memcpy(pBuf, ai->config_desc.virtual_host_addr, len);
4138 goto done;
4139 } else {
4140 if ((status = PC4500_accessrid(ai, rid, CMD_ACCESS))!=SUCCESS) {
4141 rc = status;
4142 goto done;
4143 }
4144 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4145 rc = ERROR;
4146 goto done;
4147 }
4148
4149 bap_read(ai, pBuf, 2, BAP1);
4150
4151 len = min(len, (int)le16_to_cpu(*(__le16*)pBuf)) - 2;
4152
4153 if ( len <= 2 ) {
4154 airo_print_err(ai->dev->name,
4155 "Rid %x has a length of %d which is too short",
4156 (int)rid, (int)len );
4157 rc = ERROR;
4158 goto done;
4159 }
4160
4161 rc = bap_read(ai, ((__le16*)pBuf)+1, len, BAP1);
4162 }
4163done:
4164 if (lock)
4165 up(&ai->sem);
4166 return rc;
4167}
4168
4169
4170
4171static int PC4500_writerid(struct airo_info *ai, u16 rid,
4172 const void *pBuf, int len, int lock)
4173{
4174 u16 status;
4175 int rc = SUCCESS;
4176
4177 *(__le16*)pBuf = cpu_to_le16((u16)len);
4178
4179 if (lock) {
4180 if (down_interruptible(&ai->sem))
4181 return ERROR;
4182 }
4183 if (test_bit(FLAG_MPI,&ai->flags)) {
4184 Cmd cmd;
4185 Resp rsp;
4186
4187 if (test_bit(FLAG_ENABLED, &ai->flags) && (RID_WEP_TEMP != rid))
4188 airo_print_err(ai->dev->name,
4189 "%s: MAC should be disabled (rid=%04x)",
4190 __func__, rid);
4191 memset(&cmd, 0, sizeof(cmd));
4192 memset(&rsp, 0, sizeof(rsp));
4193
4194 ai->config_desc.rid_desc.valid = 1;
4195 ai->config_desc.rid_desc.len = *((u16 *)pBuf);
4196 ai->config_desc.rid_desc.rid = 0;
4197
4198 cmd.cmd = CMD_WRITERID;
4199 cmd.parm0 = rid;
4200
4201 memcpy_toio(ai->config_desc.card_ram_off,
4202 &ai->config_desc.rid_desc, sizeof(Rid));
4203
4204 if (len < 4 || len > 2047) {
4205 airo_print_err(ai->dev->name, "%s: len=%d", __func__, len);
4206 rc = -1;
4207 } else {
4208 memcpy((char *)ai->config_desc.virtual_host_addr,
4209 pBuf, len);
4210
4211 rc = issuecommand(ai, &cmd, &rsp);
4212 if ((rc & 0xff00) != 0) {
4213 airo_print_err(ai->dev->name, "%s: Write rid Error %d",
4214 __func__, rc);
4215 airo_print_err(ai->dev->name, "%s: Cmd=%04x",
4216 __func__, cmd.cmd);
4217 }
4218
4219 if ((rsp.status & 0x7f00))
4220 rc = rsp.rsp0;
4221 }
4222 } else {
4223
4224 if ( (status = PC4500_accessrid(ai, rid, CMD_ACCESS)) != 0) {
4225 rc = status;
4226 goto done;
4227 }
4228
4229 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4230 rc = ERROR;
4231 goto done;
4232 }
4233 bap_write(ai, pBuf, len, BAP1);
4234
4235 rc = PC4500_accessrid(ai, rid, 0x100|CMD_ACCESS);
4236 }
4237done:
4238 if (lock)
4239 up(&ai->sem);
4240 return rc;
4241}
4242
4243
4244
4245static u16 transmit_allocate(struct airo_info *ai, int lenPayload, int raw)
4246{
4247 unsigned int loop = 3000;
4248 Cmd cmd;
4249 Resp rsp;
4250 u16 txFid;
4251 __le16 txControl;
4252
4253 cmd.cmd = CMD_ALLOCATETX;
4254 cmd.parm0 = lenPayload;
4255 if (down_interruptible(&ai->sem))
4256 return ERROR;
4257 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
4258 txFid = ERROR;
4259 goto done;
4260 }
4261 if ( (rsp.status & 0xFF00) != 0) {
4262 txFid = ERROR;
4263 goto done;
4264 }
4265
4266
4267
4268 while (((IN4500(ai, EVSTAT) & EV_ALLOC) == 0) && --loop);
4269 if (!loop) {
4270 txFid = ERROR;
4271 goto done;
4272 }
4273
4274
4275 txFid = IN4500(ai, TXALLOCFID);
4276 OUT4500(ai, EVACK, EV_ALLOC);
4277
4278
4279
4280
4281
4282
4283 if (raw)
4284 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_11
4285 | TXCTL_ETHERNET | TXCTL_NORELEASE);
4286 else
4287 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_3
4288 | TXCTL_ETHERNET | TXCTL_NORELEASE);
4289 if (bap_setup(ai, txFid, 0x0008, BAP1) != SUCCESS)
4290 txFid = ERROR;
4291 else
4292 bap_write(ai, &txControl, sizeof(txControl), BAP1);
4293
4294done:
4295 up(&ai->sem);
4296
4297 return txFid;
4298}
4299
4300
4301
4302
4303static int transmit_802_3_packet(struct airo_info *ai, int len, char *pPacket)
4304{
4305 __le16 payloadLen;
4306 Cmd cmd;
4307 Resp rsp;
4308 int miclen = 0;
4309 u16 txFid = len;
4310 MICBuffer pMic;
4311
4312 len >>= 16;
4313
4314 if (len <= ETH_ALEN * 2) {
4315 airo_print_warn(ai->dev->name, "Short packet %d", len);
4316 return ERROR;
4317 }
4318 len -= ETH_ALEN * 2;
4319
4320 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
4321 (ntohs(((__be16 *)pPacket)[6]) != 0x888E)) {
4322 if (encapsulate(ai,(etherHead *)pPacket,&pMic,len) != SUCCESS)
4323 return ERROR;
4324 miclen = sizeof(pMic);
4325 }
4326
4327
4328 if (bap_setup(ai, txFid, 0x0036, BAP1) != SUCCESS) return ERROR;
4329
4330
4331 payloadLen = cpu_to_le16(len + miclen);
4332 bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4333 bap_write(ai, (__le16*)pPacket, sizeof(etherHead), BAP1);
4334 if (miclen)
4335 bap_write(ai, (__le16*)&pMic, miclen, BAP1);
4336 bap_write(ai, (__le16*)(pPacket + sizeof(etherHead)), len, BAP1);
4337
4338 memset( &cmd, 0, sizeof( cmd ) );
4339 cmd.cmd = CMD_TRANSMIT;
4340 cmd.parm0 = txFid;
4341 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4342 if ( (rsp.status & 0xFF00) != 0) return ERROR;
4343 return SUCCESS;
4344}
4345
4346static int transmit_802_11_packet(struct airo_info *ai, int len, char *pPacket)
4347{
4348 __le16 fc, payloadLen;
4349 Cmd cmd;
4350 Resp rsp;
4351 int hdrlen;
4352 static u8 tail[(30-10) + 2 + 6] = {[30-10] = 6};
4353
4354 u16 txFid = len;
4355 len >>= 16;
4356
4357 fc = *(__le16*)pPacket;
4358 hdrlen = header_len(fc);
4359
4360 if (len < hdrlen) {
4361 airo_print_warn(ai->dev->name, "Short packet %d", len);
4362 return ERROR;
4363 }
4364
4365
4366
4367 if (bap_setup(ai, txFid, 6, BAP1) != SUCCESS) return ERROR;
4368
4369
4370 payloadLen = cpu_to_le16(len-hdrlen);
4371 bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4372 if (bap_setup(ai, txFid, 0x0014, BAP1) != SUCCESS) return ERROR;
4373 bap_write(ai, (__le16 *)pPacket, hdrlen, BAP1);
4374 bap_write(ai, (__le16 *)(tail + (hdrlen - 10)), 38 - hdrlen, BAP1);
4375
4376 bap_write(ai, (__le16 *)(pPacket + hdrlen), len - hdrlen, BAP1);
4377
4378 memset( &cmd, 0, sizeof( cmd ) );
4379 cmd.cmd = CMD_TRANSMIT;
4380 cmd.parm0 = txFid;
4381 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4382 if ( (rsp.status & 0xFF00) != 0) return ERROR;
4383 return SUCCESS;
4384}
4385
4386
4387
4388
4389
4390
4391static ssize_t proc_read( struct file *file,
4392 char __user *buffer,
4393 size_t len,
4394 loff_t *offset);
4395
4396static ssize_t proc_write( struct file *file,
4397 const char __user *buffer,
4398 size_t len,
4399 loff_t *offset );
4400static int proc_close( struct inode *inode, struct file *file );
4401
4402static int proc_stats_open( struct inode *inode, struct file *file );
4403static int proc_statsdelta_open( struct inode *inode, struct file *file );
4404static int proc_status_open( struct inode *inode, struct file *file );
4405static int proc_SSID_open( struct inode *inode, struct file *file );
4406static int proc_APList_open( struct inode *inode, struct file *file );
4407static int proc_BSSList_open( struct inode *inode, struct file *file );
4408static int proc_config_open( struct inode *inode, struct file *file );
4409static int proc_wepkey_open( struct inode *inode, struct file *file );
4410
4411static const struct file_operations proc_statsdelta_ops = {
4412 .owner = THIS_MODULE,
4413 .read = proc_read,
4414 .open = proc_statsdelta_open,
4415 .release = proc_close
4416};
4417
4418static const struct file_operations proc_stats_ops = {
4419 .owner = THIS_MODULE,
4420 .read = proc_read,
4421 .open = proc_stats_open,
4422 .release = proc_close
4423};
4424
4425static const struct file_operations proc_status_ops = {
4426 .owner = THIS_MODULE,
4427 .read = proc_read,
4428 .open = proc_status_open,
4429 .release = proc_close
4430};
4431
4432static const struct file_operations proc_SSID_ops = {
4433 .owner = THIS_MODULE,
4434 .read = proc_read,
4435 .write = proc_write,
4436 .open = proc_SSID_open,
4437 .release = proc_close
4438};
4439
4440static const struct file_operations proc_BSSList_ops = {
4441 .owner = THIS_MODULE,
4442 .read = proc_read,
4443 .write = proc_write,
4444 .open = proc_BSSList_open,
4445 .release = proc_close
4446};
4447
4448static const struct file_operations proc_APList_ops = {
4449 .owner = THIS_MODULE,
4450 .read = proc_read,
4451 .write = proc_write,
4452 .open = proc_APList_open,
4453 .release = proc_close
4454};
4455
4456static const struct file_operations proc_config_ops = {
4457 .owner = THIS_MODULE,
4458 .read = proc_read,
4459 .write = proc_write,
4460 .open = proc_config_open,
4461 .release = proc_close
4462};
4463
4464static const struct file_operations proc_wepkey_ops = {
4465 .owner = THIS_MODULE,
4466 .read = proc_read,
4467 .write = proc_write,
4468 .open = proc_wepkey_open,
4469 .release = proc_close
4470};
4471
4472static struct proc_dir_entry *airo_entry;
4473
4474struct proc_data {
4475 int release_buffer;
4476 int readlen;
4477 char *rbuffer;
4478 int writelen;
4479 int maxwritelen;
4480 char *wbuffer;
4481 void (*on_close) (struct inode *, struct file *);
4482};
4483
4484static int setup_proc_entry( struct net_device *dev,
4485 struct airo_info *apriv ) {
4486 struct proc_dir_entry *entry;
4487
4488 strcpy(apriv->proc_name,dev->name);
4489 apriv->proc_entry = create_proc_entry(apriv->proc_name,
4490 S_IFDIR|airo_perm,
4491 airo_entry);
4492 if (!apriv->proc_entry)
4493 goto fail;
4494 apriv->proc_entry->uid = proc_uid;
4495 apriv->proc_entry->gid = proc_gid;
4496
4497
4498 entry = proc_create_data("StatsDelta",
4499 S_IFREG | (S_IRUGO&proc_perm),
4500 apriv->proc_entry, &proc_statsdelta_ops, dev);
4501 if (!entry)
4502 goto fail_stats_delta;
4503 entry->uid = proc_uid;
4504 entry->gid = proc_gid;
4505
4506
4507 entry = proc_create_data("Stats",
4508 S_IFREG | (S_IRUGO&proc_perm),
4509 apriv->proc_entry, &proc_stats_ops, dev);
4510 if (!entry)
4511 goto fail_stats;
4512 entry->uid = proc_uid;
4513 entry->gid = proc_gid;
4514
4515
4516 entry = proc_create_data("Status",
4517 S_IFREG | (S_IRUGO&proc_perm),
4518 apriv->proc_entry, &proc_status_ops, dev);
4519 if (!entry)
4520 goto fail_status;
4521 entry->uid = proc_uid;
4522 entry->gid = proc_gid;
4523
4524
4525 entry = proc_create_data("Config",
4526 S_IFREG | proc_perm,
4527 apriv->proc_entry, &proc_config_ops, dev);
4528 if (!entry)
4529 goto fail_config;
4530 entry->uid = proc_uid;
4531 entry->gid = proc_gid;
4532
4533
4534 entry = proc_create_data("SSID",
4535 S_IFREG | proc_perm,
4536 apriv->proc_entry, &proc_SSID_ops, dev);
4537 if (!entry)
4538 goto fail_ssid;
4539 entry->uid = proc_uid;
4540 entry->gid = proc_gid;
4541
4542
4543 entry = proc_create_data("APList",
4544 S_IFREG | proc_perm,
4545 apriv->proc_entry, &proc_APList_ops, dev);
4546 if (!entry)
4547 goto fail_aplist;
4548 entry->uid = proc_uid;
4549 entry->gid = proc_gid;
4550
4551
4552 entry = proc_create_data("BSSList",
4553 S_IFREG | proc_perm,
4554 apriv->proc_entry, &proc_BSSList_ops, dev);
4555 if (!entry)
4556 goto fail_bsslist;
4557 entry->uid = proc_uid;
4558 entry->gid = proc_gid;
4559
4560
4561 entry = proc_create_data("WepKey",
4562 S_IFREG | proc_perm,
4563 apriv->proc_entry, &proc_wepkey_ops, dev);
4564 if (!entry)
4565 goto fail_wepkey;
4566 entry->uid = proc_uid;
4567 entry->gid = proc_gid;
4568
4569 return 0;
4570
4571fail_wepkey:
4572 remove_proc_entry("BSSList", apriv->proc_entry);
4573fail_bsslist:
4574 remove_proc_entry("APList", apriv->proc_entry);
4575fail_aplist:
4576 remove_proc_entry("SSID", apriv->proc_entry);
4577fail_ssid:
4578 remove_proc_entry("Config", apriv->proc_entry);
4579fail_config:
4580 remove_proc_entry("Status", apriv->proc_entry);
4581fail_status:
4582 remove_proc_entry("Stats", apriv->proc_entry);
4583fail_stats:
4584 remove_proc_entry("StatsDelta", apriv->proc_entry);
4585fail_stats_delta:
4586 remove_proc_entry(apriv->proc_name, airo_entry);
4587fail:
4588 return -ENOMEM;
4589}
4590
4591static int takedown_proc_entry( struct net_device *dev,
4592 struct airo_info *apriv ) {
4593 if ( !apriv->proc_entry->namelen ) return 0;
4594 remove_proc_entry("Stats",apriv->proc_entry);
4595 remove_proc_entry("StatsDelta",apriv->proc_entry);
4596 remove_proc_entry("Status",apriv->proc_entry);
4597 remove_proc_entry("Config",apriv->proc_entry);
4598 remove_proc_entry("SSID",apriv->proc_entry);
4599 remove_proc_entry("APList",apriv->proc_entry);
4600 remove_proc_entry("BSSList",apriv->proc_entry);
4601 remove_proc_entry("WepKey",apriv->proc_entry);
4602 remove_proc_entry(apriv->proc_name,airo_entry);
4603 return 0;
4604}
4605
4606
4607
4608
4609
4610
4611
4612
4613
4614
4615
4616
4617
4618static ssize_t proc_read( struct file *file,
4619 char __user *buffer,
4620 size_t len,
4621 loff_t *offset )
4622{
4623 struct proc_data *priv = file->private_data;
4624
4625 if (!priv->rbuffer)
4626 return -EINVAL;
4627
4628 return simple_read_from_buffer(buffer, len, offset, priv->rbuffer,
4629 priv->readlen);
4630}
4631
4632
4633
4634
4635
4636static ssize_t proc_write( struct file *file,
4637 const char __user *buffer,
4638 size_t len,
4639 loff_t *offset )
4640{
4641 loff_t pos = *offset;
4642 struct proc_data *priv = (struct proc_data*)file->private_data;
4643
4644 if (!priv->wbuffer)
4645 return -EINVAL;
4646
4647 if (pos < 0)
4648 return -EINVAL;
4649 if (pos >= priv->maxwritelen)
4650 return 0;
4651 if (len > priv->maxwritelen - pos)
4652 len = priv->maxwritelen - pos;
4653 if (copy_from_user(priv->wbuffer + pos, buffer, len))
4654 return -EFAULT;
4655 if ( pos + len > priv->writelen )
4656 priv->writelen = len + file->f_pos;
4657 *offset = pos + len;
4658 return len;
4659}
4660
4661static int proc_status_open(struct inode *inode, struct file *file)
4662{
4663 struct proc_data *data;
4664 struct proc_dir_entry *dp = PDE(inode);
4665 struct net_device *dev = dp->data;
4666 struct airo_info *apriv = dev->ml_priv;
4667 CapabilityRid cap_rid;
4668 StatusRid status_rid;
4669 u16 mode;
4670 int i;
4671
4672 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4673 return -ENOMEM;
4674 data = (struct proc_data *)file->private_data;
4675 if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4676 kfree (file->private_data);
4677 return -ENOMEM;
4678 }
4679
4680 readStatusRid(apriv, &status_rid, 1);
4681 readCapabilityRid(apriv, &cap_rid, 1);
4682
4683 mode = le16_to_cpu(status_rid.mode);
4684
4685 i = sprintf(data->rbuffer, "Status: %s%s%s%s%s%s%s%s%s\n",
4686 mode & 1 ? "CFG ": "",
4687 mode & 2 ? "ACT ": "",
4688 mode & 0x10 ? "SYN ": "",
4689 mode & 0x20 ? "LNK ": "",
4690 mode & 0x40 ? "LEAP ": "",
4691 mode & 0x80 ? "PRIV ": "",
4692 mode & 0x100 ? "KEY ": "",
4693 mode & 0x200 ? "WEP ": "",
4694 mode & 0x8000 ? "ERR ": "");
4695 sprintf( data->rbuffer+i, "Mode: %x\n"
4696 "Signal Strength: %d\n"
4697 "Signal Quality: %d\n"
4698 "SSID: %-.*s\n"
4699 "AP: %-.16s\n"
4700 "Freq: %d\n"
4701 "BitRate: %dmbs\n"
4702 "Driver Version: %s\n"
4703 "Device: %s\nManufacturer: %s\nFirmware Version: %s\n"
4704 "Radio type: %x\nCountry: %x\nHardware Version: %x\n"
4705 "Software Version: %x\nSoftware Subversion: %x\n"
4706 "Boot block version: %x\n",
4707 le16_to_cpu(status_rid.mode),
4708 le16_to_cpu(status_rid.normalizedSignalStrength),
4709 le16_to_cpu(status_rid.signalQuality),
4710 le16_to_cpu(status_rid.SSIDlen),
4711 status_rid.SSID,
4712 status_rid.apName,
4713 le16_to_cpu(status_rid.channel),
4714 le16_to_cpu(status_rid.currentXmitRate) / 2,
4715 version,
4716 cap_rid.prodName,
4717 cap_rid.manName,
4718 cap_rid.prodVer,
4719 le16_to_cpu(cap_rid.radioType),
4720 le16_to_cpu(cap_rid.country),
4721 le16_to_cpu(cap_rid.hardVer),
4722 le16_to_cpu(cap_rid.softVer),
4723 le16_to_cpu(cap_rid.softSubVer),
4724 le16_to_cpu(cap_rid.bootBlockVer));
4725 data->readlen = strlen( data->rbuffer );
4726 return 0;
4727}
4728
4729static int proc_stats_rid_open(struct inode*, struct file*, u16);
4730static int proc_statsdelta_open( struct inode *inode,
4731 struct file *file ) {
4732 if (file->f_mode&FMODE_WRITE) {
4733 return proc_stats_rid_open(inode, file, RID_STATSDELTACLEAR);
4734 }
4735 return proc_stats_rid_open(inode, file, RID_STATSDELTA);
4736}
4737
4738static int proc_stats_open( struct inode *inode, struct file *file ) {
4739 return proc_stats_rid_open(inode, file, RID_STATS);
4740}
4741
4742static int proc_stats_rid_open( struct inode *inode,
4743 struct file *file,
4744 u16 rid )
4745{
4746 struct proc_data *data;
4747 struct proc_dir_entry *dp = PDE(inode);
4748 struct net_device *dev = dp->data;
4749 struct airo_info *apriv = dev->ml_priv;
4750 StatsRid stats;
4751 int i, j;
4752 __le32 *vals = stats.vals;
4753 int len;
4754
4755 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
4756 return -ENOMEM;
4757 data = (struct proc_data *)file->private_data;
4758 if ((data->rbuffer = kmalloc( 4096, GFP_KERNEL )) == NULL) {
4759 kfree (file->private_data);
4760 return -ENOMEM;
4761 }
4762
4763 readStatsRid(apriv, &stats, rid, 1);
4764 len = le16_to_cpu(stats.len);
4765
4766 j = 0;
4767 for(i=0; statsLabels[i]!=(char *)-1 && i*4<len; i++) {
4768 if (!statsLabels[i]) continue;
4769 if (j+strlen(statsLabels[i])+16>4096) {
4770 airo_print_warn(apriv->dev->name,
4771 "Potentially disasterous buffer overflow averted!");
4772 break;
4773 }
4774 j+=sprintf(data->rbuffer+j, "%s: %u\n", statsLabels[i],
4775 le32_to_cpu(vals[i]));
4776 }
4777 if (i*4 >= len) {
4778 airo_print_warn(apriv->dev->name, "Got a short rid");
4779 }
4780 data->readlen = j;
4781 return 0;
4782}
4783
4784static int get_dec_u16( char *buffer, int *start, int limit ) {
4785 u16 value;
4786 int valid = 0;
4787 for( value = 0; buffer[*start] >= '0' &&
4788 buffer[*start] <= '9' &&
4789 *start < limit; (*start)++ ) {
4790 valid = 1;
4791 value *= 10;
4792 value += buffer[*start] - '0';
4793 }
4794 if ( !valid ) return -1;
4795 return value;
4796}
4797
4798static int airo_config_commit(struct net_device *dev,
4799 struct iw_request_info *info, void *zwrq,
4800 char *extra);
4801
4802static inline int sniffing_mode(struct airo_info *ai)
4803{
4804 return le16_to_cpu(ai->config.rmode & RXMODE_MASK) >=
4805 le16_to_cpu(RXMODE_RFMON);
4806}
4807
4808static void proc_config_on_close(struct inode *inode, struct file *file)
4809{
4810 struct proc_data *data = file->private_data;
4811 struct proc_dir_entry *dp = PDE(inode);
4812 struct net_device *dev = dp->data;
4813 struct airo_info *ai = dev->ml_priv;
4814 char *line;
4815
4816 if ( !data->writelen ) return;
4817
4818 readConfigRid(ai, 1);
4819 set_bit (FLAG_COMMIT, &ai->flags);
4820
4821 line = data->wbuffer;
4822 while( line[0] ) {
4823
4824 if ( !strncmp( line, "Mode: ", 6 ) ) {
4825 line += 6;
4826 if (sniffing_mode(ai))
4827 set_bit (FLAG_RESET, &ai->flags);
4828 ai->config.rmode &= ~RXMODE_FULL_MASK;
4829 clear_bit (FLAG_802_11, &ai->flags);
4830 ai->config.opmode &= ~MODE_CFG_MASK;
4831 ai->config.scanMode = SCANMODE_ACTIVE;
4832 if ( line[0] == 'a' ) {
4833 ai->config.opmode |= MODE_STA_IBSS;
4834 } else {
4835 ai->config.opmode |= MODE_STA_ESS;
4836 if ( line[0] == 'r' ) {
4837 ai->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
4838 ai->config.scanMode = SCANMODE_PASSIVE;
4839 set_bit (FLAG_802_11, &ai->flags);
4840 } else if ( line[0] == 'y' ) {
4841 ai->config.rmode |= RXMODE_RFMON_ANYBSS | RXMODE_DISABLE_802_3_HEADER;
4842 ai->config.scanMode = SCANMODE_PASSIVE;
4843 set_bit (FLAG_802_11, &ai->flags);
4844 } else if ( line[0] == 'l' )
4845 ai->config.rmode |= RXMODE_LANMON;
4846 }
4847 set_bit (FLAG_COMMIT, &ai->flags);
4848 }
4849
4850
4851 else if (!strncmp(line,"Radio: ", 7)) {
4852 line += 7;
4853 if (!strncmp(line,"off",3)) {
4854 set_bit (FLAG_RADIO_OFF, &ai->flags);
4855 } else {
4856 clear_bit (FLAG_RADIO_OFF, &ai->flags);
4857 }
4858 }
4859
4860 else if ( !strncmp( line, "NodeName: ", 10 ) ) {
4861 int j;
4862
4863 line += 10;
4864 memset( ai->config.nodeName, 0, 16 );
4865
4866 for( j = 0; j < 16 && line[j] != '\n'; j++ ) {
4867 ai->config.nodeName[j] = line[j];
4868 }
4869 set_bit (FLAG_COMMIT, &ai->flags);
4870 }
4871
4872
4873 else if ( !strncmp( line, "PowerMode: ", 11 ) ) {
4874 line += 11;
4875 if ( !strncmp( line, "PSPCAM", 6 ) ) {
4876 ai->config.powerSaveMode = POWERSAVE_PSPCAM;
4877 set_bit (FLAG_COMMIT, &ai->flags);
4878 } else if ( !strncmp( line, "PSP", 3 ) ) {
4879 ai->config.powerSaveMode = POWERSAVE_PSP;
4880 set_bit (FLAG_COMMIT, &ai->flags);
4881 } else {
4882 ai->config.powerSaveMode = POWERSAVE_CAM;
4883 set_bit (FLAG_COMMIT, &ai->flags);
4884 }
4885 } else if ( !strncmp( line, "DataRates: ", 11 ) ) {
4886 int v, i = 0, k = 0;
4887
4888
4889 line += 11;
4890 while((v = get_dec_u16(line, &i, 3))!=-1) {
4891 ai->config.rates[k++] = (u8)v;
4892 line += i + 1;
4893 i = 0;
4894 }
4895 set_bit (FLAG_COMMIT, &ai->flags);
4896 } else if ( !strncmp( line, "Channel: ", 9 ) ) {
4897 int v, i = 0;
4898 line += 9;
4899 v = get_dec_u16(line, &i, i+3);
4900 if ( v != -1 ) {
4901 ai->config.channelSet = cpu_to_le16(v);
4902 set_bit (FLAG_COMMIT, &ai->flags);
4903 }
4904 } else if ( !strncmp( line, "XmitPower: ", 11 ) ) {
4905 int v, i = 0;
4906 line += 11;
4907 v = get_dec_u16(line, &i, i+3);
4908 if ( v != -1 ) {
4909 ai->config.txPower = cpu_to_le16(v);
4910 set_bit (FLAG_COMMIT, &ai->flags);
4911 }
4912 } else if ( !strncmp( line, "WEP: ", 5 ) ) {
4913 line += 5;
4914 switch( line[0] ) {
4915 case 's':
4916 ai->config.authType = AUTH_SHAREDKEY;
4917 break;
4918 case 'e':
4919 ai->config.authType = AUTH_ENCRYPT;
4920 break;
4921 default:
4922 ai->config.authType = AUTH_OPEN;
4923 break;
4924 }
4925 set_bit (FLAG_COMMIT, &ai->flags);
4926 } else if ( !strncmp( line, "LongRetryLimit: ", 16 ) ) {
4927 int v, i = 0;
4928
4929 line += 16;
4930 v = get_dec_u16(line, &i, 3);
4931 v = (v<0) ? 0 : ((v>255) ? 255 : v);
4932 ai->config.longRetryLimit = cpu_to_le16(v);
4933 set_bit (FLAG_COMMIT, &ai->flags);
4934 } else if ( !strncmp( line, "ShortRetryLimit: ", 17 ) ) {
4935 int v, i = 0;
4936
4937 line += 17;
4938 v = get_dec_u16(line, &i, 3);
4939 v = (v<0) ? 0 : ((v>255) ? 255 : v);
4940 ai->config.shortRetryLimit = cpu_to_le16(v);
4941 set_bit (FLAG_COMMIT, &ai->flags);
4942 } else if ( !strncmp( line, "RTSThreshold: ", 14 ) ) {
4943 int v, i = 0;
4944
4945 line += 14;
4946 v = get_dec_u16(line, &i, 4);
4947 v = (v<0) ? 0 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4948 ai->config.rtsThres = cpu_to_le16(v);
4949 set_bit (FLAG_COMMIT, &ai->flags);
4950 } else if ( !strncmp( line, "TXMSDULifetime: ", 16 ) ) {
4951 int v, i = 0;
4952
4953 line += 16;
4954 v = get_dec_u16(line, &i, 5);
4955 v = (v<0) ? 0 : v;
4956 ai->config.txLifetime = cpu_to_le16(v);
4957 set_bit (FLAG_COMMIT, &ai->flags);
4958 } else if ( !strncmp( line, "RXMSDULifetime: ", 16 ) ) {
4959 int v, i = 0;
4960
4961 line += 16;
4962 v = get_dec_u16(line, &i, 5);
4963 v = (v<0) ? 0 : v;
4964 ai->config.rxLifetime = cpu_to_le16(v);
4965 set_bit (FLAG_COMMIT, &ai->flags);
4966 } else if ( !strncmp( line, "TXDiversity: ", 13 ) ) {
4967 ai->config.txDiversity =
4968 (line[13]=='l') ? 1 :
4969 ((line[13]=='r')? 2: 3);
4970 set_bit (FLAG_COMMIT, &ai->flags);
4971 } else if ( !strncmp( line, "RXDiversity: ", 13 ) ) {
4972 ai->config.rxDiversity =
4973 (line[13]=='l') ? 1 :
4974 ((line[13]=='r')? 2: 3);
4975 set_bit (FLAG_COMMIT, &ai->flags);
4976 } else if ( !strncmp( line, "FragThreshold: ", 15 ) ) {
4977 int v, i = 0;
4978
4979 line += 15;
4980 v = get_dec_u16(line, &i, 4);
4981 v = (v<256) ? 256 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
4982 v = v & 0xfffe;
4983 ai->config.fragThresh = cpu_to_le16(v);
4984 set_bit (FLAG_COMMIT, &ai->flags);
4985 } else if (!strncmp(line, "Modulation: ", 12)) {
4986 line += 12;
4987 switch(*line) {
4988 case 'd': ai->config.modulation=MOD_DEFAULT; set_bit(FLAG_COMMIT, &ai->flags); break;
4989 case 'c': ai->config.modulation=MOD_CCK; set_bit(FLAG_COMMIT, &ai->flags); break;
4990 case 'm': ai->config.modulation=MOD_MOK; set_bit(FLAG_COMMIT, &ai->flags); break;
4991 default: airo_print_warn(ai->dev->name, "Unknown modulation");
4992 }
4993 } else if (!strncmp(line, "Preamble: ", 10)) {
4994 line += 10;
4995 switch(*line) {
4996 case 'a': ai->config.preamble=PREAMBLE_AUTO; set_bit(FLAG_COMMIT, &ai->flags); break;
4997 case 'l': ai->config.preamble=PREAMBLE_LONG; set_bit(FLAG_COMMIT, &ai->flags); break;
4998 case 's': ai->config.preamble=PREAMBLE_SHORT; set_bit(FLAG_COMMIT, &ai->flags); break;
4999 default: airo_print_warn(ai->dev->name, "Unknown preamble");
5000 }
5001 } else {
5002 airo_print_warn(ai->dev->name, "Couldn't figure out %s", line);
5003 }
5004 while( line[0] && line[0] != '\n' ) line++;
5005 if ( line[0] ) line++;
5006 }
5007 airo_config_commit(dev, NULL, NULL, NULL);
5008}
5009
5010static char *get_rmode(__le16 mode)
5011{
5012 switch(mode & RXMODE_MASK) {
5013 case RXMODE_RFMON: return "rfmon";
5014 case RXMODE_RFMON_ANYBSS: return "yna (any) bss rfmon";
5015 case RXMODE_LANMON: return "lanmon";
5016 }
5017 return "ESS";
5018}
5019
5020static int proc_config_open(struct inode *inode, struct file *file)
5021{
5022 struct proc_data *data;
5023 struct proc_dir_entry *dp = PDE(inode);
5024 struct net_device *dev = dp->data;
5025 struct airo_info *ai = dev->ml_priv;
5026 int i;
5027 __le16 mode;
5028
5029 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
5030 return -ENOMEM;
5031 data = (struct proc_data *)file->private_data;