| /* |
| * Amiga Linux/m68k Ariadne Ethernet Driver |
| * |
| * © Copyright 1995-2003 by Geert Uytterhoeven (geert@linux-m68k.org) |
| * Peter De Schrijver (p2@mind.be) |
| * |
| * --------------------------------------------------------------------------- |
| * |
| * This program is based on |
| * |
| * lance.c: An AMD LANCE ethernet driver for linux. |
| * Written 1993-94 by Donald Becker. |
| * |
| * Am79C960: PCnet(tm)-ISA Single-Chip Ethernet Controller |
| * Advanced Micro Devices |
| * Publication #16907, Rev. B, Amendment/0, May 1994 |
| * |
| * MC68230: Parallel Interface/Timer (PI/T) |
| * Motorola Semiconductors, December, 1983 |
| * |
| * --------------------------------------------------------------------------- |
| * |
| * This file is subject to the terms and conditions of the GNU General Public |
| * License. See the file COPYING in the main directory of the Linux |
| * distribution for more details. |
| * |
| * --------------------------------------------------------------------------- |
| * |
| * The Ariadne is a Zorro-II board made by Village Tronic. It contains: |
| * |
| * - an Am79C960 PCnet-ISA Single-Chip Ethernet Controller with both |
| * 10BASE-2 (thin coax) and 10BASE-T (UTP) connectors |
| * |
| * - an MC68230 Parallel Interface/Timer configured as 2 parallel ports |
| */ |
| |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| /*#define DEBUG*/ |
| |
| #include <linux/module.h> |
| #include <linux/stddef.h> |
| #include <linux/kernel.h> |
| #include <linux/string.h> |
| #include <linux/errno.h> |
| #include <linux/ioport.h> |
| #include <linux/netdevice.h> |
| #include <linux/etherdevice.h> |
| #include <linux/interrupt.h> |
| #include <linux/skbuff.h> |
| #include <linux/init.h> |
| #include <linux/zorro.h> |
| #include <linux/bitops.h> |
| |
| #include <asm/byteorder.h> |
| #include <asm/amigaints.h> |
| #include <asm/amigahw.h> |
| #include <asm/irq.h> |
| |
| #include "ariadne.h" |
| |
| #ifdef ARIADNE_DEBUG |
| int ariadne_debug = ARIADNE_DEBUG; |
| #else |
| int ariadne_debug = 1; |
| #endif |
| |
| /* Macros to Fix Endianness problems */ |
| |
| /* Swap the Bytes in a WORD */ |
| #define swapw(x) (((x >> 8) & 0x00ff) | ((x << 8) & 0xff00)) |
| /* Get the Low BYTE in a WORD */ |
| #define lowb(x) (x & 0xff) |
| /* Get the Swapped High WORD in a LONG */ |
| #define swhighw(x) ((((x) >> 8) & 0xff00) | (((x) >> 24) & 0x00ff)) |
| /* Get the Swapped Low WORD in a LONG */ |
| #define swloww(x) ((((x) << 8) & 0xff00) | (((x) >> 8) & 0x00ff)) |
| |
| /* Transmit/Receive Ring Definitions */ |
| |
| #define TX_RING_SIZE 5 |
| #define RX_RING_SIZE 16 |
| |
| #define PKT_BUF_SIZE 1520 |
| |
| /* Private Device Data */ |
| |
| struct ariadne_private { |
| volatile struct TDRE *tx_ring[TX_RING_SIZE]; |
| volatile struct RDRE *rx_ring[RX_RING_SIZE]; |
| volatile u_short *tx_buff[TX_RING_SIZE]; |
| volatile u_short *rx_buff[RX_RING_SIZE]; |
| int cur_tx, cur_rx; /* The next free ring entry */ |
| int dirty_tx; /* The ring entries to be free()ed */ |
| char tx_full; |
| }; |
| |
| /* Structure Created in the Ariadne's RAM Buffer */ |
| |
| struct lancedata { |
| struct TDRE tx_ring[TX_RING_SIZE]; |
| struct RDRE rx_ring[RX_RING_SIZE]; |
| u_short tx_buff[TX_RING_SIZE][PKT_BUF_SIZE / sizeof(u_short)]; |
| u_short rx_buff[RX_RING_SIZE][PKT_BUF_SIZE / sizeof(u_short)]; |
| }; |
| |
| static void memcpyw(volatile u_short *dest, u_short *src, int len) |
| { |
| while (len >= 2) { |
| *(dest++) = *(src++); |
| len -= 2; |
| } |
| if (len == 1) |
| *dest = (*(u_char *)src) << 8; |
| } |
| |
| static void ariadne_init_ring(struct net_device *dev) |
| { |
| struct ariadne_private *priv = netdev_priv(dev); |
| volatile struct lancedata *lancedata = (struct lancedata *)dev->mem_start; |
| int i; |
| |
| netif_stop_queue(dev); |
| |
| priv->tx_full = 0; |
| priv->cur_rx = priv->cur_tx = 0; |
| priv->dirty_tx = 0; |
| |
| /* Set up TX Ring */ |
| for (i = 0; i < TX_RING_SIZE; i++) { |
| volatile struct TDRE *t = &lancedata->tx_ring[i]; |
| t->TMD0 = swloww(ARIADNE_RAM + |
| offsetof(struct lancedata, tx_buff[i])); |
| t->TMD1 = swhighw(ARIADNE_RAM + |
| offsetof(struct lancedata, tx_buff[i])) | |
| TF_STP | TF_ENP; |
| t->TMD2 = swapw((u_short)-PKT_BUF_SIZE); |
| t->TMD3 = 0; |
| priv->tx_ring[i] = &lancedata->tx_ring[i]; |
| priv->tx_buff[i] = lancedata->tx_buff[i]; |
| netdev_dbg(dev, "TX Entry %2d at %p, Buf at %p\n", |
| i, &lancedata->tx_ring[i], lancedata->tx_buff[i]); |
| } |
| |
| /* Set up RX Ring */ |
| for (i = 0; i < RX_RING_SIZE; i++) { |
| volatile struct RDRE *r = &lancedata->rx_ring[i]; |
| r->RMD0 = swloww(ARIADNE_RAM + |
| offsetof(struct lancedata, rx_buff[i])); |
| r->RMD1 = swhighw(ARIADNE_RAM + |
| offsetof(struct lancedata, rx_buff[i])) | |
| RF_OWN; |
| r->RMD2 = swapw((u_short)-PKT_BUF_SIZE); |
| r->RMD3 = 0x0000; |
| priv->rx_ring[i] = &lancedata->rx_ring[i]; |
| priv->rx_buff[i] = lancedata->rx_buff[i]; |
| netdev_dbg(dev, "RX Entry %2d at %p, Buf at %p\n", |
| i, &lancedata->rx_ring[i], lancedata->rx_buff[i]); |
| } |
| } |
| |
| static int ariadne_rx(struct net_device *dev) |
| { |
| struct ariadne_private *priv = netdev_priv(dev); |
| int entry = priv->cur_rx % RX_RING_SIZE; |
| int i; |
| |
| /* If we own the next entry, it's a new packet. Send it up */ |
| while (!(lowb(priv->rx_ring[entry]->RMD1) & RF_OWN)) { |
| int status = lowb(priv->rx_ring[entry]->RMD1); |
| |
| if (status != (RF_STP | RF_ENP)) { /* There was an error */ |
| /* There is a tricky error noted by |
| * John Murphy <murf@perftech.com> to Russ Nelson: |
| * Even with full-sized buffers it's possible for a |
| * jabber packet to use two buffers, with only the |
| * last correctly noting the error |
| */ |
| /* Only count a general error at the end of a packet */ |
| if (status & RF_ENP) |
| dev->stats.rx_errors++; |
| if (status & RF_FRAM) |
| dev->stats.rx_frame_errors++; |
| if (status & RF_OFLO) |
| dev->stats.rx_over_errors++; |
| if (status & RF_CRC) |
| dev->stats.rx_crc_errors++; |
| if (status & RF_BUFF) |
| dev->stats.rx_fifo_errors++; |
| priv->rx_ring[entry]->RMD1 &= 0xff00 | RF_STP | RF_ENP; |
| } else { |
| /* Malloc up new buffer, compatible with net-3 */ |
| short pkt_len = swapw(priv->rx_ring[entry]->RMD3); |
| struct sk_buff *skb; |
| |
| skb = netdev_alloc_skb(dev, pkt_len + 2); |
| if (skb == NULL) { |
| for (i = 0; i < RX_RING_SIZE; i++) |
| if (lowb(priv->rx_ring[(entry + i) % RX_RING_SIZE]->RMD1) & RF_OWN) |
| break; |
| |
| if (i > RX_RING_SIZE - 2) { |
| dev->stats.rx_dropped++; |
| priv->rx_ring[entry]->RMD1 |= RF_OWN; |
| priv->cur_rx++; |
| } |
| break; |
| } |
| |
| |
| skb_reserve(skb, 2); /* 16 byte align */ |
| skb_put(skb, pkt_len); /* Make room */ |
| skb_copy_to_linear_data(skb, |
| (const void *)priv->rx_buff[entry], |
| pkt_len); |
| skb->protocol = eth_type_trans(skb, dev); |
| netdev_dbg(dev, "RX pkt type 0x%04x from %pM to %pM data %p len %u\n", |
| ((u_short *)skb->data)[6], |
| skb->data + 6, skb->data, |
| skb->data, skb->len); |
| |
| netif_rx(skb); |
| dev->stats.rx_packets++; |
| dev->stats.rx_bytes += pkt_len; |
| } |
| |
| priv->rx_ring[entry]->RMD1 |= RF_OWN; |
| entry = (++priv->cur_rx) % RX_RING_SIZE; |
| } |
| |
| priv->cur_rx = priv->cur_rx % RX_RING_SIZE; |
| |
| /* We should check that at least two ring entries are free. |
| * If not, we should free one and mark stats->rx_dropped++ |
| */ |
| |
| return 0; |
| } |
| |
| static irqreturn_t ariadne_interrupt(int irq, void *data) |
| { |
| struct net_device *dev = (struct net_device *)data; |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| struct ariadne_private *priv; |
| int csr0, boguscnt; |
| int handled = 0; |
| |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| |
| if (!(lance->RDP & INTR)) /* Check if any interrupt has been */ |
| return IRQ_NONE; /* generated by the board */ |
| |
| priv = netdev_priv(dev); |
| |
| boguscnt = 10; |
| while ((csr0 = lance->RDP) & (ERR | RINT | TINT) && --boguscnt >= 0) { |
| /* Acknowledge all of the current interrupt sources ASAP */ |
| lance->RDP = csr0 & ~(INEA | TDMD | STOP | STRT | INIT); |
| |
| #ifdef DEBUG |
| if (ariadne_debug > 5) { |
| netdev_dbg(dev, "interrupt csr0=%#02x new csr=%#02x [", |
| csr0, lance->RDP); |
| if (csr0 & INTR) |
| pr_cont(" INTR"); |
| if (csr0 & INEA) |
| pr_cont(" INEA"); |
| if (csr0 & RXON) |
| pr_cont(" RXON"); |
| if (csr0 & TXON) |
| pr_cont(" TXON"); |
| if (csr0 & TDMD) |
| pr_cont(" TDMD"); |
| if (csr0 & STOP) |
| pr_cont(" STOP"); |
| if (csr0 & STRT) |
| pr_cont(" STRT"); |
| if (csr0 & INIT) |
| pr_cont(" INIT"); |
| if (csr0 & ERR) |
| pr_cont(" ERR"); |
| if (csr0 & BABL) |
| pr_cont(" BABL"); |
| if (csr0 & CERR) |
| pr_cont(" CERR"); |
| if (csr0 & MISS) |
| pr_cont(" MISS"); |
| if (csr0 & MERR) |
| pr_cont(" MERR"); |
| if (csr0 & RINT) |
| pr_cont(" RINT"); |
| if (csr0 & TINT) |
| pr_cont(" TINT"); |
| if (csr0 & IDON) |
| pr_cont(" IDON"); |
| pr_cont(" ]\n"); |
| } |
| #endif |
| |
| if (csr0 & RINT) { /* Rx interrupt */ |
| handled = 1; |
| ariadne_rx(dev); |
| } |
| |
| if (csr0 & TINT) { /* Tx-done interrupt */ |
| int dirty_tx = priv->dirty_tx; |
| |
| handled = 1; |
| while (dirty_tx < priv->cur_tx) { |
| int entry = dirty_tx % TX_RING_SIZE; |
| int status = lowb(priv->tx_ring[entry]->TMD1); |
| |
| if (status & TF_OWN) |
| break; /* It still hasn't been Txed */ |
| |
| priv->tx_ring[entry]->TMD1 &= 0xff00; |
| |
| if (status & TF_ERR) { |
| /* There was an major error, log it */ |
| int err_status = priv->tx_ring[entry]->TMD3; |
| dev->stats.tx_errors++; |
| if (err_status & EF_RTRY) |
| dev->stats.tx_aborted_errors++; |
| if (err_status & EF_LCAR) |
| dev->stats.tx_carrier_errors++; |
| if (err_status & EF_LCOL) |
| dev->stats.tx_window_errors++; |
| if (err_status & EF_UFLO) { |
| /* Ackk! On FIFO errors the Tx unit is turned off! */ |
| dev->stats.tx_fifo_errors++; |
| /* Remove this verbosity later! */ |
| netdev_err(dev, "Tx FIFO error! Status %04x\n", |
| csr0); |
| /* Restart the chip */ |
| lance->RDP = STRT; |
| } |
| } else { |
| if (status & (TF_MORE | TF_ONE)) |
| dev->stats.collisions++; |
| dev->stats.tx_packets++; |
| } |
| dirty_tx++; |
| } |
| |
| #ifndef final_version |
| if (priv->cur_tx - dirty_tx >= TX_RING_SIZE) { |
| netdev_err(dev, "out-of-sync dirty pointer, %d vs. %d, full=%d\n", |
| dirty_tx, priv->cur_tx, |
| priv->tx_full); |
| dirty_tx += TX_RING_SIZE; |
| } |
| #endif |
| |
| if (priv->tx_full && netif_queue_stopped(dev) && |
| dirty_tx > priv->cur_tx - TX_RING_SIZE + 2) { |
| /* The ring is no longer full */ |
| priv->tx_full = 0; |
| netif_wake_queue(dev); |
| } |
| |
| priv->dirty_tx = dirty_tx; |
| } |
| |
| /* Log misc errors */ |
| if (csr0 & BABL) { |
| handled = 1; |
| dev->stats.tx_errors++; /* Tx babble */ |
| } |
| if (csr0 & MISS) { |
| handled = 1; |
| dev->stats.rx_errors++; /* Missed a Rx frame */ |
| } |
| if (csr0 & MERR) { |
| handled = 1; |
| netdev_err(dev, "Bus master arbitration failure, status %04x\n", |
| csr0); |
| /* Restart the chip */ |
| lance->RDP = STRT; |
| } |
| } |
| |
| /* Clear any other interrupt, and set interrupt enable */ |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| lance->RDP = INEA | BABL | CERR | MISS | MERR | IDON; |
| |
| if (ariadne_debug > 4) |
| netdev_dbg(dev, "exiting interrupt, csr%d=%#04x\n", |
| lance->RAP, lance->RDP); |
| |
| return IRQ_RETVAL(handled); |
| } |
| |
| static int ariadne_open(struct net_device *dev) |
| { |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| u_short in; |
| u_long version; |
| int i; |
| |
| /* Reset the LANCE */ |
| in = lance->Reset; |
| |
| /* Stop the LANCE */ |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| lance->RDP = STOP; |
| |
| /* Check the LANCE version */ |
| lance->RAP = CSR88; /* Chip ID */ |
| version = swapw(lance->RDP); |
| lance->RAP = CSR89; /* Chip ID */ |
| version |= swapw(lance->RDP) << 16; |
| if ((version & 0x00000fff) != 0x00000003) { |
| pr_warn("Couldn't find AMD Ethernet Chip\n"); |
| return -EAGAIN; |
| } |
| if ((version & 0x0ffff000) != 0x00003000) { |
| pr_warn("Couldn't find Am79C960 (Wrong part number = %ld)\n", |
| (version & 0x0ffff000) >> 12); |
| return -EAGAIN; |
| } |
| |
| netdev_dbg(dev, "Am79C960 (PCnet-ISA) Revision %ld\n", |
| (version & 0xf0000000) >> 28); |
| |
| ariadne_init_ring(dev); |
| |
| /* Miscellaneous Stuff */ |
| lance->RAP = CSR3; /* Interrupt Masks and Deferral Control */ |
| lance->RDP = 0x0000; |
| lance->RAP = CSR4; /* Test and Features Control */ |
| lance->RDP = DPOLL | APAD_XMT | MFCOM | RCVCCOM | TXSTRTM | JABM; |
| |
| /* Set the Multicast Table */ |
| lance->RAP = CSR8; /* Logical Address Filter, LADRF[15:0] */ |
| lance->RDP = 0x0000; |
| lance->RAP = CSR9; /* Logical Address Filter, LADRF[31:16] */ |
| lance->RDP = 0x0000; |
| lance->RAP = CSR10; /* Logical Address Filter, LADRF[47:32] */ |
| lance->RDP = 0x0000; |
| lance->RAP = CSR11; /* Logical Address Filter, LADRF[63:48] */ |
| lance->RDP = 0x0000; |
| |
| /* Set the Ethernet Hardware Address */ |
| lance->RAP = CSR12; /* Physical Address Register, PADR[15:0] */ |
| lance->RDP = ((u_short *)&dev->dev_addr[0])[0]; |
| lance->RAP = CSR13; /* Physical Address Register, PADR[31:16] */ |
| lance->RDP = ((u_short *)&dev->dev_addr[0])[1]; |
| lance->RAP = CSR14; /* Physical Address Register, PADR[47:32] */ |
| lance->RDP = ((u_short *)&dev->dev_addr[0])[2]; |
| |
| /* Set the Init Block Mode */ |
| lance->RAP = CSR15; /* Mode Register */ |
| lance->RDP = 0x0000; |
| |
| /* Set the Transmit Descriptor Ring Pointer */ |
| lance->RAP = CSR30; /* Base Address of Transmit Ring */ |
| lance->RDP = swloww(ARIADNE_RAM + offsetof(struct lancedata, tx_ring)); |
| lance->RAP = CSR31; /* Base Address of transmit Ring */ |
| lance->RDP = swhighw(ARIADNE_RAM + offsetof(struct lancedata, tx_ring)); |
| |
| /* Set the Receive Descriptor Ring Pointer */ |
| lance->RAP = CSR24; /* Base Address of Receive Ring */ |
| lance->RDP = swloww(ARIADNE_RAM + offsetof(struct lancedata, rx_ring)); |
| lance->RAP = CSR25; /* Base Address of Receive Ring */ |
| lance->RDP = swhighw(ARIADNE_RAM + offsetof(struct lancedata, rx_ring)); |
| |
| /* Set the Number of RX and TX Ring Entries */ |
| lance->RAP = CSR76; /* Receive Ring Length */ |
| lance->RDP = swapw(((u_short)-RX_RING_SIZE)); |
| lance->RAP = CSR78; /* Transmit Ring Length */ |
| lance->RDP = swapw(((u_short)-TX_RING_SIZE)); |
| |
| /* Enable Media Interface Port Auto Select (10BASE-2/10BASE-T) */ |
| lance->RAP = ISACSR2; /* Miscellaneous Configuration */ |
| lance->IDP = ASEL; |
| |
| /* LED Control */ |
| lance->RAP = ISACSR5; /* LED1 Status */ |
| lance->IDP = PSE|XMTE; |
| lance->RAP = ISACSR6; /* LED2 Status */ |
| lance->IDP = PSE|COLE; |
| lance->RAP = ISACSR7; /* LED3 Status */ |
| lance->IDP = PSE|RCVE; |
| |
| netif_start_queue(dev); |
| |
| i = request_irq(IRQ_AMIGA_PORTS, ariadne_interrupt, IRQF_SHARED, |
| dev->name, dev); |
| if (i) |
| return i; |
| |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| lance->RDP = INEA | STRT; |
| |
| return 0; |
| } |
| |
| static int ariadne_close(struct net_device *dev) |
| { |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| |
| netif_stop_queue(dev); |
| |
| lance->RAP = CSR112; /* Missed Frame Count */ |
| dev->stats.rx_missed_errors = swapw(lance->RDP); |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| |
| if (ariadne_debug > 1) { |
| netdev_dbg(dev, "Shutting down ethercard, status was %02x\n", |
| lance->RDP); |
| netdev_dbg(dev, "%lu packets missed\n", |
| dev->stats.rx_missed_errors); |
| } |
| |
| /* We stop the LANCE here -- it occasionally polls memory if we don't */ |
| lance->RDP = STOP; |
| |
| free_irq(IRQ_AMIGA_PORTS, dev); |
| |
| return 0; |
| } |
| |
| static inline void ariadne_reset(struct net_device *dev) |
| { |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| lance->RDP = STOP; |
| ariadne_init_ring(dev); |
| lance->RDP = INEA | STRT; |
| netif_start_queue(dev); |
| } |
| |
| static void ariadne_tx_timeout(struct net_device *dev) |
| { |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| |
| netdev_err(dev, "transmit timed out, status %04x, resetting\n", |
| lance->RDP); |
| ariadne_reset(dev); |
| netif_wake_queue(dev); |
| } |
| |
| static netdev_tx_t ariadne_start_xmit(struct sk_buff *skb, |
| struct net_device *dev) |
| { |
| struct ariadne_private *priv = netdev_priv(dev); |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| int entry; |
| unsigned long flags; |
| int len = skb->len; |
| |
| #if 0 |
| if (ariadne_debug > 3) { |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| netdev_dbg(dev, "%s: csr0 %04x\n", __func__, lance->RDP); |
| lance->RDP = 0x0000; |
| } |
| #endif |
| |
| /* FIXME: is the 79C960 new enough to do its own padding right ? */ |
| if (skb->len < ETH_ZLEN) { |
| if (skb_padto(skb, ETH_ZLEN)) |
| return NETDEV_TX_OK; |
| len = ETH_ZLEN; |
| } |
| |
| /* Fill in a Tx ring entry */ |
| |
| netdev_dbg(dev, "TX pkt type 0x%04x from %pM to %pM data %p len %u\n", |
| ((u_short *)skb->data)[6], |
| skb->data + 6, skb->data, |
| skb->data, skb->len); |
| |
| local_irq_save(flags); |
| |
| entry = priv->cur_tx % TX_RING_SIZE; |
| |
| /* Caution: the write order is important here, set the base address with |
| the "ownership" bits last */ |
| |
| priv->tx_ring[entry]->TMD2 = swapw((u_short)-skb->len); |
| priv->tx_ring[entry]->TMD3 = 0x0000; |
| memcpyw(priv->tx_buff[entry], (u_short *)skb->data, len); |
| |
| #ifdef DEBUG |
| print_hex_dump(KERN_DEBUG, "tx_buff: ", DUMP_PREFIX_OFFSET, 16, 1, |
| (void *)priv->tx_buff[entry], |
| skb->len > 64 ? 64 : skb->len, true); |
| #endif |
| |
| priv->tx_ring[entry]->TMD1 = (priv->tx_ring[entry]->TMD1 & 0xff00) |
| | TF_OWN | TF_STP | TF_ENP; |
| |
| dev_kfree_skb(skb); |
| |
| priv->cur_tx++; |
| if ((priv->cur_tx >= TX_RING_SIZE) && |
| (priv->dirty_tx >= TX_RING_SIZE)) { |
| |
| netdev_dbg(dev, "*** Subtracting TX_RING_SIZE from cur_tx (%d) and dirty_tx (%d)\n", |
| priv->cur_tx, priv->dirty_tx); |
| |
| priv->cur_tx -= TX_RING_SIZE; |
| priv->dirty_tx -= TX_RING_SIZE; |
| } |
| dev->stats.tx_bytes += len; |
| |
| /* Trigger an immediate send poll */ |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| lance->RDP = INEA | TDMD; |
| |
| if (lowb(priv->tx_ring[(entry + 1) % TX_RING_SIZE]->TMD1) != 0) { |
| netif_stop_queue(dev); |
| priv->tx_full = 1; |
| } |
| local_irq_restore(flags); |
| |
| return NETDEV_TX_OK; |
| } |
| |
| static struct net_device_stats *ariadne_get_stats(struct net_device *dev) |
| { |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| short saved_addr; |
| unsigned long flags; |
| |
| local_irq_save(flags); |
| saved_addr = lance->RAP; |
| lance->RAP = CSR112; /* Missed Frame Count */ |
| dev->stats.rx_missed_errors = swapw(lance->RDP); |
| lance->RAP = saved_addr; |
| local_irq_restore(flags); |
| |
| return &dev->stats; |
| } |
| |
| /* Set or clear the multicast filter for this adaptor. |
| * num_addrs == -1 Promiscuous mode, receive all packets |
| * num_addrs == 0 Normal mode, clear multicast list |
| * num_addrs > 0 Multicast mode, receive normal and MC packets, |
| * and do best-effort filtering. |
| */ |
| static void set_multicast_list(struct net_device *dev) |
| { |
| volatile struct Am79C960 *lance = (struct Am79C960 *)dev->base_addr; |
| |
| if (!netif_running(dev)) |
| return; |
| |
| netif_stop_queue(dev); |
| |
| /* We take the simple way out and always enable promiscuous mode */ |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| lance->RDP = STOP; /* Temporarily stop the lance */ |
| ariadne_init_ring(dev); |
| |
| if (dev->flags & IFF_PROMISC) { |
| lance->RAP = CSR15; /* Mode Register */ |
| lance->RDP = PROM; /* Set promiscuous mode */ |
| } else { |
| short multicast_table[4]; |
| int num_addrs = netdev_mc_count(dev); |
| int i; |
| /* We don't use the multicast table, |
| * but rely on upper-layer filtering |
| */ |
| memset(multicast_table, (num_addrs == 0) ? 0 : -1, |
| sizeof(multicast_table)); |
| for (i = 0; i < 4; i++) { |
| lance->RAP = CSR8 + (i << 8); |
| /* Logical Address Filter */ |
| lance->RDP = swapw(multicast_table[i]); |
| } |
| lance->RAP = CSR15; /* Mode Register */ |
| lance->RDP = 0x0000; /* Unset promiscuous mode */ |
| } |
| |
| lance->RAP = CSR0; /* PCnet-ISA Controller Status */ |
| lance->RDP = INEA | STRT | IDON;/* Resume normal operation */ |
| |
| netif_wake_queue(dev); |
| } |
| |
| |
| static void ariadne_remove_one(struct zorro_dev *z) |
| { |
| struct net_device *dev = zorro_get_drvdata(z); |
| |
| unregister_netdev(dev); |
| release_mem_region(ZTWO_PADDR(dev->base_addr), sizeof(struct Am79C960)); |
| release_mem_region(ZTWO_PADDR(dev->mem_start), ARIADNE_RAM_SIZE); |
| free_netdev(dev); |
| } |
| |
| static struct zorro_device_id ariadne_zorro_tbl[] = { |
| { ZORRO_PROD_VILLAGE_TRONIC_ARIADNE }, |
| { 0 } |
| }; |
| MODULE_DEVICE_TABLE(zorro, ariadne_zorro_tbl); |
| |
| static const struct net_device_ops ariadne_netdev_ops = { |
| .ndo_open = ariadne_open, |
| .ndo_stop = ariadne_close, |
| .ndo_start_xmit = ariadne_start_xmit, |
| .ndo_tx_timeout = ariadne_tx_timeout, |
| .ndo_get_stats = ariadne_get_stats, |
| .ndo_set_rx_mode = set_multicast_list, |
| .ndo_validate_addr = eth_validate_addr, |
| .ndo_set_mac_address = eth_mac_addr, |
| }; |
| |
| static int ariadne_init_one(struct zorro_dev *z, |
| const struct zorro_device_id *ent) |
| { |
| unsigned long board = z->resource.start; |
| unsigned long base_addr = board + ARIADNE_LANCE; |
| unsigned long mem_start = board + ARIADNE_RAM; |
| struct resource *r1, *r2; |
| struct net_device *dev; |
| u32 serial; |
| int err; |
| |
| r1 = request_mem_region(base_addr, sizeof(struct Am79C960), "Am79C960"); |
| if (!r1) |
| return -EBUSY; |
| r2 = request_mem_region(mem_start, ARIADNE_RAM_SIZE, "RAM"); |
| if (!r2) { |
| release_mem_region(base_addr, sizeof(struct Am79C960)); |
| return -EBUSY; |
| } |
| |
| dev = alloc_etherdev(sizeof(struct ariadne_private)); |
| if (dev == NULL) { |
| release_mem_region(base_addr, sizeof(struct Am79C960)); |
| release_mem_region(mem_start, ARIADNE_RAM_SIZE); |
| return -ENOMEM; |
| } |
| |
| r1->name = dev->name; |
| r2->name = dev->name; |
| |
| serial = be32_to_cpu(z->rom.er_SerialNumber); |
| dev->dev_addr[0] = 0x00; |
| dev->dev_addr[1] = 0x60; |
| dev->dev_addr[2] = 0x30; |
| dev->dev_addr[3] = (serial >> 16) & 0xff; |
| dev->dev_addr[4] = (serial >> 8) & 0xff; |
| dev->dev_addr[5] = serial & 0xff; |
| dev->base_addr = (unsigned long)ZTWO_VADDR(base_addr); |
| dev->mem_start = (unsigned long)ZTWO_VADDR(mem_start); |
| dev->mem_end = dev->mem_start + ARIADNE_RAM_SIZE; |
| |
| dev->netdev_ops = &ariadne_netdev_ops; |
| dev->watchdog_timeo = 5 * HZ; |
| |
| err = register_netdev(dev); |
| if (err) { |
| release_mem_region(base_addr, sizeof(struct Am79C960)); |
| release_mem_region(mem_start, ARIADNE_RAM_SIZE); |
| free_netdev(dev); |
| return err; |
| } |
| zorro_set_drvdata(z, dev); |
| |
| netdev_info(dev, "Ariadne at 0x%08lx, Ethernet Address %pM\n", |
| board, dev->dev_addr); |
| |
| return 0; |
| } |
| |
| static struct zorro_driver ariadne_driver = { |
| .name = "ariadne", |
| .id_table = ariadne_zorro_tbl, |
| .probe = ariadne_init_one, |
| .remove = ariadne_remove_one, |
| }; |
| |
| static int __init ariadne_init_module(void) |
| { |
| return zorro_register_driver(&ariadne_driver); |
| } |
| |
| static void __exit ariadne_cleanup_module(void) |
| { |
| zorro_unregister_driver(&ariadne_driver); |
| } |
| |
| module_init(ariadne_init_module); |
| module_exit(ariadne_cleanup_module); |
| |
| MODULE_LICENSE("GPL"); |