?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 3.11-rc3
[cris-mirror.git] / drivers / net / ethernet / cirrus / cs89x0.c
blob19f642a45f40859874a94663cd3fc503f58014ed
1 /* cs89x0.c: A Crystal Semiconductor (Now Cirrus Logic) CS89[02]0
2 * driver for linux.
3 * Written 1996 by Russell Nelson, with reference to skeleton.c
4 * written 1993-1994 by Donald Becker.
5 *
6 * This software may be used and distributed according to the terms
7 * of the GNU General Public License, incorporated herein by reference.
8 *
9 * The author may be reached at nelson@crynwr.com, Crynwr
10 * Software, 521 Pleasant Valley Rd., Potsdam, NY 13676
11 *
12 * Other contributors:
13 * Mike Cruse : mcruse@cti-ltd.com
14 * Russ Nelson
15 * Melody Lee : ethernet@crystal.cirrus.com
16 * Alan Cox
17 * Andrew Morton
18 * Oskar Schirmer : oskar@scara.com
19 * Deepak Saxena : dsaxena@plexity.net
20 * Dmitry Pervushin : dpervushin@ru.mvista.com
21 * Deepak Saxena : dsaxena@plexity.net
22 * Domenico Andreoli : cavokz@gmail.com
23 */
24
25
26 /*
27 * Set this to zero to disable DMA code
28 *
29 * Note that even if DMA is turned off we still support the 'dma' and 'use_dma'
30 * module options so we don't break any startup scripts.
31 */
32 #ifndef CONFIG_ISA_DMA_API
33 #define ALLOW_DMA 0
34 #else
35 #define ALLOW_DMA 1
36 #endif
37
38 /*
39 * Set this to zero to remove all the debug statements via
40 * dead code elimination
41 */
42 #define DEBUGGING 1
43
44 /* Sources:
45 * Crynwr packet driver epktisa.
46 * Crystal Semiconductor data sheets.
47 */
48
49 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
50
51 #include <linux/module.h>
52 #include <linux/printk.h>
53 #include <linux/errno.h>
54 #include <linux/netdevice.h>
55 #include <linux/etherdevice.h>
56 #include <linux/platform_device.h>
57 #include <linux/kernel.h>
58 #include <linux/types.h>
59 #include <linux/fcntl.h>
60 #include <linux/interrupt.h>
61 #include <linux/ioport.h>
62 #include <linux/in.h>
63 #include <linux/skbuff.h>
64 #include <linux/spinlock.h>
65 #include <linux/string.h>
66 #include <linux/init.h>
67 #include <linux/bitops.h>
68 #include <linux/delay.h>
69 #include <linux/gfp.h>
70 #include <linux/io.h>
71
72 #include <asm/irq.h>
73 #include <linux/atomic.h>
74 #if ALLOW_DMA
75 #include <asm/dma.h>
76 #endif
77
78 #include "cs89x0.h"
79
80 #define cs89_dbg(val, level, fmt, ...) \
81 do { \
82 if (val <= net_debug) \
83 pr_##level(fmt, ##__VA_ARGS__); \
84 } while (0)
85
86 static char version[] __initdata =
87 "v2.4.3-pre1 Russell Nelson <nelson@crynwr.com>, Andrew Morton";
88
89 #define DRV_NAME "cs89x0"
90
91 /* First, a few definitions that the brave might change.
92 * A zero-terminated list of I/O addresses to be probed. Some special flags..
93 * Addr & 1 = Read back the address port, look for signature and reset
94 * the page window before probing
95 * Addr & 3 = Reset the page window and probe
96 * The CLPS eval board has the Cirrus chip at 0x80090300, in ARM IO space,
97 * but it is possible that a Cirrus board could be plugged into the ISA
98 * slots.
99 */
100 /* The cs8900 has 4 IRQ pins, software selectable. cs8900_irq_map maps
101 * them to system IRQ numbers. This mapping is card specific and is set to
102 * the configuration of the Cirrus Eval board for this chip.
103 */
104 #ifndef CONFIG_CS89x0_PLATFORM
105 static unsigned int netcard_portlist[] __used __initdata = {
106 0x300, 0x320, 0x340, 0x360, 0x200, 0x220, 0x240,
107 0x260, 0x280, 0x2a0, 0x2c0, 0x2e0, 0
108 };
109 static unsigned int cs8900_irq_map[] = {
110 10, 11, 12, 5
111 };
112 #endif
113
114 #if DEBUGGING
115 static unsigned int net_debug = DEBUGGING;
116 #else
117 #define net_debug 0 /* gcc will remove all the debug code for us */
118 #endif
119
120 /* The number of low I/O ports used by the ethercard. */
121 #define NETCARD_IO_EXTENT 16
122
123 /* we allow the user to override various values normally set in the EEPROM */
124 #define FORCE_RJ45 0x0001 /* pick one of these three */
125 #define FORCE_AUI 0x0002
126 #define FORCE_BNC 0x0004
127
128 #define FORCE_AUTO 0x0010 /* pick one of these three */
129 #define FORCE_HALF 0x0020
130 #define FORCE_FULL 0x0030
131
132 /* Information that need to be kept for each board. */
133 struct net_local {
134 int chip_type; /* one of: CS8900, CS8920, CS8920M */
135 char chip_revision; /* revision letter of the chip ('A'...) */
136 int send_cmd; /* the proper send command: TX_NOW, TX_AFTER_381, or TX_AFTER_ALL */
137 int auto_neg_cnf; /* auto-negotiation word from EEPROM */
138 int adapter_cnf; /* adapter configuration from EEPROM */
139 int isa_config; /* ISA configuration from EEPROM */
140 int irq_map; /* IRQ map from EEPROM */
141 int rx_mode; /* what mode are we in? 0, RX_MULTCAST_ACCEPT, or RX_ALL_ACCEPT */
142 int curr_rx_cfg; /* a copy of PP_RxCFG */
143 int linectl; /* either 0 or LOW_RX_SQUELCH, depending on configuration. */
144 int send_underrun; /* keep track of how many underruns in a row we get */
145 int force; /* force various values; see FORCE* above. */
146 spinlock_t lock;
147 void __iomem *virt_addr;/* CS89x0 virtual address. */
148 unsigned long size; /* Length of CS89x0 memory region. */
149 #if ALLOW_DMA
150 int use_dma; /* Flag: we're using dma */
151 int dma; /* DMA channel */
152 int dmasize; /* 16 or 64 */
153 unsigned char *dma_buff; /* points to the beginning of the buffer */
154 unsigned char *end_dma_buff; /* points to the end of the buffer */
155 unsigned char *rx_dma_ptr; /* points to the next packet */
156 #endif
157 };
158
159 /* Example routines you must write ;->. */
160 #define tx_done(dev) 1
161
162 /*
163 * Permit 'cs89x0_dma=N' in the kernel boot environment
164 */
165 #if !defined(MODULE)
166 #if ALLOW_DMA
167 static int g_cs89x0_dma;
168
169 static int __init dma_fn(char *str)
170 {
171 g_cs89x0_dma = simple_strtol(str, NULL, 0);
172 return 1;
173 }
174
175 __setup("cs89x0_dma=", dma_fn);
176 #endif /* ALLOW_DMA */
177
178 static int g_cs89x0_media__force;
179
180 static int __init media_fn(char *str)
181 {
182 if (!strcmp(str, "rj45"))
183 g_cs89x0_media__force = FORCE_RJ45;
184 else if (!strcmp(str, "aui"))
185 g_cs89x0_media__force = FORCE_AUI;
186 else if (!strcmp(str, "bnc"))
187 g_cs89x0_media__force = FORCE_BNC;
188
189 return 1;
190 }
191
192 __setup("cs89x0_media=", media_fn);
193 #endif
194
195 static void readwords(struct net_local *lp, int portno, void *buf, int length)
196 {
197 u8 *buf8 = (u8 *)buf;
198
199 do {
200 u16 tmp16;
201
202 tmp16 = ioread16(lp->virt_addr + portno);
203 *buf8++ = (u8)tmp16;
204 *buf8++ = (u8)(tmp16 >> 8);
205 } while (--length);
206 }
207
208 static void writewords(struct net_local *lp, int portno, void *buf, int length)
209 {
210 u8 *buf8 = (u8 *)buf;
211
212 do {
213 u16 tmp16;
214
215 tmp16 = *buf8++;
216 tmp16 |= (*buf8++) << 8;
217 iowrite16(tmp16, lp->virt_addr + portno);
218 } while (--length);
219 }
220
221 static u16
222 readreg(struct net_device *dev, u16 regno)
223 {
224 struct net_local *lp = netdev_priv(dev);
225
226 iowrite16(regno, lp->virt_addr + ADD_PORT);
227 return ioread16(lp->virt_addr + DATA_PORT);
228 }
229
230 static void
231 writereg(struct net_device *dev, u16 regno, u16 value)
232 {
233 struct net_local *lp = netdev_priv(dev);
234
235 iowrite16(regno, lp->virt_addr + ADD_PORT);
236 iowrite16(value, lp->virt_addr + DATA_PORT);
237 }
238
239 static int __init
240 wait_eeprom_ready(struct net_device *dev)
241 {
242 int timeout = jiffies;
243 /* check to see if the EEPROM is ready,
244 * a timeout is used just in case EEPROM is ready when
245 * SI_BUSY in the PP_SelfST is clear
246 */
247 while (readreg(dev, PP_SelfST) & SI_BUSY)
248 if (jiffies - timeout >= 40)
249 return -1;
250 return 0;
251 }
252
253 static int __init
254 get_eeprom_data(struct net_device *dev, int off, int len, int *buffer)
255 {
256 int i;
257
258 cs89_dbg(3, info, "EEPROM data from %x for %x:", off, len);
259 for (i = 0; i < len; i++) {
260 if (wait_eeprom_ready(dev) < 0)
261 return -1;
262 /* Now send the EEPROM read command and EEPROM location to read */
263 writereg(dev, PP_EECMD, (off + i) | EEPROM_READ_CMD);
264 if (wait_eeprom_ready(dev) < 0)
265 return -1;
266 buffer[i] = readreg(dev, PP_EEData);
267 cs89_dbg(3, cont, " %04x", buffer[i]);
268 }
269 cs89_dbg(3, cont, "\n");
270 return 0;
271 }
272
273 static int __init
274 get_eeprom_cksum(int off, int len, int *buffer)
275 {
276 int i, cksum;
277
278 cksum = 0;
279 for (i = 0; i < len; i++)
280 cksum += buffer[i];
281 cksum &= 0xffff;
282 if (cksum == 0)
283 return 0;
284 return -1;
285 }
286
287 static void
288 write_irq(struct net_device *dev, int chip_type, int irq)
289 {
290 int i;
291
292 if (chip_type == CS8900) {
293 #ifndef CONFIG_CS89x0_PLATFORM
294 /* Search the mapping table for the corresponding IRQ pin. */
295 for (i = 0; i != ARRAY_SIZE(cs8900_irq_map); i++)
296 if (cs8900_irq_map[i] == irq)
297 break;
298 /* Not found */
299 if (i == ARRAY_SIZE(cs8900_irq_map))
300 i = 3;
301 #else
302 /* INTRQ0 pin is used for interrupt generation. */
303 i = 0;
304 #endif
305 writereg(dev, PP_CS8900_ISAINT, i);
306 } else {
307 writereg(dev, PP_CS8920_ISAINT, irq);
308 }
309 }
310
311 static void
312 count_rx_errors(int status, struct net_device *dev)
313 {
314 dev->stats.rx_errors++;
315 if (status & RX_RUNT)
316 dev->stats.rx_length_errors++;
317 if (status & RX_EXTRA_DATA)
318 dev->stats.rx_length_errors++;
319 if ((status & RX_CRC_ERROR) && !(status & (RX_EXTRA_DATA | RX_RUNT)))
320 /* per str 172 */
321 dev->stats.rx_crc_errors++;
322 if (status & RX_DRIBBLE)
323 dev->stats.rx_frame_errors++;
324 }
325
326 /*********************************
327 * This page contains DMA routines
328 *********************************/
329
330 #if ALLOW_DMA
331
332 #define dma_page_eq(ptr1, ptr2) ((long)(ptr1) >> 17 == (long)(ptr2) >> 17)
333
334 static void
335 get_dma_channel(struct net_device *dev)
336 {
337 struct net_local *lp = netdev_priv(dev);
338
339 if (lp->dma) {
340 dev->dma = lp->dma;
341 lp->isa_config |= ISA_RxDMA;
342 } else {
343 if ((lp->isa_config & ANY_ISA_DMA) == 0)
344 return;
345 dev->dma = lp->isa_config & DMA_NO_MASK;
346 if (lp->chip_type == CS8900)
347 dev->dma += 5;
348 if (dev->dma < 5 || dev->dma > 7) {
349 lp->isa_config &= ~ANY_ISA_DMA;
350 return;
351 }
352 }
353 }
354
355 static void
356 write_dma(struct net_device *dev, int chip_type, int dma)
357 {
358 struct net_local *lp = netdev_priv(dev);
359 if ((lp->isa_config & ANY_ISA_DMA) == 0)
360 return;
361 if (chip_type == CS8900)
362 writereg(dev, PP_CS8900_ISADMA, dma - 5);
363 else
364 writereg(dev, PP_CS8920_ISADMA, dma);
365 }
366
367 static void
368 set_dma_cfg(struct net_device *dev)
369 {
370 struct net_local *lp = netdev_priv(dev);
371
372 if (lp->use_dma) {
373 if ((lp->isa_config & ANY_ISA_DMA) == 0) {
374 cs89_dbg(3, err, "set_dma_cfg(): no DMA\n");
375 return;
376 }
377 if (lp->isa_config & ISA_RxDMA) {
378 lp->curr_rx_cfg |= RX_DMA_ONLY;
379 cs89_dbg(3, info, "set_dma_cfg(): RX_DMA_ONLY\n");
380 } else {
381 lp->curr_rx_cfg |= AUTO_RX_DMA; /* not that we support it... */
382 cs89_dbg(3, info, "set_dma_cfg(): AUTO_RX_DMA\n");
383 }
384 }
385 }
386
387 static int
388 dma_bufcfg(struct net_device *dev)
389 {
390 struct net_local *lp = netdev_priv(dev);
391 if (lp->use_dma)
392 return (lp->isa_config & ANY_ISA_DMA) ? RX_DMA_ENBL : 0;
393 else
394 return 0;
395 }
396
397 static int
398 dma_busctl(struct net_device *dev)
399 {
400 int retval = 0;
401 struct net_local *lp = netdev_priv(dev);
402 if (lp->use_dma) {
403 if (lp->isa_config & ANY_ISA_DMA)
404 retval |= RESET_RX_DMA; /* Reset the DMA pointer */
405 if (lp->isa_config & DMA_BURST)
406 retval |= DMA_BURST_MODE; /* Does ISA config specify DMA burst ? */
407 if (lp->dmasize == 64)
408 retval |= RX_DMA_SIZE_64K; /* did they ask for 64K? */
409 retval |= MEMORY_ON; /* we need memory enabled to use DMA. */
410 }
411 return retval;
412 }
413
414 static void
415 dma_rx(struct net_device *dev)
416 {
417 struct net_local *lp = netdev_priv(dev);
418 struct sk_buff *skb;
419 int status, length;
420 unsigned char *bp = lp->rx_dma_ptr;
421
422 status = bp[0] + (bp[1] << 8);
423 length = bp[2] + (bp[3] << 8);
424 bp += 4;
425
426 cs89_dbg(5, debug, "%s: receiving DMA packet at %lx, status %x, length %x\n",
427 dev->name, (unsigned long)bp, status, length);
428
429 if ((status & RX_OK) == 0) {
430 count_rx_errors(status, dev);
431 goto skip_this_frame;
432 }
433
434 /* Malloc up new buffer. */
435 skb = netdev_alloc_skb(dev, length + 2);
436 if (skb == NULL) {
437 dev->stats.rx_dropped++;
438
439 /* AKPM: advance bp to the next frame */
440 skip_this_frame:
441 bp += (length + 3) & ~3;
442 if (bp >= lp->end_dma_buff)
443 bp -= lp->dmasize * 1024;
444 lp->rx_dma_ptr = bp;
445 return;
446 }
447 skb_reserve(skb, 2); /* longword align L3 header */
448
449 if (bp + length > lp->end_dma_buff) {
450 int semi_cnt = lp->end_dma_buff - bp;
451 memcpy(skb_put(skb, semi_cnt), bp, semi_cnt);
452 memcpy(skb_put(skb, length - semi_cnt), lp->dma_buff,
453 length - semi_cnt);
454 } else {
455 memcpy(skb_put(skb, length), bp, length);
456 }
457 bp += (length + 3) & ~3;
458 if (bp >= lp->end_dma_buff)
459 bp -= lp->dmasize*1024;
460 lp->rx_dma_ptr = bp;
461
462 cs89_dbg(3, info, "%s: received %d byte DMA packet of type %x\n",
463 dev->name, length,
464 ((skb->data[ETH_ALEN + ETH_ALEN] << 8) |
465 skb->data[ETH_ALEN + ETH_ALEN + 1]));
466
467 skb->protocol = eth_type_trans(skb, dev);
468 netif_rx(skb);
469 dev->stats.rx_packets++;
470 dev->stats.rx_bytes += length;
471 }
472
473 static void release_dma_buff(struct net_local *lp)
474 {
475 if (lp->dma_buff) {
476 free_pages((unsigned long)(lp->dma_buff),
477 get_order(lp->dmasize * 1024));
478 lp->dma_buff = NULL;
479 }
480 }
481
482 #endif /* ALLOW_DMA */
483
484 static void
485 control_dc_dc(struct net_device *dev, int on_not_off)
486 {
487 struct net_local *lp = netdev_priv(dev);
488 unsigned int selfcontrol;
489 int timenow = jiffies;
490 /* control the DC to DC convertor in the SelfControl register.
491 * Note: This is hooked up to a general purpose pin, might not
492 * always be a DC to DC convertor.
493 */
494
495 selfcontrol = HCB1_ENBL; /* Enable the HCB1 bit as an output */
496 if (((lp->adapter_cnf & A_CNF_DC_DC_POLARITY) != 0) ^ on_not_off)
497 selfcontrol |= HCB1;
498 else
499 selfcontrol &= ~HCB1;
500 writereg(dev, PP_SelfCTL, selfcontrol);
501
502 /* Wait for the DC/DC converter to power up - 500ms */
503 while (jiffies - timenow < HZ)
504 ;
505 }
506
507 /* send a test packet - return true if carrier bits are ok */
508 static int
509 send_test_pkt(struct net_device *dev)
510 {
511 struct net_local *lp = netdev_priv(dev);
512 char test_packet[] = {
513 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
514 0, 46, /* A 46 in network order */
515 0, 0, /* DSAP=0 & SSAP=0 fields */
516 0xf3, 0 /* Control (Test Req + P bit set) */
517 };
518 long timenow = jiffies;
519
520 writereg(dev, PP_LineCTL, readreg(dev, PP_LineCTL) | SERIAL_TX_ON);
521
522 memcpy(test_packet, dev->dev_addr, ETH_ALEN);
523 memcpy(test_packet + ETH_ALEN, dev->dev_addr, ETH_ALEN);
524
525 iowrite16(TX_AFTER_ALL, lp->virt_addr + TX_CMD_PORT);
526 iowrite16(ETH_ZLEN, lp->virt_addr + TX_LEN_PORT);
527
528 /* Test to see if the chip has allocated memory for the packet */
529 while (jiffies - timenow < 5)
530 if (readreg(dev, PP_BusST) & READY_FOR_TX_NOW)
531 break;
532 if (jiffies - timenow >= 5)
533 return 0; /* this shouldn't happen */
534
535 /* Write the contents of the packet */
536 writewords(lp, TX_FRAME_PORT, test_packet, (ETH_ZLEN + 1) >> 1);
537
538 cs89_dbg(1, debug, "Sending test packet ");
539 /* wait a couple of jiffies for packet to be received */
540 for (timenow = jiffies; jiffies - timenow < 3;)
541 ;
542 if ((readreg(dev, PP_TxEvent) & TX_SEND_OK_BITS) == TX_OK) {
543 cs89_dbg(1, cont, "succeeded\n");
544 return 1;
545 }
546 cs89_dbg(1, cont, "failed\n");
547 return 0;
548 }
549
550 #define DETECTED_NONE 0
551 #define DETECTED_RJ45H 1
552 #define DETECTED_RJ45F 2
553 #define DETECTED_AUI 3
554 #define DETECTED_BNC 4
555
556 static int
557 detect_tp(struct net_device *dev)
558 {
559 struct net_local *lp = netdev_priv(dev);
560 int timenow = jiffies;
561 int fdx;
562
563 cs89_dbg(1, debug, "%s: Attempting TP\n", dev->name);
564
565 /* If connected to another full duplex capable 10-Base-T card
566 * the link pulses seem to be lost when the auto detect bit in
567 * the LineCTL is set. To overcome this the auto detect bit will
568 * be cleared whilst testing the 10-Base-T interface. This would
569 * not be necessary for the sparrow chip but is simpler to do it
570 * anyway.
571 */
572 writereg(dev, PP_LineCTL, lp->linectl & ~AUI_ONLY);
573 control_dc_dc(dev, 0);
574
575 /* Delay for the hardware to work out if the TP cable is present
576 * - 150ms
577 */
578 for (timenow = jiffies; jiffies - timenow < 15;)
579 ;
580 if ((readreg(dev, PP_LineST) & LINK_OK) == 0)
581 return DETECTED_NONE;
582
583 if (lp->chip_type == CS8900) {
584 switch (lp->force & 0xf0) {
585 #if 0
586 case FORCE_AUTO:
587 pr_info("%s: cs8900 doesn't autonegotiate\n",
588 dev->name);
589 return DETECTED_NONE;
590 #endif
591 /* CS8900 doesn't support AUTO, change to HALF*/
592 case FORCE_AUTO:
593 lp->force &= ~FORCE_AUTO;
594 lp->force |= FORCE_HALF;
595 break;
596 case FORCE_HALF:
597 break;
598 case FORCE_FULL:
599 writereg(dev, PP_TestCTL,
600 readreg(dev, PP_TestCTL) | FDX_8900);
601 break;
602 }
603 fdx = readreg(dev, PP_TestCTL) & FDX_8900;
604 } else {
605 switch (lp->force & 0xf0) {
606 case FORCE_AUTO:
607 lp->auto_neg_cnf = AUTO_NEG_ENABLE;
608 break;
609 case FORCE_HALF:
610 lp->auto_neg_cnf = 0;
611 break;
612 case FORCE_FULL:
613 lp->auto_neg_cnf = RE_NEG_NOW | ALLOW_FDX;
614 break;
615 }
616
617 writereg(dev, PP_AutoNegCTL, lp->auto_neg_cnf & AUTO_NEG_MASK);
618
619 if ((lp->auto_neg_cnf & AUTO_NEG_BITS) == AUTO_NEG_ENABLE) {
620 pr_info("%s: negotiating duplex...\n", dev->name);
621 while (readreg(dev, PP_AutoNegST) & AUTO_NEG_BUSY) {
622 if (jiffies - timenow > 4000) {
623 pr_err("**** Full / half duplex auto-negotiation timed out ****\n");
624 break;
625 }
626 }
627 }
628 fdx = readreg(dev, PP_AutoNegST) & FDX_ACTIVE;
629 }
630 if (fdx)
631 return DETECTED_RJ45F;
632 else
633 return DETECTED_RJ45H;
634 }
635
636 static int
637 detect_bnc(struct net_device *dev)
638 {
639 struct net_local *lp = netdev_priv(dev);
640
641 cs89_dbg(1, debug, "%s: Attempting BNC\n", dev->name);
642 control_dc_dc(dev, 1);
643
644 writereg(dev, PP_LineCTL, (lp->linectl & ~AUTO_AUI_10BASET) | AUI_ONLY);
645
646 if (send_test_pkt(dev))
647 return DETECTED_BNC;
648 else
649 return DETECTED_NONE;
650 }
651
652 static int
653 detect_aui(struct net_device *dev)
654 {
655 struct net_local *lp = netdev_priv(dev);
656
657 cs89_dbg(1, debug, "%s: Attempting AUI\n", dev->name);
658 control_dc_dc(dev, 0);
659
660 writereg(dev, PP_LineCTL, (lp->linectl & ~AUTO_AUI_10BASET) | AUI_ONLY);
661
662 if (send_test_pkt(dev))
663 return DETECTED_AUI;
664 else
665 return DETECTED_NONE;
666 }
667
668 /* We have a good packet(s), get it/them out of the buffers. */
669 static void
670 net_rx(struct net_device *dev)
671 {
672 struct net_local *lp = netdev_priv(dev);
673 struct sk_buff *skb;
674 int status, length;
675
676 status = ioread16(lp->virt_addr + RX_FRAME_PORT);
677 length = ioread16(lp->virt_addr + RX_FRAME_PORT);
678
679 if ((status & RX_OK) == 0) {
680 count_rx_errors(status, dev);
681 return;
682 }
683
684 /* Malloc up new buffer. */
685 skb = netdev_alloc_skb(dev, length + 2);
686 if (skb == NULL) {
687 dev->stats.rx_dropped++;
688 return;
689 }
690 skb_reserve(skb, 2); /* longword align L3 header */
691
692 readwords(lp, RX_FRAME_PORT, skb_put(skb, length), length >> 1);
693 if (length & 1)
694 skb->data[length-1] = ioread16(lp->virt_addr + RX_FRAME_PORT);
695
696 cs89_dbg(3, debug, "%s: received %d byte packet of type %x\n",
697 dev->name, length,
698 (skb->data[ETH_ALEN + ETH_ALEN] << 8) |
699 skb->data[ETH_ALEN + ETH_ALEN + 1]);
700
701 skb->protocol = eth_type_trans(skb, dev);
702 netif_rx(skb);
703 dev->stats.rx_packets++;
704 dev->stats.rx_bytes += length;
705 }
706
707 /* The typical workload of the driver:
708 * Handle the network interface interrupts.
709 */
710
711 static irqreturn_t net_interrupt(int irq, void *dev_id)
712 {
713 struct net_device *dev = dev_id;
714 struct net_local *lp;
715 int status;
716 int handled = 0;
717
718 lp = netdev_priv(dev);
719
720 /* we MUST read all the events out of the ISQ, otherwise we'll never
721 * get interrupted again. As a consequence, we can't have any limit
722 * on the number of times we loop in the interrupt handler. The
723 * hardware guarantees that eventually we'll run out of events. Of
724 * course, if you're on a slow machine, and packets are arriving
725 * faster than you can read them off, you're screwed. Hasta la
726 * vista, baby!
727 */
728 while ((status = ioread16(lp->virt_addr + ISQ_PORT))) {
729 cs89_dbg(4, debug, "%s: event=%04x\n", dev->name, status);
730 handled = 1;
731 switch (status & ISQ_EVENT_MASK) {
732 case ISQ_RECEIVER_EVENT:
733 /* Got a packet(s). */
734 net_rx(dev);
735 break;
736 case ISQ_TRANSMITTER_EVENT:
737 dev->stats.tx_packets++;
738 netif_wake_queue(dev); /* Inform upper layers. */
739 if ((status & (TX_OK |
740 TX_LOST_CRS |
741 TX_SQE_ERROR |
742 TX_LATE_COL |
743 TX_16_COL)) != TX_OK) {
744 if ((status & TX_OK) == 0)
745 dev->stats.tx_errors++;
746 if (status & TX_LOST_CRS)
747 dev->stats.tx_carrier_errors++;
748 if (status & TX_SQE_ERROR)
749 dev->stats.tx_heartbeat_errors++;
750 if (status & TX_LATE_COL)
751 dev->stats.tx_window_errors++;
752 if (status & TX_16_COL)
753 dev->stats.tx_aborted_errors++;
754 }
755 break;
756 case ISQ_BUFFER_EVENT:
757 if (status & READY_FOR_TX) {
758 /* we tried to transmit a packet earlier,
759 * but inexplicably ran out of buffers.
760 * That shouldn't happen since we only ever
761 * load one packet. Shrug. Do the right
762 * thing anyway.
763 */
764 netif_wake_queue(dev); /* Inform upper layers. */
765 }
766 if (status & TX_UNDERRUN) {
767 cs89_dbg(0, err, "%s: transmit underrun\n",
768 dev->name);
769 lp->send_underrun++;
770 if (lp->send_underrun == 3)
771 lp->send_cmd = TX_AFTER_381;
772 else if (lp->send_underrun == 6)
773 lp->send_cmd = TX_AFTER_ALL;
774 /* transmit cycle is done, although
775 * frame wasn't transmitted - this
776 * avoids having to wait for the upper
777 * layers to timeout on us, in the
778 * event of a tx underrun
779 */
780 netif_wake_queue(dev); /* Inform upper layers. */
781 }
782 #if ALLOW_DMA
783 if (lp->use_dma && (status & RX_DMA)) {
784 int count = readreg(dev, PP_DmaFrameCnt);
785 while (count) {
786 cs89_dbg(5, debug,
787 "%s: receiving %d DMA frames\n",
788 dev->name, count);
789 if (count > 1)
790 cs89_dbg(2, debug,
791 "%s: receiving %d DMA frames\n",
792 dev->name, count);
793 dma_rx(dev);
794 if (--count == 0)
795 count = readreg(dev, PP_DmaFrameCnt);
796 if (count > 0)
797 cs89_dbg(2, debug,
798 "%s: continuing with %d DMA frames\n",
799 dev->name, count);
800 }
801 }
802 #endif
803 break;
804 case ISQ_RX_MISS_EVENT:
805 dev->stats.rx_missed_errors += (status >> 6);
806 break;
807 case ISQ_TX_COL_EVENT:
808 dev->stats.collisions += (status >> 6);
809 break;
810 }
811 }
812 return IRQ_RETVAL(handled);
813 }
814
815 /* Open/initialize the board. This is called (in the current kernel)
816 sometime after booting when the 'ifconfig' program is run.
817
818 This routine should set everything up anew at each open, even
819 registers that "should" only need to be set once at boot, so that
820 there is non-reboot way to recover if something goes wrong.
821 */
822
823 /* AKPM: do we need to do any locking here? */
824
825 static int
826 net_open(struct net_device *dev)
827 {
828 struct net_local *lp = netdev_priv(dev);
829 int result = 0;
830 int i;
831 int ret;
832
833 if (dev->irq < 2) {
834 /* Allow interrupts to be generated by the chip */
835 /* Cirrus' release had this: */
836 #if 0
837 writereg(dev, PP_BusCTL, readreg(dev, PP_BusCTL) | ENABLE_IRQ);
838 #endif
839 /* And 2.3.47 had this: */
840 writereg(dev, PP_BusCTL, ENABLE_IRQ | MEMORY_ON);
841
842 for (i = 2; i < CS8920_NO_INTS; i++) {
843 if ((1 << i) & lp->irq_map) {
844 if (request_irq(i, net_interrupt, 0, dev->name,
845 dev) == 0) {
846 dev->irq = i;
847 write_irq(dev, lp->chip_type, i);
848 /* writereg(dev, PP_BufCFG, GENERATE_SW_INTERRUPT); */
849 break;
850 }
851 }
852 }
853
854 if (i >= CS8920_NO_INTS) {
855 writereg(dev, PP_BusCTL, 0); /* disable interrupts. */
856 pr_err("can't get an interrupt\n");
857 ret = -EAGAIN;
858 goto bad_out;
859 }
860 } else {
861 #if !defined(CONFIG_CS89x0_PLATFORM)
862 if (((1 << dev->irq) & lp->irq_map) == 0) {
863 pr_err("%s: IRQ %d is not in our map of allowable IRQs, which is %x\n",
864 dev->name, dev->irq, lp->irq_map);
865 ret = -EAGAIN;
866 goto bad_out;
867 }
868 #endif
869 /* FIXME: Cirrus' release had this: */
870 writereg(dev, PP_BusCTL, readreg(dev, PP_BusCTL)|ENABLE_IRQ);
871 /* And 2.3.47 had this: */
872 #if 0
873 writereg(dev, PP_BusCTL, ENABLE_IRQ | MEMORY_ON);
874 #endif
875 write_irq(dev, lp->chip_type, dev->irq);
876 ret = request_irq(dev->irq, net_interrupt, 0, dev->name, dev);
877 if (ret) {
878 pr_err("request_irq(%d) failed\n", dev->irq);
879 goto bad_out;
880 }
881 }
882
883 #if ALLOW_DMA
884 if (lp->use_dma && (lp->isa_config & ANY_ISA_DMA)) {
885 unsigned long flags;
886 lp->dma_buff = (unsigned char *)__get_dma_pages(GFP_KERNEL,
887 get_order(lp->dmasize * 1024));
888 if (!lp->dma_buff) {
889 pr_err("%s: cannot get %dK memory for DMA\n",
890 dev->name, lp->dmasize);
891 goto release_irq;
892 }
893 cs89_dbg(1, debug, "%s: dma %lx %lx\n",
894 dev->name,
895 (unsigned long)lp->dma_buff,
896 (unsigned long)isa_virt_to_bus(lp->dma_buff));
897 if ((unsigned long)lp->dma_buff >= MAX_DMA_ADDRESS ||
898 !dma_page_eq(lp->dma_buff,
899 lp->dma_buff + lp->dmasize * 1024 - 1)) {
900 pr_err("%s: not usable as DMA buffer\n", dev->name);
901 goto release_irq;
902 }
903 memset(lp->dma_buff, 0, lp->dmasize * 1024); /* Why? */
904 if (request_dma(dev->dma, dev->name)) {
905 pr_err("%s: cannot get dma channel %d\n",
906 dev->name, dev->dma);
907 goto release_irq;
908 }
909 write_dma(dev, lp->chip_type, dev->dma);
910 lp->rx_dma_ptr = lp->dma_buff;
911 lp->end_dma_buff = lp->dma_buff + lp->dmasize * 1024;
912 spin_lock_irqsave(&lp->lock, flags);
913 disable_dma(dev->dma);
914 clear_dma_ff(dev->dma);
915 set_dma_mode(dev->dma, DMA_RX_MODE); /* auto_init as well */
916 set_dma_addr(dev->dma, isa_virt_to_bus(lp->dma_buff));
917 set_dma_count(dev->dma, lp->dmasize * 1024);
918 enable_dma(dev->dma);
919 spin_unlock_irqrestore(&lp->lock, flags);
920 }
921 #endif /* ALLOW_DMA */
922
923 /* set the Ethernet address */
924 for (i = 0; i < ETH_ALEN / 2; i++)
925 writereg(dev, PP_IA + i * 2,
926 (dev->dev_addr[i * 2] |
927 (dev->dev_addr[i * 2 + 1] << 8)));
928
929 /* while we're testing the interface, leave interrupts disabled */
930 writereg(dev, PP_BusCTL, MEMORY_ON);
931
932 /* Set the LineCTL quintuplet based on adapter configuration read from EEPROM */
933 if ((lp->adapter_cnf & A_CNF_EXTND_10B_2) &&
934 (lp->adapter_cnf & A_CNF_LOW_RX_SQUELCH))
935 lp->linectl = LOW_RX_SQUELCH;
936 else
937 lp->linectl = 0;
938
939 /* check to make sure that they have the "right" hardware available */
940 switch (lp->adapter_cnf & A_CNF_MEDIA_TYPE) {
941 case A_CNF_MEDIA_10B_T:
942 result = lp->adapter_cnf & A_CNF_10B_T;
943 break;
944 case A_CNF_MEDIA_AUI:
945 result = lp->adapter_cnf & A_CNF_AUI;
946 break;
947 case A_CNF_MEDIA_10B_2:
948 result = lp->adapter_cnf & A_CNF_10B_2;
949 break;
950 default:
951 result = lp->adapter_cnf & (A_CNF_10B_T |
952 A_CNF_AUI |
953 A_CNF_10B_2);
954 }
955 if (!result) {
956 pr_err("%s: EEPROM is configured for unavailable media\n",
957 dev->name);
958 release_dma:
959 #if ALLOW_DMA
960 free_dma(dev->dma);
961 release_irq:
962 release_dma_buff(lp);
963 #endif
964 writereg(dev, PP_LineCTL,
965 readreg(dev, PP_LineCTL) & ~(SERIAL_TX_ON | SERIAL_RX_ON));
966 free_irq(dev->irq, dev);
967 ret = -EAGAIN;
968 goto bad_out;
969 }
970
971 /* set the hardware to the configured choice */
972 switch (lp->adapter_cnf & A_CNF_MEDIA_TYPE) {
973 case A_CNF_MEDIA_10B_T:
974 result = detect_tp(dev);
975 if (result == DETECTED_NONE) {
976 pr_warn("%s: 10Base-T (RJ-45) has no cable\n",
977 dev->name);
978 if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */
979 result = DETECTED_RJ45H; /* Yes! I don't care if I see a link pulse */
980 }
981 break;
982 case A_CNF_MEDIA_AUI:
983 result = detect_aui(dev);
984 if (result == DETECTED_NONE) {
985 pr_warn("%s: 10Base-5 (AUI) has no cable\n", dev->name);
986 if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */
987 result = DETECTED_AUI; /* Yes! I don't care if I see a carrrier */
988 }
989 break;
990 case A_CNF_MEDIA_10B_2:
991 result = detect_bnc(dev);
992 if (result == DETECTED_NONE) {
993 pr_warn("%s: 10Base-2 (BNC) has no cable\n", dev->name);
994 if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */
995 result = DETECTED_BNC; /* Yes! I don't care if I can xmit a packet */
996 }
997 break;
998 case A_CNF_MEDIA_AUTO:
999 writereg(dev, PP_LineCTL, lp->linectl | AUTO_AUI_10BASET);
1000 if (lp->adapter_cnf & A_CNF_10B_T) {
1001 result = detect_tp(dev);
1002 if (result != DETECTED_NONE)
1003 break;
1004 }
1005 if (lp->adapter_cnf & A_CNF_AUI) {
1006 result = detect_aui(dev);
1007 if (result != DETECTED_NONE)
1008 break;
1009 }
1010 if (lp->adapter_cnf & A_CNF_10B_2) {
1011 result = detect_bnc(dev);
1012 if (result != DETECTED_NONE)
1013 break;
1014 }
1015 pr_err("%s: no media detected\n", dev->name);
1016 goto release_dma;
1017 }
1018 switch (result) {
1019 case DETECTED_NONE:
1020 pr_err("%s: no network cable attached to configured media\n",
1021 dev->name);
1022 goto release_dma;
1023 case DETECTED_RJ45H:
1024 pr_info("%s: using half-duplex 10Base-T (RJ-45)\n", dev->name);
1025 break;
1026 case DETECTED_RJ45F:
1027 pr_info("%s: using full-duplex 10Base-T (RJ-45)\n", dev->name);
1028 break;
1029 case DETECTED_AUI:
1030 pr_info("%s: using 10Base-5 (AUI)\n", dev->name);
1031 break;
1032 case DETECTED_BNC:
1033 pr_info("%s: using 10Base-2 (BNC)\n", dev->name);
1034 break;
1035 }
1036
1037 /* Turn on both receive and transmit operations */
1038 writereg(dev, PP_LineCTL,
1039 readreg(dev, PP_LineCTL) | SERIAL_RX_ON | SERIAL_TX_ON);
1040
1041 /* Receive only error free packets addressed to this card */
1042 lp->rx_mode = 0;
1043 writereg(dev, PP_RxCTL, DEF_RX_ACCEPT);
1044
1045 lp->curr_rx_cfg = RX_OK_ENBL | RX_CRC_ERROR_ENBL;
1046
1047 if (lp->isa_config & STREAM_TRANSFER)
1048 lp->curr_rx_cfg |= RX_STREAM_ENBL;
1049 #if ALLOW_DMA
1050 set_dma_cfg(dev);
1051 #endif
1052 writereg(dev, PP_RxCFG, lp->curr_rx_cfg);
1053
1054 writereg(dev, PP_TxCFG, (TX_LOST_CRS_ENBL |
1055 TX_SQE_ERROR_ENBL |
1056 TX_OK_ENBL |
1057 TX_LATE_COL_ENBL |
1058 TX_JBR_ENBL |
1059 TX_ANY_COL_ENBL |
1060 TX_16_COL_ENBL));
1061
1062 writereg(dev, PP_BufCFG, (READY_FOR_TX_ENBL |
1063 RX_MISS_COUNT_OVRFLOW_ENBL |
1064 #if ALLOW_DMA
1065 dma_bufcfg(dev) |
1066 #endif
1067 TX_COL_COUNT_OVRFLOW_ENBL |
1068 TX_UNDERRUN_ENBL));
1069
1070 /* now that we've got our act together, enable everything */
1071 writereg(dev, PP_BusCTL, (ENABLE_IRQ
1072 | (dev->mem_start ? MEMORY_ON : 0) /* turn memory on */
1073 #if ALLOW_DMA
1074 | dma_busctl(dev)
1075 #endif
1076 ));
1077 netif_start_queue(dev);
1078 cs89_dbg(1, debug, "net_open() succeeded\n");
1079 return 0;
1080 bad_out:
1081 return ret;
1082 }
1083
1084 /* The inverse routine to net_open(). */
1085 static int
1086 net_close(struct net_device *dev)
1087 {
1088 #if ALLOW_DMA
1089 struct net_local *lp = netdev_priv(dev);
1090 #endif
1091
1092 netif_stop_queue(dev);
1093
1094 writereg(dev, PP_RxCFG, 0);
1095 writereg(dev, PP_TxCFG, 0);
1096 writereg(dev, PP_BufCFG, 0);
1097 writereg(dev, PP_BusCTL, 0);
1098
1099 free_irq(dev->irq, dev);
1100
1101 #if ALLOW_DMA
1102 if (lp->use_dma && lp->dma) {
1103 free_dma(dev->dma);
1104 release_dma_buff(lp);
1105 }
1106 #endif
1107
1108 /* Update the statistics here. */
1109 return 0;
1110 }
1111
1112 /* Get the current statistics.
1113 * This may be called with the card open or closed.
1114 */
1115 static struct net_device_stats *
1116 net_get_stats(struct net_device *dev)
1117 {
1118 struct net_local *lp = netdev_priv(dev);
1119 unsigned long flags;
1120
1121 spin_lock_irqsave(&lp->lock, flags);
1122 /* Update the statistics from the device registers. */
1123 dev->stats.rx_missed_errors += (readreg(dev, PP_RxMiss) >> 6);
1124 dev->stats.collisions += (readreg(dev, PP_TxCol) >> 6);
1125 spin_unlock_irqrestore(&lp->lock, flags);
1126
1127 return &dev->stats;
1128 }
1129
1130 static void net_timeout(struct net_device *dev)
1131 {
1132 /* If we get here, some higher level has decided we are broken.
1133 There should really be a "kick me" function call instead. */
1134 cs89_dbg(0, err, "%s: transmit timed out, %s?\n",
1135 dev->name,
1136 tx_done(dev) ? "IRQ conflict" : "network cable problem");
1137 /* Try to restart the adaptor. */
1138 netif_wake_queue(dev);
1139 }
1140
1141 static netdev_tx_t net_send_packet(struct sk_buff *skb, struct net_device *dev)
1142 {
1143 struct net_local *lp = netdev_priv(dev);
1144 unsigned long flags;
1145
1146 cs89_dbg(3, debug, "%s: sent %d byte packet of type %x\n",
1147 dev->name, skb->len,
1148 ((skb->data[ETH_ALEN + ETH_ALEN] << 8) |
1149 skb->data[ETH_ALEN + ETH_ALEN + 1]));
1150
1151 /* keep the upload from being interrupted, since we
1152 * ask the chip to start transmitting before the
1153 * whole packet has been completely uploaded.
1154 */
1155
1156 spin_lock_irqsave(&lp->lock, flags);
1157 netif_stop_queue(dev);
1158
1159 /* initiate a transmit sequence */
1160 iowrite16(lp->send_cmd, lp->virt_addr + TX_CMD_PORT);
1161 iowrite16(skb->len, lp->virt_addr + TX_LEN_PORT);
1162
1163 /* Test to see if the chip has allocated memory for the packet */
1164 if ((readreg(dev, PP_BusST) & READY_FOR_TX_NOW) == 0) {
1165 /* Gasp! It hasn't. But that shouldn't happen since
1166 * we're waiting for TxOk, so return 1 and requeue this packet.
1167 */
1168
1169 spin_unlock_irqrestore(&lp->lock, flags);
1170 cs89_dbg(0, err, "Tx buffer not free!\n");
1171 return NETDEV_TX_BUSY;
1172 }
1173 /* Write the contents of the packet */
1174 writewords(lp, TX_FRAME_PORT, skb->data, (skb->len + 1) >> 1);
1175 spin_unlock_irqrestore(&lp->lock, flags);
1176 dev->stats.tx_bytes += skb->len;
1177 dev_kfree_skb(skb);
1178
1179 /* We DO NOT call netif_wake_queue() here.
1180 * We also DO NOT call netif_start_queue().
1181 *
1182 * Either of these would cause another bottom half run through
1183 * net_send_packet() before this packet has fully gone out.
1184 * That causes us to hit the "Gasp!" above and the send is rescheduled.
1185 * it runs like a dog. We just return and wait for the Tx completion
1186 * interrupt handler to restart the netdevice layer
1187 */
1188
1189 return NETDEV_TX_OK;
1190 }
1191
1192 static void set_multicast_list(struct net_device *dev)
1193 {
1194 struct net_local *lp = netdev_priv(dev);
1195 unsigned long flags;
1196 u16 cfg;
1197
1198 spin_lock_irqsave(&lp->lock, flags);
1199 if (dev->flags & IFF_PROMISC)
1200 lp->rx_mode = RX_ALL_ACCEPT;
1201 else if ((dev->flags & IFF_ALLMULTI) || !netdev_mc_empty(dev))
1202 /* The multicast-accept list is initialized to accept-all,
1203 * and we rely on higher-level filtering for now.
1204 */
1205 lp->rx_mode = RX_MULTCAST_ACCEPT;
1206 else
1207 lp->rx_mode = 0;
1208
1209 writereg(dev, PP_RxCTL, DEF_RX_ACCEPT | lp->rx_mode);
1210
1211 /* in promiscuous mode, we accept errored packets,
1212 * so we have to enable interrupts on them also
1213 */
1214 cfg = lp->curr_rx_cfg;
1215 if (lp->rx_mode == RX_ALL_ACCEPT)
1216 cfg |= RX_CRC_ERROR_ENBL | RX_RUNT_ENBL | RX_EXTRA_DATA_ENBL;
1217 writereg(dev, PP_RxCFG, cfg);
1218 spin_unlock_irqrestore(&lp->lock, flags);
1219 }
1220
1221 static int set_mac_address(struct net_device *dev, void *p)
1222 {
1223 int i;
1224 struct sockaddr *addr = p;
1225
1226 if (netif_running(dev))
1227 return -EBUSY;
1228
1229 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
1230
1231 cs89_dbg(0, debug, "%s: Setting MAC address to %pM\n",
1232 dev->name, dev->dev_addr);
1233
1234 /* set the Ethernet address */
1235 for (i = 0; i < ETH_ALEN / 2; i++)
1236 writereg(dev, PP_IA + i * 2,
1237 (dev->dev_addr[i * 2] |
1238 (dev->dev_addr[i * 2 + 1] << 8)));
1239
1240 return 0;
1241 }
1242
1243 #ifdef CONFIG_NET_POLL_CONTROLLER
1244 /*
1245 * Polling receive - used by netconsole and other diagnostic tools
1246 * to allow network i/o with interrupts disabled.
1247 */
1248 static void net_poll_controller(struct net_device *dev)
1249 {
1250 disable_irq(dev->irq);
1251 net_interrupt(dev->irq, dev);
1252 enable_irq(dev->irq);
1253 }
1254 #endif
1255
1256 static const struct net_device_ops net_ops = {
1257 .ndo_open = net_open,
1258 .ndo_stop = net_close,
1259 .ndo_tx_timeout = net_timeout,
1260 .ndo_start_xmit = net_send_packet,
1261 .ndo_get_stats = net_get_stats,
1262 .ndo_set_rx_mode = set_multicast_list,
1263 .ndo_set_mac_address = set_mac_address,
1264 #ifdef CONFIG_NET_POLL_CONTROLLER
1265 .ndo_poll_controller = net_poll_controller,
1266 #endif
1267 .ndo_change_mtu = eth_change_mtu,
1268 .ndo_validate_addr = eth_validate_addr,
1269 };
1270
1271 static void __init reset_chip(struct net_device *dev)
1272 {
1273 #if !defined(CONFIG_MACH_MX31ADS)
1274 struct net_local *lp = netdev_priv(dev);
1275 int reset_start_time;
1276
1277 writereg(dev, PP_SelfCTL, readreg(dev, PP_SelfCTL) | POWER_ON_RESET);
1278
1279 /* wait 30 ms */
1280 msleep(30);
1281
1282 if (lp->chip_type != CS8900) {
1283 /* Hardware problem requires PNP registers to be reconfigured after a reset */
1284 iowrite16(PP_CS8920_ISAINT, lp->virt_addr + ADD_PORT);
1285 iowrite8(dev->irq, lp->virt_addr + DATA_PORT);
1286 iowrite8(0, lp->virt_addr + DATA_PORT + 1);
1287
1288 iowrite16(PP_CS8920_ISAMemB, lp->virt_addr + ADD_PORT);
1289 iowrite8((dev->mem_start >> 16) & 0xff,
1290 lp->virt_addr + DATA_PORT);
1291 iowrite8((dev->mem_start >> 8) & 0xff,
1292 lp->virt_addr + DATA_PORT + 1);
1293 }
1294
1295 /* Wait until the chip is reset */
1296 reset_start_time = jiffies;
1297 while ((readreg(dev, PP_SelfST) & INIT_DONE) == 0 &&
1298 jiffies - reset_start_time < 2)
1299 ;
1300 #endif /* !CONFIG_MACH_MX31ADS */
1301 }
1302
1303 /* This is the real probe routine.
1304 * Linux has a history of friendly device probes on the ISA bus.
1305 * A good device probes avoids doing writes, and
1306 * verifies that the correct device exists and functions.
1307 * Return 0 on success.
1308 */
1309 static int __init
1310 cs89x0_probe1(struct net_device *dev, void __iomem *ioaddr, int modular)
1311 {
1312 struct net_local *lp = netdev_priv(dev);
1313 int i;
1314 int tmp;
1315 unsigned rev_type = 0;
1316 int eeprom_buff[CHKSUM_LEN];
1317 int retval;
1318
1319 /* Initialize the device structure. */
1320 if (!modular) {
1321 memset(lp, 0, sizeof(*lp));
1322 spin_lock_init(&lp->lock);
1323 #ifndef MODULE
1324 #if ALLOW_DMA
1325 if (g_cs89x0_dma) {
1326 lp->use_dma = 1;
1327 lp->dma = g_cs89x0_dma;
1328 lp->dmasize = 16; /* Could make this an option... */
1329 }
1330 #endif
1331 lp->force = g_cs89x0_media__force;
1332 #endif
1333 }
1334
1335 pr_debug("PP_addr at %p[%x]: 0x%x\n",
1336 ioaddr, ADD_PORT, ioread16(ioaddr + ADD_PORT));
1337 iowrite16(PP_ChipID, ioaddr + ADD_PORT);
1338
1339 tmp = ioread16(ioaddr + DATA_PORT);
1340 if (tmp != CHIP_EISA_ID_SIG) {
1341 pr_debug("%s: incorrect signature at %p[%x]: 0x%x!="
1342 CHIP_EISA_ID_SIG_STR "\n",
1343 dev->name, ioaddr, DATA_PORT, tmp);
1344 retval = -ENODEV;
1345 goto out1;
1346 }
1347
1348 lp->virt_addr = ioaddr;
1349
1350 /* get the chip type */
1351 rev_type = readreg(dev, PRODUCT_ID_ADD);
1352 lp->chip_type = rev_type & ~REVISON_BITS;
1353 lp->chip_revision = ((rev_type & REVISON_BITS) >> 8) + 'A';
1354
1355 /* Check the chip type and revision in order to set the correct
1356 * send command. CS8920 revision C and CS8900 revision F can use
1357 * the faster send.
1358 */
1359 lp->send_cmd = TX_AFTER_381;
1360 if (lp->chip_type == CS8900 && lp->chip_revision >= 'F')
1361 lp->send_cmd = TX_NOW;
1362 if (lp->chip_type != CS8900 && lp->chip_revision >= 'C')
1363 lp->send_cmd = TX_NOW;
1364
1365 pr_info_once("%s\n", version);
1366
1367 pr_info("%s: cs89%c0%s rev %c found at %p ",
1368 dev->name,
1369 lp->chip_type == CS8900 ? '0' : '2',
1370 lp->chip_type == CS8920M ? "M" : "",
1371 lp->chip_revision,
1372 lp->virt_addr);
1373
1374 reset_chip(dev);
1375
1376 /* Here we read the current configuration of the chip.
1377 * If there is no Extended EEPROM then the idea is to not disturb
1378 * the chip configuration, it should have been correctly setup by
1379 * automatic EEPROM read on reset. So, if the chip says it read
1380 * the EEPROM the driver will always do *something* instead of
1381 * complain that adapter_cnf is 0.
1382 */
1383
1384 if ((readreg(dev, PP_SelfST) & (EEPROM_OK | EEPROM_PRESENT)) ==
1385 (EEPROM_OK | EEPROM_PRESENT)) {
1386 /* Load the MAC. */
1387 for (i = 0; i < ETH_ALEN / 2; i++) {
1388 unsigned int Addr;
1389 Addr = readreg(dev, PP_IA + i * 2);
1390 dev->dev_addr[i * 2] = Addr & 0xFF;
1391 dev->dev_addr[i * 2 + 1] = Addr >> 8;
1392 }
1393
1394 /* Load the Adapter Configuration.
1395 * Note: Barring any more specific information from some
1396 * other source (ie EEPROM+Schematics), we would not know
1397 * how to operate a 10Base2 interface on the AUI port.
1398 * However, since we do read the status of HCB1 and use
1399 * settings that always result in calls to control_dc_dc(dev,0)
1400 * a BNC interface should work if the enable pin
1401 * (dc/dc converter) is on HCB1.
1402 * It will be called AUI however.
1403 */
1404
1405 lp->adapter_cnf = 0;
1406 i = readreg(dev, PP_LineCTL);
1407 /* Preserve the setting of the HCB1 pin. */
1408 if ((i & (HCB1 | HCB1_ENBL)) == (HCB1 | HCB1_ENBL))
1409 lp->adapter_cnf |= A_CNF_DC_DC_POLARITY;
1410 /* Save the sqelch bit */
1411 if ((i & LOW_RX_SQUELCH) == LOW_RX_SQUELCH)
1412 lp->adapter_cnf |= A_CNF_EXTND_10B_2 | A_CNF_LOW_RX_SQUELCH;
1413 /* Check if the card is in 10Base-t only mode */
1414 if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == 0)
1415 lp->adapter_cnf |= A_CNF_10B_T | A_CNF_MEDIA_10B_T;
1416 /* Check if the card is in AUI only mode */
1417 if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == AUI_ONLY)
1418 lp->adapter_cnf |= A_CNF_AUI | A_CNF_MEDIA_AUI;
1419 /* Check if the card is in Auto mode. */
1420 if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == AUTO_AUI_10BASET)
1421 lp->adapter_cnf |= A_CNF_AUI | A_CNF_10B_T |
1422 A_CNF_MEDIA_AUI | A_CNF_MEDIA_10B_T | A_CNF_MEDIA_AUTO;
1423
1424 cs89_dbg(1, info, "%s: PP_LineCTL=0x%x, adapter_cnf=0x%x\n",
1425 dev->name, i, lp->adapter_cnf);
1426
1427 /* IRQ. Other chips already probe, see below. */
1428 if (lp->chip_type == CS8900)
1429 lp->isa_config = readreg(dev, PP_CS8900_ISAINT) & INT_NO_MASK;
1430
1431 pr_cont("[Cirrus EEPROM] ");
1432 }
1433
1434 pr_cont("\n");
1435
1436 /* First check to see if an EEPROM is attached. */
1437
1438 if ((readreg(dev, PP_SelfST) & EEPROM_PRESENT) == 0)
1439 pr_warn("No EEPROM, relying on command line....\n");
1440 else if (get_eeprom_data(dev, START_EEPROM_DATA, CHKSUM_LEN, eeprom_buff) < 0) {
1441 pr_warn("EEPROM read failed, relying on command line\n");
1442 } else if (get_eeprom_cksum(START_EEPROM_DATA, CHKSUM_LEN, eeprom_buff) < 0) {
1443 /* Check if the chip was able to read its own configuration starting
1444 at 0 in the EEPROM*/
1445 if ((readreg(dev, PP_SelfST) & (EEPROM_OK | EEPROM_PRESENT)) !=
1446 (EEPROM_OK | EEPROM_PRESENT))
1447 pr_warn("Extended EEPROM checksum bad and no Cirrus EEPROM, relying on command line\n");
1448
1449 } else {
1450 /* This reads an extended EEPROM that is not documented
1451 * in the CS8900 datasheet.
1452 */
1453
1454 /* get transmission control word but keep the autonegotiation bits */
1455 if (!lp->auto_neg_cnf)
1456 lp->auto_neg_cnf = eeprom_buff[AUTO_NEG_CNF_OFFSET / 2];
1457 /* Store adapter configuration */
1458 if (!lp->adapter_cnf)
1459 lp->adapter_cnf = eeprom_buff[ADAPTER_CNF_OFFSET / 2];
1460 /* Store ISA configuration */
1461 lp->isa_config = eeprom_buff[ISA_CNF_OFFSET / 2];
1462 dev->mem_start = eeprom_buff[PACKET_PAGE_OFFSET / 2] << 8;
1463
1464 /* eeprom_buff has 32-bit ints, so we can't just memcpy it */
1465 /* store the initial memory base address */
1466 for (i = 0; i < ETH_ALEN / 2; i++) {
1467 dev->dev_addr[i * 2] = eeprom_buff[i];
1468 dev->dev_addr[i * 2 + 1] = eeprom_buff[i] >> 8;
1469 }
1470 cs89_dbg(1, debug, "%s: new adapter_cnf: 0x%x\n",
1471 dev->name, lp->adapter_cnf);
1472 }
1473
1474 /* allow them to force multiple transceivers. If they force multiple, autosense */
1475 {
1476 int count = 0;
1477 if (lp->force & FORCE_RJ45) {
1478 lp->adapter_cnf |= A_CNF_10B_T;
1479 count++;
1480 }
1481 if (lp->force & FORCE_AUI) {
1482 lp->adapter_cnf |= A_CNF_AUI;
1483 count++;
1484 }
1485 if (lp->force & FORCE_BNC) {
1486 lp->adapter_cnf |= A_CNF_10B_2;
1487 count++;
1488 }
1489 if (count > 1)
1490 lp->adapter_cnf |= A_CNF_MEDIA_AUTO;
1491 else if (lp->force & FORCE_RJ45)
1492 lp->adapter_cnf |= A_CNF_MEDIA_10B_T;
1493 else if (lp->force & FORCE_AUI)
1494 lp->adapter_cnf |= A_CNF_MEDIA_AUI;
1495 else if (lp->force & FORCE_BNC)
1496 lp->adapter_cnf |= A_CNF_MEDIA_10B_2;
1497 }
1498
1499 cs89_dbg(1, debug, "%s: after force 0x%x, adapter_cnf=0x%x\n",
1500 dev->name, lp->force, lp->adapter_cnf);
1501
1502 /* FIXME: We don't let you set dc-dc polarity or low RX squelch from the command line: add it here */
1503
1504 /* FIXME: We don't let you set the IMM bit from the command line: add it to lp->auto_neg_cnf here */
1505
1506 /* FIXME: we don't set the Ethernet address on the command line. Use
1507 * ifconfig IFACE hw ether AABBCCDDEEFF
1508 */
1509
1510 pr_info("media %s%s%s",
1511 (lp->adapter_cnf & A_CNF_10B_T) ? "RJ-45," : "",
1512 (lp->adapter_cnf & A_CNF_AUI) ? "AUI," : "",
1513 (lp->adapter_cnf & A_CNF_10B_2) ? "BNC," : "");
1514
1515 lp->irq_map = 0xffff;
1516
1517 /* If this is a CS8900 then no pnp soft */
1518 if (lp->chip_type != CS8900 &&
1519 /* Check if the ISA IRQ has been set */
1520 (i = readreg(dev, PP_CS8920_ISAINT) & 0xff,
1521 (i != 0 && i < CS8920_NO_INTS))) {
1522 if (!dev->irq)
1523 dev->irq = i;
1524 } else {
1525 i = lp->isa_config & INT_NO_MASK;
1526 #ifndef CONFIG_CS89x0_PLATFORM
1527 if (lp->chip_type == CS8900) {
1528 /* Translate the IRQ using the IRQ mapping table. */
1529 if (i >= ARRAY_SIZE(cs8900_irq_map))
1530 pr_err("invalid ISA interrupt number %d\n", i);
1531 else
1532 i = cs8900_irq_map[i];
1533
1534 lp->irq_map = CS8900_IRQ_MAP; /* fixed IRQ map for CS8900 */
1535 } else {
1536 int irq_map_buff[IRQ_MAP_LEN/2];
1537
1538 if (get_eeprom_data(dev, IRQ_MAP_EEPROM_DATA,
1539 IRQ_MAP_LEN / 2,
1540 irq_map_buff) >= 0) {
1541 if ((irq_map_buff[0] & 0xff) == PNP_IRQ_FRMT)
1542 lp->irq_map = ((irq_map_buff[0] >> 8) |
1543 (irq_map_buff[1] << 8));
1544 }
1545 }
1546 #endif
1547 if (!dev->irq)
1548 dev->irq = i;
1549 }
1550
1551 pr_cont(" IRQ %d", dev->irq);
1552
1553 #if ALLOW_DMA
1554 if (lp->use_dma) {
1555 get_dma_channel(dev);
1556 pr_cont(", DMA %d", dev->dma);
1557 } else
1558 #endif
1559 pr_cont(", programmed I/O");
1560
1561 /* print the ethernet address. */
1562 pr_cont(", MAC %pM\n", dev->dev_addr);
1563
1564 dev->netdev_ops = &net_ops;
1565 dev->watchdog_timeo = HZ;
1566
1567 cs89_dbg(0, info, "cs89x0_probe1() successful\n");
1568
1569 retval = register_netdev(dev);
1570 if (retval)
1571 goto out2;
1572 return 0;
1573 out2:
1574 iowrite16(PP_ChipID, lp->virt_addr + ADD_PORT);
1575 out1:
1576 return retval;
1577 }
1578
1579 #ifndef CONFIG_CS89x0_PLATFORM
1580 /*
1581 * This function converts the I/O port addres used by the cs89x0_probe() and
1582 * init_module() functions to the I/O memory address used by the
1583 * cs89x0_probe1() function.
1584 */
1585 static int __init
1586 cs89x0_ioport_probe(struct net_device *dev, unsigned long ioport, int modular)
1587 {
1588 struct net_local *lp = netdev_priv(dev);
1589 int ret;
1590 void __iomem *io_mem;
1591
1592 if (!lp)
1593 return -ENOMEM;
1594
1595 dev->base_addr = ioport;
1596
1597 if (!request_region(ioport, NETCARD_IO_EXTENT, DRV_NAME)) {
1598 ret = -EBUSY;
1599 goto out;
1600 }
1601
1602 io_mem = ioport_map(ioport & ~3, NETCARD_IO_EXTENT);
1603 if (!io_mem) {
1604 ret = -ENOMEM;
1605 goto release;
1606 }
1607
1608 /* if they give us an odd I/O address, then do ONE write to
1609 * the address port, to get it back to address zero, where we
1610 * expect to find the EISA signature word. An IO with a base of 0x3
1611 * will skip the test for the ADD_PORT.
1612 */
1613 if (ioport & 1) {
1614 cs89_dbg(1, info, "%s: odd ioaddr 0x%lx\n", dev->name, ioport);
1615 if ((ioport & 2) != 2) {
1616 if ((ioread16(io_mem + ADD_PORT) & ADD_MASK) !=
1617 ADD_SIG) {
1618 pr_err("%s: bad signature 0x%x\n",
1619 dev->name, ioread16(io_mem + ADD_PORT));
1620 ret = -ENODEV;
1621 goto unmap;
1622 }
1623 }
1624 }
1625
1626 ret = cs89x0_probe1(dev, io_mem, modular);
1627 if (!ret)
1628 goto out;
1629 unmap:
1630 ioport_unmap(io_mem);
1631 release:
1632 release_region(ioport, NETCARD_IO_EXTENT);
1633 out:
1634 return ret;
1635 }
1636
1637 #ifndef MODULE
1638 /* Check for a network adaptor of this type, and return '0' iff one exists.
1639 * If dev->base_addr == 0, probe all likely locations.
1640 * If dev->base_addr == 1, always return failure.
1641 * If dev->base_addr == 2, allocate space for the device and return success
1642 * (detachable devices only).
1643 * Return 0 on success.
1644 */
1645
1646 struct net_device * __init cs89x0_probe(int unit)
1647 {
1648 struct net_device *dev = alloc_etherdev(sizeof(struct net_local));
1649 unsigned *port;
1650 int err = 0;
1651 int irq;
1652 int io;
1653
1654 if (!dev)
1655 return ERR_PTR(-ENODEV);
1656
1657 sprintf(dev->name, "eth%d", unit);
1658 netdev_boot_setup_check(dev);
1659 io = dev->base_addr;
1660 irq = dev->irq;
1661
1662 cs89_dbg(0, info, "cs89x0_probe(0x%x)\n", io);
1663
1664 if (io > 0x1ff) { /* Check a single specified location. */
1665 err = cs89x0_ioport_probe(dev, io, 0);
1666 } else if (io != 0) { /* Don't probe at all. */
1667 err = -ENXIO;
1668 } else {
1669 for (port = netcard_portlist; *port; port++) {
1670 if (cs89x0_ioport_probe(dev, *port, 0) == 0)
1671 break;
1672 dev->irq = irq;
1673 }
1674 if (!*port)
1675 err = -ENODEV;
1676 }
1677 if (err)
1678 goto out;
1679 return dev;
1680 out:
1681 free_netdev(dev);
1682 pr_warn("no cs8900 or cs8920 detected. Be sure to disable PnP with SETUP\n");
1683 return ERR_PTR(err);
1684 }
1685 #endif
1686 #endif
1687
1688 #if defined(MODULE) && !defined(CONFIG_CS89x0_PLATFORM)
1689
1690 static struct net_device *dev_cs89x0;
1691
1692 /* Support the 'debug' module parm even if we're compiled for non-debug to
1693 * avoid breaking someone's startup scripts
1694 */
1695
1696 static int io;
1697 static int irq;
1698 static int debug;
1699 static char media[8];
1700 static int duplex = -1;
1701
1702 static int use_dma; /* These generate unused var warnings if ALLOW_DMA = 0 */
1703 static int dma;
1704 static int dmasize = 16; /* or 64 */
1705
1706 module_param(io, int, 0);
1707 module_param(irq, int, 0);
1708 module_param(debug, int, 0);
1709 module_param_string(media, media, sizeof(media), 0);
1710 module_param(duplex, int, 0);
1711 module_param(dma , int, 0);
1712 module_param(dmasize , int, 0);
1713 module_param(use_dma , int, 0);
1714 MODULE_PARM_DESC(io, "cs89x0 I/O base address");
1715 MODULE_PARM_DESC(irq, "cs89x0 IRQ number");
1716 #if DEBUGGING
1717 MODULE_PARM_DESC(debug, "cs89x0 debug level (0-6)");
1718 #else
1719 MODULE_PARM_DESC(debug, "(ignored)");
1720 #endif
1721 MODULE_PARM_DESC(media, "Set cs89x0 adapter(s) media type(s) (rj45,bnc,aui)");
1722 /* No other value than -1 for duplex seems to be currently interpreted */
1723 MODULE_PARM_DESC(duplex, "(ignored)");
1724 #if ALLOW_DMA
1725 MODULE_PARM_DESC(dma , "cs89x0 ISA DMA channel; ignored if use_dma=0");
1726 MODULE_PARM_DESC(dmasize , "cs89x0 DMA size in kB (16,64); ignored if use_dma=0");
1727 MODULE_PARM_DESC(use_dma , "cs89x0 using DMA (0-1)");
1728 #else
1729 MODULE_PARM_DESC(dma , "(ignored)");
1730 MODULE_PARM_DESC(dmasize , "(ignored)");
1731 MODULE_PARM_DESC(use_dma , "(ignored)");
1732 #endif
1733
1734 MODULE_AUTHOR("Mike Cruse, Russwll Nelson <nelson@crynwr.com>, Andrew Morton");
1735 MODULE_LICENSE("GPL");
1736
1737 /*
1738 * media=t - specify media type
1739 * or media=2
1740 * or media=aui
1741 * or medai=auto
1742 * duplex=0 - specify forced half/full/autonegotiate duplex
1743 * debug=# - debug level
1744 *
1745 * Default Chip Configuration:
1746 * DMA Burst = enabled
1747 * IOCHRDY Enabled = enabled
1748 * UseSA = enabled
1749 * CS8900 defaults to half-duplex if not specified on command-line
1750 * CS8920 defaults to autoneg if not specified on command-line
1751 * Use reset defaults for other config parameters
1752 *
1753 * Assumptions:
1754 * media type specified is supported (circuitry is present)
1755 * if memory address is > 1MB, then required mem decode hw is present
1756 * if 10B-2, then agent other than driver will enable DC/DC converter
1757 * (hw or software util)
1758 */
1759
1760 int __init init_module(void)
1761 {
1762 struct net_device *dev = alloc_etherdev(sizeof(struct net_local));
1763 struct net_local *lp;
1764 int ret = 0;
1765
1766 #if DEBUGGING
1767 net_debug = debug;
1768 #else
1769 debug = 0;
1770 #endif
1771 if (!dev)
1772 return -ENOMEM;
1773
1774 dev->irq = irq;
1775 dev->base_addr = io;
1776 lp = netdev_priv(dev);
1777
1778 #if ALLOW_DMA
1779 if (use_dma) {
1780 lp->use_dma = use_dma;
1781 lp->dma = dma;
1782 lp->dmasize = dmasize;
1783 }
1784 #endif
1785
1786 spin_lock_init(&lp->lock);
1787
1788 /* boy, they'd better get these right */
1789 if (!strcmp(media, "rj45"))
1790 lp->adapter_cnf = A_CNF_MEDIA_10B_T | A_CNF_10B_T;
1791 else if (!strcmp(media, "aui"))
1792 lp->adapter_cnf = A_CNF_MEDIA_AUI | A_CNF_AUI;
1793 else if (!strcmp(media, "bnc"))
1794 lp->adapter_cnf = A_CNF_MEDIA_10B_2 | A_CNF_10B_2;
1795 else
1796 lp->adapter_cnf = A_CNF_MEDIA_10B_T | A_CNF_10B_T;
1797
1798 if (duplex == -1)
1799 lp->auto_neg_cnf = AUTO_NEG_ENABLE;
1800
1801 if (io == 0) {
1802 pr_err("Module autoprobing not allowed\n");
1803 pr_err("Append io=0xNNN\n");
1804 ret = -EPERM;
1805 goto out;
1806 } else if (io <= 0x1ff) {
1807 ret = -ENXIO;
1808 goto out;
1809 }
1810
1811 #if ALLOW_DMA
1812 if (use_dma && dmasize != 16 && dmasize != 64) {
1813 pr_err("dma size must be either 16K or 64K, not %dK\n",
1814 dmasize);
1815 ret = -EPERM;
1816 goto out;
1817 }
1818 #endif
1819 ret = cs89x0_ioport_probe(dev, io, 1);
1820 if (ret)
1821 goto out;
1822
1823 dev_cs89x0 = dev;
1824 return 0;
1825 out:
1826 free_netdev(dev);
1827 return ret;
1828 }
1829
1830 void __exit
1831 cleanup_module(void)
1832 {
1833 struct net_local *lp = netdev_priv(dev_cs89x0);
1834
1835 unregister_netdev(dev_cs89x0);
1836 iowrite16(PP_ChipID, lp->virt_addr + ADD_PORT);
1837 ioport_unmap(lp->virt_addr);
1838 release_region(dev_cs89x0->base_addr, NETCARD_IO_EXTENT);
1839 free_netdev(dev_cs89x0);
1840 }
1841 #endif /* MODULE && !CONFIG_CS89x0_PLATFORM */
1842
1843 #ifdef CONFIG_CS89x0_PLATFORM
1844 static int __init cs89x0_platform_probe(struct platform_device *pdev)
1845 {
1846 struct net_device *dev = alloc_etherdev(sizeof(struct net_local));
1847 struct net_local *lp;
1848 struct resource *mem_res;
1849 void __iomem *virt_addr;
1850 int err;
1851
1852 if (!dev)
1853 return -ENOMEM;
1854
1855 lp = netdev_priv(dev);
1856
1857 mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1858 dev->irq = platform_get_irq(pdev, 0);
1859 if (mem_res == NULL || dev->irq <= 0) {
1860 dev_warn(&dev->dev, "memory/interrupt resource missing\n");
1861 err = -ENXIO;
1862 goto free;
1863 }
1864
1865 lp->size = resource_size(mem_res);
1866 if (!request_mem_region(mem_res->start, lp->size, DRV_NAME)) {
1867 dev_warn(&dev->dev, "request_mem_region() failed\n");
1868 err = -EBUSY;
1869 goto free;
1870 }
1871
1872 virt_addr = ioremap(mem_res->start, lp->size);
1873 if (!virt_addr) {
1874 dev_warn(&dev->dev, "ioremap() failed\n");
1875 err = -ENOMEM;
1876 goto release;
1877 }
1878
1879 err = cs89x0_probe1(dev, virt_addr, 0);
1880 if (err) {
1881 dev_warn(&dev->dev, "no cs8900 or cs8920 detected\n");
1882 goto unmap;
1883 }
1884
1885 platform_set_drvdata(pdev, dev);
1886 return 0;
1887
1888 unmap:
1889 iounmap(virt_addr);
1890 release:
1891 release_mem_region(mem_res->start, lp->size);
1892 free:
1893 free_netdev(dev);
1894 return err;
1895 }
1896
1897 static int cs89x0_platform_remove(struct platform_device *pdev)
1898 {
1899 struct net_device *dev = platform_get_drvdata(pdev);
1900 struct net_local *lp = netdev_priv(dev);
1901 struct resource *mem_res;
1902
1903 /* This platform_get_resource() call will not return NULL, because
1904 * the same call in cs89x0_platform_probe() has returned a non NULL
1905 * value.
1906 */
1907 mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1908 unregister_netdev(dev);
1909 iounmap(lp->virt_addr);
1910 release_mem_region(mem_res->start, lp->size);
1911 free_netdev(dev);
1912 return 0;
1913 }
1914
1915 static struct platform_driver cs89x0_driver = {
1916 .driver = {
1917 .name = DRV_NAME,
1918 .owner = THIS_MODULE,
1919 },
1920 .remove = cs89x0_platform_remove,
1921 };
1922
1923 module_platform_driver_probe(cs89x0_driver, cs89x0_platform_probe);
1924
1925 #endif /* CONFIG_CS89x0_PLATFORM */
CRIS linux kernel tree