r8169: de-obfuscate modulo arithmetic
[linux-2.6] / drivers / net / sun3lance.c
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         struct net_device_stats stats;
156 /* These two must be longs for set_bit() */
157         long        tx_full;
158         long        lock;
159 };
160
161 /* I/O register access macros */
162
163 #define MEM     lp->mem
164 #define DREG    lp->iobase[0]
165 #define AREG    lp->iobase[1]
166 #define REGA(a) (*( AREG = (a), &DREG ))
167
168 /* Definitions for the Lance */
169
170 /* tx_head flags */
171 #define TMD1_ENP                0x01    /* end of packet */
172 #define TMD1_STP                0x02    /* start of packet */
173 #define TMD1_DEF                0x04    /* deferred */
174 #define TMD1_ONE                0x08    /* one retry needed */
175 #define TMD1_MORE               0x10    /* more than one retry needed */
176 #define TMD1_ERR                0x40    /* error summary */
177 #define TMD1_OWN                0x80    /* ownership (set: chip owns) */
178
179 #define TMD1_OWN_CHIP   TMD1_OWN
180 #define TMD1_OWN_HOST   0
181
182 /* tx_head misc field */
183 #define TMD3_TDR                0x03FF  /* Time Domain Reflectometry counter */
184 #define TMD3_RTRY               0x0400  /* failed after 16 retries */
185 #define TMD3_LCAR               0x0800  /* carrier lost */
186 #define TMD3_LCOL               0x1000  /* late collision */
187 #define TMD3_UFLO               0x4000  /* underflow (late memory) */
188 #define TMD3_BUFF               0x8000  /* buffering error (no ENP) */
189
190 /* rx_head flags */
191 #define RMD1_ENP                0x01    /* end of packet */
192 #define RMD1_STP                0x02    /* start of packet */
193 #define RMD1_BUFF               0x04    /* buffer error */
194 #define RMD1_CRC                0x08    /* CRC error */
195 #define RMD1_OFLO               0x10    /* overflow */
196 #define RMD1_FRAM               0x20    /* framing error */
197 #define RMD1_ERR                0x40    /* error summary */
198 #define RMD1_OWN                0x80    /* ownership (set: ship owns) */
199
200 #define RMD1_OWN_CHIP   RMD1_OWN
201 #define RMD1_OWN_HOST   0
202
203 /* register names */
204 #define CSR0    0               /* mode/status */
205 #define CSR1    1               /* init block addr (low) */
206 #define CSR2    2               /* init block addr (high) */
207 #define CSR3    3               /* misc */
208 #define CSR8    8               /* address filter */
209 #define CSR15   15              /* promiscuous mode */
210
211 /* CSR0 */
212 /* (R=readable, W=writeable, S=set on write, C=clear on write) */
213 #define CSR0_INIT       0x0001          /* initialize (RS) */
214 #define CSR0_STRT       0x0002          /* start (RS) */
215 #define CSR0_STOP       0x0004          /* stop (RS) */
216 #define CSR0_TDMD       0x0008          /* transmit demand (RS) */
217 #define CSR0_TXON       0x0010          /* transmitter on (R) */
218 #define CSR0_RXON       0x0020          /* receiver on (R) */
219 #define CSR0_INEA       0x0040          /* interrupt enable (RW) */
220 #define CSR0_INTR       0x0080          /* interrupt active (R) */
221 #define CSR0_IDON       0x0100          /* initialization done (RC) */
222 #define CSR0_TINT       0x0200          /* transmitter interrupt (RC) */
223 #define CSR0_RINT       0x0400          /* receiver interrupt (RC) */
224 #define CSR0_MERR       0x0800          /* memory error (RC) */
225 #define CSR0_MISS       0x1000          /* missed frame (RC) */
226 #define CSR0_CERR       0x2000          /* carrier error (no heartbeat :-) (RC) */
227 #define CSR0_BABL       0x4000          /* babble: tx-ed too many bits (RC) */
228 #define CSR0_ERR        0x8000          /* error (RC) */
229
230 /* CSR3 */
231 #define CSR3_BCON       0x0001          /* byte control */
232 #define CSR3_ACON       0x0002          /* ALE control */
233 #define CSR3_BSWP       0x0004          /* byte swap (1=big endian) */
234
235 /***************************** Prototypes *****************************/
236
237 static int lance_probe( struct net_device *dev);
238 static int lance_open( struct net_device *dev );
239 static void lance_init_ring( struct net_device *dev );
240 static int lance_start_xmit( struct sk_buff *skb, struct net_device *dev );
241 static irqreturn_t lance_interrupt( int irq, void *dev_id);
242 static int lance_rx( struct net_device *dev );
243 static int lance_close( struct net_device *dev );
244 static struct net_device_stats *lance_get_stats( struct net_device *dev );
245 static void set_multicast_list( struct net_device *dev );
246
247 /************************* End of Prototypes **************************/
248
249 struct net_device * __init sun3lance_probe(int unit)
250 {
251         struct net_device *dev;
252         static int found;
253         int err = -ENODEV;
254
255         /* check that this machine has an onboard lance */
256         switch(idprom->id_machtype) {
257         case SM_SUN3|SM_3_50:
258         case SM_SUN3|SM_3_60:
259         case SM_SUN3X|SM_3_80:
260                 /* these machines have lance */
261                 break;
262
263         default:
264                 return ERR_PTR(-ENODEV);
265         }
266
267         if (found)
268                 return ERR_PTR(-ENODEV);
269
270         dev = alloc_etherdev(sizeof(struct lance_private));
271         if (!dev)
272                 return ERR_PTR(-ENOMEM);
273         if (unit >= 0) {
274                 sprintf(dev->name, "eth%d", unit);
275                 netdev_boot_setup_check(dev);
276         }
277         SET_MODULE_OWNER(dev);
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         for( i = 0; i < 6; ++i )
382                 printk( "%02x%s", dev->dev_addr[i], (i < 5) ? ":" : "\n" );
383
384         MEM->init.mode = 0x0000;
385         MEM->init.filter[0] = 0x00000000;
386         MEM->init.filter[1] = 0x00000000;
387         MEM->init.rdra = dvma_vtob(MEM->rx_head);
388         MEM->init.rlen    = (RX_LOG_RING_SIZE << 13) |
389                 (dvma_vtob(MEM->rx_head) >> 16);
390         MEM->init.tdra = dvma_vtob(MEM->tx_head);
391         MEM->init.tlen    = (TX_LOG_RING_SIZE << 13) |
392                 (dvma_vtob(MEM->tx_head) >> 16);
393
394         DPRINTK(2, ("initaddr: %08lx rx_ring: %08lx tx_ring: %08lx\n",
395                dvma_vtob(&(MEM->init)), dvma_vtob(MEM->rx_head),
396                (dvma_vtob(MEM->tx_head))));
397
398         if (did_version++ == 0)
399                 printk( version );
400
401         /* The LANCE-specific entries in the device structure. */
402         dev->open = &lance_open;
403         dev->hard_start_xmit = &lance_start_xmit;
404         dev->stop = &lance_close;
405         dev->get_stats = &lance_get_stats;
406         dev->set_multicast_list = &set_multicast_list;
407         dev->set_mac_address = NULL;
408 //      KLUDGE -- REMOVE ME
409         set_bit(__LINK_STATE_PRESENT, &dev->state);
410
411
412         memset( &lp->stats, 0, sizeof(lp->stats) );
413
414         return 1;
415 }
416
417 static int lance_open( struct net_device *dev )
418 {
419         struct lance_private *lp = netdev_priv(dev);
420         int i;
421
422         DPRINTK( 2, ( "%s: lance_open()\n", dev->name ));
423
424         REGA(CSR0) = CSR0_STOP;
425
426         lance_init_ring(dev);
427
428         /* From now on, AREG is kept to point to CSR0 */
429         REGA(CSR0) = CSR0_INIT;
430
431         i = 1000000;
432         while (--i > 0)
433                 if (DREG & CSR0_IDON)
434                         break;
435         if (i < 0 || (DREG & CSR0_ERR)) {
436                 DPRINTK( 2, ( "lance_open(): opening %s failed, i=%d, csr0=%04x\n",
437                                           dev->name, i, DREG ));
438                 DREG = CSR0_STOP;
439                 return( -EIO );
440         }
441
442         DREG = CSR0_IDON | CSR0_STRT | CSR0_INEA;
443
444         netif_start_queue(dev);
445
446         DPRINTK( 2, ( "%s: LANCE is open, csr0 %04x\n", dev->name, DREG ));
447
448         return( 0 );
449 }
450
451
452 /* Initialize the LANCE Rx and Tx rings. */
453
454 static void lance_init_ring( struct net_device *dev )
455 {
456         struct lance_private *lp = netdev_priv(dev);
457         int i;
458
459         lp->lock = 0;
460         lp->tx_full = 0;
461         lp->new_rx = lp->new_tx = 0;
462         lp->old_rx = lp->old_tx = 0;
463
464         for( i = 0; i < TX_RING_SIZE; i++ ) {
465                 MEM->tx_head[i].base = dvma_vtob(MEM->tx_data[i]);
466                 MEM->tx_head[i].flag = 0;
467                 MEM->tx_head[i].base_hi =
468                         (dvma_vtob(MEM->tx_data[i])) >>16;
469                 MEM->tx_head[i].length = 0;
470                 MEM->tx_head[i].misc = 0;
471         }
472
473         for( i = 0; i < RX_RING_SIZE; i++ ) {
474                 MEM->rx_head[i].base = dvma_vtob(MEM->rx_data[i]);
475                 MEM->rx_head[i].flag = RMD1_OWN_CHIP;
476                 MEM->rx_head[i].base_hi =
477                         (dvma_vtob(MEM->rx_data[i])) >> 16;
478                 MEM->rx_head[i].buf_length = -PKT_BUF_SZ | 0xf000;
479                 MEM->rx_head[i].msg_length = 0;
480         }
481
482         /* tell the card it's ether address, bytes swapped */
483         MEM->init.hwaddr[0] = dev->dev_addr[1];
484         MEM->init.hwaddr[1] = dev->dev_addr[0];
485         MEM->init.hwaddr[2] = dev->dev_addr[3];
486         MEM->init.hwaddr[3] = dev->dev_addr[2];
487         MEM->init.hwaddr[4] = dev->dev_addr[5];
488         MEM->init.hwaddr[5] = dev->dev_addr[4];
489
490         MEM->init.mode = 0x0000;
491         MEM->init.filter[0] = 0x00000000;
492         MEM->init.filter[1] = 0x00000000;
493         MEM->init.rdra = dvma_vtob(MEM->rx_head);
494         MEM->init.rlen    = (RX_LOG_RING_SIZE << 13) |
495                 (dvma_vtob(MEM->rx_head) >> 16);
496         MEM->init.tdra = dvma_vtob(MEM->tx_head);
497         MEM->init.tlen    = (TX_LOG_RING_SIZE << 13) |
498                 (dvma_vtob(MEM->tx_head) >> 16);
499
500
501         /* tell the lance the address of its init block */
502         REGA(CSR1) = dvma_vtob(&(MEM->init));
503         REGA(CSR2) = dvma_vtob(&(MEM->init)) >> 16;
504
505 #ifdef CONFIG_SUN3X
506         REGA(CSR3) = CSR3_BSWP | CSR3_ACON | CSR3_BCON;
507 #else
508         REGA(CSR3) = CSR3_BSWP;
509 #endif
510
511 }
512
513
514 static int lance_start_xmit( struct sk_buff *skb, struct net_device *dev )
515 {
516         struct lance_private *lp = netdev_priv(dev);
517         int entry, len;
518         struct lance_tx_head *head;
519         unsigned long flags;
520
521         DPRINTK( 1, ( "%s: transmit start.\n",
522                       dev->name));
523
524         /* Transmitter timeout, serious problems. */
525         if (netif_queue_stopped(dev)) {
526                 int tickssofar = jiffies - dev->trans_start;
527                 if (tickssofar < 20)
528                         return( 1 );
529
530                 DPRINTK( 1, ( "%s: transmit timed out, status %04x, resetting.\n",
531                                           dev->name, DREG ));
532                 DREG = CSR0_STOP;
533                 /*
534                  * Always set BSWP after a STOP as STOP puts it back into
535                  * little endian mode.
536                  */
537                 REGA(CSR3) = CSR3_BSWP;
538                 lp->stats.tx_errors++;
539
540                 if(lance_debug >= 2) {
541                         int i;
542                         printk("Ring data: old_tx %d new_tx %d%s new_rx %d\n",
543                                lp->old_tx, lp->new_tx,
544                                lp->tx_full ? " (full)" : "",
545                                lp->new_rx );
546                         for( i = 0 ; i < RX_RING_SIZE; i++ )
547                                 printk( "rx #%d: base=%04x blen=%04x mlen=%04x\n",
548                                         i, MEM->rx_head[i].base,
549                                         -MEM->rx_head[i].buf_length,
550                                         MEM->rx_head[i].msg_length);
551                         for( i = 0 ; i < TX_RING_SIZE; i++ )
552                                 printk("tx #%d: base=%04x len=%04x misc=%04x\n",
553                                        i, MEM->tx_head[i].base,
554                                        -MEM->tx_head[i].length,
555                                        MEM->tx_head[i].misc );
556                 }
557
558                 lance_init_ring(dev);
559                 REGA( CSR0 ) = CSR0_INEA | CSR0_INIT | CSR0_STRT;
560
561                 netif_start_queue(dev);
562                 dev->trans_start = jiffies;
563
564                 return 0;
565         }
566
567
568         /* Block a timer-based transmit from overlapping.  This could better be
569            done with atomic_swap(1, dev->tbusy), but set_bit() works as well. */
570
571         /* Block a timer-based transmit from overlapping with us by
572            stopping the queue for a bit... */
573
574         netif_stop_queue(dev);
575
576         if (test_and_set_bit( 0, (void*)&lp->lock ) != 0) {
577                 printk( "%s: tx queue lock!.\n", dev->name);
578                 /* don't clear dev->tbusy flag. */
579                 return 1;
580         }
581
582         AREG = CSR0;
583         DPRINTK( 2, ( "%s: lance_start_xmit() called, csr0 %4.4x.\n",
584                                   dev->name, DREG ));
585
586 #ifdef CONFIG_SUN3X
587         /* this weirdness doesn't appear on sun3... */
588         if(!(DREG & CSR0_INIT)) {
589                 DPRINTK( 1, ("INIT not set, reinitializing...\n"));
590                 REGA( CSR0 ) = CSR0_STOP;
591                 lance_init_ring(dev);
592                 REGA( CSR0 ) = CSR0_INIT | CSR0_STRT;
593         }
594 #endif
595
596         /* Fill in a Tx ring entry */
597 #if 0
598         if (lance_debug >= 2) {
599                 u_char *p;
600                 int i;
601                 printk( "%s: TX pkt %d type 0x%04x from ", dev->name,
602                         lp->new_tx, ((u_short *)skb->data)[6]);
603                 for( p = &((u_char *)skb->data)[6], i = 0; i < 6; i++ )
604                         printk("%02x%s", *p++, i != 5 ? ":" : "" );
605                 printk(" to ");
606                 for( p = (u_char *)skb->data, i = 0; i < 6; i++ )
607                         printk("%02x%s", *p++, i != 5 ? ":" : "" );
608                 printk(" data at 0x%08x len %d\n", (int)skb->data,
609                        (int)skb->len );
610         }
611 #endif
612         /* We're not prepared for the int until the last flags are set/reset.
613          * And the int may happen already after setting the OWN_CHIP... */
614         local_irq_save(flags);
615
616         /* Mask to ring buffer boundary. */
617         entry = lp->new_tx;
618         head  = &(MEM->tx_head[entry]);
619
620         /* Caution: the write order is important here, set the "ownership" bits
621          * last.
622          */
623
624         /* the sun3's lance needs it's buffer padded to the minimum
625            size */
626         len = (ETH_ZLEN < skb->len) ? skb->len : ETH_ZLEN;
627
628 //      head->length = -len;
629         head->length = (-len) | 0xf000;
630         head->misc = 0;
631
632         skb_copy_from_linear_data(skb, PKTBUF_ADDR(head), skb->len);
633         if (len != skb->len)
634                 memset(PKTBUF_ADDR(head) + skb->len, 0, len-skb->len);
635
636         head->flag = TMD1_OWN_CHIP | TMD1_ENP | TMD1_STP;
637         lp->new_tx = (lp->new_tx + 1) & TX_RING_MOD_MASK;
638         lp->stats.tx_bytes += skb->len;
639
640         /* Trigger an immediate send poll. */
641         REGA(CSR0) = CSR0_INEA | CSR0_TDMD | CSR0_STRT;
642         AREG = CSR0;
643         DPRINTK( 2, ( "%s: lance_start_xmit() exiting, csr0 %4.4x.\n",
644                                   dev->name, DREG ));
645         dev->trans_start = jiffies;
646         dev_kfree_skb( skb );
647
648         lp->lock = 0;
649         if ((MEM->tx_head[(entry+1) & TX_RING_MOD_MASK].flag & TMD1_OWN) ==
650             TMD1_OWN_HOST)
651                 netif_start_queue(dev);
652
653         local_irq_restore(flags);
654
655         return 0;
656 }
657
658 /* The LANCE interrupt handler. */
659
660 static irqreturn_t lance_interrupt( int irq, void *dev_id)
661 {
662         struct net_device *dev = dev_id;
663         struct lance_private *lp = netdev_priv(dev);
664         int csr0;
665         static int in_interrupt;
666
667         if (dev == NULL) {
668                 DPRINTK( 1, ( "lance_interrupt(): invalid dev_id\n" ));
669                 return IRQ_NONE;
670         }
671
672         if (in_interrupt)
673                 DPRINTK( 2, ( "%s: Re-entering the interrupt handler.\n", dev->name ));
674         in_interrupt = 1;
675
676  still_more:
677         flush_cache_all();
678
679         AREG = CSR0;
680         csr0 = DREG;
681
682         /* ack interrupts */
683         DREG = csr0 & (CSR0_TINT | CSR0_RINT | CSR0_IDON);
684
685         /* clear errors */
686         if(csr0 & CSR0_ERR)
687                 DREG = CSR0_BABL | CSR0_MERR | CSR0_CERR | CSR0_MISS;
688
689
690         DPRINTK( 2, ( "%s: interrupt  csr0=%04x new csr=%04x.\n",
691                       dev->name, csr0, DREG ));
692
693         if (csr0 & CSR0_TINT) {                 /* Tx-done interrupt */
694                 int old_tx = lp->old_tx;
695
696 //              if(lance_debug >= 3) {
697 //                      int i;
698 //
699 //                      printk("%s: tx int\n", dev->name);
700 //
701 //                      for(i = 0; i < TX_RING_SIZE; i++)
702 //                              printk("ring %d flag=%04x\n", i,
703 //                                     MEM->tx_head[i].flag);
704 //              }
705
706                 while( old_tx != lp->new_tx) {
707                         struct lance_tx_head *head = &(MEM->tx_head[old_tx]);
708
709                         DPRINTK(3, ("on tx_ring %d\n", old_tx));
710
711                         if (head->flag & TMD1_OWN_CHIP)
712                                 break; /* It still hasn't been Txed */
713
714                         if (head->flag & TMD1_ERR) {
715                                 int status = head->misc;
716                                 lp->stats.tx_errors++;
717                                 if (status & TMD3_RTRY) lp->stats.tx_aborted_errors++;
718                                 if (status & TMD3_LCAR) lp->stats.tx_carrier_errors++;
719                                 if (status & TMD3_LCOL) lp->stats.tx_window_errors++;
720                                 if (status & (TMD3_UFLO | TMD3_BUFF)) {
721                                         lp->stats.tx_fifo_errors++;
722                                         printk("%s: Tx FIFO error\n",
723                                                dev->name);
724                                         REGA(CSR0) = CSR0_STOP;
725                                         REGA(CSR3) = CSR3_BSWP;
726                                         lance_init_ring(dev);
727                                         REGA(CSR0) = CSR0_STRT | CSR0_INEA;
728                                         return IRQ_HANDLED;
729                                 }
730                         } else if(head->flag & (TMD1_ENP | TMD1_STP)) {
731
732                                 head->flag &= ~(TMD1_ENP | TMD1_STP);
733                                 if(head->flag & (TMD1_ONE | TMD1_MORE))
734                                         lp->stats.collisions++;
735
736                                 lp->stats.tx_packets++;
737                                 DPRINTK(3, ("cleared tx ring %d\n", old_tx));
738                         }
739                         old_tx = (old_tx +1) & TX_RING_MOD_MASK;
740                 }
741
742                 lp->old_tx = old_tx;
743         }
744
745
746         if (netif_queue_stopped(dev)) {
747                 /* The ring is no longer full, clear tbusy. */
748                 netif_start_queue(dev);
749                 netif_wake_queue(dev);
750         }
751
752         if (csr0 & CSR0_RINT)                   /* Rx interrupt */
753                 lance_rx( dev );
754
755         /* Log misc errors. */
756         if (csr0 & CSR0_BABL) lp->stats.tx_errors++; /* Tx babble. */
757         if (csr0 & CSR0_MISS) lp->stats.rx_errors++; /* Missed a Rx frame. */
758         if (csr0 & CSR0_MERR) {
759                 DPRINTK( 1, ( "%s: Bus master arbitration failure (?!?), "
760                               "status %04x.\n", dev->name, csr0 ));
761                 /* Restart the chip. */
762                 REGA(CSR0) = CSR0_STOP;
763                 REGA(CSR3) = CSR3_BSWP;
764                 lance_init_ring(dev);
765                 REGA(CSR0) = CSR0_STRT | CSR0_INEA;
766         }
767
768
769     /* Clear any other interrupt, and set interrupt enable. */
770 //      DREG = CSR0_BABL | CSR0_CERR | CSR0_MISS | CSR0_MERR |
771 //                 CSR0_IDON | CSR0_INEA;
772
773         REGA(CSR0) = CSR0_INEA;
774
775         if(DREG & (CSR0_RINT | CSR0_TINT)) {
776              DPRINTK(2, ("restarting interrupt, csr0=%#04x\n", DREG));
777              goto still_more;
778         }
779
780         DPRINTK( 2, ( "%s: exiting interrupt, csr0=%#04x.\n",
781                                   dev->name, DREG ));
782         in_interrupt = 0;
783         return IRQ_HANDLED;
784 }
785
786 /* get packet, toss into skbuff */
787 static int lance_rx( struct net_device *dev )
788 {
789         struct lance_private *lp = netdev_priv(dev);
790         int entry = lp->new_rx;
791
792         /* If we own the next entry, it's a new packet. Send it up. */
793         while( (MEM->rx_head[entry].flag & RMD1_OWN) == RMD1_OWN_HOST ) {
794                 struct lance_rx_head *head = &(MEM->rx_head[entry]);
795                 int status = head->flag;
796
797                 if (status != (RMD1_ENP|RMD1_STP)) {  /* There was an error. */
798                         /* There is a tricky error noted by John Murphy,
799                            <murf@perftech.com> to Russ Nelson: Even with
800                            full-sized buffers it's possible for a jabber packet to use two
801                            buffers, with only the last correctly noting the error. */
802                         if (status & RMD1_ENP)  /* Only count a general error at the */
803                                 lp->stats.rx_errors++; /* end of a packet.*/
804                         if (status & RMD1_FRAM) lp->stats.rx_frame_errors++;
805                         if (status & RMD1_OFLO) lp->stats.rx_over_errors++;
806                         if (status & RMD1_CRC) lp->stats.rx_crc_errors++;
807                         if (status & RMD1_BUFF) lp->stats.rx_fifo_errors++;
808                         head->flag &= (RMD1_ENP|RMD1_STP);
809                 } else {
810                         /* Malloc up new buffer, compatible with net-3. */
811 //                      short pkt_len = head->msg_length;// & 0xfff;
812                         short pkt_len = (head->msg_length & 0xfff) - 4;
813                         struct sk_buff *skb;
814
815                         if (pkt_len < 60) {
816                                 printk( "%s: Runt packet!\n", dev->name );
817                                 lp->stats.rx_errors++;
818                         }
819                         else {
820                                 skb = dev_alloc_skb( pkt_len+2 );
821                                 if (skb == NULL) {
822                                         DPRINTK( 1, ( "%s: Memory squeeze, deferring packet.\n",
823                                                       dev->name ));
824
825                                         lp->stats.rx_dropped++;
826                                         head->msg_length = 0;
827                                         head->flag |= RMD1_OWN_CHIP;
828                                         lp->new_rx = (lp->new_rx+1) &
829                                              RX_RING_MOD_MASK;
830                                 }
831
832 #if 0
833                                 if (lance_debug >= 3) {
834                                         u_char *data = PKTBUF_ADDR(head), *p;
835                                         printk( "%s: RX pkt %d type 0x%04x from ", dev->name, entry, ((u_short *)data)[6]);
836                                         for( p = &data[6], i = 0; i < 6; i++ )
837                                                 printk("%02x%s", *p++, i != 5 ? ":" : "" );
838                                         printk(" to ");
839                                         for( p = data, i = 0; i < 6; i++ )
840                                                 printk("%02x%s", *p++, i != 5 ? ":" : "" );
841                                         printk(" data %02x %02x %02x %02x %02x %02x %02x %02x "
842                                                "len %d at %08x\n",
843                                                data[15], data[16], data[17], data[18],
844                                                data[19], data[20], data[21], data[22],
845                                                pkt_len, data);
846                                 }
847 #endif
848                                 if (lance_debug >= 3) {
849                                         u_char *data = PKTBUF_ADDR(head);
850                                         printk( "%s: RX pkt %d type 0x%04x len %d\n ", dev->name, entry, ((u_short *)data)[6], pkt_len);
851                                 }
852
853
854                                 skb_reserve( skb, 2 );  /* 16 byte align */
855                                 skb_put( skb, pkt_len );        /* Make room */
856 //                              skb_copy_to_linear_data(skb, PKTBUF_ADDR(head), pkt_len);
857                                 eth_copy_and_sum(skb,
858                                                  PKTBUF_ADDR(head),
859                                                  pkt_len, 0);
860
861                                 skb->protocol = eth_type_trans( skb, dev );
862                                 netif_rx( skb );
863                                 dev->last_rx = jiffies;
864                                 lp->stats.rx_packets++;
865                                 lp->stats.rx_bytes += pkt_len;
866                         }
867                 }
868
869 //              head->buf_length = -PKT_BUF_SZ | 0xf000;
870                 head->msg_length = 0;
871                 head->flag = RMD1_OWN_CHIP;
872
873                 entry = lp->new_rx = (lp->new_rx +1) & RX_RING_MOD_MASK;
874         }
875
876         /* From lance.c (Donald Becker): */
877         /* We should check that at least two ring entries are free.
878            If not, we should free one and mark stats->rx_dropped++. */
879
880         return 0;
881 }
882
883
884 static int lance_close( struct net_device *dev )
885 {
886         struct lance_private *lp = netdev_priv(dev);
887
888         netif_stop_queue(dev);
889
890         AREG = CSR0;
891
892         DPRINTK( 2, ( "%s: Shutting down ethercard, status was %2.2x.\n",
893                                   dev->name, DREG ));
894
895         /* We stop the LANCE here -- it occasionally polls
896            memory if we don't. */
897         DREG = CSR0_STOP;
898         return 0;
899 }
900
901
902 static struct net_device_stats *lance_get_stats( struct net_device *dev )
903 {
904         struct lance_private *lp = netdev_priv(dev);
905
906         return &lp->stats;
907 }
908
909
910 /* Set or clear the multicast filter for this adaptor.
911    num_addrs == -1              Promiscuous mode, receive all packets
912    num_addrs == 0               Normal mode, clear multicast list
913    num_addrs > 0                Multicast mode, receive normal and MC packets, and do
914                                                 best-effort filtering.
915  */
916
917 /* completely untested on a sun3 */
918 static void set_multicast_list( struct net_device *dev )
919 {
920         struct lance_private *lp = netdev_priv(dev);
921
922         if(netif_queue_stopped(dev))
923                 /* Only possible if board is already started */
924                 return;
925
926         /* We take the simple way out and always enable promiscuous mode. */
927         DREG = CSR0_STOP; /* Temporarily stop the lance. */
928
929         if (dev->flags & IFF_PROMISC) {
930                 /* Log any net taps. */
931                 DPRINTK( 3, ( "%s: Promiscuous mode enabled.\n", dev->name ));
932                 REGA( CSR15 ) = 0x8000; /* Set promiscuous mode */
933         } else {
934                 short multicast_table[4];
935                 int num_addrs = dev->mc_count;
936                 int i;
937                 /* We don't use the multicast table, but rely on upper-layer
938                  * filtering. */
939                 memset( multicast_table, (num_addrs == 0) ? 0 : -1,
940                                 sizeof(multicast_table) );
941                 for( i = 0; i < 4; i++ )
942                         REGA( CSR8+i ) = multicast_table[i];
943                 REGA( CSR15 ) = 0; /* Unset promiscuous mode */
944         }
945
946         /*
947          * Always set BSWP after a STOP as STOP puts it back into
948          * little endian mode.
949          */
950         REGA( CSR3 ) = CSR3_BSWP;
951
952         /* Resume normal operation and reset AREG to CSR0 */
953         REGA( CSR0 ) = CSR0_IDON | CSR0_INEA | CSR0_STRT;
954 }
955
956
957 #ifdef MODULE
958
959 static struct net_device *sun3lance_dev;
960
961 int __init init_module(void)
962 {
963         sun3lance_dev = sun3lance_probe(-1);
964         if (IS_ERR(sun3lance_dev))
965                 return PTR_ERR(sun3lance_dev);
966         return 0;
967 }
968
969 void __exit cleanup_module(void)
970 {
971         unregister_netdev(sun3lance_dev);
972 #ifdef CONFIG_SUN3
973         iounmap((void __iomem *)sun3lance_dev->base_addr);
974 #endif
975         free_netdev(sun3lance_dev);
976 }
977
978 #endif /* MODULE */
979