blob: f5e2dca083cbe5e574bcae3d330643628aa358f1 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*======================================================================
2
3 Aironet driver for 4500 and 4800 series cards
4
5 This code is released under both the GPL version 2 and BSD licenses.
6 Either license may be used. The respective licenses are found at
7 the end of this file.
8
9 This code was developed by Benjamin Reed <breed@users.sourceforge.net>
10 including portions of which come from the Aironet PC4500
11 Developer's Reference Manual and used with permission. Copyright
12 (C) 1999 Benjamin Reed. All Rights Reserved. Permission to use
13 code in the Developer's manual was granted for this driver by
14 Aironet. Major code contributions were received from Javier Achirica
15 <achirica@users.sourceforge.net> and Jean Tourrilhes <jt@hpl.hp.com>.
16 Code was also integrated from the Cisco Aironet driver for Linux.
17 Support for MPI350 cards was added by Fabrice Bellet
18 <fabrice@bellet.info>.
19
20======================================================================*/
21
Herbert Xuf12cc202006-08-22 20:36:13 +100022#include <linux/err.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <linux/init.h>
24
25#include <linux/kernel.h>
26#include <linux/module.h>
27#include <linux/proc_fs.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070028
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>
David Hardeman378f0582005-09-17 17:55:31 +100037#include <linux/scatterlist.h>
Adrian Bunka39d3e72006-01-21 01:35:15 +010038#include <linux/crypto.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070039#include <asm/io.h>
40#include <asm/system.h>
Al Viro593c2b92007-12-17 15:09:34 -050041#include <asm/unaligned.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
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>
Sukadev Bhattiprolu3b4c7d642006-08-14 23:12:03 -070050#include <linux/kthread.h>
Nigel Cunningham7dfb7102006-12-06 20:34:23 -080051#include <linux/freezer.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070052
Johannes Berg2c7060022008-10-30 22:09:54 +010053#include <linux/ieee80211.h>
54
Adrian Bunkd3808762005-11-05 17:42:27 +010055#include "airo.h"
56
Michal Schmidt1138c372007-06-29 15:33:41 +020057#define DRV_NAME "airo"
58
Linus Torvalds1da177e2005-04-16 15:20:36 -070059#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 *);
Pavel Machek05adc3b2005-04-16 15:25:25 -070074static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state);
Linus Torvalds1da177e2005-04-16 15:20:36 -070075static int airo_pci_resume(struct pci_dev *pdev);
76
77static struct pci_driver airo_driver = {
Michal Schmidt1138c372007-06-29 15:33:41 +020078 .name = DRV_NAME,
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 .id_table = card_ids,
80 .probe = airo_pci_probe,
81 .remove = __devexit_p(airo_pci_remove),
82 .suspend = airo_pci_suspend,
83 .resume = airo_pci_resume,
84};
85#endif /* CONFIG_PCI */
86
87/* Include Wireless Extension definition and check version - Jean II */
88#include <linux/wireless.h>
Pavel Macheke292c732008-06-25 12:25:53 +020089#define WIRELESS_SPY /* enable iwspy support */
90#include <net/iw_handler.h> /* New driver API */
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
Pavel Macheke292c732008-06-25 12:25:53 +020092#define CISCO_EXT /* enable Cisco extensions */
Linus Torvalds1da177e2005-04-16 15:20:36 -070093#ifdef CISCO_EXT
94#include <linux/delay.h>
95#endif
96
Linus Torvalds1da177e2005-04-16 15:20:36 -070097/* Hack to do some power saving */
98#define POWER_ON_DOWN
99
100/* As you can see this list is HUGH!
101 I really don't know what a lot of these counts are about, but they
102 are all here for completeness. If the IGNLABEL macro is put in
103 infront of the label, that statistic will not be included in the list
104 of statistics in the /proc filesystem */
105
106#define IGNLABEL(comment) NULL
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/* These variables are for insmod, since it seems that the rates
215 can only be set in setup_card. Rates should be a comma separated
216 (no spaces) list of rates (up to 8). */
217
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 /* = 0 */; /* The highest rate that the card can encrypt at.
227 0 means no limit. For old cards this was 4 */
228
229static int auto_wep /* = 0 */; /* If set, it tries to figure out the wep mode */
230static int aux_bap /* = 0 */; /* Checks to see if the aux ports are needed to read
231 the bap, needed on some older cards and buses. */
232static int adhoc;
233
234static int probe = 1;
235
236static int proc_uid /* = 0 */;
237
238static int proc_gid /* = 0 */;
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 \
Bill Nottinghamd73ae552007-07-27 19:43:17 -0400246cards. Direct support for ISA/PCI/MPI cards and support \
247for PCMCIA when used with airo_cs.");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248MODULE_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/* This is a kind of sloppy hack to get this information to OUT4500 and
283 IN4500. I would be extremely interested in the situation where this
284 doesn't work though!!! */
Pavel Macheke292c732008-06-25 12:25:53 +0200285static int do8bitIO /* = 0 */;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700286
287/* Return codes */
288#define SUCCESS 0
289#define ERROR -1
290#define NO_PACKET -2
291
292/* Commands */
293#define NOP2 0x0000
294#define MAC_ENABLE 0x0001
295#define MAC_DISABLE 0x0002
296#define CMD_LOSE_SYNC 0x0003 /* Not sure what this does... */
297#define CMD_SOFTRESET 0x0004
298#define HOSTSLEEP 0x0005
299#define CMD_MAGIC_PKT 0x0006
300#define CMD_SETWAKEMASK 0x0007
301#define CMD_READCFG 0x0008
302#define CMD_SETMODE 0x0009
303#define CMD_ALLOCATETX 0x000a
304#define CMD_TRANSMIT 0x000b
305#define CMD_DEALLOCATETX 0x000c
306#define NOP 0x0010
307#define CMD_WORKAROUND 0x0011
308#define CMD_ALLOCATEAUX 0x0020
309#define CMD_ACCESS 0x0021
310#define CMD_PCIBAP 0x0022
311#define CMD_PCIAUX 0x0023
312#define CMD_ALLOCBUF 0x0028
313#define CMD_GETTLV 0x0029
314#define CMD_PUTTLV 0x002a
315#define CMD_DELTLV 0x002b
316#define CMD_FINDNEXTTLV 0x002c
317#define CMD_PSPNODES 0x0030
318#define CMD_SETCW 0x0031
319#define CMD_SETPCF 0x0032
320#define CMD_SETPHYREG 0x003e
321#define CMD_TXTEST 0x003f
322#define MAC_ENABLETX 0x0101
323#define CMD_LISTBSS 0x0103
324#define CMD_SAVECFG 0x0108
325#define CMD_ENABLEAUX 0x0111
326#define CMD_WRITERID 0x0121
327#define CMD_USEPSPNODES 0x0130
328#define MAC_ENABLERX 0x0201
329
330/* Command errors */
331#define ERROR_QUALIF 0x00
332#define ERROR_ILLCMD 0x01
333#define ERROR_ILLFMT 0x02
334#define ERROR_INVFID 0x03
335#define ERROR_INVRID 0x04
336#define ERROR_LARGE 0x05
337#define ERROR_NDISABL 0x06
338#define ERROR_ALLOCBSY 0x07
339#define ERROR_NORD 0x0B
340#define ERROR_NOWR 0x0C
341#define ERROR_INVFIDTX 0x0D
342#define ERROR_TESTACT 0x0E
343#define ERROR_TAGNFND 0x12
344#define ERROR_DECODE 0x20
345#define ERROR_DESCUNAV 0x21
346#define ERROR_BADLEN 0x22
347#define ERROR_MODE 0x80
348#define ERROR_HOP 0x81
349#define ERROR_BINTER 0x82
350#define ERROR_RXMODE 0x83
351#define ERROR_MACADDR 0x84
352#define ERROR_RATES 0x85
353#define ERROR_ORDER 0x86
354#define ERROR_SCAN 0x87
355#define ERROR_AUTH 0x88
356#define ERROR_PSMODE 0x89
357#define ERROR_RTYPE 0x8A
358#define ERROR_DIVER 0x8B
359#define ERROR_SSID 0x8C
360#define ERROR_APLIST 0x8D
361#define ERROR_AUTOWAKE 0x8E
362#define ERROR_LEAP 0x8F
363
364/* Registers */
365#define COMMAND 0x00
366#define PARAM0 0x02
367#define PARAM1 0x04
368#define PARAM2 0x06
369#define STATUS 0x08
370#define RESP0 0x0a
371#define RESP1 0x0c
372#define RESP2 0x0e
373#define LINKSTAT 0x10
374#define SELECT0 0x18
375#define OFFSET0 0x1c
376#define RXFID 0x20
377#define TXALLOCFID 0x22
378#define TXCOMPLFID 0x24
379#define DATA0 0x36
380#define EVSTAT 0x30
381#define EVINTEN 0x32
382#define EVACK 0x34
383#define SWS0 0x28
384#define SWS1 0x2a
385#define SWS2 0x2c
386#define SWS3 0x2e
387#define AUXPAGE 0x3A
388#define AUXOFF 0x3C
389#define AUXDATA 0x3E
390
391#define FID_TX 1
392#define FID_RX 2
393/* Offset into aux memory for descriptors */
394#define AUX_OFFSET 0x800
395/* Size of allocated packets */
396#define PKTSIZE 1840
397#define RIDSIZE 2048
398/* Size of the transmit queue */
399#define MAXTXQ 64
400
401/* BAP selectors */
Pavel Macheke292c732008-06-25 12:25:53 +0200402#define BAP0 0 /* Used for receiving packets */
403#define BAP1 2 /* Used for xmiting packets and working with RIDS */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404
405/* Flags */
406#define COMMAND_BUSY 0x8000
407
408#define BAP_BUSY 0x8000
409#define BAP_ERR 0x4000
410#define BAP_DONE 0x2000
411
412#define PROMISC 0xffff
413#define NOPROMISC 0x0000
414
415#define EV_CMD 0x10
416#define EV_CLEARCOMMANDBUSY 0x4000
417#define EV_RX 0x01
418#define EV_TX 0x02
419#define EV_TXEXC 0x04
420#define EV_ALLOC 0x08
421#define EV_LINK 0x80
422#define EV_AWAKE 0x100
423#define EV_TXCPY 0x400
424#define EV_UNKNOWN 0x800
425#define EV_MIC 0x1000 /* Message Integrity Check Interrupt */
426#define EV_AWAKEN 0x2000
427#define STATUS_INTS (EV_AWAKE|EV_LINK|EV_TXEXC|EV_TX|EV_TXCPY|EV_RX|EV_MIC)
428
429#ifdef CHECK_UNKNOWN_INTS
430#define IGNORE_INTS ( EV_CMD | EV_UNKNOWN)
431#else
432#define IGNORE_INTS (~STATUS_INTS)
433#endif
434
435/* RID TYPES */
436#define RID_RW 0x20
437
438/* The RIDs */
439#define RID_CAPABILITIES 0xFF00
440#define RID_APINFO 0xFF01
441#define RID_RADIOINFO 0xFF02
442#define RID_UNKNOWN3 0xFF03
443#define RID_RSSI 0xFF04
444#define RID_CONFIG 0xFF10
445#define RID_SSID 0xFF11
446#define RID_APLIST 0xFF12
447#define RID_DRVNAME 0xFF13
448#define RID_ETHERENCAP 0xFF14
449#define RID_WEP_TEMP 0xFF15
450#define RID_WEP_PERM 0xFF16
451#define RID_MODULATION 0xFF17
452#define RID_OPTIONS 0xFF18
453#define RID_ACTUALCONFIG 0xFF20 /*readonly*/
454#define RID_FACTORYCONFIG 0xFF21
455#define RID_UNKNOWN22 0xFF22
456#define RID_LEAPUSERNAME 0xFF23
457#define RID_LEAPPASSWORD 0xFF24
458#define RID_STATUS 0xFF50
459#define RID_BEACON_HST 0xFF51
460#define RID_BUSY_HST 0xFF52
461#define RID_RETRIES_HST 0xFF53
462#define RID_UNKNOWN54 0xFF54
463#define RID_UNKNOWN55 0xFF55
464#define RID_UNKNOWN56 0xFF56
465#define RID_MIC 0xFF57
466#define RID_STATS16 0xFF60
467#define RID_STATS16DELTA 0xFF61
468#define RID_STATS16DELTACLEAR 0xFF62
469#define RID_STATS 0xFF68
470#define RID_STATSDELTA 0xFF69
471#define RID_STATSDELTACLEAR 0xFF6A
472#define RID_ECHOTEST_RID 0xFF70
473#define RID_ECHOTEST_RESULTS 0xFF71
474#define RID_BSSLISTFIRST 0xFF72
475#define RID_BSSLISTNEXT 0xFF73
Dan Williams3c304952006-04-15 12:26:18 -0400476#define RID_WPA_BSSLISTFIRST 0xFF74
477#define RID_WPA_BSSLISTNEXT 0xFF75
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478
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 * Rids and endian-ness: The Rids will always be in cpu endian, since
495 * this all the patches from the big-endian guys end up doing that.
496 * so all rid access should use the read/writeXXXRid routines.
497 */
498
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499/* This structure came from an email sent to me from an engineer at
500 aironet for inclusion into this driver */
Dan Williams99590ff2009-01-24 09:12:58 -0500501typedef struct WepKeyRid WepKeyRid;
502struct WepKeyRid {
Al Viro4293ea32007-12-19 19:21:51 -0500503 __le16 len;
504 __le16 kindex;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 u8 mac[ETH_ALEN];
Al Viro4293ea32007-12-19 19:21:51 -0500506 __le16 klen;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 u8 key[16];
Dan Williams99590ff2009-01-24 09:12:58 -0500508} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509
510/* These structures are from the Aironet's PC4500 Developers Manual */
Dan Williams99590ff2009-01-24 09:12:58 -0500511typedef struct Ssid Ssid;
512struct Ssid {
Al Viro0dd22122007-12-17 16:11:57 -0500513 __le16 len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 u8 ssid[32];
Dan Williams99590ff2009-01-24 09:12:58 -0500515} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516
Dan Williams99590ff2009-01-24 09:12:58 -0500517typedef struct SsidRid SsidRid;
518struct SsidRid {
Al Viro0dd22122007-12-17 16:11:57 -0500519 __le16 len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 Ssid ssids[3];
Dan Williams99590ff2009-01-24 09:12:58 -0500521} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522
Dan Williams99590ff2009-01-24 09:12:58 -0500523typedef struct ModulationRid ModulationRid;
524struct ModulationRid {
Al Viro3eb9b412007-12-21 00:00:35 -0500525 __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)
Dan Williams99590ff2009-01-24 09:12:58 -0500530} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531
Dan Williams99590ff2009-01-24 09:12:58 -0500532typedef struct ConfigRid ConfigRid;
533struct ConfigRid {
Al Viro3eb9b412007-12-21 00:00:35 -0500534 __le16 len; /* sizeof(ConfigRid) */
535 __le16 opmode; /* operating mode */
536#define MODE_STA_IBSS cpu_to_le16(0)
537#define MODE_STA_ESS cpu_to_le16(1)
538#define MODE_AP cpu_to_le16(2)
539#define MODE_AP_RPTR cpu_to_le16(3)
540#define MODE_CFG_MASK cpu_to_le16(0xff)
541#define MODE_ETHERNET_HOST cpu_to_le16(0<<8) /* rx payloads converted */
542#define MODE_LLC_HOST cpu_to_le16(1<<8) /* rx payloads left as is */
543#define MODE_AIRONET_EXTEND cpu_to_le16(1<<9) /* enable Aironet extenstions */
544#define MODE_AP_INTERFACE cpu_to_le16(1<<10) /* enable ap interface extensions */
545#define MODE_ANTENNA_ALIGN cpu_to_le16(1<<11) /* enable antenna alignment */
546#define MODE_ETHER_LLC cpu_to_le16(1<<12) /* enable ethernet LLC */
547#define MODE_LEAF_NODE cpu_to_le16(1<<13) /* enable leaf node bridge */
548#define MODE_CF_POLLABLE cpu_to_le16(1<<14) /* enable CF pollable */
549#define MODE_MIC cpu_to_le16(1<<15) /* enable MIC */
550 __le16 rmode; /* receive mode */
551#define RXMODE_BC_MC_ADDR cpu_to_le16(0)
552#define RXMODE_BC_ADDR cpu_to_le16(1) /* ignore multicasts */
553#define RXMODE_ADDR cpu_to_le16(2) /* ignore multicast and broadcast */
554#define RXMODE_RFMON cpu_to_le16(3) /* wireless monitor mode */
555#define RXMODE_RFMON_ANYBSS cpu_to_le16(4)
556#define RXMODE_LANMON cpu_to_le16(5) /* lan style monitor -- data packets only */
557#define RXMODE_MASK cpu_to_le16(255)
558#define RXMODE_DISABLE_802_3_HEADER cpu_to_le16(1<<8) /* disables 802.3 header on rx */
559#define RXMODE_FULL_MASK (RXMODE_MASK | RXMODE_DISABLE_802_3_HEADER)
560#define RXMODE_NORMALIZED_RSSI cpu_to_le16(1<<9) /* return normalized RSSI */
561 __le16 fragThresh;
562 __le16 rtsThres;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563 u8 macAddr[ETH_ALEN];
564 u8 rates[8];
Al Viro3eb9b412007-12-21 00:00:35 -0500565 __le16 shortRetryLimit;
566 __le16 longRetryLimit;
567 __le16 txLifetime; /* in kusec */
568 __le16 rxLifetime; /* in kusec */
569 __le16 stationary;
570 __le16 ordering;
571 __le16 u16deviceType; /* for overriding device type */
572 __le16 cfpRate;
573 __le16 cfpDuration;
574 __le16 _reserved1[3];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 /*---------- Scanning/Associating ----------*/
Al Viro3eb9b412007-12-21 00:00:35 -0500576 __le16 scanMode;
577#define SCANMODE_ACTIVE cpu_to_le16(0)
578#define SCANMODE_PASSIVE cpu_to_le16(1)
579#define SCANMODE_AIROSCAN cpu_to_le16(2)
580 __le16 probeDelay; /* in kusec */
581 __le16 probeEnergyTimeout; /* in kusec */
582 __le16 probeResponseTimeout;
583 __le16 beaconListenTimeout;
584 __le16 joinNetTimeout;
585 __le16 authTimeout;
586 __le16 authType;
587#define AUTH_OPEN cpu_to_le16(0x1)
588#define AUTH_ENCRYPT cpu_to_le16(0x101)
589#define AUTH_SHAREDKEY cpu_to_le16(0x102)
590#define AUTH_ALLOW_UNENCRYPTED cpu_to_le16(0x200)
591 __le16 associationTimeout;
592 __le16 specifiedApTimeout;
593 __le16 offlineScanInterval;
594 __le16 offlineScanDuration;
595 __le16 linkLossDelay;
596 __le16 maxBeaconLostTime;
597 __le16 refreshInterval;
598#define DISABLE_REFRESH cpu_to_le16(0xFFFF)
599 __le16 _reserved1a[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600 /*---------- Power save operation ----------*/
Al Viro3eb9b412007-12-21 00:00:35 -0500601 __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];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611 /*---------- Ap/Ibss config items ----------*/
Al Viro3eb9b412007-12-21 00:00:35 -0500612 __le16 beaconPeriod;
613 __le16 atimDuration;
614 __le16 hopPeriod;
615 __le16 channelSet;
616 __le16 channel;
617 __le16 dtimPeriod;
618 __le16 bridgeDistance;
619 __le16 radioID;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620 /*---------- Radio configuration ----------*/
Al Viro3eb9b412007-12-21 00:00:35 -0500621 __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)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 u8 rxDiversity;
626 u8 txDiversity;
Al Viro3eb9b412007-12-21 00:00:35 -0500627 __le16 txPower;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628#define TXPOWER_DEFAULT 0
Al Viro3eb9b412007-12-21 00:00:35 -0500629 __le16 rssiThreshold;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700630#define RSSI_DEFAULT 0
Al Viro3eb9b412007-12-21 00:00:35 -0500631 __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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 /*---------- Aironet Extensions ----------*/
639 u8 nodeName[16];
Al Viro3eb9b412007-12-21 00:00:35 -0500640 __le16 arlThreshold;
641 __le16 arlDecay;
642 __le16 arlDelay;
643 __le16 _reserved4[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 /*---------- Aironet Extensions ----------*/
645 u8 magicAction;
646#define MAGIC_ACTION_STSCHG 1
647#define MAGIC_ACTION_RESUME 2
648#define MAGIC_IGNORE_MCAST (1<<8)
649#define MAGIC_IGNORE_BCAST (1<<9)
650#define MAGIC_SWITCH_TO_PSP (0<<10)
651#define MAGIC_STAY_IN_CAM (1<<10)
652 u8 magicControl;
Al Viro3eb9b412007-12-21 00:00:35 -0500653 __le16 autoWake;
Dan Williams99590ff2009-01-24 09:12:58 -0500654} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655
Dan Williams99590ff2009-01-24 09:12:58 -0500656typedef struct StatusRid StatusRid;
657struct StatusRid {
Al Viro329e2c02007-12-20 22:58:57 -0500658 __le16 len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659 u8 mac[ETH_ALEN];
Al Viro329e2c02007-12-20 22:58:57 -0500660 __le16 mode;
661 __le16 errorCode;
662 __le16 sigQuality;
663 __le16 SSIDlen;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664 char SSID[32];
665 char apName[16];
666 u8 bssid[4][ETH_ALEN];
Al Viro329e2c02007-12-20 22:58:57 -0500667 __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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682 u8 apIP[4];
683 u8 noisePercent; /* Noise percent in last second */
684 u8 noisedBm; /* Noise dBm in last second */
685 u8 noiseAvePercent; /* Noise percent in last minute */
686 u8 noiseAvedBm; /* Noise dBm in last minute */
687 u8 noiseMaxPercent; /* Highest noise percent in last minute */
688 u8 noiseMaxdBm; /* Highest noise dbm in last minute */
Al Viro329e2c02007-12-20 22:58:57 -0500689 __le16 load;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690 u8 carrier[4];
Al Viro329e2c02007-12-20 22:58:57 -0500691 __le16 assocStatus;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692#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
Dan Williams99590ff2009-01-24 09:12:58 -0500713} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714
Dan Williams99590ff2009-01-24 09:12:58 -0500715typedef struct StatsRid StatsRid;
716struct StatsRid {
Al Viroa23ace52007-12-19 22:24:16 -0500717 __le16 len;
718 __le16 spacer;
719 __le32 vals[100];
Dan Williams99590ff2009-01-24 09:12:58 -0500720} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700721
Dan Williams99590ff2009-01-24 09:12:58 -0500722typedef struct APListRid APListRid;
723struct APListRid {
Al Viroa7497162007-12-20 17:49:41 -0500724 __le16 len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700725 u8 ap[4][ETH_ALEN];
Dan Williams99590ff2009-01-24 09:12:58 -0500726} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700727
Dan Williams99590ff2009-01-24 09:12:58 -0500728typedef struct CapabilityRid CapabilityRid;
729struct CapabilityRid {
Al Viro56d81bd2007-12-20 17:18:35 -0500730 __le16 len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700731 char oui[3];
732 char zero;
Al Viro56d81bd2007-12-20 17:18:35 -0500733 __le16 prodNum;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734 char manName[32];
735 char prodName[16];
736 char prodVer[8];
737 char factoryAddr[ETH_ALEN];
738 char aironetAddr[ETH_ALEN];
Al Viro56d81bd2007-12-20 17:18:35 -0500739 __le16 radioType;
740 __le16 country;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741 char callid[ETH_ALEN];
742 char supportedRates[8];
743 char rxDiversity;
744 char txDiversity;
Al Viro56d81bd2007-12-20 17:18:35 -0500745 __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;
Dan Williams99590ff2009-01-24 09:12:58 -0500756} __attribute__ ((packed));
Dan Williams3c304952006-04-15 12:26:18 -0400757
758/* Only present on firmware >= 5.30.17 */
Dan Williams99590ff2009-01-24 09:12:58 -0500759typedef struct BSSListRidExtra BSSListRidExtra;
760struct BSSListRidExtra {
Al Viro17e70492007-12-19 18:56:37 -0500761 __le16 unknown[4];
Dan Williams3c304952006-04-15 12:26:18 -0400762 u8 fixed[12]; /* WLAN management frame */
763 u8 iep[624];
Dan Williams99590ff2009-01-24 09:12:58 -0500764} __attribute__ ((packed));
Dan Williams3c304952006-04-15 12:26:18 -0400765
Dan Williams99590ff2009-01-24 09:12:58 -0500766typedef struct BSSListRid BSSListRid;
767struct BSSListRid {
Al Viro17e70492007-12-19 18:56:37 -0500768 __le16 len;
769 __le16 index; /* First is 0 and 0xffff means end of list */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770#define RADIO_FH 1 /* Frequency hopping radio type */
771#define RADIO_DS 2 /* Direct sequence radio type */
772#define RADIO_TMA 4 /* Proprietary radio used in old cards (2500) */
Al Viro17e70492007-12-19 18:56:37 -0500773 __le16 radioType;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774 u8 bssid[ETH_ALEN]; /* Mac address of the BSS */
775 u8 zero;
776 u8 ssidLen;
777 u8 ssid[32];
Al Viro17e70492007-12-19 18:56:37 -0500778 __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;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700785 u8 rates[8]; /* Same as rates for config rid */
786 struct { /* For frequency hopping only */
Al Viro17e70492007-12-19 18:56:37 -0500787 __le16 dwell;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788 u8 hopSet;
789 u8 hopPattern;
790 u8 hopIndex;
791 u8 fill;
792 } fh;
Al Viro17e70492007-12-19 18:56:37 -0500793 __le16 dsChannel;
794 __le16 atimWindow;
Dan Williams3c304952006-04-15 12:26:18 -0400795
796 /* Only present on firmware >= 5.30.17 */
797 BSSListRidExtra extra;
Dan Williams99590ff2009-01-24 09:12:58 -0500798} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799
800typedef struct {
Dan Williams9e75af32006-03-16 13:46:29 -0500801 BSSListRid bss;
802 struct list_head list;
803} BSSListElement;
804
Dan Williams99590ff2009-01-24 09:12:58 -0500805typedef struct tdsRssiEntry tdsRssiEntry;
806struct tdsRssiEntry {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807 u8 rssipct;
808 u8 rssidBm;
Dan Williams99590ff2009-01-24 09:12:58 -0500809} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810
Dan Williams99590ff2009-01-24 09:12:58 -0500811typedef struct tdsRssiRid tdsRssiRid;
812struct tdsRssiRid {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813 u16 len;
814 tdsRssiEntry x[256];
Dan Williams99590ff2009-01-24 09:12:58 -0500815} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700816
Dan Williams99590ff2009-01-24 09:12:58 -0500817typedef struct MICRid MICRid;
818struct MICRid {
819 __le16 len;
820 __le16 state;
821 __le16 multicastValid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822 u8 multicast[16];
Dan Williams99590ff2009-01-24 09:12:58 -0500823 __le16 unicastValid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824 u8 unicast[16];
Dan Williams99590ff2009-01-24 09:12:58 -0500825} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700826
Dan Williams99590ff2009-01-24 09:12:58 -0500827typedef struct MICBuffer MICBuffer;
828struct MICBuffer {
Al Viro593c2b92007-12-17 15:09:34 -0500829 __be16 typelen;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830
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;
Al Viro593c2b92007-12-17 15:09:34 -0500841 __be32 mic;
842 __be32 seq;
Dan Williams99590ff2009-01-24 09:12:58 -0500843} __attribute__ ((packed));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844
845typedef struct {
846 u8 da[ETH_ALEN];
847 u8 sa[ETH_ALEN];
848} etherHead;
849
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850#define TXCTL_TXOK (1<<1) /* report if tx is ok */
851#define TXCTL_TXEX (1<<2) /* report if tx fails */
852#define TXCTL_802_3 (0<<3) /* 802.3 packet */
853#define TXCTL_802_11 (1<<3) /* 802.11 mac packet */
854#define TXCTL_ETHERNET (0<<4) /* payload has ethertype */
855#define TXCTL_LLC (1<<4) /* payload is llc */
856#define TXCTL_RELEASE (0<<5) /* release after completion */
857#define TXCTL_NORELEASE (1<<5) /* on completion returns to host */
858
859#define BUSY_FID 0x10000
860
861#ifdef CISCO_EXT
862#define AIROMAGIC 0xa55a
863/* Warning : SIOCDEVPRIVATE may disapear during 2.5.X - Jean II */
864#ifdef SIOCIWFIRSTPRIV
865#ifdef SIOCDEVPRIVATE
866#define AIROOLDIOCTL SIOCDEVPRIVATE
867#define AIROOLDIDIFC AIROOLDIOCTL + 1
868#endif /* SIOCDEVPRIVATE */
869#else /* SIOCIWFIRSTPRIV */
870#define SIOCIWFIRSTPRIV SIOCDEVPRIVATE
871#endif /* SIOCIWFIRSTPRIV */
872/* This may be wrong. When using the new SIOCIWFIRSTPRIV range, we probably
873 * should use only "GET" ioctls (last bit set to 1). "SET" ioctls are root
874 * only and don't return the modified struct ifreq to the application which
875 * is usually a problem. - Jean II */
876#define AIROIOCTL SIOCIWFIRSTPRIV
877#define AIROIDIFC AIROIOCTL + 1
878
879/* Ioctl constants to be used in airo_ioctl.command */
880
881#define AIROGCAP 0 // Capability rid
882#define AIROGCFG 1 // USED A LOT
883#define AIROGSLIST 2 // System ID list
884#define AIROGVLIST 3 // List of specified AP's
885#define AIROGDRVNAM 4 // NOTUSED
886#define AIROGEHTENC 5 // NOTUSED
887#define AIROGWEPKTMP 6
888#define AIROGWEPKNV 7
889#define AIROGSTAT 8
890#define AIROGSTATSC32 9
891#define AIROGSTATSD32 10
892#define AIROGMICRID 11
893#define AIROGMICSTATS 12
894#define AIROGFLAGS 13
895#define AIROGID 14
896#define AIRORRID 15
897#define AIRORSWVERSION 17
898
899/* Leave gap of 40 commands after AIROGSTATSD32 for future */
900
901#define AIROPCAP AIROGSTATSD32 + 40
902#define AIROPVLIST AIROPCAP + 1
903#define AIROPSLIST AIROPVLIST + 1
904#define AIROPCFG AIROPSLIST + 1
905#define AIROPSIDS AIROPCFG + 1
906#define AIROPAPLIST AIROPSIDS + 1
907#define AIROPMACON AIROPAPLIST + 1 /* Enable mac */
908#define AIROPMACOFF AIROPMACON + 1 /* Disable mac */
909#define AIROPSTCLR AIROPMACOFF + 1
910#define AIROPWEPKEY AIROPSTCLR + 1
911#define AIROPWEPKEYNV AIROPWEPKEY + 1
912#define AIROPLEAPPWD AIROPWEPKEYNV + 1
913#define AIROPLEAPUSR AIROPLEAPPWD + 1
914
915/* Flash codes */
916
917#define AIROFLSHRST AIROPWEPKEYNV + 40
918#define AIROFLSHGCHR AIROFLSHRST + 1
919#define AIROFLSHSTFL AIROFLSHGCHR + 1
920#define AIROFLSHPCHR AIROFLSHSTFL + 1
921#define AIROFLPUTBUF AIROFLSHPCHR + 1
922#define AIRORESTART AIROFLPUTBUF + 1
923
924#define FLASHSIZE 32768
925#define AUXMEMSIZE (256 * 1024)
926
927typedef struct aironet_ioctl {
928 unsigned short command; // What to do
929 unsigned short len; // Len of data
930 unsigned short ridnum; // rid number
931 unsigned char __user *data; // d-data
932} aironet_ioctl;
933
Domen Puncer62595eb2005-06-20 23:54:37 +0200934static char swversion[] = "2.1";
Linus Torvalds1da177e2005-04-16 15:20:36 -0700935#endif /* CISCO_EXT */
936
937#define NUM_MODULES 2
938#define MIC_MSGLEN_MAX 2400
939#define EMMH32_MSGLEN_MAX MIC_MSGLEN_MAX
Dan Williams15db2762006-03-16 13:46:27 -0500940#define AIRO_DEF_MTU 2312
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941
942typedef struct {
943 u32 size; // size
944 u8 enabled; // MIC enabled or not
945 u32 rxSuccess; // successful packets received
946 u32 rxIncorrectMIC; // pkts dropped due to incorrect MIC comparison
947 u32 rxNotMICed; // pkts dropped due to not being MIC'd
948 u32 rxMICPlummed; // pkts dropped due to not having a MIC plummed
949 u32 rxWrongSequence; // pkts dropped due to sequence number violation
950 u32 reserve[32];
951} mic_statistics;
952
953typedef struct {
954 u32 coeff[((EMMH32_MSGLEN_MAX)+3)>>2];
955 u64 accum; // accumulated mic, reduced to u32 in final()
956 int position; // current position (byte offset) in message
957 union {
958 u8 d8[4];
Al Viro593c2b92007-12-17 15:09:34 -0500959 __be32 d32;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700960 } part; // saves partial message word across update() calls
961} emmh32_context;
962
963typedef struct {
964 emmh32_context seed; // Context - the seed
965 u32 rx; // Received sequence number
966 u32 tx; // Tx sequence number
967 u32 window; // Start of window
968 u8 valid; // Flag to say if context is valid or not
969 u8 key[16];
970} miccntx;
971
972typedef struct {
973 miccntx mCtx; // Multicast context
974 miccntx uCtx; // Unicast context
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
Dan Williamsf55d4512009-01-24 09:04:12 -0500992struct rx_hdr {
993 __le16 status, len;
994 u8 rssi[2];
995 u8 rate;
996 u8 freq;
997 __le16 tmp[4];
998} __attribute__ ((packed));
999
Linus Torvalds1da177e2005-04-16 15:20:36 -07001000typedef struct {
1001 unsigned int ctl: 15;
1002 unsigned int rdy: 1;
1003 unsigned int len: 15;
1004 unsigned int valid: 1;
1005 dma_addr_t host_addr;
1006} RxFid;
1007
1008/*
1009 * Host receive descriptor
1010 */
1011typedef struct {
1012 unsigned char __iomem *card_ram_off; /* offset into card memory of the
1013 desc */
1014 RxFid rx_desc; /* card receive descriptor */
1015 char *virtual_host_addr; /* virtual address of host receive
1016 buffer */
1017 int pending;
1018} HostRxDesc;
1019
1020/*
1021 * Host transmit descriptor
1022 */
1023typedef struct {
1024 unsigned char __iomem *card_ram_off; /* offset into card memory of the
1025 desc */
1026 TxFid tx_desc; /* card transmit descriptor */
1027 char *virtual_host_addr; /* virtual address of host receive
1028 buffer */
1029 int pending;
1030} HostTxDesc;
1031
1032/*
1033 * Host RID descriptor
1034 */
1035typedef struct {
1036 unsigned char __iomem *card_ram_off; /* offset into card memory of the
1037 descriptor */
1038 Rid rid_desc; /* card RID descriptor */
1039 char *virtual_host_addr; /* virtual address of host receive
1040 buffer */
1041} HostRidDesc;
1042
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) /* Interrupt on successful TX */
1050#define HOST_INT_TXERR (1 << 2) /* Interrupt on unseccessful TX */
1051#define HOST_LCC_PAYLOAD (1 << 4) /* LLC payload, 0 = Ethertype */
1052#define HOST_DONT_RLSE (1 << 5) /* Don't release buffer when done */
1053#define HOST_DONT_RETRY (1 << 6) /* Don't retry trasmit */
1054#define HOST_CLR_AID (1 << 7) /* clear AID failure */
1055#define HOST_RTS (1 << 9) /* Force RTS use */
1056#define HOST_SHORT (1 << 10) /* Do short preamble */
1057 u16 ctl;
1058 u16 aid;
1059 u16 retries;
1060 u16 fill;
1061} TxCtlHdr;
1062
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
Jouni Malinenff1d2762005-05-12 22:54:16 -04001083static WifiCtlHdr wifictlhdr8023 = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084 .ctlhdr = {
1085 .ctl = HOST_DONT_RLSE,
1086 }
1087};
1088
Linus Torvalds1da177e2005-04-16 15:20:36 -07001089// A few details needed for WEP (Wireless Equivalent Privacy)
1090#define MAX_KEY_SIZE 13 // 128 (?) bits
1091#define MIN_KEY_SIZE 5 // 40 bits RC4 - WEP
1092typedef struct wep_key_t {
1093 u16 len;
1094 u8 key[16]; /* 40-bit and 104-bit keys */
1095} wep_key_t;
1096
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097/* List of Wireless Handlers (new API) */
1098static const struct iw_handler_def airo_handler_def;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001099
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);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02001108static int enable_MAC(struct airo_info *ai, int lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001109static 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);
Al Virob8c06bc2007-12-19 17:55:43 -05001114static int aux_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115 int whichbap);
Al Virob8c06bc2007-12-19 17:55:43 -05001116static int fast_bap_read(struct airo_info*, __le16 *pu16Dst, int bytelen,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001117 int whichbap);
Al Virob8c06bc2007-12-19 17:55:43 -05001118static int bap_write(struct airo_info*, const __le16 *pu16Src, int bytelen,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119 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
David Howells7d12e782006-10-05 14:55:46 +01001136static irqreturn_t airo_interrupt( int irq, void* dev_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001137static 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);
Jouni Malinenff1d2762005-05-12 22:54:16 -04001140static struct iw_statistics *airo_get_wireless_stats (struct net_device *dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001141static void airo_read_wireless_stats (struct airo_info *local);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001142#ifdef CISCO_EXT
1143static int readrids(struct net_device *dev, aironet_ioctl *comp);
1144static int writerids(struct net_device *dev, aironet_ioctl *comp);
Jouni Malinenff1d2762005-05-12 22:54:16 -04001145static int flashcard(struct net_device *dev, aironet_ioctl *comp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001146#endif /* CISCO_EXT */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001147static 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
Dan Williams41480af2005-05-10 09:45:51 -04001152static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi);
1153static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm);
1154
Dan Williams9e75af32006-03-16 13:46:29 -05001155static void airo_networks_free(struct airo_info *ai);
1156
Linus Torvalds1da177e2005-04-16 15:20:36 -07001157struct airo_info {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001158 struct net_device *dev;
Michal Schmidtaf5b5c92007-03-16 12:44:40 +01001159 struct list_head dev_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001160 /* Note, we can have MAX_FIDS outstanding. FIDs are 16-bits, so we
1161 use the high bit to mark whether it is in use. */
1162#define MAX_FIDS 6
1163#define MPI_MAX_FIDS 1
Hannes Eder9e05a2d2009-02-14 11:49:26 +00001164 u32 fids[MAX_FIDS];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001165 ConfigRid config;
1166 char keyindex; // Used with auto wep
1167 char defindex; // Used with auto wep
1168 struct proc_dir_entry *proc_entry;
1169 spinlock_t aux_lock;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001170#define FLAG_RADIO_OFF 0 /* User disabling of MAC */
1171#define FLAG_RADIO_DOWN 1 /* ifup/ifdown disabling of MAC */
1172#define FLAG_RADIO_MASK 0x03
1173#define FLAG_ENABLED 2
1174#define FLAG_ADHOC 3 /* Needed by MIC */
1175#define FLAG_MIC_CAPABLE 4
1176#define FLAG_UPDATE_MULTI 5
1177#define FLAG_UPDATE_UNI 6
1178#define FLAG_802_11 7
Dan Williams3c304952006-04-15 12:26:18 -04001179#define FLAG_PROMISC 8 /* IFF_PROMISC 0x100 - include/linux/if.h */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001180#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
Dan Williams3c304952006-04-15 12:26:18 -04001187#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;
Al Virob8c06bc2007-12-19 17:55:43 -05001200 int (*bap_read)(struct airo_info*, __le16 *pu16Dst, int bytelen,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001201 int whichbap);
1202 unsigned short *flash;
1203 tdsRssiEntry *rssi;
Sukadev Bhattiprolu3b4c7d642006-08-14 23:12:03 -07001204 struct task_struct *list_bss_task;
1205 struct task_struct *airo_thread_task;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001206 struct semaphore sem;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001207 wait_queue_head_t thr_wait;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208 unsigned long expires;
1209 struct {
1210 struct sk_buff *skb;
1211 int fid;
1212 } xmit, xmit11;
1213 struct net_device *wifidev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001214 struct iw_statistics wstats; // wireless stats
Dan Williams9e75af32006-03-16 13:46:29 -05001215 unsigned long scan_timeout; /* Time scan should be read */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001216 struct iw_spy_data spy_data;
1217 struct iw_public_data wireless_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001218 /* MIC stuff */
Herbert Xuf12cc202006-08-22 20:36:13 +10001219 struct crypto_cipher *tfm;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001220 mic_module mod[2];
1221 mic_statistics micstats;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222 HostRxDesc rxfids[MPI_MAX_FIDS]; // rx/tx/config MPI350 descriptors
1223 HostTxDesc txfids[MPI_MAX_FIDS];
1224 HostRidDesc config_desc;
1225 unsigned long ridbus; // phys addr of config_desc
1226 struct sk_buff_head txq;// tx queue used by mpi350 code
1227 struct pci_dev *pci;
1228 unsigned char __iomem *pcimem;
1229 unsigned char __iomem *pciaux;
1230 unsigned char *shared;
1231 dma_addr_t shared_dma;
Pavel Machek1cc68ae2005-06-20 15:33:04 -07001232 pm_message_t power;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001233 SsidRid *SSID;
1234 APListRid *APList;
1235#define PCI_SHARED_LEN 2*MPI_MAX_FIDS*PKTSIZE+RIDSIZE
1236 char proc_name[IFNAMSIZ];
Dan Williams9e75af32006-03-16 13:46:29 -05001237
Dan Williams138c0c62009-01-24 09:11:35 -05001238 int wep_capable;
1239 int max_wep_idx;
1240
Dan Williams3c304952006-04-15 12:26:18 -04001241 /* WPA-related stuff */
1242 unsigned int bssListFirst;
1243 unsigned int bssListNext;
1244 unsigned int bssListRidLen;
1245
Dan Williams9e75af32006-03-16 13:46:29 -05001246 struct list_head network_list;
1247 struct list_head network_free_list;
1248 BSSListElement *networks;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001249};
1250
Al Virob8c06bc2007-12-19 17:55:43 -05001251static inline int bap_read(struct airo_info *ai, __le16 *pu16Dst, int bytelen,
1252 int whichbap)
1253{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001254 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
Jouni Malinenff1d2762005-05-12 22:54:16 -04001262static 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
Dan Williams934d8bf2006-03-16 13:46:23 -05001268#define airo_print(type, name, fmt, args...) \
Michal Schmidt1138c372007-06-29 15:33:41 +02001269 printk(type DRV_NAME "(%s): " fmt "\n", name, ##args)
Dan Williams934d8bf2006-03-16 13:46:23 -05001270
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
Wang Chenfaf39942008-10-14 13:30:33 +08001283#define AIRO_FLASH(dev) (((struct airo_info *)dev->ml_priv)->flash)
Dan Williams934d8bf2006-03-16 13:46:23 -05001284
Linus Torvalds1da177e2005-04-16 15:20:36 -07001285/***********************************************************************
1286 * MIC ROUTINES *
1287 ***********************************************************************
1288 */
1289
1290static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq);
1291static void MoveWindow(miccntx *context, u32 micSeq);
Herbert Xuf12cc202006-08-22 20:36:13 +10001292static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1293 struct crypto_cipher *tfm);
Jouni Malinenff1d2762005-05-12 22:54:16 -04001294static 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298
Dan Williams018697d2009-01-24 09:13:32 -05001299static void age_mic_context(miccntx *cur, miccntx *old, u8 *key, int key_len,
1300 struct crypto_cipher *tfm)
1301{
1302 /* If the current MIC context is valid and its key is the same as
1303 * the MIC register, there's nothing to do.
1304 */
1305 if (cur->valid && (memcmp(cur->key, key, key_len) == 0))
1306 return;
1307
1308 /* Age current mic Context */
1309 memcpy(old, cur, sizeof(*cur));
1310
1311 /* Initialize new context */
1312 memcpy(cur->key, key, key_len);
1313 cur->window = 33; /* Window always points to the middle */
1314 cur->rx = 0; /* Rx Sequence numbers */
1315 cur->tx = 0; /* Tx sequence numbers */
1316 cur->valid = 1; /* Key is now valid */
1317
1318 /* Give key to mic seed */
1319 emmh32_setseed(&cur->seed, key, key_len, tfm);
1320}
1321
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322/* micinit - Initialize mic seed */
1323
1324static void micinit(struct airo_info *ai)
1325{
1326 MICRid mic_rid;
1327
Dan Williams3c304952006-04-15 12:26:18 -04001328 clear_bit(JOB_MIC, &ai->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329 PC4500_readrid(ai, RID_MIC, &mic_rid, sizeof(mic_rid), 0);
1330 up(&ai->sem);
1331
Dan Williams018697d2009-01-24 09:13:32 -05001332 ai->micstats.enabled = (le16_to_cpu(mic_rid.state) & 0x00FF) ? 1 : 0;
1333 if (!ai->micstats.enabled) {
1334 /* So next time we have a valid key and mic is enabled, we will
1335 * update the sequence number if the key is the same as before.
1336 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337 ai->mod[0].uCtx.valid = 0;
1338 ai->mod[0].mCtx.valid = 0;
Dan Williams018697d2009-01-24 09:13:32 -05001339 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 }
1353}
1354
1355/* micsetup - Get ready for business */
1356
1357static int micsetup(struct airo_info *ai) {
1358 int i;
1359
1360 if (ai->tfm == NULL)
Herbert Xuf12cc202006-08-22 20:36:13 +10001361 ai->tfm = crypto_alloc_cipher("aes", 0, CRYPTO_ALG_ASYNC);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001362
Herbert Xuf12cc202006-08-22 20:36:13 +10001363 if (IS_ERR(ai->tfm)) {
Dan Williams934d8bf2006-03-16 13:46:23 -05001364 airo_print_err(ai->dev->name, "failed to load transform for AES");
Herbert Xuf12cc202006-08-22 20:36:13 +10001365 ai->tfm = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001366 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
Jouni Malinenff1d2762005-05-12 22:54:16 -04001376static char micsnap[] = {0xAA,0xAA,0x03,0x00,0x40,0x96,0x00,0x02};
Linus Torvalds1da177e2005-04-16 15:20:36 -07001377
1378/*===========================================================================
1379 * Description: Mic a packet
1380 *
1381 * Inputs: etherHead * pointer to an 802.3 frame
1382 *
1383 * Returns: BOOLEAN if successful, otherwise false.
1384 * PacketTxLen will be updated with the mic'd packets size.
1385 *
1386 * Caveats: It is assumed that the frame buffer will already
1387 * be big enough to hold the largets mic message possible.
1388 * (No memory allocation is done here).
1389 *
1390 * Author: sbraneky (10/15/01)
1391 * Merciless hacks by rwilcher (1/14/02)
1392 */
1393
1394static int encapsulate(struct airo_info *ai ,etherHead *frame, MICBuffer *mic, int payLen)
1395{
1396 miccntx *context;
1397
1398 // Determine correct context
1399 // If not adhoc, always use unicast key
1400
1401 if (test_bit(FLAG_ADHOC, &ai->flags) && (frame->da[0] & 0x1))
1402 context = &ai->mod[0].mCtx;
1403 else
1404 context = &ai->mod[0].uCtx;
1405
1406 if (!context->valid)
1407 return ERROR;
1408
1409 mic->typelen = htons(payLen + 16); //Length of Mic'd packet
1410
1411 memcpy(&mic->u.snap, micsnap, sizeof(micsnap)); // Add Snap
1412
1413 // Add Tx sequence
1414 mic->seq = htonl(context->tx);
1415 context->tx += 2;
1416
1417 emmh32_init(&context->seed); // Mic the packet
1418 emmh32_update(&context->seed,frame->da,ETH_ALEN * 2); // DA,SA
1419 emmh32_update(&context->seed,(u8*)&mic->typelen,10); // Type/Length and Snap
1420 emmh32_update(&context->seed,(u8*)&mic->seq,sizeof(mic->seq)); //SEQ
1421 emmh32_update(&context->seed,frame->da + ETH_ALEN * 2,payLen); //payload
1422 emmh32_final(&context->seed, (u8*)&mic->mic);
1423
1424 /* New Type/length ?????????? */
1425 mic->typelen = 0; //Let NIC know it could be an oversized packet
1426 return SUCCESS;
1427}
1428
1429typedef enum {
1430 NONE,
1431 NOMIC,
1432 NOMICPLUMMED,
1433 SEQUENCE,
1434 INCORRECTMIC,
1435} mic_error;
1436
1437/*===========================================================================
1438 * Description: Decapsulates a MIC'd packet and returns the 802.3 packet
1439 * (removes the MIC stuff) if packet is a valid packet.
1440 *
1441 * Inputs: etherHead pointer to the 802.3 packet
1442 *
1443 * Returns: BOOLEAN - TRUE if packet should be dropped otherwise FALSE
1444 *
1445 * Author: sbraneky (10/15/01)
1446 * Merciless hacks by rwilcher (1/14/02)
1447 *---------------------------------------------------------------------------
1448 */
1449
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 // Check if the packet is a Mic'd packet
1459
1460 if (!ai->micstats.enabled) {
1461 //No Mic set or Mic OFF but we received a MIC'd packet.
1462 if (memcmp ((u8*)eth + 14, micsnap, sizeof(micsnap)) == 0) {
1463 ai->micstats.rxMICPlummed++;
1464 return ERROR;
1465 }
1466 return SUCCESS;
1467 }
1468
1469 if (ntohs(mic->typelen) == 0x888E)
1470 return SUCCESS;
1471
1472 if (memcmp (mic->u.snap, micsnap, sizeof(micsnap)) != 0) {
1473 // Mic enabled but packet isn't Mic'd
1474 ai->micstats.rxMICPlummed++;
1475 return ERROR;
1476 }
1477
1478 micSEQ = ntohl(mic->seq); //store SEQ as CPU order
1479
1480 //At this point we a have a mic'd packet and mic is enabled
1481 //Now do the mic error checking.
1482
1483 //Receive seq must be odd
1484 if ( (micSEQ & 1) == 0 ) {
1485 ai->micstats.rxWrongSequence++;
1486 return ERROR;
1487 }
1488
1489 for (i = 0; i < NUM_MODULES; i++) {
1490 int mcast = eth->da[0] & 1;
1491 //Determine proper context
1492 context = mcast ? &ai->mod[i].mCtx : &ai->mod[i].uCtx;
1493
1494 //Make sure context is valid
1495 if (!context->valid) {
1496 if (i == 0)
1497 micError = NOMICPLUMMED;
1498 continue;
1499 }
1500 //DeMic it
1501
1502 if (!mic->typelen)
1503 mic->typelen = htons(payLen + sizeof(MICBuffer) - 2);
1504
1505 emmh32_init(&context->seed);
1506 emmh32_update(&context->seed, eth->da, ETH_ALEN*2);
1507 emmh32_update(&context->seed, (u8 *)&mic->typelen, sizeof(mic->typelen)+sizeof(mic->u.snap));
1508 emmh32_update(&context->seed, (u8 *)&mic->seq,sizeof(mic->seq));
1509 emmh32_update(&context->seed, eth->da + ETH_ALEN*2,payLen);
1510 //Calculate MIC
1511 emmh32_final(&context->seed, digest);
1512
1513 if (memcmp(digest, &mic->mic, 4)) { //Make sure the mics match
1514 //Invalid Mic
1515 if (i == 0)
1516 micError = INCORRECTMIC;
1517 continue;
1518 }
1519
1520 //Check Sequence number if mics pass
1521 if (RxSeqValid(ai, context, mcast, micSEQ) == SUCCESS) {
1522 ai->micstats.rxSuccess++;
1523 return SUCCESS;
1524 }
1525 if (i == 0)
1526 micError = SEQUENCE;
1527 }
1528
1529 // Update statistics
1530 switch (micError) {
1531 case NOMICPLUMMED: ai->micstats.rxMICPlummed++; break;
1532 case SEQUENCE: ai->micstats.rxWrongSequence++; break;
1533 case INCORRECTMIC: ai->micstats.rxIncorrectMIC++; break;
1534 case NONE: break;
1535 case NOMIC: break;
1536 }
1537 return ERROR;
1538}
1539
1540/*===========================================================================
1541 * Description: Checks the Rx Seq number to make sure it is valid
1542 * and hasn't already been received
1543 *
1544 * Inputs: miccntx - mic context to check seq against
1545 * micSeq - the Mic seq number
1546 *
1547 * Returns: TRUE if valid otherwise FALSE.
1548 *
1549 * Author: sbraneky (10/15/01)
1550 * Merciless hacks by rwilcher (1/14/02)
1551 *---------------------------------------------------------------------------
1552 */
1553
1554static int RxSeqValid (struct airo_info *ai,miccntx *context,int mcast,u32 micSeq)
1555{
1556 u32 seq,index;
1557
1558 //Allow for the ap being rebooted - if it is then use the next
1559 //sequence number of the current sequence number - might go backwards
1560
1561 if (mcast) {
1562 if (test_bit(FLAG_UPDATE_MULTI, &ai->flags)) {
1563 clear_bit (FLAG_UPDATE_MULTI, &ai->flags);
1564 context->window = (micSeq > 33) ? micSeq : 33;
1565 context->rx = 0; // Reset rx
1566 }
1567 } else if (test_bit(FLAG_UPDATE_UNI, &ai->flags)) {
1568 clear_bit (FLAG_UPDATE_UNI, &ai->flags);
1569 context->window = (micSeq > 33) ? micSeq : 33; // Move window
1570 context->rx = 0; // Reset rx
1571 }
1572
1573 //Make sequence number relative to START of window
1574 seq = micSeq - (context->window - 33);
1575
1576 //Too old of a SEQ number to check.
1577 if ((s32)seq < 0)
1578 return ERROR;
1579
1580 if ( seq > 64 ) {
1581 //Window is infinite forward
1582 MoveWindow(context,micSeq);
1583 return SUCCESS;
1584 }
1585
1586 // We are in the window. Now check the context rx bit to see if it was already sent
1587 seq >>= 1; //divide by 2 because we only have odd numbers
1588 index = 1 << seq; //Get an index number
1589
1590 if (!(context->rx & index)) {
1591 //micSEQ falls inside the window.
1592 //Add seqence number to the list of received numbers.
1593 context->rx |= index;
1594
1595 MoveWindow(context,micSeq);
1596
1597 return SUCCESS;
1598 }
1599 return ERROR;
1600}
1601
1602static void MoveWindow(miccntx *context, u32 micSeq)
1603{
1604 u32 shift;
1605
1606 //Move window if seq greater than the middle of the window
1607 if (micSeq > context->window) {
1608 shift = (micSeq - context->window) >> 1;
1609
1610 //Shift out old
1611 if (shift < 32)
1612 context->rx >>= shift;
1613 else
1614 context->rx = 0;
1615
1616 context->window = micSeq; //Move window
1617 }
1618}
1619
1620/*==============================================*/
1621/*========== EMMH ROUTINES ====================*/
1622/*==============================================*/
1623
1624/* mic accumulate */
1625#define MIC_ACCUM(val) \
1626 context->accum += (u64)(val) * context->coeff[coeff_position++];
1627
1628static unsigned char aes_counter[16];
1629
1630/* expand the key to fill the MMH coefficient array */
Herbert Xuf12cc202006-08-22 20:36:13 +10001631static void emmh32_setseed(emmh32_context *context, u8 *pkey, int keylen,
1632 struct crypto_cipher *tfm)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001633{
1634 /* take the keying material, expand if necessary, truncate at 16-bytes */
1635 /* run through AES counter mode to generate context->coeff[] */
1636
1637 int i,j;
1638 u32 counter;
1639 u8 *cipher, plain[16];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640
1641 crypto_cipher_setkey(tfm, pkey, 16);
1642 counter = 0;
Ahmed S. Darwishe7c04fd2007-02-05 18:58:29 +02001643 for (i = 0; i < ARRAY_SIZE(context->coeff); ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001644 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);
Herbert Xuf12cc202006-08-22 20:36:13 +10001650 crypto_cipher_encrypt_one(tfm, plain, plain);
1651 cipher = plain;
Ahmed S. Darwishe7c04fd2007-02-05 18:58:29 +02001652 for (j = 0; (j < 16) && (i < ARRAY_SIZE(context->coeff)); ) {
Al Viro593c2b92007-12-17 15:09:34 -05001653 context->coeff[i++] = ntohl(*(__be32 *)&cipher[j]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001654 j += 4;
1655 }
1656 }
1657}
1658
1659/* prepare for calculation of a new mic */
Jouni Malinenff1d2762005-05-12 22:54:16 -04001660static void emmh32_init(emmh32_context *context)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001661{
1662 /* prepare for new mic calculation */
1663 context->accum = 0;
1664 context->position = 0;
1665}
1666
1667/* add some bytes to the mic calculation */
Jouni Malinenff1d2762005-05-12 22:54:16 -04001668static void emmh32_update(emmh32_context *context, u8 *pOctets, int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001669{
1670 int coeff_position, byte_position;
1671
1672 if (len == 0) return;
1673
1674 coeff_position = context->position >> 2;
1675
1676 /* deal with partial 32-bit word left over from last update */
1677 byte_position = context->position & 3;
1678 if (byte_position) {
1679 /* have a partial word in part to deal with */
1680 do {
1681 if (len == 0) return;
1682 context->part.d8[byte_position++] = *pOctets++;
1683 context->position++;
1684 len--;
1685 } while (byte_position < 4);
Al Viro593c2b92007-12-17 15:09:34 -05001686 MIC_ACCUM(ntohl(context->part.d32));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687 }
1688
1689 /* deal with full 32-bit words */
1690 while (len >= 4) {
Al Viro593c2b92007-12-17 15:09:34 -05001691 MIC_ACCUM(ntohl(*(__be32 *)pOctets));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001692 context->position += 4;
1693 pOctets += 4;
1694 len -= 4;
1695 }
1696
1697 /* deal with partial 32-bit word that will be left over from this update */
1698 byte_position = 0;
1699 while (len > 0) {
1700 context->part.d8[byte_position++] = *pOctets++;
1701 context->position++;
1702 len--;
1703 }
1704}
1705
1706/* mask used to zero empty bytes for final partial word */
1707static u32 mask32[4] = { 0x00000000L, 0xFF000000L, 0xFFFF0000L, 0xFFFFFF00L };
1708
1709/* calculate the mic */
Jouni Malinenff1d2762005-05-12 22:54:16 -04001710static void emmh32_final(emmh32_context *context, u8 digest[4])
Linus Torvalds1da177e2005-04-16 15:20:36 -07001711{
1712 int coeff_position, byte_position;
1713 u32 val;
1714
1715 u64 sum, utmp;
1716 s64 stmp;
1717
1718 coeff_position = context->position >> 2;
1719
1720 /* deal with partial 32-bit word left over from last update */
1721 byte_position = context->position & 3;
1722 if (byte_position) {
1723 /* have a partial word in part to deal with */
Al Viro593c2b92007-12-17 15:09:34 -05001724 val = ntohl(context->part.d32);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001725 MIC_ACCUM(val & mask32[byte_position]); /* zero empty bytes */
1726 }
1727
1728 /* reduce the accumulated u64 to a 32-bit MIC */
1729 sum = context->accum;
1730 stmp = (sum & 0xffffffffLL) - ((sum >> 32) * 15);
1731 utmp = (stmp & 0xffffffffLL) - ((stmp >> 32) * 15);
1732 sum = utmp & 0xffffffffLL;
1733 if (utmp > 0x10000000fLL)
1734 sum -= 15;
1735
1736 val = (u32)sum;
1737 digest[0] = (val>>24) & 0xFF;
1738 digest[1] = (val>>16) & 0xFF;
1739 digest[2] = (val>>8) & 0xFF;
1740 digest[3] = val & 0xFF;
1741}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001742
1743static int readBSSListRid(struct airo_info *ai, int first,
Al Viro17e70492007-12-19 18:56:37 -05001744 BSSListRid *list)
1745{
Dan Williams3c304952006-04-15 12:26:18 -04001746 Cmd cmd;
1747 Resp rsp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001748
1749 if (first == 1) {
Dan Williams3c304952006-04-15 12:26:18 -04001750 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;
Sukadev Bhattiprolu3b4c7d642006-08-14 23:12:03 -07001755 ai->list_bss_task = current;
Dan Williams3c304952006-04-15 12:26:18 -04001756 issuecommand(ai, &cmd, &rsp);
1757 up(&ai->sem);
1758 /* Let the command take effect */
Sukadev Bhattiprolu3b4c7d642006-08-14 23:12:03 -07001759 schedule_timeout_uninterruptible(3 * HZ);
1760 ai->list_bss_task = NULL;
Dan Williams3c304952006-04-15 12:26:18 -04001761 }
Al Viro17e70492007-12-19 18:56:37 -05001762 return PC4500_readrid(ai, first ? ai->bssListFirst : ai->bssListNext,
Dan Williams3c304952006-04-15 12:26:18 -04001763 list, ai->bssListRidLen, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001764}
1765
Al Viro4293ea32007-12-19 19:21:51 -05001766static 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,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001769 wkr, sizeof(*wkr), lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001770}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001771
Al Viro4293ea32007-12-19 19:21:51 -05001772static 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001778 if (perm) {
Al Viro4293ea32007-12-19 19:21:51 -05001779 rc = PC4500_writerid(ai, RID_WEP_PERM, wkr, sizeof(*wkr), lock);
1780 if (rc!=SUCCESS)
Dan Williams934d8bf2006-03-16 13:46:23 -05001781 airo_print_err(ai->dev->name, "WEP_PERM set %x", rc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001782 }
1783 return rc;
1784}
1785
Al Viro0dd22122007-12-17 16:11:57 -05001786static int readSsidRid(struct airo_info*ai, SsidRid *ssidr)
1787{
1788 return PC4500_readrid(ai, RID_SSID, ssidr, sizeof(*ssidr), 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001789}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001790
Al Viro0dd22122007-12-17 16:11:57 -05001791static int writeSsidRid(struct airo_info*ai, SsidRid *pssidr, int lock)
1792{
1793 return PC4500_writerid(ai, RID_SSID, pssidr, sizeof(*pssidr), lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001794}
Al Viro0dd22122007-12-17 16:11:57 -05001795
Al Viro3eb9b412007-12-21 00:00:35 -05001796static int readConfigRid(struct airo_info *ai, int lock)
1797{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001798 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001799 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
Linus Torvalds1da177e2005-04-16 15:20:36 -07001808 ai->config = cfg;
1809 return SUCCESS;
1810}
Al Viro3eb9b412007-12-21 00:00:35 -05001811
1812static inline void checkThrottle(struct airo_info *ai)
1813{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001814 int i;
1815/* Old hardware had a limit on encryption speed */
1816 if (ai->config.authType != AUTH_OPEN && maxencrypt) {
1817 for(i=0; i<8; i++) {
1818 if (ai->config.rates[i] > maxencrypt) {
1819 ai->config.rates[i] = 0;
1820 }
1821 }
1822 }
1823}
Al Viro3eb9b412007-12-21 00:00:35 -05001824
1825static int writeConfigRid(struct airo_info *ai, int lock)
1826{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001827 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
Al Viro3eb9b412007-12-21 00:00:35 -05001837 if ((cfgr.opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001838 set_bit(FLAG_ADHOC, &ai->flags);
1839 else
1840 clear_bit(FLAG_ADHOC, &ai->flags);
1841
Linus Torvalds1da177e2005-04-16 15:20:36 -07001842 return PC4500_writerid( ai, RID_CONFIG, &cfgr, sizeof(cfgr), lock);
1843}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001844
Al Viro329e2c02007-12-20 22:58:57 -05001845static int readStatusRid(struct airo_info *ai, StatusRid *statr, int lock)
1846{
1847 return PC4500_readrid(ai, RID_STATUS, statr, sizeof(*statr), lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001848}
Al Viroa7497162007-12-20 17:49:41 -05001849
1850static int readAPListRid(struct airo_info *ai, APListRid *aplr)
1851{
1852 return PC4500_readrid(ai, RID_APLIST, aplr, sizeof(*aplr), 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001853}
Al Viroa7497162007-12-20 17:49:41 -05001854
1855static int writeAPListRid(struct airo_info *ai, APListRid *aplr, int lock)
1856{
1857 return PC4500_writerid(ai, RID_APLIST, aplr, sizeof(*aplr), lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001858}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001859
Al Viro56d81bd2007-12-20 17:18:35 -05001860static int readCapabilityRid(struct airo_info *ai, CapabilityRid *capr, int lock)
1861{
1862 return PC4500_readrid(ai, RID_CAPABILITIES, capr, sizeof(*capr), lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001863}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001864
Al Viroa23ace52007-12-19 22:24:16 -05001865static int readStatsRid(struct airo_info*ai, StatsRid *sr, int rid, int lock)
1866{
1867 return PC4500_readrid(ai, rid, sr, sizeof(*sr), lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001868}
1869
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02001870static 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}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001877
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02001878static int airo_open(struct net_device *dev) {
Wang Chenfaf39942008-10-14 13:30:33 +08001879 struct airo_info *ai = dev->ml_priv;
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02001880 int rc = 0;
1881
1882 if (test_bit(FLAG_FLASHING, &ai->flags))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001883 return -EIO;
1884
1885 /* Make sure the card is configured.
1886 * Wireless Extensions may postpone config changes until the card
1887 * is open (to pipeline changes and speed-up card setup). If
1888 * those changes are not yet commited, do it now - Jean II */
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02001889 if (test_bit(FLAG_COMMIT, &ai->flags)) {
1890 disable_MAC(ai, 1);
1891 writeConfigRid(ai, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001892 }
1893
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02001894 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
Linus Torvalds1da177e2005-04-16 15:20:36 -07001911 /* Power on the MAC controller (which may have been disabled) */
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02001912 clear_bit(FLAG_RADIO_DOWN, &ai->flags);
1913 enable_interrupts(ai);
1914
1915 try_auto_wep(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001916 }
Michal Schmidt175ec1a2007-06-29 15:33:47 +02001917 enable_MAC(ai, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001918
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;
Wang Chenfaf39942008-10-14 13:30:33 +08001926 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001927
1928 if (!skb) {
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07001929 airo_print_err(dev->name, "%s: skb == NULL!",__func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001930 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) {
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03001937 dev->stats.tx_fifo_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001938 return 1;
1939 }
1940 skb_queue_tail (&ai->txq, skb);
1941 return 0;
1942 }
1943
1944 spin_lock_irqsave(&ai->aux_lock, flags);
1945 skb_queue_tail (&ai->txq, skb);
1946 pending = test_bit(FLAG_PENDING_XMIT, &ai->flags);
1947 spin_unlock_irqrestore(&ai->aux_lock,flags);
1948 netif_wake_queue (dev);
1949
1950 if (pending == 0) {
1951 set_bit(FLAG_PENDING_XMIT, &ai->flags);
1952 mpi_send_packet (dev);
1953 }
1954 return 0;
1955}
1956
1957/*
1958 * @mpi_send_packet
1959 *
1960 * Attempt to transmit a packet. Can be called from interrupt
1961 * or transmit . return number of packets we tried to send
1962 */
1963
1964static int mpi_send_packet (struct net_device *dev)
1965{
1966 struct sk_buff *skb;
1967 unsigned char *buffer;
Al Viro593c2b92007-12-17 15:09:34 -05001968 s16 len;
1969 __le16 *payloadLen;
Wang Chenfaf39942008-10-14 13:30:33 +08001970 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001971 u8 *sendbuf;
1972
1973 /* get a packet to send */
1974
Al Viro79ea13c2008-01-24 02:06:46 -08001975 if ((skb = skb_dequeue(&ai->txq)) == NULL) {
Dan Williams934d8bf2006-03-16 13:46:23 -05001976 airo_print_err(dev->name,
1977 "%s: Dequeue'd zero in send_packet()",
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07001978 __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001979 return 0;
1980 }
1981
1982 /* check min length*/
1983 len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
1984 buffer = skb->data;
1985
1986 ai->txfids[0].tx_desc.offset = 0;
1987 ai->txfids[0].tx_desc.valid = 1;
1988 ai->txfids[0].tx_desc.eoc = 1;
1989 ai->txfids[0].tx_desc.len =len+sizeof(WifiHdr);
1990
1991/*
1992 * Magic, the cards firmware needs a length count (2 bytes) in the host buffer
1993 * right after TXFID_HDR.The TXFID_HDR contains the status short so payloadlen
1994 * is immediatly after it. ------------------------------------------------
1995 * |TXFIDHDR+STATUS|PAYLOADLEN|802.3HDR|PACKETDATA|
1996 * ------------------------------------------------
1997 */
1998
1999 memcpy((char *)ai->txfids[0].virtual_host_addr,
2000 (char *)&wifictlhdr8023, sizeof(wifictlhdr8023));
2001
Al Viro593c2b92007-12-17 15:09:34 -05002002 payloadLen = (__le16 *)(ai->txfids[0].virtual_host_addr +
Linus Torvalds1da177e2005-04-16 15:20:36 -07002003 sizeof(wifictlhdr8023));
2004 sendbuf = ai->txfids[0].virtual_host_addr +
2005 sizeof(wifictlhdr8023) + 2 ;
2006
2007 /*
2008 * Firmware automaticly puts 802 header on so
2009 * we don't need to account for it in the length
2010 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002011 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
Al Viro593c2b92007-12-17 15:09:34 -05002012 (ntohs(((__be16 *)buffer)[6]) != 0x888E)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002013 MICBuffer pMic;
2014
2015 if (encapsulate(ai, (etherHead *)buffer, &pMic, len - sizeof(etherHead)) != SUCCESS)
2016 return ERROR;
2017
2018 *payloadLen = cpu_to_le16(len-sizeof(etherHead)+sizeof(pMic));
2019 ai->txfids[0].tx_desc.len += sizeof(pMic);
2020 /* copy data into airo dma buffer */
2021 memcpy (sendbuf, buffer, sizeof(etherHead));
2022 buffer += sizeof(etherHead);
2023 sendbuf += sizeof(etherHead);
2024 memcpy (sendbuf, &pMic, sizeof(pMic));
2025 sendbuf += sizeof(pMic);
2026 memcpy (sendbuf, buffer, len - sizeof(etherHead));
Adrian Bunka39d3e72006-01-21 01:35:15 +01002027 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002028 *payloadLen = cpu_to_le16(len - sizeof(etherHead));
2029
2030 dev->trans_start = jiffies;
2031
2032 /* copy data into airo dma buffer */
2033 memcpy(sendbuf, buffer, len);
2034 }
2035
2036 memcpy_toio(ai->txfids[0].card_ram_off,
2037 &ai->txfids[0].tx_desc, sizeof(TxFid));
2038
2039 OUT4500(ai, EVACK, 8);
2040
2041 dev_kfree_skb_any(skb);
2042 return 1;
2043}
2044
Gabriel A. Devenyi29b09fc2005-11-03 19:30:47 -05002045static void get_tx_error(struct airo_info *ai, s32 fid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046{
Al Viro593c2b92007-12-17 15:09:34 -05002047 __le16 status;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002048
2049 if (fid < 0)
2050 status = ((WifiCtlHdr *)ai->txfids[0].virtual_host_addr)->ctlhdr.status;
2051 else {
2052 if (bap_setup(ai, ai->fids[fid] & 0xffff, 4, BAP0) != SUCCESS)
2053 return;
2054 bap_read(ai, &status, 2, BAP0);
2055 }
2056 if (le16_to_cpu(status) & 2) /* Too many retries */
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002057 ai->dev->stats.tx_aborted_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002058 if (le16_to_cpu(status) & 4) /* Transmit lifetime exceeded */
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002059 ai->dev->stats.tx_heartbeat_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002060 if (le16_to_cpu(status) & 8) /* Aid fail */
2061 { }
2062 if (le16_to_cpu(status) & 0x10) /* MAC disabled */
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002063 ai->dev->stats.tx_carrier_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002064 if (le16_to_cpu(status) & 0x20) /* Association lost */
2065 { }
2066 /* We produce a TXDROP event only for retry or lifetime
2067 * exceeded, because that's the only status that really mean
2068 * that this particular node went away.
2069 * Other errors means that *we* screwed up. - Jean II */
2070 if ((le16_to_cpu(status) & 2) ||
2071 (le16_to_cpu(status) & 4)) {
2072 union iwreq_data wrqu;
2073 char junk[0x18];
2074
2075 /* Faster to skip over useless data than to do
2076 * another bap_setup(). We are at offset 0x6 and
2077 * need to go to 0x18 and read 6 bytes - Jean II */
Al Virob8c06bc2007-12-19 17:55:43 -05002078 bap_read(ai, (__le16 *) junk, 0x18, BAP0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002079
2080 /* Copy 802.11 dest address.
2081 * We use the 802.11 header because the frame may
2082 * not be 802.3 or may be mangled...
2083 * In Ad-Hoc mode, it will be the node address.
2084 * In managed mode, it will be most likely the AP addr
2085 * User space will figure out how to convert it to
2086 * whatever it needs (IP address or else).
2087 * - Jean II */
2088 memcpy(wrqu.addr.sa_data, junk + 0x12, ETH_ALEN);
2089 wrqu.addr.sa_family = ARPHRD_ETHER;
2090
2091 /* Send event to user space */
2092 wireless_send_event(ai->dev, IWEVTXDROP, &wrqu, NULL);
2093 }
2094}
2095
2096static void airo_end_xmit(struct net_device *dev) {
2097 u16 status;
2098 int i;
Wang Chenfaf39942008-10-14 13:30:33 +08002099 struct airo_info *priv = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002100 struct sk_buff *skb = priv->xmit.skb;
2101 int fid = priv->xmit.fid;
2102 u32 *fids = priv->fids;
2103
Dan Williams3c304952006-04-15 12:26:18 -04002104 clear_bit(JOB_XMIT, &priv->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002105 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;
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002115 dev->stats.tx_window_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116 }
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;
Wang Chenfaf39942008-10-14 13:30:33 +08002125 struct airo_info *priv = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002126 u32 *fids = priv->fids;
2127
2128 if ( skb == NULL ) {
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07002129 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002130 return 0;
2131 }
2132
2133 /* Find a vacant FID */
2134 for( i = 0; i < MAX_FIDS / 2 && (fids[i] & 0xffff0000); i++ );
2135 for( j = i + 1; j < MAX_FIDS / 2 && (fids[j] & 0xffff0000); j++ );
2136
2137 if ( j >= MAX_FIDS / 2 ) {
2138 netif_stop_queue(dev);
2139
2140 if (i == MAX_FIDS / 2) {
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002141 dev->stats.tx_fifo_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002142 return 1;
2143 }
2144 }
2145 /* check min length*/
2146 len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2147 /* Mark fid as used & save length for later */
2148 fids[i] |= (len << 16);
2149 priv->xmit.skb = skb;
2150 priv->xmit.fid = i;
2151 if (down_trylock(&priv->sem) != 0) {
2152 set_bit(FLAG_PENDING_XMIT, &priv->flags);
2153 netif_stop_queue(dev);
Dan Williams3c304952006-04-15 12:26:18 -04002154 set_bit(JOB_XMIT, &priv->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002155 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;
Wang Chenfaf39942008-10-14 13:30:33 +08002164 struct airo_info *priv = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002165 struct sk_buff *skb = priv->xmit11.skb;
2166 int fid = priv->xmit11.fid;
2167 u32 *fids = priv->fids;
2168
Dan Williams3c304952006-04-15 12:26:18 -04002169 clear_bit(JOB_XMIT11, &priv->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002170 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;
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002180 dev->stats.tx_window_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002181 }
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;
Wang Chenfaf39942008-10-14 13:30:33 +08002190 struct airo_info *priv = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002191 u32 *fids = priv->fids;
2192
2193 if (test_bit(FLAG_MPI, &priv->flags)) {
2194 /* Not implemented yet for MPI350 */
2195 netif_stop_queue(dev);
2196 return -ENETDOWN;
2197 }
2198
2199 if ( skb == NULL ) {
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07002200 airo_print_err(dev->name, "%s: skb == NULL!", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002201 return 0;
2202 }
2203
2204 /* Find a vacant FID */
2205 for( i = MAX_FIDS / 2; i < MAX_FIDS && (fids[i] & 0xffff0000); i++ );
2206 for( j = i + 1; j < MAX_FIDS && (fids[j] & 0xffff0000); j++ );
2207
2208 if ( j >= MAX_FIDS ) {
2209 netif_stop_queue(dev);
2210
2211 if (i == MAX_FIDS) {
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002212 dev->stats.tx_fifo_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002213 return 1;
2214 }
2215 }
2216 /* check min length*/
2217 len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
2218 /* Mark fid as used & save length for later */
2219 fids[i] |= (len << 16);
2220 priv->xmit11.skb = skb;
2221 priv->xmit11.fid = i;
2222 if (down_trylock(&priv->sem) != 0) {
2223 set_bit(FLAG_PENDING_XMIT11, &priv->flags);
2224 netif_stop_queue(dev);
Dan Williams3c304952006-04-15 12:26:18 -04002225 set_bit(JOB_XMIT11, &priv->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002226 wake_up_interruptible(&priv->thr_wait);
2227 } else
2228 airo_end_xmit11(dev);
2229 return 0;
2230}
2231
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002232static void airo_read_stats(struct net_device *dev)
Al Viroa23ace52007-12-19 22:24:16 -05002233{
Wang Chenfaf39942008-10-14 13:30:33 +08002234 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002235 StatsRid stats_rid;
Al Viroa23ace52007-12-19 22:24:16 -05002236 __le32 *vals = stats_rid.vals;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002237
Dan Williams3c304952006-04-15 12:26:18 -04002238 clear_bit(JOB_STATS, &ai->jobs);
Pavel Machekca078ba2005-09-03 15:56:57 -07002239 if (ai->power.event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002240 up(&ai->sem);
2241 return;
2242 }
2243 readStatsRid(ai, &stats_rid, RID_STATS, 0);
2244 up(&ai->sem);
2245
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002246 dev->stats.rx_packets = le32_to_cpu(vals[43]) + le32_to_cpu(vals[44]) +
Al Viroa23ace52007-12-19 22:24:16 -05002247 le32_to_cpu(vals[45]);
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002248 dev->stats.tx_packets = le32_to_cpu(vals[39]) + le32_to_cpu(vals[40]) +
Al Viroa23ace52007-12-19 22:24:16 -05002249 le32_to_cpu(vals[41]);
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002250 dev->stats.rx_bytes = le32_to_cpu(vals[92]);
2251 dev->stats.tx_bytes = le32_to_cpu(vals[91]);
2252 dev->stats.rx_errors = le32_to_cpu(vals[0]) + le32_to_cpu(vals[2]) +
Al Viroa23ace52007-12-19 22:24:16 -05002253 le32_to_cpu(vals[3]) + le32_to_cpu(vals[4]);
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002254 dev->stats.tx_errors = le32_to_cpu(vals[42]) +
2255 dev->stats.tx_fifo_errors;
2256 dev->stats.multicast = le32_to_cpu(vals[43]);
2257 dev->stats.collisions = le32_to_cpu(vals[89]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002258
2259 /* detailed rx_errors: */
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002260 dev->stats.rx_length_errors = le32_to_cpu(vals[3]);
2261 dev->stats.rx_crc_errors = le32_to_cpu(vals[4]);
2262 dev->stats.rx_frame_errors = le32_to_cpu(vals[2]);
2263 dev->stats.rx_fifo_errors = le32_to_cpu(vals[0]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002264}
2265
Jouni Malinenff1d2762005-05-12 22:54:16 -04002266static struct net_device_stats *airo_get_stats(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002267{
Wang Chenfaf39942008-10-14 13:30:33 +08002268 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002269
Dan Williams3c304952006-04-15 12:26:18 -04002270 if (!test_bit(JOB_STATS, &local->jobs)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002271 /* Get stats out of the card if available */
2272 if (down_trylock(&local->sem) != 0) {
Dan Williams3c304952006-04-15 12:26:18 -04002273 set_bit(JOB_STATS, &local->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002274 wake_up_interruptible(&local->thr_wait);
2275 } else
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002276 airo_read_stats(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002277 }
2278
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03002279 return &dev->stats;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002280}
2281
2282static void airo_set_promisc(struct airo_info *ai) {
2283 Cmd cmd;
2284 Resp rsp;
2285
2286 memset(&cmd, 0, sizeof(cmd));
2287 cmd.cmd=CMD_SETMODE;
Dan Williams3c304952006-04-15 12:26:18 -04002288 clear_bit(JOB_PROMISC, &ai->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002289 cmd.parm0=(ai->flags&IFF_PROMISC) ? PROMISC : NOPROMISC;
2290 issuecommand(ai, &cmd, &rsp);
2291 up(&ai->sem);
2292}
2293
2294static void airo_set_multicast_list(struct net_device *dev) {
Wang Chenfaf39942008-10-14 13:30:33 +08002295 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002296
2297 if ((dev->flags ^ ai->flags) & IFF_PROMISC) {
2298 change_bit(FLAG_PROMISC, &ai->flags);
2299 if (down_trylock(&ai->sem) != 0) {
Dan Williams3c304952006-04-15 12:26:18 -04002300 set_bit(JOB_PROMISC, &ai->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002301 wake_up_interruptible(&ai->thr_wait);
2302 } else
2303 airo_set_promisc(ai);
2304 }
2305
2306 if ((dev->flags&IFF_ALLMULTI)||dev->mc_count>0) {
2307 /* Turn on multicast. (Should be already setup...) */
2308 }
2309}
2310
2311static int airo_set_mac_address(struct net_device *dev, void *p)
2312{
Wang Chenfaf39942008-10-14 13:30:33 +08002313 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002314 struct sockaddr *addr = p;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002315
2316 readConfigRid(ai, 1);
2317 memcpy (ai->config.macAddr, addr->sa_data, dev->addr_len);
2318 set_bit (FLAG_COMMIT, &ai->flags);
2319 disable_MAC(ai, 1);
2320 writeConfigRid (ai, 1);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02002321 enable_MAC(ai, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002322 memcpy (ai->dev->dev_addr, addr->sa_data, dev->addr_len);
2323 if (ai->wifidev)
2324 memcpy (ai->wifidev->dev_addr, addr->sa_data, dev->addr_len);
2325 return 0;
2326}
2327
2328static int airo_change_mtu(struct net_device *dev, int new_mtu)
2329{
2330 if ((new_mtu < 68) || (new_mtu > 2400))
2331 return -EINVAL;
2332 dev->mtu = new_mtu;
2333 return 0;
2334}
2335
Michal Schmidtaf5b5c92007-03-16 12:44:40 +01002336static LIST_HEAD(airo_devices);
2337
2338static void add_airo_dev(struct airo_info *ai)
2339{
2340 /* Upper layers already keep track of PCI devices,
2341 * so we only need to remember our non-PCI cards. */
2342 if (!ai->pci)
2343 list_add_tail(&ai->dev_list, &airo_devices);
2344}
2345
2346static void del_airo_dev(struct airo_info *ai)
2347{
2348 if (!ai->pci)
2349 list_del(&ai->dev_list);
2350}
Linus Torvalds1da177e2005-04-16 15:20:36 -07002351
2352static int airo_close(struct net_device *dev) {
Wang Chenfaf39942008-10-14 13:30:33 +08002353 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002354
2355 netif_stop_queue(dev);
2356
2357 if (ai->wifidev != dev) {
2358#ifdef POWER_ON_DOWN
2359 /* Shut power to the card. The idea is that the user can save
2360 * power when he doesn't need the card with "ifconfig down".
2361 * That's the method that is most friendly towards the network
2362 * stack (i.e. the network stack won't try to broadcast
2363 * anything on the interface and routes are gone. Jean II */
2364 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2365 disable_MAC(ai, 1);
2366#endif
2367 disable_interrupts( ai );
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02002368
2369 free_irq(dev->irq, dev);
2370
2371 set_bit(JOB_DIE, &ai->jobs);
2372 kthread_stop(ai->airo_thread_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002373 }
2374 return 0;
2375}
2376
Linus Torvalds1da177e2005-04-16 15:20:36 -07002377void stop_airo_card( struct net_device *dev, int freeres )
2378{
Wang Chenfaf39942008-10-14 13:30:33 +08002379 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002380
2381 set_bit(FLAG_RADIO_DOWN, &ai->flags);
2382 disable_MAC(ai, 1);
2383 disable_interrupts(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002384 takedown_proc_entry( dev, ai );
2385 if (test_bit(FLAG_REGISTERED, &ai->flags)) {
2386 unregister_netdev( dev );
2387 if (ai->wifidev) {
2388 unregister_netdev(ai->wifidev);
2389 free_netdev(ai->wifidev);
2390 ai->wifidev = NULL;
2391 }
2392 clear_bit(FLAG_REGISTERED, &ai->flags);
2393 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002394 /*
2395 * Clean out tx queue
2396 */
David S. Millerb03efcf2005-07-08 14:57:23 -07002397 if (test_bit(FLAG_MPI, &ai->flags) && !skb_queue_empty(&ai->txq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002398 struct sk_buff *skb = NULL;
2399 for (;(skb = skb_dequeue(&ai->txq));)
2400 dev_kfree_skb(skb);
2401 }
2402
Dan Williams9e75af32006-03-16 13:46:29 -05002403 airo_networks_free (ai);
2404
Jesper Juhlb4558ea2005-10-28 16:53:13 -04002405 kfree(ai->flash);
2406 kfree(ai->rssi);
2407 kfree(ai->APList);
2408 kfree(ai->SSID);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002409 if (freeres) {
2410 /* PCMCIA frees this stuff, so only for PCI and ISA */
2411 release_region( dev->base_addr, 64 );
2412 if (test_bit(FLAG_MPI, &ai->flags)) {
2413 if (ai->pci)
2414 mpi_unmap_card(ai->pci);
2415 if (ai->pcimem)
2416 iounmap(ai->pcimem);
2417 if (ai->pciaux)
2418 iounmap(ai->pciaux);
2419 pci_free_consistent(ai->pci, PCI_SHARED_LEN,
2420 ai->shared, ai->shared_dma);
2421 }
2422 }
Herbert Xuf12cc202006-08-22 20:36:13 +10002423 crypto_free_cipher(ai->tfm);
Michal Schmidtaf5b5c92007-03-16 12:44:40 +01002424 del_airo_dev(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002425 free_netdev( dev );
2426}
2427
2428EXPORT_SYMBOL(stop_airo_card);
2429
Stephen Hemmingerb95cce32007-09-26 22:13:38 -07002430static int wll_header_parse(const struct sk_buff *skb, unsigned char *haddr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002431{
Arnaldo Carvalho de Melo98e399f2007-03-19 15:33:04 -07002432 memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002433 return ETH_ALEN;
2434}
2435
2436static void mpi_unmap_card(struct pci_dev *pci)
2437{
2438 unsigned long mem_start = pci_resource_start(pci, 1);
2439 unsigned long mem_len = pci_resource_len(pci, 1);
2440 unsigned long aux_start = pci_resource_start(pci, 2);
2441 unsigned long aux_len = AUXMEMSIZE;
2442
2443 release_mem_region(aux_start, aux_len);
2444 release_mem_region(mem_start, mem_len);
2445}
2446
2447/*************************************************************
2448 * This routine assumes that descriptors have been setup .
2449 * Run at insmod time or after reset when the decriptors
2450 * have been initialized . Returns 0 if all is well nz
2451 * otherwise . Does not allocate memory but sets up card
2452 * using previously allocated descriptors.
2453 */
2454static int mpi_init_descriptors (struct airo_info *ai)
2455{
2456 Cmd cmd;
2457 Resp rsp;
2458 int i;
2459 int rc = SUCCESS;
2460
2461 /* Alloc card RX descriptors */
2462 netif_stop_queue(ai->dev);
2463
2464 memset(&rsp,0,sizeof(rsp));
2465 memset(&cmd,0,sizeof(cmd));
2466
2467 cmd.cmd = CMD_ALLOCATEAUX;
2468 cmd.parm0 = FID_RX;
2469 cmd.parm1 = (ai->rxfids[0].card_ram_off - ai->pciaux);
2470 cmd.parm2 = MPI_MAX_FIDS;
2471 rc=issuecommand(ai, &cmd, &rsp);
2472 if (rc != SUCCESS) {
Dan Williams934d8bf2006-03-16 13:46:23 -05002473 airo_print_err(ai->dev->name, "Couldn't allocate RX FID");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002474 return rc;
2475 }
2476
2477 for (i=0; i<MPI_MAX_FIDS; i++) {
2478 memcpy_toio(ai->rxfids[i].card_ram_off,
2479 &ai->rxfids[i].rx_desc, sizeof(RxFid));
2480 }
2481
2482 /* Alloc card TX descriptors */
2483
2484 memset(&rsp,0,sizeof(rsp));
2485 memset(&cmd,0,sizeof(cmd));
2486
2487 cmd.cmd = CMD_ALLOCATEAUX;
2488 cmd.parm0 = FID_TX;
2489 cmd.parm1 = (ai->txfids[0].card_ram_off - ai->pciaux);
2490 cmd.parm2 = MPI_MAX_FIDS;
2491
2492 for (i=0; i<MPI_MAX_FIDS; i++) {
2493 ai->txfids[i].tx_desc.valid = 1;
2494 memcpy_toio(ai->txfids[i].card_ram_off,
2495 &ai->txfids[i].tx_desc, sizeof(TxFid));
2496 }
2497 ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2498
2499 rc=issuecommand(ai, &cmd, &rsp);
2500 if (rc != SUCCESS) {
Dan Williams934d8bf2006-03-16 13:46:23 -05002501 airo_print_err(ai->dev->name, "Couldn't allocate TX FID");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002502 return rc;
2503 }
2504
2505 /* Alloc card Rid descriptor */
2506 memset(&rsp,0,sizeof(rsp));
2507 memset(&cmd,0,sizeof(cmd));
2508
2509 cmd.cmd = CMD_ALLOCATEAUX;
2510 cmd.parm0 = RID_RW;
2511 cmd.parm1 = (ai->config_desc.card_ram_off - ai->pciaux);
2512 cmd.parm2 = 1; /* Magic number... */
2513 rc=issuecommand(ai, &cmd, &rsp);
2514 if (rc != SUCCESS) {
Dan Williams934d8bf2006-03-16 13:46:23 -05002515 airo_print_err(ai->dev->name, "Couldn't allocate RID");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002516 return rc;
2517 }
2518
2519 memcpy_toio(ai->config_desc.card_ram_off,
2520 &ai->config_desc.rid_desc, sizeof(Rid));
2521
2522 return rc;
2523}
2524
2525/*
2526 * We are setting up three things here:
2527 * 1) Map AUX memory for descriptors: Rid, TxFid, or RxFid.
2528 * 2) Map PCI memory for issueing commands.
2529 * 3) Allocate memory (shared) to send and receive ethernet frames.
2530 */
Michal Schmidt1138c372007-06-29 15:33:41 +02002531static int mpi_map_card(struct airo_info *ai, struct pci_dev *pci)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002532{
2533 unsigned long mem_start, mem_len, aux_start, aux_len;
2534 int rc = -1;
2535 int i;
Jeff Garzik2759c8d2005-09-24 04:09:04 -04002536 dma_addr_t busaddroff;
2537 unsigned char *vpackoff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002538 unsigned char __iomem *pciaddroff;
2539
2540 mem_start = pci_resource_start(pci, 1);
2541 mem_len = pci_resource_len(pci, 1);
2542 aux_start = pci_resource_start(pci, 2);
2543 aux_len = AUXMEMSIZE;
2544
Michal Schmidt1138c372007-06-29 15:33:41 +02002545 if (!request_mem_region(mem_start, mem_len, DRV_NAME)) {
2546 airo_print_err("", "Couldn't get region %x[%x]",
2547 (int)mem_start, (int)mem_len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002548 goto out;
2549 }
Michal Schmidt1138c372007-06-29 15:33:41 +02002550 if (!request_mem_region(aux_start, aux_len, DRV_NAME)) {
2551 airo_print_err("", "Couldn't get region %x[%x]",
2552 (int)aux_start, (int)aux_len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002553 goto free_region1;
2554 }
2555
2556 ai->pcimem = ioremap(mem_start, mem_len);
2557 if (!ai->pcimem) {
Michal Schmidt1138c372007-06-29 15:33:41 +02002558 airo_print_err("", "Couldn't map region %x[%x]",
2559 (int)mem_start, (int)mem_len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002560 goto free_region2;
2561 }
2562 ai->pciaux = ioremap(aux_start, aux_len);
2563 if (!ai->pciaux) {
Michal Schmidt1138c372007-06-29 15:33:41 +02002564 airo_print_err("", "Couldn't map region %x[%x]",
2565 (int)aux_start, (int)aux_len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002566 goto free_memmap;
2567 }
2568
2569 /* Reserve PKTSIZE for each fid and 2K for the Rids */
2570 ai->shared = pci_alloc_consistent(pci, PCI_SHARED_LEN, &ai->shared_dma);
2571 if (!ai->shared) {
Michal Schmidt1138c372007-06-29 15:33:41 +02002572 airo_print_err("", "Couldn't alloc_consistent %d",
2573 PCI_SHARED_LEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002574 goto free_auxmap;
2575 }
2576
2577 /*
2578 * Setup descriptor RX, TX, CONFIG
2579 */
Jeff Garzik2759c8d2005-09-24 04:09:04 -04002580 busaddroff = ai->shared_dma;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002581 pciaddroff = ai->pciaux + AUX_OFFSET;
2582 vpackoff = ai->shared;
2583
2584 /* RX descriptor setup */
2585 for(i = 0; i < MPI_MAX_FIDS; i++) {
2586 ai->rxfids[i].pending = 0;
2587 ai->rxfids[i].card_ram_off = pciaddroff;
2588 ai->rxfids[i].virtual_host_addr = vpackoff;
Jeff Garzik2759c8d2005-09-24 04:09:04 -04002589 ai->rxfids[i].rx_desc.host_addr = busaddroff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002590 ai->rxfids[i].rx_desc.valid = 1;
2591 ai->rxfids[i].rx_desc.len = PKTSIZE;
2592 ai->rxfids[i].rx_desc.rdy = 0;
2593
2594 pciaddroff += sizeof(RxFid);
2595 busaddroff += PKTSIZE;
2596 vpackoff += PKTSIZE;
2597 }
2598
2599 /* TX descriptor setup */
2600 for(i = 0; i < MPI_MAX_FIDS; i++) {
2601 ai->txfids[i].card_ram_off = pciaddroff;
2602 ai->txfids[i].virtual_host_addr = vpackoff;
2603 ai->txfids[i].tx_desc.valid = 1;
Jeff Garzik2759c8d2005-09-24 04:09:04 -04002604 ai->txfids[i].tx_desc.host_addr = busaddroff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002605 memcpy(ai->txfids[i].virtual_host_addr,
2606 &wifictlhdr8023, sizeof(wifictlhdr8023));
2607
2608 pciaddroff += sizeof(TxFid);
2609 busaddroff += PKTSIZE;
2610 vpackoff += PKTSIZE;
2611 }
2612 ai->txfids[i-1].tx_desc.eoc = 1; /* Last descriptor has EOC set */
2613
2614 /* Rid descriptor setup */
2615 ai->config_desc.card_ram_off = pciaddroff;
2616 ai->config_desc.virtual_host_addr = vpackoff;
Jeff Garzik2759c8d2005-09-24 04:09:04 -04002617 ai->config_desc.rid_desc.host_addr = busaddroff;
2618 ai->ridbus = busaddroff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002619 ai->config_desc.rid_desc.rid = 0;
2620 ai->config_desc.rid_desc.len = RIDSIZE;
2621 ai->config_desc.rid_desc.valid = 1;
2622 pciaddroff += sizeof(Rid);
2623 busaddroff += RIDSIZE;
2624 vpackoff += RIDSIZE;
2625
2626 /* Tell card about descriptors */
2627 if (mpi_init_descriptors (ai) != SUCCESS)
2628 goto free_shared;
2629
2630 return 0;
2631 free_shared:
2632 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2633 free_auxmap:
2634 iounmap(ai->pciaux);
2635 free_memmap:
2636 iounmap(ai->pcimem);
2637 free_region2:
2638 release_mem_region(aux_start, aux_len);
2639 free_region1:
2640 release_mem_region(mem_start, mem_len);
2641 out:
2642 return rc;
2643}
2644
Stephen Hemminger3b04ddd2007-10-09 01:40:57 -07002645static const struct header_ops airo_header_ops = {
2646 .parse = wll_header_parse,
2647};
2648
Linus Torvalds1da177e2005-04-16 15:20:36 -07002649static void wifi_setup(struct net_device *dev)
2650{
Stephen Hemminger3b04ddd2007-10-09 01:40:57 -07002651 dev->header_ops = &airo_header_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002652 dev->hard_start_xmit = &airo_start_xmit11;
2653 dev->get_stats = &airo_get_stats;
2654 dev->set_mac_address = &airo_set_mac_address;
2655 dev->do_ioctl = &airo_ioctl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002656 dev->wireless_handlers = &airo_handler_def;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002657 dev->change_mtu = &airo_change_mtu;
2658 dev->open = &airo_open;
2659 dev->stop = &airo_close;
2660
2661 dev->type = ARPHRD_IEEE80211;
2662 dev->hard_header_len = ETH_HLEN;
Dan Williams15db2762006-03-16 13:46:27 -05002663 dev->mtu = AIRO_DEF_MTU;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002664 dev->addr_len = ETH_ALEN;
2665 dev->tx_queue_len = 100;
2666
2667 memset(dev->broadcast,0xFF, ETH_ALEN);
2668
2669 dev->flags = IFF_BROADCAST|IFF_MULTICAST;
2670}
2671
2672static struct net_device *init_wifidev(struct airo_info *ai,
2673 struct net_device *ethdev)
2674{
2675 int err;
2676 struct net_device *dev = alloc_netdev(0, "wifi%d", wifi_setup);
2677 if (!dev)
2678 return NULL;
Wang Chenfaf39942008-10-14 13:30:33 +08002679 dev->ml_priv = ethdev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002680 dev->irq = ethdev->irq;
2681 dev->base_addr = ethdev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002682 dev->wireless_data = ethdev->wireless_data;
Masakazu Mokuno229ce3a2008-05-14 14:16:50 +09002683 SET_NETDEV_DEV(dev, ethdev->dev.parent);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002684 memcpy(dev->dev_addr, ethdev->dev_addr, dev->addr_len);
2685 err = register_netdev(dev);
2686 if (err<0) {
2687 free_netdev(dev);
2688 return NULL;
2689 }
2690 return dev;
2691}
2692
Jouni Malinenff1d2762005-05-12 22:54:16 -04002693static int reset_card( struct net_device *dev , int lock) {
Wang Chenfaf39942008-10-14 13:30:33 +08002694 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002695
2696 if (lock && down_interruptible(&ai->sem))
2697 return -1;
2698 waitbusy (ai);
2699 OUT4500(ai,COMMAND,CMD_SOFTRESET);
2700 msleep(200);
2701 waitbusy (ai);
2702 msleep(200);
2703 if (lock)
2704 up(&ai->sem);
2705 return 0;
2706}
2707
Dan Williams3c304952006-04-15 12:26:18 -04002708#define AIRO_MAX_NETWORK_COUNT 64
Dan Williams9e75af32006-03-16 13:46:29 -05002709static int airo_networks_allocate(struct airo_info *ai)
2710{
2711 if (ai->networks)
2712 return 0;
2713
2714 ai->networks =
Dan Williams3c304952006-04-15 12:26:18 -04002715 kzalloc(AIRO_MAX_NETWORK_COUNT * sizeof(BSSListElement),
Dan Williams9e75af32006-03-16 13:46:29 -05002716 GFP_KERNEL);
2717 if (!ai->networks) {
Michal Schmidt1138c372007-06-29 15:33:41 +02002718 airo_print_warn("", "Out of memory allocating beacons");
Dan Williams9e75af32006-03-16 13:46:29 -05002719 return -ENOMEM;
2720 }
2721
2722 return 0;
2723}
2724
2725static void airo_networks_free(struct airo_info *ai)
2726{
Dan Williams9e75af32006-03-16 13:46:29 -05002727 kfree(ai->networks);
2728 ai->networks = NULL;
2729}
2730
2731static void airo_networks_initialize(struct airo_info *ai)
2732{
2733 int i;
2734
2735 INIT_LIST_HEAD(&ai->network_free_list);
2736 INIT_LIST_HEAD(&ai->network_list);
Dan Williams3c304952006-04-15 12:26:18 -04002737 for (i = 0; i < AIRO_MAX_NETWORK_COUNT; i++)
Dan Williams9e75af32006-03-16 13:46:29 -05002738 list_add_tail(&ai->networks[i].list,
2739 &ai->network_free_list);
2740}
2741
Jouni Malinenff1d2762005-05-12 22:54:16 -04002742static struct net_device *_init_airo_card( unsigned short irq, int port,
2743 int is_pcmcia, struct pci_dev *pci,
2744 struct device *dmdev )
Linus Torvalds1da177e2005-04-16 15:20:36 -07002745{
2746 struct net_device *dev;
2747 struct airo_info *ai;
2748 int i, rc;
Dan Williamsf65b56d2009-01-24 09:10:42 -05002749 CapabilityRid cap_rid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002750
2751 /* Create the network device object. */
Michal Schmidt1138c372007-06-29 15:33:41 +02002752 dev = alloc_netdev(sizeof(*ai), "", ether_setup);
2753 if (!dev) {
Dan Williams934d8bf2006-03-16 13:46:23 -05002754 airo_print_err("", "Couldn't alloc_etherdev");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002755 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002756 }
2757
Wang Chenfaf39942008-10-14 13:30:33 +08002758 ai = dev->ml_priv = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002759 ai->wifidev = NULL;
Michal Schmidtfb038c22007-06-29 15:33:52 +02002760 ai->flags = 1 << FLAG_RADIO_DOWN;
Dan Williams3c304952006-04-15 12:26:18 -04002761 ai->jobs = 0;
Dan Williams934d8bf2006-03-16 13:46:23 -05002762 ai->dev = dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002763 if (pci && (pci->device == 0x5000 || pci->device == 0xa504)) {
Michal Schmidt1138c372007-06-29 15:33:41 +02002764 airo_print_dbg("", "Found an MPI350 card");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002765 set_bit(FLAG_MPI, &ai->flags);
2766 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002767 spin_lock_init(&ai->aux_lock);
2768 sema_init(&ai->sem, 1);
2769 ai->config.len = 0;
2770 ai->pci = pci;
2771 init_waitqueue_head (&ai->thr_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002772 ai->tfm = NULL;
Michal Schmidtaf5b5c92007-03-16 12:44:40 +01002773 add_airo_dev(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002774
Dan Williams9e75af32006-03-16 13:46:29 -05002775 if (airo_networks_allocate (ai))
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02002776 goto err_out_free;
Dan Williams9e75af32006-03-16 13:46:29 -05002777 airo_networks_initialize (ai);
2778
Linus Torvalds1da177e2005-04-16 15:20:36 -07002779 /* The Airo-specific entries in the device structure. */
2780 if (test_bit(FLAG_MPI,&ai->flags)) {
2781 skb_queue_head_init (&ai->txq);
2782 dev->hard_start_xmit = &mpi_start_xmit;
2783 } else
2784 dev->hard_start_xmit = &airo_start_xmit;
2785 dev->get_stats = &airo_get_stats;
2786 dev->set_multicast_list = &airo_set_multicast_list;
2787 dev->set_mac_address = &airo_set_mac_address;
2788 dev->do_ioctl = &airo_ioctl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002789 dev->wireless_handlers = &airo_handler_def;
2790 ai->wireless_data.spy_data = &ai->spy_data;
2791 dev->wireless_data = &ai->wireless_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002792 dev->change_mtu = &airo_change_mtu;
2793 dev->open = &airo_open;
2794 dev->stop = &airo_close;
2795 dev->irq = irq;
2796 dev->base_addr = port;
2797
2798 SET_NETDEV_DEV(dev, dmdev);
2799
Matthieu CASTET1d97f382005-12-01 02:35:26 -05002800 reset_card (dev, 1);
2801 msleep(400);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002802
Linus Torvalds1da177e2005-04-16 15:20:36 -07002803 if (!is_pcmcia) {
Michal Schmidt1138c372007-06-29 15:33:41 +02002804 if (!request_region(dev->base_addr, 64, DRV_NAME)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002805 rc = -EBUSY;
Dan Williams934d8bf2006-03-16 13:46:23 -05002806 airo_print_err(dev->name, "Couldn't request region");
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02002807 goto err_out_nets;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002808 }
2809 }
2810
2811 if (test_bit(FLAG_MPI,&ai->flags)) {
Michal Schmidt1138c372007-06-29 15:33:41 +02002812 if (mpi_map_card(ai, pci)) {
2813 airo_print_err("", "Could not map memory");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002814 goto err_out_res;
2815 }
2816 }
2817
2818 if (probe) {
Dan Williamsf65b56d2009-01-24 09:10:42 -05002819 if (setup_card(ai, dev->dev_addr, 1) != SUCCESS) {
Dan Williams934d8bf2006-03-16 13:46:23 -05002820 airo_print_err(dev->name, "MAC could not be enabled" );
Linus Torvalds1da177e2005-04-16 15:20:36 -07002821 rc = -EIO;
2822 goto err_out_map;
2823 }
2824 } else if (!test_bit(FLAG_MPI,&ai->flags)) {
2825 ai->bap_read = fast_bap_read;
2826 set_bit(FLAG_FLASHING, &ai->flags);
2827 }
2828
Michal Schmidt1138c372007-06-29 15:33:41 +02002829 strcpy(dev->name, "eth%d");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002830 rc = register_netdev(dev);
2831 if (rc) {
Dan Williams934d8bf2006-03-16 13:46:23 -05002832 airo_print_err(dev->name, "Couldn't register_netdev");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002833 goto err_out_map;
2834 }
2835 ai->wifidev = init_wifidev(ai, dev);
Florin Malita431aca52006-10-10 16:46:30 -04002836 if (!ai->wifidev)
2837 goto err_out_reg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002838
Dan Williamsf65b56d2009-01-24 09:10:42 -05002839 rc = readCapabilityRid(ai, &cap_rid, 1);
2840 if (rc != SUCCESS) {
2841 rc = -EIO;
2842 goto err_out_wifi;
2843 }
Dan Williams138c0c62009-01-24 09:11:35 -05002844 /* WEP capability discovery */
2845 ai->wep_capable = (cap_rid.softCap & cpu_to_le16(0x02)) ? 1 : 0;
2846 ai->max_wep_idx = (cap_rid.softCap & cpu_to_le16(0x80)) ? 3 : 0;
Dan Williamsf65b56d2009-01-24 09:10:42 -05002847
2848 airo_print_info(dev->name, "Firmware version %x.%x.%02x",
2849 ((le16_to_cpu(cap_rid.softVer) >> 8) & 0xF),
2850 (le16_to_cpu(cap_rid.softVer) & 0xFF),
2851 le16_to_cpu(cap_rid.softSubVer));
2852
2853 /* Test for WPA support */
2854 /* Only firmware versions 5.30.17 or better can do WPA */
2855 if (le16_to_cpu(cap_rid.softVer) > 0x530
2856 || (le16_to_cpu(cap_rid.softVer) == 0x530
2857 && le16_to_cpu(cap_rid.softSubVer) >= 17)) {
2858 airo_print_info(ai->dev->name, "WPA supported.");
2859
2860 set_bit(FLAG_WPA_CAPABLE, &ai->flags);
2861 ai->bssListFirst = RID_WPA_BSSLISTFIRST;
2862 ai->bssListNext = RID_WPA_BSSLISTNEXT;
2863 ai->bssListRidLen = sizeof(BSSListRid);
2864 } else {
2865 airo_print_info(ai->dev->name, "WPA unsupported with firmware "
2866 "versions older than 5.30.17.");
2867
2868 ai->bssListFirst = RID_BSSLISTFIRST;
2869 ai->bssListNext = RID_BSSLISTNEXT;
2870 ai->bssListRidLen = sizeof(BSSListRid) - sizeof(BSSListRidExtra);
2871 }
2872
Linus Torvalds1da177e2005-04-16 15:20:36 -07002873 set_bit(FLAG_REGISTERED,&ai->flags);
Johannes Berge1749612008-10-27 15:59:26 -07002874 airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002875
2876 /* Allocate the transmit buffers */
2877 if (probe && !test_bit(FLAG_MPI,&ai->flags))
2878 for( i = 0; i < MAX_FIDS; i++ )
Dan Williams15db2762006-03-16 13:46:27 -05002879 ai->fids[i] = transmit_allocate(ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002880
Wang Chenfaf39942008-10-14 13:30:33 +08002881 if (setup_proc_entry(dev, dev->ml_priv) < 0)
Florin Malita431aca52006-10-10 16:46:30 -04002882 goto err_out_wifi;
2883
Linus Torvalds1da177e2005-04-16 15:20:36 -07002884 return dev;
2885
Florin Malita431aca52006-10-10 16:46:30 -04002886err_out_wifi:
2887 unregister_netdev(ai->wifidev);
2888 free_netdev(ai->wifidev);
2889err_out_reg:
2890 unregister_netdev(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002891err_out_map:
2892 if (test_bit(FLAG_MPI,&ai->flags) && pci) {
2893 pci_free_consistent(pci, PCI_SHARED_LEN, ai->shared, ai->shared_dma);
2894 iounmap(ai->pciaux);
2895 iounmap(ai->pcimem);
2896 mpi_unmap_card(ai->pci);
2897 }
2898err_out_res:
2899 if (!is_pcmcia)
2900 release_region( dev->base_addr, 64 );
Michal Schmidt4d881902007-03-16 12:42:59 +01002901err_out_nets:
2902 airo_networks_free(ai);
Michal Schmidtaf5b5c92007-03-16 12:44:40 +01002903 del_airo_dev(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002904err_out_free:
2905 free_netdev(dev);
2906 return NULL;
2907}
2908
2909struct net_device *init_airo_card( unsigned short irq, int port, int is_pcmcia,
2910 struct device *dmdev)
2911{
2912 return _init_airo_card ( irq, port, is_pcmcia, NULL, dmdev);
2913}
2914
2915EXPORT_SYMBOL(init_airo_card);
2916
2917static int waitbusy (struct airo_info *ai) {
2918 int delay = 0;
Andrew Mortonb212f332008-05-28 12:40:39 -07002919 while ((IN4500(ai, COMMAND) & COMMAND_BUSY) && (delay < 10000)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002920 udelay (10);
2921 if ((++delay % 20) == 0)
2922 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
2923 }
2924 return delay < 10000;
2925}
2926
2927int reset_airo_card( struct net_device *dev )
2928{
2929 int i;
Wang Chenfaf39942008-10-14 13:30:33 +08002930 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002931
2932 if (reset_card (dev, 1))
2933 return -1;
2934
2935 if ( setup_card(ai, dev->dev_addr, 1 ) != SUCCESS ) {
Dan Williams934d8bf2006-03-16 13:46:23 -05002936 airo_print_err(dev->name, "MAC could not be enabled");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002937 return -1;
2938 }
Johannes Berge1749612008-10-27 15:59:26 -07002939 airo_print_info(dev->name, "MAC enabled %pM", dev->dev_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002940 /* Allocate the transmit buffers if needed */
2941 if (!test_bit(FLAG_MPI,&ai->flags))
2942 for( i = 0; i < MAX_FIDS; i++ )
Dan Williams15db2762006-03-16 13:46:27 -05002943 ai->fids[i] = transmit_allocate (ai,AIRO_DEF_MTU,i>=MAX_FIDS/2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002944
2945 enable_interrupts( ai );
2946 netif_wake_queue(dev);
2947 return 0;
2948}
2949
2950EXPORT_SYMBOL(reset_airo_card);
2951
2952static void airo_send_event(struct net_device *dev) {
Wang Chenfaf39942008-10-14 13:30:33 +08002953 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002954 union iwreq_data wrqu;
2955 StatusRid status_rid;
2956
Dan Williams3c304952006-04-15 12:26:18 -04002957 clear_bit(JOB_EVENT, &ai->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002958 PC4500_readrid(ai, RID_STATUS, &status_rid, sizeof(status_rid), 0);
2959 up(&ai->sem);
2960 wrqu.data.length = 0;
2961 wrqu.data.flags = 0;
2962 memcpy(wrqu.ap_addr.sa_data, status_rid.bssid[0], ETH_ALEN);
2963 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
2964
2965 /* Send event to user space */
2966 wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
2967}
2968
Dan Williams9e75af32006-03-16 13:46:29 -05002969static void airo_process_scan_results (struct airo_info *ai) {
2970 union iwreq_data wrqu;
Dan Williams3c304952006-04-15 12:26:18 -04002971 BSSListRid bss;
Dan Williams9e75af32006-03-16 13:46:29 -05002972 int rc;
2973 BSSListElement * loop_net;
2974 BSSListElement * tmp_net;
2975
2976 /* Blow away current list of scan results */
2977 list_for_each_entry_safe (loop_net, tmp_net, &ai->network_list, list) {
2978 list_move_tail (&loop_net->list, &ai->network_free_list);
2979 /* Don't blow away ->list, just BSS data */
2980 memset (loop_net, 0, sizeof (loop_net->bss));
2981 }
2982
2983 /* Try to read the first entry of the scan result */
Dan Williams3c304952006-04-15 12:26:18 -04002984 rc = PC4500_readrid(ai, ai->bssListFirst, &bss, ai->bssListRidLen, 0);
Al Viro17e70492007-12-19 18:56:37 -05002985 if((rc) || (bss.index == cpu_to_le16(0xffff))) {
Dan Williams9e75af32006-03-16 13:46:29 -05002986 /* No scan results */
2987 goto out;
2988 }
2989
2990 /* Read and parse all entries */
2991 tmp_net = NULL;
Al Viro17e70492007-12-19 18:56:37 -05002992 while((!rc) && (bss.index != cpu_to_le16(0xffff))) {
Dan Williams9e75af32006-03-16 13:46:29 -05002993 /* Grab a network off the free list */
2994 if (!list_empty(&ai->network_free_list)) {
2995 tmp_net = list_entry(ai->network_free_list.next,
2996 BSSListElement, list);
2997 list_del(ai->network_free_list.next);
2998 }
2999
3000 if (tmp_net != NULL) {
Dan Williams3c304952006-04-15 12:26:18 -04003001 memcpy(tmp_net, &bss, sizeof(tmp_net->bss));
Dan Williams9e75af32006-03-16 13:46:29 -05003002 list_add_tail(&tmp_net->list, &ai->network_list);
3003 tmp_net = NULL;
3004 }
3005
3006 /* Read next entry */
Dan Williams3c304952006-04-15 12:26:18 -04003007 rc = PC4500_readrid(ai, ai->bssListNext,
3008 &bss, ai->bssListRidLen, 0);
Dan Williams9e75af32006-03-16 13:46:29 -05003009 }
3010
3011out:
3012 ai->scan_timeout = 0;
Dan Williams3c304952006-04-15 12:26:18 -04003013 clear_bit(JOB_SCAN_RESULTS, &ai->jobs);
Dan Williams9e75af32006-03-16 13:46:29 -05003014 up(&ai->sem);
3015
3016 /* Send an empty event to user space.
3017 * We don't send the received data on
3018 * the event because it would require
3019 * us to do complex transcoding, and
3020 * we want to minimise the work done in
3021 * the irq handler. Use a request to
3022 * extract the data - Jean II */
3023 wrqu.data.length = 0;
3024 wrqu.data.flags = 0;
3025 wireless_send_event(ai->dev, SIOCGIWSCAN, &wrqu, NULL);
3026}
3027
Linus Torvalds1da177e2005-04-16 15:20:36 -07003028static int airo_thread(void *data) {
3029 struct net_device *dev = data;
Wang Chenfaf39942008-10-14 13:30:33 +08003030 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003031 int locked;
Rafael J. Wysocki83144182007-07-17 04:03:35 -07003032
3033 set_freezable();
Linus Torvalds1da177e2005-04-16 15:20:36 -07003034 while(1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003035 /* make swsusp happy with our thread */
Christoph Lameter3e1d1d22005-06-24 23:13:50 -07003036 try_to_freeze();
Linus Torvalds1da177e2005-04-16 15:20:36 -07003037
Dan Williams3c304952006-04-15 12:26:18 -04003038 if (test_bit(JOB_DIE, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003039 break;
3040
Dan Williams3c304952006-04-15 12:26:18 -04003041 if (ai->jobs) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003042 locked = down_interruptible(&ai->sem);
3043 } else {
3044 wait_queue_t wait;
3045
3046 init_waitqueue_entry(&wait, current);
3047 add_wait_queue(&ai->thr_wait, &wait);
3048 for (;;) {
3049 set_current_state(TASK_INTERRUPTIBLE);
Dan Williams3c304952006-04-15 12:26:18 -04003050 if (ai->jobs)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003051 break;
Dan Williams9e75af32006-03-16 13:46:29 -05003052 if (ai->expires || ai->scan_timeout) {
3053 if (ai->scan_timeout &&
3054 time_after_eq(jiffies,ai->scan_timeout)){
Dan Williams3c304952006-04-15 12:26:18 -04003055 set_bit(JOB_SCAN_RESULTS, &ai->jobs);
Dan Williams9e75af32006-03-16 13:46:29 -05003056 break;
3057 } else if (ai->expires &&
3058 time_after_eq(jiffies,ai->expires)){
Dan Williams3c304952006-04-15 12:26:18 -04003059 set_bit(JOB_AUTOWEP, &ai->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003060 break;
3061 }
Dave Kleikamp5bb85f12006-10-10 14:45:46 -07003062 if (!kthread_should_stop() &&
3063 !freezing(current)) {
Dan Williams9e75af32006-03-16 13:46:29 -05003064 unsigned long wake_at;
3065 if (!ai->expires || !ai->scan_timeout) {
3066 wake_at = max(ai->expires,
3067 ai->scan_timeout);
3068 } else {
3069 wake_at = min(ai->expires,
3070 ai->scan_timeout);
3071 }
3072 schedule_timeout(wake_at - jiffies);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003073 continue;
3074 }
Dave Kleikamp5bb85f12006-10-10 14:45:46 -07003075 } else if (!kthread_should_stop() &&
3076 !freezing(current)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003077 schedule();
3078 continue;
3079 }
3080 break;
3081 }
3082 current->state = TASK_RUNNING;
3083 remove_wait_queue(&ai->thr_wait, &wait);
3084 locked = 1;
3085 }
3086
3087 if (locked)
3088 continue;
3089
Dan Williams3c304952006-04-15 12:26:18 -04003090 if (test_bit(JOB_DIE, &ai->jobs)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003091 up(&ai->sem);
3092 break;
3093 }
3094
Pavel Machekca078ba2005-09-03 15:56:57 -07003095 if (ai->power.event || test_bit(FLAG_FLASHING, &ai->flags)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003096 up(&ai->sem);
3097 continue;
3098 }
3099
Dan Williams3c304952006-04-15 12:26:18 -04003100 if (test_bit(JOB_XMIT, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003101 airo_end_xmit(dev);
Dan Williams3c304952006-04-15 12:26:18 -04003102 else if (test_bit(JOB_XMIT11, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003103 airo_end_xmit11(dev);
Dan Williams3c304952006-04-15 12:26:18 -04003104 else if (test_bit(JOB_STATS, &ai->jobs))
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03003105 airo_read_stats(dev);
Dan Williams3c304952006-04-15 12:26:18 -04003106 else if (test_bit(JOB_WSTATS, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003107 airo_read_wireless_stats(ai);
Dan Williams3c304952006-04-15 12:26:18 -04003108 else if (test_bit(JOB_PROMISC, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003109 airo_set_promisc(ai);
Dan Williams3c304952006-04-15 12:26:18 -04003110 else if (test_bit(JOB_MIC, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003111 micinit(ai);
Dan Williams3c304952006-04-15 12:26:18 -04003112 else if (test_bit(JOB_EVENT, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003113 airo_send_event(dev);
Dan Williams3c304952006-04-15 12:26:18 -04003114 else if (test_bit(JOB_AUTOWEP, &ai->jobs))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003115 timer_func(dev);
Dan Williams3c304952006-04-15 12:26:18 -04003116 else if (test_bit(JOB_SCAN_RESULTS, &ai->jobs))
Dan Williams9e75af32006-03-16 13:46:29 -05003117 airo_process_scan_results(ai);
3118 else /* Shouldn't get here, but we make sure to unlock */
3119 up(&ai->sem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003120 }
Sukadev Bhattiprolu3b4c7d642006-08-14 23:12:03 -07003121
3122 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003123}
3124
Al Viro0300b332007-12-19 22:38:33 -05003125static int header_len(__le16 ctl)
3126{
3127 u16 fc = le16_to_cpu(ctl);
3128 switch (fc & 0xc) {
3129 case 4:
3130 if ((fc & 0xe0) == 0xc0)
3131 return 10; /* one-address control packet */
3132 return 16; /* two-address control packet */
3133 case 8:
3134 if ((fc & 0x300) == 0x300)
3135 return 30; /* WDS packet */
3136 }
3137 return 24;
3138}
3139
Dan Williamsf55d4512009-01-24 09:04:12 -05003140static void airo_handle_cisco_mic(struct airo_info *ai)
3141{
3142 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags)) {
3143 set_bit(JOB_MIC, &ai->jobs);
3144 wake_up_interruptible(&ai->thr_wait);
3145 }
3146}
3147
3148/* Airo Status codes */
3149#define STAT_NOBEACON 0x8000 /* Loss of sync - missed beacons */
3150#define STAT_MAXRETRIES 0x8001 /* Loss of sync - max retries */
3151#define STAT_MAXARL 0x8002 /* Loss of sync - average retry level exceeded*/
3152#define STAT_FORCELOSS 0x8003 /* Loss of sync - host request */
3153#define STAT_TSFSYNC 0x8004 /* Loss of sync - TSF synchronization */
3154#define STAT_DEAUTH 0x8100 /* low byte is 802.11 reason code */
3155#define STAT_DISASSOC 0x8200 /* low byte is 802.11 reason code */
3156#define STAT_ASSOC_FAIL 0x8400 /* low byte is 802.11 reason code */
3157#define STAT_AUTH_FAIL 0x0300 /* low byte is 802.11 reason code */
3158#define STAT_ASSOC 0x0400 /* Associated */
3159#define STAT_REASSOC 0x0600 /* Reassociated? Only on firmware >= 5.30.17 */
3160
3161static void airo_print_status(const char *devname, u16 status)
3162{
3163 u8 reason = status & 0xFF;
3164
3165 switch (status) {
3166 case STAT_NOBEACON:
3167 airo_print_dbg(devname, "link lost (missed beacons)");
3168 break;
3169 case STAT_MAXRETRIES:
3170 case STAT_MAXARL:
3171 airo_print_dbg(devname, "link lost (max retries)");
3172 break;
3173 case STAT_FORCELOSS:
3174 airo_print_dbg(devname, "link lost (local choice)");
3175 break;
3176 case STAT_TSFSYNC:
3177 airo_print_dbg(devname, "link lost (TSF sync lost)");
3178 break;
3179 case STAT_DEAUTH:
3180 airo_print_dbg(devname, "deauthenticated (reason: %d)", reason);
3181 break;
3182 case STAT_DISASSOC:
3183 airo_print_dbg(devname, "disassociated (reason: %d)", reason);
3184 break;
3185 case STAT_ASSOC_FAIL:
3186 airo_print_dbg(devname, "association failed (reason: %d)",
3187 reason);
3188 break;
3189 case STAT_AUTH_FAIL:
3190 airo_print_dbg(devname, "authentication failed (reason: %d)",
3191 reason);
3192 break;
3193 default:
3194 break;
3195 }
3196}
3197
3198static void airo_handle_link(struct airo_info *ai)
3199{
3200 union iwreq_data wrqu;
3201 int scan_forceloss = 0;
3202 u16 status;
3203
3204 /* Get new status and acknowledge the link change */
3205 status = le16_to_cpu(IN4500(ai, LINKSTAT));
3206 OUT4500(ai, EVACK, EV_LINK);
3207
3208 if ((status == STAT_FORCELOSS) && (ai->scan_timeout > 0))
3209 scan_forceloss = 1;
3210
3211 airo_print_status(ai->dev->name, status);
3212
3213 if ((status == STAT_ASSOC) || (status == STAT_REASSOC)) {
3214 if (auto_wep)
3215 ai->expires = 0;
3216 if (ai->list_bss_task)
3217 wake_up_process(ai->list_bss_task);
3218 set_bit(FLAG_UPDATE_UNI, &ai->flags);
3219 set_bit(FLAG_UPDATE_MULTI, &ai->flags);
3220
3221 if (down_trylock(&ai->sem) != 0) {
3222 set_bit(JOB_EVENT, &ai->jobs);
3223 wake_up_interruptible(&ai->thr_wait);
3224 } else
3225 airo_send_event(ai->dev);
3226 } else if (!scan_forceloss) {
3227 if (auto_wep && !ai->expires) {
3228 ai->expires = RUN_AT(3*HZ);
3229 wake_up_interruptible(&ai->thr_wait);
3230 }
3231
3232 /* Send event to user space */
3233 memset(wrqu.ap_addr.sa_data, '\0', ETH_ALEN);
3234 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
3235 wireless_send_event(ai->dev, SIOCGIWAP, &wrqu, NULL);
3236 }
3237}
3238
3239static void airo_handle_rx(struct airo_info *ai)
3240{
3241 struct sk_buff *skb = NULL;
3242 __le16 fc, v, *buffer, tmpbuf[4];
3243 u16 len, hdrlen = 0, gap, fid;
3244 struct rx_hdr hdr;
3245 int success = 0;
3246
3247 if (test_bit(FLAG_MPI, &ai->flags)) {
3248 if (test_bit(FLAG_802_11, &ai->flags))
3249 mpi_receive_802_11(ai);
3250 else
3251 mpi_receive_802_3(ai);
3252 OUT4500(ai, EVACK, EV_RX);
3253 return;
3254 }
3255
3256 fid = IN4500(ai, RXFID);
3257
3258 /* Get the packet length */
3259 if (test_bit(FLAG_802_11, &ai->flags)) {
3260 bap_setup (ai, fid, 4, BAP0);
3261 bap_read (ai, (__le16*)&hdr, sizeof(hdr), BAP0);
3262 /* Bad CRC. Ignore packet */
3263 if (le16_to_cpu(hdr.status) & 2)
3264 hdr.len = 0;
3265 if (ai->wifidev == NULL)
3266 hdr.len = 0;
3267 } else {
3268 bap_setup(ai, fid, 0x36, BAP0);
3269 bap_read(ai, &hdr.len, 2, BAP0);
3270 }
3271 len = le16_to_cpu(hdr.len);
3272
3273 if (len > AIRO_DEF_MTU) {
3274 airo_print_err(ai->dev->name, "Bad size %d", len);
3275 goto done;
3276 }
3277 if (len == 0)
3278 goto done;
3279
3280 if (test_bit(FLAG_802_11, &ai->flags)) {
3281 bap_read(ai, &fc, sizeof (fc), BAP0);
3282 hdrlen = header_len(fc);
3283 } else
3284 hdrlen = ETH_ALEN * 2;
3285
3286 skb = dev_alloc_skb(len + hdrlen + 2 + 2);
3287 if (!skb) {
3288 ai->dev->stats.rx_dropped++;
3289 goto done;
3290 }
3291
3292 skb_reserve(skb, 2); /* This way the IP header is aligned */
3293 buffer = (__le16 *) skb_put(skb, len + hdrlen);
3294 if (test_bit(FLAG_802_11, &ai->flags)) {
3295 buffer[0] = fc;
3296 bap_read(ai, buffer + 1, hdrlen - 2, BAP0);
3297 if (hdrlen == 24)
3298 bap_read(ai, tmpbuf, 6, BAP0);
3299
3300 bap_read(ai, &v, sizeof(v), BAP0);
3301 gap = le16_to_cpu(v);
3302 if (gap) {
3303 if (gap <= 8) {
3304 bap_read(ai, tmpbuf, gap, BAP0);
3305 } else {
3306 airo_print_err(ai->dev->name, "gaplen too "
3307 "big. Problems will follow...");
3308 }
3309 }
3310 bap_read(ai, buffer + hdrlen/2, len, BAP0);
3311 } else {
3312 MICBuffer micbuf;
3313
3314 bap_read(ai, buffer, ETH_ALEN * 2, BAP0);
3315 if (ai->micstats.enabled) {
3316 bap_read(ai, (__le16 *) &micbuf, sizeof (micbuf), BAP0);
3317 if (ntohs(micbuf.typelen) > 0x05DC)
3318 bap_setup(ai, fid, 0x44, BAP0);
3319 else {
3320 if (len <= sizeof (micbuf)) {
3321 dev_kfree_skb_irq(skb);
3322 goto done;
3323 }
3324
3325 len -= sizeof(micbuf);
3326 skb_trim(skb, len + hdrlen);
3327 }
3328 }
3329
3330 bap_read(ai, buffer + ETH_ALEN, len, BAP0);
3331 if (decapsulate(ai, &micbuf, (etherHead*) buffer, len))
3332 dev_kfree_skb_irq (skb);
3333 else
3334 success = 1;
3335 }
3336
3337#ifdef WIRELESS_SPY
3338 if (success && (ai->spy_data.spy_number > 0)) {
3339 char *sa;
3340 struct iw_quality wstats;
3341
3342 /* Prepare spy data : addr + qual */
3343 if (!test_bit(FLAG_802_11, &ai->flags)) {
3344 sa = (char *) buffer + 6;
3345 bap_setup(ai, fid, 8, BAP0);
3346 bap_read(ai, (__le16 *) hdr.rssi, 2, BAP0);
3347 } else
3348 sa = (char *) buffer + 10;
3349 wstats.qual = hdr.rssi[0];
3350 if (ai->rssi)
3351 wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3352 else
3353 wstats.level = (hdr.rssi[1] + 321) / 2;
3354 wstats.noise = ai->wstats.qual.noise;
3355 wstats.updated = IW_QUAL_LEVEL_UPDATED
3356 | IW_QUAL_QUAL_UPDATED
3357 | IW_QUAL_DBM;
3358 /* Update spy records */
3359 wireless_spy_update(ai->dev, sa, &wstats);
3360 }
3361#endif /* WIRELESS_SPY */
3362
3363done:
3364 OUT4500(ai, EVACK, EV_RX);
3365
3366 if (success) {
3367 if (test_bit(FLAG_802_11, &ai->flags)) {
3368 skb_reset_mac_header(skb);
3369 skb->pkt_type = PACKET_OTHERHOST;
3370 skb->dev = ai->wifidev;
3371 skb->protocol = htons(ETH_P_802_2);
3372 } else
3373 skb->protocol = eth_type_trans(skb, ai->dev);
3374 skb->ip_summed = CHECKSUM_NONE;
3375
3376 netif_rx(skb);
3377 }
3378}
3379
3380static void airo_handle_tx(struct airo_info *ai, u16 status)
3381{
3382 int i, len = 0, index = -1;
3383 u16 fid;
3384
3385 if (test_bit(FLAG_MPI, &ai->flags)) {
3386 unsigned long flags;
3387
3388 if (status & EV_TXEXC)
3389 get_tx_error(ai, -1);
3390
3391 spin_lock_irqsave(&ai->aux_lock, flags);
3392 if (!skb_queue_empty(&ai->txq)) {
3393 spin_unlock_irqrestore(&ai->aux_lock,flags);
3394 mpi_send_packet(ai->dev);
3395 } else {
3396 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
3397 spin_unlock_irqrestore(&ai->aux_lock,flags);
3398 netif_wake_queue(ai->dev);
3399 }
3400 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3401 return;
3402 }
3403
3404 fid = IN4500(ai, TXCOMPLFID);
3405
3406 for(i = 0; i < MAX_FIDS; i++) {
3407 if ((ai->fids[i] & 0xffff) == fid) {
3408 len = ai->fids[i] >> 16;
3409 index = i;
3410 }
3411 }
3412
3413 if (index != -1) {
3414 if (status & EV_TXEXC)
3415 get_tx_error(ai, index);
3416
3417 OUT4500(ai, EVACK, status & (EV_TX | EV_TXEXC));
3418
3419 /* Set up to be used again */
3420 ai->fids[index] &= 0xffff;
3421 if (index < MAX_FIDS / 2) {
3422 if (!test_bit(FLAG_PENDING_XMIT, &ai->flags))
3423 netif_wake_queue(ai->dev);
3424 } else {
3425 if (!test_bit(FLAG_PENDING_XMIT11, &ai->flags))
3426 netif_wake_queue(ai->wifidev);
3427 }
3428 } else {
3429 OUT4500(ai, EVACK, status & (EV_TX | EV_TXCPY | EV_TXEXC));
3430 airo_print_err(ai->dev->name, "Unallocated FID was used to xmit");
3431 }
3432}
3433
Jeff Garzik28fc1f52007-10-29 05:46:16 -04003434static irqreturn_t airo_interrupt(int irq, void *dev_id)
3435{
3436 struct net_device *dev = dev_id;
Dan Williamsf55d4512009-01-24 09:04:12 -05003437 u16 status, savedInterrupts = 0;
3438 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003439 int handled = 0;
3440
3441 if (!netif_device_present(dev))
3442 return IRQ_NONE;
3443
3444 for (;;) {
Dan Williamsf55d4512009-01-24 09:04:12 -05003445 status = IN4500(ai, EVSTAT);
3446 if (!(status & STATUS_INTS) || (status == 0xffff))
3447 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003448
3449 handled = 1;
3450
Dan Williamsf55d4512009-01-24 09:04:12 -05003451 if (status & EV_AWAKE) {
3452 OUT4500(ai, EVACK, EV_AWAKE);
3453 OUT4500(ai, EVACK, EV_AWAKE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003454 }
3455
3456 if (!savedInterrupts) {
Dan Williamsf55d4512009-01-24 09:04:12 -05003457 savedInterrupts = IN4500(ai, EVINTEN);
3458 OUT4500(ai, EVINTEN, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003459 }
3460
Dan Williamsf55d4512009-01-24 09:04:12 -05003461 if (status & EV_MIC) {
3462 OUT4500(ai, EVACK, EV_MIC);
3463 airo_handle_cisco_mic(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003464 }
Dan Williams6fcdf562006-03-31 15:08:46 -05003465
Dan Williamsf55d4512009-01-24 09:04:12 -05003466 if (status & EV_LINK) {
3467 /* Link status changed */
3468 airo_handle_link(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003469 }
3470
3471 /* Check to see if there is something to receive */
Dan Williamsf55d4512009-01-24 09:04:12 -05003472 if (status & EV_RX)
3473 airo_handle_rx(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003474
3475 /* Check to see if a packet has been transmitted */
Dan Williamsf55d4512009-01-24 09:04:12 -05003476 if (status & (EV_TX | EV_TXCPY | EV_TXEXC))
3477 airo_handle_tx(ai, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003478
Dan Williamsf55d4512009-01-24 09:04:12 -05003479 if ( status & ~STATUS_INTS & ~IGNORE_INTS ) {
3480 airo_print_warn(ai->dev->name, "Got weird status %x",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003481 status & ~STATUS_INTS & ~IGNORE_INTS );
Dan Williamsf55d4512009-01-24 09:04:12 -05003482 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003483 }
3484
3485 if (savedInterrupts)
Dan Williamsf55d4512009-01-24 09:04:12 -05003486 OUT4500(ai, EVINTEN, savedInterrupts);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003487
Linus Torvalds1da177e2005-04-16 15:20:36 -07003488 return IRQ_RETVAL(handled);
3489}
3490
3491/*
3492 * Routines to talk to the card
3493 */
3494
3495/*
3496 * This was originally written for the 4500, hence the name
3497 * NOTE: If use with 8bit mode and SMP bad things will happen!
3498 * Why would some one do 8 bit IO in an SMP machine?!?
3499 */
3500static void OUT4500( struct airo_info *ai, u16 reg, u16 val ) {
3501 if (test_bit(FLAG_MPI,&ai->flags))
3502 reg <<= 1;
3503 if ( !do8bitIO )
3504 outw( val, ai->dev->base_addr + reg );
3505 else {
3506 outb( val & 0xff, ai->dev->base_addr + reg );
3507 outb( val >> 8, ai->dev->base_addr + reg + 1 );
3508 }
3509}
3510
3511static u16 IN4500( struct airo_info *ai, u16 reg ) {
3512 unsigned short rc;
3513
3514 if (test_bit(FLAG_MPI,&ai->flags))
3515 reg <<= 1;
3516 if ( !do8bitIO )
3517 rc = inw( ai->dev->base_addr + reg );
3518 else {
3519 rc = inb( ai->dev->base_addr + reg );
3520 rc += ((int)inb( ai->dev->base_addr + reg + 1 )) << 8;
3521 }
3522 return rc;
3523}
3524
Michal Schmidt175ec1a2007-06-29 15:33:47 +02003525static int enable_MAC(struct airo_info *ai, int lock)
3526{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003527 int rc;
Michal Schmidt175ec1a2007-06-29 15:33:47 +02003528 Cmd cmd;
3529 Resp rsp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003530
3531 /* FLAG_RADIO_OFF : Radio disabled via /proc or Wireless Extensions
3532 * FLAG_RADIO_DOWN : Radio disabled via "ifconfig ethX down"
3533 * Note : we could try to use !netif_running(dev) in enable_MAC()
3534 * instead of this flag, but I don't trust it *within* the
3535 * open/close functions, and testing both flags together is
3536 * "cheaper" - Jean II */
3537 if (ai->flags & FLAG_RADIO_MASK) return SUCCESS;
3538
3539 if (lock && down_interruptible(&ai->sem))
3540 return -ERESTARTSYS;
3541
3542 if (!test_bit(FLAG_ENABLED, &ai->flags)) {
3543 memset(&cmd, 0, sizeof(cmd));
3544 cmd.cmd = MAC_ENABLE;
Michal Schmidt175ec1a2007-06-29 15:33:47 +02003545 rc = issuecommand(ai, &cmd, &rsp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003546 if (rc == SUCCESS)
3547 set_bit(FLAG_ENABLED, &ai->flags);
3548 } else
3549 rc = SUCCESS;
3550
3551 if (lock)
3552 up(&ai->sem);
3553
3554 if (rc)
Michal Schmidt175ec1a2007-06-29 15:33:47 +02003555 airo_print_err(ai->dev->name, "Cannot enable MAC");
3556 else if ((rsp.status & 0xFF00) != 0) {
3557 airo_print_err(ai->dev->name, "Bad MAC enable reason=%x, "
3558 "rid=%x, offset=%d", rsp.rsp0, rsp.rsp1, rsp.rsp2);
3559 rc = ERROR;
3560 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003561 return rc;
3562}
3563
3564static void disable_MAC( struct airo_info *ai, int lock ) {
3565 Cmd cmd;
3566 Resp rsp;
3567
3568 if (lock && down_interruptible(&ai->sem))
3569 return;
3570
3571 if (test_bit(FLAG_ENABLED, &ai->flags)) {
3572 memset(&cmd, 0, sizeof(cmd));
3573 cmd.cmd = MAC_DISABLE; // disable in case already enabled
3574 issuecommand(ai, &cmd, &rsp);
3575 clear_bit(FLAG_ENABLED, &ai->flags);
3576 }
3577 if (lock)
3578 up(&ai->sem);
3579}
3580
3581static void enable_interrupts( struct airo_info *ai ) {
3582 /* Enable the interrupts */
3583 OUT4500( ai, EVINTEN, STATUS_INTS );
3584}
3585
3586static void disable_interrupts( struct airo_info *ai ) {
3587 OUT4500( ai, EVINTEN, 0 );
3588}
3589
3590static void mpi_receive_802_3(struct airo_info *ai)
3591{
3592 RxFid rxd;
3593 int len = 0;
3594 struct sk_buff *skb;
3595 char *buffer;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003596 int off = 0;
3597 MICBuffer micbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003598
3599 memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3600 /* Make sure we got something */
3601 if (rxd.rdy && rxd.valid == 0) {
3602 len = rxd.len + 12;
3603 if (len < 12 || len > 2048)
3604 goto badrx;
3605
3606 skb = dev_alloc_skb(len);
3607 if (!skb) {
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03003608 ai->dev->stats.rx_dropped++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003609 goto badrx;
3610 }
3611 buffer = skb_put(skb,len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003612 memcpy(buffer, ai->rxfids[0].virtual_host_addr, ETH_ALEN * 2);
3613 if (ai->micstats.enabled) {
3614 memcpy(&micbuf,
3615 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2,
3616 sizeof(micbuf));
3617 if (ntohs(micbuf.typelen) <= 0x05DC) {
3618 if (len <= sizeof(micbuf) + ETH_ALEN * 2)
3619 goto badmic;
3620
3621 off = sizeof(micbuf);
3622 skb_trim (skb, len - off);
3623 }
3624 }
3625 memcpy(buffer + ETH_ALEN * 2,
3626 ai->rxfids[0].virtual_host_addr + ETH_ALEN * 2 + off,
3627 len - ETH_ALEN * 2 - off);
3628 if (decapsulate (ai, &micbuf, (etherHead*)buffer, len - off - ETH_ALEN * 2)) {
3629badmic:
3630 dev_kfree_skb_irq (skb);
3631 goto badrx;
3632 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003633#ifdef WIRELESS_SPY
3634 if (ai->spy_data.spy_number > 0) {
3635 char *sa;
3636 struct iw_quality wstats;
3637 /* Prepare spy data : addr + qual */
3638 sa = buffer + ETH_ALEN;
3639 wstats.qual = 0; /* XXX Where do I get that info from ??? */
3640 wstats.level = 0;
3641 wstats.updated = 0;
3642 /* Update spy records */
3643 wireless_spy_update(ai->dev, sa, &wstats);
3644 }
3645#endif /* WIRELESS_SPY */
3646
Linus Torvalds1da177e2005-04-16 15:20:36 -07003647 skb->ip_summed = CHECKSUM_NONE;
3648 skb->protocol = eth_type_trans(skb, ai->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003649 netif_rx(skb);
3650 }
3651badrx:
3652 if (rxd.valid == 0) {
3653 rxd.valid = 1;
3654 rxd.rdy = 0;
3655 rxd.len = PKTSIZE;
3656 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3657 }
3658}
3659
Hannes Eder2ed5ba82008-12-26 00:12:59 -08003660static void mpi_receive_802_11(struct airo_info *ai)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003661{
3662 RxFid rxd;
3663 struct sk_buff *skb = NULL;
Al Viro0300b332007-12-19 22:38:33 -05003664 u16 len, hdrlen = 0;
3665 __le16 fc;
Dan Williamsf55d4512009-01-24 09:04:12 -05003666 struct rx_hdr hdr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003667 u16 gap;
3668 u16 *buffer;
Dan Williamsf55d4512009-01-24 09:04:12 -05003669 char *ptr = ai->rxfids[0].virtual_host_addr + 4;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003670
3671 memcpy_fromio(&rxd, ai->rxfids[0].card_ram_off, sizeof(rxd));
3672 memcpy ((char *)&hdr, ptr, sizeof(hdr));
3673 ptr += sizeof(hdr);
3674 /* Bad CRC. Ignore packet */
3675 if (le16_to_cpu(hdr.status) & 2)
3676 hdr.len = 0;
3677 if (ai->wifidev == NULL)
3678 hdr.len = 0;
3679 len = le16_to_cpu(hdr.len);
Dan Williams15db2762006-03-16 13:46:27 -05003680 if (len > AIRO_DEF_MTU) {
Dan Williams934d8bf2006-03-16 13:46:23 -05003681 airo_print_err(ai->dev->name, "Bad size %d", len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003682 goto badrx;
3683 }
3684 if (len == 0)
3685 goto badrx;
3686
Al Viro0300b332007-12-19 22:38:33 -05003687 fc = get_unaligned((__le16 *)ptr);
3688 hdrlen = header_len(fc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003689
3690 skb = dev_alloc_skb( len + hdrlen + 2 );
3691 if ( !skb ) {
Paulius Zaleckas5d9276d2008-05-05 22:38:34 +03003692 ai->dev->stats.rx_dropped++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003693 goto badrx;
3694 }
3695 buffer = (u16*)skb_put (skb, len + hdrlen);
3696 memcpy ((char *)buffer, ptr, hdrlen);
3697 ptr += hdrlen;
3698 if (hdrlen == 24)
3699 ptr += 6;
Harvey Harrison533dd1b2008-04-29 01:03:36 -07003700 gap = get_unaligned_le16(ptr);
Al Viro593c2b92007-12-17 15:09:34 -05003701 ptr += sizeof(__le16);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003702 if (gap) {
3703 if (gap <= 8)
3704 ptr += gap;
3705 else
Dan Williams934d8bf2006-03-16 13:46:23 -05003706 airo_print_err(ai->dev->name,
3707 "gaplen too big. Problems will follow...");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003708 }
3709 memcpy ((char *)buffer + hdrlen, ptr, len);
3710 ptr += len;
3711#ifdef IW_WIRELESS_SPY /* defined in iw_handler.h */
3712 if (ai->spy_data.spy_number > 0) {
3713 char *sa;
3714 struct iw_quality wstats;
3715 /* Prepare spy data : addr + qual */
3716 sa = (char*)buffer + 10;
3717 wstats.qual = hdr.rssi[0];
3718 if (ai->rssi)
3719 wstats.level = 0x100 - ai->rssi[hdr.rssi[1]].rssidBm;
3720 else
3721 wstats.level = (hdr.rssi[1] + 321) / 2;
Dan Williams41480af2005-05-10 09:45:51 -04003722 wstats.noise = ai->wstats.qual.noise;
3723 wstats.updated = IW_QUAL_QUAL_UPDATED
3724 | IW_QUAL_LEVEL_UPDATED
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07003725 | IW_QUAL_DBM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003726 /* Update spy records */
3727 wireless_spy_update(ai->dev, sa, &wstats);
3728 }
3729#endif /* IW_WIRELESS_SPY */
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -07003730 skb_reset_mac_header(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003731 skb->pkt_type = PACKET_OTHERHOST;
3732 skb->dev = ai->wifidev;
3733 skb->protocol = htons(ETH_P_802_2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003734 skb->ip_summed = CHECKSUM_NONE;
3735 netif_rx( skb );
Dan Williamsf55d4512009-01-24 09:04:12 -05003736
Linus Torvalds1da177e2005-04-16 15:20:36 -07003737badrx:
3738 if (rxd.valid == 0) {
3739 rxd.valid = 1;
3740 rxd.rdy = 0;
3741 rxd.len = PKTSIZE;
3742 memcpy_toio(ai->rxfids[0].card_ram_off, &rxd, sizeof(rxd));
3743 }
3744}
3745
3746static u16 setup_card(struct airo_info *ai, u8 *mac, int lock)
3747{
3748 Cmd cmd;
3749 Resp rsp;
3750 int status;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003751 SsidRid mySsid;
Al Viro4293ea32007-12-19 19:21:51 -05003752 __le16 lastindex;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003753 WepKeyRid wkr;
3754 int rc;
3755
3756 memset( &mySsid, 0, sizeof( mySsid ) );
Jesper Juhlb4558ea2005-10-28 16:53:13 -04003757 kfree (ai->flash);
3758 ai->flash = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003759
3760 /* The NOP is the first step in getting the card going */
3761 cmd.cmd = NOP;
3762 cmd.parm0 = cmd.parm1 = cmd.parm2 = 0;
3763 if (lock && down_interruptible(&ai->sem))
3764 return ERROR;
3765 if ( issuecommand( ai, &cmd, &rsp ) != SUCCESS ) {
3766 if (lock)
3767 up(&ai->sem);
3768 return ERROR;
3769 }
3770 disable_MAC( ai, 0);
3771
3772 // Let's figure out if we need to use the AUX port
3773 if (!test_bit(FLAG_MPI,&ai->flags)) {
3774 cmd.cmd = CMD_ENABLEAUX;
3775 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
3776 if (lock)
3777 up(&ai->sem);
Dan Williams934d8bf2006-03-16 13:46:23 -05003778 airo_print_err(ai->dev->name, "Error checking for AUX port");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003779 return ERROR;
3780 }
3781 if (!aux_bap || rsp.status & 0xff00) {
3782 ai->bap_read = fast_bap_read;
Dan Williams934d8bf2006-03-16 13:46:23 -05003783 airo_print_dbg(ai->dev->name, "Doing fast bap_reads");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003784 } else {
3785 ai->bap_read = aux_bap_read;
Dan Williams934d8bf2006-03-16 13:46:23 -05003786 airo_print_dbg(ai->dev->name, "Doing AUX bap_reads");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003787 }
3788 }
3789 if (lock)
3790 up(&ai->sem);
3791 if (ai->config.len == 0) {
Hannes Eder49c4a5d2009-02-14 11:49:09 +00003792 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003793 tdsRssiRid rssi_rid;
3794 CapabilityRid cap_rid;
3795
Jesper Juhlb4558ea2005-10-28 16:53:13 -04003796 kfree(ai->APList);
3797 ai->APList = NULL;
3798 kfree(ai->SSID);
3799 ai->SSID = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003800 // general configuration (read/modify/write)
3801 status = readConfigRid(ai, lock);
3802 if ( status != SUCCESS ) return ERROR;
3803
3804 status = readCapabilityRid(ai, &cap_rid, lock);
3805 if ( status != SUCCESS ) return ERROR;
3806
3807 status = PC4500_readrid(ai,RID_RSSI,&rssi_rid,sizeof(rssi_rid),lock);
3808 if ( status == SUCCESS ) {
3809 if (ai->rssi || (ai->rssi = kmalloc(512, GFP_KERNEL)) != NULL)
Dan Williams41480af2005-05-10 09:45:51 -04003810 memcpy(ai->rssi, (u8*)&rssi_rid + 2, 512); /* Skip RID length member */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003811 }
3812 else {
Jesper Juhlb4558ea2005-10-28 16:53:13 -04003813 kfree(ai->rssi);
3814 ai->rssi = NULL;
Al Viro56d81bd2007-12-20 17:18:35 -05003815 if (cap_rid.softCap & cpu_to_le16(8))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003816 ai->config.rmode |= RXMODE_NORMALIZED_RSSI;
3817 else
Dan Williams934d8bf2006-03-16 13:46:23 -05003818 airo_print_warn(ai->dev->name, "unknown received signal "
3819 "level scale");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003820 }
3821 ai->config.opmode = adhoc ? MODE_STA_IBSS : MODE_STA_ESS;
3822 ai->config.authType = AUTH_OPEN;
3823 ai->config.modulation = MOD_CCK;
3824
Al Viro56d81bd2007-12-20 17:18:35 -05003825 if (le16_to_cpu(cap_rid.len) >= sizeof(cap_rid) &&
Al Viro15617852007-12-20 17:21:36 -05003826 (cap_rid.extSoftCap & cpu_to_le16(1)) &&
Al Viro56d81bd2007-12-20 17:18:35 -05003827 micsetup(ai) == SUCCESS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003828 ai->config.opmode |= MODE_MIC;
3829 set_bit(FLAG_MIC_CAPABLE, &ai->flags);
3830 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003831
3832 /* Save off the MAC */
3833 for( i = 0; i < ETH_ALEN; i++ ) {
3834 mac[i] = ai->config.macAddr[i];
3835 }
3836
3837 /* Check to see if there are any insmod configured
3838 rates to add */
3839 if ( rates[0] ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003840 memset(ai->config.rates,0,sizeof(ai->config.rates));
3841 for( i = 0; i < 8 && rates[i]; i++ ) {
3842 ai->config.rates[i] = rates[i];
3843 }
3844 }
3845 if ( basic_rate > 0 ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003846 for( i = 0; i < 8; i++ ) {
3847 if ( ai->config.rates[i] == basic_rate ||
3848 !ai->config.rates ) {
3849 ai->config.rates[i] = basic_rate | 0x80;
3850 break;
3851 }
3852 }
3853 }
3854 set_bit (FLAG_COMMIT, &ai->flags);
3855 }
3856
3857 /* Setup the SSIDs if present */
3858 if ( ssids[0] ) {
3859 int i;
3860 for( i = 0; i < 3 && ssids[i]; i++ ) {
Al Viro0dd22122007-12-17 16:11:57 -05003861 size_t len = strlen(ssids[i]);
3862 if (len > 32)
3863 len = 32;
3864 mySsid.ssids[i].len = cpu_to_le16(len);
3865 memcpy(mySsid.ssids[i].ssid, ssids[i], len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003866 }
Al Viro0dd22122007-12-17 16:11:57 -05003867 mySsid.len = cpu_to_le16(sizeof(mySsid));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003868 }
3869
3870 status = writeConfigRid(ai, lock);
3871 if ( status != SUCCESS ) return ERROR;
3872
3873 /* Set up the SSID list */
3874 if ( ssids[0] ) {
3875 status = writeSsidRid(ai, &mySsid, lock);
3876 if ( status != SUCCESS ) return ERROR;
3877 }
3878
Michal Schmidt175ec1a2007-06-29 15:33:47 +02003879 status = enable_MAC(ai, lock);
3880 if (status != SUCCESS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003881 return ERROR;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003882
3883 /* Grab the initial wep key, we gotta save it for auto_wep */
3884 rc = readWepKeyRid(ai, &wkr, 1, lock);
3885 if (rc == SUCCESS) do {
3886 lastindex = wkr.kindex;
Al Viro4293ea32007-12-19 19:21:51 -05003887 if (wkr.kindex == cpu_to_le16(0xffff)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003888 ai->defindex = wkr.mac[0];
3889 }
3890 rc = readWepKeyRid(ai, &wkr, 0, lock);
3891 } while(lastindex != wkr.kindex);
3892
Michal Schmidt1c2b7db2007-06-29 15:33:36 +02003893 try_auto_wep(ai);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003894
3895 return SUCCESS;
3896}
3897
3898static u16 issuecommand(struct airo_info *ai, Cmd *pCmd, Resp *pRsp) {
3899 // Im really paranoid about letting it run forever!
3900 int max_tries = 600000;
3901
3902 if (IN4500(ai, EVSTAT) & EV_CMD)
3903 OUT4500(ai, EVACK, EV_CMD);
3904
3905 OUT4500(ai, PARAM0, pCmd->parm0);
3906 OUT4500(ai, PARAM1, pCmd->parm1);
3907 OUT4500(ai, PARAM2, pCmd->parm2);
3908 OUT4500(ai, COMMAND, pCmd->cmd);
3909
3910 while (max_tries-- && (IN4500(ai, EVSTAT) & EV_CMD) == 0) {
3911 if ((IN4500(ai, COMMAND)) == pCmd->cmd)
3912 // PC4500 didn't notice command, try again
3913 OUT4500(ai, COMMAND, pCmd->cmd);
3914 if (!in_atomic() && (max_tries & 255) == 0)
3915 schedule();
3916 }
3917
3918 if ( max_tries == -1 ) {
Dan Williams934d8bf2006-03-16 13:46:23 -05003919 airo_print_err(ai->dev->name,
3920 "Max tries exceeded when issueing command");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003921 if (IN4500(ai, COMMAND) & COMMAND_BUSY)
3922 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3923 return ERROR;
3924 }
3925
3926 // command completed
3927 pRsp->status = IN4500(ai, STATUS);
3928 pRsp->rsp0 = IN4500(ai, RESP0);
3929 pRsp->rsp1 = IN4500(ai, RESP1);
3930 pRsp->rsp2 = IN4500(ai, RESP2);
Robert Schulze13dca9b2006-07-10 18:37:44 +02003931 if ((pRsp->status & 0xff00)!=0 && pCmd->cmd != CMD_SOFTRESET)
3932 airo_print_err(ai->dev->name,
3933 "cmd:%x status:%x rsp0:%x rsp1:%x rsp2:%x",
3934 pCmd->cmd, pRsp->status, pRsp->rsp0, pRsp->rsp1,
3935 pRsp->rsp2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003936
3937 // clear stuck command busy if necessary
3938 if (IN4500(ai, COMMAND) & COMMAND_BUSY) {
3939 OUT4500(ai, EVACK, EV_CLEARCOMMANDBUSY);
3940 }
3941 // acknowledge processing the status/response
3942 OUT4500(ai, EVACK, EV_CMD);
3943
3944 return SUCCESS;
3945}
3946
3947/* Sets up the bap to start exchange data. whichbap should
3948 * be one of the BAP0 or BAP1 defines. Locks should be held before
3949 * calling! */
3950static int bap_setup(struct airo_info *ai, u16 rid, u16 offset, int whichbap )
3951{
3952 int timeout = 50;
3953 int max_tries = 3;
3954
3955 OUT4500(ai, SELECT0+whichbap, rid);
3956 OUT4500(ai, OFFSET0+whichbap, offset);
3957 while (1) {
3958 int status = IN4500(ai, OFFSET0+whichbap);
3959 if (status & BAP_BUSY) {
3960 /* This isn't really a timeout, but its kinda
3961 close */
3962 if (timeout--) {
3963 continue;
3964 }
3965 } else if ( status & BAP_ERR ) {
3966 /* invalid rid or offset */
Dan Williams934d8bf2006-03-16 13:46:23 -05003967 airo_print_err(ai->dev->name, "BAP error %x %d",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003968 status, whichbap );
3969 return ERROR;
3970 } else if (status & BAP_DONE) { // success
3971 return SUCCESS;
3972 }
3973 if ( !(max_tries--) ) {
Dan Williams934d8bf2006-03-16 13:46:23 -05003974 airo_print_err(ai->dev->name,
Michal Schmidt1138c372007-06-29 15:33:41 +02003975 "BAP setup error too many retries\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07003976 return ERROR;
3977 }
3978 // -- PC4500 missed it, try again
3979 OUT4500(ai, SELECT0+whichbap, rid);
3980 OUT4500(ai, OFFSET0+whichbap, offset);
3981 timeout = 50;
3982 }
3983}
3984
3985/* should only be called by aux_bap_read. This aux function and the
3986 following use concepts not documented in the developers guide. I
3987 got them from a patch given to my by Aironet */
3988static u16 aux_setup(struct airo_info *ai, u16 page,
3989 u16 offset, u16 *len)
3990{
3991 u16 next;
3992
3993 OUT4500(ai, AUXPAGE, page);
3994 OUT4500(ai, AUXOFF, 0);
3995 next = IN4500(ai, AUXDATA);
3996 *len = IN4500(ai, AUXDATA)&0xff;
3997 if (offset != 4) OUT4500(ai, AUXOFF, offset);
3998 return next;
3999}
4000
4001/* requires call to bap_setup() first */
Al Virob8c06bc2007-12-19 17:55:43 -05004002static int aux_bap_read(struct airo_info *ai, __le16 *pu16Dst,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004003 int bytelen, int whichbap)
4004{
4005 u16 len;
4006 u16 page;
4007 u16 offset;
4008 u16 next;
4009 int words;
4010 int i;
4011 unsigned long flags;
4012
4013 spin_lock_irqsave(&ai->aux_lock, flags);
4014 page = IN4500(ai, SWS0+whichbap);
4015 offset = IN4500(ai, SWS2+whichbap);
4016 next = aux_setup(ai, page, offset, &len);
4017 words = (bytelen+1)>>1;
4018
4019 for (i=0; i<words;) {
4020 int count;
4021 count = (len>>1) < (words-i) ? (len>>1) : (words-i);
4022 if ( !do8bitIO )
4023 insw( ai->dev->base_addr+DATA0+whichbap,
4024 pu16Dst+i,count );
4025 else
4026 insb( ai->dev->base_addr+DATA0+whichbap,
4027 pu16Dst+i, count << 1 );
4028 i += count;
4029 if (i<words) {
4030 next = aux_setup(ai, next, 4, &len);
4031 }
4032 }
4033 spin_unlock_irqrestore(&ai->aux_lock, flags);
4034 return SUCCESS;
4035}
4036
4037
4038/* requires call to bap_setup() first */
Al Virob8c06bc2007-12-19 17:55:43 -05004039static int fast_bap_read(struct airo_info *ai, __le16 *pu16Dst,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004040 int bytelen, int whichbap)
4041{
4042 bytelen = (bytelen + 1) & (~1); // round up to even value
4043 if ( !do8bitIO )
4044 insw( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen>>1 );
4045 else
4046 insb( ai->dev->base_addr+DATA0+whichbap, pu16Dst, bytelen );
4047 return SUCCESS;
4048}
4049
4050/* requires call to bap_setup() first */
Al Virob8c06bc2007-12-19 17:55:43 -05004051static int bap_write(struct airo_info *ai, const __le16 *pu16Src,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004052 int bytelen, int whichbap)
4053{
4054 bytelen = (bytelen + 1) & (~1); // round up to even value
4055 if ( !do8bitIO )
4056 outsw( ai->dev->base_addr+DATA0+whichbap,
4057 pu16Src, bytelen>>1 );
4058 else
4059 outsb( ai->dev->base_addr+DATA0+whichbap, pu16Src, bytelen );
4060 return SUCCESS;
4061}
4062
4063static int PC4500_accessrid(struct airo_info *ai, u16 rid, u16 accmd)
4064{
4065 Cmd cmd; /* for issuing commands */
4066 Resp rsp; /* response from commands */
4067 u16 status;
4068
4069 memset(&cmd, 0, sizeof(cmd));
4070 cmd.cmd = accmd;
4071 cmd.parm0 = rid;
4072 status = issuecommand(ai, &cmd, &rsp);
4073 if (status != 0) return status;
4074 if ( (rsp.status & 0x7F00) != 0) {
4075 return (accmd << 8) + (rsp.rsp0 & 0xFF);
4076 }
4077 return 0;
4078}
4079
4080/* Note, that we are using BAP1 which is also used by transmit, so
4081 * we must get a lock. */
4082static int PC4500_readrid(struct airo_info *ai, u16 rid, void *pBuf, int len, int lock)
4083{
4084 u16 status;
4085 int rc = SUCCESS;
4086
4087 if (lock) {
4088 if (down_interruptible(&ai->sem))
4089 return ERROR;
4090 }
4091 if (test_bit(FLAG_MPI,&ai->flags)) {
4092 Cmd cmd;
4093 Resp rsp;
4094
4095 memset(&cmd, 0, sizeof(cmd));
4096 memset(&rsp, 0, sizeof(rsp));
4097 ai->config_desc.rid_desc.valid = 1;
4098 ai->config_desc.rid_desc.len = RIDSIZE;
4099 ai->config_desc.rid_desc.rid = 0;
4100 ai->config_desc.rid_desc.host_addr = ai->ridbus;
4101
4102 cmd.cmd = CMD_ACCESS;
4103 cmd.parm0 = rid;
4104
4105 memcpy_toio(ai->config_desc.card_ram_off,
4106 &ai->config_desc.rid_desc, sizeof(Rid));
4107
4108 rc = issuecommand(ai, &cmd, &rsp);
4109
4110 if (rsp.status & 0x7f00)
4111 rc = rsp.rsp0;
4112 if (!rc)
4113 memcpy(pBuf, ai->config_desc.virtual_host_addr, len);
4114 goto done;
4115 } else {
4116 if ((status = PC4500_accessrid(ai, rid, CMD_ACCESS))!=SUCCESS) {
4117 rc = status;
4118 goto done;
4119 }
4120 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4121 rc = ERROR;
4122 goto done;
4123 }
4124 // read the rid length field
4125 bap_read(ai, pBuf, 2, BAP1);
4126 // length for remaining part of rid
Al Viro593c2b92007-12-17 15:09:34 -05004127 len = min(len, (int)le16_to_cpu(*(__le16*)pBuf)) - 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004128
4129 if ( len <= 2 ) {
Dan Williams934d8bf2006-03-16 13:46:23 -05004130 airo_print_err(ai->dev->name,
4131 "Rid %x has a length of %d which is too short",
Linus Torvalds1da177e2005-04-16 15:20:36 -07004132 (int)rid, (int)len );
4133 rc = ERROR;
4134 goto done;
4135 }
4136 // read remainder of the rid
Al Virob8c06bc2007-12-19 17:55:43 -05004137 rc = bap_read(ai, ((__le16*)pBuf)+1, len, BAP1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004138 }
4139done:
4140 if (lock)
4141 up(&ai->sem);
4142 return rc;
4143}
4144
4145/* Note, that we are using BAP1 which is also used by transmit, so
4146 * make sure this isnt called when a transmit is happening */
4147static int PC4500_writerid(struct airo_info *ai, u16 rid,
4148 const void *pBuf, int len, int lock)
4149{
4150 u16 status;
4151 int rc = SUCCESS;
4152
Al Viro593c2b92007-12-17 15:09:34 -05004153 *(__le16*)pBuf = cpu_to_le16((u16)len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004154
4155 if (lock) {
4156 if (down_interruptible(&ai->sem))
4157 return ERROR;
4158 }
4159 if (test_bit(FLAG_MPI,&ai->flags)) {
4160 Cmd cmd;
4161 Resp rsp;
4162
Dan Streetmanf89b2322005-11-11 11:41:42 -05004163 if (test_bit(FLAG_ENABLED, &ai->flags) && (RID_WEP_TEMP != rid))
Dan Williams934d8bf2006-03-16 13:46:23 -05004164 airo_print_err(ai->dev->name,
4165 "%s: MAC should be disabled (rid=%04x)",
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07004166 __func__, rid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004167 memset(&cmd, 0, sizeof(cmd));
4168 memset(&rsp, 0, sizeof(rsp));
4169
4170 ai->config_desc.rid_desc.valid = 1;
4171 ai->config_desc.rid_desc.len = *((u16 *)pBuf);
4172 ai->config_desc.rid_desc.rid = 0;
4173
4174 cmd.cmd = CMD_WRITERID;
4175 cmd.parm0 = rid;
4176
4177 memcpy_toio(ai->config_desc.card_ram_off,
4178 &ai->config_desc.rid_desc, sizeof(Rid));
4179
4180 if (len < 4 || len > 2047) {
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07004181 airo_print_err(ai->dev->name, "%s: len=%d", __func__, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004182 rc = -1;
4183 } else {
4184 memcpy((char *)ai->config_desc.virtual_host_addr,
4185 pBuf, len);
4186
4187 rc = issuecommand(ai, &cmd, &rsp);
4188 if ((rc & 0xff00) != 0) {
Dan Williams934d8bf2006-03-16 13:46:23 -05004189 airo_print_err(ai->dev->name, "%s: Write rid Error %d",
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07004190 __func__, rc);
Dan Williams934d8bf2006-03-16 13:46:23 -05004191 airo_print_err(ai->dev->name, "%s: Cmd=%04x",
Harvey Harrisonc94c93d2008-07-28 23:01:34 -07004192 __func__, cmd.cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004193 }
4194
4195 if ((rsp.status & 0x7f00))
4196 rc = rsp.rsp0;
4197 }
4198 } else {
4199 // --- first access so that we can write the rid data
4200 if ( (status = PC4500_accessrid(ai, rid, CMD_ACCESS)) != 0) {
4201 rc = status;
4202 goto done;
4203 }
4204 // --- now write the rid data
4205 if (bap_setup(ai, rid, 0, BAP1) != SUCCESS) {
4206 rc = ERROR;
4207 goto done;
4208 }
4209 bap_write(ai, pBuf, len, BAP1);
4210 // ---now commit the rid data
4211 rc = PC4500_accessrid(ai, rid, 0x100|CMD_ACCESS);
4212 }
4213done:
4214 if (lock)
4215 up(&ai->sem);
4216 return rc;
4217}
4218
4219/* Allocates a FID to be used for transmitting packets. We only use
4220 one for now. */
4221static u16 transmit_allocate(struct airo_info *ai, int lenPayload, int raw)
4222{
4223 unsigned int loop = 3000;
4224 Cmd cmd;
4225 Resp rsp;
4226 u16 txFid;
Al Viro593c2b92007-12-17 15:09:34 -05004227 __le16 txControl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004228
4229 cmd.cmd = CMD_ALLOCATETX;
4230 cmd.parm0 = lenPayload;
4231 if (down_interruptible(&ai->sem))
4232 return ERROR;
4233 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) {
4234 txFid = ERROR;
4235 goto done;
4236 }
4237 if ( (rsp.status & 0xFF00) != 0) {
4238 txFid = ERROR;
4239 goto done;
4240 }
4241 /* wait for the allocate event/indication
4242 * It makes me kind of nervous that this can just sit here and spin,
4243 * but in practice it only loops like four times. */
4244 while (((IN4500(ai, EVSTAT) & EV_ALLOC) == 0) && --loop);
4245 if (!loop) {
4246 txFid = ERROR;
4247 goto done;
4248 }
4249
4250 // get the allocated fid and acknowledge
4251 txFid = IN4500(ai, TXALLOCFID);
4252 OUT4500(ai, EVACK, EV_ALLOC);
4253
4254 /* The CARD is pretty cool since it converts the ethernet packet
4255 * into 802.11. Also note that we don't release the FID since we
4256 * will be using the same one over and over again. */
4257 /* We only have to setup the control once since we are not
4258 * releasing the fid. */
4259 if (raw)
4260 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_11
4261 | TXCTL_ETHERNET | TXCTL_NORELEASE);
4262 else
4263 txControl = cpu_to_le16(TXCTL_TXOK | TXCTL_TXEX | TXCTL_802_3
4264 | TXCTL_ETHERNET | TXCTL_NORELEASE);
4265 if (bap_setup(ai, txFid, 0x0008, BAP1) != SUCCESS)
4266 txFid = ERROR;
4267 else
4268 bap_write(ai, &txControl, sizeof(txControl), BAP1);
4269
4270done:
4271 up(&ai->sem);
4272
4273 return txFid;
4274}
4275
4276/* In general BAP1 is dedicated to transmiting packets. However,
4277 since we need a BAP when accessing RIDs, we also use BAP1 for that.
4278 Make sure the BAP1 spinlock is held when this is called. */
4279static int transmit_802_3_packet(struct airo_info *ai, int len, char *pPacket)
4280{
Al Viro593c2b92007-12-17 15:09:34 -05004281 __le16 payloadLen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004282 Cmd cmd;
4283 Resp rsp;
4284 int miclen = 0;
4285 u16 txFid = len;
4286 MICBuffer pMic;
4287
4288 len >>= 16;
4289
4290 if (len <= ETH_ALEN * 2) {
Dan Williams934d8bf2006-03-16 13:46:23 -05004291 airo_print_warn(ai->dev->name, "Short packet %d", len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004292 return ERROR;
4293 }
4294 len -= ETH_ALEN * 2;
4295
Linus Torvalds1da177e2005-04-16 15:20:36 -07004296 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags) && ai->micstats.enabled &&
Al Viro593c2b92007-12-17 15:09:34 -05004297 (ntohs(((__be16 *)pPacket)[6]) != 0x888E)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004298 if (encapsulate(ai,(etherHead *)pPacket,&pMic,len) != SUCCESS)
4299 return ERROR;
4300 miclen = sizeof(pMic);
4301 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004302 // packet is destination[6], source[6], payload[len-12]
4303 // write the payload length and dst/src/payload
4304 if (bap_setup(ai, txFid, 0x0036, BAP1) != SUCCESS) return ERROR;
4305 /* The hardware addresses aren't counted as part of the payload, so
4306 * we have to subtract the 12 bytes for the addresses off */
4307 payloadLen = cpu_to_le16(len + miclen);
4308 bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
Al Virob8c06bc2007-12-19 17:55:43 -05004309 bap_write(ai, (__le16*)pPacket, sizeof(etherHead), BAP1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004310 if (miclen)
Al Virob8c06bc2007-12-19 17:55:43 -05004311 bap_write(ai, (__le16*)&pMic, miclen, BAP1);
4312 bap_write(ai, (__le16*)(pPacket + sizeof(etherHead)), len, BAP1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004313 // issue the transmit command
4314 memset( &cmd, 0, sizeof( cmd ) );
4315 cmd.cmd = CMD_TRANSMIT;
4316 cmd.parm0 = txFid;
4317 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4318 if ( (rsp.status & 0xFF00) != 0) return ERROR;
4319 return SUCCESS;
4320}
4321
4322static int transmit_802_11_packet(struct airo_info *ai, int len, char *pPacket)
4323{
Al Viro593c2b92007-12-17 15:09:34 -05004324 __le16 fc, payloadLen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004325 Cmd cmd;
4326 Resp rsp;
4327 int hdrlen;
Al Viro977b1432007-12-19 16:45:29 -05004328 static u8 tail[(30-10) + 2 + 6] = {[30-10] = 6};
4329 /* padding of header to full size + le16 gaplen (6) + gaplen bytes */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004330 u16 txFid = len;
4331 len >>= 16;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004332
Al Viro0300b332007-12-19 22:38:33 -05004333 fc = *(__le16*)pPacket;
4334 hdrlen = header_len(fc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004335
4336 if (len < hdrlen) {
Dan Williams934d8bf2006-03-16 13:46:23 -05004337 airo_print_warn(ai->dev->name, "Short packet %d", len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004338 return ERROR;
4339 }
4340
4341 /* packet is 802.11 header + payload
4342 * write the payload length and dst/src/payload */
4343 if (bap_setup(ai, txFid, 6, BAP1) != SUCCESS) return ERROR;
4344 /* The 802.11 header aren't counted as part of the payload, so
4345 * we have to subtract the header bytes off */
4346 payloadLen = cpu_to_le16(len-hdrlen);
4347 bap_write(ai, &payloadLen, sizeof(payloadLen),BAP1);
4348 if (bap_setup(ai, txFid, 0x0014, BAP1) != SUCCESS) return ERROR;
Al Virob8c06bc2007-12-19 17:55:43 -05004349 bap_write(ai, (__le16 *)pPacket, hdrlen, BAP1);
4350 bap_write(ai, (__le16 *)(tail + (hdrlen - 10)), 38 - hdrlen, BAP1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004351
Al Virob8c06bc2007-12-19 17:55:43 -05004352 bap_write(ai, (__le16 *)(pPacket + hdrlen), len - hdrlen, BAP1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004353 // issue the transmit command
4354 memset( &cmd, 0, sizeof( cmd ) );
4355 cmd.cmd = CMD_TRANSMIT;
4356 cmd.parm0 = txFid;
4357 if (issuecommand(ai, &cmd, &rsp) != SUCCESS) return ERROR;
4358 if ( (rsp.status & 0xFF00) != 0) return ERROR;
4359 return SUCCESS;
4360}
4361
4362/*
4363 * This is the proc_fs routines. It is a bit messier than I would
4364 * like! Feel free to clean it up!
4365 */
4366
4367static ssize_t proc_read( struct file *file,
4368 char __user *buffer,
4369 size_t len,
4370 loff_t *offset);
4371
4372static ssize_t proc_write( struct file *file,
4373 const char __user *buffer,
4374 size_t len,
4375 loff_t *offset );
4376static int proc_close( struct inode *inode, struct file *file );
4377
4378static int proc_stats_open( struct inode *inode, struct file *file );
4379static int proc_statsdelta_open( struct inode *inode, struct file *file );
4380static int proc_status_open( struct inode *inode, struct file *file );
4381static int proc_SSID_open( struct inode *inode, struct file *file );
4382static int proc_APList_open( struct inode *inode, struct file *file );
4383static int proc_BSSList_open( struct inode *inode, struct file *file );
4384static int proc_config_open( struct inode *inode, struct file *file );
4385static int proc_wepkey_open( struct inode *inode, struct file *file );
4386
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004387static const struct file_operations proc_statsdelta_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004388 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004389 .read = proc_read,
4390 .open = proc_statsdelta_open,
4391 .release = proc_close
4392};
4393
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004394static const struct file_operations proc_stats_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004395 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004396 .read = proc_read,
4397 .open = proc_stats_open,
4398 .release = proc_close
4399};
4400
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004401static const struct file_operations proc_status_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004402 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004403 .read = proc_read,
4404 .open = proc_status_open,
4405 .release = proc_close
4406};
4407
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004408static const struct file_operations proc_SSID_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004409 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004410 .read = proc_read,
4411 .write = proc_write,
4412 .open = proc_SSID_open,
4413 .release = proc_close
4414};
4415
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004416static const struct file_operations proc_BSSList_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004417 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004418 .read = proc_read,
4419 .write = proc_write,
4420 .open = proc_BSSList_open,
4421 .release = proc_close
4422};
4423
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004424static const struct file_operations proc_APList_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004425 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004426 .read = proc_read,
4427 .write = proc_write,
4428 .open = proc_APList_open,
4429 .release = proc_close
4430};
4431
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004432static const struct file_operations proc_config_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004433 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004434 .read = proc_read,
4435 .write = proc_write,
4436 .open = proc_config_open,
4437 .release = proc_close
4438};
4439
Arjan van de Vend54b1fd2007-02-12 00:55:34 -08004440static const struct file_operations proc_wepkey_ops = {
Denis V. Luneva95609c2008-04-29 01:02:29 -07004441 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004442 .read = proc_read,
4443 .write = proc_write,
4444 .open = proc_wepkey_open,
4445 .release = proc_close
4446};
4447
4448static struct proc_dir_entry *airo_entry;
4449
4450struct proc_data {
4451 int release_buffer;
4452 int readlen;
4453 char *rbuffer;
4454 int writelen;
4455 int maxwritelen;
4456 char *wbuffer;
4457 void (*on_close) (struct inode *, struct file *);
4458};
4459
Linus Torvalds1da177e2005-04-16 15:20:36 -07004460static int setup_proc_entry( struct net_device *dev,
4461 struct airo_info *apriv ) {
4462 struct proc_dir_entry *entry;
4463 /* First setup the device directory */
4464 strcpy(apriv->proc_name,dev->name);
4465 apriv->proc_entry = create_proc_entry(apriv->proc_name,
4466 S_IFDIR|airo_perm,
4467 airo_entry);
Florin Malita431aca52006-10-10 16:46:30 -04004468 if (!apriv->proc_entry)
4469 goto fail;
4470 apriv->proc_entry->uid = proc_uid;
4471 apriv->proc_entry->gid = proc_gid;
4472 apriv->proc_entry->owner = THIS_MODULE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004473
4474 /* Setup the StatsDelta */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004475 entry = proc_create_data("StatsDelta",
4476 S_IFREG | (S_IRUGO&proc_perm),
4477 apriv->proc_entry, &proc_statsdelta_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004478 if (!entry)
4479 goto fail_stats_delta;
4480 entry->uid = proc_uid;
4481 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004482
4483 /* Setup the Stats */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004484 entry = proc_create_data("Stats",
4485 S_IFREG | (S_IRUGO&proc_perm),
4486 apriv->proc_entry, &proc_stats_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004487 if (!entry)
4488 goto fail_stats;
4489 entry->uid = proc_uid;
4490 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004491
4492 /* Setup the Status */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004493 entry = proc_create_data("Status",
4494 S_IFREG | (S_IRUGO&proc_perm),
4495 apriv->proc_entry, &proc_status_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004496 if (!entry)
4497 goto fail_status;
4498 entry->uid = proc_uid;
4499 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004500
4501 /* Setup the Config */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004502 entry = proc_create_data("Config",
4503 S_IFREG | proc_perm,
4504 apriv->proc_entry, &proc_config_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004505 if (!entry)
4506 goto fail_config;
4507 entry->uid = proc_uid;
4508 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004509
4510 /* Setup the SSID */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004511 entry = proc_create_data("SSID",
4512 S_IFREG | proc_perm,
4513 apriv->proc_entry, &proc_SSID_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004514 if (!entry)
4515 goto fail_ssid;
4516 entry->uid = proc_uid;
4517 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004518
4519 /* Setup the APList */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004520 entry = proc_create_data("APList",
4521 S_IFREG | proc_perm,
4522 apriv->proc_entry, &proc_APList_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004523 if (!entry)
4524 goto fail_aplist;
4525 entry->uid = proc_uid;
4526 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004527
4528 /* Setup the BSSList */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004529 entry = proc_create_data("BSSList",
4530 S_IFREG | proc_perm,
4531 apriv->proc_entry, &proc_BSSList_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004532 if (!entry)
4533 goto fail_bsslist;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004534 entry->uid = proc_uid;
4535 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004536
4537 /* Setup the WepKey */
Denis V. Luneva95609c2008-04-29 01:02:29 -07004538 entry = proc_create_data("WepKey",
4539 S_IFREG | proc_perm,
4540 apriv->proc_entry, &proc_wepkey_ops, dev);
Florin Malita431aca52006-10-10 16:46:30 -04004541 if (!entry)
4542 goto fail_wepkey;
4543 entry->uid = proc_uid;
4544 entry->gid = proc_gid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004545
4546 return 0;
Florin Malita431aca52006-10-10 16:46:30 -04004547
4548fail_wepkey:
4549 remove_proc_entry("BSSList", apriv->proc_entry);
4550fail_bsslist:
4551 remove_proc_entry("APList", apriv->proc_entry);
4552fail_aplist:
4553 remove_proc_entry("SSID", apriv->proc_entry);
4554fail_ssid:
4555 remove_proc_entry("Config", apriv->proc_entry);
4556fail_config:
4557 remove_proc_entry("Status", apriv->proc_entry);
4558fail_status:
4559 remove_proc_entry("Stats", apriv->proc_entry);
4560fail_stats:
4561 remove_proc_entry("StatsDelta", apriv->proc_entry);
4562fail_stats_delta:
4563 remove_proc_entry(apriv->proc_name, airo_entry);
4564fail:
4565 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004566}
4567
4568static int takedown_proc_entry( struct net_device *dev,
4569 struct airo_info *apriv ) {
4570 if ( !apriv->proc_entry->namelen ) return 0;
4571 remove_proc_entry("Stats",apriv->proc_entry);
4572 remove_proc_entry("StatsDelta",apriv->proc_entry);
4573 remove_proc_entry("Status",apriv->proc_entry);
4574 remove_proc_entry("Config",apriv->proc_entry);
4575 remove_proc_entry("SSID",apriv->proc_entry);
4576 remove_proc_entry("APList",apriv->proc_entry);
4577 remove_proc_entry("BSSList",apriv->proc_entry);
4578 remove_proc_entry("WepKey",apriv->proc_entry);
4579 remove_proc_entry(apriv->proc_name,airo_entry);
4580 return 0;
4581}
4582
4583/*
4584 * What we want from the proc_fs is to be able to efficiently read
4585 * and write the configuration. To do this, we want to read the
4586 * configuration when the file is opened and write it when the file is
4587 * closed. So basically we allocate a read buffer at open and fill it
4588 * with data, and allocate a write buffer and read it at close.
4589 */
4590
4591/*
4592 * The read routine is generic, it relies on the preallocated rbuffer
4593 * to supply the data.
4594 */
4595static ssize_t proc_read( struct file *file,
4596 char __user *buffer,
4597 size_t len,
4598 loff_t *offset )
4599{
Akinobu Mitacc0d9ff2008-06-09 16:44:30 -07004600 struct proc_data *priv = file->private_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004601
4602 if (!priv->rbuffer)
4603 return -EINVAL;
4604
Akinobu Mitacc0d9ff2008-06-09 16:44:30 -07004605 return simple_read_from_buffer(buffer, len, offset, priv->rbuffer,
4606 priv->readlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004607}
4608
4609/*
4610 * The write routine is generic, it fills in a preallocated rbuffer
4611 * to supply the data.
4612 */
4613static ssize_t proc_write( struct file *file,
4614 const char __user *buffer,
4615 size_t len,
4616 loff_t *offset )
4617{
4618 loff_t pos = *offset;
4619 struct proc_data *priv = (struct proc_data*)file->private_data;
4620
4621 if (!priv->wbuffer)
4622 return -EINVAL;
4623
4624 if (pos < 0)
4625 return -EINVAL;
4626 if (pos >= priv->maxwritelen)
4627 return 0;
4628 if (len > priv->maxwritelen - pos)
4629 len = priv->maxwritelen - pos;
4630 if (copy_from_user(priv->wbuffer + pos, buffer, len))
4631 return -EFAULT;
4632 if ( pos + len > priv->writelen )
4633 priv->writelen = len + file->f_pos;
4634 *offset = pos + len;
4635 return len;
4636}
4637
Al Viro329e2c02007-12-20 22:58:57 -05004638static int proc_status_open(struct inode *inode, struct file *file)
4639{
Linus Torvalds1da177e2005-04-16 15:20:36 -07004640 struct proc_data *data;
4641 struct proc_dir_entry *dp = PDE(inode);
4642 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08004643 struct airo_info *apriv = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004644 CapabilityRid cap_rid;
4645 StatusRid status_rid;
Al Viro329e2c02007-12-20 22:58:57 -05004646 u16 mode;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004647 int i;
4648
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01004649 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004650 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004651 data = (struct proc_data *)file->private_data;
4652 if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
4653 kfree (file->private_data);
4654 return -ENOMEM;
4655 }
4656
4657 readStatusRid(apriv, &status_rid, 1);
4658 readCapabilityRid(apriv, &cap_rid, 1);
4659
Al Viro329e2c02007-12-20 22:58:57 -05004660 mode = le16_to_cpu(status_rid.mode);
4661
Linus Torvalds1da177e2005-04-16 15:20:36 -07004662 i = sprintf(data->rbuffer, "Status: %s%s%s%s%s%s%s%s%s\n",
Al Viro329e2c02007-12-20 22:58:57 -05004663 mode & 1 ? "CFG ": "",
4664 mode & 2 ? "ACT ": "",
4665 mode & 0x10 ? "SYN ": "",
4666 mode & 0x20 ? "LNK ": "",
4667 mode & 0x40 ? "LEAP ": "",
4668 mode & 0x80 ? "PRIV ": "",
4669 mode & 0x100 ? "KEY ": "",
4670 mode & 0x200 ? "WEP ": "",
4671 mode & 0x8000 ? "ERR ": "");
Linus Torvalds1da177e2005-04-16 15:20:36 -07004672 sprintf( data->rbuffer+i, "Mode: %x\n"
4673 "Signal Strength: %d\n"
4674 "Signal Quality: %d\n"
4675 "SSID: %-.*s\n"
4676 "AP: %-.16s\n"
4677 "Freq: %d\n"
4678 "BitRate: %dmbs\n"
4679 "Driver Version: %s\n"
4680 "Device: %s\nManufacturer: %s\nFirmware Version: %s\n"
4681 "Radio type: %x\nCountry: %x\nHardware Version: %x\n"
4682 "Software Version: %x\nSoftware Subversion: %x\n"
4683 "Boot block version: %x\n",
Al Viro329e2c02007-12-20 22:58:57 -05004684 le16_to_cpu(status_rid.mode),
4685 le16_to_cpu(status_rid.normalizedSignalStrength),
4686 le16_to_cpu(status_rid.signalQuality),
4687 le16_to_cpu(status_rid.SSIDlen),
Linus Torvalds1da177e2005-04-16 15:20:36 -07004688 status_rid.SSID,
4689 status_rid.apName,
Al Viro329e2c02007-12-20 22:58:57 -05004690 le16_to_cpu(status_rid.channel),
4691 le16_to_cpu(status_rid.currentXmitRate) / 2,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004692 version,
4693 cap_rid.prodName,
4694 cap_rid.manName,
4695 cap_rid.prodVer,
Al Viro56d81bd2007-12-20 17:18:35 -05004696 le16_to_cpu(cap_rid.radioType),
4697 le16_to_cpu(cap_rid.country),
4698 le16_to_cpu(cap_rid.hardVer),
4699 le16_to_cpu(cap_rid.softVer),
4700 le16_to_cpu(cap_rid.softSubVer),
4701 le16_to_cpu(cap_rid.bootBlockVer));
Linus Torvalds1da177e2005-04-16 15:20:36 -07004702 data->readlen = strlen( data->rbuffer );
4703 return 0;
4704}
4705
4706static int proc_stats_rid_open(struct inode*, struct file*, u16);
4707static int proc_statsdelta_open( struct inode *inode,
4708 struct file *file ) {
4709 if (file->f_mode&FMODE_WRITE) {
4710 return proc_stats_rid_open(inode, file, RID_STATSDELTACLEAR);
4711 }
4712 return proc_stats_rid_open(inode, file, RID_STATSDELTA);
4713}
4714
4715static int proc_stats_open( struct inode *inode, struct file *file ) {
4716 return proc_stats_rid_open(inode, file, RID_STATS);
4717}
4718
4719static int proc_stats_rid_open( struct inode *inode,
4720 struct file *file,
Al Viroa23ace52007-12-19 22:24:16 -05004721 u16 rid )
4722{
Linus Torvalds1da177e2005-04-16 15:20:36 -07004723 struct proc_data *data;
4724 struct proc_dir_entry *dp = PDE(inode);
4725 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08004726 struct airo_info *apriv = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004727 StatsRid stats;
4728 int i, j;
Al Viroa23ace52007-12-19 22:24:16 -05004729 __le32 *vals = stats.vals;
John W. Linvillebc8263f2009-02-10 13:53:01 -05004730 int len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004731
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01004732 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004733 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004734 data = (struct proc_data *)file->private_data;
4735 if ((data->rbuffer = kmalloc( 4096, GFP_KERNEL )) == NULL) {
4736 kfree (file->private_data);
4737 return -ENOMEM;
4738 }
4739
4740 readStatsRid(apriv, &stats, rid, 1);
John W. Linvillebc8263f2009-02-10 13:53:01 -05004741 len = le16_to_cpu(stats.len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004742
4743 j = 0;
Al Viroa23ace52007-12-19 22:24:16 -05004744 for(i=0; statsLabels[i]!=(char *)-1 && i*4<len; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004745 if (!statsLabels[i]) continue;
4746 if (j+strlen(statsLabels[i])+16>4096) {
Dan Williams934d8bf2006-03-16 13:46:23 -05004747 airo_print_warn(apriv->dev->name,
4748 "Potentially disasterous buffer overflow averted!");
Linus Torvalds1da177e2005-04-16 15:20:36 -07004749 break;
4750 }
Al Viroa23ace52007-12-19 22:24:16 -05004751 j+=sprintf(data->rbuffer+j, "%s: %u\n", statsLabels[i],
4752 le32_to_cpu(vals[i]));
Linus Torvalds1da177e2005-04-16 15:20:36 -07004753 }
Al Viroa23ace52007-12-19 22:24:16 -05004754 if (i*4 >= len) {
Dan Williams934d8bf2006-03-16 13:46:23 -05004755 airo_print_warn(apriv->dev->name, "Got a short rid");
Linus Torvalds1da177e2005-04-16 15:20:36 -07004756 }
4757 data->readlen = j;
4758 return 0;
4759}
4760
4761static int get_dec_u16( char *buffer, int *start, int limit ) {
4762 u16 value;
4763 int valid = 0;
4764 for( value = 0; buffer[*start] >= '0' &&
4765 buffer[*start] <= '9' &&
4766 *start < limit; (*start)++ ) {
4767 valid = 1;
4768 value *= 10;
4769 value += buffer[*start] - '0';
4770 }
4771 if ( !valid ) return -1;
4772 return value;
4773}
4774
4775static int airo_config_commit(struct net_device *dev,
4776 struct iw_request_info *info, void *zwrq,
4777 char *extra);
4778
Al Viro3eb9b412007-12-21 00:00:35 -05004779static inline int sniffing_mode(struct airo_info *ai)
4780{
4781 return le16_to_cpu(ai->config.rmode & RXMODE_MASK) >=
4782 le16_to_cpu(RXMODE_RFMON);
4783}
4784
4785static void proc_config_on_close(struct inode *inode, struct file *file)
4786{
Linus Torvalds1da177e2005-04-16 15:20:36 -07004787 struct proc_data *data = file->private_data;
4788 struct proc_dir_entry *dp = PDE(inode);
4789 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08004790 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004791 char *line;
4792
4793 if ( !data->writelen ) return;
4794
4795 readConfigRid(ai, 1);
4796 set_bit (FLAG_COMMIT, &ai->flags);
4797
4798 line = data->wbuffer;
4799 while( line[0] ) {
4800/*** Mode processing */
4801 if ( !strncmp( line, "Mode: ", 6 ) ) {
4802 line += 6;
Al Viro3eb9b412007-12-21 00:00:35 -05004803 if (sniffing_mode(ai))
4804 set_bit (FLAG_RESET, &ai->flags);
4805 ai->config.rmode &= ~RXMODE_FULL_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004806 clear_bit (FLAG_802_11, &ai->flags);
Al Viro3eb9b412007-12-21 00:00:35 -05004807 ai->config.opmode &= ~MODE_CFG_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004808 ai->config.scanMode = SCANMODE_ACTIVE;
4809 if ( line[0] == 'a' ) {
Al Viro3eb9b412007-12-21 00:00:35 -05004810 ai->config.opmode |= MODE_STA_IBSS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004811 } else {
Al Viro3eb9b412007-12-21 00:00:35 -05004812 ai->config.opmode |= MODE_STA_ESS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004813 if ( line[0] == 'r' ) {
4814 ai->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
4815 ai->config.scanMode = SCANMODE_PASSIVE;
4816 set_bit (FLAG_802_11, &ai->flags);
4817 } else if ( line[0] == 'y' ) {
4818 ai->config.rmode |= RXMODE_RFMON_ANYBSS | RXMODE_DISABLE_802_3_HEADER;
4819 ai->config.scanMode = SCANMODE_PASSIVE;
4820 set_bit (FLAG_802_11, &ai->flags);
4821 } else if ( line[0] == 'l' )
4822 ai->config.rmode |= RXMODE_LANMON;
4823 }
4824 set_bit (FLAG_COMMIT, &ai->flags);
4825 }
4826
4827/*** Radio status */
4828 else if (!strncmp(line,"Radio: ", 7)) {
4829 line += 7;
4830 if (!strncmp(line,"off",3)) {
4831 set_bit (FLAG_RADIO_OFF, &ai->flags);
4832 } else {
4833 clear_bit (FLAG_RADIO_OFF, &ai->flags);
4834 }
4835 }
4836/*** NodeName processing */
4837 else if ( !strncmp( line, "NodeName: ", 10 ) ) {
4838 int j;
4839
4840 line += 10;
4841 memset( ai->config.nodeName, 0, 16 );
4842/* Do the name, assume a space between the mode and node name */
4843 for( j = 0; j < 16 && line[j] != '\n'; j++ ) {
4844 ai->config.nodeName[j] = line[j];
4845 }
4846 set_bit (FLAG_COMMIT, &ai->flags);
4847 }
4848
4849/*** PowerMode processing */
4850 else if ( !strncmp( line, "PowerMode: ", 11 ) ) {
4851 line += 11;
4852 if ( !strncmp( line, "PSPCAM", 6 ) ) {
4853 ai->config.powerSaveMode = POWERSAVE_PSPCAM;
4854 set_bit (FLAG_COMMIT, &ai->flags);
4855 } else if ( !strncmp( line, "PSP", 3 ) ) {
4856 ai->config.powerSaveMode = POWERSAVE_PSP;
4857 set_bit (FLAG_COMMIT, &ai->flags);
4858 } else {
4859 ai->config.powerSaveMode = POWERSAVE_CAM;
4860 set_bit (FLAG_COMMIT, &ai->flags);
4861 }
4862 } else if ( !strncmp( line, "DataRates: ", 11 ) ) {
4863 int v, i = 0, k = 0; /* i is index into line,
4864 k is index to rates */
4865
4866 line += 11;
4867 while((v = get_dec_u16(line, &i, 3))!=-1) {
4868 ai->config.rates[k++] = (u8)v;
4869 line += i + 1;
4870 i = 0;
4871 }
4872 set_bit (FLAG_COMMIT, &ai->flags);
4873 } else if ( !strncmp( line, "Channel: ", 9 ) ) {
4874 int v, i = 0;
4875 line += 9;
4876 v = get_dec_u16(line, &i, i+3);
4877 if ( v != -1 ) {
Al Viro3eb9b412007-12-21 00:00:35 -05004878 ai->config.channelSet = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004879 set_bit (FLAG_COMMIT, &ai->flags);
4880 }
4881 } else if ( !strncmp( line, "XmitPower: ", 11 ) ) {
4882 int v, i = 0;
4883 line += 11;
4884 v = get_dec_u16(line, &i, i+3);
4885 if ( v != -1 ) {
Al Viro3eb9b412007-12-21 00:00:35 -05004886 ai->config.txPower = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004887 set_bit (FLAG_COMMIT, &ai->flags);
4888 }
4889 } else if ( !strncmp( line, "WEP: ", 5 ) ) {
4890 line += 5;
4891 switch( line[0] ) {
4892 case 's':
Al Viro3eb9b412007-12-21 00:00:35 -05004893 ai->config.authType = AUTH_SHAREDKEY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004894 break;
4895 case 'e':
Al Viro3eb9b412007-12-21 00:00:35 -05004896 ai->config.authType = AUTH_ENCRYPT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004897 break;
4898 default:
Al Viro3eb9b412007-12-21 00:00:35 -05004899 ai->config.authType = AUTH_OPEN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004900 break;
4901 }
4902 set_bit (FLAG_COMMIT, &ai->flags);
4903 } else if ( !strncmp( line, "LongRetryLimit: ", 16 ) ) {
4904 int v, i = 0;
4905
4906 line += 16;
4907 v = get_dec_u16(line, &i, 3);
4908 v = (v<0) ? 0 : ((v>255) ? 255 : v);
Al Viro3eb9b412007-12-21 00:00:35 -05004909 ai->config.longRetryLimit = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004910 set_bit (FLAG_COMMIT, &ai->flags);
4911 } else if ( !strncmp( line, "ShortRetryLimit: ", 17 ) ) {
4912 int v, i = 0;
4913
4914 line += 17;
4915 v = get_dec_u16(line, &i, 3);
4916 v = (v<0) ? 0 : ((v>255) ? 255 : v);
Al Viro3eb9b412007-12-21 00:00:35 -05004917 ai->config.shortRetryLimit = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004918 set_bit (FLAG_COMMIT, &ai->flags);
4919 } else if ( !strncmp( line, "RTSThreshold: ", 14 ) ) {
4920 int v, i = 0;
4921
4922 line += 14;
4923 v = get_dec_u16(line, &i, 4);
Dan Williams15db2762006-03-16 13:46:27 -05004924 v = (v<0) ? 0 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
Al Viro3eb9b412007-12-21 00:00:35 -05004925 ai->config.rtsThres = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004926 set_bit (FLAG_COMMIT, &ai->flags);
4927 } else if ( !strncmp( line, "TXMSDULifetime: ", 16 ) ) {
4928 int v, i = 0;
4929
4930 line += 16;
4931 v = get_dec_u16(line, &i, 5);
4932 v = (v<0) ? 0 : v;
Al Viro3eb9b412007-12-21 00:00:35 -05004933 ai->config.txLifetime = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004934 set_bit (FLAG_COMMIT, &ai->flags);
4935 } else if ( !strncmp( line, "RXMSDULifetime: ", 16 ) ) {
4936 int v, i = 0;
4937
4938 line += 16;
4939 v = get_dec_u16(line, &i, 5);
4940 v = (v<0) ? 0 : v;
Al Viro3eb9b412007-12-21 00:00:35 -05004941 ai->config.rxLifetime = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004942 set_bit (FLAG_COMMIT, &ai->flags);
4943 } else if ( !strncmp( line, "TXDiversity: ", 13 ) ) {
4944 ai->config.txDiversity =
4945 (line[13]=='l') ? 1 :
4946 ((line[13]=='r')? 2: 3);
4947 set_bit (FLAG_COMMIT, &ai->flags);
4948 } else if ( !strncmp( line, "RXDiversity: ", 13 ) ) {
4949 ai->config.rxDiversity =
4950 (line[13]=='l') ? 1 :
4951 ((line[13]=='r')? 2: 3);
4952 set_bit (FLAG_COMMIT, &ai->flags);
4953 } else if ( !strncmp( line, "FragThreshold: ", 15 ) ) {
4954 int v, i = 0;
4955
4956 line += 15;
4957 v = get_dec_u16(line, &i, 4);
Dan Williams15db2762006-03-16 13:46:27 -05004958 v = (v<256) ? 256 : ((v>AIRO_DEF_MTU) ? AIRO_DEF_MTU : v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004959 v = v & 0xfffe; /* Make sure its even */
Al Viro3eb9b412007-12-21 00:00:35 -05004960 ai->config.fragThresh = cpu_to_le16(v);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004961 set_bit (FLAG_COMMIT, &ai->flags);
4962 } else if (!strncmp(line, "Modulation: ", 12)) {
4963 line += 12;
4964 switch(*line) {
4965 case 'd': ai->config.modulation=MOD_DEFAULT; set_bit(FLAG_COMMIT, &ai->flags); break;
4966 case 'c': ai->config.modulation=MOD_CCK; set_bit(FLAG_COMMIT, &ai->flags); break;
4967 case 'm': ai->config.modulation=MOD_MOK; set_bit(FLAG_COMMIT, &ai->flags); break;
Dan Williams934d8bf2006-03-16 13:46:23 -05004968 default: airo_print_warn(ai->dev->name, "Unknown modulation");
Linus Torvalds1da177e2005-04-16 15:20:36 -07004969 }
4970 } else if (!strncmp(line, "Preamble: ", 10)) {
4971 line += 10;
4972 switch(*line) {
4973 case 'a': ai->config.preamble=PREAMBLE_AUTO; set_bit(FLAG_COMMIT, &ai->flags); break;
4974 case 'l': ai->config.preamble=PREAMBLE_LONG; set_bit(FLAG_COMMIT, &ai->flags); break;
4975 case 's': ai->config.preamble=PREAMBLE_SHORT; set_bit(FLAG_COMMIT, &ai->flags); break;
Dan Williams934d8bf2006-03-16 13:46:23 -05004976 default: airo_print_warn(ai->dev->name, "Unknown preamble");
Linus Torvalds1da177e2005-04-16 15:20:36 -07004977 }
4978 } else {
Dan Williams934d8bf2006-03-16 13:46:23 -05004979 airo_print_warn(ai->dev->name, "Couldn't figure out %s", line);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004980 }
4981 while( line[0] && line[0] != '\n' ) line++;
4982 if ( line[0] ) line++;
4983 }
4984 airo_config_commit(dev, NULL, NULL, NULL);
4985}
4986
Al Viro3eb9b412007-12-21 00:00:35 -05004987static char *get_rmode(__le16 mode)
4988{
4989 switch(mode & RXMODE_MASK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004990 case RXMODE_RFMON: return "rfmon";
4991 case RXMODE_RFMON_ANYBSS: return "yna (any) bss rfmon";
4992 case RXMODE_LANMON: return "lanmon";
4993 }
4994 return "ESS";
4995}
4996
Al Viro3eb9b412007-12-21 00:00:35 -05004997static int proc_config_open(struct inode *inode, struct file *file)
4998{
Linus Torvalds1da177e2005-04-16 15:20:36 -07004999 struct proc_data *data;
5000 struct proc_dir_entry *dp = PDE(inode);
5001 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005002 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005003 int i;
Al Viro3eb9b412007-12-21 00:00:35 -05005004 __le16 mode;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005005
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005006 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005007 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005008 data = (struct proc_data *)file->private_data;
5009 if ((data->rbuffer = kmalloc( 2048, GFP_KERNEL )) == NULL) {
5010 kfree (file->private_data);
5011 return -ENOMEM;
5012 }
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005013 if ((data->wbuffer = kzalloc( 2048, GFP_KERNEL )) == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005014 kfree (data->rbuffer);
5015 kfree (file->private_data);
5016 return -ENOMEM;
5017 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005018 data->maxwritelen = 2048;
5019 data->on_close = proc_config_on_close;
5020
5021 readConfigRid(ai, 1);
5022
Al Viro3eb9b412007-12-21 00:00:35 -05005023 mode = ai->config.opmode & MODE_CFG_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005024 i = sprintf( data->rbuffer,
5025 "Mode: %s\n"
5026 "Radio: %s\n"
5027 "NodeName: %-16s\n"
5028 "PowerMode: %s\n"
5029 "DataRates: %d %d %d %d %d %d %d %d\n"
5030 "Channel: %d\n"
5031 "XmitPower: %d\n",
Al Viro3eb9b412007-12-21 00:00:35 -05005032 mode == MODE_STA_IBSS ? "adhoc" :
5033 mode == MODE_STA_ESS ? get_rmode(ai->config.rmode):
5034 mode == MODE_AP ? "AP" :
5035 mode == MODE_AP_RPTR ? "AP RPTR" : "Error",
Linus Torvalds1da177e2005-04-16 15:20:36 -07005036 test_bit(FLAG_RADIO_OFF, &ai->flags) ? "off" : "on",
5037 ai->config.nodeName,
Al Viro3eb9b412007-12-21 00:00:35 -05005038 ai->config.powerSaveMode == POWERSAVE_CAM ? "CAM" :
5039 ai->config.powerSaveMode == POWERSAVE_PSP ? "PSP" :
5040 ai->config.powerSaveMode == POWERSAVE_PSPCAM ? "PSPCAM" :
5041 "Error",
Linus Torvalds1da177e2005-04-16 15:20:36 -07005042 (int)ai->config.rates[0],
5043 (int)ai->config.rates[1],
5044 (int)ai->config.rates[2],
5045 (int)ai->config.rates[3],
5046 (int)ai->config.rates[4],
5047 (int)ai->config.rates[5],
5048 (int)ai->config.rates[6],
5049 (int)ai->config.rates[7],
Al Viro3eb9b412007-12-21 00:00:35 -05005050 le16_to_cpu(ai->config.channelSet),
5051 le16_to_cpu(ai->config.txPower)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005052 );
5053 sprintf( data->rbuffer + i,
5054 "LongRetryLimit: %d\n"
5055 "ShortRetryLimit: %d\n"
5056 "RTSThreshold: %d\n"
5057 "TXMSDULifetime: %d\n"
5058 "RXMSDULifetime: %d\n"
5059 "TXDiversity: %s\n"
5060 "RXDiversity: %s\n"
5061 "FragThreshold: %d\n"
5062 "WEP: %s\n"
5063 "Modulation: %s\n"
5064 "Preamble: %s\n",
Al Viro3eb9b412007-12-21 00:00:35 -05005065 le16_to_cpu(ai->config.longRetryLimit),
5066 le16_to_cpu(ai->config.shortRetryLimit),
5067 le16_to_cpu(ai->config.rtsThres),
5068 le16_to_cpu(ai->config.txLifetime),
5069 le16_to_cpu(ai->config.rxLifetime),
Linus Torvalds1da177e2005-04-16 15:20:36 -07005070 ai->config.txDiversity == 1 ? "left" :
5071 ai->config.txDiversity == 2 ? "right" : "both",
5072 ai->config.rxDiversity == 1 ? "left" :
5073 ai->config.rxDiversity == 2 ? "right" : "both",
Al Viro3eb9b412007-12-21 00:00:35 -05005074 le16_to_cpu(ai->config.fragThresh),
Linus Torvalds1da177e2005-04-16 15:20:36 -07005075 ai->config.authType == AUTH_ENCRYPT ? "encrypt" :
5076 ai->config.authType == AUTH_SHAREDKEY ? "shared" : "open",
Al Viro3eb9b412007-12-21 00:00:35 -05005077 ai->config.modulation == MOD_DEFAULT ? "default" :
Linus Torvalds1da177e2005-04-16 15:20:36 -07005078 ai->config.modulation == MOD_CCK ? "cck" :
5079 ai->config.modulation == MOD_MOK ? "mok" : "error",
5080 ai->config.preamble == PREAMBLE_AUTO ? "auto" :
5081 ai->config.preamble == PREAMBLE_LONG ? "long" :
5082 ai->config.preamble == PREAMBLE_SHORT ? "short" : "error"
5083 );
5084 data->readlen = strlen( data->rbuffer );
5085 return 0;
5086}
5087
Al Viro0dd22122007-12-17 16:11:57 -05005088static void proc_SSID_on_close(struct inode *inode, struct file *file)
5089{
Linus Torvalds1da177e2005-04-16 15:20:36 -07005090 struct proc_data *data = (struct proc_data *)file->private_data;
5091 struct proc_dir_entry *dp = PDE(inode);
5092 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005093 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005094 SsidRid SSID_rid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005095 int i;
Al Viro0dd22122007-12-17 16:11:57 -05005096 char *p = data->wbuffer;
5097 char *end = p + data->writelen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005098
Al Viro0dd22122007-12-17 16:11:57 -05005099 if (!data->writelen)
5100 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005101
Al Viro0dd22122007-12-17 16:11:57 -05005102 *end = '\n'; /* sentinel; we have space for it */
Linus Torvalds1da177e2005-04-16 15:20:36 -07005103
Al Viro0dd22122007-12-17 16:11:57 -05005104 memset(&SSID_rid, 0, sizeof(SSID_rid));
5105
5106 for (i = 0; i < 3 && p < end; i++) {
5107 int j = 0;
5108 /* copy up to 32 characters from this line */
5109 while (*p != '\n' && j < 32)
5110 SSID_rid.ssids[i].ssid[j++] = *p++;
5111 if (j == 0)
5112 break;
5113 SSID_rid.ssids[i].len = cpu_to_le16(j);
5114 /* skip to the beginning of the next line */
5115 while (*p++ != '\n')
5116 ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005117 }
5118 if (i)
Al Viro0dd22122007-12-17 16:11:57 -05005119 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005120 disable_MAC(ai, 1);
5121 writeSsidRid(ai, &SSID_rid, 1);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005122 enable_MAC(ai, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005123}
5124
Jesper Juhl77933d72005-07-27 11:46:09 -07005125static inline u8 hexVal(char c) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005126 if (c>='0' && c<='9') return c -= '0';
5127 if (c>='a' && c<='f') return c -= 'a'-10;
5128 if (c>='A' && c<='F') return c -= 'A'-10;
5129 return 0;
5130}
5131
5132static void proc_APList_on_close( struct inode *inode, struct file *file ) {
5133 struct proc_data *data = (struct proc_data *)file->private_data;
5134 struct proc_dir_entry *dp = PDE(inode);
5135 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005136 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005137 APListRid APList_rid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005138 int i;
5139
5140 if ( !data->writelen ) return;
5141
5142 memset( &APList_rid, 0, sizeof(APList_rid) );
Al Viroa7497162007-12-20 17:49:41 -05005143 APList_rid.len = cpu_to_le16(sizeof(APList_rid));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005144
5145 for( i = 0; i < 4 && data->writelen >= (i+1)*6*3; i++ ) {
5146 int j;
5147 for( j = 0; j < 6*3 && data->wbuffer[j+i*6*3]; j++ ) {
5148 switch(j%3) {
5149 case 0:
5150 APList_rid.ap[i][j/3]=
5151 hexVal(data->wbuffer[j+i*6*3])<<4;
5152 break;
5153 case 1:
5154 APList_rid.ap[i][j/3]|=
5155 hexVal(data->wbuffer[j+i*6*3]);
5156 break;
5157 }
5158 }
5159 }
5160 disable_MAC(ai, 1);
5161 writeAPListRid(ai, &APList_rid, 1);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005162 enable_MAC(ai, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005163}
5164
5165/* This function wraps PC4500_writerid with a MAC disable */
5166static int do_writerid( struct airo_info *ai, u16 rid, const void *rid_data,
5167 int len, int dummy ) {
5168 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005169
5170 disable_MAC(ai, 1);
5171 rc = PC4500_writerid(ai, rid, rid_data, len, 1);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005172 enable_MAC(ai, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005173 return rc;
5174}
5175
Dan Williamsc0380692009-01-24 09:12:15 -05005176/* Returns the WEP key at the specified index, or -1 if that key does
5177 * not exist. The buffer is assumed to be at least 16 bytes in length.
Linus Torvalds1da177e2005-04-16 15:20:36 -07005178 */
Dan Williamsc0380692009-01-24 09:12:15 -05005179static int get_wep_key(struct airo_info *ai, u16 index, char *buf, u16 buflen)
5180{
Linus Torvalds1da177e2005-04-16 15:20:36 -07005181 WepKeyRid wkr;
5182 int rc;
Al Viro4293ea32007-12-19 19:21:51 -05005183 __le16 lastindex;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005184
5185 rc = readWepKeyRid(ai, &wkr, 1, 1);
Dan Williamsc0380692009-01-24 09:12:15 -05005186 if (rc != SUCCESS)
5187 return -1;
5188 do {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005189 lastindex = wkr.kindex;
Dan Williamsc0380692009-01-24 09:12:15 -05005190 if (le16_to_cpu(wkr.kindex) == index) {
5191 int klen = min_t(int, buflen, le16_to_cpu(wkr.klen));
5192 memcpy(buf, wkr.key, klen);
5193 return klen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005194 }
Dan Williamsc0380692009-01-24 09:12:15 -05005195 rc = readWepKeyRid(ai, &wkr, 0, 1);
5196 if (rc != SUCCESS)
5197 return -1;
Al Viro4293ea32007-12-19 19:21:51 -05005198 } while (lastindex != wkr.kindex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005199 return -1;
5200}
5201
Dan Williamsc0380692009-01-24 09:12:15 -05005202static int get_wep_tx_idx(struct airo_info *ai)
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 (wkr.kindex == cpu_to_le16(0xffff))
5214 return wkr.mac[0];
5215 rc = readWepKeyRid(ai, &wkr, 0, 1);
5216 if (rc != SUCCESS)
5217 return -1;
5218 } while (lastindex != wkr.kindex);
5219 return -1;
5220}
5221
5222static int set_wep_key(struct airo_info *ai, u16 index, const char *key,
5223 u16 keylen, int perm, int lock)
Al Viro4293ea32007-12-19 19:21:51 -05005224{
Linus Torvalds1da177e2005-04-16 15:20:36 -07005225 static const unsigned char macaddr[ETH_ALEN] = { 0x01, 0, 0, 0, 0, 0 };
5226 WepKeyRid wkr;
Dan Williamsc0380692009-01-24 09:12:15 -05005227 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005228
Linus Torvalds1da177e2005-04-16 15:20:36 -07005229 if (keylen == 0) {
Dan Williamsc0380692009-01-24 09:12:15 -05005230 airo_print_err(ai->dev->name, "%s: key length to set was zero",
5231 __func__);
5232 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005233 }
5234
Dan Williamsc0380692009-01-24 09:12:15 -05005235 memset(&wkr, 0, sizeof(wkr));
5236 wkr.len = cpu_to_le16(sizeof(wkr));
5237 wkr.kindex = cpu_to_le16(index);
5238 wkr.klen = cpu_to_le16(keylen);
5239 memcpy(wkr.key, key, keylen);
5240 memcpy(wkr.mac, macaddr, ETH_ALEN);
5241
Dan Streetmanf89b2322005-11-11 11:41:42 -05005242 if (perm) disable_MAC(ai, lock);
Dan Williamsc0380692009-01-24 09:12:15 -05005243 rc = writeWepKeyRid(ai, &wkr, perm, lock);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005244 if (perm) enable_MAC(ai, lock);
Dan Williamsc0380692009-01-24 09:12:15 -05005245 return rc;
5246}
5247
5248static int set_wep_tx_idx(struct airo_info *ai, u16 index, int perm, int lock)
5249{
5250 WepKeyRid wkr;
5251 int rc;
5252
5253 memset(&wkr, 0, sizeof(wkr));
5254 wkr.len = cpu_to_le16(sizeof(wkr));
5255 wkr.kindex = cpu_to_le16(0xffff);
5256 wkr.mac[0] = (char)index;
5257
5258 if (perm) {
5259 ai->defindex = (char)index;
5260 disable_MAC(ai, lock);
5261 }
5262
5263 rc = writeWepKeyRid(ai, &wkr, perm, lock);
5264
5265 if (perm)
5266 enable_MAC(ai, lock);
5267 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005268}
5269
5270static void proc_wepkey_on_close( struct inode *inode, struct file *file ) {
5271 struct proc_data *data;
5272 struct proc_dir_entry *dp = PDE(inode);
5273 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005274 struct airo_info *ai = dev->ml_priv;
Dan Williamsc0380692009-01-24 09:12:15 -05005275 int i, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005276 char key[16];
5277 u16 index = 0;
5278 int j = 0;
5279
5280 memset(key, 0, sizeof(key));
5281
5282 data = (struct proc_data *)file->private_data;
5283 if ( !data->writelen ) return;
5284
5285 if (data->wbuffer[0] >= '0' && data->wbuffer[0] <= '3' &&
5286 (data->wbuffer[1] == ' ' || data->wbuffer[1] == '\n')) {
5287 index = data->wbuffer[0] - '0';
5288 if (data->wbuffer[1] == '\n') {
Dan Williamsc0380692009-01-24 09:12:15 -05005289 rc = set_wep_tx_idx(ai, index, 1, 1);
5290 if (rc < 0) {
5291 airo_print_err(ai->dev->name, "failed to set "
5292 "WEP transmit index to %d: %d.",
5293 index, rc);
5294 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005295 return;
5296 }
5297 j = 2;
5298 } else {
Dan Williams934d8bf2006-03-16 13:46:23 -05005299 airo_print_err(ai->dev->name, "WepKey passed invalid key index");
Linus Torvalds1da177e2005-04-16 15:20:36 -07005300 return;
5301 }
5302
5303 for( i = 0; i < 16*3 && data->wbuffer[i+j]; i++ ) {
5304 switch(i%3) {
5305 case 0:
5306 key[i/3] = hexVal(data->wbuffer[i+j])<<4;
5307 break;
5308 case 1:
5309 key[i/3] |= hexVal(data->wbuffer[i+j]);
5310 break;
5311 }
5312 }
Dan Williamsc0380692009-01-24 09:12:15 -05005313
5314 rc = set_wep_key(ai, index, key, i/3, 1, 1);
5315 if (rc < 0) {
5316 airo_print_err(ai->dev->name, "failed to set WEP key at index "
5317 "%d: %d.", index, rc);
5318 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005319}
5320
Al Viro4293ea32007-12-19 19:21:51 -05005321static int proc_wepkey_open( struct inode *inode, struct file *file )
5322{
Linus Torvalds1da177e2005-04-16 15:20:36 -07005323 struct proc_data *data;
5324 struct proc_dir_entry *dp = PDE(inode);
5325 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005326 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005327 char *ptr;
5328 WepKeyRid wkr;
Al Viro4293ea32007-12-19 19:21:51 -05005329 __le16 lastindex;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005330 int j=0;
5331 int rc;
5332
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005333 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005334 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005335 memset(&wkr, 0, sizeof(wkr));
5336 data = (struct proc_data *)file->private_data;
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005337 if ((data->rbuffer = kzalloc( 180, GFP_KERNEL )) == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005338 kfree (file->private_data);
5339 return -ENOMEM;
5340 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005341 data->writelen = 0;
5342 data->maxwritelen = 80;
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005343 if ((data->wbuffer = kzalloc( 80, GFP_KERNEL )) == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005344 kfree (data->rbuffer);
5345 kfree (file->private_data);
5346 return -ENOMEM;
5347 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005348 data->on_close = proc_wepkey_on_close;
5349
5350 ptr = data->rbuffer;
5351 strcpy(ptr, "No wep keys\n");
5352 rc = readWepKeyRid(ai, &wkr, 1, 1);
5353 if (rc == SUCCESS) do {
5354 lastindex = wkr.kindex;
Al Viro4293ea32007-12-19 19:21:51 -05005355 if (wkr.kindex == cpu_to_le16(0xffff)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005356 j += sprintf(ptr+j, "Tx key = %d\n",
5357 (int)wkr.mac[0]);
5358 } else {
5359 j += sprintf(ptr+j, "Key %d set with length = %d\n",
Al Viro4293ea32007-12-19 19:21:51 -05005360 le16_to_cpu(wkr.kindex),
5361 le16_to_cpu(wkr.klen));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005362 }
5363 readWepKeyRid(ai, &wkr, 0, 1);
5364 } while((lastindex != wkr.kindex) && (j < 180-30));
5365
5366 data->readlen = strlen( data->rbuffer );
5367 return 0;
5368}
5369
Al Viro0dd22122007-12-17 16:11:57 -05005370static int proc_SSID_open(struct inode *inode, struct file *file)
5371{
Linus Torvalds1da177e2005-04-16 15:20:36 -07005372 struct proc_data *data;
5373 struct proc_dir_entry *dp = PDE(inode);
5374 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005375 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005376 int i;
5377 char *ptr;
5378 SsidRid SSID_rid;
5379
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005380 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005381 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005382 data = (struct proc_data *)file->private_data;
5383 if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5384 kfree (file->private_data);
5385 return -ENOMEM;
5386 }
5387 data->writelen = 0;
5388 data->maxwritelen = 33*3;
Al Viro0dd22122007-12-17 16:11:57 -05005389 /* allocate maxwritelen + 1; we'll want a sentinel */
5390 if ((data->wbuffer = kzalloc(33*3 + 1, GFP_KERNEL)) == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005391 kfree (data->rbuffer);
5392 kfree (file->private_data);
5393 return -ENOMEM;
5394 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005395 data->on_close = proc_SSID_on_close;
5396
5397 readSsidRid(ai, &SSID_rid);
5398 ptr = data->rbuffer;
Al Viro0dd22122007-12-17 16:11:57 -05005399 for (i = 0; i < 3; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005400 int j;
Al Viro0dd22122007-12-17 16:11:57 -05005401 size_t len = le16_to_cpu(SSID_rid.ssids[i].len);
5402 if (!len)
5403 break;
5404 if (len > 32)
5405 len = 32;
5406 for (j = 0; j < len && SSID_rid.ssids[i].ssid[j]; j++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005407 *ptr++ = SSID_rid.ssids[i].ssid[j];
Linus Torvalds1da177e2005-04-16 15:20:36 -07005408 *ptr++ = '\n';
5409 }
5410 *ptr = '\0';
5411 data->readlen = strlen( data->rbuffer );
5412 return 0;
5413}
5414
5415static int proc_APList_open( struct inode *inode, struct file *file ) {
5416 struct proc_data *data;
5417 struct proc_dir_entry *dp = PDE(inode);
5418 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005419 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005420 int i;
5421 char *ptr;
5422 APListRid APList_rid;
5423
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005424 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005425 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005426 data = (struct proc_data *)file->private_data;
5427 if ((data->rbuffer = kmalloc( 104, GFP_KERNEL )) == NULL) {
5428 kfree (file->private_data);
5429 return -ENOMEM;
5430 }
5431 data->writelen = 0;
5432 data->maxwritelen = 4*6*3;
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005433 if ((data->wbuffer = kzalloc( data->maxwritelen, GFP_KERNEL )) == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005434 kfree (data->rbuffer);
5435 kfree (file->private_data);
5436 return -ENOMEM;
5437 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005438 data->on_close = proc_APList_on_close;
5439
5440 readAPListRid(ai, &APList_rid);
5441 ptr = data->rbuffer;
5442 for( i = 0; i < 4; i++ ) {
5443// We end when we find a zero MAC
5444 if ( !*(int*)APList_rid.ap[i] &&
5445 !*(int*)&APList_rid.ap[i][2]) break;
Johannes Berge1749612008-10-27 15:59:26 -07005446 ptr += sprintf(ptr, "%pM\n", APList_rid.ap[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005447 }
5448 if (i==0) ptr += sprintf(ptr, "Not using specific APs\n");
5449
5450 *ptr = '\0';
5451 data->readlen = strlen( data->rbuffer );
5452 return 0;
5453}
5454
5455static int proc_BSSList_open( struct inode *inode, struct file *file ) {
5456 struct proc_data *data;
5457 struct proc_dir_entry *dp = PDE(inode);
5458 struct net_device *dev = dp->data;
Wang Chenfaf39942008-10-14 13:30:33 +08005459 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005460 char *ptr;
5461 BSSListRid BSSList_rid;
5462 int rc;
5463 /* If doLoseSync is not 1, we won't do a Lose Sync */
5464 int doLoseSync = -1;
5465
Panagiotis Issarisb69a3aa2005-11-08 00:03:15 +01005466 if ((file->private_data = kzalloc(sizeof(struct proc_data ), GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005467 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005468 data = (struct proc_data *)file->private_data;
5469 if ((data->rbuffer = kmalloc( 1024, GFP_KERNEL )) == NULL) {
5470 kfree (file->private_data);
5471 return -ENOMEM;
5472 }
5473 data->writelen = 0;
5474 data->maxwritelen = 0;
5475 data->wbuffer = NULL;
5476 data->on_close = NULL;
5477
5478 if (file->f_mode & FMODE_WRITE) {
5479 if (!(file->f_mode & FMODE_READ)) {
5480 Cmd cmd;
5481 Resp rsp;
5482
5483 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
5484 memset(&cmd, 0, sizeof(cmd));
5485 cmd.cmd=CMD_LISTBSS;
5486 if (down_interruptible(&ai->sem))
5487 return -ERESTARTSYS;
5488 issuecommand(ai, &cmd, &rsp);
5489 up(&ai->sem);
5490 data->readlen = 0;
5491 return 0;
5492 }
5493 doLoseSync = 1;
5494 }
5495 ptr = data->rbuffer;
5496 /* There is a race condition here if there are concurrent opens.
5497 Since it is a rare condition, we'll just live with it, otherwise
5498 we have to add a spin lock... */
5499 rc = readBSSListRid(ai, doLoseSync, &BSSList_rid);
Al Viro17e70492007-12-19 18:56:37 -05005500 while(rc == 0 && BSSList_rid.index != cpu_to_le16(0xffff)) {
Johannes Berge1749612008-10-27 15:59:26 -07005501 ptr += sprintf(ptr, "%pM %*s rssi = %d",
5502 BSSList_rid.bssid,
Linus Torvalds1da177e2005-04-16 15:20:36 -07005503 (int)BSSList_rid.ssidLen,
5504 BSSList_rid.ssid,
Al Viro17e70492007-12-19 18:56:37 -05005505 le16_to_cpu(BSSList_rid.dBm));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005506 ptr += sprintf(ptr, " channel = %d %s %s %s %s\n",
Al Viro17e70492007-12-19 18:56:37 -05005507 le16_to_cpu(BSSList_rid.dsChannel),
Linus Torvalds1da177e2005-04-16 15:20:36 -07005508 BSSList_rid.cap & CAP_ESS ? "ESS" : "",
5509 BSSList_rid.cap & CAP_IBSS ? "adhoc" : "",
5510 BSSList_rid.cap & CAP_PRIVACY ? "wep" : "",
5511 BSSList_rid.cap & CAP_SHORTHDR ? "shorthdr" : "");
5512 rc = readBSSListRid(ai, 0, &BSSList_rid);
5513 }
5514 *ptr = '\0';
5515 data->readlen = strlen( data->rbuffer );
5516 return 0;
5517}
5518
5519static int proc_close( struct inode *inode, struct file *file )
5520{
Jesper Juhlb4558ea2005-10-28 16:53:13 -04005521 struct proc_data *data = file->private_data;
5522
5523 if (data->on_close != NULL)
5524 data->on_close(inode, file);
5525 kfree(data->rbuffer);
5526 kfree(data->wbuffer);
5527 kfree(data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005528 return 0;
5529}
5530
Linus Torvalds1da177e2005-04-16 15:20:36 -07005531/* Since the card doesn't automatically switch to the right WEP mode,
5532 we will make it do it. If the card isn't associated, every secs we
5533 will switch WEP modes to see if that will help. If the card is
5534 associated we will check every minute to see if anything has
5535 changed. */
5536static void timer_func( struct net_device *dev ) {
Wang Chenfaf39942008-10-14 13:30:33 +08005537 struct airo_info *apriv = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005538
5539/* We don't have a link so try changing the authtype */
5540 readConfigRid(apriv, 0);
5541 disable_MAC(apriv, 0);
5542 switch(apriv->config.authType) {
5543 case AUTH_ENCRYPT:
5544/* So drop to OPEN */
5545 apriv->config.authType = AUTH_OPEN;
5546 break;
5547 case AUTH_SHAREDKEY:
5548 if (apriv->keyindex < auto_wep) {
Dan Williamsc0380692009-01-24 09:12:15 -05005549 set_wep_tx_idx(apriv, apriv->keyindex, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005550 apriv->config.authType = AUTH_SHAREDKEY;
5551 apriv->keyindex++;
5552 } else {
5553 /* Drop to ENCRYPT */
5554 apriv->keyindex = 0;
Dan Williamsc0380692009-01-24 09:12:15 -05005555 set_wep_tx_idx(apriv, apriv->defindex, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005556 apriv->config.authType = AUTH_ENCRYPT;
5557 }
5558 break;
5559 default: /* We'll escalate to SHAREDKEY */
5560 apriv->config.authType = AUTH_SHAREDKEY;
5561 }
5562 set_bit (FLAG_COMMIT, &apriv->flags);
5563 writeConfigRid(apriv, 0);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005564 enable_MAC(apriv, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005565 up(&apriv->sem);
5566
5567/* Schedule check to see if the change worked */
Dan Williams3c304952006-04-15 12:26:18 -04005568 clear_bit(JOB_AUTOWEP, &apriv->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005569 apriv->expires = RUN_AT(HZ*3);
5570}
5571
Linus Torvalds1da177e2005-04-16 15:20:36 -07005572#ifdef CONFIG_PCI
5573static int __devinit airo_pci_probe(struct pci_dev *pdev,
5574 const struct pci_device_id *pent)
5575{
5576 struct net_device *dev;
5577
5578 if (pci_enable_device(pdev))
5579 return -ENODEV;
5580 pci_set_master(pdev);
5581
5582 if (pdev->device == 0x5000 || pdev->device == 0xa504)
5583 dev = _init_airo_card(pdev->irq, pdev->resource[0].start, 0, pdev, &pdev->dev);
5584 else
5585 dev = _init_airo_card(pdev->irq, pdev->resource[2].start, 0, pdev, &pdev->dev);
Michal Schmidt777ec5e2007-06-29 15:33:30 +02005586 if (!dev) {
5587 pci_disable_device(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005588 return -ENODEV;
Michal Schmidt777ec5e2007-06-29 15:33:30 +02005589 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005590
5591 pci_set_drvdata(pdev, dev);
5592 return 0;
5593}
5594
5595static void __devexit airo_pci_remove(struct pci_dev *pdev)
5596{
Michal Schmidtaf5b5c92007-03-16 12:44:40 +01005597 struct net_device *dev = pci_get_drvdata(pdev);
5598
5599 airo_print_info(dev->name, "Unregistering...");
5600 stop_airo_card(dev, 1);
Michal Schmidt777ec5e2007-06-29 15:33:30 +02005601 pci_disable_device(pdev);
5602 pci_set_drvdata(pdev, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005603}
5604
Pavel Machek05adc3b2005-04-16 15:25:25 -07005605static int airo_pci_suspend(struct pci_dev *pdev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005606{
5607 struct net_device *dev = pci_get_drvdata(pdev);
Wang Chenfaf39942008-10-14 13:30:33 +08005608 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005609 Cmd cmd;
5610 Resp rsp;
5611
Pavel Macheke292c732008-06-25 12:25:53 +02005612 if (!ai->APList)
5613 ai->APList = kmalloc(sizeof(APListRid), GFP_KERNEL);
5614 if (!ai->APList)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005615 return -ENOMEM;
Pavel Macheke292c732008-06-25 12:25:53 +02005616 if (!ai->SSID)
5617 ai->SSID = kmalloc(sizeof(SsidRid), GFP_KERNEL);
5618 if (!ai->SSID)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005619 return -ENOMEM;
5620 readAPListRid(ai, ai->APList);
5621 readSsidRid(ai, ai->SSID);
5622 memset(&cmd, 0, sizeof(cmd));
5623 /* the lock will be released at the end of the resume callback */
5624 if (down_interruptible(&ai->sem))
5625 return -EAGAIN;
5626 disable_MAC(ai, 0);
5627 netif_device_detach(dev);
5628 ai->power = state;
Pavel Macheke292c732008-06-25 12:25:53 +02005629 cmd.cmd = HOSTSLEEP;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005630 issuecommand(ai, &cmd, &rsp);
5631
Pavel Machek1cc68ae2005-06-20 15:33:04 -07005632 pci_enable_wake(pdev, pci_choose_state(pdev, state), 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005633 pci_save_state(pdev);
Pavel Machek1cc68ae2005-06-20 15:33:04 -07005634 return pci_set_power_state(pdev, pci_choose_state(pdev, state));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005635}
5636
5637static int airo_pci_resume(struct pci_dev *pdev)
5638{
5639 struct net_device *dev = pci_get_drvdata(pdev);
Wang Chenfaf39942008-10-14 13:30:33 +08005640 struct airo_info *ai = dev->ml_priv;
Michal Schmidt53232802005-10-04 07:46:21 -04005641 pci_power_t prev_state = pdev->current_state;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005642
Michal Schmidt53232802005-10-04 07:46:21 -04005643 pci_set_power_state(pdev, PCI_D0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005644 pci_restore_state(pdev);
Michal Schmidt53232802005-10-04 07:46:21 -04005645 pci_enable_wake(pdev, PCI_D0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005646
Michal Schmidt53232802005-10-04 07:46:21 -04005647 if (prev_state != PCI_D1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005648 reset_card(dev, 0);
5649 mpi_init_descriptors(ai);
5650 setup_card(ai, dev->dev_addr, 0);
5651 clear_bit(FLAG_RADIO_OFF, &ai->flags);
5652 clear_bit(FLAG_PENDING_XMIT, &ai->flags);
5653 } else {
5654 OUT4500(ai, EVACK, EV_AWAKEN);
5655 OUT4500(ai, EVACK, EV_AWAKEN);
5656 msleep(100);
5657 }
5658
Pavel Macheke292c732008-06-25 12:25:53 +02005659 set_bit(FLAG_COMMIT, &ai->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005660 disable_MAC(ai, 0);
5661 msleep(200);
5662 if (ai->SSID) {
5663 writeSsidRid(ai, ai->SSID, 0);
5664 kfree(ai->SSID);
5665 ai->SSID = NULL;
5666 }
5667 if (ai->APList) {
5668 writeAPListRid(ai, ai->APList, 0);
5669 kfree(ai->APList);
5670 ai->APList = NULL;
5671 }
5672 writeConfigRid(ai, 0);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005673 enable_MAC(ai, 0);
Pavel Machek1cc68ae2005-06-20 15:33:04 -07005674 ai->power = PMSG_ON;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005675 netif_device_attach(dev);
5676 netif_wake_queue(dev);
5677 enable_interrupts(ai);
5678 up(&ai->sem);
5679 return 0;
5680}
5681#endif
5682
5683static int __init airo_init_module( void )
5684{
Jeff Garzikde897882006-10-01 07:31:09 -04005685 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005686
Alexey Dobriyan928b4d82008-04-29 01:01:44 -07005687 airo_entry = create_proc_entry("driver/aironet",
Linus Torvalds1da177e2005-04-16 15:20:36 -07005688 S_IFDIR | airo_perm,
Alexey Dobriyan928b4d82008-04-29 01:01:44 -07005689 NULL);
Jeff Garzikde897882006-10-01 07:31:09 -04005690
5691 if (airo_entry) {
5692 airo_entry->uid = proc_uid;
5693 airo_entry->gid = proc_gid;
5694 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005695
Pavel Macheke292c732008-06-25 12:25:53 +02005696 for (i = 0; i < 4 && io[i] && irq[i]; i++) {
Dan Williams934d8bf2006-03-16 13:46:23 -05005697 airo_print_info("", "Trying to configure ISA adapter at irq=%d "
5698 "io=0x%x", irq[i], io[i] );
Linus Torvalds1da177e2005-04-16 15:20:36 -07005699 if (init_airo_card( irq[i], io[i], 0, NULL ))
Jeff Garzikde897882006-10-01 07:31:09 -04005700 /* do nothing */ ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005701 }
5702
5703#ifdef CONFIG_PCI
Dan Williams934d8bf2006-03-16 13:46:23 -05005704 airo_print_info("", "Probing for PCI adapters");
Jeff Garzikde897882006-10-01 07:31:09 -04005705 i = pci_register_driver(&airo_driver);
Dan Williams934d8bf2006-03-16 13:46:23 -05005706 airo_print_info("", "Finished probing for PCI adapters");
Jeff Garzikde897882006-10-01 07:31:09 -04005707
5708 if (i) {
Alexey Dobriyan928b4d82008-04-29 01:01:44 -07005709 remove_proc_entry("driver/aironet", NULL);
Jeff Garzikde897882006-10-01 07:31:09 -04005710 return i;
5711 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005712#endif
5713
5714 /* Always exit with success, as we are a library module
5715 * as well as a driver module
5716 */
5717 return 0;
5718}
5719
5720static void __exit airo_cleanup_module( void )
5721{
Michal Schmidtaf5b5c92007-03-16 12:44:40 +01005722 struct airo_info *ai;
5723 while(!list_empty(&airo_devices)) {
5724 ai = list_entry(airo_devices.next, struct airo_info, dev_list);
5725 airo_print_info(ai->dev->name, "Unregistering...");
5726 stop_airo_card(ai->dev, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005727 }
5728#ifdef CONFIG_PCI
5729 pci_unregister_driver(&airo_driver);
5730#endif
Alexey Dobriyan928b4d82008-04-29 01:01:44 -07005731 remove_proc_entry("driver/aironet", NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005732}
5733
Linus Torvalds1da177e2005-04-16 15:20:36 -07005734/*
5735 * Initial Wireless Extension code for Aironet driver by :
5736 * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 17 November 00
5737 * Conversion to new driver API by :
5738 * Jean Tourrilhes <jt@hpl.hp.com> - HPL - 26 March 02
5739 * Javier also did a good amount of work here, adding some new extensions
5740 * and fixing my code. Let's just say that without him this code just
5741 * would not work at all... - Jean II
5742 */
5743
Dan Williams41480af2005-05-10 09:45:51 -04005744static u8 airo_rssi_to_dbm (tdsRssiEntry *rssi_rid, u8 rssi)
5745{
Pavel Macheke292c732008-06-25 12:25:53 +02005746 if (!rssi_rid)
Dan Williams41480af2005-05-10 09:45:51 -04005747 return 0;
5748
5749 return (0x100 - rssi_rid[rssi].rssidBm);
5750}
5751
5752static u8 airo_dbm_to_pct (tdsRssiEntry *rssi_rid, u8 dbm)
5753{
5754 int i;
5755
Pavel Macheke292c732008-06-25 12:25:53 +02005756 if (!rssi_rid)
Dan Williams41480af2005-05-10 09:45:51 -04005757 return 0;
5758
Pavel Macheke292c732008-06-25 12:25:53 +02005759 for (i = 0; i < 256; i++)
Dan Williams41480af2005-05-10 09:45:51 -04005760 if (rssi_rid[i].rssidBm == dbm)
5761 return rssi_rid[i].rssipct;
5762
5763 return 0;
5764}
5765
5766
Linus Torvalds1da177e2005-04-16 15:20:36 -07005767static int airo_get_quality (StatusRid *status_rid, CapabilityRid *cap_rid)
5768{
5769 int quality = 0;
Al Viro329e2c02007-12-20 22:58:57 -05005770 u16 sq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005771
Al Viro329e2c02007-12-20 22:58:57 -05005772 if ((status_rid->mode & cpu_to_le16(0x3f)) != cpu_to_le16(0x3f))
Al Viro56d81bd2007-12-20 17:18:35 -05005773 return 0;
5774
5775 if (!(cap_rid->hardCap & cpu_to_le16(8)))
5776 return 0;
5777
Al Viro329e2c02007-12-20 22:58:57 -05005778 sq = le16_to_cpu(status_rid->signalQuality);
Al Viro56d81bd2007-12-20 17:18:35 -05005779 if (memcmp(cap_rid->prodName, "350", 3))
Al Viro329e2c02007-12-20 22:58:57 -05005780 if (sq > 0x20)
Al Viro56d81bd2007-12-20 17:18:35 -05005781 quality = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005782 else
Al Viro329e2c02007-12-20 22:58:57 -05005783 quality = 0x20 - sq;
Al Viro56d81bd2007-12-20 17:18:35 -05005784 else
Al Viro329e2c02007-12-20 22:58:57 -05005785 if (sq > 0xb0)
Al Viro56d81bd2007-12-20 17:18:35 -05005786 quality = 0;
Al Viro329e2c02007-12-20 22:58:57 -05005787 else if (sq < 0x10)
Al Viro56d81bd2007-12-20 17:18:35 -05005788 quality = 0xa0;
5789 else
Al Viro329e2c02007-12-20 22:58:57 -05005790 quality = 0xb0 - sq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005791 return quality;
5792}
5793
5794#define airo_get_max_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x20 : 0xa0)
5795#define airo_get_avg_quality(cap_rid) (memcmp((cap_rid)->prodName, "350", 3) ? 0x10 : 0x50);
5796
5797/*------------------------------------------------------------------*/
5798/*
5799 * Wireless Handler : get protocol name
5800 */
5801static int airo_get_name(struct net_device *dev,
5802 struct iw_request_info *info,
5803 char *cwrq,
5804 char *extra)
5805{
5806 strcpy(cwrq, "IEEE 802.11-DS");
5807 return 0;
5808}
5809
5810/*------------------------------------------------------------------*/
5811/*
5812 * Wireless Handler : set frequency
5813 */
5814static int airo_set_freq(struct net_device *dev,
5815 struct iw_request_info *info,
5816 struct iw_freq *fwrq,
5817 char *extra)
5818{
Wang Chenfaf39942008-10-14 13:30:33 +08005819 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005820 int rc = -EINPROGRESS; /* Call commit handler */
5821
5822 /* If setting by frequency, convert to a channel */
David Kilroy9ee677c2008-12-23 14:03:38 +00005823 if(fwrq->e == 1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005824 int f = fwrq->m / 100000;
David Kilroy9ee677c2008-12-23 14:03:38 +00005825
Linus Torvalds1da177e2005-04-16 15:20:36 -07005826 /* Hack to fall through... */
5827 fwrq->e = 0;
David Kilroy9ee677c2008-12-23 14:03:38 +00005828 fwrq->m = ieee80211_freq_to_dsss_chan(f);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005829 }
5830 /* Setting by channel number */
5831 if((fwrq->m > 1000) || (fwrq->e > 0))
5832 rc = -EOPNOTSUPP;
5833 else {
5834 int channel = fwrq->m;
5835 /* We should do a better check than that,
5836 * based on the card capability !!! */
Javier Achirica2610c732006-01-17 08:01:01 -05005837 if((channel < 1) || (channel > 14)) {
Dan Williams934d8bf2006-03-16 13:46:23 -05005838 airo_print_dbg(dev->name, "New channel value of %d is invalid!",
5839 fwrq->m);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005840 rc = -EINVAL;
5841 } else {
5842 readConfigRid(local, 1);
5843 /* Yes ! We can set it !!! */
Al Viro3eb9b412007-12-21 00:00:35 -05005844 local->config.channelSet = cpu_to_le16(channel);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005845 set_bit (FLAG_COMMIT, &local->flags);
5846 }
5847 }
5848 return rc;
5849}
5850
5851/*------------------------------------------------------------------*/
5852/*
5853 * Wireless Handler : get frequency
5854 */
5855static int airo_get_freq(struct net_device *dev,
5856 struct iw_request_info *info,
5857 struct iw_freq *fwrq,
5858 char *extra)
5859{
Wang Chenfaf39942008-10-14 13:30:33 +08005860 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005861 StatusRid status_rid; /* Card status info */
Javier Achirica2610c732006-01-17 08:01:01 -05005862 int ch;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005863
5864 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05005865 if ((local->config.opmode & MODE_CFG_MASK) == MODE_STA_ESS)
5866 status_rid.channel = local->config.channelSet;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005867 else
5868 readStatusRid(local, &status_rid, 1);
5869
Al Viro329e2c02007-12-20 22:58:57 -05005870 ch = le16_to_cpu(status_rid.channel);
Javier Achirica2610c732006-01-17 08:01:01 -05005871 if((ch > 0) && (ch < 15)) {
David Kilroy9ee677c2008-12-23 14:03:38 +00005872 fwrq->m = ieee80211_dsss_chan_to_freq(ch) * 100000;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005873 fwrq->e = 1;
Javier Achirica2610c732006-01-17 08:01:01 -05005874 } else {
5875 fwrq->m = ch;
5876 fwrq->e = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005877 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07005878
5879 return 0;
5880}
5881
5882/*------------------------------------------------------------------*/
5883/*
5884 * Wireless Handler : set ESSID
5885 */
5886static int airo_set_essid(struct net_device *dev,
5887 struct iw_request_info *info,
5888 struct iw_point *dwrq,
5889 char *extra)
5890{
Wang Chenfaf39942008-10-14 13:30:33 +08005891 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005892 SsidRid SSID_rid; /* SSIDs */
5893
5894 /* Reload the list of current SSID */
5895 readSsidRid(local, &SSID_rid);
5896
5897 /* Check if we asked for `any' */
5898 if(dwrq->flags == 0) {
5899 /* Just send an empty SSID list */
5900 memset(&SSID_rid, 0, sizeof(SSID_rid));
5901 } else {
5902 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
5903
5904 /* Check the size of the string */
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07005905 if(dwrq->length > IW_ESSID_MAX_SIZE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005906 return -E2BIG ;
5907 }
5908 /* Check if index is valid */
5909 if((index < 0) || (index >= 4)) {
5910 return -EINVAL;
5911 }
5912
5913 /* Set the SSID */
5914 memset(SSID_rid.ssids[index].ssid, 0,
5915 sizeof(SSID_rid.ssids[index].ssid));
5916 memcpy(SSID_rid.ssids[index].ssid, extra, dwrq->length);
Al Viro0dd22122007-12-17 16:11:57 -05005917 SSID_rid.ssids[index].len = cpu_to_le16(dwrq->length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005918 }
Al Viro0dd22122007-12-17 16:11:57 -05005919 SSID_rid.len = cpu_to_le16(sizeof(SSID_rid));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005920 /* Write it to the card */
5921 disable_MAC(local, 1);
5922 writeSsidRid(local, &SSID_rid, 1);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005923 enable_MAC(local, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005924
5925 return 0;
5926}
5927
5928/*------------------------------------------------------------------*/
5929/*
5930 * Wireless Handler : get ESSID
5931 */
5932static int airo_get_essid(struct net_device *dev,
5933 struct iw_request_info *info,
5934 struct iw_point *dwrq,
5935 char *extra)
5936{
Wang Chenfaf39942008-10-14 13:30:33 +08005937 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005938 StatusRid status_rid; /* Card status info */
5939
5940 readStatusRid(local, &status_rid, 1);
5941
5942 /* Note : if dwrq->flags != 0, we should
5943 * get the relevant SSID from the SSID list... */
5944
5945 /* Get the current SSID */
Al Viro329e2c02007-12-20 22:58:57 -05005946 memcpy(extra, status_rid.SSID, le16_to_cpu(status_rid.SSIDlen));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005947 /* If none, we may want to get the one that was set */
5948
5949 /* Push it out ! */
Al Viro329e2c02007-12-20 22:58:57 -05005950 dwrq->length = le16_to_cpu(status_rid.SSIDlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005951 dwrq->flags = 1; /* active */
5952
5953 return 0;
5954}
5955
5956/*------------------------------------------------------------------*/
5957/*
5958 * Wireless Handler : set AP address
5959 */
5960static int airo_set_wap(struct net_device *dev,
5961 struct iw_request_info *info,
5962 struct sockaddr *awrq,
5963 char *extra)
5964{
Wang Chenfaf39942008-10-14 13:30:33 +08005965 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005966 Cmd cmd;
5967 Resp rsp;
5968 APListRid APList_rid;
Dan Williams4be757d2006-01-30 11:58:00 -05005969 static const u8 any[ETH_ALEN] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
5970 static const u8 off[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
Linus Torvalds1da177e2005-04-16 15:20:36 -07005971
5972 if (awrq->sa_family != ARPHRD_ETHER)
5973 return -EINVAL;
Dan Williams4be757d2006-01-30 11:58:00 -05005974 else if (!memcmp(any, awrq->sa_data, ETH_ALEN) ||
5975 !memcmp(off, awrq->sa_data, ETH_ALEN)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005976 memset(&cmd, 0, sizeof(cmd));
5977 cmd.cmd=CMD_LOSE_SYNC;
5978 if (down_interruptible(&local->sem))
5979 return -ERESTARTSYS;
5980 issuecommand(local, &cmd, &rsp);
5981 up(&local->sem);
5982 } else {
5983 memset(&APList_rid, 0, sizeof(APList_rid));
Al Viroa7497162007-12-20 17:49:41 -05005984 APList_rid.len = cpu_to_le16(sizeof(APList_rid));
Linus Torvalds1da177e2005-04-16 15:20:36 -07005985 memcpy(APList_rid.ap[0], awrq->sa_data, ETH_ALEN);
5986 disable_MAC(local, 1);
5987 writeAPListRid(local, &APList_rid, 1);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02005988 enable_MAC(local, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005989 }
5990 return 0;
5991}
5992
5993/*------------------------------------------------------------------*/
5994/*
5995 * Wireless Handler : get AP address
5996 */
5997static int airo_get_wap(struct net_device *dev,
5998 struct iw_request_info *info,
5999 struct sockaddr *awrq,
6000 char *extra)
6001{
Wang Chenfaf39942008-10-14 13:30:33 +08006002 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006003 StatusRid status_rid; /* Card status info */
6004
6005 readStatusRid(local, &status_rid, 1);
6006
6007 /* Tentative. This seems to work, wow, I'm lucky !!! */
6008 memcpy(awrq->sa_data, status_rid.bssid[0], ETH_ALEN);
6009 awrq->sa_family = ARPHRD_ETHER;
6010
6011 return 0;
6012}
6013
6014/*------------------------------------------------------------------*/
6015/*
6016 * Wireless Handler : set Nickname
6017 */
6018static int airo_set_nick(struct net_device *dev,
6019 struct iw_request_info *info,
6020 struct iw_point *dwrq,
6021 char *extra)
6022{
Wang Chenfaf39942008-10-14 13:30:33 +08006023 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006024
6025 /* Check the size of the string */
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07006026 if(dwrq->length > 16) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006027 return -E2BIG;
6028 }
6029 readConfigRid(local, 1);
6030 memset(local->config.nodeName, 0, sizeof(local->config.nodeName));
6031 memcpy(local->config.nodeName, extra, dwrq->length);
6032 set_bit (FLAG_COMMIT, &local->flags);
6033
6034 return -EINPROGRESS; /* Call commit handler */
6035}
6036
6037/*------------------------------------------------------------------*/
6038/*
6039 * Wireless Handler : get Nickname
6040 */
6041static int airo_get_nick(struct net_device *dev,
6042 struct iw_request_info *info,
6043 struct iw_point *dwrq,
6044 char *extra)
6045{
Wang Chenfaf39942008-10-14 13:30:33 +08006046 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006047
6048 readConfigRid(local, 1);
6049 strncpy(extra, local->config.nodeName, 16);
6050 extra[16] = '\0';
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07006051 dwrq->length = strlen(extra);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006052
6053 return 0;
6054}
6055
6056/*------------------------------------------------------------------*/
6057/*
6058 * Wireless Handler : set Bit-Rate
6059 */
6060static int airo_set_rate(struct net_device *dev,
6061 struct iw_request_info *info,
6062 struct iw_param *vwrq,
6063 char *extra)
6064{
Wang Chenfaf39942008-10-14 13:30:33 +08006065 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006066 CapabilityRid cap_rid; /* Card capability info */
6067 u8 brate = 0;
6068 int i;
6069
6070 /* First : get a valid bit rate value */
6071 readCapabilityRid(local, &cap_rid, 1);
6072
6073 /* Which type of value ? */
6074 if((vwrq->value < 8) && (vwrq->value >= 0)) {
6075 /* Setting by rate index */
6076 /* Find value in the magic rate table */
6077 brate = cap_rid.supportedRates[vwrq->value];
6078 } else {
6079 /* Setting by frequency value */
6080 u8 normvalue = (u8) (vwrq->value/500000);
6081
6082 /* Check if rate is valid */
6083 for(i = 0 ; i < 8 ; i++) {
6084 if(normvalue == cap_rid.supportedRates[i]) {
6085 brate = normvalue;
6086 break;
6087 }
6088 }
6089 }
6090 /* -1 designed the max rate (mostly auto mode) */
6091 if(vwrq->value == -1) {
6092 /* Get the highest available rate */
6093 for(i = 0 ; i < 8 ; i++) {
6094 if(cap_rid.supportedRates[i] == 0)
6095 break;
6096 }
6097 if(i != 0)
6098 brate = cap_rid.supportedRates[i - 1];
6099 }
6100 /* Check that it is valid */
6101 if(brate == 0) {
6102 return -EINVAL;
6103 }
6104
6105 readConfigRid(local, 1);
6106 /* Now, check if we want a fixed or auto value */
6107 if(vwrq->fixed == 0) {
6108 /* Fill all the rates up to this max rate */
6109 memset(local->config.rates, 0, 8);
6110 for(i = 0 ; i < 8 ; i++) {
6111 local->config.rates[i] = cap_rid.supportedRates[i];
6112 if(local->config.rates[i] == brate)
6113 break;
6114 }
6115 } else {
6116 /* Fixed mode */
6117 /* One rate, fixed */
6118 memset(local->config.rates, 0, 8);
6119 local->config.rates[0] = brate;
6120 }
6121 set_bit (FLAG_COMMIT, &local->flags);
6122
6123 return -EINPROGRESS; /* Call commit handler */
6124}
6125
6126/*------------------------------------------------------------------*/
6127/*
6128 * Wireless Handler : get Bit-Rate
6129 */
6130static int airo_get_rate(struct net_device *dev,
6131 struct iw_request_info *info,
6132 struct iw_param *vwrq,
6133 char *extra)
6134{
Wang Chenfaf39942008-10-14 13:30:33 +08006135 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006136 StatusRid status_rid; /* Card status info */
6137
6138 readStatusRid(local, &status_rid, 1);
6139
Al Viro329e2c02007-12-20 22:58:57 -05006140 vwrq->value = le16_to_cpu(status_rid.currentXmitRate) * 500000;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006141 /* If more than one rate, set auto */
6142 readConfigRid(local, 1);
6143 vwrq->fixed = (local->config.rates[1] == 0);
6144
6145 return 0;
6146}
6147
6148/*------------------------------------------------------------------*/
6149/*
6150 * Wireless Handler : set RTS threshold
6151 */
6152static int airo_set_rts(struct net_device *dev,
6153 struct iw_request_info *info,
6154 struct iw_param *vwrq,
6155 char *extra)
6156{
Wang Chenfaf39942008-10-14 13:30:33 +08006157 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006158 int rthr = vwrq->value;
6159
6160 if(vwrq->disabled)
Dan Williams15db2762006-03-16 13:46:27 -05006161 rthr = AIRO_DEF_MTU;
6162 if((rthr < 0) || (rthr > AIRO_DEF_MTU)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006163 return -EINVAL;
6164 }
6165 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006166 local->config.rtsThres = cpu_to_le16(rthr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006167 set_bit (FLAG_COMMIT, &local->flags);
6168
6169 return -EINPROGRESS; /* Call commit handler */
6170}
6171
6172/*------------------------------------------------------------------*/
6173/*
6174 * Wireless Handler : get RTS threshold
6175 */
6176static int airo_get_rts(struct net_device *dev,
6177 struct iw_request_info *info,
6178 struct iw_param *vwrq,
6179 char *extra)
6180{
Wang Chenfaf39942008-10-14 13:30:33 +08006181 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006182
6183 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006184 vwrq->value = le16_to_cpu(local->config.rtsThres);
Dan Williams15db2762006-03-16 13:46:27 -05006185 vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006186 vwrq->fixed = 1;
6187
6188 return 0;
6189}
6190
6191/*------------------------------------------------------------------*/
6192/*
6193 * Wireless Handler : set Fragmentation threshold
6194 */
6195static int airo_set_frag(struct net_device *dev,
6196 struct iw_request_info *info,
6197 struct iw_param *vwrq,
6198 char *extra)
6199{
Wang Chenfaf39942008-10-14 13:30:33 +08006200 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006201 int fthr = vwrq->value;
6202
6203 if(vwrq->disabled)
Dan Williams15db2762006-03-16 13:46:27 -05006204 fthr = AIRO_DEF_MTU;
6205 if((fthr < 256) || (fthr > AIRO_DEF_MTU)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006206 return -EINVAL;
6207 }
6208 fthr &= ~0x1; /* Get an even value - is it really needed ??? */
6209 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006210 local->config.fragThresh = cpu_to_le16(fthr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006211 set_bit (FLAG_COMMIT, &local->flags);
6212
6213 return -EINPROGRESS; /* Call commit handler */
6214}
6215
6216/*------------------------------------------------------------------*/
6217/*
6218 * Wireless Handler : get Fragmentation threshold
6219 */
6220static int airo_get_frag(struct net_device *dev,
6221 struct iw_request_info *info,
6222 struct iw_param *vwrq,
6223 char *extra)
6224{
Wang Chenfaf39942008-10-14 13:30:33 +08006225 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006226
6227 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006228 vwrq->value = le16_to_cpu(local->config.fragThresh);
Dan Williams15db2762006-03-16 13:46:27 -05006229 vwrq->disabled = (vwrq->value >= AIRO_DEF_MTU);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006230 vwrq->fixed = 1;
6231
6232 return 0;
6233}
6234
6235/*------------------------------------------------------------------*/
6236/*
6237 * Wireless Handler : set Mode of Operation
6238 */
6239static int airo_set_mode(struct net_device *dev,
6240 struct iw_request_info *info,
6241 __u32 *uwrq,
6242 char *extra)
6243{
Wang Chenfaf39942008-10-14 13:30:33 +08006244 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006245 int reset = 0;
6246
6247 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006248 if (sniffing_mode(local))
Linus Torvalds1da177e2005-04-16 15:20:36 -07006249 reset = 1;
6250
6251 switch(*uwrq) {
6252 case IW_MODE_ADHOC:
Al Viro3eb9b412007-12-21 00:00:35 -05006253 local->config.opmode &= ~MODE_CFG_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006254 local->config.opmode |= MODE_STA_IBSS;
Al Viro3eb9b412007-12-21 00:00:35 -05006255 local->config.rmode &= ~RXMODE_FULL_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006256 local->config.scanMode = SCANMODE_ACTIVE;
6257 clear_bit (FLAG_802_11, &local->flags);
6258 break;
6259 case IW_MODE_INFRA:
Al Viro3eb9b412007-12-21 00:00:35 -05006260 local->config.opmode &= ~MODE_CFG_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006261 local->config.opmode |= MODE_STA_ESS;
Al Viro3eb9b412007-12-21 00:00:35 -05006262 local->config.rmode &= ~RXMODE_FULL_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006263 local->config.scanMode = SCANMODE_ACTIVE;
6264 clear_bit (FLAG_802_11, &local->flags);
6265 break;
6266 case IW_MODE_MASTER:
Al Viro3eb9b412007-12-21 00:00:35 -05006267 local->config.opmode &= ~MODE_CFG_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006268 local->config.opmode |= MODE_AP;
Al Viro3eb9b412007-12-21 00:00:35 -05006269 local->config.rmode &= ~RXMODE_FULL_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006270 local->config.scanMode = SCANMODE_ACTIVE;
6271 clear_bit (FLAG_802_11, &local->flags);
6272 break;
6273 case IW_MODE_REPEAT:
Al Viro3eb9b412007-12-21 00:00:35 -05006274 local->config.opmode &= ~MODE_CFG_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006275 local->config.opmode |= MODE_AP_RPTR;
Al Viro3eb9b412007-12-21 00:00:35 -05006276 local->config.rmode &= ~RXMODE_FULL_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006277 local->config.scanMode = SCANMODE_ACTIVE;
6278 clear_bit (FLAG_802_11, &local->flags);
6279 break;
6280 case IW_MODE_MONITOR:
Al Viro3eb9b412007-12-21 00:00:35 -05006281 local->config.opmode &= ~MODE_CFG_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006282 local->config.opmode |= MODE_STA_ESS;
Al Viro3eb9b412007-12-21 00:00:35 -05006283 local->config.rmode &= ~RXMODE_FULL_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006284 local->config.rmode |= RXMODE_RFMON | RXMODE_DISABLE_802_3_HEADER;
6285 local->config.scanMode = SCANMODE_PASSIVE;
6286 set_bit (FLAG_802_11, &local->flags);
6287 break;
6288 default:
6289 return -EINVAL;
6290 }
6291 if (reset)
6292 set_bit (FLAG_RESET, &local->flags);
6293 set_bit (FLAG_COMMIT, &local->flags);
6294
6295 return -EINPROGRESS; /* Call commit handler */
6296}
6297
6298/*------------------------------------------------------------------*/
6299/*
6300 * Wireless Handler : get Mode of Operation
6301 */
6302static int airo_get_mode(struct net_device *dev,
6303 struct iw_request_info *info,
6304 __u32 *uwrq,
6305 char *extra)
6306{
Wang Chenfaf39942008-10-14 13:30:33 +08006307 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006308
6309 readConfigRid(local, 1);
6310 /* If not managed, assume it's ad-hoc */
Al Viro3eb9b412007-12-21 00:00:35 -05006311 switch (local->config.opmode & MODE_CFG_MASK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006312 case MODE_STA_ESS:
6313 *uwrq = IW_MODE_INFRA;
6314 break;
6315 case MODE_AP:
6316 *uwrq = IW_MODE_MASTER;
6317 break;
6318 case MODE_AP_RPTR:
6319 *uwrq = IW_MODE_REPEAT;
6320 break;
6321 default:
6322 *uwrq = IW_MODE_ADHOC;
6323 }
6324
6325 return 0;
6326}
6327
Dan Williams138c0c62009-01-24 09:11:35 -05006328static inline int valid_index(struct airo_info *ai, int index)
Al Viro56d81bd2007-12-20 17:18:35 -05006329{
Dan Williams138c0c62009-01-24 09:11:35 -05006330 return (index >= 0) && (index <= ai->max_wep_idx);
Al Viro56d81bd2007-12-20 17:18:35 -05006331}
6332
Linus Torvalds1da177e2005-04-16 15:20:36 -07006333/*------------------------------------------------------------------*/
6334/*
6335 * Wireless Handler : set Encryption Key
6336 */
6337static int airo_set_encode(struct net_device *dev,
6338 struct iw_request_info *info,
6339 struct iw_point *dwrq,
6340 char *extra)
6341{
Wang Chenfaf39942008-10-14 13:30:33 +08006342 struct airo_info *local = dev->ml_priv;
Dan Williamsc0380692009-01-24 09:12:15 -05006343 int perm = (dwrq->flags & IW_ENCODE_TEMP ? 0 : 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006344 __le16 currentAuthType = local->config.authType;
Dan Williamsc0380692009-01-24 09:12:15 -05006345 int rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006346
Dan Williams138c0c62009-01-24 09:11:35 -05006347 if (!local->wep_capable)
Linus Torvalds1da177e2005-04-16 15:20:36 -07006348 return -EOPNOTSUPP;
Dan Williams138c0c62009-01-24 09:11:35 -05006349
Linus Torvalds1da177e2005-04-16 15:20:36 -07006350 readConfigRid(local, 1);
6351
6352 /* Basic checking: do we have a key to set ?
6353 * Note : with the new API, it's impossible to get a NULL pointer.
6354 * Therefore, we need to check a key size == 0 instead.
6355 * New version of iwconfig properly set the IW_ENCODE_NOKEY flag
6356 * when no key is present (only change flags), but older versions
6357 * don't do it. - Jean II */
6358 if (dwrq->length > 0) {
6359 wep_key_t key;
6360 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
Dan Williamsc0380692009-01-24 09:12:15 -05006361 int current_index;
Dan Williams138c0c62009-01-24 09:11:35 -05006362
Linus Torvalds1da177e2005-04-16 15:20:36 -07006363 /* Check the size of the key */
6364 if (dwrq->length > MAX_KEY_SIZE) {
6365 return -EINVAL;
6366 }
Dan Williams138c0c62009-01-24 09:11:35 -05006367
Dan Williamsc0380692009-01-24 09:12:15 -05006368 current_index = get_wep_tx_idx(local);
6369 if (current_index < 0)
6370 current_index = 0;
6371
Linus Torvalds1da177e2005-04-16 15:20:36 -07006372 /* Check the index (none -> use current) */
Dan Williams138c0c62009-01-24 09:11:35 -05006373 if (!valid_index(local, index))
Linus Torvalds1da177e2005-04-16 15:20:36 -07006374 index = current_index;
Dan Williams138c0c62009-01-24 09:11:35 -05006375
Linus Torvalds1da177e2005-04-16 15:20:36 -07006376 /* Set the length */
6377 if (dwrq->length > MIN_KEY_SIZE)
6378 key.len = MAX_KEY_SIZE;
6379 else
6380 if (dwrq->length > 0)
6381 key.len = MIN_KEY_SIZE;
6382 else
6383 /* Disable the key */
6384 key.len = 0;
6385 /* Check if the key is not marked as invalid */
6386 if(!(dwrq->flags & IW_ENCODE_NOKEY)) {
6387 /* Cleanup */
6388 memset(key.key, 0, MAX_KEY_SIZE);
6389 /* Copy the key in the driver */
6390 memcpy(key.key, extra, dwrq->length);
6391 /* Send the key to the card */
Dan Williamsc0380692009-01-24 09:12:15 -05006392 rc = set_wep_key(local, index, key.key, key.len, perm, 1);
6393 if (rc < 0) {
6394 airo_print_err(local->dev->name, "failed to set"
6395 " WEP key at index %d: %d.",
6396 index, rc);
6397 return rc;
6398 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07006399 }
6400 /* WE specify that if a valid key is set, encryption
6401 * should be enabled (user may turn it off later)
6402 * This is also how "iwconfig ethX key on" works */
6403 if((index == current_index) && (key.len > 0) &&
6404 (local->config.authType == AUTH_OPEN)) {
6405 local->config.authType = AUTH_ENCRYPT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006406 }
6407 } else {
6408 /* Do we want to just set the transmit key index ? */
6409 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
Dan Williamsc0380692009-01-24 09:12:15 -05006410 if (valid_index(local, index)) {
6411 rc = set_wep_tx_idx(local, index, perm, 1);
6412 if (rc < 0) {
6413 airo_print_err(local->dev->name, "failed to set"
6414 " WEP transmit index to %d: %d.",
6415 index, rc);
6416 return rc;
6417 }
6418 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006419 /* Don't complain if only change the mode */
Jeff Garzik93a3b602007-11-23 21:50:20 -05006420 if (!(dwrq->flags & IW_ENCODE_MODE))
Linus Torvalds1da177e2005-04-16 15:20:36 -07006421 return -EINVAL;
Dan Williams138c0c62009-01-24 09:11:35 -05006422 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07006423 }
6424 /* Read the flags */
6425 if(dwrq->flags & IW_ENCODE_DISABLED)
6426 local->config.authType = AUTH_OPEN; // disable encryption
6427 if(dwrq->flags & IW_ENCODE_RESTRICTED)
6428 local->config.authType = AUTH_SHAREDKEY; // Only Both
6429 if(dwrq->flags & IW_ENCODE_OPEN)
6430 local->config.authType = AUTH_ENCRYPT; // Only Wep
6431 /* Commit the changes to flags if needed */
Dan Streetmanf89b2322005-11-11 11:41:42 -05006432 if (local->config.authType != currentAuthType)
Linus Torvalds1da177e2005-04-16 15:20:36 -07006433 set_bit (FLAG_COMMIT, &local->flags);
6434 return -EINPROGRESS; /* Call commit handler */
6435}
6436
6437/*------------------------------------------------------------------*/
6438/*
6439 * Wireless Handler : get Encryption Key
6440 */
6441static int airo_get_encode(struct net_device *dev,
6442 struct iw_request_info *info,
6443 struct iw_point *dwrq,
6444 char *extra)
6445{
Wang Chenfaf39942008-10-14 13:30:33 +08006446 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006447 int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
Dan Williamsc0380692009-01-24 09:12:15 -05006448 u8 buf[16];
Linus Torvalds1da177e2005-04-16 15:20:36 -07006449
Dan Williams138c0c62009-01-24 09:11:35 -05006450 if (!local->wep_capable)
Linus Torvalds1da177e2005-04-16 15:20:36 -07006451 return -EOPNOTSUPP;
Dan Williams138c0c62009-01-24 09:11:35 -05006452
Linus Torvalds1da177e2005-04-16 15:20:36 -07006453 readConfigRid(local, 1);
Dan Williams138c0c62009-01-24 09:11:35 -05006454
Linus Torvalds1da177e2005-04-16 15:20:36 -07006455 /* Check encryption mode */
6456 switch(local->config.authType) {
6457 case AUTH_ENCRYPT:
6458 dwrq->flags = IW_ENCODE_OPEN;
6459 break;
6460 case AUTH_SHAREDKEY:
6461 dwrq->flags = IW_ENCODE_RESTRICTED;
6462 break;
6463 default:
6464 case AUTH_OPEN:
6465 dwrq->flags = IW_ENCODE_DISABLED;
6466 break;
6467 }
6468 /* We can't return the key, so set the proper flag and return zero */
6469 dwrq->flags |= IW_ENCODE_NOKEY;
6470 memset(extra, 0, 16);
6471
6472 /* Which key do we want ? -1 -> tx index */
Dan Williamsc0380692009-01-24 09:12:15 -05006473 if (!valid_index(local, index)) {
6474 index = get_wep_tx_idx(local);
6475 if (index < 0)
6476 index = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006477 }
Dan Williamsc0380692009-01-24 09:12:15 -05006478 dwrq->flags |= index + 1;
6479
6480 /* Copy the key to the user buffer */
6481 dwrq->length = get_wep_key(local, index, &buf[0], sizeof(buf));
6482 memcpy(extra, buf, dwrq->length);
6483
Linus Torvalds1da177e2005-04-16 15:20:36 -07006484 return 0;
6485}
6486
6487/*------------------------------------------------------------------*/
6488/*
Dan Williams4be757d2006-01-30 11:58:00 -05006489 * Wireless Handler : set extended Encryption parameters
6490 */
6491static int airo_set_encodeext(struct net_device *dev,
6492 struct iw_request_info *info,
6493 union iwreq_data *wrqu,
6494 char *extra)
6495{
Wang Chenfaf39942008-10-14 13:30:33 +08006496 struct airo_info *local = dev->ml_priv;
Dan Williams4be757d2006-01-30 11:58:00 -05006497 struct iw_point *encoding = &wrqu->encoding;
6498 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
Dan Williams4be757d2006-01-30 11:58:00 -05006499 int perm = ( encoding->flags & IW_ENCODE_TEMP ? 0 : 1 );
Al Viro3eb9b412007-12-21 00:00:35 -05006500 __le16 currentAuthType = local->config.authType;
Dan Williamsc0380692009-01-24 09:12:15 -05006501 int idx, key_len, alg = ext->alg, set_key = 1, rc;
Dan Williams4be757d2006-01-30 11:58:00 -05006502 wep_key_t key;
6503
Dan Williams138c0c62009-01-24 09:11:35 -05006504 if (!local->wep_capable)
Dan Williams4be757d2006-01-30 11:58:00 -05006505 return -EOPNOTSUPP;
Dan Williams138c0c62009-01-24 09:11:35 -05006506
Dan Williams4be757d2006-01-30 11:58:00 -05006507 readConfigRid(local, 1);
6508
6509 /* Determine and validate the key index */
6510 idx = encoding->flags & IW_ENCODE_INDEX;
6511 if (idx) {
Dan Williams138c0c62009-01-24 09:11:35 -05006512 if (!valid_index(local, idx - 1))
Dan Williams4be757d2006-01-30 11:58:00 -05006513 return -EINVAL;
6514 idx--;
Dan Williamsc0380692009-01-24 09:12:15 -05006515 } else {
6516 idx = get_wep_tx_idx(local);
6517 if (idx < 0)
6518 idx = 0;
6519 }
Dan Williams4be757d2006-01-30 11:58:00 -05006520
6521 if (encoding->flags & IW_ENCODE_DISABLED)
6522 alg = IW_ENCODE_ALG_NONE;
6523
Dan Williams4be757d2006-01-30 11:58:00 -05006524 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
Dan Williams22d88462006-02-05 18:00:30 -05006525 /* Only set transmit key index here, actual
6526 * key is set below if needed.
6527 */
Dan Williamsc0380692009-01-24 09:12:15 -05006528 rc = set_wep_tx_idx(local, idx, perm, 1);
6529 if (rc < 0) {
6530 airo_print_err(local->dev->name, "failed to set "
6531 "WEP transmit index to %d: %d.",
6532 idx, rc);
6533 return rc;
6534 }
Dan Williams22d88462006-02-05 18:00:30 -05006535 set_key = ext->key_len > 0 ? 1 : 0;
6536 }
6537
6538 if (set_key) {
Dan Williams4be757d2006-01-30 11:58:00 -05006539 /* Set the requested key first */
6540 memset(key.key, 0, MAX_KEY_SIZE);
6541 switch (alg) {
6542 case IW_ENCODE_ALG_NONE:
6543 key.len = 0;
6544 break;
6545 case IW_ENCODE_ALG_WEP:
6546 if (ext->key_len > MIN_KEY_SIZE) {
6547 key.len = MAX_KEY_SIZE;
6548 } else if (ext->key_len > 0) {
6549 key.len = MIN_KEY_SIZE;
6550 } else {
6551 return -EINVAL;
6552 }
6553 key_len = min (ext->key_len, key.len);
6554 memcpy(key.key, ext->key, key_len);
6555 break;
6556 default:
6557 return -EINVAL;
6558 }
6559 /* Send the key to the card */
Dan Williamsc0380692009-01-24 09:12:15 -05006560 rc = set_wep_key(local, idx, key.key, key.len, perm, 1);
6561 if (rc < 0) {
6562 airo_print_err(local->dev->name, "failed to set WEP key"
6563 " at index %d: %d.", idx, rc);
6564 return rc;
6565 }
Dan Williams4be757d2006-01-30 11:58:00 -05006566 }
6567
6568 /* Read the flags */
6569 if(encoding->flags & IW_ENCODE_DISABLED)
6570 local->config.authType = AUTH_OPEN; // disable encryption
6571 if(encoding->flags & IW_ENCODE_RESTRICTED)
6572 local->config.authType = AUTH_SHAREDKEY; // Only Both
6573 if(encoding->flags & IW_ENCODE_OPEN)
6574 local->config.authType = AUTH_ENCRYPT; // Only Wep
6575 /* Commit the changes to flags if needed */
6576 if (local->config.authType != currentAuthType)
6577 set_bit (FLAG_COMMIT, &local->flags);
6578
6579 return -EINPROGRESS;
6580}
6581
6582
6583/*------------------------------------------------------------------*/
6584/*
6585 * Wireless Handler : get extended Encryption parameters
6586 */
6587static int airo_get_encodeext(struct net_device *dev,
6588 struct iw_request_info *info,
6589 union iwreq_data *wrqu,
6590 char *extra)
6591{
Wang Chenfaf39942008-10-14 13:30:33 +08006592 struct airo_info *local = dev->ml_priv;
Dan Williams4be757d2006-01-30 11:58:00 -05006593 struct iw_point *encoding = &wrqu->encoding;
6594 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
Dan Williams4be757d2006-01-30 11:58:00 -05006595 int idx, max_key_len;
Dan Williamsc0380692009-01-24 09:12:15 -05006596 u8 buf[16];
Dan Williams4be757d2006-01-30 11:58:00 -05006597
Dan Williams138c0c62009-01-24 09:11:35 -05006598 if (!local->wep_capable)
Dan Williams4be757d2006-01-30 11:58:00 -05006599 return -EOPNOTSUPP;
Dan Williams138c0c62009-01-24 09:11:35 -05006600
Dan Williams4be757d2006-01-30 11:58:00 -05006601 readConfigRid(local, 1);
6602
6603 max_key_len = encoding->length - sizeof(*ext);
6604 if (max_key_len < 0)
6605 return -EINVAL;
6606
6607 idx = encoding->flags & IW_ENCODE_INDEX;
6608 if (idx) {
Dan Williams138c0c62009-01-24 09:11:35 -05006609 if (!valid_index(local, idx - 1))
Dan Williams4be757d2006-01-30 11:58:00 -05006610 return -EINVAL;
6611 idx--;
Dan Williamsc0380692009-01-24 09:12:15 -05006612 } else {
6613 idx = get_wep_tx_idx(local);
6614 if (idx < 0)
6615 idx = 0;
6616 }
Dan Williams4be757d2006-01-30 11:58:00 -05006617
6618 encoding->flags = idx + 1;
6619 memset(ext, 0, sizeof(*ext));
6620
6621 /* Check encryption mode */
6622 switch(local->config.authType) {
6623 case AUTH_ENCRYPT:
6624 encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6625 break;
6626 case AUTH_SHAREDKEY:
6627 encoding->flags = IW_ENCODE_ALG_WEP | IW_ENCODE_ENABLED;
6628 break;
6629 default:
6630 case AUTH_OPEN:
6631 encoding->flags = IW_ENCODE_ALG_NONE | IW_ENCODE_DISABLED;
6632 break;
6633 }
6634 /* We can't return the key, so set the proper flag and return zero */
6635 encoding->flags |= IW_ENCODE_NOKEY;
6636 memset(extra, 0, 16);
6637
6638 /* Copy the key to the user buffer */
Dan Williamsc0380692009-01-24 09:12:15 -05006639 ext->key_len = get_wep_key(local, idx, &buf[0], sizeof(buf));
6640 memcpy(extra, buf, ext->key_len);
Dan Williams4be757d2006-01-30 11:58:00 -05006641
6642 return 0;
6643}
6644
6645
6646/*------------------------------------------------------------------*/
6647/*
6648 * Wireless Handler : set extended authentication parameters
6649 */
6650static int airo_set_auth(struct net_device *dev,
6651 struct iw_request_info *info,
6652 union iwreq_data *wrqu, char *extra)
6653{
Wang Chenfaf39942008-10-14 13:30:33 +08006654 struct airo_info *local = dev->ml_priv;
Dan Williams4be757d2006-01-30 11:58:00 -05006655 struct iw_param *param = &wrqu->param;
Al Viro3eb9b412007-12-21 00:00:35 -05006656 __le16 currentAuthType = local->config.authType;
Dan Williams4be757d2006-01-30 11:58:00 -05006657
6658 switch (param->flags & IW_AUTH_INDEX) {
6659 case IW_AUTH_WPA_VERSION:
6660 case IW_AUTH_CIPHER_PAIRWISE:
6661 case IW_AUTH_CIPHER_GROUP:
6662 case IW_AUTH_KEY_MGMT:
6663 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6664 case IW_AUTH_PRIVACY_INVOKED:
6665 /*
6666 * airo does not use these parameters
6667 */
6668 break;
6669
6670 case IW_AUTH_DROP_UNENCRYPTED:
6671 if (param->value) {
6672 /* Only change auth type if unencrypted */
6673 if (currentAuthType == AUTH_OPEN)
6674 local->config.authType = AUTH_ENCRYPT;
6675 } else {
6676 local->config.authType = AUTH_OPEN;
6677 }
6678
6679 /* Commit the changes to flags if needed */
6680 if (local->config.authType != currentAuthType)
6681 set_bit (FLAG_COMMIT, &local->flags);
6682 break;
6683
6684 case IW_AUTH_80211_AUTH_ALG: {
6685 /* FIXME: What about AUTH_OPEN? This API seems to
6686 * disallow setting our auth to AUTH_OPEN.
6687 */
6688 if (param->value & IW_AUTH_ALG_SHARED_KEY) {
6689 local->config.authType = AUTH_SHAREDKEY;
6690 } else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
6691 local->config.authType = AUTH_ENCRYPT;
6692 } else
6693 return -EINVAL;
6694 break;
6695
6696 /* Commit the changes to flags if needed */
6697 if (local->config.authType != currentAuthType)
6698 set_bit (FLAG_COMMIT, &local->flags);
6699 }
6700
6701 case IW_AUTH_WPA_ENABLED:
6702 /* Silently accept disable of WPA */
6703 if (param->value > 0)
6704 return -EOPNOTSUPP;
6705 break;
6706
6707 default:
6708 return -EOPNOTSUPP;
6709 }
6710 return -EINPROGRESS;
6711}
6712
6713
6714/*------------------------------------------------------------------*/
6715/*
6716 * Wireless Handler : get extended authentication parameters
6717 */
6718static int airo_get_auth(struct net_device *dev,
6719 struct iw_request_info *info,
6720 union iwreq_data *wrqu, char *extra)
6721{
Wang Chenfaf39942008-10-14 13:30:33 +08006722 struct airo_info *local = dev->ml_priv;
Dan Williams4be757d2006-01-30 11:58:00 -05006723 struct iw_param *param = &wrqu->param;
Al Viro3eb9b412007-12-21 00:00:35 -05006724 __le16 currentAuthType = local->config.authType;
Dan Williams4be757d2006-01-30 11:58:00 -05006725
6726 switch (param->flags & IW_AUTH_INDEX) {
6727 case IW_AUTH_DROP_UNENCRYPTED:
6728 switch (currentAuthType) {
6729 case AUTH_SHAREDKEY:
6730 case AUTH_ENCRYPT:
6731 param->value = 1;
6732 break;
6733 default:
6734 param->value = 0;
6735 break;
6736 }
6737 break;
6738
6739 case IW_AUTH_80211_AUTH_ALG:
6740 switch (currentAuthType) {
6741 case AUTH_SHAREDKEY:
6742 param->value = IW_AUTH_ALG_SHARED_KEY;
6743 break;
6744 case AUTH_ENCRYPT:
6745 default:
6746 param->value = IW_AUTH_ALG_OPEN_SYSTEM;
6747 break;
6748 }
6749 break;
6750
6751 case IW_AUTH_WPA_ENABLED:
6752 param->value = 0;
6753 break;
6754
6755 default:
6756 return -EOPNOTSUPP;
6757 }
6758 return 0;
6759}
6760
6761
6762/*------------------------------------------------------------------*/
6763/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07006764 * Wireless Handler : set Tx-Power
6765 */
6766static int airo_set_txpow(struct net_device *dev,
6767 struct iw_request_info *info,
6768 struct iw_param *vwrq,
6769 char *extra)
6770{
Wang Chenfaf39942008-10-14 13:30:33 +08006771 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006772 CapabilityRid cap_rid; /* Card capability info */
6773 int i;
6774 int rc = -EINVAL;
Al Viro3eb9b412007-12-21 00:00:35 -05006775 __le16 v = cpu_to_le16(vwrq->value);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006776
6777 readCapabilityRid(local, &cap_rid, 1);
6778
6779 if (vwrq->disabled) {
6780 set_bit (FLAG_RADIO_OFF, &local->flags);
6781 set_bit (FLAG_COMMIT, &local->flags);
6782 return -EINPROGRESS; /* Call commit handler */
6783 }
6784 if (vwrq->flags != IW_TXPOW_MWATT) {
6785 return -EINVAL;
6786 }
6787 clear_bit (FLAG_RADIO_OFF, &local->flags);
6788 for (i = 0; cap_rid.txPowerLevels[i] && (i < 8); i++)
Al Viro3eb9b412007-12-21 00:00:35 -05006789 if (v == cap_rid.txPowerLevels[i]) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006790 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006791 local->config.txPower = v;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006792 set_bit (FLAG_COMMIT, &local->flags);
6793 rc = -EINPROGRESS; /* Call commit handler */
6794 break;
6795 }
6796 return rc;
6797}
6798
6799/*------------------------------------------------------------------*/
6800/*
6801 * Wireless Handler : get Tx-Power
6802 */
6803static int airo_get_txpow(struct net_device *dev,
6804 struct iw_request_info *info,
6805 struct iw_param *vwrq,
6806 char *extra)
6807{
Wang Chenfaf39942008-10-14 13:30:33 +08006808 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006809
6810 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05006811 vwrq->value = le16_to_cpu(local->config.txPower);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006812 vwrq->fixed = 1; /* No power control */
6813 vwrq->disabled = test_bit(FLAG_RADIO_OFF, &local->flags);
6814 vwrq->flags = IW_TXPOW_MWATT;
6815
6816 return 0;
6817}
6818
6819/*------------------------------------------------------------------*/
6820/*
6821 * Wireless Handler : set Retry limits
6822 */
6823static int airo_set_retry(struct net_device *dev,
6824 struct iw_request_info *info,
6825 struct iw_param *vwrq,
6826 char *extra)
6827{
Wang Chenfaf39942008-10-14 13:30:33 +08006828 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006829 int rc = -EINVAL;
6830
6831 if(vwrq->disabled) {
6832 return -EINVAL;
6833 }
6834 readConfigRid(local, 1);
6835 if(vwrq->flags & IW_RETRY_LIMIT) {
Al Viro3eb9b412007-12-21 00:00:35 -05006836 __le16 v = cpu_to_le16(vwrq->value);
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07006837 if(vwrq->flags & IW_RETRY_LONG)
Al Viro3eb9b412007-12-21 00:00:35 -05006838 local->config.longRetryLimit = v;
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07006839 else if (vwrq->flags & IW_RETRY_SHORT)
Al Viro3eb9b412007-12-21 00:00:35 -05006840 local->config.shortRetryLimit = v;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006841 else {
6842 /* No modifier : set both */
Al Viro3eb9b412007-12-21 00:00:35 -05006843 local->config.longRetryLimit = v;
6844 local->config.shortRetryLimit = v;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006845 }
6846 set_bit (FLAG_COMMIT, &local->flags);
6847 rc = -EINPROGRESS; /* Call commit handler */
6848 }
6849 if(vwrq->flags & IW_RETRY_LIFETIME) {
Al Viro3eb9b412007-12-21 00:00:35 -05006850 local->config.txLifetime = cpu_to_le16(vwrq->value / 1024);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006851 set_bit (FLAG_COMMIT, &local->flags);
6852 rc = -EINPROGRESS; /* Call commit handler */
6853 }
6854 return rc;
6855}
6856
6857/*------------------------------------------------------------------*/
6858/*
6859 * Wireless Handler : get Retry limits
6860 */
6861static int airo_get_retry(struct net_device *dev,
6862 struct iw_request_info *info,
6863 struct iw_param *vwrq,
6864 char *extra)
6865{
Wang Chenfaf39942008-10-14 13:30:33 +08006866 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006867
6868 vwrq->disabled = 0; /* Can't be disabled */
6869
6870 readConfigRid(local, 1);
6871 /* Note : by default, display the min retry number */
6872 if((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
6873 vwrq->flags = IW_RETRY_LIFETIME;
Al Viro3eb9b412007-12-21 00:00:35 -05006874 vwrq->value = le16_to_cpu(local->config.txLifetime) * 1024;
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07006875 } else if((vwrq->flags & IW_RETRY_LONG)) {
6876 vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
Al Viro3eb9b412007-12-21 00:00:35 -05006877 vwrq->value = le16_to_cpu(local->config.longRetryLimit);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006878 } else {
6879 vwrq->flags = IW_RETRY_LIMIT;
Al Viro3eb9b412007-12-21 00:00:35 -05006880 vwrq->value = le16_to_cpu(local->config.shortRetryLimit);
6881 if(local->config.shortRetryLimit != local->config.longRetryLimit)
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07006882 vwrq->flags |= IW_RETRY_SHORT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006883 }
6884
6885 return 0;
6886}
6887
6888/*------------------------------------------------------------------*/
6889/*
6890 * Wireless Handler : get range info
6891 */
6892static int airo_get_range(struct net_device *dev,
6893 struct iw_request_info *info,
6894 struct iw_point *dwrq,
6895 char *extra)
6896{
Wang Chenfaf39942008-10-14 13:30:33 +08006897 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006898 struct iw_range *range = (struct iw_range *) extra;
6899 CapabilityRid cap_rid; /* Card capability info */
6900 int i;
6901 int k;
6902
6903 readCapabilityRid(local, &cap_rid, 1);
6904
6905 dwrq->length = sizeof(struct iw_range);
6906 memset(range, 0, sizeof(*range));
6907 range->min_nwid = 0x0000;
6908 range->max_nwid = 0x0000;
6909 range->num_channels = 14;
6910 /* Should be based on cap_rid.country to give only
6911 * what the current card support */
6912 k = 0;
6913 for(i = 0; i < 14; i++) {
6914 range->freq[k].i = i + 1; /* List index */
David Kilroy9ee677c2008-12-23 14:03:38 +00006915 range->freq[k].m = ieee80211_dsss_chan_to_freq(i + 1) * 100000;
6916 range->freq[k++].e = 1; /* Values in MHz -> * 10^5 * 10 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07006917 }
6918 range->num_frequency = k;
6919
Linus Torvalds1da177e2005-04-16 15:20:36 -07006920 range->sensitivity = 65535;
6921
Dan Williams41480af2005-05-10 09:45:51 -04006922 /* Hum... Should put the right values there */
6923 if (local->rssi)
6924 range->max_qual.qual = 100; /* % */
6925 else
6926 range->max_qual.qual = airo_get_max_quality(&cap_rid);
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07006927 range->max_qual.level = 0x100 - 120; /* -120 dBm */
6928 range->max_qual.noise = 0x100 - 120; /* -120 dBm */
Dan Williams41480af2005-05-10 09:45:51 -04006929
6930 /* Experimental measurements - boundary 11/5.5 Mb/s */
6931 /* Note : with or without the (local->rssi), results
6932 * are somewhat different. - Jean II */
6933 if (local->rssi) {
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07006934 range->avg_qual.qual = 50; /* % */
6935 range->avg_qual.level = 0x100 - 70; /* -70 dBm */
Dan Williams41480af2005-05-10 09:45:51 -04006936 } else {
6937 range->avg_qual.qual = airo_get_avg_quality(&cap_rid);
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07006938 range->avg_qual.level = 0x100 - 80; /* -80 dBm */
Dan Williams41480af2005-05-10 09:45:51 -04006939 }
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07006940 range->avg_qual.noise = 0x100 - 85; /* -85 dBm */
Dan Williams41480af2005-05-10 09:45:51 -04006941
Linus Torvalds1da177e2005-04-16 15:20:36 -07006942 for(i = 0 ; i < 8 ; i++) {
6943 range->bitrate[i] = cap_rid.supportedRates[i] * 500000;
6944 if(range->bitrate[i] == 0)
6945 break;
6946 }
6947 range->num_bitrates = i;
6948
6949 /* Set an indication of the max TCP throughput
6950 * in bit/s that we can expect using this interface.
6951 * May be use for QoS stuff... Jean II */
6952 if(i > 2)
6953 range->throughput = 5000 * 1000;
6954 else
6955 range->throughput = 1500 * 1000;
6956
6957 range->min_rts = 0;
Dan Williams15db2762006-03-16 13:46:27 -05006958 range->max_rts = AIRO_DEF_MTU;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006959 range->min_frag = 256;
Dan Williams15db2762006-03-16 13:46:27 -05006960 range->max_frag = AIRO_DEF_MTU;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006961
Al Viro56d81bd2007-12-20 17:18:35 -05006962 if(cap_rid.softCap & cpu_to_le16(2)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006963 // WEP: RC4 40 bits
6964 range->encoding_size[0] = 5;
6965 // RC4 ~128 bits
Al Viro56d81bd2007-12-20 17:18:35 -05006966 if (cap_rid.softCap & cpu_to_le16(0x100)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07006967 range->encoding_size[1] = 13;
6968 range->num_encoding_sizes = 2;
6969 } else
6970 range->num_encoding_sizes = 1;
Al Viro56d81bd2007-12-20 17:18:35 -05006971 range->max_encoding_tokens =
6972 cap_rid.softCap & cpu_to_le16(0x80) ? 4 : 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006973 } else {
6974 range->num_encoding_sizes = 0;
6975 range->max_encoding_tokens = 0;
6976 }
6977 range->min_pmp = 0;
6978 range->max_pmp = 5000000; /* 5 secs */
6979 range->min_pmt = 0;
6980 range->max_pmt = 65535 * 1024; /* ??? */
6981 range->pmp_flags = IW_POWER_PERIOD;
6982 range->pmt_flags = IW_POWER_TIMEOUT;
6983 range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
6984
6985 /* Transmit Power - values are in mW */
6986 for(i = 0 ; i < 8 ; i++) {
Al Viro56d81bd2007-12-20 17:18:35 -05006987 range->txpower[i] = le16_to_cpu(cap_rid.txPowerLevels[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006988 if(range->txpower[i] == 0)
6989 break;
6990 }
6991 range->num_txpower = i;
6992 range->txpower_capa = IW_TXPOW_MWATT;
Dan Williams3c304952006-04-15 12:26:18 -04006993 range->we_version_source = 19;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006994 range->we_version_compiled = WIRELESS_EXT;
6995 range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
6996 range->retry_flags = IW_RETRY_LIMIT;
6997 range->r_time_flags = IW_RETRY_LIFETIME;
6998 range->min_retry = 1;
6999 range->max_retry = 65535;
7000 range->min_r_time = 1024;
7001 range->max_r_time = 65535 * 1024;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007002
7003 /* Event capability (kernel + driver) */
7004 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
7005 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
7006 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
7007 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
7008 range->event_capa[1] = IW_EVENT_CAPA_K_1;
7009 range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVTXDROP);
7010 return 0;
7011}
7012
7013/*------------------------------------------------------------------*/
7014/*
7015 * Wireless Handler : set Power Management
7016 */
7017static int airo_set_power(struct net_device *dev,
7018 struct iw_request_info *info,
7019 struct iw_param *vwrq,
7020 char *extra)
7021{
Wang Chenfaf39942008-10-14 13:30:33 +08007022 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007023
7024 readConfigRid(local, 1);
7025 if (vwrq->disabled) {
Al Viro3eb9b412007-12-21 00:00:35 -05007026 if (sniffing_mode(local))
Linus Torvalds1da177e2005-04-16 15:20:36 -07007027 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007028 local->config.powerSaveMode = POWERSAVE_CAM;
Al Viro3eb9b412007-12-21 00:00:35 -05007029 local->config.rmode &= ~RXMODE_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007030 local->config.rmode |= RXMODE_BC_MC_ADDR;
7031 set_bit (FLAG_COMMIT, &local->flags);
7032 return -EINPROGRESS; /* Call commit handler */
7033 }
7034 if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
Al Viro3eb9b412007-12-21 00:00:35 -05007035 local->config.fastListenDelay = cpu_to_le16((vwrq->value + 500) / 1024);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007036 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7037 set_bit (FLAG_COMMIT, &local->flags);
7038 } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
Al Viro3eb9b412007-12-21 00:00:35 -05007039 local->config.fastListenInterval =
7040 local->config.listenInterval =
7041 cpu_to_le16((vwrq->value + 500) / 1024);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007042 local->config.powerSaveMode = POWERSAVE_PSPCAM;
7043 set_bit (FLAG_COMMIT, &local->flags);
7044 }
7045 switch (vwrq->flags & IW_POWER_MODE) {
7046 case IW_POWER_UNICAST_R:
Al Viro3eb9b412007-12-21 00:00:35 -05007047 if (sniffing_mode(local))
Linus Torvalds1da177e2005-04-16 15:20:36 -07007048 return -EINVAL;
Al Viro3eb9b412007-12-21 00:00:35 -05007049 local->config.rmode &= ~RXMODE_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007050 local->config.rmode |= RXMODE_ADDR;
7051 set_bit (FLAG_COMMIT, &local->flags);
7052 break;
7053 case IW_POWER_ALL_R:
Al Viro3eb9b412007-12-21 00:00:35 -05007054 if (sniffing_mode(local))
Linus Torvalds1da177e2005-04-16 15:20:36 -07007055 return -EINVAL;
Al Viro3eb9b412007-12-21 00:00:35 -05007056 local->config.rmode &= ~RXMODE_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007057 local->config.rmode |= RXMODE_BC_MC_ADDR;
7058 set_bit (FLAG_COMMIT, &local->flags);
7059 case IW_POWER_ON:
Jean Tourrilhes7f8544c2006-08-29 17:58:11 -07007060 /* This is broken, fixme ;-) */
Linus Torvalds1da177e2005-04-16 15:20:36 -07007061 break;
7062 default:
7063 return -EINVAL;
7064 }
7065 // Note : we may want to factor local->need_commit here
7066 // Note2 : may also want to factor RXMODE_RFMON test
7067 return -EINPROGRESS; /* Call commit handler */
7068}
7069
7070/*------------------------------------------------------------------*/
7071/*
7072 * Wireless Handler : get Power Management
7073 */
7074static int airo_get_power(struct net_device *dev,
7075 struct iw_request_info *info,
7076 struct iw_param *vwrq,
7077 char *extra)
7078{
Wang Chenfaf39942008-10-14 13:30:33 +08007079 struct airo_info *local = dev->ml_priv;
Al Viro3eb9b412007-12-21 00:00:35 -05007080 __le16 mode;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007081
7082 readConfigRid(local, 1);
7083 mode = local->config.powerSaveMode;
7084 if ((vwrq->disabled = (mode == POWERSAVE_CAM)))
7085 return 0;
7086 if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
Al Viro3eb9b412007-12-21 00:00:35 -05007087 vwrq->value = le16_to_cpu(local->config.fastListenDelay) * 1024;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007088 vwrq->flags = IW_POWER_TIMEOUT;
7089 } else {
Al Viro3eb9b412007-12-21 00:00:35 -05007090 vwrq->value = le16_to_cpu(local->config.fastListenInterval) * 1024;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007091 vwrq->flags = IW_POWER_PERIOD;
7092 }
Al Viro3eb9b412007-12-21 00:00:35 -05007093 if ((local->config.rmode & RXMODE_MASK) == RXMODE_ADDR)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007094 vwrq->flags |= IW_POWER_UNICAST_R;
7095 else
7096 vwrq->flags |= IW_POWER_ALL_R;
7097
7098 return 0;
7099}
7100
7101/*------------------------------------------------------------------*/
7102/*
7103 * Wireless Handler : set Sensitivity
7104 */
7105static int airo_set_sens(struct net_device *dev,
7106 struct iw_request_info *info,
7107 struct iw_param *vwrq,
7108 char *extra)
7109{
Wang Chenfaf39942008-10-14 13:30:33 +08007110 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007111
7112 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05007113 local->config.rssiThreshold =
7114 cpu_to_le16(vwrq->disabled ? RSSI_DEFAULT : vwrq->value);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007115 set_bit (FLAG_COMMIT, &local->flags);
7116
7117 return -EINPROGRESS; /* Call commit handler */
7118}
7119
7120/*------------------------------------------------------------------*/
7121/*
7122 * Wireless Handler : get Sensitivity
7123 */
7124static int airo_get_sens(struct net_device *dev,
7125 struct iw_request_info *info,
7126 struct iw_param *vwrq,
7127 char *extra)
7128{
Wang Chenfaf39942008-10-14 13:30:33 +08007129 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007130
7131 readConfigRid(local, 1);
Al Viro3eb9b412007-12-21 00:00:35 -05007132 vwrq->value = le16_to_cpu(local->config.rssiThreshold);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007133 vwrq->disabled = (vwrq->value == 0);
7134 vwrq->fixed = 1;
7135
7136 return 0;
7137}
7138
7139/*------------------------------------------------------------------*/
7140/*
7141 * Wireless Handler : get AP List
7142 * Note : this is deprecated in favor of IWSCAN
7143 */
7144static int airo_get_aplist(struct net_device *dev,
7145 struct iw_request_info *info,
7146 struct iw_point *dwrq,
7147 char *extra)
7148{
Wang Chenfaf39942008-10-14 13:30:33 +08007149 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007150 struct sockaddr *address = (struct sockaddr *) extra;
Frank Seidel998a5a72009-02-25 15:39:57 +01007151 struct iw_quality *qual;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007152 BSSListRid BSSList;
7153 int i;
7154 int loseSync = capable(CAP_NET_ADMIN) ? 1: -1;
7155
Frank Seidel998a5a72009-02-25 15:39:57 +01007156 qual = kmalloc(IW_MAX_AP * sizeof(*qual), GFP_KERNEL);
7157 if (!qual)
7158 return -ENOMEM;
7159
Linus Torvalds1da177e2005-04-16 15:20:36 -07007160 for (i = 0; i < IW_MAX_AP; i++) {
Al Viro17e70492007-12-19 18:56:37 -05007161 u16 dBm;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007162 if (readBSSListRid(local, loseSync, &BSSList))
7163 break;
7164 loseSync = 0;
7165 memcpy(address[i].sa_data, BSSList.bssid, ETH_ALEN);
7166 address[i].sa_family = ARPHRD_ETHER;
Al Viro17e70492007-12-19 18:56:37 -05007167 dBm = le16_to_cpu(BSSList.dBm);
Dan Williams41480af2005-05-10 09:45:51 -04007168 if (local->rssi) {
Al Viro17e70492007-12-19 18:56:37 -05007169 qual[i].level = 0x100 - dBm;
7170 qual[i].qual = airo_dbm_to_pct(local->rssi, dBm);
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07007171 qual[i].updated = IW_QUAL_QUAL_UPDATED
7172 | IW_QUAL_LEVEL_UPDATED
7173 | IW_QUAL_DBM;
Dan Williams41480af2005-05-10 09:45:51 -04007174 } else {
Al Viro17e70492007-12-19 18:56:37 -05007175 qual[i].level = (dBm + 321) / 2;
Dan Williams41480af2005-05-10 09:45:51 -04007176 qual[i].qual = 0;
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07007177 qual[i].updated = IW_QUAL_QUAL_INVALID
7178 | IW_QUAL_LEVEL_UPDATED
7179 | IW_QUAL_DBM;
Dan Williams41480af2005-05-10 09:45:51 -04007180 }
7181 qual[i].noise = local->wstats.qual.noise;
Al Viro17e70492007-12-19 18:56:37 -05007182 if (BSSList.index == cpu_to_le16(0xffff))
Linus Torvalds1da177e2005-04-16 15:20:36 -07007183 break;
7184 }
7185 if (!i) {
7186 StatusRid status_rid; /* Card status info */
7187 readStatusRid(local, &status_rid, 1);
7188 for (i = 0;
7189 i < min(IW_MAX_AP, 4) &&
7190 (status_rid.bssid[i][0]
7191 & status_rid.bssid[i][1]
7192 & status_rid.bssid[i][2]
7193 & status_rid.bssid[i][3]
7194 & status_rid.bssid[i][4]
7195 & status_rid.bssid[i][5])!=0xff &&
7196 (status_rid.bssid[i][0]
7197 | status_rid.bssid[i][1]
7198 | status_rid.bssid[i][2]
7199 | status_rid.bssid[i][3]
7200 | status_rid.bssid[i][4]
7201 | status_rid.bssid[i][5]);
7202 i++) {
7203 memcpy(address[i].sa_data,
7204 status_rid.bssid[i], ETH_ALEN);
7205 address[i].sa_family = ARPHRD_ETHER;
7206 }
7207 } else {
7208 dwrq->flags = 1; /* Should be define'd */
7209 memcpy(extra + sizeof(struct sockaddr)*i,
7210 &qual, sizeof(struct iw_quality)*i);
7211 }
7212 dwrq->length = i;
7213
Frank Seidel998a5a72009-02-25 15:39:57 +01007214 kfree(qual);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007215 return 0;
7216}
7217
7218/*------------------------------------------------------------------*/
7219/*
7220 * Wireless Handler : Initiate Scan
7221 */
7222static int airo_set_scan(struct net_device *dev,
7223 struct iw_request_info *info,
David Kilroy9930cce2008-09-13 12:22:05 +01007224 struct iw_point *dwrq,
Linus Torvalds1da177e2005-04-16 15:20:36 -07007225 char *extra)
7226{
Wang Chenfaf39942008-10-14 13:30:33 +08007227 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007228 Cmd cmd;
7229 Resp rsp;
Dan Williams9e75af32006-03-16 13:46:29 -05007230 int wake = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007231
7232 /* Note : you may have realised that, as this is a SET operation,
7233 * this is privileged and therefore a normal user can't
7234 * perform scanning.
7235 * This is not an error, while the device perform scanning,
7236 * traffic doesn't flow, so it's a perfect DoS...
7237 * Jean II */
7238 if (ai->flags & FLAG_RADIO_MASK) return -ENETDOWN;
7239
Dan Williams9e75af32006-03-16 13:46:29 -05007240 if (down_interruptible(&ai->sem))
7241 return -ERESTARTSYS;
7242
7243 /* If there's already a scan in progress, don't
7244 * trigger another one. */
7245 if (ai->scan_timeout > 0)
7246 goto out;
7247
Linus Torvalds1da177e2005-04-16 15:20:36 -07007248 /* Initiate a scan command */
Dan Williams6fcdf562006-03-31 15:08:46 -05007249 ai->scan_timeout = RUN_AT(3*HZ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007250 memset(&cmd, 0, sizeof(cmd));
7251 cmd.cmd=CMD_LISTBSS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007252 issuecommand(ai, &cmd, &rsp);
Dan Williams9e75af32006-03-16 13:46:29 -05007253 wake = 1;
7254
7255out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07007256 up(&ai->sem);
Dan Williams9e75af32006-03-16 13:46:29 -05007257 if (wake)
7258 wake_up_interruptible(&ai->thr_wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007259 return 0;
7260}
7261
7262/*------------------------------------------------------------------*/
7263/*
7264 * Translate scan data returned from the card to a card independent
7265 * format that the Wireless Tools will understand - Jean II
7266 */
7267static inline char *airo_translate_scan(struct net_device *dev,
David S. Millerccc58052008-06-16 18:50:49 -07007268 struct iw_request_info *info,
Linus Torvalds1da177e2005-04-16 15:20:36 -07007269 char *current_ev,
7270 char *end_buf,
Dan Williams41480af2005-05-10 09:45:51 -04007271 BSSListRid *bss)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007272{
Wang Chenfaf39942008-10-14 13:30:33 +08007273 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007274 struct iw_event iwe; /* Temporary buffer */
Al Viro17e70492007-12-19 18:56:37 -05007275 __le16 capabilities;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007276 char * current_val; /* For rates */
7277 int i;
Dan Williams3c304952006-04-15 12:26:18 -04007278 char * buf;
Al Viro851b3e52007-12-19 19:20:12 -05007279 u16 dBm;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007280
7281 /* First entry *MUST* be the AP MAC address */
7282 iwe.cmd = SIOCGIWAP;
7283 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
Dan Williams41480af2005-05-10 09:45:51 -04007284 memcpy(iwe.u.ap_addr.sa_data, bss->bssid, ETH_ALEN);
David S. Millerccc58052008-06-16 18:50:49 -07007285 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7286 &iwe, IW_EV_ADDR_LEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007287
7288 /* Other entries will be displayed in the order we give them */
7289
7290 /* Add the ESSID */
Dan Williams41480af2005-05-10 09:45:51 -04007291 iwe.u.data.length = bss->ssidLen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007292 if(iwe.u.data.length > 32)
7293 iwe.u.data.length = 32;
7294 iwe.cmd = SIOCGIWESSID;
7295 iwe.u.data.flags = 1;
David S. Millerccc58052008-06-16 18:50:49 -07007296 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7297 &iwe, bss->ssid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007298
7299 /* Add mode */
7300 iwe.cmd = SIOCGIWMODE;
Al Viro17e70492007-12-19 18:56:37 -05007301 capabilities = bss->cap;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007302 if(capabilities & (CAP_ESS | CAP_IBSS)) {
7303 if(capabilities & CAP_ESS)
7304 iwe.u.mode = IW_MODE_MASTER;
7305 else
7306 iwe.u.mode = IW_MODE_ADHOC;
David S. Millerccc58052008-06-16 18:50:49 -07007307 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7308 &iwe, IW_EV_UINT_LEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007309 }
7310
7311 /* Add frequency */
7312 iwe.cmd = SIOCGIWFREQ;
Dan Williams41480af2005-05-10 09:45:51 -04007313 iwe.u.freq.m = le16_to_cpu(bss->dsChannel);
David Kilroy9ee677c2008-12-23 14:03:38 +00007314 iwe.u.freq.m = ieee80211_dsss_chan_to_freq(iwe.u.freq.m) * 100000;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007315 iwe.u.freq.e = 1;
David S. Millerccc58052008-06-16 18:50:49 -07007316 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7317 &iwe, IW_EV_FREQ_LEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007318
Al Viro851b3e52007-12-19 19:20:12 -05007319 dBm = le16_to_cpu(bss->dBm);
7320
Linus Torvalds1da177e2005-04-16 15:20:36 -07007321 /* Add quality statistics */
7322 iwe.cmd = IWEVQUAL;
Dan Williams41480af2005-05-10 09:45:51 -04007323 if (ai->rssi) {
Al Viro851b3e52007-12-19 19:20:12 -05007324 iwe.u.qual.level = 0x100 - dBm;
7325 iwe.u.qual.qual = airo_dbm_to_pct(ai->rssi, dBm);
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07007326 iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED
7327 | IW_QUAL_LEVEL_UPDATED
7328 | IW_QUAL_DBM;
Dan Williams41480af2005-05-10 09:45:51 -04007329 } else {
Al Viro851b3e52007-12-19 19:20:12 -05007330 iwe.u.qual.level = (dBm + 321) / 2;
Dan Williams41480af2005-05-10 09:45:51 -04007331 iwe.u.qual.qual = 0;
Jeff Garzikbbeec902005-09-07 00:27:54 -04007332 iwe.u.qual.updated = IW_QUAL_QUAL_INVALID
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07007333 | IW_QUAL_LEVEL_UPDATED
7334 | IW_QUAL_DBM;
Dan Williams41480af2005-05-10 09:45:51 -04007335 }
7336 iwe.u.qual.noise = ai->wstats.qual.noise;
David S. Millerccc58052008-06-16 18:50:49 -07007337 current_ev = iwe_stream_add_event(info, current_ev, end_buf,
7338 &iwe, IW_EV_QUAL_LEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007339
7340 /* Add encryption capability */
7341 iwe.cmd = SIOCGIWENCODE;
7342 if(capabilities & CAP_PRIVACY)
7343 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
7344 else
7345 iwe.u.data.flags = IW_ENCODE_DISABLED;
7346 iwe.u.data.length = 0;
David S. Millerccc58052008-06-16 18:50:49 -07007347 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7348 &iwe, bss->ssid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007349
7350 /* Rate : stuffing multiple values in a single event require a bit
7351 * more of magic - Jean II */
David S. Millerccc58052008-06-16 18:50:49 -07007352 current_val = current_ev + iwe_stream_lcp_len(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007353
7354 iwe.cmd = SIOCGIWRATE;
7355 /* Those two flags are ignored... */
7356 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
7357 /* Max 8 values */
7358 for(i = 0 ; i < 8 ; i++) {
7359 /* NULL terminated */
Dan Williams41480af2005-05-10 09:45:51 -04007360 if(bss->rates[i] == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007361 break;
7362 /* Bit rate given in 500 kb/s units (+ 0x80) */
Dan Williams41480af2005-05-10 09:45:51 -04007363 iwe.u.bitrate.value = ((bss->rates[i] & 0x7f) * 500000);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007364 /* Add new value to event */
David S. Millerccc58052008-06-16 18:50:49 -07007365 current_val = iwe_stream_add_value(info, current_ev,
7366 current_val, end_buf,
7367 &iwe, IW_EV_PARAM_LEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007368 }
7369 /* Check if we added any event */
David S. Millerccc58052008-06-16 18:50:49 -07007370 if ((current_val - current_ev) > iwe_stream_lcp_len(info))
Linus Torvalds1da177e2005-04-16 15:20:36 -07007371 current_ev = current_val;
7372
Dan Williams3c304952006-04-15 12:26:18 -04007373 /* Beacon interval */
7374 buf = kmalloc(30, GFP_KERNEL);
7375 if (buf) {
7376 iwe.cmd = IWEVCUSTOM;
7377 sprintf(buf, "bcn_int=%d", bss->beaconInterval);
7378 iwe.u.data.length = strlen(buf);
David S. Millerccc58052008-06-16 18:50:49 -07007379 current_ev = iwe_stream_add_point(info, current_ev, end_buf,
7380 &iwe, buf);
Dan Williams3c304952006-04-15 12:26:18 -04007381 kfree(buf);
7382 }
7383
7384 /* Put WPA/RSN Information Elements into the event stream */
7385 if (test_bit(FLAG_WPA_CAPABLE, &ai->flags)) {
7386 unsigned int num_null_ies = 0;
7387 u16 length = sizeof (bss->extra.iep);
Johannes Berg2c7060022008-10-30 22:09:54 +01007388 u8 *ie = (void *)&bss->extra.iep;
Dan Williams3c304952006-04-15 12:26:18 -04007389
Johannes Berg2c7060022008-10-30 22:09:54 +01007390 while ((length >= 2) && (num_null_ies < 2)) {
7391 if (2 + ie[1] > length) {
Dan Williams3c304952006-04-15 12:26:18 -04007392 /* Invalid element, don't continue parsing IE */
7393 break;
7394 }
7395
Johannes Berg2c7060022008-10-30 22:09:54 +01007396 switch (ie[0]) {
7397 case WLAN_EID_SSID:
Dan Williams3c304952006-04-15 12:26:18 -04007398 /* Two zero-length SSID elements
7399 * mean we're done parsing elements */
Johannes Berg2c7060022008-10-30 22:09:54 +01007400 if (!ie[1])
Dan Williams3c304952006-04-15 12:26:18 -04007401 num_null_ies++;
7402 break;
7403
Johannes Berg2c7060022008-10-30 22:09:54 +01007404 case WLAN_EID_GENERIC:
7405 if (ie[1] >= 4 &&
7406 ie[2] == 0x00 &&
7407 ie[3] == 0x50 &&
7408 ie[4] == 0xf2 &&
7409 ie[5] == 0x01) {
Dan Williams3c304952006-04-15 12:26:18 -04007410 iwe.cmd = IWEVGENIE;
Johannes Berg2c7060022008-10-30 22:09:54 +01007411 /* 64 is an arbitrary cut-off */
7412 iwe.u.data.length = min(ie[1] + 2,
7413 64);
David S. Millerccc58052008-06-16 18:50:49 -07007414 current_ev = iwe_stream_add_point(
7415 info, current_ev,
Johannes Berg2c7060022008-10-30 22:09:54 +01007416 end_buf, &iwe, ie);
Dan Williams3c304952006-04-15 12:26:18 -04007417 }
7418 break;
7419
Johannes Berg2c7060022008-10-30 22:09:54 +01007420 case WLAN_EID_RSN:
Dan Williams3c304952006-04-15 12:26:18 -04007421 iwe.cmd = IWEVGENIE;
Johannes Berg2c7060022008-10-30 22:09:54 +01007422 /* 64 is an arbitrary cut-off */
7423 iwe.u.data.length = min(ie[1] + 2, 64);
David S. Millerccc58052008-06-16 18:50:49 -07007424 current_ev = iwe_stream_add_point(
7425 info, current_ev, end_buf,
Johannes Berg2c7060022008-10-30 22:09:54 +01007426 &iwe, ie);
Dan Williams3c304952006-04-15 12:26:18 -04007427 break;
7428
7429 default:
7430 break;
7431 }
7432
Johannes Berg2c7060022008-10-30 22:09:54 +01007433 length -= 2 + ie[1];
7434 ie += 2 + ie[1];
Dan Williams3c304952006-04-15 12:26:18 -04007435 }
7436 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007437 return current_ev;
7438}
7439
7440/*------------------------------------------------------------------*/
7441/*
7442 * Wireless Handler : Read Scan Results
7443 */
7444static int airo_get_scan(struct net_device *dev,
7445 struct iw_request_info *info,
7446 struct iw_point *dwrq,
7447 char *extra)
7448{
Wang Chenfaf39942008-10-14 13:30:33 +08007449 struct airo_info *ai = dev->ml_priv;
Dan Williams9e75af32006-03-16 13:46:29 -05007450 BSSListElement *net;
7451 int err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007452 char *current_ev = extra;
7453
Dan Williams9e75af32006-03-16 13:46:29 -05007454 /* If a scan is in-progress, return -EAGAIN */
7455 if (ai->scan_timeout > 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007456 return -EAGAIN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007457
Dan Williams9e75af32006-03-16 13:46:29 -05007458 if (down_interruptible(&ai->sem))
7459 return -EAGAIN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007460
Dan Williams9e75af32006-03-16 13:46:29 -05007461 list_for_each_entry (net, &ai->network_list, list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07007462 /* Translate to WE format this entry */
David S. Millerccc58052008-06-16 18:50:49 -07007463 current_ev = airo_translate_scan(dev, info, current_ev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07007464 extra + dwrq->length,
Dan Williams9e75af32006-03-16 13:46:29 -05007465 &net->bss);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007466
7467 /* Check if there is space for one more entry */
7468 if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
7469 /* Ask user space to try again with a bigger buffer */
Dan Williams9e75af32006-03-16 13:46:29 -05007470 err = -E2BIG;
7471 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007472 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007473 }
Dan Williams9e75af32006-03-16 13:46:29 -05007474
Linus Torvalds1da177e2005-04-16 15:20:36 -07007475 /* Length of data */
7476 dwrq->length = (current_ev - extra);
7477 dwrq->flags = 0; /* todo */
7478
Dan Williams9e75af32006-03-16 13:46:29 -05007479out:
7480 up(&ai->sem);
7481 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007482}
7483
7484/*------------------------------------------------------------------*/
7485/*
7486 * Commit handler : called after a bunch of SET operations
7487 */
7488static int airo_config_commit(struct net_device *dev,
7489 struct iw_request_info *info, /* NULL */
7490 void *zwrq, /* NULL */
7491 char *extra) /* NULL */
7492{
Wang Chenfaf39942008-10-14 13:30:33 +08007493 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007494
7495 if (!test_bit (FLAG_COMMIT, &local->flags))
7496 return 0;
7497
7498 /* Some of the "SET" function may have modified some of the
7499 * parameters. It's now time to commit them in the card */
7500 disable_MAC(local, 1);
7501 if (test_bit (FLAG_RESET, &local->flags)) {
7502 APListRid APList_rid;
7503 SsidRid SSID_rid;
7504
7505 readAPListRid(local, &APList_rid);
7506 readSsidRid(local, &SSID_rid);
7507 if (test_bit(FLAG_MPI,&local->flags))
7508 setup_card(local, dev->dev_addr, 1 );
7509 else
7510 reset_airo_card(dev);
7511 disable_MAC(local, 1);
7512 writeSsidRid(local, &SSID_rid, 1);
7513 writeAPListRid(local, &APList_rid, 1);
7514 }
7515 if (down_interruptible(&local->sem))
7516 return -ERESTARTSYS;
7517 writeConfigRid(local, 0);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02007518 enable_MAC(local, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007519 if (test_bit (FLAG_RESET, &local->flags))
7520 airo_set_promisc(local);
7521 else
7522 up(&local->sem);
7523
7524 return 0;
7525}
7526
7527/*------------------------------------------------------------------*/
7528/*
7529 * Structures to export the Wireless Handlers
7530 */
7531
7532static const struct iw_priv_args airo_private_args[] = {
7533/*{ cmd, set_args, get_args, name } */
7534 { AIROIOCTL, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7535 IW_PRIV_TYPE_BYTE | 2047, "airoioctl" },
7536 { AIROIDIFC, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | sizeof (aironet_ioctl),
7537 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "airoidifc" },
7538};
7539
7540static const iw_handler airo_handler[] =
7541{
7542 (iw_handler) airo_config_commit, /* SIOCSIWCOMMIT */
7543 (iw_handler) airo_get_name, /* SIOCGIWNAME */
7544 (iw_handler) NULL, /* SIOCSIWNWID */
7545 (iw_handler) NULL, /* SIOCGIWNWID */
7546 (iw_handler) airo_set_freq, /* SIOCSIWFREQ */
7547 (iw_handler) airo_get_freq, /* SIOCGIWFREQ */
7548 (iw_handler) airo_set_mode, /* SIOCSIWMODE */
7549 (iw_handler) airo_get_mode, /* SIOCGIWMODE */
7550 (iw_handler) airo_set_sens, /* SIOCSIWSENS */
7551 (iw_handler) airo_get_sens, /* SIOCGIWSENS */
7552 (iw_handler) NULL, /* SIOCSIWRANGE */
7553 (iw_handler) airo_get_range, /* SIOCGIWRANGE */
7554 (iw_handler) NULL, /* SIOCSIWPRIV */
7555 (iw_handler) NULL, /* SIOCGIWPRIV */
7556 (iw_handler) NULL, /* SIOCSIWSTATS */
7557 (iw_handler) NULL, /* SIOCGIWSTATS */
7558 iw_handler_set_spy, /* SIOCSIWSPY */
7559 iw_handler_get_spy, /* SIOCGIWSPY */
7560 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
7561 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
7562 (iw_handler) airo_set_wap, /* SIOCSIWAP */
7563 (iw_handler) airo_get_wap, /* SIOCGIWAP */
7564 (iw_handler) NULL, /* -- hole -- */
7565 (iw_handler) airo_get_aplist, /* SIOCGIWAPLIST */
7566 (iw_handler) airo_set_scan, /* SIOCSIWSCAN */
7567 (iw_handler) airo_get_scan, /* SIOCGIWSCAN */
7568 (iw_handler) airo_set_essid, /* SIOCSIWESSID */
7569 (iw_handler) airo_get_essid, /* SIOCGIWESSID */
7570 (iw_handler) airo_set_nick, /* SIOCSIWNICKN */
7571 (iw_handler) airo_get_nick, /* SIOCGIWNICKN */
7572 (iw_handler) NULL, /* -- hole -- */
7573 (iw_handler) NULL, /* -- hole -- */
7574 (iw_handler) airo_set_rate, /* SIOCSIWRATE */
7575 (iw_handler) airo_get_rate, /* SIOCGIWRATE */
7576 (iw_handler) airo_set_rts, /* SIOCSIWRTS */
7577 (iw_handler) airo_get_rts, /* SIOCGIWRTS */
7578 (iw_handler) airo_set_frag, /* SIOCSIWFRAG */
7579 (iw_handler) airo_get_frag, /* SIOCGIWFRAG */
7580 (iw_handler) airo_set_txpow, /* SIOCSIWTXPOW */
7581 (iw_handler) airo_get_txpow, /* SIOCGIWTXPOW */
7582 (iw_handler) airo_set_retry, /* SIOCSIWRETRY */
7583 (iw_handler) airo_get_retry, /* SIOCGIWRETRY */
7584 (iw_handler) airo_set_encode, /* SIOCSIWENCODE */
7585 (iw_handler) airo_get_encode, /* SIOCGIWENCODE */
7586 (iw_handler) airo_set_power, /* SIOCSIWPOWER */
7587 (iw_handler) airo_get_power, /* SIOCGIWPOWER */
Dan Williams4be757d2006-01-30 11:58:00 -05007588 (iw_handler) NULL, /* -- hole -- */
7589 (iw_handler) NULL, /* -- hole -- */
7590 (iw_handler) NULL, /* SIOCSIWGENIE */
7591 (iw_handler) NULL, /* SIOCGIWGENIE */
7592 (iw_handler) airo_set_auth, /* SIOCSIWAUTH */
7593 (iw_handler) airo_get_auth, /* SIOCGIWAUTH */
7594 (iw_handler) airo_set_encodeext, /* SIOCSIWENCODEEXT */
7595 (iw_handler) airo_get_encodeext, /* SIOCGIWENCODEEXT */
7596 (iw_handler) NULL, /* SIOCSIWPMKSA */
Linus Torvalds1da177e2005-04-16 15:20:36 -07007597};
7598
7599/* Note : don't describe AIROIDIFC and AIROOLDIDIFC in here.
7600 * We want to force the use of the ioctl code, because those can't be
7601 * won't work the iw_handler code (because they simultaneously read
7602 * and write data and iw_handler can't do that).
7603 * Note that it's perfectly legal to read/write on a single ioctl command,
7604 * you just can't use iwpriv and need to force it via the ioctl handler.
7605 * Jean II */
7606static const iw_handler airo_private_handler[] =
7607{
7608 NULL, /* SIOCIWFIRSTPRIV */
7609};
7610
7611static const struct iw_handler_def airo_handler_def =
7612{
Denis Chengff8ac602007-09-02 18:30:18 +08007613 .num_standard = ARRAY_SIZE(airo_handler),
7614 .num_private = ARRAY_SIZE(airo_private_handler),
7615 .num_private_args = ARRAY_SIZE(airo_private_args),
Linus Torvalds1da177e2005-04-16 15:20:36 -07007616 .standard = airo_handler,
7617 .private = airo_private_handler,
7618 .private_args = airo_private_args,
7619 .get_wireless_stats = airo_get_wireless_stats,
7620};
7621
Linus Torvalds1da177e2005-04-16 15:20:36 -07007622/*
7623 * This defines the configuration part of the Wireless Extensions
7624 * Note : irq and spinlock protection will occur in the subroutines
7625 *
7626 * TODO :
7627 * o Check input value more carefully and fill correct values in range
7628 * o Test and shakeout the bugs (if any)
7629 *
7630 * Jean II
7631 *
7632 * Javier Achirica did a great job of merging code from the unnamed CISCO
7633 * developer that added support for flashing the card.
7634 */
7635static int airo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
7636{
7637 int rc = 0;
Wang Chenfaf39942008-10-14 13:30:33 +08007638 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007639
Pavel Machekca078ba2005-09-03 15:56:57 -07007640 if (ai->power.event)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007641 return 0;
7642
7643 switch (cmd) {
7644#ifdef CISCO_EXT
7645 case AIROIDIFC:
7646#ifdef AIROOLDIDIFC
7647 case AIROOLDIDIFC:
7648#endif
7649 {
7650 int val = AIROMAGIC;
7651 aironet_ioctl com;
7652 if (copy_from_user(&com,rq->ifr_data,sizeof(com)))
7653 rc = -EFAULT;
7654 else if (copy_to_user(com.data,(char *)&val,sizeof(val)))
7655 rc = -EFAULT;
7656 }
7657 break;
7658
7659 case AIROIOCTL:
7660#ifdef AIROOLDIOCTL
7661 case AIROOLDIOCTL:
7662#endif
7663 /* Get the command struct and hand it off for evaluation by
7664 * the proper subfunction
7665 */
7666 {
7667 aironet_ioctl com;
7668 if (copy_from_user(&com,rq->ifr_data,sizeof(com))) {
7669 rc = -EFAULT;
7670 break;
7671 }
7672
7673 /* Separate R/W functions bracket legality here
7674 */
7675 if ( com.command == AIRORSWVERSION ) {
7676 if (copy_to_user(com.data, swversion, sizeof(swversion)))
7677 rc = -EFAULT;
7678 else
7679 rc = 0;
7680 }
7681 else if ( com.command <= AIRORRID)
7682 rc = readrids(dev,&com);
7683 else if ( com.command >= AIROPCAP && com.command <= (AIROPLEAPUSR+2) )
7684 rc = writerids(dev,&com);
7685 else if ( com.command >= AIROFLSHRST && com.command <= AIRORESTART )
7686 rc = flashcard(dev,&com);
7687 else
7688 rc = -EINVAL; /* Bad command in ioctl */
7689 }
7690 break;
7691#endif /* CISCO_EXT */
7692
7693 // All other calls are currently unsupported
7694 default:
7695 rc = -EOPNOTSUPP;
7696 }
7697 return rc;
7698}
7699
Linus Torvalds1da177e2005-04-16 15:20:36 -07007700/*
7701 * Get the Wireless stats out of the driver
7702 * Note : irq and spinlock protection will occur in the subroutines
7703 *
7704 * TODO :
7705 * o Check if work in Ad-Hoc mode (otherwise, use SPY, as in wvlan_cs)
7706 *
7707 * Jean
7708 */
7709static void airo_read_wireless_stats(struct airo_info *local)
7710{
7711 StatusRid status_rid;
7712 StatsRid stats_rid;
7713 CapabilityRid cap_rid;
Al Viroa23ace52007-12-19 22:24:16 -05007714 __le32 *vals = stats_rid.vals;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007715
7716 /* Get stats out of the card */
Dan Williams3c304952006-04-15 12:26:18 -04007717 clear_bit(JOB_WSTATS, &local->jobs);
Pavel Machekca078ba2005-09-03 15:56:57 -07007718 if (local->power.event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07007719 up(&local->sem);
7720 return;
7721 }
7722 readCapabilityRid(local, &cap_rid, 0);
7723 readStatusRid(local, &status_rid, 0);
7724 readStatsRid(local, &stats_rid, RID_STATS, 0);
7725 up(&local->sem);
7726
7727 /* The status */
Al Viro329e2c02007-12-20 22:58:57 -05007728 local->wstats.status = le16_to_cpu(status_rid.mode);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007729
Dan Williams41480af2005-05-10 09:45:51 -04007730 /* Signal quality and co */
7731 if (local->rssi) {
Al Viro329e2c02007-12-20 22:58:57 -05007732 local->wstats.qual.level =
7733 airo_rssi_to_dbm(local->rssi,
7734 le16_to_cpu(status_rid.sigQuality));
Dan Williams41480af2005-05-10 09:45:51 -04007735 /* normalizedSignalStrength appears to be a percentage */
Al Viro329e2c02007-12-20 22:58:57 -05007736 local->wstats.qual.qual =
7737 le16_to_cpu(status_rid.normalizedSignalStrength);
Dan Williams41480af2005-05-10 09:45:51 -04007738 } else {
Al Viro329e2c02007-12-20 22:58:57 -05007739 local->wstats.qual.level =
7740 (le16_to_cpu(status_rid.normalizedSignalStrength) + 321) / 2;
Dan Williams41480af2005-05-10 09:45:51 -04007741 local->wstats.qual.qual = airo_get_quality(&status_rid, &cap_rid);
7742 }
Al Viro329e2c02007-12-20 22:58:57 -05007743 if (le16_to_cpu(status_rid.len) >= 124) {
Dan Williams41480af2005-05-10 09:45:51 -04007744 local->wstats.qual.noise = 0x100 - status_rid.noisedBm;
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07007745 local->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007746 } else {
7747 local->wstats.qual.noise = 0;
Jean Tourrilhesce6623c2005-09-02 11:45:10 -07007748 local->wstats.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED | IW_QUAL_NOISE_INVALID | IW_QUAL_DBM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007749 }
7750
7751 /* Packets discarded in the wireless adapter due to wireless
7752 * specific problems */
Al Viroa23ace52007-12-19 22:24:16 -05007753 local->wstats.discard.nwid = le32_to_cpu(vals[56]) +
7754 le32_to_cpu(vals[57]) +
7755 le32_to_cpu(vals[58]); /* SSID Mismatch */
7756 local->wstats.discard.code = le32_to_cpu(vals[6]);/* RxWepErr */
7757 local->wstats.discard.fragment = le32_to_cpu(vals[30]);
7758 local->wstats.discard.retries = le32_to_cpu(vals[10]);
7759 local->wstats.discard.misc = le32_to_cpu(vals[1]) +
7760 le32_to_cpu(vals[32]);
7761 local->wstats.miss.beacon = le32_to_cpu(vals[34]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007762}
7763
Jouni Malinenff1d2762005-05-12 22:54:16 -04007764static struct iw_statistics *airo_get_wireless_stats(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007765{
Wang Chenfaf39942008-10-14 13:30:33 +08007766 struct airo_info *local = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007767
Dan Williams3c304952006-04-15 12:26:18 -04007768 if (!test_bit(JOB_WSTATS, &local->jobs)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07007769 /* Get stats out of the card if available */
7770 if (down_trylock(&local->sem) != 0) {
Dan Williams3c304952006-04-15 12:26:18 -04007771 set_bit(JOB_WSTATS, &local->jobs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007772 wake_up_interruptible(&local->thr_wait);
7773 } else
7774 airo_read_wireless_stats(local);
7775 }
7776
7777 return &local->wstats;
7778}
Linus Torvalds1da177e2005-04-16 15:20:36 -07007779
7780#ifdef CISCO_EXT
7781/*
7782 * This just translates from driver IOCTL codes to the command codes to
7783 * feed to the radio's host interface. Things can be added/deleted
7784 * as needed. This represents the READ side of control I/O to
7785 * the card
7786 */
7787static int readrids(struct net_device *dev, aironet_ioctl *comp) {
7788 unsigned short ridcode;
7789 unsigned char *iobuf;
7790 int len;
Wang Chenfaf39942008-10-14 13:30:33 +08007791 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007792
7793 if (test_bit(FLAG_FLASHING, &ai->flags))
7794 return -EIO;
7795
7796 switch(comp->command)
7797 {
7798 case AIROGCAP: ridcode = RID_CAPABILITIES; break;
7799 case AIROGCFG: ridcode = RID_CONFIG;
7800 if (test_bit(FLAG_COMMIT, &ai->flags)) {
7801 disable_MAC (ai, 1);
7802 writeConfigRid (ai, 1);
Michal Schmidt175ec1a2007-06-29 15:33:47 +02007803 enable_MAC(ai, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007804 }
7805 break;
7806 case AIROGSLIST: ridcode = RID_SSID; break;
7807 case AIROGVLIST: ridcode = RID_APLIST; break;
7808 case AIROGDRVNAM: ridcode = RID_DRVNAME; break;
7809 case AIROGEHTENC: ridcode = RID_ETHERENCAP; break;
7810 case AIROGWEPKTMP: ridcode = RID_WEP_TEMP;
7811 /* Only super-user can read WEP keys */
7812 if (!capable(CAP_NET_ADMIN))
7813 return -EPERM;
7814 break;
7815 case AIROGWEPKNV: ridcode = RID_WEP_PERM;
7816 /* Only super-user can read WEP keys */
7817 if (!capable(CAP_NET_ADMIN))
7818 return -EPERM;
7819 break;
7820 case AIROGSTAT: ridcode = RID_STATUS; break;
7821 case AIROGSTATSD32: ridcode = RID_STATSDELTA; break;
7822 case AIROGSTATSC32: ridcode = RID_STATS; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007823 case AIROGMICSTATS:
7824 if (copy_to_user(comp->data, &ai->micstats,
7825 min((int)comp->len,(int)sizeof(ai->micstats))))
7826 return -EFAULT;
7827 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007828 case AIRORRID: ridcode = comp->ridnum; break;
7829 default:
7830 return -EINVAL;
7831 break;
7832 }
7833
7834 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7835 return -ENOMEM;
7836
7837 PC4500_readrid(ai,ridcode,iobuf,RIDSIZE, 1);
7838 /* get the count of bytes in the rid docs say 1st 2 bytes is it.
7839 * then return it to the user
7840 * 9/22/2000 Honor user given length
7841 */
7842 len = comp->len;
7843
7844 if (copy_to_user(comp->data, iobuf, min(len, (int)RIDSIZE))) {
7845 kfree (iobuf);
7846 return -EFAULT;
7847 }
7848 kfree (iobuf);
7849 return 0;
7850}
7851
7852/*
7853 * Danger Will Robinson write the rids here
7854 */
7855
7856static int writerids(struct net_device *dev, aironet_ioctl *comp) {
Wang Chenfaf39942008-10-14 13:30:33 +08007857 struct airo_info *ai = dev->ml_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007858 int ridcode;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007859 int enabled;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007860 static int (* writer)(struct airo_info *, u16 rid, const void *, int, int);
7861 unsigned char *iobuf;
7862
7863 /* Only super-user can write RIDs */
7864 if (!capable(CAP_NET_ADMIN))
7865 return -EPERM;
7866
7867 if (test_bit(FLAG_FLASHING, &ai->flags))
7868 return -EIO;
7869
7870 ridcode = 0;
7871 writer = do_writerid;
7872
7873 switch(comp->command)
7874 {
7875 case AIROPSIDS: ridcode = RID_SSID; break;
7876 case AIROPCAP: ridcode = RID_CAPABILITIES; break;
7877 case AIROPAPLIST: ridcode = RID_APLIST; break;
7878 case AIROPCFG: ai->config.len = 0;
7879 clear_bit(FLAG_COMMIT, &ai->flags);
7880 ridcode = RID_CONFIG; break;
7881 case AIROPWEPKEYNV: ridcode = RID_WEP_PERM; break;
7882 case AIROPLEAPUSR: ridcode = RID_LEAPUSERNAME; break;
7883 case AIROPLEAPPWD: ridcode = RID_LEAPPASSWORD; break;
7884 case AIROPWEPKEY: ridcode = RID_WEP_TEMP; writer = PC4500_writerid;
7885 break;
7886 case AIROPLEAPUSR+1: ridcode = 0xFF2A; break;
7887 case AIROPLEAPUSR+2: ridcode = 0xFF2B; break;
7888
7889 /* this is not really a rid but a command given to the card
7890 * same with MAC off
7891 */
7892 case AIROPMACON:
Michal Schmidt175ec1a2007-06-29 15:33:47 +02007893 if (enable_MAC(ai, 1) != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007894 return -EIO;
7895 return 0;
7896
7897 /*
7898 * Evidently this code in the airo driver does not get a symbol
7899 * as disable_MAC. it's probably so short the compiler does not gen one.
7900 */
7901 case AIROPMACOFF:
7902 disable_MAC(ai, 1);
7903 return 0;
7904
7905 /* This command merely clears the counts does not actually store any data
7906 * only reads rid. But as it changes the cards state, I put it in the
7907 * writerid routines.
7908 */
7909 case AIROPSTCLR:
7910 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7911 return -ENOMEM;
7912
7913 PC4500_readrid(ai,RID_STATSDELTACLEAR,iobuf,RIDSIZE, 1);
7914
Linus Torvalds1da177e2005-04-16 15:20:36 -07007915 enabled = ai->micstats.enabled;
7916 memset(&ai->micstats,0,sizeof(ai->micstats));
7917 ai->micstats.enabled = enabled;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007918
7919 if (copy_to_user(comp->data, iobuf,
7920 min((int)comp->len, (int)RIDSIZE))) {
7921 kfree (iobuf);
7922 return -EFAULT;
7923 }
7924 kfree (iobuf);
7925 return 0;
7926
7927 default:
7928 return -EOPNOTSUPP; /* Blarg! */
7929 }
7930 if(comp->len > RIDSIZE)
7931 return -EINVAL;
7932
7933 if ((iobuf = kmalloc(RIDSIZE, GFP_KERNEL)) == NULL)
7934 return -ENOMEM;
7935
7936 if (copy_from_user(iobuf,comp->data,comp->len)) {
7937 kfree (iobuf);
7938 return -EFAULT;
7939 }
7940
7941 if (comp->command == AIROPCFG) {
7942 ConfigRid *cfg = (ConfigRid *)iobuf;
7943
7944 if (test_bit(FLAG_MIC_CAPABLE, &ai->flags))
Al Viro3eb9b412007-12-21 00:00:35 -05007945 cfg->opmode |= MODE_MIC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007946
Al Viro3eb9b412007-12-21 00:00:35 -05007947 if ((cfg->opmode & MODE_CFG_MASK) == MODE_STA_IBSS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007948 set_bit (FLAG_ADHOC, &ai->flags);
7949 else
7950 clear_bit (FLAG_ADHOC, &ai->flags);
7951 }
7952
7953 if((*writer)(ai, ridcode, iobuf,comp->len,1)) {
7954 kfree (iobuf);
7955 return -EIO;
7956 }
7957 kfree (iobuf);
7958 return 0;
7959}
7960
7961/*****************************************************************************
7962 * Ancillary flash / mod functions much black magic lurkes here *
7963 *****************************************************************************
7964 */
7965
7966/*
7967 * Flash command switch table
7968 */
7969
Jouni Malinenff1d2762005-05-12 22:54:16 -04007970static int flashcard(struct net_device *dev, aironet_ioctl *comp) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07007971 int z;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007972
7973 /* Only super-user can modify flash */
7974 if (!capable(CAP_NET_ADMIN))
7975 return -EPERM;
7976
7977 switch(comp->command)
7978 {
7979 case AIROFLSHRST:
Wang Chenfaf39942008-10-14 13:30:33 +08007980 return cmdreset((struct airo_info *)dev->ml_priv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007981
7982 case AIROFLSHSTFL:
Wang Chenfaf39942008-10-14 13:30:33 +08007983 if (!AIRO_FLASH(dev) &&
7984 (AIRO_FLASH(dev) = kmalloc(FLASHSIZE, GFP_KERNEL)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007985 return -ENOMEM;
Wang Chenfaf39942008-10-14 13:30:33 +08007986 return setflashmode((struct airo_info *)dev->ml_priv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007987
7988 case AIROFLSHGCHR: /* Get char from aux */
7989 if(comp->len != sizeof(int))
7990 return -EINVAL;
7991 if (copy_from_user(&z,comp->data,comp->len))
7992 return -EFAULT;
Wang Chenfaf39942008-10-14 13:30:33 +08007993 return flashgchar((struct airo_info *)dev->ml_priv, z, 8000);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007994
7995 case AIROFLSHPCHR: /* Send char to card. */
7996 if(comp->len != sizeof(int))
7997 return -EINVAL;
7998 if (copy_from_user(&z,comp->data,comp->len))
7999 return -EFAULT;
Wang Chenfaf39942008-10-14 13:30:33 +08008000 return flashpchar((struct airo_info *)dev->ml_priv, z, 8000);
Linus Torvalds1da177e2005-04-16 15:20:36 -07008001
8002 case AIROFLPUTBUF: /* Send 32k to card */
Wang Chenfaf39942008-10-14 13:30:33 +08008003 if (!AIRO_FLASH(dev))
Linus Torvalds1da177e2005-04-16 15:20:36 -07008004 return -ENOMEM;
8005 if(comp->len > FLASHSIZE)
8006 return -EINVAL;
Wang Chenfaf39942008-10-14 13:30:33 +08008007 if (copy_from_user(AIRO_FLASH(dev), comp->data, comp->len))
Linus Torvalds1da177e2005-04-16 15:20:36 -07008008 return -EFAULT;
8009
Wang Chenfaf39942008-10-14 13:30:33 +08008010 flashputbuf((struct airo_info *)dev->ml_priv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07008011 return 0;
8012
8013 case AIRORESTART:
Wang Chenfaf39942008-10-14 13:30:33 +08008014 if (flashrestart((struct airo_info *)dev->ml_priv, dev))
Linus Torvalds1da177e2005-04-16 15:20:36 -07008015 return -EIO;
8016 return 0;
8017 }
8018 return -EINVAL;
8019}
8020
8021#define FLASH_COMMAND 0x7e7e
8022
8023/*
8024 * STEP 1)
8025 * Disable MAC and do soft reset on
8026 * card.
8027 */
8028
Jouni Malinenff1d2762005-05-12 22:54:16 -04008029static int cmdreset(struct airo_info *ai) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07008030 disable_MAC(ai, 1);
8031
8032 if(!waitbusy (ai)){
Dan Williams934d8bf2006-03-16 13:46:23 -05008033 airo_print_info(ai->dev->name, "Waitbusy hang before RESET");
Linus Torvalds1da177e2005-04-16 15:20:36 -07008034 return -EBUSY;
8035 }
8036
8037 OUT4500(ai,COMMAND,CMD_SOFTRESET);
8038
8039 ssleep(1); /* WAS 600 12/7/00 */
8040
8041 if(!waitbusy (ai)){
Dan Williams934d8bf2006-03-16 13:46:23 -05008042 airo_print_info(ai->dev->name, "Waitbusy hang AFTER RESET");
Linus Torvalds1da177e2005-04-16 15:20:36 -07008043 return -EBUSY;
8044 }
8045 return 0;
8046}
8047
8048/* STEP 2)
8049 * Put the card in legendary flash
8050 * mode
8051 */
8052
Jouni Malinenff1d2762005-05-12 22:54:16 -04008053static int setflashmode (struct airo_info *ai) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07008054 set_bit (FLAG_FLASHING, &ai->flags);
8055
8056 OUT4500(ai, SWS0, FLASH_COMMAND);
8057 OUT4500(ai, SWS1, FLASH_COMMAND);
8058 if (probe) {
8059 OUT4500(ai, SWS0, FLASH_COMMAND);
8060 OUT4500(ai, COMMAND,0x10);
8061 } else {
8062 OUT4500(ai, SWS2, FLASH_COMMAND);
8063 OUT4500(ai, SWS3, FLASH_COMMAND);
8064 OUT4500(ai, COMMAND,0);
8065 }
8066 msleep(500); /* 500ms delay */
8067
8068 if(!waitbusy(ai)) {
8069 clear_bit (FLAG_FLASHING, &ai->flags);
Dan Williams934d8bf2006-03-16 13:46:23 -05008070 airo_print_info(ai->dev->name, "Waitbusy hang after setflash mode");
Linus Torvalds1da177e2005-04-16 15:20:36 -07008071 return -EIO;
8072 }
8073 return 0;
8074}
8075
8076/* Put character to SWS0 wait for dwelltime
8077 * x 50us for echo .
8078 */
8079
Jouni Malinenff1d2762005-05-12 22:54:16 -04008080static int flashpchar(struct airo_info *ai,int byte,int dwelltime) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07008081 int echo;
8082 int waittime;
8083
8084 byte |= 0x8000;
8085
8086 if(dwelltime == 0 )
8087 dwelltime = 200;
8088
8089 waittime=dwelltime;
8090
8091 /* Wait for busy bit d15 to go false indicating buffer empty */
8092 while ((IN4500 (ai, SWS0) & 0x8000) && waittime > 0) {
8093 udelay (50);
8094 waittime -= 50;
8095 }
8096
8097 /* timeout for busy clear wait */
8098 if(waittime <= 0 ){
Dan Williams934d8bf2006-03-16 13:46:23 -05008099 airo_print_info(ai->dev->name, "flash putchar busywait timeout!");
Linus Torvalds1da177e2005-04-16 15:20:36 -07008100 return -EBUSY;
8101 }
8102
8103 /* Port is clear now write byte and wait for it to echo back */
8104 do {
8105 OUT4500(ai,SWS0,byte);
8106 udelay(50);
8107 dwelltime -= 50;
8108 echo = IN4500(ai,SWS1);
8109 } while (dwelltime >= 0 && echo != byte);
8110
8111 OUT4500(ai,SWS1,0);
8112
8113 return (echo == byte) ? 0 : -EIO;
8114}
8115
8116/*
8117 * Get a character from the card matching matchbyte
8118 * Step 3)
8119 */
Jouni Malinenff1d2762005-05-12 22:54:16 -04008120static int flashgchar(struct airo_info *ai,int matchbyte,int dwelltime){
Linus Torvalds1da177e2005-04-16 15:20:36 -07008121 int rchar;
8122 unsigned char rbyte=0;
8123
8124 do {
8125 rchar = IN4500(ai,SWS1);
8126
8127 if(dwelltime && !(0x8000 & rchar)){
8128 dwelltime -= 10;
8129 mdelay(10);
8130 continue;
8131 }
8132 rbyte = 0xff & rchar;
8133
8134 if( (rbyte == matchbyte) && (0x8000 & rchar) ){
8135 OUT4500(ai,SWS1,0);
8136 return 0;
8137 }
8138 if( rbyte == 0x81 || rbyte == 0x82 || rbyte == 0x83 || rbyte == 0x1a || 0xffff == rchar)
8139 break;
8140 OUT4500(ai,SWS1,0);
8141
8142 }while(dwelltime > 0);
8143 return -EIO;
8144}
8145
8146/*
8147 * Transfer 32k of firmware data from user buffer to our buffer and
8148 * send to the card
8149 */
8150
Jouni Malinenff1d2762005-05-12 22:54:16 -04008151static int flashputbuf(struct airo_info *ai){
Linus Torvalds1da177e2005-04-16 15:20:36 -07008152 int nwords;
8153
8154 /* Write stuff */
8155 if (test_bit(FLAG_MPI,&ai->flags))
8156 memcpy_toio(ai->pciaux + 0x8000, ai->flash, FLASHSIZE);
8157 else {
8158 OUT4500(ai,AUXPAGE,0x100);
8159 OUT4500(ai,AUXOFF,0);
8160
8161 for(nwords=0;nwords != FLASHSIZE / 2;nwords++){
8162 OUT4500(ai,AUXDATA,ai->flash[nwords] & 0xffff);
8163 }
8164 }
8165 OUT4500(ai,SWS0,0x8000);
8166
8167 return 0;
8168}
8169
8170/*
8171 *
8172 */
Jouni Malinenff1d2762005-05-12 22:54:16 -04008173static int flashrestart(struct airo_info *ai,struct net_device *dev){
Linus Torvalds1da177e2005-04-16 15:20:36 -07008174 int i,status;
8175
8176 ssleep(1); /* Added 12/7/00 */
8177 clear_bit (FLAG_FLASHING, &ai->flags);
8178 if (test_bit(FLAG_MPI, &ai->flags)) {
8179 status = mpi_init_descriptors(ai);
8180 if (status != SUCCESS)
8181 return status;
8182 }
8183 status = setup_card(ai, dev->dev_addr, 1);
8184
8185 if (!test_bit(FLAG_MPI,&ai->flags))
8186 for( i = 0; i < MAX_FIDS; i++ ) {
8187 ai->fids[i] = transmit_allocate
Dan Williams15db2762006-03-16 13:46:27 -05008188 ( ai, AIRO_DEF_MTU, i >= MAX_FIDS / 2 );
Linus Torvalds1da177e2005-04-16 15:20:36 -07008189 }
8190
8191 ssleep(1); /* Added 12/7/00 */
8192 return status;
8193}
8194#endif /* CISCO_EXT */
8195
8196/*
8197 This program is free software; you can redistribute it and/or
8198 modify it under the terms of the GNU General Public License
8199 as published by the Free Software Foundation; either version 2
8200 of the License, or (at your option) any later version.
8201
8202 This program is distributed in the hope that it will be useful,
8203 but WITHOUT ANY WARRANTY; without even the implied warranty of
8204 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
8205 GNU General Public License for more details.
8206
8207 In addition:
8208
8209 Redistribution and use in source and binary forms, with or without
8210 modification, are permitted provided that the following conditions
8211 are met:
8212
8213 1. Redistributions of source code must retain the above copyright
8214 notice, this list of conditions and the following disclaimer.
8215 2. Redistributions in binary form must reproduce the above copyright
8216 notice, this list of conditions and the following disclaimer in the
8217 documentation and/or other materials provided with the distribution.
8218 3. The name of the author may not be used to endorse or promote
8219 products derived from this software without specific prior written
8220 permission.
8221
8222 THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
8223 IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
8224 WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
8225 ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
8226 INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
8227 (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
8228 SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
8229 HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
8230 STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
8231 IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
8232 POSSIBILITY OF SUCH DAMAGE.
8233*/
8234
8235module_init(airo_init_module);
8236module_exit(airo_cleanup_module);