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