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