genirq: Add IRQF_RESUME_EARLY and resume such IRQs earlier
[pandora-kernel.git] / drivers / net / ariadne.c
1 /*
2  *  Amiga Linux/m68k Ariadne Ethernet Driver
3  *
4  *  © Copyright 1995-2003 by Geert Uytterhoeven (geert@linux-m68k.org)
5  *                           Peter De Schrijver (p2@mind.be)
6  *
7  *  ---------------------------------------------------------------------------
8  *
9  *  This program is based on
10  *
11  *      lance.c:        An AMD LANCE ethernet driver for linux.
12  *                      Written 1993-94 by Donald Becker.
13  *
14  *      Am79C960:       PCnet(tm)-ISA Single-Chip Ethernet Controller
15  *                      Advanced Micro Devices
16  *                      Publication #16907, Rev. B, Amendment/0, May 1994
17  *
18  *      MC68230:        Parallel Interface/Timer (PI/T)
19  *                      Motorola Semiconductors, December, 1983
20  *
21  *  ---------------------------------------------------------------------------
22  *
23  *  This file is subject to the terms and conditions of the GNU General Public
24  *  License.  See the file COPYING in the main directory of the Linux
25  *  distribution for more details.
26  *
27  *  ---------------------------------------------------------------------------
28  *
29  *  The Ariadne is a Zorro-II board made by Village Tronic. It contains:
30  *
31  *      - an Am79C960 PCnet-ISA Single-Chip Ethernet Controller with both
32  *        10BASE-2 (thin coax) and 10BASE-T (UTP) connectors
33  *
34  *      - an MC68230 Parallel Interface/Timer configured as 2 parallel ports
35  */
36
37 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
38 /*#define DEBUG*/
39
40 #include <linux/module.h>
41 #include <linux/stddef.h>
42 #include <linux/kernel.h>
43 #include <linux/string.h>
44 #include <linux/errno.h>
45 #include <linux/ioport.h>
46 #include <linux/netdevice.h>
47 #include <linux/etherdevice.h>
48 #include <linux/interrupt.h>
49 #include <linux/skbuff.h>
50 #include <linux/init.h>
51 #include <linux/zorro.h>
52 #include <linux/bitops.h>
53
54 #include <asm/amigaints.h>
55 #include <asm/amigahw.h>
56 #include <asm/irq.h>
57
58 #include "ariadne.h"
59
60 #ifdef ARIADNE_DEBUG
61 int ariadne_debug = ARIADNE_DEBUG;
62 #else
63 int ariadne_debug = 1;
64 #endif
65
66 /* Macros to Fix Endianness problems */
67
68 /* Swap the Bytes in a WORD */
69 #define swapw(x)        (((x >> 8) & 0x00ff) | ((x << 8) & 0xff00))
70 /* Get the Low BYTE in a WORD */
71 #define lowb(x)         (x & 0xff)
72 /* Get the Swapped High WORD in a LONG */
73 #define swhighw(x)      ((((x) >> 8) & 0xff00) | (((x) >> 24) & 0x00ff))
74 /* Get the Swapped Low WORD in a LONG */
75 #define swloww(x)       ((((x) << 8) & 0xff00) | (((x) >> 8) & 0x00ff))
76
77 /* Transmit/Receive Ring Definitions */
78
79 #define TX_RING_SIZE    5
80 #define RX_RING_SIZE    16
81
82 #define PKT_BUF_SIZE    1520
83
84 /* Private Device Data */
85
86 struct ariadne_private {
87         volatile struct TDRE *tx_ring[TX_RING_SIZE];
88         volatile struct RDRE *rx_ring[RX_RING_SIZE];
89         volatile u_short *tx_buff[TX_RING_SIZE];
90         volatile u_short *rx_buff[RX_RING_SIZE];
91         int cur_tx, cur_rx;             /* The next free ring entry */
92         int dirty_tx;                   /* The ring entries to be free()ed */
93         char tx_full;
94 };
95
96 /* Structure Created in the Ariadne's RAM Buffer */
97
98 struct lancedata {
99         struct TDRE tx_ring[TX_RING_SIZE];
100         struct RDRE rx_ring[RX_RING_SIZE];
101         u_short tx_buff[TX_RING_SIZE][PKT_BUF_SIZE / sizeof(u_short)];
102         u_short rx_buff[RX_RING_SIZE][PKT_BUF_SIZE / sizeof(u_short)];
103 };
104
105 static void memcpyw(volatile u_short *dest, u_short *src, int len)
106 {
107         while (len >= 2) {
108                 *(dest++) = *(src++);
109                 len -= 2;
110         }
111         if (len == 1)
112                 *dest = (*(u_char *)src) << 8;
113 }
114
115 static void ariadne_init_ring(struct net_device *dev)
116 {
117         struct ariadne_private *priv = netdev_priv(dev);
118         volatile struct lancedata *lancedata = (struct lancedata *)dev->mem_start;
119         int i;
120
121         netif_stop_queue(dev);
122
123         priv->tx_full = 0;
124         priv->cur_rx = priv->cur_tx = 0;
125         priv->dirty_tx = 0;
126
127         /* Set up TX Ring */
128         for (i = 0; i < TX_RING_SIZE; i++) {
129                 volatile struct TDRE *t = &lancedata->tx_ring[i];
130                 t->TMD0 = swloww(ARIADNE_RAM +
131                                  offsetof(struct lancedata, tx_buff[i]));
132                 t->TMD1 = swhighw(ARIADNE_RAM +
133                                   offsetof(struct lancedata, tx_buff[i])) |
134                         TF_STP | TF_ENP;
135                 t->TMD2 = swapw((u_short)-PKT_BUF_SIZE);
136                 t->TMD3 = 0;
137                 priv->tx_ring[i] = &lancedata->tx_ring[i];
138                 priv->tx_buff[i] = lancedata->tx_buff[i];
139                 netdev_dbg(dev, "TX Entry %2d at %p, Buf at %p\n",
140                            i, &lancedata->tx_ring[i], lancedata->tx_buff[i]);
141         }
142
143         /* Set up RX Ring */
144         for (i = 0; i < RX_RING_SIZE; i++) {
145                 volatile struct RDRE *r = &lancedata->rx_ring[i];
146                 r->RMD0 = swloww(ARIADNE_RAM +
147                                  offsetof(struct lancedata, rx_buff[i]));
148                 r->RMD1 = swhighw(ARIADNE_RAM +
149                                   offsetof(struct lancedata, rx_buff[i])) |
150                         RF_OWN;
151                 r->RMD2 = swapw((u_short)-PKT_BUF_SIZE);
152                 r->RMD3 = 0x0000;
153                 priv->rx_ring[i] = &lancedata->rx_ring[i];
154                 priv->rx_buff[i] = lancedata->rx_buff[i];
155                 netdev_dbg(dev, "RX Entry %2d at %p, Buf at %p\n",
156                            i, &lancedata->rx_ring[i], lancedata->rx_buff[i]);
157         }
158 }
159
160 static int ariadne_rx(struct net_device *dev)
161 {
162         struct ariadne_private *priv = netdev_priv(dev);
163         int entry = priv->cur_rx % RX_RING_SIZE;
164         int i;
165
166         /* If we own the next entry, it's a new packet. Send it up */
167         while (!(lowb(priv->rx_ring[entry]->RMD1) & RF_OWN)) {
168                 int status = lowb(priv->rx_ring[entry]->RMD1);
169
170                 if (status != (RF_STP | RF_ENP)) {      /* There was an error */
171                         /* There is a tricky error noted by
172                          * John Murphy <murf@perftech.com> to Russ Nelson:
173                          * Even with full-sized buffers it's possible for a
174                          * jabber packet to use two buffers, with only the
175                          * last correctly noting the error
176                          */
177                         /* Only count a general error at the end of a packet */
178                         if (status & RF_ENP)
179                                 dev->stats.rx_errors++;
180                         if (status & RF_FRAM)
181                                 dev->stats.rx_frame_errors++;
182                         if (status & RF_OFLO)
183                                 dev->stats.rx_over_errors++;
184                         if (status & RF_CRC)
185                                 dev->stats.rx_crc_errors++;
186                         if (status & RF_BUFF)
187                                 dev->stats.rx_fifo_errors++;
188                         priv->rx_ring[entry]->RMD1 &= 0xff00 | RF_STP | RF_ENP;
189                 } else {
190                         /* Malloc up new buffer, compatible with net-3 */
191                         short pkt_len = swapw(priv->rx_ring[entry]->RMD3);
192                         struct sk_buff *skb;
193
194                         skb = dev_alloc_skb(pkt_len + 2);
195                         if (skb == NULL) {
196                                 netdev_warn(dev, "Memory squeeze, deferring packet\n");
197                                 for (i = 0; i < RX_RING_SIZE; i++)
198                                         if (lowb(priv->rx_ring[(entry + i) % RX_RING_SIZE]->RMD1) & RF_OWN)
199                                                 break;
200
201                                 if (i > RX_RING_SIZE - 2) {
202                                         dev->stats.rx_dropped++;
203                                         priv->rx_ring[entry]->RMD1 |= RF_OWN;
204                                         priv->cur_rx++;
205                                 }
206                                 break;
207                         }
208
209
210                         skb_reserve(skb, 2);    /* 16 byte align */
211                         skb_put(skb, pkt_len);  /* Make room */
212                         skb_copy_to_linear_data(skb,
213                                                 (const void *)priv->rx_buff[entry],
214                                                 pkt_len);
215                         skb->protocol = eth_type_trans(skb, dev);
216                         netdev_dbg(dev, "RX pkt type 0x%04x from %pM to %pM data 0x%08x len %d\n",
217                                    ((u_short *)skb->data)[6],
218                                    skb->data + 6, skb->data,
219                                    (int)skb->data, (int)skb->len);
220
221                         netif_rx(skb);
222                         dev->stats.rx_packets++;
223                         dev->stats.rx_bytes += pkt_len;
224                 }
225
226                 priv->rx_ring[entry]->RMD1 |= RF_OWN;
227                 entry = (++priv->cur_rx) % RX_RING_SIZE;
228         }
229
230         priv->cur_rx = priv->cur_rx % RX_RING_SIZE;
231
232         /* We should check that at least two ring entries are free.
233          * If not, we should free one and mark stats->rx_dropped++
234          */
235
236         return 0;
237 }
238
239 static irqreturn_t ariadne_interrupt(int irq, void *data)
240 {
241         struct net_device *dev = (struct net_device *)data;
242         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
243         struct ariadne_private *priv;
244         int csr0, boguscnt;
245         int handled = 0;
246
247         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
248
249         if (!(lance->RDP & INTR))       /* Check if any interrupt has been */
250                 return IRQ_NONE;        /* generated by the board */
251
252         priv = netdev_priv(dev);
253
254         boguscnt = 10;
255         while ((csr0 = lance->RDP) & (ERR | RINT | TINT) && --boguscnt >= 0) {
256                 /* Acknowledge all of the current interrupt sources ASAP */
257                 lance->RDP = csr0 & ~(INEA | TDMD | STOP | STRT | INIT);
258
259 #ifdef DEBUG
260                 if (ariadne_debug > 5) {
261                         netdev_dbg(dev, "interrupt  csr0=%#02x new csr=%#02x [",
262                                    csr0, lance->RDP);
263                         if (csr0 & INTR)
264                                 pr_cont(" INTR");
265                         if (csr0 & INEA)
266                                 pr_cont(" INEA");
267                         if (csr0 & RXON)
268                                 pr_cont(" RXON");
269                         if (csr0 & TXON)
270                                 pr_cont(" TXON");
271                         if (csr0 & TDMD)
272                                 pr_cont(" TDMD");
273                         if (csr0 & STOP)
274                                 pr_cont(" STOP");
275                         if (csr0 & STRT)
276                                 pr_cont(" STRT");
277                         if (csr0 & INIT)
278                                 pr_cont(" INIT");
279                         if (csr0 & ERR)
280                                 pr_cont(" ERR");
281                         if (csr0 & BABL)
282                                 pr_cont(" BABL");
283                         if (csr0 & CERR)
284                                 pr_cont(" CERR");
285                         if (csr0 & MISS)
286                                 pr_cont(" MISS");
287                         if (csr0 & MERR)
288                                 pr_cont(" MERR");
289                         if (csr0 & RINT)
290                                 pr_cont(" RINT");
291                         if (csr0 & TINT)
292                                 pr_cont(" TINT");
293                         if (csr0 & IDON)
294                                 pr_cont(" IDON");
295                         pr_cont(" ]\n");
296                 }
297 #endif
298
299                 if (csr0 & RINT) {      /* Rx interrupt */
300                         handled = 1;
301                         ariadne_rx(dev);
302                 }
303
304                 if (csr0 & TINT) {      /* Tx-done interrupt */
305                         int dirty_tx = priv->dirty_tx;
306
307                         handled = 1;
308                         while (dirty_tx < priv->cur_tx) {
309                                 int entry = dirty_tx % TX_RING_SIZE;
310                                 int status = lowb(priv->tx_ring[entry]->TMD1);
311
312                                 if (status & TF_OWN)
313                                         break;  /* It still hasn't been Txed */
314
315                                 priv->tx_ring[entry]->TMD1 &= 0xff00;
316
317                                 if (status & TF_ERR) {
318                                         /* There was an major error, log it */
319                                         int err_status = priv->tx_ring[entry]->TMD3;
320                                         dev->stats.tx_errors++;
321                                         if (err_status & EF_RTRY)
322                                                 dev->stats.tx_aborted_errors++;
323                                         if (err_status & EF_LCAR)
324                                                 dev->stats.tx_carrier_errors++;
325                                         if (err_status & EF_LCOL)
326                                                 dev->stats.tx_window_errors++;
327                                         if (err_status & EF_UFLO) {
328                                                 /* Ackk!  On FIFO errors the Tx unit is turned off! */
329                                                 dev->stats.tx_fifo_errors++;
330                                                 /* Remove this verbosity later! */
331                                                 netdev_err(dev, "Tx FIFO error! Status %04x\n",
332                                                            csr0);
333                                                 /* Restart the chip */
334                                                 lance->RDP = STRT;
335                                         }
336                                 } else {
337                                         if (status & (TF_MORE | TF_ONE))
338                                                 dev->stats.collisions++;
339                                         dev->stats.tx_packets++;
340                                 }
341                                 dirty_tx++;
342                         }
343
344 #ifndef final_version
345                         if (priv->cur_tx - dirty_tx >= TX_RING_SIZE) {
346                                 netdev_err(dev, "out-of-sync dirty pointer, %d vs. %d, full=%d\n",
347                                            dirty_tx, priv->cur_tx,
348                                            priv->tx_full);
349                                 dirty_tx += TX_RING_SIZE;
350                         }
351 #endif
352
353                         if (priv->tx_full && netif_queue_stopped(dev) &&
354                             dirty_tx > priv->cur_tx - TX_RING_SIZE + 2) {
355                                 /* The ring is no longer full */
356                                 priv->tx_full = 0;
357                                 netif_wake_queue(dev);
358                         }
359
360                         priv->dirty_tx = dirty_tx;
361                 }
362
363                 /* Log misc errors */
364                 if (csr0 & BABL) {
365                         handled = 1;
366                         dev->stats.tx_errors++; /* Tx babble */
367                 }
368                 if (csr0 & MISS) {
369                         handled = 1;
370                         dev->stats.rx_errors++; /* Missed a Rx frame */
371                 }
372                 if (csr0 & MERR) {
373                         handled = 1;
374                         netdev_err(dev, "Bus master arbitration failure, status %04x\n",
375                                    csr0);
376                         /* Restart the chip */
377                         lance->RDP = STRT;
378                 }
379         }
380
381         /* Clear any other interrupt, and set interrupt enable */
382         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
383         lance->RDP = INEA | BABL | CERR | MISS | MERR | IDON;
384
385         if (ariadne_debug > 4)
386                 netdev_dbg(dev, "exiting interrupt, csr%d=%#04x\n",
387                            lance->RAP, lance->RDP);
388
389         return IRQ_RETVAL(handled);
390 }
391
392 static int ariadne_open(struct net_device *dev)
393 {
394         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
395         u_short in;
396         u_long version;
397         int i;
398
399         /* Reset the LANCE */
400         in = lance->Reset;
401
402         /* Stop the LANCE */
403         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
404         lance->RDP = STOP;
405
406         /* Check the LANCE version */
407         lance->RAP = CSR88;             /* Chip ID */
408         version = swapw(lance->RDP);
409         lance->RAP = CSR89;             /* Chip ID */
410         version |= swapw(lance->RDP) << 16;
411         if ((version & 0x00000fff) != 0x00000003) {
412                 pr_warn("Couldn't find AMD Ethernet Chip\n");
413                 return -EAGAIN;
414         }
415         if ((version & 0x0ffff000) != 0x00003000) {
416                 pr_warn("Couldn't find Am79C960 (Wrong part number = %ld)\n",
417                        (version & 0x0ffff000) >> 12);
418                 return -EAGAIN;
419         }
420
421         netdev_dbg(dev, "Am79C960 (PCnet-ISA) Revision %ld\n",
422                    (version & 0xf0000000) >> 28);
423
424         ariadne_init_ring(dev);
425
426         /* Miscellaneous Stuff */
427         lance->RAP = CSR3;              /* Interrupt Masks and Deferral Control */
428         lance->RDP = 0x0000;
429         lance->RAP = CSR4;              /* Test and Features Control */
430         lance->RDP = DPOLL | APAD_XMT | MFCOM | RCVCCOM | TXSTRTM | JABM;
431
432         /* Set the Multicast Table */
433         lance->RAP = CSR8;              /* Logical Address Filter, LADRF[15:0] */
434         lance->RDP = 0x0000;
435         lance->RAP = CSR9;              /* Logical Address Filter, LADRF[31:16] */
436         lance->RDP = 0x0000;
437         lance->RAP = CSR10;             /* Logical Address Filter, LADRF[47:32] */
438         lance->RDP = 0x0000;
439         lance->RAP = CSR11;             /* Logical Address Filter, LADRF[63:48] */
440         lance->RDP = 0x0000;
441
442         /* Set the Ethernet Hardware Address */
443         lance->RAP = CSR12;             /* Physical Address Register, PADR[15:0] */
444         lance->RDP = ((u_short *)&dev->dev_addr[0])[0];
445         lance->RAP = CSR13;             /* Physical Address Register, PADR[31:16] */
446         lance->RDP = ((u_short *)&dev->dev_addr[0])[1];
447         lance->RAP = CSR14;             /* Physical Address Register, PADR[47:32] */
448         lance->RDP = ((u_short *)&dev->dev_addr[0])[2];
449
450         /* Set the Init Block Mode */
451         lance->RAP = CSR15;             /* Mode Register */
452         lance->RDP = 0x0000;
453
454         /* Set the Transmit Descriptor Ring Pointer */
455         lance->RAP = CSR30;             /* Base Address of Transmit Ring */
456         lance->RDP = swloww(ARIADNE_RAM + offsetof(struct lancedata, tx_ring));
457         lance->RAP = CSR31;             /* Base Address of transmit Ring */
458         lance->RDP = swhighw(ARIADNE_RAM + offsetof(struct lancedata, tx_ring));
459
460         /* Set the Receive Descriptor Ring Pointer */
461         lance->RAP = CSR24;             /* Base Address of Receive Ring */
462         lance->RDP = swloww(ARIADNE_RAM + offsetof(struct lancedata, rx_ring));
463         lance->RAP = CSR25;             /* Base Address of Receive Ring */
464         lance->RDP = swhighw(ARIADNE_RAM + offsetof(struct lancedata, rx_ring));
465
466         /* Set the Number of RX and TX Ring Entries */
467         lance->RAP = CSR76;             /* Receive Ring Length */
468         lance->RDP = swapw(((u_short)-RX_RING_SIZE));
469         lance->RAP = CSR78;             /* Transmit Ring Length */
470         lance->RDP = swapw(((u_short)-TX_RING_SIZE));
471
472         /* Enable Media Interface Port Auto Select (10BASE-2/10BASE-T) */
473         lance->RAP = ISACSR2;           /* Miscellaneous Configuration */
474         lance->IDP = ASEL;
475
476         /* LED Control */
477         lance->RAP = ISACSR5;           /* LED1 Status */
478         lance->IDP = PSE|XMTE;
479         lance->RAP = ISACSR6;   /* LED2 Status */
480         lance->IDP = PSE|COLE;
481         lance->RAP = ISACSR7;   /* LED3 Status */
482         lance->IDP = PSE|RCVE;
483
484         netif_start_queue(dev);
485
486         i = request_irq(IRQ_AMIGA_PORTS, ariadne_interrupt, IRQF_SHARED,
487                         dev->name, dev);
488         if (i)
489                 return i;
490
491         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
492         lance->RDP = INEA | STRT;
493
494         return 0;
495 }
496
497 static int ariadne_close(struct net_device *dev)
498 {
499         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
500
501         netif_stop_queue(dev);
502
503         lance->RAP = CSR112;            /* Missed Frame Count */
504         dev->stats.rx_missed_errors = swapw(lance->RDP);
505         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
506
507         if (ariadne_debug > 1) {
508                 netdev_dbg(dev, "Shutting down ethercard, status was %02x\n",
509                            lance->RDP);
510                 netdev_dbg(dev, "%lu packets missed\n",
511                            dev->stats.rx_missed_errors);
512         }
513
514         /* We stop the LANCE here -- it occasionally polls memory if we don't */
515         lance->RDP = STOP;
516
517         free_irq(IRQ_AMIGA_PORTS, dev);
518
519         return 0;
520 }
521
522 static inline void ariadne_reset(struct net_device *dev)
523 {
524         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
525
526         lance->RAP = CSR0;      /* PCnet-ISA Controller Status */
527         lance->RDP = STOP;
528         ariadne_init_ring(dev);
529         lance->RDP = INEA | STRT;
530         netif_start_queue(dev);
531 }
532
533 static void ariadne_tx_timeout(struct net_device *dev)
534 {
535         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
536
537         netdev_err(dev, "transmit timed out, status %04x, resetting\n",
538                    lance->RDP);
539         ariadne_reset(dev);
540         netif_wake_queue(dev);
541 }
542
543 static netdev_tx_t ariadne_start_xmit(struct sk_buff *skb,
544                                       struct net_device *dev)
545 {
546         struct ariadne_private *priv = netdev_priv(dev);
547         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
548         int entry;
549         unsigned long flags;
550         int len = skb->len;
551
552 #if 0
553         if (ariadne_debug > 3) {
554                 lance->RAP = CSR0;      /* PCnet-ISA Controller Status */
555                 netdev_dbg(dev, "%s: csr0 %04x\n", __func__, lance->RDP);
556                 lance->RDP = 0x0000;
557         }
558 #endif
559
560         /* FIXME: is the 79C960 new enough to do its own padding right ? */
561         if (skb->len < ETH_ZLEN) {
562                 if (skb_padto(skb, ETH_ZLEN))
563                         return NETDEV_TX_OK;
564                 len = ETH_ZLEN;
565         }
566
567         /* Fill in a Tx ring entry */
568
569         netdev_dbg(dev, "TX pkt type 0x%04x from %pM to %pM data 0x%08x len %d\n",
570                    ((u_short *)skb->data)[6],
571                    skb->data + 6, skb->data,
572                    (int)skb->data, (int)skb->len);
573
574         local_irq_save(flags);
575
576         entry = priv->cur_tx % TX_RING_SIZE;
577
578         /* Caution: the write order is important here, set the base address with
579            the "ownership" bits last */
580
581         priv->tx_ring[entry]->TMD2 = swapw((u_short)-skb->len);
582         priv->tx_ring[entry]->TMD3 = 0x0000;
583         memcpyw(priv->tx_buff[entry], (u_short *)skb->data, len);
584
585 #ifdef DEBUG
586         print_hex_dump(KERN_DEBUG, "tx_buff: ", DUMP_PREFIX_OFFSET, 16, 1,
587                        (void *)priv->tx_buff[entry],
588                        skb->len > 64 ? 64 : skb->len, true);
589 #endif
590
591         priv->tx_ring[entry]->TMD1 = (priv->tx_ring[entry]->TMD1 & 0xff00)
592                 | TF_OWN | TF_STP | TF_ENP;
593
594         dev_kfree_skb(skb);
595
596         priv->cur_tx++;
597         if ((priv->cur_tx >= TX_RING_SIZE) &&
598             (priv->dirty_tx >= TX_RING_SIZE)) {
599
600                 netdev_dbg(dev, "*** Subtracting TX_RING_SIZE from cur_tx (%d) and dirty_tx (%d)\n",
601                            priv->cur_tx, priv->dirty_tx);
602
603                 priv->cur_tx -= TX_RING_SIZE;
604                 priv->dirty_tx -= TX_RING_SIZE;
605         }
606         dev->stats.tx_bytes += len;
607
608         /* Trigger an immediate send poll */
609         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
610         lance->RDP = INEA | TDMD;
611
612         if (lowb(priv->tx_ring[(entry + 1) % TX_RING_SIZE]->TMD1) != 0) {
613                 netif_stop_queue(dev);
614                 priv->tx_full = 1;
615         }
616         local_irq_restore(flags);
617
618         return NETDEV_TX_OK;
619 }
620
621 static struct net_device_stats *ariadne_get_stats(struct net_device *dev)
622 {
623         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
624         short saved_addr;
625         unsigned long flags;
626
627         local_irq_save(flags);
628         saved_addr = lance->RAP;
629         lance->RAP = CSR112;            /* Missed Frame Count */
630         dev->stats.rx_missed_errors = swapw(lance->RDP);
631         lance->RAP = saved_addr;
632         local_irq_restore(flags);
633
634         return &dev->stats;
635 }
636
637 /* Set or clear the multicast filter for this adaptor.
638  * num_addrs == -1      Promiscuous mode, receive all packets
639  * num_addrs == 0       Normal mode, clear multicast list
640  * num_addrs > 0        Multicast mode, receive normal and MC packets,
641  *                      and do best-effort filtering.
642  */
643 static void set_multicast_list(struct net_device *dev)
644 {
645         volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr;
646
647         if (!netif_running(dev))
648                 return;
649
650         netif_stop_queue(dev);
651
652         /* We take the simple way out and always enable promiscuous mode */
653         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
654         lance->RDP = STOP;              /* Temporarily stop the lance */
655         ariadne_init_ring(dev);
656
657         if (dev->flags & IFF_PROMISC) {
658                 lance->RAP = CSR15;     /* Mode Register */
659                 lance->RDP = PROM;      /* Set promiscuous mode */
660         } else {
661                 short multicast_table[4];
662                 int num_addrs = netdev_mc_count(dev);
663                 int i;
664                 /* We don't use the multicast table,
665                  * but rely on upper-layer filtering
666                  */
667                 memset(multicast_table, (num_addrs == 0) ? 0 : -1,
668                        sizeof(multicast_table));
669                 for (i = 0; i < 4; i++) {
670                         lance->RAP = CSR8 + (i << 8);
671                                         /* Logical Address Filter */
672                         lance->RDP = swapw(multicast_table[i]);
673                 }
674                 lance->RAP = CSR15;     /* Mode Register */
675                 lance->RDP = 0x0000;    /* Unset promiscuous mode */
676         }
677
678         lance->RAP = CSR0;              /* PCnet-ISA Controller Status */
679         lance->RDP = INEA | STRT | IDON;/* Resume normal operation */
680
681         netif_wake_queue(dev);
682 }
683
684
685 static void __devexit ariadne_remove_one(struct zorro_dev *z)
686 {
687         struct net_device *dev = zorro_get_drvdata(z);
688
689         unregister_netdev(dev);
690         release_mem_region(ZTWO_PADDR(dev->base_addr), sizeof(struct Am79C960));
691         release_mem_region(ZTWO_PADDR(dev->mem_start), ARIADNE_RAM_SIZE);
692         free_netdev(dev);
693 }
694
695 static struct zorro_device_id ariadne_zorro_tbl[] __devinitdata = {
696         { ZORRO_PROD_VILLAGE_TRONIC_ARIADNE },
697         { 0 }
698 };
699 MODULE_DEVICE_TABLE(zorro, ariadne_zorro_tbl);
700
701 static const struct net_device_ops ariadne_netdev_ops = {
702         .ndo_open               = ariadne_open,
703         .ndo_stop               = ariadne_close,
704         .ndo_start_xmit         = ariadne_start_xmit,
705         .ndo_tx_timeout         = ariadne_tx_timeout,
706         .ndo_get_stats          = ariadne_get_stats,
707         .ndo_set_multicast_list = set_multicast_list,
708         .ndo_validate_addr      = eth_validate_addr,
709         .ndo_change_mtu         = eth_change_mtu,
710         .ndo_set_mac_address    = eth_mac_addr,
711 };
712
713 static int __devinit ariadne_init_one(struct zorro_dev *z,
714                                       const struct zorro_device_id *ent)
715 {
716         unsigned long board = z->resource.start;
717         unsigned long base_addr = board + ARIADNE_LANCE;
718         unsigned long mem_start = board + ARIADNE_RAM;
719         struct resource *r1, *r2;
720         struct net_device *dev;
721         struct ariadne_private *priv;
722         int err;
723
724         r1 = request_mem_region(base_addr, sizeof(struct Am79C960), "Am79C960");
725         if (!r1)
726                 return -EBUSY;
727         r2 = request_mem_region(mem_start, ARIADNE_RAM_SIZE, "RAM");
728         if (!r2) {
729                 release_mem_region(base_addr, sizeof(struct Am79C960));
730                 return -EBUSY;
731         }
732
733         dev = alloc_etherdev(sizeof(struct ariadne_private));
734         if (dev == NULL) {
735                 release_mem_region(base_addr, sizeof(struct Am79C960));
736                 release_mem_region(mem_start, ARIADNE_RAM_SIZE);
737                 return -ENOMEM;
738         }
739
740         priv = netdev_priv(dev);
741
742         r1->name = dev->name;
743         r2->name = dev->name;
744
745         dev->dev_addr[0] = 0x00;
746         dev->dev_addr[1] = 0x60;
747         dev->dev_addr[2] = 0x30;
748         dev->dev_addr[3] = (z->rom.er_SerialNumber >> 16) & 0xff;
749         dev->dev_addr[4] = (z->rom.er_SerialNumber >> 8) & 0xff;
750         dev->dev_addr[5] = z->rom.er_SerialNumber & 0xff;
751         dev->base_addr = ZTWO_VADDR(base_addr);
752         dev->mem_start = ZTWO_VADDR(mem_start);
753         dev->mem_end = dev->mem_start + ARIADNE_RAM_SIZE;
754
755         dev->netdev_ops = &ariadne_netdev_ops;
756         dev->watchdog_timeo = 5 * HZ;
757
758         err = register_netdev(dev);
759         if (err) {
760                 release_mem_region(base_addr, sizeof(struct Am79C960));
761                 release_mem_region(mem_start, ARIADNE_RAM_SIZE);
762                 free_netdev(dev);
763                 return err;
764         }
765         zorro_set_drvdata(z, dev);
766
767         netdev_info(dev, "Ariadne at 0x%08lx, Ethernet Address %pM\n",
768                     board, dev->dev_addr);
769
770         return 0;
771 }
772
773 static struct zorro_driver ariadne_driver = {
774         .name           = "ariadne",
775         .id_table       = ariadne_zorro_tbl,
776         .probe          = ariadne_init_one,
777         .remove         = __devexit_p(ariadne_remove_one),
778 };
779
780 static int __init ariadne_init_module(void)
781 {
782         return zorro_register_driver(&ariadne_driver);
783 }
784
785 static void __exit ariadne_cleanup_module(void)
786 {
787         zorro_unregister_driver(&ariadne_driver);
788 }
789
790 module_init(ariadne_init_module);
791 module_exit(ariadne_cleanup_module);
792
793 MODULE_LICENSE("GPL");