hostap_cs.c 24.2 KB
Newer Older
Jouni Malinen's avatar
Jouni Malinen committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
#define PRISM2_PCCARD

#include <linux/config.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/if.h>
#include <linux/wait.h>
#include <linux/timer.h>
#include <linux/skbuff.h>
#include <linux/netdevice.h>
#include <linux/workqueue.h>
#include <linux/wireless.h>
#include <net/iw_handler.h>

#include <pcmcia/cs_types.h>
#include <pcmcia/cs.h>
#include <pcmcia/cistpl.h>
#include <pcmcia/cisreg.h>
#include <pcmcia/ds.h>

#include <asm/io.h>

#include "hostap_wlan.h"


static char *version = PRISM2_VERSION " (Jouni Malinen <jkmaline@cc.hut.fi>)";
static dev_info_t dev_info = "hostap_cs";

MODULE_AUTHOR("Jouni Malinen");
MODULE_DESCRIPTION("Support for Intersil Prism2-based 802.11 wireless LAN "
		   "cards (PC Card).");
MODULE_SUPPORTED_DEVICE("Intersil Prism2-based WLAN cards (PC Card)");
MODULE_LICENSE("GPL");
Jouni Malinen's avatar
Jouni Malinen committed
34
MODULE_VERSION(PRISM2_VERSION);
Jouni Malinen's avatar
Jouni Malinen committed
35
36
37
38
39
40
41


static int ignore_cis_vcc;
module_param(ignore_cis_vcc, int, 0444);
MODULE_PARM_DESC(ignore_cis_vcc, "Ignore broken CIS VCC entry");


42
43
44
/* struct local_info::hw_priv */
struct hostap_cs_priv {
	dev_node_t node;
45
	struct pcmcia_device *link;
46
47
48
49
	int sandisk_connectplus;
};


Jouni Malinen's avatar
Jouni Malinen committed
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
#ifdef PRISM2_IO_DEBUG

static inline void hfa384x_outb_debug(struct net_device *dev, int a, u8 v)
{
	struct hostap_interface *iface;
	local_info_t *local;
	unsigned long flags;

	iface = netdev_priv(dev);
	local = iface->local;
	spin_lock_irqsave(&local->lock, flags);
	prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_OUTB, a, v);
	outb(v, dev->base_addr + a);
	spin_unlock_irqrestore(&local->lock, flags);
}

static inline u8 hfa384x_inb_debug(struct net_device *dev, int a)
{
	struct hostap_interface *iface;
	local_info_t *local;
	unsigned long flags;
	u8 v;

	iface = netdev_priv(dev);
	local = iface->local;
	spin_lock_irqsave(&local->lock, flags);
	v = inb(dev->base_addr + a);
	prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_INB, a, v);
	spin_unlock_irqrestore(&local->lock, flags);
	return v;
}

static inline void hfa384x_outw_debug(struct net_device *dev, int a, u16 v)
{
	struct hostap_interface *iface;
	local_info_t *local;
	unsigned long flags;

	iface = netdev_priv(dev);
	local = iface->local;
	spin_lock_irqsave(&local->lock, flags);
	prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_OUTW, a, v);
	outw(v, dev->base_addr + a);
	spin_unlock_irqrestore(&local->lock, flags);
}

static inline u16 hfa384x_inw_debug(struct net_device *dev, int a)
{
	struct hostap_interface *iface;
	local_info_t *local;
	unsigned long flags;
	u16 v;

	iface = netdev_priv(dev);
	local = iface->local;
	spin_lock_irqsave(&local->lock, flags);
	v = inw(dev->base_addr + a);
	prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_INW, a, v);
	spin_unlock_irqrestore(&local->lock, flags);
	return v;
}

static inline void hfa384x_outsw_debug(struct net_device *dev, int a,
				       u8 *buf, int wc)
{
	struct hostap_interface *iface;
	local_info_t *local;
	unsigned long flags;

	iface = netdev_priv(dev);
	local = iface->local;
	spin_lock_irqsave(&local->lock, flags);
	prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_OUTSW, a, wc);
	outsw(dev->base_addr + a, buf, wc);
	spin_unlock_irqrestore(&local->lock, flags);
}

static inline void hfa384x_insw_debug(struct net_device *dev, int a,
				      u8 *buf, int wc)
{
	struct hostap_interface *iface;
	local_info_t *local;
	unsigned long flags;

	iface = netdev_priv(dev);
	local = iface->local;
	spin_lock_irqsave(&local->lock, flags);
	prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_INSW, a, wc);
	insw(dev->base_addr + a, buf, wc);
	spin_unlock_irqrestore(&local->lock, flags);
}

#define HFA384X_OUTB(v,a) hfa384x_outb_debug(dev, (a), (v))
#define HFA384X_INB(a) hfa384x_inb_debug(dev, (a))
#define HFA384X_OUTW(v,a) hfa384x_outw_debug(dev, (a), (v))
#define HFA384X_INW(a) hfa384x_inw_debug(dev, (a))
#define HFA384X_OUTSW(a, buf, wc) hfa384x_outsw_debug(dev, (a), (buf), (wc))
#define HFA384X_INSW(a, buf, wc) hfa384x_insw_debug(dev, (a), (buf), (wc))

#else /* PRISM2_IO_DEBUG */

#define HFA384X_OUTB(v,a) outb((v), dev->base_addr + (a))
#define HFA384X_INB(a) inb(dev->base_addr + (a))
#define HFA384X_OUTW(v,a) outw((v), dev->base_addr + (a))
#define HFA384X_INW(a) inw(dev->base_addr + (a))
#define HFA384X_INSW(a, buf, wc) insw(dev->base_addr + (a), buf, wc)
#define HFA384X_OUTSW(a, buf, wc) outsw(dev->base_addr + (a), buf, wc)

#endif /* PRISM2_IO_DEBUG */


static int hfa384x_from_bap(struct net_device *dev, u16 bap, void *buf,
			    int len)
{
	u16 d_off;
	u16 *pos;

	d_off = (bap == 1) ? HFA384X_DATA1_OFF : HFA384X_DATA0_OFF;
	pos = (u16 *) buf;

	if (len / 2)
		HFA384X_INSW(d_off, buf, len / 2);
	pos += len / 2;

	if (len & 1)
		*((char *) pos) = HFA384X_INB(d_off);

	return 0;
}


static int hfa384x_to_bap(struct net_device *dev, u16 bap, void *buf, int len)
{
	u16 d_off;
	u16 *pos;

	d_off = (bap == 1) ? HFA384X_DATA1_OFF : HFA384X_DATA0_OFF;
	pos = (u16 *) buf;

	if (len / 2)
		HFA384X_OUTSW(d_off, buf, len / 2);
	pos += len / 2;

	if (len & 1)
		HFA384X_OUTB(*((char *) pos), d_off);

	return 0;
}


/* FIX: This might change at some point.. */
#include "hostap_hw.c"



205
static void prism2_detach(struct pcmcia_device *p_dev);
Jouni Malinen's avatar
Jouni Malinen committed
206
static void prism2_release(u_long arg);
207
static int prism2_config(struct pcmcia_device *link);
Jouni Malinen's avatar
Jouni Malinen committed
208
209
210
211


static int prism2_pccard_card_present(local_info_t *local)
{
212
	struct hostap_cs_priv *hw_priv = local->hw_priv;
213
	if (hw_priv != NULL && hw_priv->link != NULL && pcmcia_dev_present(hw_priv->link))
Jouni Malinen's avatar
Jouni Malinen committed
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
		return 1;
	return 0;
}


/*
 * SanDisk CompactFlash WLAN Flashcard - Product Manual v1.0
 * Document No. 20-10-00058, January 2004
 * http://www.sandisk.com/pdf/industrial/ProdManualCFWLANv1.0.pdf
 */
#define SANDISK_WLAN_ACTIVATION_OFF 0x40
#define SANDISK_HCR_OFF 0x42


static void sandisk_set_iobase(local_info_t *local)
{
	int res;
	conf_reg_t reg;
232
	struct hostap_cs_priv *hw_priv = local->hw_priv;
Jouni Malinen's avatar
Jouni Malinen committed
233
234
235
236

	reg.Function = 0;
	reg.Action = CS_WRITE;
	reg.Offset = 0x10; /* 0x3f0 IO base 1 */
237
	reg.Value = hw_priv->link->io.BasePort1 & 0x00ff;
238
	res = pcmcia_access_configuration_register(hw_priv->link,
239
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
240
241
242
243
244
245
246
247
248
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "Prism3 SanDisk - failed to set I/O base 0 -"
		       " res=%d\n", res);
	}
	udelay(10);

	reg.Function = 0;
	reg.Action = CS_WRITE;
	reg.Offset = 0x12; /* 0x3f2 IO base 2 */
249
	reg.Value = (hw_priv->link->io.BasePort1 & 0xff00) >> 8;
250
	res = pcmcia_access_configuration_register(hw_priv->link,
251
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "Prism3 SanDisk - failed to set I/O base 1 -"
		       " res=%d\n", res);
	}
}


static void sandisk_write_hcr(local_info_t *local, int hcr)
{
	struct net_device *dev = local->dev;
	int i;

	HFA384X_OUTB(0x80, SANDISK_WLAN_ACTIVATION_OFF);
	udelay(50);
	for (i = 0; i < 10; i++) {
		HFA384X_OUTB(hcr, SANDISK_HCR_OFF);
	}
	udelay(55);
	HFA384X_OUTB(0x45, SANDISK_WLAN_ACTIVATION_OFF);
}


static int sandisk_enable_wireless(struct net_device *dev)
{
	int res, ret = 0;
	conf_reg_t reg;
	struct hostap_interface *iface = dev->priv;
	local_info_t *local = iface->local;
	tuple_t tuple;
	cisparse_t *parse = NULL;
	u_char buf[64];
283
	struct hostap_cs_priv *hw_priv = local->hw_priv;
Jouni Malinen's avatar
Jouni Malinen committed
284

285
	if (hw_priv->link->io.NumPorts1 < 0x42) {
Jouni Malinen's avatar
Jouni Malinen committed
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
		/* Not enough ports to be SanDisk multi-function card */
		ret = -ENODEV;
		goto done;
	}

	parse = kmalloc(sizeof(cisparse_t), GFP_KERNEL);
	if (parse == NULL) {
		ret = -ENOMEM;
		goto done;
	}

	tuple.DesiredTuple = CISTPL_MANFID;
	tuple.Attributes = TUPLE_RETURN_COMMON;
	tuple.TupleData = buf;
	tuple.TupleDataMax = sizeof(buf);
	tuple.TupleOffset = 0;
302
303
304
	if (pcmcia_get_first_tuple(hw_priv->link, &tuple) ||
	    pcmcia_get_tuple_data(hw_priv->link, &tuple) ||
	    pcmcia_parse_tuple(hw_priv->link, &tuple, parse) ||
Jouni Malinen's avatar
Jouni Malinen committed
305
306
307
308
309
310
311
	    parse->manfid.manf != 0xd601 || parse->manfid.card != 0x0101) {
		/* No SanDisk manfid found */
		ret = -ENODEV;
		goto done;
	}

	tuple.DesiredTuple = CISTPL_LONGLINK_MFC;
312
313
314
	if (pcmcia_get_first_tuple(hw_priv->link, &tuple) ||
	    pcmcia_get_tuple_data(hw_priv->link, &tuple) ||
	    pcmcia_parse_tuple(hw_priv->link, &tuple, parse) ||
Jouni Malinen's avatar
Jouni Malinen committed
315
316
317
318
319
320
321
322
		parse->longlink_mfc.nfn < 2) {
		/* No multi-function links found */
		ret = -ENODEV;
		goto done;
	}

	printk(KERN_DEBUG "%s: Multi-function SanDisk ConnectPlus detected"
	       " - using vendor-specific initialization\n", dev->name);
323
	hw_priv->sandisk_connectplus = 1;
Jouni Malinen's avatar
Jouni Malinen committed
324
325
326
327
328

	reg.Function = 0;
	reg.Action = CS_WRITE;
	reg.Offset = CISREG_COR;
	reg.Value = COR_SOFT_RESET;
329
	res = pcmcia_access_configuration_register(hw_priv->link,
330
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "%s: SanDisk - COR sreset failed (%d)\n",
		       dev->name, res);
		goto done;
	}
	mdelay(5);

	reg.Function = 0;
	reg.Action = CS_WRITE;
	reg.Offset = CISREG_COR;
	/*
	 * Do not enable interrupts here to avoid some bogus events. Interrupts
	 * will be enabled during the first cor_sreset call.
	 */
	reg.Value = COR_LEVEL_REQ | 0x8 | COR_ADDR_DECODE | COR_FUNC_ENA;
346
	res = pcmcia_access_configuration_register(hw_priv->link,
347
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "%s: SanDisk - COR sreset failed (%d)\n",
		       dev->name, res);
		goto done;
	}
	mdelay(5);

	sandisk_set_iobase(local);

	HFA384X_OUTB(0xc5, SANDISK_WLAN_ACTIVATION_OFF);
	udelay(10);
	HFA384X_OUTB(0x4b, SANDISK_WLAN_ACTIVATION_OFF);
	udelay(10);

done:
	kfree(parse);
	return ret;
}


static void prism2_pccard_cor_sreset(local_info_t *local)
{
	int res;
	conf_reg_t reg;
372
	struct hostap_cs_priv *hw_priv = local->hw_priv;
Jouni Malinen's avatar
Jouni Malinen committed
373
374
375
376
377
378
379
380

	if (!prism2_pccard_card_present(local))
	       return;

	reg.Function = 0;
	reg.Action = CS_READ;
	reg.Offset = CISREG_COR;
	reg.Value = 0;
381
	res = pcmcia_access_configuration_register(hw_priv->link,
382
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
383
384
385
386
387
388
389
390
391
392
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 1 (%d)\n",
		       res);
		return;
	}
	printk(KERN_DEBUG "prism2_pccard_cor_sreset: original COR %02x\n",
	       reg.Value);

	reg.Action = CS_WRITE;
	reg.Value |= COR_SOFT_RESET;
393
	res = pcmcia_access_configuration_register(hw_priv->link,
394
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
395
396
397
398
399
400
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 2 (%d)\n",
		       res);
		return;
	}

401
	mdelay(hw_priv->sandisk_connectplus ? 5 : 2);
Jouni Malinen's avatar
Jouni Malinen committed
402
403

	reg.Value &= ~COR_SOFT_RESET;
404
	if (hw_priv->sandisk_connectplus)
Jouni Malinen's avatar
Jouni Malinen committed
405
		reg.Value |= COR_IREQ_ENA;
406
	res = pcmcia_access_configuration_register(hw_priv->link,
407
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
408
409
410
411
412
413
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "prism2_pccard_cor_sreset failed 3 (%d)\n",
		       res);
		return;
	}

414
	mdelay(hw_priv->sandisk_connectplus ? 5 : 2);
Jouni Malinen's avatar
Jouni Malinen committed
415

416
	if (hw_priv->sandisk_connectplus)
Jouni Malinen's avatar
Jouni Malinen committed
417
418
419
420
421
422
423
424
425
		sandisk_set_iobase(local);
}


static void prism2_pccard_genesis_reset(local_info_t *local, int hcr)
{
	int res;
	conf_reg_t reg;
	int old_cor;
426
	struct hostap_cs_priv *hw_priv = local->hw_priv;
Jouni Malinen's avatar
Jouni Malinen committed
427
428
429
430

	if (!prism2_pccard_card_present(local))
	       return;

431
	if (hw_priv->sandisk_connectplus) {
Jouni Malinen's avatar
Jouni Malinen committed
432
433
434
435
436
437
438
439
		sandisk_write_hcr(local, hcr);
		return;
	}

	reg.Function = 0;
	reg.Action = CS_READ;
	reg.Offset = CISREG_COR;
	reg.Value = 0;
440
	res = pcmcia_access_configuration_register(hw_priv->link,
441
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
442
443
444
445
446
447
448
449
450
451
452
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 1 "
		       "(%d)\n", res);
		return;
	}
	printk(KERN_DEBUG "prism2_pccard_genesis_sreset: original COR %02x\n",
	       reg.Value);
	old_cor = reg.Value;

	reg.Action = CS_WRITE;
	reg.Value |= COR_SOFT_RESET;
453
	res = pcmcia_access_configuration_register(hw_priv->link,
454
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
455
456
457
458
459
460
461
462
463
464
465
466
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 2 "
		       "(%d)\n", res);
		return;
	}

	mdelay(10);

	/* Setup Genesis mode */
	reg.Action = CS_WRITE;
	reg.Value = hcr;
	reg.Offset = CISREG_CCSR;
467
	res = pcmcia_access_configuration_register(hw_priv->link,
468
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
469
470
471
472
473
474
475
476
477
478
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 3 "
		       "(%d)\n", res);
		return;
	}
	mdelay(10);

	reg.Action = CS_WRITE;
	reg.Offset = CISREG_COR;
	reg.Value = old_cor & ~COR_SOFT_RESET;
479
	res = pcmcia_access_configuration_register(hw_priv->link,
480
						   &reg);
Jouni Malinen's avatar
Jouni Malinen committed
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
	if (res != CS_SUCCESS) {
		printk(KERN_DEBUG "prism2_pccard_genesis_sreset failed 4 "
		       "(%d)\n", res);
		return;
	}

	mdelay(10);
}


static struct prism2_helper_functions prism2_pccard_funcs =
{
	.card_present	= prism2_pccard_card_present,
	.cor_sreset	= prism2_pccard_cor_sreset,
	.genesis_reset	= prism2_pccard_genesis_reset,
	.hw_type	= HOSTAP_HW_PCCARD,
};


/* allocate local data and register with CardServices
 * initialize dev_link structure, but do not configure the card yet */
502
static int hostap_cs_probe(struct pcmcia_device *p_dev)
Jouni Malinen's avatar
Jouni Malinen committed
503
{
504
505
	int ret;

Jouni Malinen's avatar
Jouni Malinen committed
506
	PDEBUG(DEBUG_HW, "%s: setting Vcc=33 (constant)\n", dev_info);
507
	p_dev->conf.IntType = INT_MEMORY_AND_IO;
508

509
510
	ret = prism2_config(p_dev);
	if (ret) {
511
		PDEBUG(DEBUG_EXTRA, "prism2_config() failed\n");
512
	}
513

514
	return ret;
Jouni Malinen's avatar
Jouni Malinen committed
515
516
517
}


518
static void prism2_detach(struct pcmcia_device *link)
Jouni Malinen's avatar
Jouni Malinen committed
519
520
521
{
	PDEBUG(DEBUG_FLOW, "prism2_detach\n");

522
	prism2_release((u_long)link);
Jouni Malinen's avatar
Jouni Malinen committed
523
524
525

	/* release net devices */
	if (link->priv) {
526
		struct hostap_cs_priv *hw_priv;
527
528
529
530
		struct net_device *dev;
		struct hostap_interface *iface;
		dev = link->priv;
		iface = netdev_priv(dev);
531
		hw_priv = iface->local->hw_priv;
532
		prism2_free_local_data(dev);
533
		kfree(hw_priv);
Jouni Malinen's avatar
Jouni Malinen committed
534
535
536
537
538
539
540
541
542
543
544
	}
}


#define CS_CHECK(fn, ret) \
do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)

#define CFG_CHECK2(fn, retf) \
do { int ret = (retf); \
if (ret != 0) { \
	PDEBUG(DEBUG_EXTRA, "CardServices(" #fn ") returned %d\n", ret); \
545
	cs_error(link, fn, ret); \
Jouni Malinen's avatar
Jouni Malinen committed
546
547
548
549
550
551
552
	goto next_entry; \
} \
} while (0)


/* run after a CARD_INSERTION event is received to configure the PCMCIA
 * socket and make the device available to the system */
553
static int prism2_config(struct pcmcia_device *link)
Jouni Malinen's avatar
Jouni Malinen committed
554
555
556
557
558
559
560
561
562
563
564
{
	struct net_device *dev;
	struct hostap_interface *iface;
	local_info_t *local;
	int ret = 1;
	tuple_t tuple;
	cisparse_t *parse;
	int last_fn, last_ret;
	u_char buf[64];
	config_info_t conf;
	cistpl_cftable_entry_t dflt = { 0 };
565
	struct hostap_cs_priv *hw_priv;
Jouni Malinen's avatar
Jouni Malinen committed
566
567
568
569

	PDEBUG(DEBUG_FLOW, "prism2_config()\n");

	parse = kmalloc(sizeof(cisparse_t), GFP_KERNEL);
570
571
	hw_priv = kmalloc(sizeof(*hw_priv), GFP_KERNEL);
	if (parse == NULL || hw_priv == NULL) {
Jouni Malinen's avatar
Jouni Malinen committed
572
573
574
		ret = -ENOMEM;
		goto failed;
	}
575
	memset(hw_priv, 0, sizeof(*hw_priv));
Jouni Malinen's avatar
Jouni Malinen committed
576
577
578
579
580
581

	tuple.DesiredTuple = CISTPL_CONFIG;
	tuple.Attributes = 0;
	tuple.TupleData = buf;
	tuple.TupleDataMax = sizeof(buf);
	tuple.TupleOffset = 0;
582
583
584
	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
	CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
	CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, parse));
Jouni Malinen's avatar
Jouni Malinen committed
585
586
587
588
	link->conf.ConfigBase = parse->config.base;
	link->conf.Present = parse->config.rmask[0];

	CS_CHECK(GetConfigurationInfo,
589
		 pcmcia_get_configuration_info(link, &conf));
Jouni Malinen's avatar
Jouni Malinen committed
590
591
592

	/* Look for an appropriate configuration table entry in the CIS */
	tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
593
	CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
Jouni Malinen's avatar
Jouni Malinen committed
594
595
596
	for (;;) {
		cistpl_cftable_entry_t *cfg = &(parse->cftable_entry);
		CFG_CHECK2(GetTupleData,
597
			   pcmcia_get_tuple_data(link, &tuple));
Jouni Malinen's avatar
Jouni Malinen committed
598
		CFG_CHECK2(ParseTuple,
599
			   pcmcia_parse_tuple(link, &tuple, parse));
Jouni Malinen's avatar
Jouni Malinen committed
600
601
602
603
604
605
606
607

		if (cfg->flags & CISTPL_CFTABLE_DEFAULT)
			dflt = *cfg;
		if (cfg->index == 0)
			goto next_entry;
		link->conf.ConfigIndex = cfg->index;
		PDEBUG(DEBUG_EXTRA, "Checking CFTABLE_ENTRY 0x%02X "
		       "(default 0x%02X)\n", cfg->index, dflt.index);
608

Jouni Malinen's avatar
Jouni Malinen committed
609
610
611
612
613
		/* Does this card need audio output? */
		if (cfg->flags & CISTPL_CFTABLE_AUDIO) {
			link->conf.Attributes |= CONF_ENABLE_SPKR;
			link->conf.Status = CCSR_AUDIO_ENA;
		}
614

Jouni Malinen's avatar
Jouni Malinen committed
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
		/* Use power settings for Vcc and Vpp if present */
		/*  Note that the CIS values need to be rescaled */
		if (cfg->vcc.present & (1 << CISTPL_POWER_VNOM)) {
			if (conf.Vcc != cfg->vcc.param[CISTPL_POWER_VNOM] /
			    10000 && !ignore_cis_vcc) {
				PDEBUG(DEBUG_EXTRA, "  Vcc mismatch - skipping"
				       " this entry\n");
				goto next_entry;
			}
		} else if (dflt.vcc.present & (1 << CISTPL_POWER_VNOM)) {
			if (conf.Vcc != dflt.vcc.param[CISTPL_POWER_VNOM] /
			    10000 && !ignore_cis_vcc) {
				PDEBUG(DEBUG_EXTRA, "  Vcc (default) mismatch "
				       "- skipping this entry\n");
				goto next_entry;
			}
		}

		if (cfg->vpp1.present & (1 << CISTPL_POWER_VNOM))
634
			link->conf.Vpp =
Jouni Malinen's avatar
Jouni Malinen committed
635
636
				cfg->vpp1.param[CISTPL_POWER_VNOM] / 10000;
		else if (dflt.vpp1.present & (1 << CISTPL_POWER_VNOM))
637
			link->conf.Vpp =
Jouni Malinen's avatar
Jouni Malinen committed
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
				dflt.vpp1.param[CISTPL_POWER_VNOM] / 10000;

		/* Do we need to allocate an interrupt? */
		if (cfg->irq.IRQInfo1 || dflt.irq.IRQInfo1)
			link->conf.Attributes |= CONF_ENABLE_IRQ;
		else if (!(link->conf.Attributes & CONF_ENABLE_IRQ)) {
			/* At least Compaq WL200 does not have IRQInfo1 set,
			 * but it does not work without interrupts.. */
			printk("Config has no IRQ info, but trying to enable "
			       "IRQ anyway..\n");
			link->conf.Attributes |= CONF_ENABLE_IRQ;
		}

		/* IO window settings */
		PDEBUG(DEBUG_EXTRA, "IO window settings: cfg->io.nwin=%d "
		       "dflt.io.nwin=%d\n",
		       cfg->io.nwin, dflt.io.nwin);
		link->io.NumPorts1 = link->io.NumPorts2 = 0;
		if ((cfg->io.nwin > 0) || (dflt.io.nwin > 0)) {
			cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt.io;
			link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
			PDEBUG(DEBUG_EXTRA, "io->flags = 0x%04X, "
			       "io.base=0x%04x, len=%d\n", io->flags,
			       io->win[0].base, io->win[0].len);
			if (!(io->flags & CISTPL_IO_8BIT))
				link->io.Attributes1 = IO_DATA_PATH_WIDTH_16;
			if (!(io->flags & CISTPL_IO_16BIT))
				link->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
			link->io.IOAddrLines = io->flags &
				CISTPL_IO_LINES_MASK;
			link->io.BasePort1 = io->win[0].base;
			link->io.NumPorts1 = io->win[0].len;
			if (io->nwin > 1) {
				link->io.Attributes2 = link->io.Attributes1;
				link->io.BasePort2 = io->win[1].base;
				link->io.NumPorts2 = io->win[1].len;
			}
		}

		/* This reserves IO space but doesn't actually enable it */
		CFG_CHECK2(RequestIO,
679
			   pcmcia_request_io(link, &link->io));
Jouni Malinen's avatar
Jouni Malinen committed
680
681
682
683
684
685

		/* This configuration table entry is OK */
		break;

	next_entry:
		CS_CHECK(GetNextTuple,
686
			 pcmcia_get_next_tuple(link, &tuple));
Jouni Malinen's avatar
Jouni Malinen committed
687
688
689
	}

	/* Need to allocate net_device before requesting IRQ handler */
Dave Hansen's avatar
Dave Hansen committed
690
	dev = prism2_init_local_data(&prism2_pccard_funcs, 0,
691
				     &handle_to_dev(link));
Jouni Malinen's avatar
Jouni Malinen committed
692
693
694
695
	if (dev == NULL)
		goto failed;
	link->priv = dev;

696
697
698
699
700
	iface = netdev_priv(dev);
	local = iface->local;
	local->hw_priv = hw_priv;
	hw_priv->link = link;
	strcpy(hw_priv->node.dev_name, dev->name);
701
	link->dev_node = &hw_priv->node;
702

Jouni Malinen's avatar
Jouni Malinen committed
703
704
705
706
707
708
709
	/*
	 * Allocate an interrupt line.  Note that this does not assign a
	 * handler to the interrupt, unless the 'Handler' member of the
	 * irq structure is initialized.
	 */
	if (link->conf.Attributes & CONF_ENABLE_IRQ) {
		link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
Jar's avatar
Jar committed
710
		link->irq.IRQInfo1 = IRQ_LEVEL_ID;
Jouni Malinen's avatar
Jouni Malinen committed
711
712
713
		link->irq.Handler = prism2_interrupt;
		link->irq.Instance = dev;
		CS_CHECK(RequestIRQ,
714
			 pcmcia_request_irq(link, &link->irq));
Jouni Malinen's avatar
Jouni Malinen committed
715
716
717
718
719
720
721
722
	}

	/*
	 * This actually configures the PCMCIA socket -- setting up
	 * the I/O windows and the interrupt mapping, and putting the
	 * card and host interface into "Memory and IO" mode.
	 */
	CS_CHECK(RequestConfiguration,
723
		 pcmcia_request_configuration(link, &link->conf));
Jouni Malinen's avatar
Jouni Malinen committed
724
725
726
727
728

	dev->irq = link->irq.AssignedIRQ;
	dev->base_addr = link->io.BasePort1;

	/* Finally, report what we've done */
729
730
731
732
733
	printk(KERN_INFO "%s: index 0x%02x: ",
	       dev_info, link->conf.ConfigIndex);
	if (link->conf.Vpp)
		printk(", Vpp %d.%d", link->conf.Vpp / 10,
		       link->conf.Vpp % 10);
Jouni Malinen's avatar
Jouni Malinen committed
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
	if (link->conf.Attributes & CONF_ENABLE_IRQ)
		printk(", irq %d", link->irq.AssignedIRQ);
	if (link->io.NumPorts1)
		printk(", io 0x%04x-0x%04x", link->io.BasePort1,
		       link->io.BasePort1+link->io.NumPorts1-1);
	if (link->io.NumPorts2)
		printk(" & 0x%04x-0x%04x", link->io.BasePort2,
		       link->io.BasePort2+link->io.NumPorts2-1);
	printk("\n");

	local->shutdown = 0;

	sandisk_enable_wireless(dev);

	ret = prism2_hw_config(dev, 1);
	if (!ret) {
		ret = hostap_hw_ready(dev);
		if (ret == 0 && local->ddev)
752
			strcpy(hw_priv->node.dev_name, local->ddev->name);
Jouni Malinen's avatar
Jouni Malinen committed
753
754
755
756
757
	}
	kfree(parse);
	return ret;

 cs_failed:
758
	cs_error(link, last_fn, last_ret);
Jouni Malinen's avatar
Jouni Malinen committed
759
760
761

 failed:
	kfree(parse);
762
	kfree(hw_priv);
Jouni Malinen's avatar
Jouni Malinen committed
763
764
765
766
767
768
769
	prism2_release((u_long)link);
	return ret;
}


static void prism2_release(u_long arg)
{
770
	struct pcmcia_device *link = (struct pcmcia_device *)arg;
Jouni Malinen's avatar
Jouni Malinen committed
771
772
773
774
775
776
777
778

	PDEBUG(DEBUG_FLOW, "prism2_release\n");

	if (link->priv) {
		struct net_device *dev = link->priv;
		struct hostap_interface *iface;

		iface = netdev_priv(dev);
779
		prism2_hw_shutdown(dev, 0);
Jouni Malinen's avatar
Jouni Malinen committed
780
781
782
		iface->local->shutdown = 1;
	}

783
	pcmcia_disable_device(link);
Jouni Malinen's avatar
Jouni Malinen committed
784
785
786
	PDEBUG(DEBUG_FLOW, "release - done\n");
}

787
static int hostap_cs_suspend(struct pcmcia_device *link)
788
789
790
{
	struct net_device *dev = (struct net_device *) link->priv;
	int dev_open = 0;
791
	struct hostap_interface *iface = NULL;
Jouni Malinen's avatar
Jouni Malinen committed
792

793
794
	if (dev)
		iface = netdev_priv(dev);
795

796
797
798
799
800
801
	PDEBUG(DEBUG_EXTRA, "%s: CS_EVENT_PM_SUSPEND\n", dev_info);
	if (iface && iface->local)
		dev_open = iface->local->num_dev_open > 0;
	if (dev_open) {
		netif_stop_queue(dev);
		netif_device_detach(dev);
802
	}
803
	prism2_suspend(dev);
804
805
806
807

	return 0;
}

808
static int hostap_cs_resume(struct pcmcia_device *link)
Jouni Malinen's avatar
Jouni Malinen committed
809
810
{
	struct net_device *dev = (struct net_device *) link->priv;
811
	int dev_open = 0;
812
813
814
815
	struct hostap_interface *iface = NULL;

	if (dev)
		iface = netdev_priv(dev);
816

817
818
	PDEBUG(DEBUG_EXTRA, "%s: CS_EVENT_PM_RESUME\n", dev_info);

819
820
	if (iface && iface->local)
		dev_open = iface->local->num_dev_open > 0;
821

822
823
824
825
826
	prism2_hw_shutdown(dev, 1);
	prism2_hw_config(dev, dev_open ? 0 : 1);
	if (dev_open) {
		netif_device_attach(dev);
		netif_start_queue(dev);
827
	}
Jouni Malinen's avatar
Jouni Malinen committed
828

829
830
831
	return 0;
}

Henrik Brix Andersen's avatar
Henrik Brix Andersen committed
832
833
834
835
836
837
838
static struct pcmcia_device_id hostap_cs_ids[] = {
	PCMCIA_DEVICE_MANF_CARD(0x000b, 0x7100),
	PCMCIA_DEVICE_MANF_CARD(0x000b, 0x7300),
	PCMCIA_DEVICE_MANF_CARD(0x0101, 0x0777),
	PCMCIA_DEVICE_MANF_CARD(0x0126, 0x8000),
	PCMCIA_DEVICE_MANF_CARD(0x0138, 0x0002),
	PCMCIA_DEVICE_MANF_CARD(0x0250, 0x0002),
Richard Purdie's avatar
Richard Purdie committed
839
	PCMCIA_DEVICE_MANF_CARD(0x026f, 0x030b),
Henrik Brix Andersen's avatar
Henrik Brix Andersen committed
840
841
842
843
844
845
846
	PCMCIA_DEVICE_MANF_CARD(0x0274, 0x1612),
	PCMCIA_DEVICE_MANF_CARD(0x0274, 0x1613),
	PCMCIA_DEVICE_MANF_CARD(0x028a, 0x0002),
	PCMCIA_DEVICE_MANF_CARD(0x02aa, 0x0002),
	PCMCIA_DEVICE_MANF_CARD(0x02d2, 0x0001),
	PCMCIA_DEVICE_MANF_CARD(0x50c2, 0x0001),
	PCMCIA_DEVICE_MANF_CARD(0x50c2, 0x7300),
847
/*	PCMCIA_DEVICE_MANF_CARD(0xc00f, 0x0000),    conflict with pcnet_cs */
Henrik Brix Andersen's avatar
Henrik Brix Andersen committed
848
849
850
	PCMCIA_DEVICE_MANF_CARD(0xd601, 0x0002),
	PCMCIA_DEVICE_MANF_CARD(0xd601, 0x0005),
	PCMCIA_DEVICE_MANF_CARD(0xd601, 0x0010),
851
852
853
854
	PCMCIA_DEVICE_MANF_CARD_PROD_ID1(0x0156, 0x0002, "INTERSIL",
					 0x74c5e40d),
	PCMCIA_DEVICE_MANF_CARD_PROD_ID1(0x0156, 0x0002, "Intersil",
					 0x4b801a17),
Henrik Brix Andersen's avatar
Henrik Brix Andersen committed
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
	PCMCIA_MFC_DEVICE_PROD_ID12(0, "SanDisk", "ConnectPlus",
				    0x7a954bd9, 0x74be00c6),
	PCMCIA_DEVICE_PROD_ID1234(
		"Intersil", "PRISM 2_5 PCMCIA ADAPTER",	"ISL37300P",
		"Eval-RevA",
		0x4b801a17, 0x6345a0bf, 0xc9049a39, 0xc23adc0e),
	PCMCIA_DEVICE_PROD_ID123(
		"Addtron", "AWP-100 Wireless PCMCIA", "Version 01.02",
		0xe6ec52ce, 0x08649af2, 0x4b74baa0),
	PCMCIA_DEVICE_PROD_ID123(
		"D", "Link DWL-650 11Mbps WLAN Card", "Version 01.02",
		0x71b18589, 0xb6f1b0ab, 0x4b74baa0),
	PCMCIA_DEVICE_PROD_ID123(
		"Instant Wireless ", " Network PC CARD", "Version 01.02",
		0x11d901af, 0x6e9bd926, 0x4b74baa0),
	PCMCIA_DEVICE_PROD_ID123(
		"SMC", "SMC2632W", "Version 01.02",
		0xc4f8b18b, 0x474a1f2a, 0x4b74baa0),
Richard Purdie's avatar
Richard Purdie committed
873
	PCMCIA_DEVICE_PROD_ID12("BUFFALO", "WLI-CF-S11G", 
874
				0x2decece3, 0x82067c18),
Henrik Brix Andersen's avatar
Henrik Brix Andersen committed
875
876
877
878
879
880
881
882
883
	PCMCIA_DEVICE_PROD_ID12("Compaq", "WL200_11Mbps_Wireless_PCI_Card",
				0x54f7c49c, 0x15a75e5b),
	PCMCIA_DEVICE_PROD_ID12("INTERSIL", "HFA384x/IEEE",
				0x74c5e40d, 0xdb472a18),
	PCMCIA_DEVICE_PROD_ID12("Linksys", "Wireless CompactFlash Card",
				0x0733cc81, 0x0c52f395),
	PCMCIA_DEVICE_PROD_ID12(
		"ZoomAir 11Mbps High", "Rate wireless Networking",
		0x273fe3db, 0x32a1eaee),
884
885
886
887
888
889
	PCMCIA_DEVICE_PROD_ID123(
		"Pretec", "CompactWLAN Card 802.11b", "2.5",
		0x1cadd3e5, 0xe697636c, 0x7a5bfcf1),
	PCMCIA_DEVICE_PROD_ID123(
		"U.S. Robotics", "IEEE 802.11b PC-CARD", "Version 01.02",
		0xc7b8df9d, 0x1700d087, 0x4b74baa0),
Henrik Brix Andersen's avatar
Henrik Brix Andersen committed
890
891
892
893
894
	PCMCIA_DEVICE_NULL
};
MODULE_DEVICE_TABLE(pcmcia, hostap_cs_ids);


Jouni Malinen's avatar
Jouni Malinen committed
895
896
897
898
static struct pcmcia_driver hostap_driver = {
	.drv		= {
		.name	= "hostap_cs",
	},
899
	.probe		= hostap_cs_probe,
900
	.remove		= prism2_detach,
Jouni Malinen's avatar
Jouni Malinen committed
901
	.owner		= THIS_MODULE,
Henrik Brix Andersen's avatar
Henrik Brix Andersen committed
902
	.id_table	= hostap_cs_ids,
903
904
	.suspend	= hostap_cs_suspend,
	.resume		= hostap_cs_resume,
Jouni Malinen's avatar
Jouni Malinen committed
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
};

static int __init init_prism2_pccard(void)
{
	printk(KERN_INFO "%s: %s\n", dev_info, version);
	return pcmcia_register_driver(&hostap_driver);
}

static void __exit exit_prism2_pccard(void)
{
	pcmcia_unregister_driver(&hostap_driver);
	printk(KERN_INFO "%s: Driver unloaded\n", dev_info);
}


module_init(init_prism2_pccard);
module_exit(exit_prism2_pccard);