blob: 0a3bacc20d96482bc0f0a7c144f26014c77ec25a [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * Wavelan Pcmcia driver
3 *
4 * Jean II - HPLB '96
5 *
6 * Reorganisation and extension of the driver.
7 * Original copyright follow. See wavelan_cs.p.h for details.
8 *
9 * This code is derived from Anthony D. Joseph's code and all the changes here
10 * are also under the original copyright below.
11 *
12 * This code supports version 2.00 of WaveLAN/PCMCIA cards (2.4GHz), and
13 * can work on Linux 2.0.36 with support of David Hinds' PCMCIA Card Services
14 *
15 * Joe Finney (joe@comp.lancs.ac.uk) at Lancaster University in UK added
16 * critical code in the routine to initialize the Modem Management Controller.
17 *
18 * Thanks to Alan Cox and Bruce Janson for their advice.
19 *
20 * -- Yunzhou Li (scip4166@nus.sg)
21 *
22#ifdef WAVELAN_ROAMING
23 * Roaming support added 07/22/98 by Justin Seger (jseger@media.mit.edu)
24 * based on patch by Joe Finney from Lancaster University.
25#endif
26 *
27 * Lucent (formerly AT&T GIS, formerly NCR) WaveLAN PCMCIA card: An
28 * Ethernet-like radio transceiver controlled by an Intel 82593 coprocessor.
29 *
30 * A non-shared memory PCMCIA ethernet driver for linux
31 *
32 * ISA version modified to support PCMCIA by Anthony Joseph (adj@lcs.mit.edu)
33 *
34 *
35 * Joseph O'Sullivan & John Langford (josullvn@cs.cmu.edu & jcl@cs.cmu.edu)
36 *
37 * Apr 2 '98 made changes to bring the i82593 control/int handling in line
38 * with offical specs...
39 *
40 ****************************************************************************
41 * Copyright 1995
42 * Anthony D. Joseph
43 * Massachusetts Institute of Technology
44 *
45 * Permission to use, copy, modify, and distribute this program
46 * for any purpose and without fee is hereby granted, provided
47 * that this copyright and permission notice appear on all copies
48 * and supporting documentation, the name of M.I.T. not be used
49 * in advertising or publicity pertaining to distribution of the
50 * program without specific prior permission, and notice be given
51 * in supporting documentation that copying and distribution is
52 * by permission of M.I.T. M.I.T. makes no representations about
53 * the suitability of this software for any purpose. It is pro-
54 * vided "as is" without express or implied warranty.
55 ****************************************************************************
56 *
57 */
58
59/* Do *NOT* add other headers here, you are guaranteed to be wrong - Jean II */
60#include "wavelan_cs.p.h" /* Private header */
61
Jouni Malinenff1d2762005-05-12 22:54:16 -040062#ifdef WAVELAN_ROAMING
63static void wl_cell_expiry(unsigned long data);
64static void wl_del_wavepoint(wavepoint_history *wavepoint, struct net_local *lp);
65static void wv_nwid_filter(unsigned char mode, net_local *lp);
66#endif /* WAVELAN_ROAMING */
67
Linus Torvalds1da177e2005-04-16 15:20:36 -070068/************************* MISC SUBROUTINES **************************/
69/*
70 * Subroutines which won't fit in one of the following category
71 * (wavelan modem or i82593)
72 */
73
Linus Torvalds1da177e2005-04-16 15:20:36 -070074/******************* MODEM MANAGEMENT SUBROUTINES *******************/
75/*
76 * Useful subroutines to manage the modem of the wavelan
77 */
78
79/*------------------------------------------------------------------*/
80/*
81 * Read from card's Host Adaptor Status Register.
82 */
83static inline u_char
84hasr_read(u_long base)
85{
86 return(inb(HASR(base)));
87} /* hasr_read */
88
89/*------------------------------------------------------------------*/
90/*
91 * Write to card's Host Adapter Command Register.
92 */
93static inline void
94hacr_write(u_long base,
95 u_char hacr)
96{
97 outb(hacr, HACR(base));
98} /* hacr_write */
99
100/*------------------------------------------------------------------*/
101/*
102 * Write to card's Host Adapter Command Register. Include a delay for
103 * those times when it is needed.
104 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200105static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106hacr_write_slow(u_long base,
107 u_char hacr)
108{
109 hacr_write(base, hacr);
110 /* delay might only be needed sometimes */
111 mdelay(1);
112} /* hacr_write_slow */
113
114/*------------------------------------------------------------------*/
115/*
116 * Read the Parameter Storage Area from the WaveLAN card's memory
117 */
118static void
119psa_read(struct net_device * dev,
120 int o, /* offset in PSA */
121 u_char * b, /* buffer to fill */
122 int n) /* size to read */
123{
124 net_local *lp = netdev_priv(dev);
125 u_char __iomem *ptr = lp->mem + PSA_ADDR + (o << 1);
126
127 while(n-- > 0)
128 {
129 *b++ = readb(ptr);
130 /* Due to a lack of address decode pins, the WaveLAN PCMCIA card
131 * only supports reading even memory addresses. That means the
132 * increment here MUST be two.
133 * Because of that, we can't use memcpy_fromio()...
134 */
135 ptr += 2;
136 }
137} /* psa_read */
138
139/*------------------------------------------------------------------*/
140/*
141 * Write the Paramter Storage Area to the WaveLAN card's memory
142 */
143static void
144psa_write(struct net_device * dev,
145 int o, /* Offset in psa */
146 u_char * b, /* Buffer in memory */
147 int n) /* Length of buffer */
148{
149 net_local *lp = netdev_priv(dev);
150 u_char __iomem *ptr = lp->mem + PSA_ADDR + (o << 1);
151 int count = 0;
Olof Johansson906da802008-02-04 22:27:35 -0800152 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153 /* As there seem to have no flag PSA_BUSY as in the ISA model, we are
154 * oblige to verify this address to know when the PSA is ready... */
155 volatile u_char __iomem *verify = lp->mem + PSA_ADDR +
156 (psaoff(0, psa_comp_number) << 1);
157
Robert P. J. Daybeb7dd82007-05-09 07:14:03 +0200158 /* Authorize writing to PSA */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 hacr_write(base, HACR_PWR_STAT | HACR_ROM_WEN);
160
161 while(n-- > 0)
162 {
163 /* write to PSA */
164 writeb(*b++, ptr);
165 ptr += 2;
166
167 /* I don't have the spec, so I don't know what the correct
168 * sequence to write is. This hack seem to work for me... */
169 count = 0;
170 while((readb(verify) != PSA_COMP_PCMCIA_915) && (count++ < 100))
171 mdelay(1);
172 }
173
174 /* Put the host interface back in standard state */
175 hacr_write(base, HACR_DEFAULT);
176} /* psa_write */
177
178#ifdef SET_PSA_CRC
179/*------------------------------------------------------------------*/
180/*
181 * Calculate the PSA CRC
182 * Thanks to Valster, Nico <NVALSTER@wcnd.nl.lucent.com> for the code
183 * NOTE: By specifying a length including the CRC position the
184 * returned value should be zero. (i.e. a correct checksum in the PSA)
185 *
186 * The Windows drivers don't use the CRC, but the AP and the PtP tool
187 * depend on it.
188 */
189static u_short
190psa_crc(unsigned char * psa, /* The PSA */
191 int size) /* Number of short for CRC */
192{
193 int byte_cnt; /* Loop on the PSA */
194 u_short crc_bytes = 0; /* Data in the PSA */
195 int bit_cnt; /* Loop on the bits of the short */
196
197 for(byte_cnt = 0; byte_cnt < size; byte_cnt++ )
198 {
199 crc_bytes ^= psa[byte_cnt]; /* Its an xor */
200
201 for(bit_cnt = 1; bit_cnt < 9; bit_cnt++ )
202 {
203 if(crc_bytes & 0x0001)
204 crc_bytes = (crc_bytes >> 1) ^ 0xA001;
205 else
206 crc_bytes >>= 1 ;
207 }
208 }
209
210 return crc_bytes;
211} /* psa_crc */
212#endif /* SET_PSA_CRC */
213
214/*------------------------------------------------------------------*/
215/*
216 * update the checksum field in the Wavelan's PSA
217 */
218static void
219update_psa_checksum(struct net_device * dev)
220{
221#ifdef SET_PSA_CRC
222 psa_t psa;
223 u_short crc;
224
225 /* read the parameter storage area */
226 psa_read(dev, 0, (unsigned char *) &psa, sizeof(psa));
227
228 /* update the checksum */
229 crc = psa_crc((unsigned char *) &psa,
230 sizeof(psa) - sizeof(psa.psa_crc[0]) - sizeof(psa.psa_crc[1])
231 - sizeof(psa.psa_crc_status));
232
233 psa.psa_crc[0] = crc & 0xFF;
234 psa.psa_crc[1] = (crc & 0xFF00) >> 8;
235
236 /* Write it ! */
237 psa_write(dev, (char *)&psa.psa_crc - (char *)&psa,
238 (unsigned char *)&psa.psa_crc, 2);
239
240#ifdef DEBUG_IOCTL_INFO
241 printk (KERN_DEBUG "%s: update_psa_checksum(): crc = 0x%02x%02x\n",
242 dev->name, psa.psa_crc[0], psa.psa_crc[1]);
243
244 /* Check again (luxury !) */
245 crc = psa_crc((unsigned char *) &psa,
246 sizeof(psa) - sizeof(psa.psa_crc_status));
247
248 if(crc != 0)
249 printk(KERN_WARNING "%s: update_psa_checksum(): CRC does not agree with PSA data (even after recalculating)\n", dev->name);
250#endif /* DEBUG_IOCTL_INFO */
251#endif /* SET_PSA_CRC */
252} /* update_psa_checksum */
253
254/*------------------------------------------------------------------*/
255/*
256 * Write 1 byte to the MMC.
257 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200258static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259mmc_out(u_long base,
260 u_short o,
261 u_char d)
262{
263 int count = 0;
264
265 /* Wait for MMC to go idle */
266 while((count++ < 100) && (inb(HASR(base)) & HASR_MMI_BUSY))
267 udelay(10);
268
269 outb((u_char)((o << 1) | MMR_MMI_WR), MMR(base));
270 outb(d, MMD(base));
271}
272
273/*------------------------------------------------------------------*/
274/*
275 * Routine to write bytes to the Modem Management Controller.
276 * We start by the end because it is the way it should be !
277 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200278static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279mmc_write(u_long base,
280 u_char o,
281 u_char * b,
282 int n)
283{
284 o += n;
285 b += n;
286
287 while(n-- > 0 )
288 mmc_out(base, --o, *(--b));
289} /* mmc_write */
290
291/*------------------------------------------------------------------*/
292/*
293 * Read 1 byte from the MMC.
294 * Optimised version for 1 byte, avoid using memory...
295 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200296static u_char
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297mmc_in(u_long base,
298 u_short o)
299{
300 int count = 0;
301
302 while((count++ < 100) && (inb(HASR(base)) & HASR_MMI_BUSY))
303 udelay(10);
304 outb(o << 1, MMR(base)); /* Set the read address */
305
306 outb(0, MMD(base)); /* Required dummy write */
307
308 while((count++ < 100) && (inb(HASR(base)) & HASR_MMI_BUSY))
309 udelay(10);
310 return (u_char) (inb(MMD(base))); /* Now do the actual read */
311}
312
313/*------------------------------------------------------------------*/
314/*
315 * Routine to read bytes from the Modem Management Controller.
316 * The implementation is complicated by a lack of address lines,
317 * which prevents decoding of the low-order bit.
318 * (code has just been moved in the above function)
319 * We start by the end because it is the way it should be !
320 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200321static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322mmc_read(u_long base,
323 u_char o,
324 u_char * b,
325 int n)
326{
327 o += n;
328 b += n;
329
330 while(n-- > 0)
331 *(--b) = mmc_in(base, --o);
332} /* mmc_read */
333
334/*------------------------------------------------------------------*/
335/*
336 * Get the type of encryption available...
337 */
338static inline int
339mmc_encr(u_long base) /* i/o port of the card */
340{
341 int temp;
342
343 temp = mmc_in(base, mmroff(0, mmr_des_avail));
344 if((temp != MMR_DES_AVAIL_DES) && (temp != MMR_DES_AVAIL_AES))
345 return 0;
346 else
347 return temp;
348}
349
350/*------------------------------------------------------------------*/
351/*
352 * Wait for the frequency EEprom to complete a command...
Linus Torvalds1da177e2005-04-16 15:20:36 -0700353 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200354static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355fee_wait(u_long base, /* i/o port of the card */
356 int delay, /* Base delay to wait for */
357 int number) /* Number of time to wait */
358{
359 int count = 0; /* Wait only a limited time */
360
361 while((count++ < number) &&
362 (mmc_in(base, mmroff(0, mmr_fee_status)) & MMR_FEE_STATUS_BUSY))
363 udelay(delay);
364}
365
366/*------------------------------------------------------------------*/
367/*
368 * Read bytes from the Frequency EEprom (frequency select cards).
369 */
370static void
371fee_read(u_long base, /* i/o port of the card */
372 u_short o, /* destination offset */
373 u_short * b, /* data buffer */
374 int n) /* number of registers */
375{
376 b += n; /* Position at the end of the area */
377
378 /* Write the address */
379 mmc_out(base, mmwoff(0, mmw_fee_addr), o + n - 1);
380
381 /* Loop on all buffer */
382 while(n-- > 0)
383 {
384 /* Write the read command */
385 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_READ);
386
387 /* Wait until EEprom is ready (should be quick !) */
388 fee_wait(base, 10, 100);
389
390 /* Read the value */
391 *--b = ((mmc_in(base, mmroff(0, mmr_fee_data_h)) << 8) |
392 mmc_in(base, mmroff(0, mmr_fee_data_l)));
393 }
394}
395
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
397/*------------------------------------------------------------------*/
398/*
399 * Write bytes from the Frequency EEprom (frequency select cards).
400 * This is a bit complicated, because the frequency eeprom has to
401 * be unprotected and the write enabled.
402 * Jean II
403 */
404static void
405fee_write(u_long base, /* i/o port of the card */
406 u_short o, /* destination offset */
407 u_short * b, /* data buffer */
408 int n) /* number of registers */
409{
410 b += n; /* Position at the end of the area */
411
412#ifdef EEPROM_IS_PROTECTED /* disabled */
413#ifdef DOESNT_SEEM_TO_WORK /* disabled */
414 /* Ask to read the protected register */
415 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_PRREAD);
416
417 fee_wait(base, 10, 100);
418
419 /* Read the protected register */
420 printk("Protected 2 : %02X-%02X\n",
421 mmc_in(base, mmroff(0, mmr_fee_data_h)),
422 mmc_in(base, mmroff(0, mmr_fee_data_l)));
423#endif /* DOESNT_SEEM_TO_WORK */
424
425 /* Enable protected register */
426 mmc_out(base, mmwoff(0, mmw_fee_addr), MMW_FEE_ADDR_EN);
427 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_PREN);
428
429 fee_wait(base, 10, 100);
430
431 /* Unprotect area */
432 mmc_out(base, mmwoff(0, mmw_fee_addr), o + n);
433 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_PRWRITE);
434#ifdef DOESNT_SEEM_TO_WORK /* disabled */
435 /* Or use : */
436 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_PRCLEAR);
437#endif /* DOESNT_SEEM_TO_WORK */
438
439 fee_wait(base, 10, 100);
440#endif /* EEPROM_IS_PROTECTED */
441
442 /* Write enable */
443 mmc_out(base, mmwoff(0, mmw_fee_addr), MMW_FEE_ADDR_EN);
444 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_WREN);
445
446 fee_wait(base, 10, 100);
447
448 /* Write the EEprom address */
449 mmc_out(base, mmwoff(0, mmw_fee_addr), o + n - 1);
450
451 /* Loop on all buffer */
452 while(n-- > 0)
453 {
454 /* Write the value */
455 mmc_out(base, mmwoff(0, mmw_fee_data_h), (*--b) >> 8);
456 mmc_out(base, mmwoff(0, mmw_fee_data_l), *b & 0xFF);
457
458 /* Write the write command */
459 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_WRITE);
460
461 /* Wavelan doc says : wait at least 10 ms for EEBUSY = 0 */
462 mdelay(10);
463 fee_wait(base, 10, 100);
464 }
465
466 /* Write disable */
467 mmc_out(base, mmwoff(0, mmw_fee_addr), MMW_FEE_ADDR_DS);
468 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_WDS);
469
470 fee_wait(base, 10, 100);
471
472#ifdef EEPROM_IS_PROTECTED /* disabled */
473 /* Reprotect EEprom */
474 mmc_out(base, mmwoff(0, mmw_fee_addr), 0x00);
475 mmc_out(base, mmwoff(0, mmw_fee_ctrl), MMW_FEE_CTRL_PRWRITE);
476
477 fee_wait(base, 10, 100);
478#endif /* EEPROM_IS_PROTECTED */
479}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480
481/******************* WaveLAN Roaming routines... ********************/
482
483#ifdef WAVELAN_ROAMING /* Conditional compile, see wavelan_cs.h */
484
Jouni Malinenff1d2762005-05-12 22:54:16 -0400485static unsigned char WAVELAN_BEACON_ADDRESS[] = {0x09,0x00,0x0e,0x20,0x03,0x00};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486
Jouni Malinenff1d2762005-05-12 22:54:16 -0400487static void wv_roam_init(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488{
489 net_local *lp= netdev_priv(dev);
490
491 /* Do not remove this unless you have a good reason */
492 printk(KERN_NOTICE "%s: Warning, you have enabled roaming on"
493 " device %s !\n", dev->name, dev->name);
494 printk(KERN_NOTICE "Roaming is currently an experimental unsupported feature"
495 " of the Wavelan driver.\n");
496 printk(KERN_NOTICE "It may work, but may also make the driver behave in"
497 " erratic ways or crash.\n");
498
499 lp->wavepoint_table.head=NULL; /* Initialise WavePoint table */
500 lp->wavepoint_table.num_wavepoints=0;
501 lp->wavepoint_table.locked=0;
502 lp->curr_point=NULL; /* No default WavePoint */
503 lp->cell_search=0;
504
505 lp->cell_timer.data=(long)lp; /* Start cell expiry timer */
506 lp->cell_timer.function=wl_cell_expiry;
507 lp->cell_timer.expires=jiffies+CELL_TIMEOUT;
508 add_timer(&lp->cell_timer);
509
510 wv_nwid_filter(NWID_PROMISC,lp) ; /* Enter NWID promiscuous mode */
511 /* to build up a good WavePoint */
512 /* table... */
513 printk(KERN_DEBUG "WaveLAN: Roaming enabled on device %s\n",dev->name);
514}
515
Jouni Malinenff1d2762005-05-12 22:54:16 -0400516static void wv_roam_cleanup(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517{
518 wavepoint_history *ptr,*old_ptr;
519 net_local *lp= netdev_priv(dev);
520
521 printk(KERN_DEBUG "WaveLAN: Roaming Disabled on device %s\n",dev->name);
522
523 /* Fixme : maybe we should check that the timer exist before deleting it */
524 del_timer(&lp->cell_timer); /* Remove cell expiry timer */
525 ptr=lp->wavepoint_table.head; /* Clear device's WavePoint table */
526 while(ptr!=NULL)
527 {
528 old_ptr=ptr;
529 ptr=ptr->next;
530 wl_del_wavepoint(old_ptr,lp);
531 }
532}
533
534/* Enable/Disable NWID promiscuous mode on a given device */
Jouni Malinenff1d2762005-05-12 22:54:16 -0400535static void wv_nwid_filter(unsigned char mode, net_local *lp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536{
537 mm_t m;
538 unsigned long flags;
539
540#ifdef WAVELAN_ROAMING_DEBUG
541 printk(KERN_DEBUG "WaveLAN: NWID promisc %s, device %s\n",(mode==NWID_PROMISC) ? "on" : "off", lp->dev->name);
542#endif
543
544 /* Disable interrupts & save flags */
545 spin_lock_irqsave(&lp->spinlock, flags);
546
547 m.w.mmw_loopt_sel = (mode==NWID_PROMISC) ? MMW_LOOPT_SEL_DIS_NWID : 0x00;
548 mmc_write(lp->dev->base_addr, (char *)&m.w.mmw_loopt_sel - (char *)&m, (unsigned char *)&m.w.mmw_loopt_sel, 1);
549
550 if(mode==NWID_PROMISC)
551 lp->cell_search=1;
552 else
553 lp->cell_search=0;
554
555 /* ReEnable interrupts & restore flags */
556 spin_unlock_irqrestore(&lp->spinlock, flags);
557}
558
559/* Find a record in the WavePoint table matching a given NWID */
Jouni Malinenff1d2762005-05-12 22:54:16 -0400560static wavepoint_history *wl_roam_check(unsigned short nwid, net_local *lp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561{
562 wavepoint_history *ptr=lp->wavepoint_table.head;
563
564 while(ptr!=NULL){
565 if(ptr->nwid==nwid)
566 return ptr;
567 ptr=ptr->next;
568 }
569 return NULL;
570}
571
572/* Create a new wavepoint table entry */
Jouni Malinenff1d2762005-05-12 22:54:16 -0400573static wavepoint_history *wl_new_wavepoint(unsigned short nwid, unsigned char seq, net_local* lp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700574{
575 wavepoint_history *new_wavepoint;
576
577#ifdef WAVELAN_ROAMING_DEBUG
578 printk(KERN_DEBUG "WaveLAN: New Wavepoint, NWID:%.4X\n",nwid);
579#endif
580
581 if(lp->wavepoint_table.num_wavepoints==MAX_WAVEPOINTS)
582 return NULL;
583
Robert P. J. Day5cbded52006-12-13 00:35:56 -0800584 new_wavepoint = kmalloc(sizeof(wavepoint_history),GFP_ATOMIC);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 if(new_wavepoint==NULL)
586 return NULL;
587
588 new_wavepoint->nwid=nwid; /* New WavePoints NWID */
589 new_wavepoint->average_fast=0; /* Running Averages..*/
590 new_wavepoint->average_slow=0;
591 new_wavepoint->qualptr=0; /* Start of ringbuffer */
592 new_wavepoint->last_seq=seq-1; /* Last sequence no.seen */
593 memset(new_wavepoint->sigqual,0,WAVEPOINT_HISTORY);/* Empty ringbuffer */
594
595 new_wavepoint->next=lp->wavepoint_table.head;/* Add to wavepoint table */
596 new_wavepoint->prev=NULL;
597
598 if(lp->wavepoint_table.head!=NULL)
599 lp->wavepoint_table.head->prev=new_wavepoint;
600
601 lp->wavepoint_table.head=new_wavepoint;
602
603 lp->wavepoint_table.num_wavepoints++; /* no. of visible wavepoints */
604
605 return new_wavepoint;
606}
607
608/* Remove a wavepoint entry from WavePoint table */
Jouni Malinenff1d2762005-05-12 22:54:16 -0400609static void wl_del_wavepoint(wavepoint_history *wavepoint, struct net_local *lp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610{
611 if(wavepoint==NULL)
612 return;
613
614 if(lp->curr_point==wavepoint)
615 lp->curr_point=NULL;
616
617 if(wavepoint->prev!=NULL)
618 wavepoint->prev->next=wavepoint->next;
619
620 if(wavepoint->next!=NULL)
621 wavepoint->next->prev=wavepoint->prev;
622
623 if(lp->wavepoint_table.head==wavepoint)
624 lp->wavepoint_table.head=wavepoint->next;
625
626 lp->wavepoint_table.num_wavepoints--;
627 kfree(wavepoint);
628}
629
630/* Timer callback function - checks WavePoint table for stale entries */
Jouni Malinenff1d2762005-05-12 22:54:16 -0400631static void wl_cell_expiry(unsigned long data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632{
633 net_local *lp=(net_local *)data;
634 wavepoint_history *wavepoint=lp->wavepoint_table.head,*old_point;
635
636#if WAVELAN_ROAMING_DEBUG > 1
637 printk(KERN_DEBUG "WaveLAN: Wavepoint timeout, dev %s\n",lp->dev->name);
638#endif
639
640 if(lp->wavepoint_table.locked)
641 {
642#if WAVELAN_ROAMING_DEBUG > 1
643 printk(KERN_DEBUG "WaveLAN: Wavepoint table locked...\n");
644#endif
645
646 lp->cell_timer.expires=jiffies+1; /* If table in use, come back later */
647 add_timer(&lp->cell_timer);
648 return;
649 }
650
651 while(wavepoint!=NULL)
652 {
653 if(time_after(jiffies, wavepoint->last_seen + CELL_TIMEOUT))
654 {
655#ifdef WAVELAN_ROAMING_DEBUG
656 printk(KERN_DEBUG "WaveLAN: Bye bye %.4X\n",wavepoint->nwid);
657#endif
658
659 old_point=wavepoint;
660 wavepoint=wavepoint->next;
661 wl_del_wavepoint(old_point,lp);
662 }
663 else
664 wavepoint=wavepoint->next;
665 }
666 lp->cell_timer.expires=jiffies+CELL_TIMEOUT;
667 add_timer(&lp->cell_timer);
668}
669
670/* Update SNR history of a wavepoint */
Jouni Malinenff1d2762005-05-12 22:54:16 -0400671static void wl_update_history(wavepoint_history *wavepoint, unsigned char sigqual, unsigned char seq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700672{
673 int i=0,num_missed=0,ptr=0;
674 int average_fast=0,average_slow=0;
675
676 num_missed=(seq-wavepoint->last_seq)%WAVEPOINT_HISTORY;/* Have we missed
677 any beacons? */
678 if(num_missed)
679 for(i=0;i<num_missed;i++)
680 {
681 wavepoint->sigqual[wavepoint->qualptr++]=0; /* If so, enter them as 0's */
682 wavepoint->qualptr %=WAVEPOINT_HISTORY; /* in the ringbuffer. */
683 }
684 wavepoint->last_seen=jiffies; /* Add beacon to history */
685 wavepoint->last_seq=seq;
686 wavepoint->sigqual[wavepoint->qualptr++]=sigqual;
687 wavepoint->qualptr %=WAVEPOINT_HISTORY;
688 ptr=(wavepoint->qualptr-WAVEPOINT_FAST_HISTORY+WAVEPOINT_HISTORY)%WAVEPOINT_HISTORY;
689
690 for(i=0;i<WAVEPOINT_FAST_HISTORY;i++) /* Update running averages */
691 {
692 average_fast+=wavepoint->sigqual[ptr++];
693 ptr %=WAVEPOINT_HISTORY;
694 }
695
696 average_slow=average_fast;
697 for(i=WAVEPOINT_FAST_HISTORY;i<WAVEPOINT_HISTORY;i++)
698 {
699 average_slow+=wavepoint->sigqual[ptr++];
700 ptr %=WAVEPOINT_HISTORY;
701 }
702
703 wavepoint->average_fast=average_fast/WAVEPOINT_FAST_HISTORY;
704 wavepoint->average_slow=average_slow/WAVEPOINT_HISTORY;
705}
706
707/* Perform a handover to a new WavePoint */
Jouni Malinenff1d2762005-05-12 22:54:16 -0400708static void wv_roam_handover(wavepoint_history *wavepoint, net_local *lp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700709{
Olof Johansson906da802008-02-04 22:27:35 -0800710 unsigned int base = lp->dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711 mm_t m;
712 unsigned long flags;
713
714 if(wavepoint==lp->curr_point) /* Sanity check... */
715 {
716 wv_nwid_filter(!NWID_PROMISC,lp);
717 return;
718 }
719
720#ifdef WAVELAN_ROAMING_DEBUG
721 printk(KERN_DEBUG "WaveLAN: Doing handover to %.4X, dev %s\n",wavepoint->nwid,lp->dev->name);
722#endif
723
724 /* Disable interrupts & save flags */
725 spin_lock_irqsave(&lp->spinlock, flags);
726
727 m.w.mmw_netw_id_l = wavepoint->nwid & 0xFF;
728 m.w.mmw_netw_id_h = (wavepoint->nwid & 0xFF00) >> 8;
729
730 mmc_write(base, (char *)&m.w.mmw_netw_id_l - (char *)&m, (unsigned char *)&m.w.mmw_netw_id_l, 2);
731
732 /* ReEnable interrupts & restore flags */
733 spin_unlock_irqrestore(&lp->spinlock, flags);
734
735 wv_nwid_filter(!NWID_PROMISC,lp);
736 lp->curr_point=wavepoint;
737}
738
739/* Called when a WavePoint beacon is received */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200740static void wl_roam_gather(struct net_device * dev,
741 u_char * hdr, /* Beacon header */
742 u_char * stats) /* SNR, Signal quality
Linus Torvalds1da177e2005-04-16 15:20:36 -0700743 of packet */
744{
745 wavepoint_beacon *beacon= (wavepoint_beacon *)hdr; /* Rcvd. Beacon */
746 unsigned short nwid=ntohs(beacon->nwid);
747 unsigned short sigqual=stats[2] & MMR_SGNL_QUAL; /* SNR of beacon */
748 wavepoint_history *wavepoint=NULL; /* WavePoint table entry */
749 net_local *lp = netdev_priv(dev); /* Device info */
750
751#ifdef I_NEED_THIS_FEATURE
752 /* Some people don't need this, some other may need it */
753 nwid=nwid^ntohs(beacon->domain_id);
754#endif
755
756#if WAVELAN_ROAMING_DEBUG > 1
757 printk(KERN_DEBUG "WaveLAN: beacon, dev %s:\n",dev->name);
758 printk(KERN_DEBUG "Domain: %.4X NWID: %.4X SigQual=%d\n",ntohs(beacon->domain_id),nwid,sigqual);
759#endif
760
761 lp->wavepoint_table.locked=1; /* <Mutex> */
762
763 wavepoint=wl_roam_check(nwid,lp); /* Find WavePoint table entry */
764 if(wavepoint==NULL) /* If no entry, Create a new one... */
765 {
766 wavepoint=wl_new_wavepoint(nwid,beacon->seq,lp);
767 if(wavepoint==NULL)
768 goto out;
769 }
770 if(lp->curr_point==NULL) /* If this is the only WavePoint, */
771 wv_roam_handover(wavepoint, lp); /* Jump on it! */
772
773 wl_update_history(wavepoint, sigqual, beacon->seq); /* Update SNR history
774 stats. */
775
776 if(lp->curr_point->average_slow < SEARCH_THRESH_LOW) /* If our current */
777 if(!lp->cell_search) /* WavePoint is getting faint, */
778 wv_nwid_filter(NWID_PROMISC,lp); /* start looking for a new one */
779
780 if(wavepoint->average_slow >
781 lp->curr_point->average_slow + WAVELAN_ROAMING_DELTA)
782 wv_roam_handover(wavepoint, lp); /* Handover to a better WavePoint */
783
784 if(lp->curr_point->average_slow > SEARCH_THRESH_HIGH) /* If our SNR is */
785 if(lp->cell_search) /* getting better, drop out of cell search mode */
786 wv_nwid_filter(!NWID_PROMISC,lp);
787
788out:
789 lp->wavepoint_table.locked=0; /* </MUTEX> :-) */
790}
791
792/* Test this MAC frame a WavePoint beacon */
793static inline int WAVELAN_BEACON(unsigned char *data)
794{
795 wavepoint_beacon *beacon= (wavepoint_beacon *)data;
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200796 static const wavepoint_beacon beacon_template={0xaa,0xaa,0x03,0x08,0x00,0x0e,0x20,0x03,0x00};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700797
798 if(memcmp(beacon,&beacon_template,9)==0)
799 return 1;
800 else
801 return 0;
802}
803#endif /* WAVELAN_ROAMING */
804
805/************************ I82593 SUBROUTINES *************************/
806/*
807 * Useful subroutines to manage the Ethernet controller
808 */
809
810/*------------------------------------------------------------------*/
811/*
812 * Routine to synchronously send a command to the i82593 chip.
813 * Should be called with interrupts disabled.
814 * (called by wv_packet_write(), wv_ru_stop(), wv_ru_start(),
815 * wv_82593_config() & wv_diag())
816 */
817static int
818wv_82593_cmd(struct net_device * dev,
819 char * str,
820 int cmd,
821 int result)
822{
Olof Johansson906da802008-02-04 22:27:35 -0800823 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824 int status;
825 int wait_completed;
826 long spin;
827
828 /* Spin until the chip finishes executing its current command (if any) */
829 spin = 1000;
830 do
831 {
832 /* Time calibration of the loop */
833 udelay(10);
834
835 /* Read the interrupt register */
836 outb(OP0_NOP | CR0_STATUS_3, LCCR(base));
837 status = inb(LCSR(base));
838 }
839 while(((status & SR3_EXEC_STATE_MASK) != SR3_EXEC_IDLE) && (spin-- > 0));
840
841 /* If the interrupt hasn't be posted */
842 if(spin <= 0)
843 {
844#ifdef DEBUG_INTERRUPT_ERROR
845 printk(KERN_INFO "wv_82593_cmd: %s timeout (previous command), status 0x%02x\n",
846 str, status);
847#endif
848 return(FALSE);
849 }
850
851 /* Issue the command to the controller */
852 outb(cmd, LCCR(base));
853
854 /* If we don't have to check the result of the command
855 * Note : this mean that the irq handler will deal with that */
856 if(result == SR0_NO_RESULT)
857 return(TRUE);
858
859 /* We are waiting for command completion */
860 wait_completed = TRUE;
861
862 /* Busy wait while the LAN controller executes the command. */
863 spin = 1000;
864 do
865 {
866 /* Time calibration of the loop */
867 udelay(10);
868
869 /* Read the interrupt register */
870 outb(CR0_STATUS_0 | OP0_NOP, LCCR(base));
871 status = inb(LCSR(base));
872
873 /* Check if there was an interrupt posted */
874 if((status & SR0_INTERRUPT))
875 {
876 /* Acknowledge the interrupt */
877 outb(CR0_INT_ACK | OP0_NOP, LCCR(base));
878
879 /* Check if interrupt is a command completion */
880 if(((status & SR0_BOTH_RX_TX) != SR0_BOTH_RX_TX) &&
881 ((status & SR0_BOTH_RX_TX) != 0x0) &&
882 !(status & SR0_RECEPTION))
883 {
884 /* Signal command completion */
885 wait_completed = FALSE;
886 }
887 else
888 {
889 /* Note : Rx interrupts will be handled later, because we can
890 * handle multiple Rx packets at once */
891#ifdef DEBUG_INTERRUPT_INFO
892 printk(KERN_INFO "wv_82593_cmd: not our interrupt\n");
893#endif
894 }
895 }
896 }
897 while(wait_completed && (spin-- > 0));
898
899 /* If the interrupt hasn't be posted */
900 if(wait_completed)
901 {
902#ifdef DEBUG_INTERRUPT_ERROR
903 printk(KERN_INFO "wv_82593_cmd: %s timeout, status 0x%02x\n",
904 str, status);
905#endif
906 return(FALSE);
907 }
908
909 /* Check the return code returned by the card (see above) against
910 * the expected return code provided by the caller */
911 if((status & SR0_EVENT_MASK) != result)
912 {
913#ifdef DEBUG_INTERRUPT_ERROR
914 printk(KERN_INFO "wv_82593_cmd: %s failed, status = 0x%x\n",
915 str, status);
916#endif
917 return(FALSE);
918 }
919
920 return(TRUE);
921} /* wv_82593_cmd */
922
923/*------------------------------------------------------------------*/
924/*
925 * This routine does a 593 op-code number 7, and obtains the diagnose
926 * status for the WaveLAN.
927 */
928static inline int
929wv_diag(struct net_device * dev)
930{
Jean Tourrilhesaca0b512006-02-16 17:44:54 -0800931 return(wv_82593_cmd(dev, "wv_diag(): diagnose",
932 OP0_DIAGNOSE, SR0_DIAGNOSE_PASSED));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700933} /* wv_diag */
934
935/*------------------------------------------------------------------*/
936/*
937 * Routine to read len bytes from the i82593's ring buffer, starting at
938 * chip address addr. The results read from the chip are stored in buf.
939 * The return value is the address to use for next the call.
940 */
941static int
942read_ringbuf(struct net_device * dev,
943 int addr,
944 char * buf,
945 int len)
946{
Olof Johansson906da802008-02-04 22:27:35 -0800947 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700948 int ring_ptr = addr;
949 int chunk_len;
950 char * buf_ptr = buf;
951
952 /* Get all the buffer */
953 while(len > 0)
954 {
955 /* Position the Program I/O Register at the ring buffer pointer */
956 outb(ring_ptr & 0xff, PIORL(base));
957 outb(((ring_ptr >> 8) & PIORH_MASK), PIORH(base));
958
959 /* First, determine how much we can read without wrapping around the
960 ring buffer */
961 if((addr + len) < (RX_BASE + RX_SIZE))
962 chunk_len = len;
963 else
964 chunk_len = RX_BASE + RX_SIZE - addr;
965 insb(PIOP(base), buf_ptr, chunk_len);
966 buf_ptr += chunk_len;
967 len -= chunk_len;
968 ring_ptr = (ring_ptr - RX_BASE + chunk_len) % RX_SIZE + RX_BASE;
969 }
970 return(ring_ptr);
971} /* read_ringbuf */
972
973/*------------------------------------------------------------------*/
974/*
975 * Reconfigure the i82593, or at least ask for it...
976 * Because wv_82593_config use the transmission buffer, we must do it
977 * when we are sure that there is no transmission, so we do it now
978 * or in wavelan_packet_xmit() (I can't find any better place,
979 * wavelan_interrupt is not an option...), so you may experience
980 * some delay sometime...
981 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +0200982static void
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983wv_82593_reconfig(struct net_device * dev)
984{
985 net_local * lp = netdev_priv(dev);
Dominik Brodowskifba395e2006-03-31 17:21:06 +0200986 struct pcmcia_device * link = lp->link;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700987 unsigned long flags;
988
989 /* Arm the flag, will be cleard in wv_82593_config() */
990 lp->reconfig_82593 = TRUE;
991
992 /* Check if we can do it now ! */
993 if((link->open) && (netif_running(dev)) && !(netif_queue_stopped(dev)))
994 {
995 spin_lock_irqsave(&lp->spinlock, flags); /* Disable interrupts */
996 wv_82593_config(dev);
997 spin_unlock_irqrestore(&lp->spinlock, flags); /* Re-enable interrupts */
998 }
999 else
1000 {
1001#ifdef DEBUG_IOCTL_INFO
1002 printk(KERN_DEBUG
1003 "%s: wv_82593_reconfig(): delayed (state = %lX, link = %d)\n",
1004 dev->name, dev->state, link->open);
1005#endif
1006 }
1007}
1008
1009/********************* DEBUG & INFO SUBROUTINES *********************/
1010/*
1011 * This routines are used in the code to show debug informations.
1012 * Most of the time, it dump the content of hardware structures...
1013 */
1014
1015#ifdef DEBUG_PSA_SHOW
1016/*------------------------------------------------------------------*/
1017/*
1018 * Print the formatted contents of the Parameter Storage Area.
1019 */
1020static void
1021wv_psa_show(psa_t * p)
1022{
1023 printk(KERN_DEBUG "##### wavelan psa contents: #####\n");
1024 printk(KERN_DEBUG "psa_io_base_addr_1: 0x%02X %02X %02X %02X\n",
1025 p->psa_io_base_addr_1,
1026 p->psa_io_base_addr_2,
1027 p->psa_io_base_addr_3,
1028 p->psa_io_base_addr_4);
1029 printk(KERN_DEBUG "psa_rem_boot_addr_1: 0x%02X %02X %02X\n",
1030 p->psa_rem_boot_addr_1,
1031 p->psa_rem_boot_addr_2,
1032 p->psa_rem_boot_addr_3);
1033 printk(KERN_DEBUG "psa_holi_params: 0x%02x, ", p->psa_holi_params);
1034 printk("psa_int_req_no: %d\n", p->psa_int_req_no);
1035#ifdef DEBUG_SHOW_UNUSED
Johannes Berge1749612008-10-27 15:59:26 -07001036 printk(KERN_DEBUG "psa_unused0[]: %pM\n", p->psa_unused0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001037#endif /* DEBUG_SHOW_UNUSED */
Johannes Berge1749612008-10-27 15:59:26 -07001038 printk(KERN_DEBUG "psa_univ_mac_addr[]: %pM\n", p->psa_univ_mac_addr);
1039 printk(KERN_DEBUG "psa_local_mac_addr[]: %pM\n", p->psa_local_mac_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001040 printk(KERN_DEBUG "psa_univ_local_sel: %d, ", p->psa_univ_local_sel);
1041 printk("psa_comp_number: %d, ", p->psa_comp_number);
1042 printk("psa_thr_pre_set: 0x%02x\n", p->psa_thr_pre_set);
1043 printk(KERN_DEBUG "psa_feature_select/decay_prm: 0x%02x, ",
1044 p->psa_feature_select);
1045 printk("psa_subband/decay_update_prm: %d\n", p->psa_subband);
1046 printk(KERN_DEBUG "psa_quality_thr: 0x%02x, ", p->psa_quality_thr);
1047 printk("psa_mod_delay: 0x%02x\n", p->psa_mod_delay);
1048 printk(KERN_DEBUG "psa_nwid: 0x%02x%02x, ", p->psa_nwid[0], p->psa_nwid[1]);
1049 printk("psa_nwid_select: %d\n", p->psa_nwid_select);
1050 printk(KERN_DEBUG "psa_encryption_select: %d, ", p->psa_encryption_select);
1051 printk("psa_encryption_key[]: %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x\n",
1052 p->psa_encryption_key[0],
1053 p->psa_encryption_key[1],
1054 p->psa_encryption_key[2],
1055 p->psa_encryption_key[3],
1056 p->psa_encryption_key[4],
1057 p->psa_encryption_key[5],
1058 p->psa_encryption_key[6],
1059 p->psa_encryption_key[7]);
1060 printk(KERN_DEBUG "psa_databus_width: %d\n", p->psa_databus_width);
1061 printk(KERN_DEBUG "psa_call_code/auto_squelch: 0x%02x, ",
1062 p->psa_call_code[0]);
1063 printk("psa_call_code[]: %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n",
1064 p->psa_call_code[0],
1065 p->psa_call_code[1],
1066 p->psa_call_code[2],
1067 p->psa_call_code[3],
1068 p->psa_call_code[4],
1069 p->psa_call_code[5],
1070 p->psa_call_code[6],
1071 p->psa_call_code[7]);
1072#ifdef DEBUG_SHOW_UNUSED
John W. Linvilled5251ae2008-05-02 09:56:34 -04001073 printk(KERN_DEBUG "psa_reserved[]: %02X:%02X\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074 p->psa_reserved[0],
John W. Linvilled5251ae2008-05-02 09:56:34 -04001075 p->psa_reserved[1]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076#endif /* DEBUG_SHOW_UNUSED */
1077 printk(KERN_DEBUG "psa_conf_status: %d, ", p->psa_conf_status);
1078 printk("psa_crc: 0x%02x%02x, ", p->psa_crc[0], p->psa_crc[1]);
1079 printk("psa_crc_status: 0x%02x\n", p->psa_crc_status);
1080} /* wv_psa_show */
1081#endif /* DEBUG_PSA_SHOW */
1082
1083#ifdef DEBUG_MMC_SHOW
1084/*------------------------------------------------------------------*/
1085/*
1086 * Print the formatted status of the Modem Management Controller.
1087 * This function need to be completed...
1088 */
1089static void
1090wv_mmc_show(struct net_device * dev)
1091{
Olof Johansson906da802008-02-04 22:27:35 -08001092 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001093 net_local * lp = netdev_priv(dev);
1094 mmr_t m;
1095
1096 /* Basic check */
1097 if(hasr_read(base) & HASR_NO_CLK)
1098 {
1099 printk(KERN_WARNING "%s: wv_mmc_show: modem not connected\n",
1100 dev->name);
1101 return;
1102 }
1103
1104 spin_lock_irqsave(&lp->spinlock, flags);
1105
1106 /* Read the mmc */
1107 mmc_out(base, mmwoff(0, mmw_freeze), 1);
1108 mmc_read(base, 0, (u_char *)&m, sizeof(m));
1109 mmc_out(base, mmwoff(0, mmw_freeze), 0);
1110
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111 /* Don't forget to update statistics */
1112 lp->wstats.discard.nwid += (m.mmr_wrong_nwid_h << 8) | m.mmr_wrong_nwid_l;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113
1114 spin_unlock_irqrestore(&lp->spinlock, flags);
1115
1116 printk(KERN_DEBUG "##### wavelan modem status registers: #####\n");
1117#ifdef DEBUG_SHOW_UNUSED
1118 printk(KERN_DEBUG "mmc_unused0[]: %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n",
1119 m.mmr_unused0[0],
1120 m.mmr_unused0[1],
1121 m.mmr_unused0[2],
1122 m.mmr_unused0[3],
1123 m.mmr_unused0[4],
1124 m.mmr_unused0[5],
1125 m.mmr_unused0[6],
1126 m.mmr_unused0[7]);
1127#endif /* DEBUG_SHOW_UNUSED */
Robert P. J. Dayd08df602007-02-17 19:07:33 +01001128 printk(KERN_DEBUG "Encryption algorithm: %02X - Status: %02X\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001129 m.mmr_des_avail, m.mmr_des_status);
1130#ifdef DEBUG_SHOW_UNUSED
1131 printk(KERN_DEBUG "mmc_unused1[]: %02X:%02X:%02X:%02X:%02X\n",
1132 m.mmr_unused1[0],
1133 m.mmr_unused1[1],
1134 m.mmr_unused1[2],
1135 m.mmr_unused1[3],
1136 m.mmr_unused1[4]);
1137#endif /* DEBUG_SHOW_UNUSED */
1138 printk(KERN_DEBUG "dce_status: 0x%x [%s%s%s%s]\n",
1139 m.mmr_dce_status,
1140 (m.mmr_dce_status & MMR_DCE_STATUS_RX_BUSY) ? "energy detected,":"",
1141 (m.mmr_dce_status & MMR_DCE_STATUS_LOOPT_IND) ?
1142 "loop test indicated," : "",
1143 (m.mmr_dce_status & MMR_DCE_STATUS_TX_BUSY) ? "transmitter on," : "",
1144 (m.mmr_dce_status & MMR_DCE_STATUS_JBR_EXPIRED) ?
1145 "jabber timer expired," : "");
1146 printk(KERN_DEBUG "Dsp ID: %02X\n",
1147 m.mmr_dsp_id);
1148#ifdef DEBUG_SHOW_UNUSED
1149 printk(KERN_DEBUG "mmc_unused2[]: %02X:%02X\n",
1150 m.mmr_unused2[0],
1151 m.mmr_unused2[1]);
1152#endif /* DEBUG_SHOW_UNUSED */
1153 printk(KERN_DEBUG "# correct_nwid: %d, # wrong_nwid: %d\n",
1154 (m.mmr_correct_nwid_h << 8) | m.mmr_correct_nwid_l,
1155 (m.mmr_wrong_nwid_h << 8) | m.mmr_wrong_nwid_l);
1156 printk(KERN_DEBUG "thr_pre_set: 0x%x [current signal %s]\n",
1157 m.mmr_thr_pre_set & MMR_THR_PRE_SET,
1158 (m.mmr_thr_pre_set & MMR_THR_PRE_SET_CUR) ? "above" : "below");
1159 printk(KERN_DEBUG "signal_lvl: %d [%s], ",
1160 m.mmr_signal_lvl & MMR_SIGNAL_LVL,
1161 (m.mmr_signal_lvl & MMR_SIGNAL_LVL_VALID) ? "new msg" : "no new msg");
1162 printk("silence_lvl: %d [%s], ", m.mmr_silence_lvl & MMR_SILENCE_LVL,
1163 (m.mmr_silence_lvl & MMR_SILENCE_LVL_VALID) ? "update done" : "no new update");
1164 printk("sgnl_qual: 0x%x [%s]\n", m.mmr_sgnl_qual & MMR_SGNL_QUAL,
1165 (m.mmr_sgnl_qual & MMR_SGNL_QUAL_ANT) ? "Antenna 1" : "Antenna 0");
1166#ifdef DEBUG_SHOW_UNUSED
1167 printk(KERN_DEBUG "netw_id_l: %x\n", m.mmr_netw_id_l);
1168#endif /* DEBUG_SHOW_UNUSED */
1169} /* wv_mmc_show */
1170#endif /* DEBUG_MMC_SHOW */
1171
1172#ifdef DEBUG_I82593_SHOW
1173/*------------------------------------------------------------------*/
1174/*
1175 * Print the formatted status of the i82593's receive unit.
1176 */
1177static void
1178wv_ru_show(struct net_device * dev)
1179{
1180 net_local *lp = netdev_priv(dev);
1181
1182 printk(KERN_DEBUG "##### wavelan i82593 receiver status: #####\n");
1183 printk(KERN_DEBUG "ru: rfp %d stop %d", lp->rfp, lp->stop);
1184 /*
1185 * Not implemented yet...
1186 */
1187 printk("\n");
1188} /* wv_ru_show */
1189#endif /* DEBUG_I82593_SHOW */
1190
1191#ifdef DEBUG_DEVICE_SHOW
1192/*------------------------------------------------------------------*/
1193/*
1194 * Print the formatted status of the WaveLAN PCMCIA device driver.
1195 */
1196static void
1197wv_dev_show(struct net_device * dev)
1198{
1199 printk(KERN_DEBUG "dev:");
1200 printk(" state=%lX,", dev->state);
1201 printk(" trans_start=%ld,", dev->trans_start);
1202 printk(" flags=0x%x,", dev->flags);
1203 printk("\n");
1204} /* wv_dev_show */
1205
1206/*------------------------------------------------------------------*/
1207/*
1208 * Print the formatted status of the WaveLAN PCMCIA device driver's
1209 * private information.
1210 */
1211static void
1212wv_local_show(struct net_device * dev)
1213{
1214 net_local *lp = netdev_priv(dev);
1215
1216 printk(KERN_DEBUG "local:");
1217 /*
1218 * Not implemented yet...
1219 */
1220 printk("\n");
1221} /* wv_local_show */
1222#endif /* DEBUG_DEVICE_SHOW */
1223
1224#if defined(DEBUG_RX_INFO) || defined(DEBUG_TX_INFO)
1225/*------------------------------------------------------------------*/
1226/*
1227 * Dump packet header (and content if necessary) on the screen
1228 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02001229static void
Linus Torvalds1da177e2005-04-16 15:20:36 -07001230wv_packet_info(u_char * p, /* Packet to dump */
1231 int length, /* Length of the packet */
1232 char * msg1, /* Name of the device */
1233 char * msg2) /* Name of the function */
1234{
1235 int i;
1236 int maxi;
1237
Johannes Berge1749612008-10-27 15:59:26 -07001238 printk(KERN_DEBUG "%s: %s(): dest %pM, length %d\n",
1239 msg1, msg2, p, length);
1240 printk(KERN_DEBUG "%s: %s(): src %pM, type 0x%02X%02X\n",
1241 msg1, msg2, &p[6], p[12], p[13]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242
1243#ifdef DEBUG_PACKET_DUMP
1244
1245 printk(KERN_DEBUG "data=\"");
1246
1247 if((maxi = length) > DEBUG_PACKET_DUMP)
1248 maxi = DEBUG_PACKET_DUMP;
1249 for(i = 14; i < maxi; i++)
1250 if(p[i] >= ' ' && p[i] <= '~')
1251 printk(" %c", p[i]);
1252 else
1253 printk("%02X", p[i]);
1254 if(maxi < length)
1255 printk("..");
1256 printk("\"\n");
1257 printk(KERN_DEBUG "\n");
1258#endif /* DEBUG_PACKET_DUMP */
1259}
1260#endif /* defined(DEBUG_RX_INFO) || defined(DEBUG_TX_INFO) */
1261
1262/*------------------------------------------------------------------*/
1263/*
1264 * This is the information which is displayed by the driver at startup
1265 * There is a lot of flag to configure it at your will...
1266 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02001267static void
Linus Torvalds1da177e2005-04-16 15:20:36 -07001268wv_init_info(struct net_device * dev)
1269{
Olof Johansson906da802008-02-04 22:27:35 -08001270 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001271 psa_t psa;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001272
1273 /* Read the parameter storage area */
1274 psa_read(dev, 0, (unsigned char *) &psa, sizeof(psa));
1275
1276#ifdef DEBUG_PSA_SHOW
1277 wv_psa_show(&psa);
1278#endif
1279#ifdef DEBUG_MMC_SHOW
1280 wv_mmc_show(dev);
1281#endif
1282#ifdef DEBUG_I82593_SHOW
1283 wv_ru_show(dev);
1284#endif
1285
1286#ifdef DEBUG_BASIC_SHOW
1287 /* Now, let's go for the basic stuff */
Johannes Berge1749612008-10-27 15:59:26 -07001288 printk(KERN_NOTICE "%s: WaveLAN: port %#x, irq %d, hw_addr %pM",
1289 dev->name, base, dev->irq, dev->dev_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290
1291 /* Print current network id */
1292 if(psa.psa_nwid_select)
1293 printk(", nwid 0x%02X-%02X", psa.psa_nwid[0], psa.psa_nwid[1]);
1294 else
1295 printk(", nwid off");
1296
1297 /* If 2.00 card */
1298 if(!(mmc_in(base, mmroff(0, mmr_fee_status)) &
1299 (MMR_FEE_STATUS_DWLD | MMR_FEE_STATUS_BUSY)))
1300 {
1301 unsigned short freq;
1302
1303 /* Ask the EEprom to read the frequency from the first area */
1304 fee_read(base, 0x00 /* 1st area - frequency... */,
1305 &freq, 1);
1306
1307 /* Print frequency */
1308 printk(", 2.00, %ld", (freq >> 6) + 2400L);
1309
1310 /* Hack !!! */
1311 if(freq & 0x20)
1312 printk(".5");
1313 }
1314 else
1315 {
1316 printk(", PCMCIA, ");
1317 switch (psa.psa_subband)
1318 {
1319 case PSA_SUBBAND_915:
1320 printk("915");
1321 break;
1322 case PSA_SUBBAND_2425:
1323 printk("2425");
1324 break;
1325 case PSA_SUBBAND_2460:
1326 printk("2460");
1327 break;
1328 case PSA_SUBBAND_2484:
1329 printk("2484");
1330 break;
1331 case PSA_SUBBAND_2430_5:
1332 printk("2430.5");
1333 break;
1334 default:
1335 printk("unknown");
1336 }
1337 }
1338
1339 printk(" MHz\n");
1340#endif /* DEBUG_BASIC_SHOW */
1341
1342#ifdef DEBUG_VERSION_SHOW
1343 /* Print version information */
1344 printk(KERN_NOTICE "%s", version);
1345#endif
1346} /* wv_init_info */
1347
1348/********************* IOCTL, STATS & RECONFIG *********************/
1349/*
1350 * We found here routines that are called by Linux on differents
1351 * occasions after the configuration and not for transmitting data
1352 * These may be called when the user use ifconfig, /proc/net/dev
1353 * or wireless extensions
1354 */
1355
1356/*------------------------------------------------------------------*/
1357/*
1358 * Get the current ethernet statistics. This may be called with the
1359 * card open or closed.
1360 * Used when the user read /proc/net/dev
1361 */
1362static en_stats *
1363wavelan_get_stats(struct net_device * dev)
1364{
1365#ifdef DEBUG_IOCTL_TRACE
1366 printk(KERN_DEBUG "%s: <>wavelan_get_stats()\n", dev->name);
1367#endif
1368
1369 return(&((net_local *)netdev_priv(dev))->stats);
1370}
1371
1372/*------------------------------------------------------------------*/
1373/*
1374 * Set or clear the multicast filter for this adaptor.
1375 * num_addrs == -1 Promiscuous mode, receive all packets
1376 * num_addrs == 0 Normal mode, clear multicast list
1377 * num_addrs > 0 Multicast mode, receive normal and MC packets,
1378 * and do best-effort filtering.
1379 */
1380
1381static void
1382wavelan_set_multicast_list(struct net_device * dev)
1383{
1384 net_local * lp = netdev_priv(dev);
1385
1386#ifdef DEBUG_IOCTL_TRACE
1387 printk(KERN_DEBUG "%s: ->wavelan_set_multicast_list()\n", dev->name);
1388#endif
1389
1390#ifdef DEBUG_IOCTL_INFO
1391 printk(KERN_DEBUG "%s: wavelan_set_multicast_list(): setting Rx mode %02X to %d addresses.\n",
1392 dev->name, dev->flags, dev->mc_count);
1393#endif
1394
1395 if(dev->flags & IFF_PROMISC)
1396 {
1397 /*
1398 * Enable promiscuous mode: receive all packets.
1399 */
1400 if(!lp->promiscuous)
1401 {
1402 lp->promiscuous = 1;
1403 lp->allmulticast = 0;
1404 lp->mc_count = 0;
1405
1406 wv_82593_reconfig(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001407 }
1408 }
1409 else
1410 /* If all multicast addresses
1411 * or too much multicast addresses for the hardware filter */
1412 if((dev->flags & IFF_ALLMULTI) ||
1413 (dev->mc_count > I82593_MAX_MULTICAST_ADDRESSES))
1414 {
1415 /*
1416 * Disable promiscuous mode, but active the all multicast mode
1417 */
1418 if(!lp->allmulticast)
1419 {
1420 lp->promiscuous = 0;
1421 lp->allmulticast = 1;
1422 lp->mc_count = 0;
1423
1424 wv_82593_reconfig(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001425 }
1426 }
1427 else
1428 /* If there is some multicast addresses to send */
1429 if(dev->mc_list != (struct dev_mc_list *) NULL)
1430 {
1431 /*
1432 * Disable promiscuous mode, but receive all packets
1433 * in multicast list
1434 */
1435#ifdef MULTICAST_AVOID
1436 if(lp->promiscuous || lp->allmulticast ||
1437 (dev->mc_count != lp->mc_count))
1438#endif
1439 {
1440 lp->promiscuous = 0;
1441 lp->allmulticast = 0;
1442 lp->mc_count = dev->mc_count;
1443
1444 wv_82593_reconfig(dev);
1445 }
1446 }
1447 else
1448 {
1449 /*
1450 * Switch to normal mode: disable promiscuous mode and
1451 * clear the multicast list.
1452 */
1453 if(lp->promiscuous || lp->mc_count == 0)
1454 {
1455 lp->promiscuous = 0;
1456 lp->allmulticast = 0;
1457 lp->mc_count = 0;
1458
1459 wv_82593_reconfig(dev);
1460 }
1461 }
1462#ifdef DEBUG_IOCTL_TRACE
1463 printk(KERN_DEBUG "%s: <-wavelan_set_multicast_list()\n", dev->name);
1464#endif
1465}
1466
1467/*------------------------------------------------------------------*/
1468/*
1469 * This function doesn't exist...
1470 * (Note : it was a nice way to test the reconfigure stuff...)
1471 */
1472#ifdef SET_MAC_ADDRESS
1473static int
1474wavelan_set_mac_address(struct net_device * dev,
1475 void * addr)
1476{
1477 struct sockaddr * mac = addr;
1478
1479 /* Copy the address */
1480 memcpy(dev->dev_addr, mac->sa_data, WAVELAN_ADDR_SIZE);
1481
1482 /* Reconfig the beast */
1483 wv_82593_reconfig(dev);
1484
1485 return 0;
1486}
1487#endif /* SET_MAC_ADDRESS */
1488
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489
1490/*------------------------------------------------------------------*/
1491/*
1492 * Frequency setting (for hardware able of it)
1493 * It's a bit complicated and you don't really want to look into it...
1494 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02001495static int
Linus Torvalds1da177e2005-04-16 15:20:36 -07001496wv_set_frequency(u_long base, /* i/o port of the card */
1497 iw_freq * frequency)
1498{
1499 const int BAND_NUM = 10; /* Number of bands */
1500 long freq = 0L; /* offset to 2.4 GHz in .5 MHz */
1501#ifdef DEBUG_IOCTL_INFO
1502 int i;
1503#endif
1504
1505 /* Setting by frequency */
1506 /* Theoritically, you may set any frequency between
1507 * the two limits with a 0.5 MHz precision. In practice,
1508 * I don't want you to have trouble with local
1509 * regulations... */
1510 if((frequency->e == 1) &&
1511 (frequency->m >= (int) 2.412e8) && (frequency->m <= (int) 2.487e8))
1512 {
1513 freq = ((frequency->m / 10000) - 24000L) / 5;
1514 }
1515
1516 /* Setting by channel (same as wfreqsel) */
1517 /* Warning : each channel is 22MHz wide, so some of the channels
1518 * will interfere... */
1519 if((frequency->e == 0) &&
1520 (frequency->m >= 0) && (frequency->m < BAND_NUM))
1521 {
1522 /* Get frequency offset. */
1523 freq = channel_bands[frequency->m] >> 1;
1524 }
1525
1526 /* Verify if the frequency is allowed */
1527 if(freq != 0L)
1528 {
1529 u_short table[10]; /* Authorized frequency table */
1530
1531 /* Read the frequency table */
1532 fee_read(base, 0x71 /* frequency table */,
1533 table, 10);
1534
1535#ifdef DEBUG_IOCTL_INFO
1536 printk(KERN_DEBUG "Frequency table :");
1537 for(i = 0; i < 10; i++)
1538 {
1539 printk(" %04X",
1540 table[i]);
1541 }
1542 printk("\n");
1543#endif
1544
1545 /* Look in the table if the frequency is allowed */
1546 if(!(table[9 - ((freq - 24) / 16)] &
1547 (1 << ((freq - 24) % 16))))
1548 return -EINVAL; /* not allowed */
1549 }
1550 else
1551 return -EINVAL;
1552
1553 /* If we get a usable frequency */
1554 if(freq != 0L)
1555 {
1556 unsigned short area[16];
1557 unsigned short dac[2];
1558 unsigned short area_verify[16];
1559 unsigned short dac_verify[2];
1560 /* Corresponding gain (in the power adjust value table)
1561 * see AT&T Wavelan Data Manual, REF 407-024689/E, page 3-8
1562 * & WCIN062D.DOC, page 6.2.9 */
1563 unsigned short power_limit[] = { 40, 80, 120, 160, 0 };
1564 int power_band = 0; /* Selected band */
1565 unsigned short power_adjust; /* Correct value */
1566
1567 /* Search for the gain */
1568 power_band = 0;
1569 while((freq > power_limit[power_band]) &&
1570 (power_limit[++power_band] != 0))
1571 ;
1572
1573 /* Read the first area */
1574 fee_read(base, 0x00,
1575 area, 16);
1576
1577 /* Read the DAC */
1578 fee_read(base, 0x60,
1579 dac, 2);
1580
1581 /* Read the new power adjust value */
1582 fee_read(base, 0x6B - (power_band >> 1),
1583 &power_adjust, 1);
1584 if(power_band & 0x1)
1585 power_adjust >>= 8;
1586 else
1587 power_adjust &= 0xFF;
1588
1589#ifdef DEBUG_IOCTL_INFO
1590 printk(KERN_DEBUG "Wavelan EEprom Area 1 :");
1591 for(i = 0; i < 16; i++)
1592 {
1593 printk(" %04X",
1594 area[i]);
1595 }
1596 printk("\n");
1597
1598 printk(KERN_DEBUG "Wavelan EEprom DAC : %04X %04X\n",
1599 dac[0], dac[1]);
1600#endif
1601
1602 /* Frequency offset (for info only...) */
1603 area[0] = ((freq << 5) & 0xFFE0) | (area[0] & 0x1F);
1604
1605 /* Receiver Principle main divider coefficient */
1606 area[3] = (freq >> 1) + 2400L - 352L;
1607 area[2] = ((freq & 0x1) << 4) | (area[2] & 0xFFEF);
1608
1609 /* Transmitter Main divider coefficient */
1610 area[13] = (freq >> 1) + 2400L;
1611 area[12] = ((freq & 0x1) << 4) | (area[2] & 0xFFEF);
1612
1613 /* Others part of the area are flags, bit streams or unused... */
1614
1615 /* Set the value in the DAC */
1616 dac[1] = ((power_adjust >> 1) & 0x7F) | (dac[1] & 0xFF80);
1617 dac[0] = ((power_adjust & 0x1) << 4) | (dac[0] & 0xFFEF);
1618
1619 /* Write the first area */
1620 fee_write(base, 0x00,
1621 area, 16);
1622
1623 /* Write the DAC */
1624 fee_write(base, 0x60,
1625 dac, 2);
1626
Robert P. J. Daybeb7dd82007-05-09 07:14:03 +02001627 /* We now should verify here that the EEprom writing was ok */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628
1629 /* ReRead the first area */
1630 fee_read(base, 0x00,
1631 area_verify, 16);
1632
1633 /* ReRead the DAC */
1634 fee_read(base, 0x60,
1635 dac_verify, 2);
1636
1637 /* Compare */
1638 if(memcmp(area, area_verify, 16 * 2) ||
1639 memcmp(dac, dac_verify, 2 * 2))
1640 {
1641#ifdef DEBUG_IOCTL_ERROR
1642 printk(KERN_INFO "Wavelan: wv_set_frequency : unable to write new frequency to EEprom (?)\n");
1643#endif
1644 return -EOPNOTSUPP;
1645 }
1646
1647 /* We must download the frequency parameters to the
1648 * synthetisers (from the EEprom - area 1)
1649 * Note : as the EEprom is auto decremented, we set the end
1650 * if the area... */
1651 mmc_out(base, mmwoff(0, mmw_fee_addr), 0x0F);
1652 mmc_out(base, mmwoff(0, mmw_fee_ctrl),
1653 MMW_FEE_CTRL_READ | MMW_FEE_CTRL_DWLD);
1654
1655 /* Wait until the download is finished */
1656 fee_wait(base, 100, 100);
1657
1658 /* We must now download the power adjust value (gain) to
1659 * the synthetisers (from the EEprom - area 7 - DAC) */
1660 mmc_out(base, mmwoff(0, mmw_fee_addr), 0x61);
1661 mmc_out(base, mmwoff(0, mmw_fee_ctrl),
1662 MMW_FEE_CTRL_READ | MMW_FEE_CTRL_DWLD);
1663
1664 /* Wait until the download is finished */
1665 fee_wait(base, 100, 100);
1666
1667#ifdef DEBUG_IOCTL_INFO
1668 /* Verification of what we have done... */
1669
1670 printk(KERN_DEBUG "Wavelan EEprom Area 1 :");
1671 for(i = 0; i < 16; i++)
1672 {
1673 printk(" %04X",
1674 area_verify[i]);
1675 }
1676 printk("\n");
1677
1678 printk(KERN_DEBUG "Wavelan EEprom DAC : %04X %04X\n",
1679 dac_verify[0], dac_verify[1]);
1680#endif
1681
1682 return 0;
1683 }
1684 else
1685 return -EINVAL; /* Bah, never get there... */
1686}
1687
1688/*------------------------------------------------------------------*/
1689/*
1690 * Give the list of available frequencies
1691 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02001692static int
Linus Torvalds1da177e2005-04-16 15:20:36 -07001693wv_frequency_list(u_long base, /* i/o port of the card */
1694 iw_freq * list, /* List of frequency to fill */
1695 int max) /* Maximum number of frequencies */
1696{
1697 u_short table[10]; /* Authorized frequency table */
1698 long freq = 0L; /* offset to 2.4 GHz in .5 MHz + 12 MHz */
1699 int i; /* index in the table */
1700 const int BAND_NUM = 10; /* Number of bands */
1701 int c = 0; /* Channel number */
1702
1703 /* Read the frequency table */
1704 fee_read(base, 0x71 /* frequency table */,
1705 table, 10);
1706
1707 /* Look all frequencies */
1708 i = 0;
1709 for(freq = 0; freq < 150; freq++)
1710 /* Look in the table if the frequency is allowed */
1711 if(table[9 - (freq / 16)] & (1 << (freq % 16)))
1712 {
1713 /* Compute approximate channel number */
1714 while((((channel_bands[c] >> 1) - 24) < freq) &&
1715 (c < BAND_NUM))
1716 c++;
1717 list[i].i = c; /* Set the list index */
1718
1719 /* put in the list */
1720 list[i].m = (((freq + 24) * 5) + 24000L) * 10000;
1721 list[i++].e = 1;
1722
1723 /* Check number */
1724 if(i >= max)
1725 return(i);
1726 }
1727
1728 return(i);
1729}
1730
1731#ifdef IW_WIRELESS_SPY
1732/*------------------------------------------------------------------*/
1733/*
1734 * Gather wireless spy statistics : for each packet, compare the source
1735 * address with out list, and if match, get the stats...
1736 * Sorry, but this function really need wireless extensions...
1737 */
1738static inline void
1739wl_spy_gather(struct net_device * dev,
1740 u_char * mac, /* MAC address */
1741 u_char * stats) /* Statistics to gather */
1742{
1743 struct iw_quality wstats;
1744
1745 wstats.qual = stats[2] & MMR_SGNL_QUAL;
1746 wstats.level = stats[0] & MMR_SIGNAL_LVL;
1747 wstats.noise = stats[1] & MMR_SILENCE_LVL;
1748 wstats.updated = 0x7;
1749
1750 /* Update spy records */
1751 wireless_spy_update(dev, mac, &wstats);
1752}
1753#endif /* IW_WIRELESS_SPY */
1754
1755#ifdef HISTOGRAM
1756/*------------------------------------------------------------------*/
1757/*
1758 * This function calculate an histogram on the signal level.
1759 * As the noise is quite constant, it's like doing it on the SNR.
1760 * We have defined a set of interval (lp->his_range), and each time
1761 * the level goes in that interval, we increment the count (lp->his_sum).
1762 * With this histogram you may detect if one wavelan is really weak,
1763 * or you may also calculate the mean and standard deviation of the level...
1764 */
1765static inline void
1766wl_his_gather(struct net_device * dev,
1767 u_char * stats) /* Statistics to gather */
1768{
1769 net_local * lp = netdev_priv(dev);
1770 u_char level = stats[0] & MMR_SIGNAL_LVL;
1771 int i;
1772
1773 /* Find the correct interval */
1774 i = 0;
1775 while((i < (lp->his_number - 1)) && (level >= lp->his_range[i++]))
1776 ;
1777
1778 /* Increment interval counter */
1779 (lp->his_sum[i])++;
1780}
1781#endif /* HISTOGRAM */
1782
1783static void wl_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1784{
1785 strncpy(info->driver, "wavelan_cs", sizeof(info->driver)-1);
1786}
1787
Jeff Garzik7282d492006-09-13 14:30:00 -04001788static const struct ethtool_ops ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001789 .get_drvinfo = wl_get_drvinfo
1790};
1791
1792/*------------------------------------------------------------------*/
1793/*
1794 * Wireless Handler : get protocol name
1795 */
1796static int wavelan_get_name(struct net_device *dev,
1797 struct iw_request_info *info,
1798 union iwreq_data *wrqu,
1799 char *extra)
1800{
1801 strcpy(wrqu->name, "WaveLAN");
1802 return 0;
1803}
1804
1805/*------------------------------------------------------------------*/
1806/*
1807 * Wireless Handler : set NWID
1808 */
1809static int wavelan_set_nwid(struct net_device *dev,
1810 struct iw_request_info *info,
1811 union iwreq_data *wrqu,
1812 char *extra)
1813{
Olof Johansson906da802008-02-04 22:27:35 -08001814 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001815 net_local *lp = netdev_priv(dev);
1816 psa_t psa;
1817 mm_t m;
1818 unsigned long flags;
1819 int ret = 0;
1820
1821 /* Disable interrupts and save flags. */
1822 spin_lock_irqsave(&lp->spinlock, flags);
1823
1824 /* Set NWID in WaveLAN. */
1825 if (!wrqu->nwid.disabled) {
1826 /* Set NWID in psa */
1827 psa.psa_nwid[0] = (wrqu->nwid.value & 0xFF00) >> 8;
1828 psa.psa_nwid[1] = wrqu->nwid.value & 0xFF;
1829 psa.psa_nwid_select = 0x01;
1830 psa_write(dev,
1831 (char *) psa.psa_nwid - (char *) &psa,
1832 (unsigned char *) psa.psa_nwid, 3);
1833
1834 /* Set NWID in mmc. */
1835 m.w.mmw_netw_id_l = psa.psa_nwid[1];
1836 m.w.mmw_netw_id_h = psa.psa_nwid[0];
1837 mmc_write(base,
1838 (char *) &m.w.mmw_netw_id_l -
1839 (char *) &m,
1840 (unsigned char *) &m.w.mmw_netw_id_l, 2);
1841 mmc_out(base, mmwoff(0, mmw_loopt_sel), 0x00);
1842 } else {
1843 /* Disable NWID in the psa. */
1844 psa.psa_nwid_select = 0x00;
1845 psa_write(dev,
1846 (char *) &psa.psa_nwid_select -
1847 (char *) &psa,
1848 (unsigned char *) &psa.psa_nwid_select,
1849 1);
1850
1851 /* Disable NWID in the mmc (no filtering). */
1852 mmc_out(base, mmwoff(0, mmw_loopt_sel),
1853 MMW_LOOPT_SEL_DIS_NWID);
1854 }
1855 /* update the Wavelan checksum */
1856 update_psa_checksum(dev);
1857
1858 /* Enable interrupts and restore flags. */
1859 spin_unlock_irqrestore(&lp->spinlock, flags);
1860
1861 return ret;
1862}
1863
1864/*------------------------------------------------------------------*/
1865/*
1866 * Wireless Handler : get NWID
1867 */
1868static int wavelan_get_nwid(struct net_device *dev,
1869 struct iw_request_info *info,
1870 union iwreq_data *wrqu,
1871 char *extra)
1872{
1873 net_local *lp = netdev_priv(dev);
1874 psa_t psa;
1875 unsigned long flags;
1876 int ret = 0;
1877
1878 /* Disable interrupts and save flags. */
1879 spin_lock_irqsave(&lp->spinlock, flags);
1880
1881 /* Read the NWID. */
1882 psa_read(dev,
1883 (char *) psa.psa_nwid - (char *) &psa,
1884 (unsigned char *) psa.psa_nwid, 3);
1885 wrqu->nwid.value = (psa.psa_nwid[0] << 8) + psa.psa_nwid[1];
1886 wrqu->nwid.disabled = !(psa.psa_nwid_select);
1887 wrqu->nwid.fixed = 1; /* Superfluous */
1888
1889 /* Enable interrupts and restore flags. */
1890 spin_unlock_irqrestore(&lp->spinlock, flags);
1891
1892 return ret;
1893}
1894
1895/*------------------------------------------------------------------*/
1896/*
1897 * Wireless Handler : set frequency
1898 */
1899static int wavelan_set_freq(struct net_device *dev,
1900 struct iw_request_info *info,
1901 union iwreq_data *wrqu,
1902 char *extra)
1903{
Olof Johansson906da802008-02-04 22:27:35 -08001904 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001905 net_local *lp = netdev_priv(dev);
1906 unsigned long flags;
1907 int ret;
1908
1909 /* Disable interrupts and save flags. */
1910 spin_lock_irqsave(&lp->spinlock, flags);
1911
1912 /* Attempt to recognise 2.00 cards (2.4 GHz frequency selectable). */
1913 if (!(mmc_in(base, mmroff(0, mmr_fee_status)) &
1914 (MMR_FEE_STATUS_DWLD | MMR_FEE_STATUS_BUSY)))
1915 ret = wv_set_frequency(base, &(wrqu->freq));
1916 else
1917 ret = -EOPNOTSUPP;
1918
1919 /* Enable interrupts and restore flags. */
1920 spin_unlock_irqrestore(&lp->spinlock, flags);
1921
1922 return ret;
1923}
1924
1925/*------------------------------------------------------------------*/
1926/*
1927 * Wireless Handler : get frequency
1928 */
1929static int wavelan_get_freq(struct net_device *dev,
1930 struct iw_request_info *info,
1931 union iwreq_data *wrqu,
1932 char *extra)
1933{
Olof Johansson906da802008-02-04 22:27:35 -08001934 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001935 net_local *lp = netdev_priv(dev);
1936 psa_t psa;
1937 unsigned long flags;
1938 int ret = 0;
1939
1940 /* Disable interrupts and save flags. */
1941 spin_lock_irqsave(&lp->spinlock, flags);
1942
1943 /* Attempt to recognise 2.00 cards (2.4 GHz frequency selectable).
1944 * Does it work for everybody, especially old cards? */
1945 if (!(mmc_in(base, mmroff(0, mmr_fee_status)) &
1946 (MMR_FEE_STATUS_DWLD | MMR_FEE_STATUS_BUSY))) {
1947 unsigned short freq;
1948
1949 /* Ask the EEPROM to read the frequency from the first area. */
1950 fee_read(base, 0x00, &freq, 1);
1951 wrqu->freq.m = ((freq >> 5) * 5 + 24000L) * 10000;
1952 wrqu->freq.e = 1;
1953 } else {
1954 psa_read(dev,
1955 (char *) &psa.psa_subband - (char *) &psa,
1956 (unsigned char *) &psa.psa_subband, 1);
1957
1958 if (psa.psa_subband <= 4) {
1959 wrqu->freq.m = fixed_bands[psa.psa_subband];
1960 wrqu->freq.e = (psa.psa_subband != 0);
1961 } else
1962 ret = -EOPNOTSUPP;
1963 }
1964
1965 /* Enable interrupts and restore flags. */
1966 spin_unlock_irqrestore(&lp->spinlock, flags);
1967
1968 return ret;
1969}
1970
1971/*------------------------------------------------------------------*/
1972/*
1973 * Wireless Handler : set level threshold
1974 */
1975static int wavelan_set_sens(struct net_device *dev,
1976 struct iw_request_info *info,
1977 union iwreq_data *wrqu,
1978 char *extra)
1979{
Olof Johansson906da802008-02-04 22:27:35 -08001980 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001981 net_local *lp = netdev_priv(dev);
1982 psa_t psa;
1983 unsigned long flags;
1984 int ret = 0;
1985
1986 /* Disable interrupts and save flags. */
1987 spin_lock_irqsave(&lp->spinlock, flags);
1988
1989 /* Set the level threshold. */
1990 /* We should complain loudly if wrqu->sens.fixed = 0, because we
1991 * can't set auto mode... */
1992 psa.psa_thr_pre_set = wrqu->sens.value & 0x3F;
1993 psa_write(dev,
1994 (char *) &psa.psa_thr_pre_set - (char *) &psa,
1995 (unsigned char *) &psa.psa_thr_pre_set, 1);
1996 /* update the Wavelan checksum */
1997 update_psa_checksum(dev);
1998 mmc_out(base, mmwoff(0, mmw_thr_pre_set),
1999 psa.psa_thr_pre_set);
2000
2001 /* Enable interrupts and restore flags. */
2002 spin_unlock_irqrestore(&lp->spinlock, flags);
2003
2004 return ret;
2005}
2006
2007/*------------------------------------------------------------------*/
2008/*
2009 * Wireless Handler : get level threshold
2010 */
2011static int wavelan_get_sens(struct net_device *dev,
2012 struct iw_request_info *info,
2013 union iwreq_data *wrqu,
2014 char *extra)
2015{
2016 net_local *lp = netdev_priv(dev);
2017 psa_t psa;
2018 unsigned long flags;
2019 int ret = 0;
2020
2021 /* Disable interrupts and save flags. */
2022 spin_lock_irqsave(&lp->spinlock, flags);
2023
2024 /* Read the level threshold. */
2025 psa_read(dev,
2026 (char *) &psa.psa_thr_pre_set - (char *) &psa,
2027 (unsigned char *) &psa.psa_thr_pre_set, 1);
2028 wrqu->sens.value = psa.psa_thr_pre_set & 0x3F;
2029 wrqu->sens.fixed = 1;
2030
2031 /* Enable interrupts and restore flags. */
2032 spin_unlock_irqrestore(&lp->spinlock, flags);
2033
2034 return ret;
2035}
2036
2037/*------------------------------------------------------------------*/
2038/*
2039 * Wireless Handler : set encryption key
2040 */
2041static int wavelan_set_encode(struct net_device *dev,
2042 struct iw_request_info *info,
2043 union iwreq_data *wrqu,
2044 char *extra)
2045{
Olof Johansson906da802008-02-04 22:27:35 -08002046 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002047 net_local *lp = netdev_priv(dev);
2048 unsigned long flags;
2049 psa_t psa;
2050 int ret = 0;
2051
2052 /* Disable interrupts and save flags. */
2053 spin_lock_irqsave(&lp->spinlock, flags);
2054
2055 /* Check if capable of encryption */
2056 if (!mmc_encr(base)) {
2057 ret = -EOPNOTSUPP;
2058 }
2059
2060 /* Check the size of the key */
2061 if((wrqu->encoding.length != 8) && (wrqu->encoding.length != 0)) {
2062 ret = -EINVAL;
2063 }
2064
2065 if(!ret) {
2066 /* Basic checking... */
2067 if (wrqu->encoding.length == 8) {
2068 /* Copy the key in the driver */
2069 memcpy(psa.psa_encryption_key, extra,
2070 wrqu->encoding.length);
2071 psa.psa_encryption_select = 1;
2072
2073 psa_write(dev,
2074 (char *) &psa.psa_encryption_select -
2075 (char *) &psa,
2076 (unsigned char *) &psa.
2077 psa_encryption_select, 8 + 1);
2078
2079 mmc_out(base, mmwoff(0, mmw_encr_enable),
2080 MMW_ENCR_ENABLE_EN | MMW_ENCR_ENABLE_MODE);
2081 mmc_write(base, mmwoff(0, mmw_encr_key),
2082 (unsigned char *) &psa.
2083 psa_encryption_key, 8);
2084 }
2085
2086 /* disable encryption */
2087 if (wrqu->encoding.flags & IW_ENCODE_DISABLED) {
2088 psa.psa_encryption_select = 0;
2089 psa_write(dev,
2090 (char *) &psa.psa_encryption_select -
2091 (char *) &psa,
2092 (unsigned char *) &psa.
2093 psa_encryption_select, 1);
2094
2095 mmc_out(base, mmwoff(0, mmw_encr_enable), 0);
2096 }
2097 /* update the Wavelan checksum */
2098 update_psa_checksum(dev);
2099 }
2100
2101 /* Enable interrupts and restore flags. */
2102 spin_unlock_irqrestore(&lp->spinlock, flags);
2103
2104 return ret;
2105}
2106
2107/*------------------------------------------------------------------*/
2108/*
2109 * Wireless Handler : get encryption key
2110 */
2111static int wavelan_get_encode(struct net_device *dev,
2112 struct iw_request_info *info,
2113 union iwreq_data *wrqu,
2114 char *extra)
2115{
Olof Johansson906da802008-02-04 22:27:35 -08002116 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002117 net_local *lp = netdev_priv(dev);
2118 psa_t psa;
2119 unsigned long flags;
2120 int ret = 0;
2121
2122 /* Disable interrupts and save flags. */
2123 spin_lock_irqsave(&lp->spinlock, flags);
2124
2125 /* Check if encryption is available */
2126 if (!mmc_encr(base)) {
2127 ret = -EOPNOTSUPP;
2128 } else {
2129 /* Read the encryption key */
2130 psa_read(dev,
2131 (char *) &psa.psa_encryption_select -
2132 (char *) &psa,
2133 (unsigned char *) &psa.
2134 psa_encryption_select, 1 + 8);
2135
2136 /* encryption is enabled ? */
2137 if (psa.psa_encryption_select)
2138 wrqu->encoding.flags = IW_ENCODE_ENABLED;
2139 else
2140 wrqu->encoding.flags = IW_ENCODE_DISABLED;
2141 wrqu->encoding.flags |= mmc_encr(base);
2142
2143 /* Copy the key to the user buffer */
2144 wrqu->encoding.length = 8;
2145 memcpy(extra, psa.psa_encryption_key, wrqu->encoding.length);
2146 }
2147
2148 /* Enable interrupts and restore flags. */
2149 spin_unlock_irqrestore(&lp->spinlock, flags);
2150
2151 return ret;
2152}
2153
2154#ifdef WAVELAN_ROAMING_EXT
2155/*------------------------------------------------------------------*/
2156/*
2157 * Wireless Handler : set ESSID (domain)
2158 */
2159static int wavelan_set_essid(struct net_device *dev,
2160 struct iw_request_info *info,
2161 union iwreq_data *wrqu,
2162 char *extra)
2163{
2164 net_local *lp = netdev_priv(dev);
2165 unsigned long flags;
2166 int ret = 0;
2167
2168 /* Disable interrupts and save flags. */
2169 spin_lock_irqsave(&lp->spinlock, flags);
2170
2171 /* Check if disable */
2172 if(wrqu->data.flags == 0)
2173 lp->filter_domains = 0;
2174 else {
2175 char essid[IW_ESSID_MAX_SIZE + 1];
2176 char * endp;
2177
2178 /* Terminate the string */
2179 memcpy(essid, extra, wrqu->data.length);
2180 essid[IW_ESSID_MAX_SIZE] = '\0';
2181
2182#ifdef DEBUG_IOCTL_INFO
2183 printk(KERN_DEBUG "SetEssid : ``%s''\n", essid);
2184#endif /* DEBUG_IOCTL_INFO */
2185
2186 /* Convert to a number (note : Wavelan specific) */
2187 lp->domain_id = simple_strtoul(essid, &endp, 16);
2188 /* Has it worked ? */
2189 if(endp > essid)
2190 lp->filter_domains = 1;
2191 else {
2192 lp->filter_domains = 0;
2193 ret = -EINVAL;
2194 }
2195 }
2196
2197 /* Enable interrupts and restore flags. */
2198 spin_unlock_irqrestore(&lp->spinlock, flags);
2199
2200 return ret;
2201}
2202
2203/*------------------------------------------------------------------*/
2204/*
2205 * Wireless Handler : get ESSID (domain)
2206 */
2207static int wavelan_get_essid(struct net_device *dev,
2208 struct iw_request_info *info,
2209 union iwreq_data *wrqu,
2210 char *extra)
2211{
2212 net_local *lp = netdev_priv(dev);
2213
2214 /* Is the domain ID active ? */
2215 wrqu->data.flags = lp->filter_domains;
2216
2217 /* Copy Domain ID into a string (Wavelan specific) */
2218 /* Sound crazy, be we can't have a snprintf in the kernel !!! */
2219 sprintf(extra, "%lX", lp->domain_id);
2220 extra[IW_ESSID_MAX_SIZE] = '\0';
2221
2222 /* Set the length */
Dan Williamsd6a13a22006-01-12 15:00:58 -05002223 wrqu->data.length = strlen(extra);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002224
2225 return 0;
2226}
2227
2228/*------------------------------------------------------------------*/
2229/*
2230 * Wireless Handler : set AP address
2231 */
2232static int wavelan_set_wap(struct net_device *dev,
2233 struct iw_request_info *info,
2234 union iwreq_data *wrqu,
2235 char *extra)
2236{
2237#ifdef DEBUG_IOCTL_INFO
Johannes Berg7c510e42008-10-27 17:47:26 -07002238 printk(KERN_DEBUG "Set AP to : %pM\n", wrqu->ap_addr.sa_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002239#endif /* DEBUG_IOCTL_INFO */
2240
2241 return -EOPNOTSUPP;
2242}
2243
2244/*------------------------------------------------------------------*/
2245/*
2246 * Wireless Handler : get AP address
2247 */
2248static int wavelan_get_wap(struct net_device *dev,
2249 struct iw_request_info *info,
2250 union iwreq_data *wrqu,
2251 char *extra)
2252{
2253 /* Should get the real McCoy instead of own Ethernet address */
2254 memcpy(wrqu->ap_addr.sa_data, dev->dev_addr, WAVELAN_ADDR_SIZE);
2255 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
2256
2257 return -EOPNOTSUPP;
2258}
2259#endif /* WAVELAN_ROAMING_EXT */
2260
2261#ifdef WAVELAN_ROAMING
2262/*------------------------------------------------------------------*/
2263/*
2264 * Wireless Handler : set mode
2265 */
2266static int wavelan_set_mode(struct net_device *dev,
2267 struct iw_request_info *info,
2268 union iwreq_data *wrqu,
2269 char *extra)
2270{
2271 net_local *lp = netdev_priv(dev);
2272 unsigned long flags;
2273 int ret = 0;
2274
2275 /* Disable interrupts and save flags. */
2276 spin_lock_irqsave(&lp->spinlock, flags);
2277
2278 /* Check mode */
2279 switch(wrqu->mode) {
2280 case IW_MODE_ADHOC:
2281 if(do_roaming) {
2282 wv_roam_cleanup(dev);
2283 do_roaming = 0;
2284 }
2285 break;
2286 case IW_MODE_INFRA:
2287 if(!do_roaming) {
2288 wv_roam_init(dev);
2289 do_roaming = 1;
2290 }
2291 break;
2292 default:
2293 ret = -EINVAL;
2294 }
2295
2296 /* Enable interrupts and restore flags. */
2297 spin_unlock_irqrestore(&lp->spinlock, flags);
2298
2299 return ret;
2300}
2301
2302/*------------------------------------------------------------------*/
2303/*
2304 * Wireless Handler : get mode
2305 */
2306static int wavelan_get_mode(struct net_device *dev,
2307 struct iw_request_info *info,
2308 union iwreq_data *wrqu,
2309 char *extra)
2310{
2311 if(do_roaming)
2312 wrqu->mode = IW_MODE_INFRA;
2313 else
2314 wrqu->mode = IW_MODE_ADHOC;
2315
2316 return 0;
2317}
2318#endif /* WAVELAN_ROAMING */
2319
2320/*------------------------------------------------------------------*/
2321/*
2322 * Wireless Handler : get range info
2323 */
2324static int wavelan_get_range(struct net_device *dev,
2325 struct iw_request_info *info,
2326 union iwreq_data *wrqu,
2327 char *extra)
2328{
Olof Johansson906da802008-02-04 22:27:35 -08002329 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002330 net_local *lp = netdev_priv(dev);
2331 struct iw_range *range = (struct iw_range *) extra;
2332 unsigned long flags;
2333 int ret = 0;
2334
2335 /* Set the length (very important for backward compatibility) */
2336 wrqu->data.length = sizeof(struct iw_range);
2337
2338 /* Set all the info we don't care or don't know about to zero */
2339 memset(range, 0, sizeof(struct iw_range));
2340
2341 /* Set the Wireless Extension versions */
2342 range->we_version_compiled = WIRELESS_EXT;
2343 range->we_version_source = 9;
2344
2345 /* Set information in the range struct. */
2346 range->throughput = 1.4 * 1000 * 1000; /* don't argue on this ! */
2347 range->min_nwid = 0x0000;
2348 range->max_nwid = 0xFFFF;
2349
2350 range->sensitivity = 0x3F;
2351 range->max_qual.qual = MMR_SGNL_QUAL;
2352 range->max_qual.level = MMR_SIGNAL_LVL;
2353 range->max_qual.noise = MMR_SILENCE_LVL;
2354 range->avg_qual.qual = MMR_SGNL_QUAL; /* Always max */
2355 /* Need to get better values for those two */
2356 range->avg_qual.level = 30;
2357 range->avg_qual.noise = 8;
2358
2359 range->num_bitrates = 1;
2360 range->bitrate[0] = 2000000; /* 2 Mb/s */
2361
2362 /* Event capability (kernel + driver) */
2363 range->event_capa[0] = (IW_EVENT_CAPA_MASK(0x8B02) |
2364 IW_EVENT_CAPA_MASK(0x8B04) |
2365 IW_EVENT_CAPA_MASK(0x8B06));
2366 range->event_capa[1] = IW_EVENT_CAPA_K_1;
2367
2368 /* Disable interrupts and save flags. */
2369 spin_lock_irqsave(&lp->spinlock, flags);
2370
2371 /* Attempt to recognise 2.00 cards (2.4 GHz frequency selectable). */
2372 if (!(mmc_in(base, mmroff(0, mmr_fee_status)) &
2373 (MMR_FEE_STATUS_DWLD | MMR_FEE_STATUS_BUSY))) {
2374 range->num_channels = 10;
2375 range->num_frequency = wv_frequency_list(base, range->freq,
2376 IW_MAX_FREQUENCIES);
2377 } else
2378 range->num_channels = range->num_frequency = 0;
2379
2380 /* Encryption supported ? */
2381 if (mmc_encr(base)) {
2382 range->encoding_size[0] = 8; /* DES = 64 bits key */
2383 range->num_encoding_sizes = 1;
2384 range->max_encoding_tokens = 1; /* Only one key possible */
2385 } else {
2386 range->num_encoding_sizes = 0;
2387 range->max_encoding_tokens = 0;
2388 }
2389
2390 /* Enable interrupts and restore flags. */
2391 spin_unlock_irqrestore(&lp->spinlock, flags);
2392
2393 return ret;
2394}
2395
2396/*------------------------------------------------------------------*/
2397/*
2398 * Wireless Private Handler : set quality threshold
2399 */
2400static int wavelan_set_qthr(struct net_device *dev,
2401 struct iw_request_info *info,
2402 union iwreq_data *wrqu,
2403 char *extra)
2404{
Olof Johansson906da802008-02-04 22:27:35 -08002405 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002406 net_local *lp = netdev_priv(dev);
2407 psa_t psa;
2408 unsigned long flags;
2409
2410 /* Disable interrupts and save flags. */
2411 spin_lock_irqsave(&lp->spinlock, flags);
2412
2413 psa.psa_quality_thr = *(extra) & 0x0F;
2414 psa_write(dev,
2415 (char *) &psa.psa_quality_thr - (char *) &psa,
2416 (unsigned char *) &psa.psa_quality_thr, 1);
2417 /* update the Wavelan checksum */
2418 update_psa_checksum(dev);
2419 mmc_out(base, mmwoff(0, mmw_quality_thr),
2420 psa.psa_quality_thr);
2421
2422 /* Enable interrupts and restore flags. */
2423 spin_unlock_irqrestore(&lp->spinlock, flags);
2424
2425 return 0;
2426}
2427
2428/*------------------------------------------------------------------*/
2429/*
2430 * Wireless Private Handler : get quality threshold
2431 */
2432static int wavelan_get_qthr(struct net_device *dev,
2433 struct iw_request_info *info,
2434 union iwreq_data *wrqu,
2435 char *extra)
2436{
2437 net_local *lp = netdev_priv(dev);
2438 psa_t psa;
2439 unsigned long flags;
2440
2441 /* Disable interrupts and save flags. */
2442 spin_lock_irqsave(&lp->spinlock, flags);
2443
2444 psa_read(dev,
2445 (char *) &psa.psa_quality_thr - (char *) &psa,
2446 (unsigned char *) &psa.psa_quality_thr, 1);
2447 *(extra) = psa.psa_quality_thr & 0x0F;
2448
2449 /* Enable interrupts and restore flags. */
2450 spin_unlock_irqrestore(&lp->spinlock, flags);
2451
2452 return 0;
2453}
2454
2455#ifdef WAVELAN_ROAMING
2456/*------------------------------------------------------------------*/
2457/*
2458 * Wireless Private Handler : set roaming
2459 */
2460static int wavelan_set_roam(struct net_device *dev,
2461 struct iw_request_info *info,
2462 union iwreq_data *wrqu,
2463 char *extra)
2464{
2465 net_local *lp = netdev_priv(dev);
2466 unsigned long flags;
2467
2468 /* Disable interrupts and save flags. */
2469 spin_lock_irqsave(&lp->spinlock, flags);
2470
2471 /* Note : should check if user == root */
2472 if(do_roaming && (*extra)==0)
2473 wv_roam_cleanup(dev);
2474 else if(do_roaming==0 && (*extra)!=0)
2475 wv_roam_init(dev);
2476
2477 do_roaming = (*extra);
2478
2479 /* Enable interrupts and restore flags. */
2480 spin_unlock_irqrestore(&lp->spinlock, flags);
2481
2482 return 0;
2483}
2484
2485/*------------------------------------------------------------------*/
2486/*
2487 * Wireless Private Handler : get quality threshold
2488 */
2489static int wavelan_get_roam(struct net_device *dev,
2490 struct iw_request_info *info,
2491 union iwreq_data *wrqu,
2492 char *extra)
2493{
2494 *(extra) = do_roaming;
2495
2496 return 0;
2497}
2498#endif /* WAVELAN_ROAMING */
2499
2500#ifdef HISTOGRAM
2501/*------------------------------------------------------------------*/
2502/*
2503 * Wireless Private Handler : set histogram
2504 */
2505static int wavelan_set_histo(struct net_device *dev,
2506 struct iw_request_info *info,
2507 union iwreq_data *wrqu,
2508 char *extra)
2509{
2510 net_local *lp = netdev_priv(dev);
2511
2512 /* Check the number of intervals. */
2513 if (wrqu->data.length > 16) {
2514 return(-E2BIG);
2515 }
2516
2517 /* Disable histo while we copy the addresses.
2518 * As we don't disable interrupts, we need to do this */
2519 lp->his_number = 0;
2520
2521 /* Are there ranges to copy? */
2522 if (wrqu->data.length > 0) {
2523 /* Copy interval ranges to the driver */
2524 memcpy(lp->his_range, extra, wrqu->data.length);
2525
2526 {
2527 int i;
2528 printk(KERN_DEBUG "Histo :");
2529 for(i = 0; i < wrqu->data.length; i++)
2530 printk(" %d", lp->his_range[i]);
2531 printk("\n");
2532 }
2533
2534 /* Reset result structure. */
2535 memset(lp->his_sum, 0x00, sizeof(long) * 16);
2536 }
2537
2538 /* Now we can set the number of ranges */
2539 lp->his_number = wrqu->data.length;
2540
2541 return(0);
2542}
2543
2544/*------------------------------------------------------------------*/
2545/*
2546 * Wireless Private Handler : get histogram
2547 */
2548static int wavelan_get_histo(struct net_device *dev,
2549 struct iw_request_info *info,
2550 union iwreq_data *wrqu,
2551 char *extra)
2552{
2553 net_local *lp = netdev_priv(dev);
2554
2555 /* Set the number of intervals. */
2556 wrqu->data.length = lp->his_number;
2557
2558 /* Give back the distribution statistics */
2559 if(lp->his_number > 0)
2560 memcpy(extra, lp->his_sum, sizeof(long) * lp->his_number);
2561
2562 return(0);
2563}
2564#endif /* HISTOGRAM */
2565
2566/*------------------------------------------------------------------*/
2567/*
2568 * Structures to export the Wireless Handlers
2569 */
2570
2571static const struct iw_priv_args wavelan_private_args[] = {
2572/*{ cmd, set_args, get_args, name } */
2573 { SIOCSIPQTHR, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, 0, "setqualthr" },
2574 { SIOCGIPQTHR, 0, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, "getqualthr" },
2575 { SIOCSIPROAM, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, 0, "setroam" },
2576 { SIOCGIPROAM, 0, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, "getroam" },
2577 { SIOCSIPHISTO, IW_PRIV_TYPE_BYTE | 16, 0, "sethisto" },
2578 { SIOCGIPHISTO, 0, IW_PRIV_TYPE_INT | 16, "gethisto" },
2579};
2580
2581static const iw_handler wavelan_handler[] =
2582{
2583 NULL, /* SIOCSIWNAME */
2584 wavelan_get_name, /* SIOCGIWNAME */
2585 wavelan_set_nwid, /* SIOCSIWNWID */
2586 wavelan_get_nwid, /* SIOCGIWNWID */
2587 wavelan_set_freq, /* SIOCSIWFREQ */
2588 wavelan_get_freq, /* SIOCGIWFREQ */
2589#ifdef WAVELAN_ROAMING
2590 wavelan_set_mode, /* SIOCSIWMODE */
2591 wavelan_get_mode, /* SIOCGIWMODE */
2592#else /* WAVELAN_ROAMING */
2593 NULL, /* SIOCSIWMODE */
2594 NULL, /* SIOCGIWMODE */
2595#endif /* WAVELAN_ROAMING */
2596 wavelan_set_sens, /* SIOCSIWSENS */
2597 wavelan_get_sens, /* SIOCGIWSENS */
2598 NULL, /* SIOCSIWRANGE */
2599 wavelan_get_range, /* SIOCGIWRANGE */
2600 NULL, /* SIOCSIWPRIV */
2601 NULL, /* SIOCGIWPRIV */
2602 NULL, /* SIOCSIWSTATS */
2603 NULL, /* SIOCGIWSTATS */
2604 iw_handler_set_spy, /* SIOCSIWSPY */
2605 iw_handler_get_spy, /* SIOCGIWSPY */
2606 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
2607 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
2608#ifdef WAVELAN_ROAMING_EXT
2609 wavelan_set_wap, /* SIOCSIWAP */
2610 wavelan_get_wap, /* SIOCGIWAP */
2611 NULL, /* -- hole -- */
2612 NULL, /* SIOCGIWAPLIST */
2613 NULL, /* -- hole -- */
2614 NULL, /* -- hole -- */
2615 wavelan_set_essid, /* SIOCSIWESSID */
2616 wavelan_get_essid, /* SIOCGIWESSID */
2617#else /* WAVELAN_ROAMING_EXT */
2618 NULL, /* SIOCSIWAP */
2619 NULL, /* SIOCGIWAP */
2620 NULL, /* -- hole -- */
2621 NULL, /* SIOCGIWAPLIST */
2622 NULL, /* -- hole -- */
2623 NULL, /* -- hole -- */
2624 NULL, /* SIOCSIWESSID */
2625 NULL, /* SIOCGIWESSID */
2626#endif /* WAVELAN_ROAMING_EXT */
2627 NULL, /* SIOCSIWNICKN */
2628 NULL, /* SIOCGIWNICKN */
2629 NULL, /* -- hole -- */
2630 NULL, /* -- hole -- */
2631 NULL, /* SIOCSIWRATE */
2632 NULL, /* SIOCGIWRATE */
2633 NULL, /* SIOCSIWRTS */
2634 NULL, /* SIOCGIWRTS */
2635 NULL, /* SIOCSIWFRAG */
2636 NULL, /* SIOCGIWFRAG */
2637 NULL, /* SIOCSIWTXPOW */
2638 NULL, /* SIOCGIWTXPOW */
2639 NULL, /* SIOCSIWRETRY */
2640 NULL, /* SIOCGIWRETRY */
2641 wavelan_set_encode, /* SIOCSIWENCODE */
2642 wavelan_get_encode, /* SIOCGIWENCODE */
2643};
2644
2645static const iw_handler wavelan_private_handler[] =
2646{
2647 wavelan_set_qthr, /* SIOCIWFIRSTPRIV */
2648 wavelan_get_qthr, /* SIOCIWFIRSTPRIV + 1 */
2649#ifdef WAVELAN_ROAMING
2650 wavelan_set_roam, /* SIOCIWFIRSTPRIV + 2 */
2651 wavelan_get_roam, /* SIOCIWFIRSTPRIV + 3 */
2652#else /* WAVELAN_ROAMING */
2653 NULL, /* SIOCIWFIRSTPRIV + 2 */
2654 NULL, /* SIOCIWFIRSTPRIV + 3 */
2655#endif /* WAVELAN_ROAMING */
2656#ifdef HISTOGRAM
2657 wavelan_set_histo, /* SIOCIWFIRSTPRIV + 4 */
2658 wavelan_get_histo, /* SIOCIWFIRSTPRIV + 5 */
2659#endif /* HISTOGRAM */
2660};
2661
2662static const struct iw_handler_def wavelan_handler_def =
2663{
Denis Chengff8ac602007-09-02 18:30:18 +08002664 .num_standard = ARRAY_SIZE(wavelan_handler),
2665 .num_private = ARRAY_SIZE(wavelan_private_handler),
2666 .num_private_args = ARRAY_SIZE(wavelan_private_args),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002667 .standard = wavelan_handler,
2668 .private = wavelan_private_handler,
2669 .private_args = wavelan_private_args,
2670 .get_wireless_stats = wavelan_get_wireless_stats,
2671};
2672
2673/*------------------------------------------------------------------*/
2674/*
2675 * Get wireless statistics
2676 * Called by /proc/net/wireless...
2677 */
2678static iw_stats *
2679wavelan_get_wireless_stats(struct net_device * dev)
2680{
Olof Johansson906da802008-02-04 22:27:35 -08002681 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002682 net_local * lp = netdev_priv(dev);
2683 mmr_t m;
2684 iw_stats * wstats;
2685 unsigned long flags;
2686
2687#ifdef DEBUG_IOCTL_TRACE
2688 printk(KERN_DEBUG "%s: ->wavelan_get_wireless_stats()\n", dev->name);
2689#endif
2690
2691 /* Disable interrupts & save flags */
2692 spin_lock_irqsave(&lp->spinlock, flags);
2693
2694 wstats = &lp->wstats;
2695
2696 /* Get data from the mmc */
2697 mmc_out(base, mmwoff(0, mmw_freeze), 1);
2698
2699 mmc_read(base, mmroff(0, mmr_dce_status), &m.mmr_dce_status, 1);
2700 mmc_read(base, mmroff(0, mmr_wrong_nwid_l), &m.mmr_wrong_nwid_l, 2);
2701 mmc_read(base, mmroff(0, mmr_thr_pre_set), &m.mmr_thr_pre_set, 4);
2702
2703 mmc_out(base, mmwoff(0, mmw_freeze), 0);
2704
2705 /* Copy data to wireless stuff */
2706 wstats->status = m.mmr_dce_status & MMR_DCE_STATUS;
2707 wstats->qual.qual = m.mmr_sgnl_qual & MMR_SGNL_QUAL;
2708 wstats->qual.level = m.mmr_signal_lvl & MMR_SIGNAL_LVL;
2709 wstats->qual.noise = m.mmr_silence_lvl & MMR_SILENCE_LVL;
2710 wstats->qual.updated = (((m.mmr_signal_lvl & MMR_SIGNAL_LVL_VALID) >> 7) |
2711 ((m.mmr_signal_lvl & MMR_SIGNAL_LVL_VALID) >> 6) |
2712 ((m.mmr_silence_lvl & MMR_SILENCE_LVL_VALID) >> 5));
2713 wstats->discard.nwid += (m.mmr_wrong_nwid_h << 8) | m.mmr_wrong_nwid_l;
2714 wstats->discard.code = 0L;
2715 wstats->discard.misc = 0L;
2716
2717 /* ReEnable interrupts & restore flags */
2718 spin_unlock_irqrestore(&lp->spinlock, flags);
2719
2720#ifdef DEBUG_IOCTL_TRACE
2721 printk(KERN_DEBUG "%s: <-wavelan_get_wireless_stats()\n", dev->name);
2722#endif
2723 return &lp->wstats;
2724}
Linus Torvalds1da177e2005-04-16 15:20:36 -07002725
2726/************************* PACKET RECEPTION *************************/
2727/*
2728 * This part deal with receiving the packets.
2729 * The interrupt handler get an interrupt when a packet has been
2730 * successfully received and called this part...
2731 */
2732
2733/*------------------------------------------------------------------*/
2734/*
2735 * Calculate the starting address of the frame pointed to by the receive
2736 * frame pointer and verify that the frame seem correct
2737 * (called by wv_packet_rcv())
2738 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02002739static int
Linus Torvalds1da177e2005-04-16 15:20:36 -07002740wv_start_of_frame(struct net_device * dev,
2741 int rfp, /* end of frame */
2742 int wrap) /* start of buffer */
2743{
Olof Johansson906da802008-02-04 22:27:35 -08002744 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002745 int rp;
2746 int len;
2747
2748 rp = (rfp - 5 + RX_SIZE) % RX_SIZE;
2749 outb(rp & 0xff, PIORL(base));
2750 outb(((rp >> 8) & PIORH_MASK), PIORH(base));
2751 len = inb(PIOP(base));
2752 len |= inb(PIOP(base)) << 8;
2753
2754 /* Sanity checks on size */
2755 /* Frame too big */
2756 if(len > MAXDATAZ + 100)
2757 {
2758#ifdef DEBUG_RX_ERROR
2759 printk(KERN_INFO "%s: wv_start_of_frame: Received frame too large, rfp %d len 0x%x\n",
2760 dev->name, rfp, len);
2761#endif
2762 return(-1);
2763 }
2764
2765 /* Frame too short */
2766 if(len < 7)
2767 {
2768#ifdef DEBUG_RX_ERROR
2769 printk(KERN_INFO "%s: wv_start_of_frame: Received null frame, rfp %d len 0x%x\n",
2770 dev->name, rfp, len);
2771#endif
2772 return(-1);
2773 }
2774
2775 /* Wrap around buffer */
2776 if(len > ((wrap - (rfp - len) + RX_SIZE) % RX_SIZE)) /* magic formula ! */
2777 {
2778#ifdef DEBUG_RX_ERROR
2779 printk(KERN_INFO "%s: wv_start_of_frame: wrap around buffer, wrap %d rfp %d len 0x%x\n",
2780 dev->name, wrap, rfp, len);
2781#endif
2782 return(-1);
2783 }
2784
2785 return((rp - len + RX_SIZE) % RX_SIZE);
2786} /* wv_start_of_frame */
2787
2788/*------------------------------------------------------------------*/
2789/*
2790 * This routine does the actual copy of data (including the ethernet
2791 * header structure) from the WaveLAN card to an sk_buff chain that
2792 * will be passed up to the network interface layer. NOTE: We
2793 * currently don't handle trailer protocols (neither does the rest of
2794 * the network interface), so if that is needed, it will (at least in
2795 * part) be added here. The contents of the receive ring buffer are
2796 * copied to a message chain that is then passed to the kernel.
2797 *
2798 * Note: if any errors occur, the packet is "dropped on the floor"
2799 * (called by wv_packet_rcv())
2800 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02002801static void
Linus Torvalds1da177e2005-04-16 15:20:36 -07002802wv_packet_read(struct net_device * dev,
2803 int fd_p,
2804 int sksize)
2805{
2806 net_local * lp = netdev_priv(dev);
2807 struct sk_buff * skb;
2808
2809#ifdef DEBUG_RX_TRACE
2810 printk(KERN_DEBUG "%s: ->wv_packet_read(0x%X, %d)\n",
2811 dev->name, fd_p, sksize);
2812#endif
2813
2814 /* Allocate some buffer for the new packet */
2815 if((skb = dev_alloc_skb(sksize+2)) == (struct sk_buff *) NULL)
2816 {
2817#ifdef DEBUG_RX_ERROR
2818 printk(KERN_INFO "%s: wv_packet_read(): could not alloc_skb(%d, GFP_ATOMIC)\n",
2819 dev->name, sksize);
2820#endif
2821 lp->stats.rx_dropped++;
2822 /*
2823 * Not only do we want to return here, but we also need to drop the
2824 * packet on the floor to clear the interrupt.
2825 */
2826 return;
2827 }
2828
Linus Torvalds1da177e2005-04-16 15:20:36 -07002829 skb_reserve(skb, 2);
2830 fd_p = read_ringbuf(dev, fd_p, (char *) skb_put(skb, sksize), sksize);
2831 skb->protocol = eth_type_trans(skb, dev);
2832
2833#ifdef DEBUG_RX_INFO
Arnaldo Carvalho de Melo98e399f2007-03-19 15:33:04 -07002834 wv_packet_info(skb_mac_header(skb), sksize, dev->name, "wv_packet_read");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002835#endif /* DEBUG_RX_INFO */
2836
2837 /* Statistics gathering & stuff associated.
2838 * It seem a bit messy with all the define, but it's really simple... */
2839 if(
2840#ifdef IW_WIRELESS_SPY
2841 (lp->spy_data.spy_number > 0) ||
2842#endif /* IW_WIRELESS_SPY */
2843#ifdef HISTOGRAM
2844 (lp->his_number > 0) ||
2845#endif /* HISTOGRAM */
2846#ifdef WAVELAN_ROAMING
2847 (do_roaming) ||
2848#endif /* WAVELAN_ROAMING */
2849 0)
2850 {
2851 u_char stats[3]; /* Signal level, Noise level, Signal quality */
2852
2853 /* read signal level, silence level and signal quality bytes */
2854 fd_p = read_ringbuf(dev, (fd_p + 4) % RX_SIZE + RX_BASE,
2855 stats, 3);
2856#ifdef DEBUG_RX_INFO
2857 printk(KERN_DEBUG "%s: wv_packet_read(): Signal level %d/63, Silence level %d/63, signal quality %d/16\n",
2858 dev->name, stats[0] & 0x3F, stats[1] & 0x3F, stats[2] & 0x0F);
2859#endif
2860
2861#ifdef WAVELAN_ROAMING
2862 if(do_roaming)
2863 if(WAVELAN_BEACON(skb->data))
2864 wl_roam_gather(dev, skb->data, stats);
2865#endif /* WAVELAN_ROAMING */
2866
2867#ifdef WIRELESS_SPY
Arnaldo Carvalho de Melo98e399f2007-03-19 15:33:04 -07002868 wl_spy_gather(dev, skb_mac_header(skb) + WAVELAN_ADDR_SIZE, stats);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002869#endif /* WIRELESS_SPY */
2870#ifdef HISTOGRAM
2871 wl_his_gather(dev, stats);
2872#endif /* HISTOGRAM */
2873 }
2874
2875 /*
2876 * Hand the packet to the Network Module
2877 */
2878 netif_rx(skb);
2879
2880 /* Keep stats up to date */
2881 dev->last_rx = jiffies;
2882 lp->stats.rx_packets++;
2883 lp->stats.rx_bytes += sksize;
2884
2885#ifdef DEBUG_RX_TRACE
2886 printk(KERN_DEBUG "%s: <-wv_packet_read()\n", dev->name);
2887#endif
2888 return;
2889}
2890
2891/*------------------------------------------------------------------*/
2892/*
2893 * This routine is called by the interrupt handler to initiate a
2894 * packet transfer from the card to the network interface layer above
2895 * this driver. This routine checks if a buffer has been successfully
2896 * received by the WaveLAN card. If so, the routine wv_packet_read is
2897 * called to do the actual transfer of the card's data including the
2898 * ethernet header into a packet consisting of an sk_buff chain.
2899 * (called by wavelan_interrupt())
2900 * Note : the spinlock is already grabbed for us and irq are disabled.
2901 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02002902static void
Linus Torvalds1da177e2005-04-16 15:20:36 -07002903wv_packet_rcv(struct net_device * dev)
2904{
Olof Johansson906da802008-02-04 22:27:35 -08002905 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002906 net_local * lp = netdev_priv(dev);
2907 int newrfp;
2908 int rp;
2909 int len;
2910 int f_start;
2911 int status;
2912 int i593_rfp;
2913 int stat_ptr;
2914 u_char c[4];
2915
2916#ifdef DEBUG_RX_TRACE
2917 printk(KERN_DEBUG "%s: ->wv_packet_rcv()\n", dev->name);
2918#endif
2919
2920 /* Get the new receive frame pointer from the i82593 chip */
2921 outb(CR0_STATUS_2 | OP0_NOP, LCCR(base));
2922 i593_rfp = inb(LCSR(base));
2923 i593_rfp |= inb(LCSR(base)) << 8;
2924 i593_rfp %= RX_SIZE;
2925
2926 /* Get the new receive frame pointer from the WaveLAN card.
2927 * It is 3 bytes more than the increment of the i82593 receive
2928 * frame pointer, for each packet. This is because it includes the
2929 * 3 roaming bytes added by the mmc.
2930 */
2931 newrfp = inb(RPLL(base));
2932 newrfp |= inb(RPLH(base)) << 8;
2933 newrfp %= RX_SIZE;
2934
2935#ifdef DEBUG_RX_INFO
2936 printk(KERN_DEBUG "%s: wv_packet_rcv(): i593_rfp %d stop %d newrfp %d lp->rfp %d\n",
2937 dev->name, i593_rfp, lp->stop, newrfp, lp->rfp);
2938#endif
2939
2940#ifdef DEBUG_RX_ERROR
2941 /* If no new frame pointer... */
2942 if(lp->overrunning || newrfp == lp->rfp)
2943 printk(KERN_INFO "%s: wv_packet_rcv(): no new frame: i593_rfp %d stop %d newrfp %d lp->rfp %d\n",
2944 dev->name, i593_rfp, lp->stop, newrfp, lp->rfp);
2945#endif
2946
2947 /* Read all frames (packets) received */
2948 while(newrfp != lp->rfp)
2949 {
2950 /* A frame is composed of the packet, followed by a status word,
2951 * the length of the frame (word) and the mmc info (SNR & qual).
2952 * It's because the length is at the end that we can only scan
2953 * frames backward. */
2954
2955 /* Find the first frame by skipping backwards over the frames */
2956 rp = newrfp; /* End of last frame */
2957 while(((f_start = wv_start_of_frame(dev, rp, newrfp)) != lp->rfp) &&
2958 (f_start != -1))
2959 rp = f_start;
2960
2961 /* If we had a problem */
2962 if(f_start == -1)
2963 {
2964#ifdef DEBUG_RX_ERROR
2965 printk(KERN_INFO "wavelan_cs: cannot find start of frame ");
2966 printk(" i593_rfp %d stop %d newrfp %d lp->rfp %d\n",
2967 i593_rfp, lp->stop, newrfp, lp->rfp);
2968#endif
2969 lp->rfp = rp; /* Get to the last usable frame */
2970 continue;
2971 }
2972
2973 /* f_start point to the beggining of the first frame received
2974 * and rp to the beggining of the next one */
2975
2976 /* Read status & length of the frame */
2977 stat_ptr = (rp - 7 + RX_SIZE) % RX_SIZE;
2978 stat_ptr = read_ringbuf(dev, stat_ptr, c, 4);
2979 status = c[0] | (c[1] << 8);
2980 len = c[2] | (c[3] << 8);
2981
2982 /* Check status */
2983 if((status & RX_RCV_OK) != RX_RCV_OK)
2984 {
2985 lp->stats.rx_errors++;
2986 if(status & RX_NO_SFD)
2987 lp->stats.rx_frame_errors++;
2988 if(status & RX_CRC_ERR)
2989 lp->stats.rx_crc_errors++;
2990 if(status & RX_OVRRUN)
2991 lp->stats.rx_over_errors++;
2992
2993#ifdef DEBUG_RX_FAIL
2994 printk(KERN_DEBUG "%s: wv_packet_rcv(): packet not received ok, status = 0x%x\n",
2995 dev->name, status);
2996#endif
2997 }
2998 else
2999 /* Read the packet and transmit to Linux */
3000 wv_packet_read(dev, f_start, len - 2);
3001
3002 /* One frame has been processed, skip it */
3003 lp->rfp = rp;
3004 }
3005
3006 /*
3007 * Update the frame stop register, but set it to less than
3008 * the full 8K to allow space for 3 bytes of signal strength
3009 * per packet.
3010 */
3011 lp->stop = (i593_rfp + RX_SIZE - ((RX_SIZE / 64) * 3)) % RX_SIZE;
3012 outb(OP0_SWIT_TO_PORT_1 | CR0_CHNL, LCCR(base));
3013 outb(CR1_STOP_REG_UPDATE | (lp->stop >> RX_SIZE_SHIFT), LCCR(base));
3014 outb(OP1_SWIT_TO_PORT_0, LCCR(base));
3015
3016#ifdef DEBUG_RX_TRACE
3017 printk(KERN_DEBUG "%s: <-wv_packet_rcv()\n", dev->name);
3018#endif
3019}
3020
3021/*********************** PACKET TRANSMISSION ***********************/
3022/*
3023 * This part deal with sending packet through the wavelan
3024 * We copy the packet to the send buffer and then issue the send
3025 * command to the i82593. The result of this operation will be
3026 * checked in wavelan_interrupt()
3027 */
3028
3029/*------------------------------------------------------------------*/
3030/*
3031 * This routine fills in the appropriate registers and memory
3032 * locations on the WaveLAN card and starts the card off on
3033 * the transmit.
3034 * (called in wavelan_packet_xmit())
3035 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02003036static void
Linus Torvalds1da177e2005-04-16 15:20:36 -07003037wv_packet_write(struct net_device * dev,
3038 void * buf,
3039 short length)
3040{
3041 net_local * lp = netdev_priv(dev);
Olof Johansson906da802008-02-04 22:27:35 -08003042 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003043 unsigned long flags;
3044 int clen = length;
3045 register u_short xmtdata_base = TX_BASE;
3046
3047#ifdef DEBUG_TX_TRACE
3048 printk(KERN_DEBUG "%s: ->wv_packet_write(%d)\n", dev->name, length);
3049#endif
3050
3051 spin_lock_irqsave(&lp->spinlock, flags);
3052
3053 /* Write the length of data buffer followed by the buffer */
3054 outb(xmtdata_base & 0xff, PIORL(base));
3055 outb(((xmtdata_base >> 8) & PIORH_MASK) | PIORH_SEL_TX, PIORH(base));
3056 outb(clen & 0xff, PIOP(base)); /* lsb */
3057 outb(clen >> 8, PIOP(base)); /* msb */
3058
3059 /* Send the data */
3060 outsb(PIOP(base), buf, clen);
3061
3062 /* Indicate end of transmit chain */
3063 outb(OP0_NOP, PIOP(base));
3064 /* josullvn@cs.cmu.edu: need to send a second NOP for alignment... */
3065 outb(OP0_NOP, PIOP(base));
3066
3067 /* Reset the transmit DMA pointer */
3068 hacr_write_slow(base, HACR_PWR_STAT | HACR_TX_DMA_RESET);
3069 hacr_write(base, HACR_DEFAULT);
3070 /* Send the transmit command */
3071 wv_82593_cmd(dev, "wv_packet_write(): transmit",
3072 OP0_TRANSMIT, SR0_NO_RESULT);
3073
3074 /* Make sure the watchdog will keep quiet for a while */
3075 dev->trans_start = jiffies;
3076
3077 /* Keep stats up to date */
3078 lp->stats.tx_bytes += length;
3079
3080 spin_unlock_irqrestore(&lp->spinlock, flags);
3081
3082#ifdef DEBUG_TX_INFO
3083 wv_packet_info((u_char *) buf, length, dev->name, "wv_packet_write");
3084#endif /* DEBUG_TX_INFO */
3085
3086#ifdef DEBUG_TX_TRACE
3087 printk(KERN_DEBUG "%s: <-wv_packet_write()\n", dev->name);
3088#endif
3089}
3090
3091/*------------------------------------------------------------------*/
3092/*
3093 * This routine is called when we want to send a packet (NET3 callback)
3094 * In this routine, we check if the harware is ready to accept
3095 * the packet. We also prevent reentrance. Then, we call the function
3096 * to send the packet...
3097 */
3098static int
3099wavelan_packet_xmit(struct sk_buff * skb,
3100 struct net_device * dev)
3101{
3102 net_local * lp = netdev_priv(dev);
3103 unsigned long flags;
3104
3105#ifdef DEBUG_TX_TRACE
3106 printk(KERN_DEBUG "%s: ->wavelan_packet_xmit(0x%X)\n", dev->name,
3107 (unsigned) skb);
3108#endif
3109
3110 /*
3111 * Block a timer-based transmit from overlapping a previous transmit.
3112 * In other words, prevent reentering this routine.
3113 */
3114 netif_stop_queue(dev);
3115
3116 /* If somebody has asked to reconfigure the controller,
3117 * we can do it now */
3118 if(lp->reconfig_82593)
3119 {
3120 spin_lock_irqsave(&lp->spinlock, flags); /* Disable interrupts */
3121 wv_82593_config(dev);
3122 spin_unlock_irqrestore(&lp->spinlock, flags); /* Re-enable interrupts */
3123 /* Note : the configure procedure was totally synchronous,
3124 * so the Tx buffer is now free */
3125 }
3126
3127#ifdef DEBUG_TX_ERROR
3128 if (skb->next)
3129 printk(KERN_INFO "skb has next\n");
3130#endif
3131
3132 /* Check if we need some padding */
3133 /* Note : on wireless the propagation time is in the order of 1us,
3134 * and we don't have the Ethernet specific requirement of beeing
3135 * able to detect collisions, therefore in theory we don't really
3136 * need to pad. Jean II */
Herbert Xu5b057c62006-06-23 02:06:41 -07003137 if (skb_padto(skb, ETH_ZLEN))
3138 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003139
3140 wv_packet_write(dev, skb->data, skb->len);
3141
3142 dev_kfree_skb(skb);
3143
3144#ifdef DEBUG_TX_TRACE
3145 printk(KERN_DEBUG "%s: <-wavelan_packet_xmit()\n", dev->name);
3146#endif
3147 return(0);
3148}
3149
3150/********************** HARDWARE CONFIGURATION **********************/
3151/*
3152 * This part do the real job of starting and configuring the hardware.
3153 */
3154
3155/*------------------------------------------------------------------*/
3156/*
3157 * Routine to initialize the Modem Management Controller.
3158 * (called by wv_hw_config())
3159 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02003160static int
Linus Torvalds1da177e2005-04-16 15:20:36 -07003161wv_mmc_init(struct net_device * dev)
3162{
Olof Johansson906da802008-02-04 22:27:35 -08003163 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003164 psa_t psa;
3165 mmw_t m;
3166 int configured;
3167 int i; /* Loop counter */
3168
3169#ifdef DEBUG_CONFIG_TRACE
3170 printk(KERN_DEBUG "%s: ->wv_mmc_init()\n", dev->name);
3171#endif
3172
3173 /* Read the parameter storage area */
3174 psa_read(dev, 0, (unsigned char *) &psa, sizeof(psa));
3175
3176 /*
3177 * Check the first three octets of the MAC addr for the manufacturer's code.
3178 * Note: If you get the error message below, you've got a
3179 * non-NCR/AT&T/Lucent PCMCIA cards, see wavelan_cs.h for detail on
3180 * how to configure your card...
3181 */
Jeff Garzik93a3b602007-11-23 21:50:20 -05003182 for (i = 0; i < ARRAY_SIZE(MAC_ADDRESSES); i++)
3183 if ((psa.psa_univ_mac_addr[0] == MAC_ADDRESSES[i][0]) &&
3184 (psa.psa_univ_mac_addr[1] == MAC_ADDRESSES[i][1]) &&
3185 (psa.psa_univ_mac_addr[2] == MAC_ADDRESSES[i][2]))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003186 break;
3187
3188 /* If we have not found it... */
Jeff Garzik93a3b602007-11-23 21:50:20 -05003189 if (i == ARRAY_SIZE(MAC_ADDRESSES))
Linus Torvalds1da177e2005-04-16 15:20:36 -07003190 {
3191#ifdef DEBUG_CONFIG_ERRORS
3192 printk(KERN_WARNING "%s: wv_mmc_init(): Invalid MAC address: %02X:%02X:%02X:...\n",
3193 dev->name, psa.psa_univ_mac_addr[0],
3194 psa.psa_univ_mac_addr[1], psa.psa_univ_mac_addr[2]);
3195#endif
3196 return FALSE;
3197 }
3198
3199 /* Get the MAC address */
3200 memcpy(&dev->dev_addr[0], &psa.psa_univ_mac_addr[0], WAVELAN_ADDR_SIZE);
3201
3202#ifdef USE_PSA_CONFIG
3203 configured = psa.psa_conf_status & 1;
3204#else
3205 configured = 0;
3206#endif
3207
3208 /* Is the PSA is not configured */
3209 if(!configured)
3210 {
3211 /* User will be able to configure NWID after (with iwconfig) */
3212 psa.psa_nwid[0] = 0;
3213 psa.psa_nwid[1] = 0;
3214
3215 /* As NWID is not set : no NWID checking */
3216 psa.psa_nwid_select = 0;
3217
3218 /* Disable encryption */
3219 psa.psa_encryption_select = 0;
3220
3221 /* Set to standard values
3222 * 0x04 for AT,
3223 * 0x01 for MCA,
3224 * 0x04 for PCMCIA and 2.00 card (AT&T 407-024689/E document)
3225 */
3226 if (psa.psa_comp_number & 1)
3227 psa.psa_thr_pre_set = 0x01;
3228 else
3229 psa.psa_thr_pre_set = 0x04;
3230 psa.psa_quality_thr = 0x03;
3231
3232 /* It is configured */
3233 psa.psa_conf_status |= 1;
3234
3235#ifdef USE_PSA_CONFIG
3236 /* Write the psa */
3237 psa_write(dev, (char *)psa.psa_nwid - (char *)&psa,
3238 (unsigned char *)psa.psa_nwid, 4);
3239 psa_write(dev, (char *)&psa.psa_thr_pre_set - (char *)&psa,
3240 (unsigned char *)&psa.psa_thr_pre_set, 1);
3241 psa_write(dev, (char *)&psa.psa_quality_thr - (char *)&psa,
3242 (unsigned char *)&psa.psa_quality_thr, 1);
3243 psa_write(dev, (char *)&psa.psa_conf_status - (char *)&psa,
3244 (unsigned char *)&psa.psa_conf_status, 1);
3245 /* update the Wavelan checksum */
3246 update_psa_checksum(dev);
3247#endif /* USE_PSA_CONFIG */
3248 }
3249
3250 /* Zero the mmc structure */
3251 memset(&m, 0x00, sizeof(m));
3252
3253 /* Copy PSA info to the mmc */
3254 m.mmw_netw_id_l = psa.psa_nwid[1];
3255 m.mmw_netw_id_h = psa.psa_nwid[0];
3256
3257 if(psa.psa_nwid_select & 1)
3258 m.mmw_loopt_sel = 0x00;
3259 else
3260 m.mmw_loopt_sel = MMW_LOOPT_SEL_DIS_NWID;
3261
3262 memcpy(&m.mmw_encr_key, &psa.psa_encryption_key,
3263 sizeof(m.mmw_encr_key));
3264
3265 if(psa.psa_encryption_select)
3266 m.mmw_encr_enable = MMW_ENCR_ENABLE_EN | MMW_ENCR_ENABLE_MODE;
3267 else
3268 m.mmw_encr_enable = 0;
3269
3270 m.mmw_thr_pre_set = psa.psa_thr_pre_set & 0x3F;
3271 m.mmw_quality_thr = psa.psa_quality_thr & 0x0F;
3272
3273 /*
3274 * Set default modem control parameters.
3275 * See NCR document 407-0024326 Rev. A.
3276 */
3277 m.mmw_jabber_enable = 0x01;
3278 m.mmw_anten_sel = MMW_ANTEN_SEL_ALG_EN;
3279 m.mmw_ifs = 0x20;
3280 m.mmw_mod_delay = 0x04;
3281 m.mmw_jam_time = 0x38;
3282
3283 m.mmw_des_io_invert = 0;
3284 m.mmw_freeze = 0;
3285 m.mmw_decay_prm = 0;
3286 m.mmw_decay_updat_prm = 0;
3287
3288 /* Write all info to mmc */
3289 mmc_write(base, 0, (u_char *)&m, sizeof(m));
3290
3291 /* The following code start the modem of the 2.00 frequency
3292 * selectable cards at power on. It's not strictly needed for the
3293 * following boots...
3294 * The original patch was by Joe Finney for the PCMCIA driver, but
3295 * I've cleaned it a bit and add documentation.
3296 * Thanks to Loeke Brederveld from Lucent for the info.
3297 */
3298
3299 /* Attempt to recognise 2.00 cards (2.4 GHz frequency selectable)
3300 * (does it work for everybody ? - especially old cards...) */
3301 /* Note : WFREQSEL verify that it is able to read from EEprom
3302 * a sensible frequency (address 0x00) + that MMR_FEE_STATUS_ID
3303 * is 0xA (Xilinx version) or 0xB (Ariadne version).
3304 * My test is more crude but do work... */
3305 if(!(mmc_in(base, mmroff(0, mmr_fee_status)) &
3306 (MMR_FEE_STATUS_DWLD | MMR_FEE_STATUS_BUSY)))
3307 {
3308 /* We must download the frequency parameters to the
3309 * synthetisers (from the EEprom - area 1)
3310 * Note : as the EEprom is auto decremented, we set the end
3311 * if the area... */
3312 m.mmw_fee_addr = 0x0F;
3313 m.mmw_fee_ctrl = MMW_FEE_CTRL_READ | MMW_FEE_CTRL_DWLD;
3314 mmc_write(base, (char *)&m.mmw_fee_ctrl - (char *)&m,
3315 (unsigned char *)&m.mmw_fee_ctrl, 2);
3316
3317 /* Wait until the download is finished */
3318 fee_wait(base, 100, 100);
3319
3320#ifdef DEBUG_CONFIG_INFO
3321 /* The frequency was in the last word downloaded... */
3322 mmc_read(base, (char *)&m.mmw_fee_data_l - (char *)&m,
3323 (unsigned char *)&m.mmw_fee_data_l, 2);
3324
3325 /* Print some info for the user */
3326 printk(KERN_DEBUG "%s: Wavelan 2.00 recognised (frequency select) : Current frequency = %ld\n",
3327 dev->name,
3328 ((m.mmw_fee_data_h << 4) |
3329 (m.mmw_fee_data_l >> 4)) * 5 / 2 + 24000L);
3330#endif
3331
3332 /* We must now download the power adjust value (gain) to
3333 * the synthetisers (from the EEprom - area 7 - DAC) */
3334 m.mmw_fee_addr = 0x61;
3335 m.mmw_fee_ctrl = MMW_FEE_CTRL_READ | MMW_FEE_CTRL_DWLD;
3336 mmc_write(base, (char *)&m.mmw_fee_ctrl - (char *)&m,
3337 (unsigned char *)&m.mmw_fee_ctrl, 2);
3338
3339 /* Wait until the download is finished */
3340 } /* if 2.00 card */
3341
3342#ifdef DEBUG_CONFIG_TRACE
3343 printk(KERN_DEBUG "%s: <-wv_mmc_init()\n", dev->name);
3344#endif
3345 return TRUE;
3346}
3347
3348/*------------------------------------------------------------------*/
3349/*
3350 * Routine to gracefully turn off reception, and wait for any commands
3351 * to complete.
3352 * (called in wv_ru_start() and wavelan_close() and wavelan_event())
3353 */
3354static int
3355wv_ru_stop(struct net_device * dev)
3356{
Olof Johansson906da802008-02-04 22:27:35 -08003357 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003358 net_local * lp = netdev_priv(dev);
3359 unsigned long flags;
3360 int status;
3361 int spin;
3362
3363#ifdef DEBUG_CONFIG_TRACE
3364 printk(KERN_DEBUG "%s: ->wv_ru_stop()\n", dev->name);
3365#endif
3366
3367 spin_lock_irqsave(&lp->spinlock, flags);
3368
3369 /* First, send the LAN controller a stop receive command */
3370 wv_82593_cmd(dev, "wv_graceful_shutdown(): stop-rcv",
3371 OP0_STOP_RCV, SR0_NO_RESULT);
3372
3373 /* Then, spin until the receive unit goes idle */
3374 spin = 300;
3375 do
3376 {
3377 udelay(10);
3378 outb(OP0_NOP | CR0_STATUS_3, LCCR(base));
3379 status = inb(LCSR(base));
3380 }
3381 while(((status & SR3_RCV_STATE_MASK) != SR3_RCV_IDLE) && (spin-- > 0));
3382
3383 /* Now, spin until the chip finishes executing its current command */
3384 do
3385 {
3386 udelay(10);
3387 outb(OP0_NOP | CR0_STATUS_3, LCCR(base));
3388 status = inb(LCSR(base));
3389 }
3390 while(((status & SR3_EXEC_STATE_MASK) != SR3_EXEC_IDLE) && (spin-- > 0));
3391
3392 spin_unlock_irqrestore(&lp->spinlock, flags);
3393
3394 /* If there was a problem */
3395 if(spin <= 0)
3396 {
3397#ifdef DEBUG_CONFIG_ERRORS
3398 printk(KERN_INFO "%s: wv_ru_stop(): The chip doesn't want to stop...\n",
3399 dev->name);
3400#endif
3401 return FALSE;
3402 }
3403
3404#ifdef DEBUG_CONFIG_TRACE
3405 printk(KERN_DEBUG "%s: <-wv_ru_stop()\n", dev->name);
3406#endif
3407 return TRUE;
3408} /* wv_ru_stop */
3409
3410/*------------------------------------------------------------------*/
3411/*
3412 * This routine starts the receive unit running. First, it checks if
3413 * the card is actually ready. Then the card is instructed to receive
3414 * packets again.
3415 * (called in wv_hw_reset() & wavelan_open())
3416 */
3417static int
3418wv_ru_start(struct net_device * dev)
3419{
Olof Johansson906da802008-02-04 22:27:35 -08003420 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003421 net_local * lp = netdev_priv(dev);
3422 unsigned long flags;
3423
3424#ifdef DEBUG_CONFIG_TRACE
3425 printk(KERN_DEBUG "%s: ->wv_ru_start()\n", dev->name);
3426#endif
3427
3428 /*
3429 * We need to start from a quiescent state. To do so, we could check
3430 * if the card is already running, but instead we just try to shut
3431 * it down. First, we disable reception (in case it was already enabled).
3432 */
3433 if(!wv_ru_stop(dev))
3434 return FALSE;
3435
3436 spin_lock_irqsave(&lp->spinlock, flags);
3437
3438 /* Now we know that no command is being executed. */
3439
3440 /* Set the receive frame pointer and stop pointer */
3441 lp->rfp = 0;
3442 outb(OP0_SWIT_TO_PORT_1 | CR0_CHNL, LCCR(base));
3443
3444 /* Reset ring management. This sets the receive frame pointer to 1 */
3445 outb(OP1_RESET_RING_MNGMT, LCCR(base));
3446
3447#if 0
3448 /* XXX the i82593 manual page 6-4 seems to indicate that the stop register
3449 should be set as below */
3450 /* outb(CR1_STOP_REG_UPDATE|((RX_SIZE - 0x40)>> RX_SIZE_SHIFT),LCCR(base));*/
3451#elif 0
3452 /* but I set it 0 instead */
3453 lp->stop = 0;
3454#else
3455 /* but I set it to 3 bytes per packet less than 8K */
3456 lp->stop = (0 + RX_SIZE - ((RX_SIZE / 64) * 3)) % RX_SIZE;
3457#endif
3458 outb(CR1_STOP_REG_UPDATE | (lp->stop >> RX_SIZE_SHIFT), LCCR(base));
3459 outb(OP1_INT_ENABLE, LCCR(base));
3460 outb(OP1_SWIT_TO_PORT_0, LCCR(base));
3461
3462 /* Reset receive DMA pointer */
3463 hacr_write_slow(base, HACR_PWR_STAT | HACR_TX_DMA_RESET);
3464 hacr_write_slow(base, HACR_DEFAULT);
3465
3466 /* Receive DMA on channel 1 */
3467 wv_82593_cmd(dev, "wv_ru_start(): rcv-enable",
3468 CR0_CHNL | OP0_RCV_ENABLE, SR0_NO_RESULT);
3469
3470#ifdef DEBUG_I82593_SHOW
3471 {
3472 int status;
3473 int opri;
3474 int spin = 10000;
3475
3476 /* spin until the chip starts receiving */
3477 do
3478 {
3479 outb(OP0_NOP | CR0_STATUS_3, LCCR(base));
3480 status = inb(LCSR(base));
3481 if(spin-- <= 0)
3482 break;
3483 }
3484 while(((status & SR3_RCV_STATE_MASK) != SR3_RCV_ACTIVE) &&
3485 ((status & SR3_RCV_STATE_MASK) != SR3_RCV_READY));
3486 printk(KERN_DEBUG "rcv status is 0x%x [i:%d]\n",
3487 (status & SR3_RCV_STATE_MASK), i);
3488 }
3489#endif
3490
3491 spin_unlock_irqrestore(&lp->spinlock, flags);
3492
3493#ifdef DEBUG_CONFIG_TRACE
3494 printk(KERN_DEBUG "%s: <-wv_ru_start()\n", dev->name);
3495#endif
3496 return TRUE;
3497}
3498
3499/*------------------------------------------------------------------*/
3500/*
3501 * This routine does a standard config of the WaveLAN controller (i82593).
3502 * In the ISA driver, this is integrated in wavelan_hardware_reset()
3503 * (called by wv_hw_config(), wv_82593_reconfig() & wavelan_packet_xmit())
3504 */
3505static int
3506wv_82593_config(struct net_device * dev)
3507{
Olof Johansson906da802008-02-04 22:27:35 -08003508 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003509 net_local * lp = netdev_priv(dev);
3510 struct i82593_conf_block cfblk;
3511 int ret = TRUE;
3512
3513#ifdef DEBUG_CONFIG_TRACE
3514 printk(KERN_DEBUG "%s: ->wv_82593_config()\n", dev->name);
3515#endif
3516
3517 /* Create & fill i82593 config block
3518 *
3519 * Now conform to Wavelan document WCIN085B
3520 */
3521 memset(&cfblk, 0x00, sizeof(struct i82593_conf_block));
3522 cfblk.d6mod = FALSE; /* Run in i82593 advanced mode */
3523 cfblk.fifo_limit = 5; /* = 56 B rx and 40 B tx fifo thresholds */
3524 cfblk.forgnesi = FALSE; /* 0=82C501, 1=AMD7992B compatibility */
3525 cfblk.fifo_32 = 1;
3526 cfblk.throttle_enb = FALSE;
3527 cfblk.contin = TRUE; /* enable continuous mode */
3528 cfblk.cntrxint = FALSE; /* enable continuous mode receive interrupts */
3529 cfblk.addr_len = WAVELAN_ADDR_SIZE;
3530 cfblk.acloc = TRUE; /* Disable source addr insertion by i82593 */
3531 cfblk.preamb_len = 0; /* 2 bytes preamble (SFD) */
3532 cfblk.loopback = FALSE;
Robert P. J. Dayd08df602007-02-17 19:07:33 +01003533 cfblk.lin_prio = 0; /* conform to 802.3 backoff algorithm */
3534 cfblk.exp_prio = 5; /* conform to 802.3 backoff algorithm */
3535 cfblk.bof_met = 1; /* conform to 802.3 backoff algorithm */
Jean Tourrilhesaca0b512006-02-16 17:44:54 -08003536 cfblk.ifrm_spc = 0x20 >> 4; /* 32 bit times interframe spacing */
3537 cfblk.slottim_low = 0x20 >> 5; /* 32 bit times slot time */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003538 cfblk.slottim_hi = 0x0;
3539 cfblk.max_retr = 15;
3540 cfblk.prmisc = ((lp->promiscuous) ? TRUE: FALSE); /* Promiscuous mode */
3541 cfblk.bc_dis = FALSE; /* Enable broadcast reception */
3542 cfblk.crs_1 = TRUE; /* Transmit without carrier sense */
3543 cfblk.nocrc_ins = FALSE; /* i82593 generates CRC */
3544 cfblk.crc_1632 = FALSE; /* 32-bit Autodin-II CRC */
3545 cfblk.crs_cdt = FALSE; /* CD not to be interpreted as CS */
3546 cfblk.cs_filter = 0; /* CS is recognized immediately */
3547 cfblk.crs_src = FALSE; /* External carrier sense */
3548 cfblk.cd_filter = 0; /* CD is recognized immediately */
3549 cfblk.min_fr_len = ETH_ZLEN >> 2; /* Minimum frame length 64 bytes */
3550 cfblk.lng_typ = FALSE; /* Length field > 1500 = type field */
3551 cfblk.lng_fld = TRUE; /* Disable 802.3 length field check */
3552 cfblk.rxcrc_xf = TRUE; /* Don't transfer CRC to memory */
3553 cfblk.artx = TRUE; /* Disable automatic retransmission */
3554 cfblk.sarec = TRUE; /* Disable source addr trig of CD */
3555 cfblk.tx_jabber = TRUE; /* Disable jabber jam sequence */
3556 cfblk.hash_1 = FALSE; /* Use bits 0-5 in mc address hash */
3557 cfblk.lbpkpol = TRUE; /* Loopback pin active high */
3558 cfblk.fdx = FALSE; /* Disable full duplex operation */
3559 cfblk.dummy_6 = 0x3f; /* all ones */
3560 cfblk.mult_ia = FALSE; /* No multiple individual addresses */
3561 cfblk.dis_bof = FALSE; /* Disable the backoff algorithm ?! */
3562 cfblk.dummy_1 = TRUE; /* set to 1 */
3563 cfblk.tx_ifs_retrig = 3; /* Hmm... Disabled */
3564#ifdef MULTICAST_ALL
3565 cfblk.mc_all = (lp->allmulticast ? TRUE: FALSE); /* Allow all multicasts */
3566#else
3567 cfblk.mc_all = FALSE; /* No multicast all mode */
3568#endif
3569 cfblk.rcv_mon = 0; /* Monitor mode disabled */
3570 cfblk.frag_acpt = TRUE; /* Do not accept fragments */
3571 cfblk.tstrttrs = FALSE; /* No start transmission threshold */
3572 cfblk.fretx = TRUE; /* FIFO automatic retransmission */
3573 cfblk.syncrqs = FALSE; /* Synchronous DRQ deassertion... */
3574 cfblk.sttlen = TRUE; /* 6 byte status registers */
3575 cfblk.rx_eop = TRUE; /* Signal EOP on packet reception */
3576 cfblk.tx_eop = TRUE; /* Signal EOP on packet transmission */
3577 cfblk.rbuf_size = RX_SIZE>>11; /* Set receive buffer size */
3578 cfblk.rcvstop = TRUE; /* Enable Receive Stop Register */
3579
3580#ifdef DEBUG_I82593_SHOW
3581 {
3582 u_char *c = (u_char *) &cfblk;
3583 int i;
3584 printk(KERN_DEBUG "wavelan_cs: config block:");
3585 for(i = 0; i < sizeof(struct i82593_conf_block); i++,c++)
3586 {
3587 if((i % 16) == 0) printk("\n" KERN_DEBUG);
3588 printk("%02x ", *c);
3589 }
3590 printk("\n");
3591 }
3592#endif
3593
3594 /* Copy the config block to the i82593 */
3595 outb(TX_BASE & 0xff, PIORL(base));
3596 outb(((TX_BASE >> 8) & PIORH_MASK) | PIORH_SEL_TX, PIORH(base));
3597 outb(sizeof(struct i82593_conf_block) & 0xff, PIOP(base)); /* lsb */
3598 outb(sizeof(struct i82593_conf_block) >> 8, PIOP(base)); /* msb */
3599 outsb(PIOP(base), (char *) &cfblk, sizeof(struct i82593_conf_block));
3600
3601 /* reset transmit DMA pointer */
3602 hacr_write_slow(base, HACR_PWR_STAT | HACR_TX_DMA_RESET);
3603 hacr_write(base, HACR_DEFAULT);
3604 if(!wv_82593_cmd(dev, "wv_82593_config(): configure",
3605 OP0_CONFIGURE, SR0_CONFIGURE_DONE))
3606 ret = FALSE;
3607
3608 /* Initialize adapter's ethernet MAC address */
3609 outb(TX_BASE & 0xff, PIORL(base));
3610 outb(((TX_BASE >> 8) & PIORH_MASK) | PIORH_SEL_TX, PIORH(base));
3611 outb(WAVELAN_ADDR_SIZE, PIOP(base)); /* byte count lsb */
3612 outb(0, PIOP(base)); /* byte count msb */
3613 outsb(PIOP(base), &dev->dev_addr[0], WAVELAN_ADDR_SIZE);
3614
3615 /* reset transmit DMA pointer */
3616 hacr_write_slow(base, HACR_PWR_STAT | HACR_TX_DMA_RESET);
3617 hacr_write(base, HACR_DEFAULT);
3618 if(!wv_82593_cmd(dev, "wv_82593_config(): ia-setup",
3619 OP0_IA_SETUP, SR0_IA_SETUP_DONE))
3620 ret = FALSE;
3621
3622#ifdef WAVELAN_ROAMING
3623 /* If roaming is enabled, join the "Beacon Request" multicast group... */
3624 /* But only if it's not in there already! */
3625 if(do_roaming)
3626 dev_mc_add(dev,WAVELAN_BEACON_ADDRESS, WAVELAN_ADDR_SIZE, 1);
3627#endif /* WAVELAN_ROAMING */
3628
3629 /* If any multicast address to set */
3630 if(lp->mc_count)
3631 {
3632 struct dev_mc_list * dmi;
3633 int addrs_len = WAVELAN_ADDR_SIZE * lp->mc_count;
3634
3635#ifdef DEBUG_CONFIG_INFO
3636 printk(KERN_DEBUG "%s: wv_hw_config(): set %d multicast addresses:\n",
3637 dev->name, lp->mc_count);
3638 for(dmi=dev->mc_list; dmi; dmi=dmi->next)
Johannes Berge1749612008-10-27 15:59:26 -07003639 printk(KERN_DEBUG " %pM\n", dmi->dmi_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003640#endif
3641
3642 /* Initialize adapter's ethernet multicast addresses */
3643 outb(TX_BASE & 0xff, PIORL(base));
3644 outb(((TX_BASE >> 8) & PIORH_MASK) | PIORH_SEL_TX, PIORH(base));
3645 outb(addrs_len & 0xff, PIOP(base)); /* byte count lsb */
3646 outb((addrs_len >> 8), PIOP(base)); /* byte count msb */
3647 for(dmi=dev->mc_list; dmi; dmi=dmi->next)
3648 outsb(PIOP(base), dmi->dmi_addr, dmi->dmi_addrlen);
3649
3650 /* reset transmit DMA pointer */
3651 hacr_write_slow(base, HACR_PWR_STAT | HACR_TX_DMA_RESET);
3652 hacr_write(base, HACR_DEFAULT);
3653 if(!wv_82593_cmd(dev, "wv_82593_config(): mc-setup",
3654 OP0_MC_SETUP, SR0_MC_SETUP_DONE))
3655 ret = FALSE;
3656 lp->mc_count = dev->mc_count; /* remember to avoid repeated reset */
3657 }
3658
3659 /* Job done, clear the flag */
3660 lp->reconfig_82593 = FALSE;
3661
3662#ifdef DEBUG_CONFIG_TRACE
3663 printk(KERN_DEBUG "%s: <-wv_82593_config()\n", dev->name);
3664#endif
3665 return(ret);
3666}
3667
3668/*------------------------------------------------------------------*/
3669/*
3670 * Read the Access Configuration Register, perform a software reset,
3671 * and then re-enable the card's software.
3672 *
3673 * If I understand correctly : reset the pcmcia interface of the
3674 * wavelan.
3675 * (called by wv_config())
3676 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02003677static int
Linus Torvalds1da177e2005-04-16 15:20:36 -07003678wv_pcmcia_reset(struct net_device * dev)
3679{
3680 int i;
3681 conf_reg_t reg = { 0, CS_READ, CISREG_COR, 0 };
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003682 struct pcmcia_device * link = ((net_local *)netdev_priv(dev))->link;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003683
3684#ifdef DEBUG_CONFIG_TRACE
3685 printk(KERN_DEBUG "%s: ->wv_pcmcia_reset()\n", dev->name);
3686#endif
3687
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003688 i = pcmcia_access_configuration_register(link, &reg);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003689 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003690 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003691 cs_error(link, AccessConfigurationRegister, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003692 return FALSE;
3693 }
3694
3695#ifdef DEBUG_CONFIG_INFO
3696 printk(KERN_DEBUG "%s: wavelan_pcmcia_reset(): Config reg is 0x%x\n",
3697 dev->name, (u_int) reg.Value);
3698#endif
3699
3700 reg.Action = CS_WRITE;
3701 reg.Value = reg.Value | COR_SW_RESET;
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003702 i = pcmcia_access_configuration_register(link, &reg);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003703 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003704 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003705 cs_error(link, AccessConfigurationRegister, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003706 return FALSE;
3707 }
3708
3709 reg.Action = CS_WRITE;
3710 reg.Value = COR_LEVEL_IRQ | COR_CONFIG;
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003711 i = pcmcia_access_configuration_register(link, &reg);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003712 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003713 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003714 cs_error(link, AccessConfigurationRegister, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003715 return FALSE;
3716 }
3717
3718#ifdef DEBUG_CONFIG_TRACE
3719 printk(KERN_DEBUG "%s: <-wv_pcmcia_reset()\n", dev->name);
3720#endif
3721 return TRUE;
3722}
3723
3724/*------------------------------------------------------------------*/
3725/*
3726 * wavelan_hw_config() is called after a CARD_INSERTION event is
3727 * received, to configure the wavelan hardware.
3728 * Note that the reception will be enabled in wavelan->open(), so the
3729 * device is configured but idle...
3730 * Performs the following actions:
3731 * 1. A pcmcia software reset (using wv_pcmcia_reset())
3732 * 2. A power reset (reset DMA)
3733 * 3. Reset the LAN controller
3734 * 4. Initialize the radio modem (using wv_mmc_init)
3735 * 5. Configure LAN controller (using wv_82593_config)
3736 * 6. Perform a diagnostic on the LAN controller
3737 * (called by wavelan_event() & wv_hw_reset())
3738 */
3739static int
3740wv_hw_config(struct net_device * dev)
3741{
3742 net_local * lp = netdev_priv(dev);
Olof Johansson906da802008-02-04 22:27:35 -08003743 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003744 unsigned long flags;
3745 int ret = FALSE;
3746
3747#ifdef DEBUG_CONFIG_TRACE
3748 printk(KERN_DEBUG "%s: ->wv_hw_config()\n", dev->name);
3749#endif
3750
Helge Deller60da4812008-01-13 15:16:34 +01003751 /* compile-time check the sizes of structures */
3752 BUILD_BUG_ON(sizeof(psa_t) != PSA_SIZE);
3753 BUILD_BUG_ON(sizeof(mmw_t) != MMW_SIZE);
3754 BUILD_BUG_ON(sizeof(mmr_t) != MMR_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003755
3756 /* Reset the pcmcia interface */
3757 if(wv_pcmcia_reset(dev) == FALSE)
3758 return FALSE;
3759
3760 /* Disable interrupts */
3761 spin_lock_irqsave(&lp->spinlock, flags);
3762
3763 /* Disguised goto ;-) */
3764 do
3765 {
3766 /* Power UP the module + reset the modem + reset host adapter
3767 * (in fact, reset DMA channels) */
3768 hacr_write_slow(base, HACR_RESET);
3769 hacr_write(base, HACR_DEFAULT);
3770
3771 /* Check if the module has been powered up... */
3772 if(hasr_read(base) & HASR_NO_CLK)
3773 {
3774#ifdef DEBUG_CONFIG_ERRORS
3775 printk(KERN_WARNING "%s: wv_hw_config(): modem not connected or not a wavelan card\n",
3776 dev->name);
3777#endif
3778 break;
3779 }
3780
3781 /* initialize the modem */
3782 if(wv_mmc_init(dev) == FALSE)
3783 {
3784#ifdef DEBUG_CONFIG_ERRORS
3785 printk(KERN_WARNING "%s: wv_hw_config(): Can't configure the modem\n",
3786 dev->name);
3787#endif
3788 break;
3789 }
3790
3791 /* reset the LAN controller (i82593) */
3792 outb(OP0_RESET, LCCR(base));
3793 mdelay(1); /* A bit crude ! */
3794
3795 /* Initialize the LAN controller */
3796 if(wv_82593_config(dev) == FALSE)
3797 {
3798#ifdef DEBUG_CONFIG_ERRORS
3799 printk(KERN_INFO "%s: wv_hw_config(): i82593 init failed\n",
3800 dev->name);
3801#endif
3802 break;
3803 }
3804
3805 /* Diagnostic */
3806 if(wv_diag(dev) == FALSE)
3807 {
3808#ifdef DEBUG_CONFIG_ERRORS
3809 printk(KERN_INFO "%s: wv_hw_config(): i82593 diagnostic failed\n",
3810 dev->name);
3811#endif
3812 break;
3813 }
3814
3815 /*
3816 * insert code for loopback test here
3817 */
3818
3819 /* The device is now configured */
3820 lp->configured = 1;
3821 ret = TRUE;
3822 }
3823 while(0);
3824
3825 /* Re-enable interrupts */
3826 spin_unlock_irqrestore(&lp->spinlock, flags);
3827
3828#ifdef DEBUG_CONFIG_TRACE
3829 printk(KERN_DEBUG "%s: <-wv_hw_config()\n", dev->name);
3830#endif
3831 return(ret);
3832}
3833
3834/*------------------------------------------------------------------*/
3835/*
3836 * Totally reset the wavelan and restart it.
3837 * Performs the following actions:
3838 * 1. Call wv_hw_config()
3839 * 2. Start the LAN controller's receive unit
3840 * (called by wavelan_event(), wavelan_watchdog() and wavelan_open())
3841 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02003842static void
Linus Torvalds1da177e2005-04-16 15:20:36 -07003843wv_hw_reset(struct net_device * dev)
3844{
3845 net_local * lp = netdev_priv(dev);
3846
3847#ifdef DEBUG_CONFIG_TRACE
3848 printk(KERN_DEBUG "%s: ->wv_hw_reset()\n", dev->name);
3849#endif
3850
3851 lp->nresets++;
3852 lp->configured = 0;
3853
3854 /* Call wv_hw_config() for most of the reset & init stuff */
3855 if(wv_hw_config(dev) == FALSE)
3856 return;
3857
3858 /* start receive unit */
3859 wv_ru_start(dev);
3860
3861#ifdef DEBUG_CONFIG_TRACE
3862 printk(KERN_DEBUG "%s: <-wv_hw_reset()\n", dev->name);
3863#endif
3864}
3865
3866/*------------------------------------------------------------------*/
3867/*
3868 * wv_pcmcia_config() is called after a CARD_INSERTION event is
3869 * received, to configure the PCMCIA socket, and to make the ethernet
3870 * device available to the system.
3871 * (called by wavelan_event())
3872 */
Denys Vlasenko2aee82d2008-04-01 02:56:32 +02003873static int
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003874wv_pcmcia_config(struct pcmcia_device * link)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003875{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003876 struct net_device * dev = (struct net_device *) link->priv;
3877 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003878 win_req_t req;
3879 memreq_t mem;
3880 net_local * lp = netdev_priv(dev);
3881
3882
3883#ifdef DEBUG_CONFIG_TRACE
3884 printk(KERN_DEBUG "->wv_pcmcia_config(0x%p)\n", link);
3885#endif
3886
Linus Torvalds1da177e2005-04-16 15:20:36 -07003887 do
3888 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003889 i = pcmcia_request_io(link, &link->io);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003890 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003891 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003892 cs_error(link, RequestIO, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003893 break;
3894 }
3895
3896 /*
3897 * Now allocate an interrupt line. Note that this does not
3898 * actually assign a handler to the interrupt.
3899 */
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003900 i = pcmcia_request_irq(link, &link->irq);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003901 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003902 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003903 cs_error(link, RequestIRQ, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003904 break;
3905 }
3906
3907 /*
3908 * This actually configures the PCMCIA socket -- setting up
3909 * the I/O windows and the interrupt mapping.
3910 */
3911 link->conf.ConfigIndex = 1;
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003912 i = pcmcia_request_configuration(link, &link->conf);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003913 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003914 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003915 cs_error(link, RequestConfiguration, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003916 break;
3917 }
3918
3919 /*
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003920 * Allocate a small memory window. Note that the struct pcmcia_device
Linus Torvalds1da177e2005-04-16 15:20:36 -07003921 * structure provides space for one window handle -- if your
3922 * device needs several windows, you'll need to keep track of
3923 * the handles in your private data structure, link->priv.
3924 */
3925 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
3926 req.Base = req.Size = 0;
3927 req.AccessSpeed = mem_speed;
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003928 i = pcmcia_request_window(&link, &req, &link->win);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003929 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003930 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003931 cs_error(link, RequestWindow, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003932 break;
3933 }
3934
3935 lp->mem = ioremap(req.Base, req.Size);
3936 dev->mem_start = (u_long)lp->mem;
3937 dev->mem_end = dev->mem_start + req.Size;
3938
3939 mem.CardOffset = 0; mem.Page = 0;
3940 i = pcmcia_map_mem_page(link->win, &mem);
Dominik Brodowski4c89e882008-08-03 10:07:45 +02003941 if (i != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003942 {
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003943 cs_error(link, MapMemPage, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003944 break;
3945 }
3946
3947 /* Feed device with this info... */
3948 dev->irq = link->irq.AssignedIRQ;
3949 dev->base_addr = link->io.BasePort1;
3950 netif_start_queue(dev);
3951
3952#ifdef DEBUG_CONFIG_INFO
3953 printk(KERN_DEBUG "wv_pcmcia_config: MEMSTART %p IRQ %d IOPORT 0x%x\n",
3954 lp->mem, dev->irq, (u_int) dev->base_addr);
3955#endif
3956
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003957 SET_NETDEV_DEV(dev, &handle_to_dev(link));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003958 i = register_netdev(dev);
3959 if(i != 0)
3960 {
3961#ifdef DEBUG_CONFIG_ERRORS
3962 printk(KERN_INFO "wv_pcmcia_config(): register_netdev() failed\n");
3963#endif
3964 break;
3965 }
3966 }
3967 while(0); /* Humm... Disguised goto !!! */
3968
Linus Torvalds1da177e2005-04-16 15:20:36 -07003969 /* If any step failed, release any partially configured state */
3970 if(i != 0)
3971 {
3972 wv_pcmcia_release(link);
3973 return FALSE;
3974 }
3975
3976 strcpy(((net_local *) netdev_priv(dev))->node.dev_name, dev->name);
Dominik Brodowskifd238232006-03-05 10:45:09 +01003977 link->dev_node = &((net_local *) netdev_priv(dev))->node;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003978
3979#ifdef DEBUG_CONFIG_TRACE
3980 printk(KERN_DEBUG "<-wv_pcmcia_config()\n");
3981#endif
3982 return TRUE;
3983}
3984
3985/*------------------------------------------------------------------*/
3986/*
3987 * After a card is removed, wv_pcmcia_release() will unregister the net
3988 * device, and release the PCMCIA configuration. If the device is
3989 * still open, this will be postponed until it is closed.
3990 */
3991static void
Dominik Brodowskifba395e2006-03-31 17:21:06 +02003992wv_pcmcia_release(struct pcmcia_device *link)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003993{
Dominik Brodowski5f2a71f2006-01-15 09:32:39 +01003994 struct net_device * dev = (struct net_device *) link->priv;
3995 net_local * lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003996
3997#ifdef DEBUG_CONFIG_TRACE
Dominik Brodowski5f2a71f2006-01-15 09:32:39 +01003998 printk(KERN_DEBUG "%s: -> wv_pcmcia_release(0x%p)\n", dev->name, link);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003999#endif
4000
Dominik Brodowski5f2a71f2006-01-15 09:32:39 +01004001 iounmap(lp->mem);
Dominik Brodowskifba395e2006-03-31 17:21:06 +02004002 pcmcia_disable_device(link);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004003
4004#ifdef DEBUG_CONFIG_TRACE
Dominik Brodowski5f2a71f2006-01-15 09:32:39 +01004005 printk(KERN_DEBUG "%s: <- wv_pcmcia_release()\n", dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004006#endif
4007}
4008
4009/************************ INTERRUPT HANDLING ************************/
4010
4011/*
4012 * This function is the interrupt handler for the WaveLAN card. This
4013 * routine will be called whenever:
4014 * 1. A packet is received.
4015 * 2. A packet has successfully been transferred and the unit is
4016 * ready to transmit another packet.
4017 * 3. A command has completed execution.
4018 */
4019static irqreturn_t
4020wavelan_interrupt(int irq,
David Howells7d12e782006-10-05 14:55:46 +01004021 void * dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004022{
Jeff Garzikc31f28e2006-10-06 14:56:04 -04004023 struct net_device * dev = dev_id;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004024 net_local * lp;
Olof Johansson906da802008-02-04 22:27:35 -08004025 unsigned int base;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004026 int status0;
4027 u_int tx_status;
4028
Linus Torvalds1da177e2005-04-16 15:20:36 -07004029#ifdef DEBUG_INTERRUPT_TRACE
4030 printk(KERN_DEBUG "%s: ->wavelan_interrupt()\n", dev->name);
4031#endif
4032
4033 lp = netdev_priv(dev);
4034 base = dev->base_addr;
4035
4036#ifdef DEBUG_INTERRUPT_INFO
4037 /* Check state of our spinlock (it should be cleared) */
4038 if(spin_is_locked(&lp->spinlock))
4039 printk(KERN_DEBUG
4040 "%s: wavelan_interrupt(): spinlock is already locked !!!\n",
4041 dev->name);
4042#endif
4043
4044 /* Prevent reentrancy. We need to do that because we may have
4045 * multiple interrupt handler running concurently.
4046 * It is safe because interrupts are disabled before aquiring
4047 * the spinlock. */
4048 spin_lock(&lp->spinlock);
4049
4050 /* Treat all pending interrupts */
4051 while(1)
4052 {
4053 /* ---------------- INTERRUPT CHECKING ---------------- */
4054 /*
4055 * Look for the interrupt and verify the validity
4056 */
4057 outb(CR0_STATUS_0 | OP0_NOP, LCCR(base));
4058 status0 = inb(LCSR(base));
4059
4060#ifdef DEBUG_INTERRUPT_INFO
4061 printk(KERN_DEBUG "status0 0x%x [%s => 0x%x]", status0,
4062 (status0&SR0_INTERRUPT)?"int":"no int",status0&~SR0_INTERRUPT);
4063 if(status0&SR0_INTERRUPT)
4064 {
4065 printk(" [%s => %d]\n", (status0 & SR0_CHNL) ? "chnl" :
4066 ((status0 & SR0_EXECUTION) ? "cmd" :
4067 ((status0 & SR0_RECEPTION) ? "recv" : "unknown")),
4068 (status0 & SR0_EVENT_MASK));
4069 }
4070 else
4071 printk("\n");
4072#endif
4073
4074 /* Return if no actual interrupt from i82593 (normal exit) */
4075 if(!(status0 & SR0_INTERRUPT))
4076 break;
4077
4078 /* If interrupt is both Rx and Tx or none...
4079 * This code in fact is there to catch the spurious interrupt
4080 * when you remove the wavelan pcmcia card from the socket */
4081 if(((status0 & SR0_BOTH_RX_TX) == SR0_BOTH_RX_TX) ||
4082 ((status0 & SR0_BOTH_RX_TX) == 0x0))
4083 {
4084#ifdef DEBUG_INTERRUPT_INFO
4085 printk(KERN_INFO "%s: wv_interrupt(): bogus interrupt (or from dead card) : %X\n",
4086 dev->name, status0);
4087#endif
4088 /* Acknowledge the interrupt */
4089 outb(CR0_INT_ACK | OP0_NOP, LCCR(base));
4090 break;
4091 }
4092
4093 /* ----------------- RECEIVING PACKET ----------------- */
4094 /*
4095 * When the wavelan signal the reception of a new packet,
4096 * we call wv_packet_rcv() to copy if from the buffer and
4097 * send it to NET3
4098 */
4099 if(status0 & SR0_RECEPTION)
4100 {
4101#ifdef DEBUG_INTERRUPT_INFO
4102 printk(KERN_DEBUG "%s: wv_interrupt(): receive\n", dev->name);
4103#endif
4104
4105 if((status0 & SR0_EVENT_MASK) == SR0_STOP_REG_HIT)
4106 {
4107#ifdef DEBUG_INTERRUPT_ERROR
4108 printk(KERN_INFO "%s: wv_interrupt(): receive buffer overflow\n",
4109 dev->name);
4110#endif
4111 lp->stats.rx_over_errors++;
4112 lp->overrunning = 1;
4113 }
4114
4115 /* Get the packet */
4116 wv_packet_rcv(dev);
4117 lp->overrunning = 0;
4118
4119 /* Acknowledge the interrupt */
4120 outb(CR0_INT_ACK | OP0_NOP, LCCR(base));
4121 continue;
4122 }
4123
4124 /* ---------------- COMMAND COMPLETION ---------------- */
4125 /*
4126 * Interrupts issued when the i82593 has completed a command.
4127 * Most likely : transmission done
4128 */
4129
4130 /* If a transmission has been done */
4131 if((status0 & SR0_EVENT_MASK) == SR0_TRANSMIT_DONE ||
4132 (status0 & SR0_EVENT_MASK) == SR0_RETRANSMIT_DONE ||
4133 (status0 & SR0_EVENT_MASK) == SR0_TRANSMIT_NO_CRC_DONE)
4134 {
4135#ifdef DEBUG_TX_ERROR
4136 if((status0 & SR0_EVENT_MASK) == SR0_TRANSMIT_NO_CRC_DONE)
4137 printk(KERN_INFO "%s: wv_interrupt(): packet transmitted without CRC.\n",
4138 dev->name);
4139#endif
4140
4141 /* Get transmission status */
4142 tx_status = inb(LCSR(base));
4143 tx_status |= (inb(LCSR(base)) << 8);
4144#ifdef DEBUG_INTERRUPT_INFO
4145 printk(KERN_DEBUG "%s: wv_interrupt(): transmission done\n",
4146 dev->name);
4147 {
4148 u_int rcv_bytes;
4149 u_char status3;
4150 rcv_bytes = inb(LCSR(base));
4151 rcv_bytes |= (inb(LCSR(base)) << 8);
4152 status3 = inb(LCSR(base));
4153 printk(KERN_DEBUG "tx_status 0x%02x rcv_bytes 0x%02x status3 0x%x\n",
4154 tx_status, rcv_bytes, (u_int) status3);
4155 }
4156#endif
4157 /* Check for possible errors */
4158 if((tx_status & TX_OK) != TX_OK)
4159 {
4160 lp->stats.tx_errors++;
4161
4162 if(tx_status & TX_FRTL)
4163 {
4164#ifdef DEBUG_TX_ERROR
4165 printk(KERN_INFO "%s: wv_interrupt(): frame too long\n",
4166 dev->name);
4167#endif
4168 }
4169 if(tx_status & TX_UND_RUN)
4170 {
4171#ifdef DEBUG_TX_FAIL
4172 printk(KERN_DEBUG "%s: wv_interrupt(): DMA underrun\n",
4173 dev->name);
4174#endif
4175 lp->stats.tx_aborted_errors++;
4176 }
4177 if(tx_status & TX_LOST_CTS)
4178 {
4179#ifdef DEBUG_TX_FAIL
4180 printk(KERN_DEBUG "%s: wv_interrupt(): no CTS\n", dev->name);
4181#endif
4182 lp->stats.tx_carrier_errors++;
4183 }
4184 if(tx_status & TX_LOST_CRS)
4185 {
4186#ifdef DEBUG_TX_FAIL
4187 printk(KERN_DEBUG "%s: wv_interrupt(): no carrier\n",
4188 dev->name);
4189#endif
4190 lp->stats.tx_carrier_errors++;
4191 }
4192 if(tx_status & TX_HRT_BEAT)
4193 {
4194#ifdef DEBUG_TX_FAIL
4195 printk(KERN_DEBUG "%s: wv_interrupt(): heart beat\n", dev->name);
4196#endif
4197 lp->stats.tx_heartbeat_errors++;
4198 }
4199 if(tx_status & TX_DEFER)
4200 {
4201#ifdef DEBUG_TX_FAIL
4202 printk(KERN_DEBUG "%s: wv_interrupt(): channel jammed\n",
4203 dev->name);
4204#endif
4205 }
4206 /* Ignore late collisions since they're more likely to happen
4207 * here (the WaveLAN design prevents the LAN controller from
4208 * receiving while it is transmitting). We take action only when
4209 * the maximum retransmit attempts is exceeded.
4210 */
4211 if(tx_status & TX_COLL)
4212 {
4213 if(tx_status & TX_MAX_COL)
4214 {
4215#ifdef DEBUG_TX_FAIL
4216 printk(KERN_DEBUG "%s: wv_interrupt(): channel congestion\n",
4217 dev->name);
4218#endif
4219 if(!(tx_status & TX_NCOL_MASK))
4220 {
4221 lp->stats.collisions += 0x10;
4222 }
4223 }
4224 }
4225 } /* if(!(tx_status & TX_OK)) */
4226
4227 lp->stats.collisions += (tx_status & TX_NCOL_MASK);
4228 lp->stats.tx_packets++;
4229
4230 netif_wake_queue(dev);
4231 outb(CR0_INT_ACK | OP0_NOP, LCCR(base)); /* Acknowledge the interrupt */
4232 }
4233 else /* if interrupt = transmit done or retransmit done */
4234 {
4235#ifdef DEBUG_INTERRUPT_ERROR
4236 printk(KERN_INFO "wavelan_cs: unknown interrupt, status0 = %02x\n",
4237 status0);
4238#endif
4239 outb(CR0_INT_ACK | OP0_NOP, LCCR(base)); /* Acknowledge the interrupt */
4240 }
4241 } /* while(1) */
4242
4243 spin_unlock(&lp->spinlock);
4244
4245#ifdef DEBUG_INTERRUPT_TRACE
4246 printk(KERN_DEBUG "%s: <-wavelan_interrupt()\n", dev->name);
4247#endif
4248
4249 /* We always return IRQ_HANDLED, because we will receive empty
4250 * interrupts under normal operations. Anyway, it doesn't matter
4251 * as we are dealing with an ISA interrupt that can't be shared.
4252 *
4253 * Explanation : under heavy receive, the following happens :
4254 * ->wavelan_interrupt()
4255 * (status0 & SR0_INTERRUPT) != 0
4256 * ->wv_packet_rcv()
4257 * (status0 & SR0_INTERRUPT) != 0
4258 * ->wv_packet_rcv()
4259 * (status0 & SR0_INTERRUPT) == 0 // i.e. no more event
4260 * <-wavelan_interrupt()
4261 * ->wavelan_interrupt()
4262 * (status0 & SR0_INTERRUPT) == 0 // i.e. empty interrupt
4263 * <-wavelan_interrupt()
4264 * Jean II */
4265 return IRQ_HANDLED;
4266} /* wv_interrupt */
4267
4268/*------------------------------------------------------------------*/
4269/*
4270 * Watchdog: when we start a transmission, a timer is set for us in the
4271 * kernel. If the transmission completes, this timer is disabled. If
4272 * the timer expires, we are called and we try to unlock the hardware.
4273 *
4274 * Note : This watchdog is move clever than the one in the ISA driver,
4275 * because it try to abort the current command before reseting
4276 * everything...
4277 * On the other hand, it's a bit simpler, because we don't have to
4278 * deal with the multiple Tx buffers...
4279 */
4280static void
4281wavelan_watchdog(struct net_device * dev)
4282{
4283 net_local * lp = netdev_priv(dev);
Olof Johansson906da802008-02-04 22:27:35 -08004284 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004285 unsigned long flags;
4286 int aborted = FALSE;
4287
4288#ifdef DEBUG_INTERRUPT_TRACE
4289 printk(KERN_DEBUG "%s: ->wavelan_watchdog()\n", dev->name);
4290#endif
4291
4292#ifdef DEBUG_INTERRUPT_ERROR
4293 printk(KERN_INFO "%s: wavelan_watchdog: watchdog timer expired\n",
4294 dev->name);
4295#endif
4296
4297 spin_lock_irqsave(&lp->spinlock, flags);
4298
4299 /* Ask to abort the current command */
4300 outb(OP0_ABORT, LCCR(base));
4301
4302 /* Wait for the end of the command (a bit hackish) */
4303 if(wv_82593_cmd(dev, "wavelan_watchdog(): abort",
4304 OP0_NOP | CR0_STATUS_3, SR0_EXECUTION_ABORTED))
4305 aborted = TRUE;
4306
4307 /* Release spinlock here so that wv_hw_reset() can grab it */
4308 spin_unlock_irqrestore(&lp->spinlock, flags);
4309
4310 /* Check if we were successful in aborting it */
4311 if(!aborted)
4312 {
4313 /* It seem that it wasn't enough */
4314#ifdef DEBUG_INTERRUPT_ERROR
4315 printk(KERN_INFO "%s: wavelan_watchdog: abort failed, trying reset\n",
4316 dev->name);
4317#endif
4318 wv_hw_reset(dev);
4319 }
4320
4321#ifdef DEBUG_PSA_SHOW
4322 {
4323 psa_t psa;
4324 psa_read(dev, 0, (unsigned char *) &psa, sizeof(psa));
4325 wv_psa_show(&psa);
4326 }
4327#endif
4328#ifdef DEBUG_MMC_SHOW
4329 wv_mmc_show(dev);
4330#endif
4331#ifdef DEBUG_I82593_SHOW
4332 wv_ru_show(dev);
4333#endif
4334
4335 /* We are no more waiting for something... */
4336 netif_wake_queue(dev);
4337
4338#ifdef DEBUG_INTERRUPT_TRACE
4339 printk(KERN_DEBUG "%s: <-wavelan_watchdog()\n", dev->name);
4340#endif
4341}
4342
4343/********************* CONFIGURATION CALLBACKS *********************/
4344/*
4345 * Here are the functions called by the pcmcia package (cardmgr) and
4346 * linux networking (NET3) for initialization, configuration and
4347 * deinstallations of the Wavelan Pcmcia Hardware.
4348 */
4349
4350/*------------------------------------------------------------------*/
4351/*
4352 * Configure and start up the WaveLAN PCMCIA adaptor.
4353 * Called by NET3 when it "open" the device.
4354 */
4355static int
4356wavelan_open(struct net_device * dev)
4357{
4358 net_local * lp = netdev_priv(dev);
Dominik Brodowskifba395e2006-03-31 17:21:06 +02004359 struct pcmcia_device * link = lp->link;
Olof Johansson906da802008-02-04 22:27:35 -08004360 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004361
4362#ifdef DEBUG_CALLBACK_TRACE
4363 printk(KERN_DEBUG "%s: ->wavelan_open(dev=0x%x)\n", dev->name,
4364 (unsigned int) dev);
4365#endif
4366
4367 /* Check if the modem is powered up (wavelan_close() power it down */
4368 if(hasr_read(base) & HASR_NO_CLK)
4369 {
4370 /* Power up (power up time is 250us) */
4371 hacr_write(base, HACR_DEFAULT);
4372
4373 /* Check if the module has been powered up... */
4374 if(hasr_read(base) & HASR_NO_CLK)
4375 {
4376#ifdef DEBUG_CONFIG_ERRORS
4377 printk(KERN_WARNING "%s: wavelan_open(): modem not connected\n",
4378 dev->name);
4379#endif
4380 return FALSE;
4381 }
4382 }
4383
4384 /* Start reception and declare the driver ready */
4385 if(!lp->configured)
4386 return FALSE;
4387 if(!wv_ru_start(dev))
4388 wv_hw_reset(dev); /* If problem : reset */
4389 netif_start_queue(dev);
4390
4391 /* Mark the device as used */
4392 link->open++;
4393
4394#ifdef WAVELAN_ROAMING
4395 if(do_roaming)
4396 wv_roam_init(dev);
4397#endif /* WAVELAN_ROAMING */
4398
4399#ifdef DEBUG_CALLBACK_TRACE
4400 printk(KERN_DEBUG "%s: <-wavelan_open()\n", dev->name);
4401#endif
4402 return 0;
4403}
4404
4405/*------------------------------------------------------------------*/
4406/*
4407 * Shutdown the WaveLAN PCMCIA adaptor.
4408 * Called by NET3 when it "close" the device.
4409 */
4410static int
4411wavelan_close(struct net_device * dev)
4412{
Dominik Brodowskifba395e2006-03-31 17:21:06 +02004413 struct pcmcia_device * link = ((net_local *)netdev_priv(dev))->link;
Olof Johansson906da802008-02-04 22:27:35 -08004414 unsigned int base = dev->base_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004415
4416#ifdef DEBUG_CALLBACK_TRACE
4417 printk(KERN_DEBUG "%s: ->wavelan_close(dev=0x%x)\n", dev->name,
4418 (unsigned int) dev);
4419#endif
4420
4421 /* If the device isn't open, then nothing to do */
4422 if(!link->open)
4423 {
4424#ifdef DEBUG_CONFIG_INFO
4425 printk(KERN_DEBUG "%s: wavelan_close(): device not open\n", dev->name);
4426#endif
4427 return 0;
4428 }
4429
4430#ifdef WAVELAN_ROAMING
4431 /* Cleanup of roaming stuff... */
4432 if(do_roaming)
4433 wv_roam_cleanup(dev);
4434#endif /* WAVELAN_ROAMING */
4435
4436 link->open--;
4437
4438 /* If the card is still present */
4439 if(netif_running(dev))
4440 {
4441 netif_stop_queue(dev);
4442
4443 /* Stop receiving new messages and wait end of transmission */
4444 wv_ru_stop(dev);
4445
4446 /* Power down the module */
4447 hacr_write(base, HACR_DEFAULT & (~HACR_PWR_STAT));
4448 }
4449
4450#ifdef DEBUG_CALLBACK_TRACE
4451 printk(KERN_DEBUG "%s: <-wavelan_close()\n", dev->name);
4452#endif
4453 return 0;
4454}
4455
4456/*------------------------------------------------------------------*/
4457/*
4458 * wavelan_attach() creates an "instance" of the driver, allocating
4459 * local data structures for one device (one interface). The device
4460 * is registered with Card Services.
4461 *
4462 * The dev_link structure is initialized, but we don't actually
4463 * configure the card at this point -- we wait until we receive a
4464 * card insertion event.
4465 */
Dominik Brodowskif8cfa612005-11-14 21:25:51 +01004466static int
Dominik Brodowski15b99ac2006-03-31 17:26:06 +02004467wavelan_probe(struct pcmcia_device *p_dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004468{
Linus Torvalds1da177e2005-04-16 15:20:36 -07004469 struct net_device * dev; /* Interface generic data */
4470 net_local * lp; /* Interface specific data */
Dominik Brodowski15b99ac2006-03-31 17:26:06 +02004471 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004472
4473#ifdef DEBUG_CALLBACK_TRACE
4474 printk(KERN_DEBUG "-> wavelan_attach()\n");
4475#endif
4476
Linus Torvalds1da177e2005-04-16 15:20:36 -07004477 /* The io structure describes IO port mapping */
Dominik Brodowskifd238232006-03-05 10:45:09 +01004478 p_dev->io.NumPorts1 = 8;
4479 p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
4480 p_dev->io.IOAddrLines = 3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004481
4482 /* Interrupt setup */
Alan Cox47cbb112008-09-23 13:53:09 +01004483 p_dev->irq.Attributes = IRQ_TYPE_DYNAMIC_SHARING | IRQ_HANDLE_PRESENT;
Dominik Brodowskifd238232006-03-05 10:45:09 +01004484 p_dev->irq.IRQInfo1 = IRQ_LEVEL_ID;
4485 p_dev->irq.Handler = wavelan_interrupt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004486
4487 /* General socket configuration */
Dominik Brodowskifd238232006-03-05 10:45:09 +01004488 p_dev->conf.Attributes = CONF_ENABLE_IRQ;
4489 p_dev->conf.IntType = INT_MEMORY_AND_IO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004490
4491 /* Allocate the generic data structure */
4492 dev = alloc_etherdev(sizeof(net_local));
Dominik Brodowskifd238232006-03-05 10:45:09 +01004493 if (!dev)
Dominik Brodowskif8cfa612005-11-14 21:25:51 +01004494 return -ENOMEM;
Dominik Brodowskifd238232006-03-05 10:45:09 +01004495
4496 p_dev->priv = p_dev->irq.Instance = dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004497
4498 lp = netdev_priv(dev);
4499
4500 /* Init specific data */
4501 lp->configured = 0;
4502 lp->reconfig_82593 = FALSE;
4503 lp->nresets = 0;
4504 /* Multicast stuff */
4505 lp->promiscuous = 0;
4506 lp->allmulticast = 0;
4507 lp->mc_count = 0;
4508
4509 /* Init spinlock */
4510 spin_lock_init(&lp->spinlock);
4511
4512 /* back links */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004513 lp->dev = dev;
4514
4515 /* wavelan NET3 callbacks */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004516 dev->open = &wavelan_open;
4517 dev->stop = &wavelan_close;
4518 dev->hard_start_xmit = &wavelan_packet_xmit;
4519 dev->get_stats = &wavelan_get_stats;
4520 dev->set_multicast_list = &wavelan_set_multicast_list;
4521#ifdef SET_MAC_ADDRESS
4522 dev->set_mac_address = &wavelan_set_mac_address;
4523#endif /* SET_MAC_ADDRESS */
4524
4525 /* Set the watchdog timer */
4526 dev->tx_timeout = &wavelan_watchdog;
4527 dev->watchdog_timeo = WATCHDOG_JIFFIES;
4528 SET_ETHTOOL_OPS(dev, &ops);
4529
Linus Torvalds1da177e2005-04-16 15:20:36 -07004530 dev->wireless_handlers = &wavelan_handler_def;
4531 lp->wireless_data.spy_data = &lp->spy_data;
4532 dev->wireless_data = &lp->wireless_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004533
4534 /* Other specific data */
4535 dev->mtu = WAVELAN_MTU;
4536
Dominik Brodowski15b99ac2006-03-31 17:26:06 +02004537 ret = wv_pcmcia_config(p_dev);
4538 if (ret)
4539 return ret;
4540
4541 ret = wv_hw_config(dev);
4542 if (ret) {
Dominik Brodowskif8cfa612005-11-14 21:25:51 +01004543 dev->irq = 0;
Dominik Brodowski15b99ac2006-03-31 17:26:06 +02004544 pcmcia_disable_device(p_dev);
4545 return ret;
4546 }
4547
4548 wv_init_info(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004549
4550#ifdef DEBUG_CALLBACK_TRACE
4551 printk(KERN_DEBUG "<- wavelan_attach()\n");
4552#endif
4553
Dominik Brodowskif8cfa612005-11-14 21:25:51 +01004554 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004555}
4556
4557/*------------------------------------------------------------------*/
4558/*
4559 * This deletes a driver "instance". The device is de-registered with
4560 * Card Services. If it has been released, all local data structures
4561 * are freed. Otherwise, the structures will be freed when the device
4562 * is released.
4563 */
4564static void
Dominik Brodowskifba395e2006-03-31 17:21:06 +02004565wavelan_detach(struct pcmcia_device *link)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004566{
4567#ifdef DEBUG_CALLBACK_TRACE
4568 printk(KERN_DEBUG "-> wavelan_detach(0x%p)\n", link);
4569#endif
4570
Dominik Brodowskie2d40962006-03-02 00:09:29 +01004571 /* Some others haven't done their job : give them another chance */
4572 wv_pcmcia_release(link);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004573
Linus Torvalds1da177e2005-04-16 15:20:36 -07004574 /* Free pieces */
4575 if(link->priv)
4576 {
4577 struct net_device * dev = (struct net_device *) link->priv;
4578
4579 /* Remove ourselves from the kernel list of ethernet devices */
4580 /* Warning : can't be called from interrupt, timer or wavelan_close() */
Dominik Brodowskifd238232006-03-05 10:45:09 +01004581 if (link->dev_node)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004582 unregister_netdev(dev);
Dominik Brodowskifd238232006-03-05 10:45:09 +01004583 link->dev_node = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004584 ((net_local *)netdev_priv(dev))->link = NULL;
4585 ((net_local *)netdev_priv(dev))->dev = NULL;
4586 free_netdev(dev);
4587 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004588
4589#ifdef DEBUG_CALLBACK_TRACE
4590 printk(KERN_DEBUG "<- wavelan_detach()\n");
4591#endif
4592}
4593
Dominik Brodowskifba395e2006-03-31 17:21:06 +02004594static int wavelan_suspend(struct pcmcia_device *link)
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004595{
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004596 struct net_device * dev = (struct net_device *) link->priv;
4597
4598 /* NB: wavelan_close will be called, but too late, so we are
4599 * obliged to close nicely the wavelan here. David, could you
4600 * close the device before suspending them ? And, by the way,
4601 * could you, on resume, add a "route add -net ..." after the
4602 * ifconfig up ? Thanks... */
4603
4604 /* Stop receiving new messages and wait end of transmission */
4605 wv_ru_stop(dev);
4606
Dominik Brodowskie2d40962006-03-02 00:09:29 +01004607 if (link->open)
Dominik Brodowski8661bb52006-03-02 00:02:33 +01004608 netif_device_detach(dev);
4609
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004610 /* Power down the module */
4611 hacr_write(dev->base_addr, HACR_DEFAULT & (~HACR_PWR_STAT));
4612
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004613 return 0;
4614}
4615
Dominik Brodowskifba395e2006-03-31 17:21:06 +02004616static int wavelan_resume(struct pcmcia_device *link)
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004617{
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004618 struct net_device * dev = (struct net_device *) link->priv;
4619
Dominik Brodowskie2d40962006-03-02 00:09:29 +01004620 if (link->open) {
Dominik Brodowski8661bb52006-03-02 00:02:33 +01004621 wv_hw_reset(dev);
4622 netif_device_attach(dev);
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004623 }
4624
4625 return 0;
4626}
4627
4628
Dominik Brodowskib9421232005-06-27 16:28:25 -07004629static struct pcmcia_device_id wavelan_ids[] = {
4630 PCMCIA_DEVICE_PROD_ID12("AT&T","WaveLAN/PCMCIA", 0xe7c5affd, 0x1bc50975),
4631 PCMCIA_DEVICE_PROD_ID12("Digital", "RoamAbout/DS", 0x9999ab35, 0x00d05e06),
4632 PCMCIA_DEVICE_PROD_ID12("Lucent Technologies", "WaveLAN/PCMCIA", 0x23eb9949, 0x1bc50975),
4633 PCMCIA_DEVICE_PROD_ID12("NCR", "WaveLAN/PCMCIA", 0x24358cd4, 0x1bc50975),
4634 PCMCIA_DEVICE_NULL,
4635};
4636MODULE_DEVICE_TABLE(pcmcia, wavelan_ids);
4637
Linus Torvalds1da177e2005-04-16 15:20:36 -07004638static struct pcmcia_driver wavelan_driver = {
4639 .owner = THIS_MODULE,
4640 .drv = {
4641 .name = "wavelan_cs",
4642 },
Dominik Brodowski15b99ac2006-03-31 17:26:06 +02004643 .probe = wavelan_probe,
Dominik Brodowskicc3b4862005-11-14 21:23:14 +01004644 .remove = wavelan_detach,
Dominik Brodowskib9421232005-06-27 16:28:25 -07004645 .id_table = wavelan_ids,
Dominik Brodowski98e4c282005-11-14 21:21:18 +01004646 .suspend = wavelan_suspend,
4647 .resume = wavelan_resume,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004648};
4649
4650static int __init
4651init_wavelan_cs(void)
4652{
4653 return pcmcia_register_driver(&wavelan_driver);
4654}
4655
4656static void __exit
4657exit_wavelan_cs(void)
4658{
4659 pcmcia_unregister_driver(&wavelan_driver);
4660}
4661
4662module_init(init_wavelan_cs);
4663module_exit(exit_wavelan_cs);