?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[SCSI] qla2xxx: Add QoS support.
[linux-2.6/mini2440.git] / drivers / net / sun3lance.c
blobe5beb299cbd0192fe3925c9ff7a15aa2c62cb0a3
1 /* sun3lance.c: Ethernet driver for SUN3 Lance chip */
2 /*
3
4 Sun3 Lance ethernet driver, by Sam Creasey (sammy@users.qual.net).
5 This driver is a part of the linux kernel, and is thus distributed
6 under the GNU General Public License.
7
8 The values used in LANCE_OBIO and LANCE_IRQ seem to be empirically
9 true for the correct IRQ and address of the lance registers. They
10 have not been widely tested, however. What we probably need is a
11 "proper" way to search for a device in the sun3's prom, but, alas,
12 linux has no such thing.
13
14 This driver is largely based on atarilance.c, by Roman Hodek. Other
15 sources of inspiration were the NetBSD sun3 am7990 driver, and the
16 linux sparc lance driver (sunlance.c).
17
18 There are more assumptions made throughout this driver, it almost
19 certainly still needs work, but it does work at least for RARP/BOOTP and
20 mounting the root NFS filesystem.
21
22 */
23
24 static char *version = "sun3lance.c: v1.2 1/12/2001 Sam Creasey (sammy@sammy.net)\n";
25
26 #include <linux/module.h>
27 #include <linux/stddef.h>
28 #include <linux/kernel.h>
29 #include <linux/string.h>
30 #include <linux/errno.h>
31 #include <linux/slab.h>
32 #include <linux/interrupt.h>
33 #include <linux/init.h>
34 #include <linux/ioport.h>
35 #include <linux/delay.h>
36 #include <linux/netdevice.h>
37 #include <linux/etherdevice.h>
38 #include <linux/skbuff.h>
39 #include <linux/bitops.h>
40
41 #include <asm/cacheflush.h>
42 #include <asm/setup.h>
43 #include <asm/irq.h>
44 #include <asm/io.h>
45 #include <asm/pgtable.h>
46 #include <asm/dvma.h>
47 #include <asm/idprom.h>
48 #include <asm/machines.h>
49
50 #ifdef CONFIG_SUN3
51 #include <asm/sun3mmu.h>
52 #else
53 #include <asm/sun3xprom.h>
54 #endif
55
56 /* sun3/60 addr/irq for the lance chip. If your sun is different,
57 change this. */
58 #define LANCE_OBIO 0x120000
59 #define LANCE_IRQ IRQ_AUTO_3
60
61 /* Debug level:
62 * 0 = silent, print only serious errors
63 * 1 = normal, print error messages
64 * 2 = debug, print debug infos
65 * 3 = debug, print even more debug infos (packet data)
66 */
67
68 #define LANCE_DEBUG 0
69
70 #ifdef LANCE_DEBUG
71 static int lance_debug = LANCE_DEBUG;
72 #else
73 static int lance_debug = 1;
74 #endif
75 module_param(lance_debug, int, 0);
76 MODULE_PARM_DESC(lance_debug, "SUN3 Lance debug level (0-3)");
77 MODULE_LICENSE("GPL");
78
79 #define DPRINTK(n,a) \
80 do { \
81 if (lance_debug >= n) \
82 printk a; \
83 } while( 0 )
84
85
86 /* we're only using 32k of memory, so we use 4 TX
87 buffers and 16 RX buffers. These values are expressed as log2. */
88
89 #define TX_LOG_RING_SIZE 3
90 #define RX_LOG_RING_SIZE 5
91
92 /* These are the derived values */
93
94 #define TX_RING_SIZE (1 << TX_LOG_RING_SIZE)
95 #define TX_RING_LEN_BITS (TX_LOG_RING_SIZE << 5)
96 #define TX_RING_MOD_MASK (TX_RING_SIZE - 1)
97
98 #define RX_RING_SIZE (1 << RX_LOG_RING_SIZE)
99 #define RX_RING_LEN_BITS (RX_LOG_RING_SIZE << 5)
100 #define RX_RING_MOD_MASK (RX_RING_SIZE - 1)
101
102 /* Definitions for packet buffer access: */
103 #define PKT_BUF_SZ 1544
104
105 /* Get the address of a packet buffer corresponding to a given buffer head */
106 #define PKTBUF_ADDR(head) (void *)((unsigned long)(MEM) | (head)->base)
107
108
109 /* The LANCE Rx and Tx ring descriptors. */
110 struct lance_rx_head {
111 unsigned short base; /* Low word of base addr */
112 volatile unsigned char flag;
113 unsigned char base_hi; /* High word of base addr (unused) */
114 short buf_length; /* This length is 2s complement! */
115 volatile short msg_length; /* This length is "normal". */
116 };
117
118 struct lance_tx_head {
119 unsigned short base; /* Low word of base addr */
120 volatile unsigned char flag;
121 unsigned char base_hi; /* High word of base addr (unused) */
122 short length; /* Length is 2s complement! */
123 volatile short misc;
124 };
125
126 /* The LANCE initialization block, described in databook. */
127 struct lance_init_block {
128 unsigned short mode; /* Pre-set mode */
129 unsigned char hwaddr[6]; /* Physical ethernet address */
130 unsigned int filter[2]; /* Multicast filter (unused). */
131 /* Receive and transmit ring base, along with length bits. */
132 unsigned short rdra;
133 unsigned short rlen;
134 unsigned short tdra;
135 unsigned short tlen;
136 unsigned short pad[4]; /* is thie needed? */
137 };
138
139 /* The whole layout of the Lance shared memory */
140 struct lance_memory {
141 struct lance_init_block init;
142 struct lance_tx_head tx_head[TX_RING_SIZE];
143 struct lance_rx_head rx_head[RX_RING_SIZE];
144 char rx_data[RX_RING_SIZE][PKT_BUF_SZ];
145 char tx_data[TX_RING_SIZE][PKT_BUF_SZ];
146 };
147
148 /* The driver's private device structure */
149
150 struct lance_private {
151 volatile unsigned short *iobase;
152 struct lance_memory *mem;
153 int new_rx, new_tx; /* The next free ring entry */
154 int old_tx, old_rx; /* ring entry to be processed */
155 /* These two must be longs for set_bit() */
156 long tx_full;
157 long lock;
158 };
159
160 /* I/O register access macros */
161
162 #define MEM lp->mem
163 #define DREG lp->iobase[0]
164 #define AREG lp->iobase[1]
165 #define REGA(a) (*( AREG = (a), &DREG ))
166
167 /* Definitions for the Lance */
168
169 /* tx_head flags */
170 #define TMD1_ENP 0x01 /* end of packet */
171 #define TMD1_STP 0x02 /* start of packet */
172 #define TMD1_DEF 0x04 /* deferred */
173 #define TMD1_ONE 0x08 /* one retry needed */
174 #define TMD1_MORE 0x10 /* more than one retry needed */
175 #define TMD1_ERR 0x40 /* error summary */
176 #define TMD1_OWN 0x80 /* ownership (set: chip owns) */
177
178 #define TMD1_OWN_CHIP TMD1_OWN
179 #define TMD1_OWN_HOST 0
180
181 /* tx_head misc field */
182 #define TMD3_TDR 0x03FF /* Time Domain Reflectometry counter */
183 #define TMD3_RTRY 0x0400 /* failed after 16 retries */
184 #define TMD3_LCAR 0x0800 /* carrier lost */
185 #define TMD3_LCOL 0x1000 /* late collision */
186 #define TMD3_UFLO 0x4000 /* underflow (late memory) */
187 #define TMD3_BUFF 0x8000 /* buffering error (no ENP) */
188
189 /* rx_head flags */
190 #define RMD1_ENP 0x01 /* end of packet */
191 #define RMD1_STP 0x02 /* start of packet */
192 #define RMD1_BUFF 0x04 /* buffer error */
193 #define RMD1_CRC 0x08 /* CRC error */
194 #define RMD1_OFLO 0x10 /* overflow */
195 #define RMD1_FRAM 0x20 /* framing error */
196 #define RMD1_ERR 0x40 /* error summary */
197 #define RMD1_OWN 0x80 /* ownership (set: ship owns) */
198
199 #define RMD1_OWN_CHIP RMD1_OWN
200 #define RMD1_OWN_HOST 0
201
202 /* register names */
203 #define CSR0 0 /* mode/status */
204 #define CSR1 1 /* init block addr (low) */
205 #define CSR2 2 /* init block addr (high) */
206 #define CSR3 3 /* misc */
207 #define CSR8 8 /* address filter */
208 #define CSR15 15 /* promiscuous mode */
209
210 /* CSR0 */
211 /* (R=readable, W=writeable, S=set on write, C=clear on write) */
212 #define CSR0_INIT 0x0001 /* initialize (RS) */
213 #define CSR0_STRT 0x0002 /* start (RS) */
214 #define CSR0_STOP 0x0004 /* stop (RS) */
215 #define CSR0_TDMD 0x0008 /* transmit demand (RS) */
216 #define CSR0_TXON 0x0010 /* transmitter on (R) */
217 #define CSR0_RXON 0x0020 /* receiver on (R) */
218 #define CSR0_INEA 0x0040 /* interrupt enable (RW) */
219 #define CSR0_INTR 0x0080 /* interrupt active (R) */
220 #define CSR0_IDON 0x0100 /* initialization done (RC) */
221 #define CSR0_TINT 0x0200 /* transmitter interrupt (RC) */
222 #define CSR0_RINT 0x0400 /* receiver interrupt (RC) */
223 #define CSR0_MERR 0x0800 /* memory error (RC) */
224 #define CSR0_MISS 0x1000 /* missed frame (RC) */
225 #define CSR0_CERR 0x2000 /* carrier error (no heartbeat :-) (RC) */
226 #define CSR0_BABL 0x4000 /* babble: tx-ed too many bits (RC) */
227 #define CSR0_ERR 0x8000 /* error (RC) */
228
229 /* CSR3 */
230 #define CSR3_BCON 0x0001 /* byte control */
231 #define CSR3_ACON 0x0002 /* ALE control */
232 #define CSR3_BSWP 0x0004 /* byte swap (1=big endian) */
233
234 /***************************** Prototypes *****************************/
235
236 static int lance_probe( struct net_device *dev);
237 static int lance_open( struct net_device *dev );
238 static void lance_init_ring( struct net_device *dev );
239 static int lance_start_xmit( struct sk_buff *skb, struct net_device *dev );
240 static irqreturn_t lance_interrupt( int irq, void *dev_id);
241 static int lance_rx( struct net_device *dev );
242 static int lance_close( struct net_device *dev );
243 static void set_multicast_list( struct net_device *dev );
244
245 /************************* End of Prototypes **************************/
246
247 struct net_device * __init sun3lance_probe(int unit)
248 {
249 struct net_device *dev;
250 static int found;
251 int err = -ENODEV;
252
253 if (!MACH_IS_SUN3 && !MACH_IS_SUN3X)
254 return ERR_PTR(-ENODEV);
255
256 /* check that this machine has an onboard lance */
257 switch(idprom->id_machtype) {
258 case SM_SUN3|SM_3_50:
259 case SM_SUN3|SM_3_60:
260 case SM_SUN3X|SM_3_80:
261 /* these machines have lance */
262 break;
263
264 default:
265 return ERR_PTR(-ENODEV);
266 }
267
268 if (found)
269 return ERR_PTR(-ENODEV);
270
271 dev = alloc_etherdev(sizeof(struct lance_private));
272 if (!dev)
273 return ERR_PTR(-ENOMEM);
274 if (unit >= 0) {
275 sprintf(dev->name, "eth%d", unit);
276 netdev_boot_setup_check(dev);
277 }
278
279 if (!lance_probe(dev))
280 goto out;
281
282 err = register_netdev(dev);
283 if (err)
284 goto out1;
285 found = 1;
286 return dev;
287
288 out1:
289 #ifdef CONFIG_SUN3
290 iounmap((void __iomem *)dev->base_addr);
291 #endif
292 out:
293 free_netdev(dev);
294 return ERR_PTR(err);
295 }
296
297 static int __init lance_probe( struct net_device *dev)
298 {
299 unsigned long ioaddr;
300
301 struct lance_private *lp;
302 int i;
303 static int did_version;
304 volatile unsigned short *ioaddr_probe;
305 unsigned short tmp1, tmp2;
306
307 #ifdef CONFIG_SUN3
308 ioaddr = (unsigned long)ioremap(LANCE_OBIO, PAGE_SIZE);
309 if (!ioaddr)
310 return 0;
311 #else
312 ioaddr = SUN3X_LANCE;
313 #endif
314
315 /* test to see if there's really a lance here */
316 /* (CSRO_INIT shouldn't be readable) */
317
318 ioaddr_probe = (volatile unsigned short *)ioaddr;
319 tmp1 = ioaddr_probe[0];
320 tmp2 = ioaddr_probe[1];
321
322 ioaddr_probe[1] = CSR0;
323 ioaddr_probe[0] = CSR0_INIT | CSR0_STOP;
324
325 if(ioaddr_probe[0] != CSR0_STOP) {
326 ioaddr_probe[0] = tmp1;
327 ioaddr_probe[1] = tmp2;
328
329 #ifdef CONFIG_SUN3
330 iounmap((void __iomem *)ioaddr);
331 #endif
332 return 0;
333 }
334
335 lp = netdev_priv(dev);
336
337 /* XXX - leak? */
338 MEM = dvma_malloc_align(sizeof(struct lance_memory), 0x10000);
339 if (MEM == NULL) {
340 #ifdef CONFIG_SUN3
341 iounmap((void __iomem *)ioaddr);
342 #endif
343 printk(KERN_WARNING "SUN3 Lance couldn't allocate DVMA memory\n");
344 return 0;
345 }
346
347 lp->iobase = (volatile unsigned short *)ioaddr;
348 dev->base_addr = (unsigned long)ioaddr; /* informational only */
349
350 REGA(CSR0) = CSR0_STOP;
351
352 if (request_irq(LANCE_IRQ, lance_interrupt, IRQF_DISABLED, "SUN3 Lance", dev) < 0) {
353 #ifdef CONFIG_SUN3
354 iounmap((void __iomem *)ioaddr);
355 #endif
356 dvma_free((void *)MEM);
357 printk(KERN_WARNING "SUN3 Lance unable to allocate IRQ\n");
358 return 0;
359 }
360 dev->irq = (unsigned short)LANCE_IRQ;
361
362
363 printk("%s: SUN3 Lance at io %#lx, mem %#lx, irq %d, hwaddr ",
364 dev->name,
365 (unsigned long)ioaddr,
366 (unsigned long)MEM,
367 dev->irq);
368
369 /* copy in the ethernet address from the prom */
370 for(i = 0; i < 6 ; i++)
371 dev->dev_addr[i] = idprom->id_ethaddr[i];
372
373 /* tell the card it's ether address, bytes swapped */
374 MEM->init.hwaddr[0] = dev->dev_addr[1];
375 MEM->init.hwaddr[1] = dev->dev_addr[0];
376 MEM->init.hwaddr[2] = dev->dev_addr[3];
377 MEM->init.hwaddr[3] = dev->dev_addr[2];
378 MEM->init.hwaddr[4] = dev->dev_addr[5];
379 MEM->init.hwaddr[5] = dev->dev_addr[4];
380
381 printk("%pM\n", dev->dev_addr);
382
383 MEM->init.mode = 0x0000;
384 MEM->init.filter[0] = 0x00000000;
385 MEM->init.filter[1] = 0x00000000;
386 MEM->init.rdra = dvma_vtob(MEM->rx_head);
387 MEM->init.rlen = (RX_LOG_RING_SIZE << 13) |
388 (dvma_vtob(MEM->rx_head) >> 16);
389 MEM->init.tdra = dvma_vtob(MEM->tx_head);
390 MEM->init.tlen = (TX_LOG_RING_SIZE << 13) |
391 (dvma_vtob(MEM->tx_head) >> 16);
392
393 DPRINTK(2, ("initaddr: %08lx rx_ring: %08lx tx_ring: %08lx\n",
394 dvma_vtob(&(MEM->init)), dvma_vtob(MEM->rx_head),
395 (dvma_vtob(MEM->tx_head))));
396
397 if (did_version++ == 0)
398 printk( version );
399
400 /* The LANCE-specific entries in the device structure. */
401 dev->open = &lance_open;
402 dev->hard_start_xmit = &lance_start_xmit;
403 dev->stop = &lance_close;
404 dev->set_multicast_list = &set_multicast_list;
405 dev->set_mac_address = NULL;
406 // KLUDGE -- REMOVE ME
407 set_bit(__LINK_STATE_PRESENT, &dev->state);
408
409
410 return 1;
411 }
412
413 static int lance_open( struct net_device *dev )
414 {
415 struct lance_private *lp = netdev_priv(dev);
416 int i;
417
418 DPRINTK( 2, ( "%s: lance_open()\n", dev->name ));
419
420 REGA(CSR0) = CSR0_STOP;
421
422 lance_init_ring(dev);
423
424 /* From now on, AREG is kept to point to CSR0 */
425 REGA(CSR0) = CSR0_INIT;
426
427 i = 1000000;
428 while (--i > 0)
429 if (DREG & CSR0_IDON)
430 break;
431 if (i <= 0 || (DREG & CSR0_ERR)) {
432 DPRINTK( 2, ( "lance_open(): opening %s failed, i=%d, csr0=%04x\n",
433 dev->name, i, DREG ));
434 DREG = CSR0_STOP;
435 return( -EIO );
436 }
437
438 DREG = CSR0_IDON | CSR0_STRT | CSR0_INEA;
439
440 netif_start_queue(dev);
441
442 DPRINTK( 2, ( "%s: LANCE is open, csr0 %04x\n", dev->name, DREG ));
443
444 return( 0 );
445 }
446
447
448 /* Initialize the LANCE Rx and Tx rings. */
449
450 static void lance_init_ring( struct net_device *dev )
451 {
452 struct lance_private *lp = netdev_priv(dev);
453 int i;
454
455 lp->lock = 0;
456 lp->tx_full = 0;
457 lp->new_rx = lp->new_tx = 0;
458 lp->old_rx = lp->old_tx = 0;
459
460 for( i = 0; i < TX_RING_SIZE; i++ ) {
461 MEM->tx_head[i].base = dvma_vtob(MEM->tx_data[i]);
462 MEM->tx_head[i].flag = 0;
463 MEM->tx_head[i].base_hi =
464 (dvma_vtob(MEM->tx_data[i])) >>16;
465 MEM->tx_head[i].length = 0;
466 MEM->tx_head[i].misc = 0;
467 }
468
469 for( i = 0; i < RX_RING_SIZE; i++ ) {
470 MEM->rx_head[i].base = dvma_vtob(MEM->rx_data[i]);
471 MEM->rx_head[i].flag = RMD1_OWN_CHIP;
472 MEM->rx_head[i].base_hi =
473 (dvma_vtob(MEM->rx_data[i])) >> 16;
474 MEM->rx_head[i].buf_length = -PKT_BUF_SZ | 0xf000;
475 MEM->rx_head[i].msg_length = 0;
476 }
477
478 /* tell the card it's ether address, bytes swapped */
479 MEM->init.hwaddr[0] = dev->dev_addr[1];
480 MEM->init.hwaddr[1] = dev->dev_addr[0];
481 MEM->init.hwaddr[2] = dev->dev_addr[3];
482 MEM->init.hwaddr[3] = dev->dev_addr[2];
483 MEM->init.hwaddr[4] = dev->dev_addr[5];
484 MEM->init.hwaddr[5] = dev->dev_addr[4];
485
486 MEM->init.mode = 0x0000;
487 MEM->init.filter[0] = 0x00000000;
488 MEM->init.filter[1] = 0x00000000;
489 MEM->init.rdra = dvma_vtob(MEM->rx_head);
490 MEM->init.rlen = (RX_LOG_RING_SIZE << 13) |
491 (dvma_vtob(MEM->rx_head) >> 16);
492 MEM->init.tdra = dvma_vtob(MEM->tx_head);
493 MEM->init.tlen = (TX_LOG_RING_SIZE << 13) |
494 (dvma_vtob(MEM->tx_head) >> 16);
495
496
497 /* tell the lance the address of its init block */
498 REGA(CSR1) = dvma_vtob(&(MEM->init));
499 REGA(CSR2) = dvma_vtob(&(MEM->init)) >> 16;
500
501 #ifdef CONFIG_SUN3X
502 REGA(CSR3) = CSR3_BSWP | CSR3_ACON | CSR3_BCON;
503 #else
504 REGA(CSR3) = CSR3_BSWP;
505 #endif
506
507 }
508
509
510 static int lance_start_xmit( struct sk_buff *skb, struct net_device *dev )
511 {
512 struct lance_private *lp = netdev_priv(dev);
513 int entry, len;
514 struct lance_tx_head *head;
515 unsigned long flags;
516
517 DPRINTK( 1, ( "%s: transmit start.\n",
518 dev->name));
519
520 /* Transmitter timeout, serious problems. */
521 if (netif_queue_stopped(dev)) {
522 int tickssofar = jiffies - dev->trans_start;
523 if (tickssofar < 20)
524 return( 1 );
525
526 DPRINTK( 1, ( "%s: transmit timed out, status %04x, resetting.\n",
527 dev->name, DREG ));
528 DREG = CSR0_STOP;
529 /*
530 * Always set BSWP after a STOP as STOP puts it back into
531 * little endian mode.
532 */
533 REGA(CSR3) = CSR3_BSWP;
534 dev->stats.tx_errors++;
535
536 if(lance_debug >= 2) {
537 int i;
538 printk("Ring data: old_tx %d new_tx %d%s new_rx %d\n",
539 lp->old_tx, lp->new_tx,
540 lp->tx_full ? " (full)" : "",
541 lp->new_rx );
542 for( i = 0 ; i < RX_RING_SIZE; i++ )
543 printk( "rx #%d: base=%04x blen=%04x mlen=%04x\n",
544 i, MEM->rx_head[i].base,
545 -MEM->rx_head[i].buf_length,
546 MEM->rx_head[i].msg_length);
547 for( i = 0 ; i < TX_RING_SIZE; i++ )
548 printk("tx #%d: base=%04x len=%04x misc=%04x\n",
549 i, MEM->tx_head[i].base,
550 -MEM->tx_head[i].length,
551 MEM->tx_head[i].misc );
552 }
553
554 lance_init_ring(dev);
555 REGA( CSR0 ) = CSR0_INEA | CSR0_INIT | CSR0_STRT;
556
557 netif_start_queue(dev);
558 dev->trans_start = jiffies;
559
560 return 0;
561 }
562
563
564 /* Block a timer-based transmit from overlapping. This could better be
565 done with atomic_swap(1, dev->tbusy), but set_bit() works as well. */
566
567 /* Block a timer-based transmit from overlapping with us by
568 stopping the queue for a bit... */
569
570 netif_stop_queue(dev);
571
572 if (test_and_set_bit( 0, (void*)&lp->lock ) != 0) {
573 printk( "%s: tx queue lock!.\n", dev->name);
574 /* don't clear dev->tbusy flag. */
575 return 1;
576 }
577
578 AREG = CSR0;
579 DPRINTK( 2, ( "%s: lance_start_xmit() called, csr0 %4.4x.\n",
580 dev->name, DREG ));
581
582 #ifdef CONFIG_SUN3X
583 /* this weirdness doesn't appear on sun3... */
584 if(!(DREG & CSR0_INIT)) {
585 DPRINTK( 1, ("INIT not set, reinitializing...\n"));
586 REGA( CSR0 ) = CSR0_STOP;
587 lance_init_ring(dev);
588 REGA( CSR0 ) = CSR0_INIT | CSR0_STRT;
589 }
590 #endif
591
592 /* Fill in a Tx ring entry */
593 #if 0
594 if (lance_debug >= 2) {
595 printk( "%s: TX pkt %d type 0x%04x"
596 " from %s to %s"
597 " data at 0x%08x len %d\n",
598 dev->name, lp->new_tx, ((u_short *)skb->data)[6],
599 DEV_ADDR(&skb->data[6]), DEV_ADDR(skb->data),
600 (int)skb->data, (int)skb->len );
601 }
602 #endif
603 /* We're not prepared for the int until the last flags are set/reset.
604 * And the int may happen already after setting the OWN_CHIP... */
605 local_irq_save(flags);
606
607 /* Mask to ring buffer boundary. */
608 entry = lp->new_tx;
609 head = &(MEM->tx_head[entry]);
610
611 /* Caution: the write order is important here, set the "ownership" bits
612 * last.
613 */
614
615 /* the sun3's lance needs it's buffer padded to the minimum
616 size */
617 len = (ETH_ZLEN < skb->len) ? skb->len : ETH_ZLEN;
618
619 // head->length = -len;
620 head->length = (-len) | 0xf000;
621 head->misc = 0;
622
623 skb_copy_from_linear_data(skb, PKTBUF_ADDR(head), skb->len);
624 if (len != skb->len)
625 memset(PKTBUF_ADDR(head) + skb->len, 0, len-skb->len);
626
627 head->flag = TMD1_OWN_CHIP | TMD1_ENP | TMD1_STP;
628 lp->new_tx = (lp->new_tx + 1) & TX_RING_MOD_MASK;
629 dev->stats.tx_bytes += skb->len;
630
631 /* Trigger an immediate send poll. */
632 REGA(CSR0) = CSR0_INEA | CSR0_TDMD | CSR0_STRT;
633 AREG = CSR0;
634 DPRINTK( 2, ( "%s: lance_start_xmit() exiting, csr0 %4.4x.\n",
635 dev->name, DREG ));
636 dev->trans_start = jiffies;
637 dev_kfree_skb( skb );
638
639 lp->lock = 0;
640 if ((MEM->tx_head[(entry+1) & TX_RING_MOD_MASK].flag & TMD1_OWN) ==
641 TMD1_OWN_HOST)
642 netif_start_queue(dev);
643
644 local_irq_restore(flags);
645
646 return 0;
647 }
648
649 /* The LANCE interrupt handler. */
650
651 static irqreturn_t lance_interrupt( int irq, void *dev_id)
652 {
653 struct net_device *dev = dev_id;
654 struct lance_private *lp = netdev_priv(dev);
655 int csr0;
656 static int in_interrupt;
657
658 if (dev == NULL) {
659 DPRINTK( 1, ( "lance_interrupt(): invalid dev_id\n" ));
660 return IRQ_NONE;
661 }
662
663 if (in_interrupt)
664 DPRINTK( 2, ( "%s: Re-entering the interrupt handler.\n", dev->name ));
665 in_interrupt = 1;
666
667 still_more:
668 flush_cache_all();
669
670 AREG = CSR0;
671 csr0 = DREG;
672
673 /* ack interrupts */
674 DREG = csr0 & (CSR0_TINT | CSR0_RINT | CSR0_IDON);
675
676 /* clear errors */
677 if(csr0 & CSR0_ERR)
678 DREG = CSR0_BABL | CSR0_MERR | CSR0_CERR | CSR0_MISS;
679
680
681 DPRINTK( 2, ( "%s: interrupt csr0=%04x new csr=%04x.\n",
682 dev->name, csr0, DREG ));
683
684 if (csr0 & CSR0_TINT) { /* Tx-done interrupt */
685 int old_tx = lp->old_tx;
686
687 // if(lance_debug >= 3) {
688 // int i;
689 //
690 // printk("%s: tx int\n", dev->name);
691 //
692 // for(i = 0; i < TX_RING_SIZE; i++)
693 // printk("ring %d flag=%04x\n", i,
694 // MEM->tx_head[i].flag);
695 // }
696
697 while( old_tx != lp->new_tx) {
698 struct lance_tx_head *head = &(MEM->tx_head[old_tx]);
699
700 DPRINTK(3, ("on tx_ring %d\n", old_tx));
701
702 if (head->flag & TMD1_OWN_CHIP)
703 break; /* It still hasn't been Txed */
704
705 if (head->flag & TMD1_ERR) {
706 int status = head->misc;
707 dev->stats.tx_errors++;
708 if (status & TMD3_RTRY) dev->stats.tx_aborted_errors++;
709 if (status & TMD3_LCAR) dev->stats.tx_carrier_errors++;
710 if (status & TMD3_LCOL) dev->stats.tx_window_errors++;
711 if (status & (TMD3_UFLO | TMD3_BUFF)) {
712 dev->stats.tx_fifo_errors++;
713 printk("%s: Tx FIFO error\n",
714 dev->name);
715 REGA(CSR0) = CSR0_STOP;
716 REGA(CSR3) = CSR3_BSWP;
717 lance_init_ring(dev);
718 REGA(CSR0) = CSR0_STRT | CSR0_INEA;
719 return IRQ_HANDLED;
720 }
721 } else if(head->flag & (TMD1_ENP | TMD1_STP)) {
722
723 head->flag &= ~(TMD1_ENP | TMD1_STP);
724 if(head->flag & (TMD1_ONE | TMD1_MORE))
725 dev->stats.collisions++;
726
727 dev->stats.tx_packets++;
728 DPRINTK(3, ("cleared tx ring %d\n", old_tx));
729 }
730 old_tx = (old_tx +1) & TX_RING_MOD_MASK;
731 }
732
733 lp->old_tx = old_tx;
734 }
735
736
737 if (netif_queue_stopped(dev)) {
738 /* The ring is no longer full, clear tbusy. */
739 netif_start_queue(dev);
740 netif_wake_queue(dev);
741 }
742
743 if (csr0 & CSR0_RINT) /* Rx interrupt */
744 lance_rx( dev );
745
746 /* Log misc errors. */
747 if (csr0 & CSR0_BABL) dev->stats.tx_errors++; /* Tx babble. */
748 if (csr0 & CSR0_MISS) dev->stats.rx_errors++; /* Missed a Rx frame. */
749 if (csr0 & CSR0_MERR) {
750 DPRINTK( 1, ( "%s: Bus master arbitration failure (?!?), "
751 "status %04x.\n", dev->name, csr0 ));
752 /* Restart the chip. */
753 REGA(CSR0) = CSR0_STOP;
754 REGA(CSR3) = CSR3_BSWP;
755 lance_init_ring(dev);
756 REGA(CSR0) = CSR0_STRT | CSR0_INEA;
757 }
758
759
760 /* Clear any other interrupt, and set interrupt enable. */
761 // DREG = CSR0_BABL | CSR0_CERR | CSR0_MISS | CSR0_MERR |
762 // CSR0_IDON | CSR0_INEA;
763
764 REGA(CSR0) = CSR0_INEA;
765
766 if(DREG & (CSR0_RINT | CSR0_TINT)) {
767 DPRINTK(2, ("restarting interrupt, csr0=%#04x\n", DREG));
768 goto still_more;
769 }
770
771 DPRINTK( 2, ( "%s: exiting interrupt, csr0=%#04x.\n",
772 dev->name, DREG ));
773 in_interrupt = 0;
774 return IRQ_HANDLED;
775 }
776
777 /* get packet, toss into skbuff */
778 static int lance_rx( struct net_device *dev )
779 {
780 struct lance_private *lp = netdev_priv(dev);
781 int entry = lp->new_rx;
782
783 /* If we own the next entry, it's a new packet. Send it up. */
784 while( (MEM->rx_head[entry].flag & RMD1_OWN) == RMD1_OWN_HOST ) {
785 struct lance_rx_head *head = &(MEM->rx_head[entry]);
786 int status = head->flag;
787
788 if (status != (RMD1_ENP|RMD1_STP)) { /* There was an error. */
789 /* There is a tricky error noted by John Murphy,
790 <murf@perftech.com> to Russ Nelson: Even with
791 full-sized buffers it's possible for a jabber packet to use two
792 buffers, with only the last correctly noting the error. */
793 if (status & RMD1_ENP) /* Only count a general error at the */
794 dev->stats.rx_errors++; /* end of a packet.*/
795 if (status & RMD1_FRAM) dev->stats.rx_frame_errors++;
796 if (status & RMD1_OFLO) dev->stats.rx_over_errors++;
797 if (status & RMD1_CRC) dev->stats.rx_crc_errors++;
798 if (status & RMD1_BUFF) dev->stats.rx_fifo_errors++;
799 head->flag &= (RMD1_ENP|RMD1_STP);
800 } else {
801 /* Malloc up new buffer, compatible with net-3. */
802 // short pkt_len = head->msg_length;// & 0xfff;
803 short pkt_len = (head->msg_length & 0xfff) - 4;
804 struct sk_buff *skb;
805
806 if (pkt_len < 60) {
807 printk( "%s: Runt packet!\n", dev->name );
808 dev->stats.rx_errors++;
809 }
810 else {
811 skb = dev_alloc_skb( pkt_len+2 );
812 if (skb == NULL) {
813 DPRINTK( 1, ( "%s: Memory squeeze, deferring packet.\n",
814 dev->name ));
815
816 dev->stats.rx_dropped++;
817 head->msg_length = 0;
818 head->flag |= RMD1_OWN_CHIP;
819 lp->new_rx = (lp->new_rx+1) &
820 RX_RING_MOD_MASK;
821 }
822
823 #if 0
824 if (lance_debug >= 3) {
825 u_char *data = PKTBUF_ADDR(head);
826 printk("%s: RX pkt %d type 0x%04x"
827 " from %pM to %pM",
828 dev->name, lp->new_tx, ((u_short *)data)[6],
829 &data[6], data);
830
831 printk(" data %02x %02x %02x %02x %02x %02x %02x %02x "
832 "len %d at %08x\n",
833 data[15], data[16], data[17], data[18],
834 data[19], data[20], data[21], data[22],
835 pkt_len, data);
836 }
837 #endif
838 if (lance_debug >= 3) {
839 u_char *data = PKTBUF_ADDR(head);
840 printk( "%s: RX pkt %d type 0x%04x len %d\n ", dev->name, entry, ((u_short *)data)[6], pkt_len);
841 }
842
843
844 skb_reserve( skb, 2 ); /* 16 byte align */
845 skb_put( skb, pkt_len ); /* Make room */
846 skb_copy_to_linear_data(skb,
847 PKTBUF_ADDR(head),
848 pkt_len);
849
850 skb->protocol = eth_type_trans( skb, dev );
851 netif_rx( skb );
852 dev->stats.rx_packets++;
853 dev->stats.rx_bytes += pkt_len;
854 }
855 }
856
857 // head->buf_length = -PKT_BUF_SZ | 0xf000;
858 head->msg_length = 0;
859 head->flag = RMD1_OWN_CHIP;
860
861 entry = lp->new_rx = (lp->new_rx +1) & RX_RING_MOD_MASK;
862 }
863
864 /* From lance.c (Donald Becker): */
865 /* We should check that at least two ring entries are free.
866 If not, we should free one and mark stats->rx_dropped++. */
867
868 return 0;
869 }
870
871
872 static int lance_close( struct net_device *dev )
873 {
874 struct lance_private *lp = netdev_priv(dev);
875
876 netif_stop_queue(dev);
877
878 AREG = CSR0;
879
880 DPRINTK( 2, ( "%s: Shutting down ethercard, status was %2.2x.\n",
881 dev->name, DREG ));
882
883 /* We stop the LANCE here -- it occasionally polls
884 memory if we don't. */
885 DREG = CSR0_STOP;
886 return 0;
887 }
888
889
890 /* Set or clear the multicast filter for this adaptor.
891 num_addrs == -1 Promiscuous mode, receive all packets
892 num_addrs == 0 Normal mode, clear multicast list
893 num_addrs > 0 Multicast mode, receive normal and MC packets, and do
894 best-effort filtering.
895 */
896
897 /* completely untested on a sun3 */
898 static void set_multicast_list( struct net_device *dev )
899 {
900 struct lance_private *lp = netdev_priv(dev);
901
902 if(netif_queue_stopped(dev))
903 /* Only possible if board is already started */
904 return;
905
906 /* We take the simple way out and always enable promiscuous mode. */
907 DREG = CSR0_STOP; /* Temporarily stop the lance. */
908
909 if (dev->flags & IFF_PROMISC) {
910 /* Log any net taps. */
911 DPRINTK( 3, ( "%s: Promiscuous mode enabled.\n", dev->name ));
912 REGA( CSR15 ) = 0x8000; /* Set promiscuous mode */
913 } else {
914 short multicast_table[4];
915 int num_addrs = dev->mc_count;
916 int i;
917 /* We don't use the multicast table, but rely on upper-layer
918 * filtering. */
919 memset( multicast_table, (num_addrs == 0) ? 0 : -1,
920 sizeof(multicast_table) );
921 for( i = 0; i < 4; i++ )
922 REGA( CSR8+i ) = multicast_table[i];
923 REGA( CSR15 ) = 0; /* Unset promiscuous mode */
924 }
925
926 /*
927 * Always set BSWP after a STOP as STOP puts it back into
928 * little endian mode.
929 */
930 REGA( CSR3 ) = CSR3_BSWP;
931
932 /* Resume normal operation and reset AREG to CSR0 */
933 REGA( CSR0 ) = CSR0_IDON | CSR0_INEA | CSR0_STRT;
934 }
935
936
937 #ifdef MODULE
938
939 static struct net_device *sun3lance_dev;
940
941 int __init init_module(void)
942 {
943 sun3lance_dev = sun3lance_probe(-1);
944 if (IS_ERR(sun3lance_dev))
945 return PTR_ERR(sun3lance_dev);
946 return 0;
947 }
948
949 void __exit cleanup_module(void)
950 {
951 unregister_netdev(sun3lance_dev);
952 #ifdef CONFIG_SUN3
953 iounmap((void __iomem *)sun3lance_dev->base_addr);
954 #endif
955 free_netdev(sun3lance_dev);
956 }
957
958 #endif /* MODULE */
959
Support for the Chinese Samsung S3C2440 based development boards