Add qemu 2.4.0
[kvmfornfv.git] / qemu / roms / u-boot / drivers / net / pcnet.c
diff --git a/qemu/roms/u-boot/drivers/net/pcnet.c b/qemu/roms/u-boot/drivers/net/pcnet.c
new file mode 100644 (file)
index 0000000..237fbba
--- /dev/null
@@ -0,0 +1,542 @@
+/*
+ * (C) Copyright 2002 Wolfgang Grandegger, wg@denx.de.
+ *
+ * This driver for AMD PCnet network controllers is derived from the
+ * Linux driver pcnet32.c written 1996-1999 by Thomas Bogendoerfer.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+#include <malloc.h>
+#include <net.h>
+#include <netdev.h>
+#include <asm/io.h>
+#include <pci.h>
+
+#define        PCNET_DEBUG_LEVEL       0       /* 0=off, 1=init, 2=rx/tx */
+
+#define PCNET_DEBUG1(fmt,args...)      \
+       debug_cond(PCNET_DEBUG_LEVEL > 0, fmt ,##args)
+#define PCNET_DEBUG2(fmt,args...)      \
+       debug_cond(PCNET_DEBUG_LEVEL > 1, fmt ,##args)
+
+#if !defined(CONF_PCNET_79C973) && defined(CONF_PCNET_79C975)
+#error "Macro for PCnet chip version is not defined!"
+#endif
+
+/*
+ * Set the number of Tx and Rx buffers, using Log_2(# buffers).
+ * Reasonable default values are 4 Tx buffers, and 16 Rx buffers.
+ * That translates to 2 (4 == 2^^2) and 4 (16 == 2^^4).
+ */
+#define PCNET_LOG_TX_BUFFERS   0
+#define PCNET_LOG_RX_BUFFERS   2
+
+#define TX_RING_SIZE           (1 << (PCNET_LOG_TX_BUFFERS))
+#define TX_RING_LEN_BITS       ((PCNET_LOG_TX_BUFFERS) << 12)
+
+#define RX_RING_SIZE           (1 << (PCNET_LOG_RX_BUFFERS))
+#define RX_RING_LEN_BITS       ((PCNET_LOG_RX_BUFFERS) << 4)
+
+#define PKT_BUF_SZ             1544
+
+/* The PCNET Rx and Tx ring descriptors. */
+struct pcnet_rx_head {
+       u32 base;
+       s16 buf_length;
+       s16 status;
+       u32 msg_length;
+       u32 reserved;
+};
+
+struct pcnet_tx_head {
+       u32 base;
+       s16 length;
+       s16 status;
+       u32 misc;
+       u32 reserved;
+};
+
+/* The PCNET 32-Bit initialization block, described in databook. */
+struct pcnet_init_block {
+       u16 mode;
+       u16 tlen_rlen;
+       u8 phys_addr[6];
+       u16 reserved;
+       u32 filter[2];
+       /* Receive and transmit ring base, along with extra bits. */
+       u32 rx_ring;
+       u32 tx_ring;
+       u32 reserved2;
+};
+
+struct pcnet_uncached_priv {
+       struct pcnet_rx_head rx_ring[RX_RING_SIZE];
+       struct pcnet_tx_head tx_ring[TX_RING_SIZE];
+       struct pcnet_init_block init_block;
+};
+
+typedef struct pcnet_priv {
+       struct pcnet_uncached_priv *uc;
+       /* Receive Buffer space */
+       unsigned char (*rx_buf)[RX_RING_SIZE][PKT_BUF_SZ + 4];
+       int cur_rx;
+       int cur_tx;
+} pcnet_priv_t;
+
+static pcnet_priv_t *lp;
+
+/* Offsets from base I/O address for WIO mode */
+#define PCNET_RDP              0x10
+#define PCNET_RAP              0x12
+#define PCNET_RESET            0x14
+#define PCNET_BDP              0x16
+
+static u16 pcnet_read_csr(struct eth_device *dev, int index)
+{
+       outw(index, dev->iobase + PCNET_RAP);
+       return inw(dev->iobase + PCNET_RDP);
+}
+
+static void pcnet_write_csr(struct eth_device *dev, int index, u16 val)
+{
+       outw(index, dev->iobase + PCNET_RAP);
+       outw(val, dev->iobase + PCNET_RDP);
+}
+
+static u16 pcnet_read_bcr(struct eth_device *dev, int index)
+{
+       outw(index, dev->iobase + PCNET_RAP);
+       return inw(dev->iobase + PCNET_BDP);
+}
+
+static void pcnet_write_bcr(struct eth_device *dev, int index, u16 val)
+{
+       outw(index, dev->iobase + PCNET_RAP);
+       outw(val, dev->iobase + PCNET_BDP);
+}
+
+static void pcnet_reset(struct eth_device *dev)
+{
+       inw(dev->iobase + PCNET_RESET);
+}
+
+static int pcnet_check(struct eth_device *dev)
+{
+       outw(88, dev->iobase + PCNET_RAP);
+       return inw(dev->iobase + PCNET_RAP) == 88;
+}
+
+static int pcnet_init (struct eth_device *dev, bd_t * bis);
+static int pcnet_send(struct eth_device *dev, void *packet, int length);
+static int pcnet_recv (struct eth_device *dev);
+static void pcnet_halt (struct eth_device *dev);
+static int pcnet_probe (struct eth_device *dev, bd_t * bis, int dev_num);
+
+#define PCI_TO_MEM(d, a) pci_virt_to_mem((pci_dev_t)d->priv, (a))
+#define PCI_TO_MEM_LE(d,a) (u32)(cpu_to_le32(PCI_TO_MEM(d,a)))
+
+static struct pci_device_id supported[] = {
+       {PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_LANCE},
+       {}
+};
+
+
+int pcnet_initialize(bd_t *bis)
+{
+       pci_dev_t devbusfn;
+       struct eth_device *dev;
+       u16 command, status;
+       int dev_nr = 0;
+
+       PCNET_DEBUG1("\npcnet_initialize...\n");
+
+       for (dev_nr = 0;; dev_nr++) {
+
+               /*
+                * Find the PCnet PCI device(s).
+                */
+               devbusfn = pci_find_devices(supported, dev_nr);
+               if (devbusfn < 0)
+                       break;
+
+               /*
+                * Allocate and pre-fill the device structure.
+                */
+               dev = (struct eth_device *)malloc(sizeof(*dev));
+               if (!dev) {
+                       printf("pcnet: Can not allocate memory\n");
+                       break;
+               }
+               memset(dev, 0, sizeof(*dev));
+               dev->priv = (void *)devbusfn;
+               sprintf(dev->name, "pcnet#%d", dev_nr);
+
+               /*
+                * Setup the PCI device.
+                */
+               pci_read_config_dword(devbusfn, PCI_BASE_ADDRESS_0,
+                                     (unsigned int *)&dev->iobase);
+               dev->iobase = pci_io_to_phys(devbusfn, dev->iobase);
+               dev->iobase &= ~0xf;
+
+               PCNET_DEBUG1("%s: devbusfn=0x%x iobase=0x%x: ",
+                            dev->name, devbusfn, dev->iobase);
+
+               command = PCI_COMMAND_IO | PCI_COMMAND_MASTER;
+               pci_write_config_word(devbusfn, PCI_COMMAND, command);
+               pci_read_config_word(devbusfn, PCI_COMMAND, &status);
+               if ((status & command) != command) {
+                       printf("%s: Couldn't enable IO access or Bus Mastering\n",
+                              dev->name);
+                       free(dev);
+                       continue;
+               }
+
+               pci_write_config_byte(devbusfn, PCI_LATENCY_TIMER, 0x40);
+
+               /*
+                * Probe the PCnet chip.
+                */
+               if (pcnet_probe(dev, bis, dev_nr) < 0) {
+                       free(dev);
+                       continue;
+               }
+
+               /*
+                * Setup device structure and register the driver.
+                */
+               dev->init = pcnet_init;
+               dev->halt = pcnet_halt;
+               dev->send = pcnet_send;
+               dev->recv = pcnet_recv;
+
+               eth_register(dev);
+       }
+
+       udelay(10 * 1000);
+
+       return dev_nr;
+}
+
+static int pcnet_probe(struct eth_device *dev, bd_t *bis, int dev_nr)
+{
+       int chip_version;
+       char *chipname;
+
+#ifdef PCNET_HAS_PROM
+       int i;
+#endif
+
+       /* Reset the PCnet controller */
+       pcnet_reset(dev);
+
+       /* Check if register access is working */
+       if (pcnet_read_csr(dev, 0) != 4 || !pcnet_check(dev)) {
+               printf("%s: CSR register access check failed\n", dev->name);
+               return -1;
+       }
+
+       /* Identify the chip */
+       chip_version =
+               pcnet_read_csr(dev, 88) | (pcnet_read_csr(dev, 89) << 16);
+       if ((chip_version & 0xfff) != 0x003)
+               return -1;
+       chip_version = (chip_version >> 12) & 0xffff;
+       switch (chip_version) {
+       case 0x2621:
+               chipname = "PCnet/PCI II 79C970A";      /* PCI */
+               break;
+#ifdef CONFIG_PCNET_79C973
+       case 0x2625:
+               chipname = "PCnet/FAST III 79C973";     /* PCI */
+               break;
+#endif
+#ifdef CONFIG_PCNET_79C975
+       case 0x2627:
+               chipname = "PCnet/FAST III 79C975";     /* PCI */
+               break;
+#endif
+       default:
+               printf("%s: PCnet version %#x not supported\n",
+                      dev->name, chip_version);
+               return -1;
+       }
+
+       PCNET_DEBUG1("AMD %s\n", chipname);
+
+#ifdef PCNET_HAS_PROM
+       /*
+        * In most chips, after a chip reset, the ethernet address is read from
+        * the station address PROM at the base address and programmed into the
+        * "Physical Address Registers" CSR12-14.
+        */
+       for (i = 0; i < 3; i++) {
+               unsigned int val;
+
+               val = pcnet_read_csr(dev, i + 12) & 0x0ffff;
+               /* There may be endianness issues here. */
+               dev->enetaddr[2 * i] = val & 0x0ff;
+               dev->enetaddr[2 * i + 1] = (val >> 8) & 0x0ff;
+       }
+#endif /* PCNET_HAS_PROM */
+
+       return 0;
+}
+
+static int pcnet_init(struct eth_device *dev, bd_t *bis)
+{
+       struct pcnet_uncached_priv *uc;
+       int i, val;
+       u32 addr;
+
+       PCNET_DEBUG1("%s: pcnet_init...\n", dev->name);
+
+       /* Switch pcnet to 32bit mode */
+       pcnet_write_bcr(dev, 20, 2);
+
+       /* Set/reset autoselect bit */
+       val = pcnet_read_bcr(dev, 2) & ~2;
+       val |= 2;
+       pcnet_write_bcr(dev, 2, val);
+
+       /* Enable auto negotiate, setup, disable fd */
+       val = pcnet_read_bcr(dev, 32) & ~0x98;
+       val |= 0x20;
+       pcnet_write_bcr(dev, 32, val);
+
+       /*
+        * Enable NOUFLO on supported controllers, with the transmit
+        * start point set to the full packet. This will cause entire
+        * packets to be buffered by the ethernet controller before
+        * transmission, eliminating underflows which are common on
+        * slower devices. Controllers which do not support NOUFLO will
+        * simply be left with a larger transmit FIFO threshold.
+        */
+       val = pcnet_read_bcr(dev, 18);
+       val |= 1 << 11;
+       pcnet_write_bcr(dev, 18, val);
+       val = pcnet_read_csr(dev, 80);
+       val |= 0x3 << 10;
+       pcnet_write_csr(dev, 80, val);
+
+       /*
+        * We only maintain one structure because the drivers will never
+        * be used concurrently. In 32bit mode the RX and TX ring entries
+        * must be aligned on 16-byte boundaries.
+        */
+       if (lp == NULL) {
+               addr = (u32)malloc(sizeof(pcnet_priv_t) + 0x10);
+               addr = (addr + 0xf) & ~0xf;
+               lp = (pcnet_priv_t *)addr;
+
+               addr = (u32)memalign(ARCH_DMA_MINALIGN, sizeof(*lp->uc));
+               flush_dcache_range(addr, addr + sizeof(*lp->uc));
+               addr = UNCACHED_SDRAM(addr);
+               lp->uc = (struct pcnet_uncached_priv *)addr;
+
+               addr = (u32)memalign(ARCH_DMA_MINALIGN, sizeof(*lp->rx_buf));
+               flush_dcache_range(addr, addr + sizeof(*lp->rx_buf));
+               lp->rx_buf = (void *)addr;
+       }
+
+       uc = lp->uc;
+
+       uc->init_block.mode = cpu_to_le16(0x0000);
+       uc->init_block.filter[0] = 0x00000000;
+       uc->init_block.filter[1] = 0x00000000;
+
+       /*
+        * Initialize the Rx ring.
+        */
+       lp->cur_rx = 0;
+       for (i = 0; i < RX_RING_SIZE; i++) {
+               uc->rx_ring[i].base = PCI_TO_MEM_LE(dev, (*lp->rx_buf)[i]);
+               uc->rx_ring[i].buf_length = cpu_to_le16(-PKT_BUF_SZ);
+               uc->rx_ring[i].status = cpu_to_le16(0x8000);
+               PCNET_DEBUG1
+                       ("Rx%d: base=0x%x buf_length=0x%hx status=0x%hx\n", i,
+                        uc->rx_ring[i].base, uc->rx_ring[i].buf_length,
+                        uc->rx_ring[i].status);
+       }
+
+       /*
+        * Initialize the Tx ring. The Tx buffer address is filled in as
+        * needed, but we do need to clear the upper ownership bit.
+        */
+       lp->cur_tx = 0;
+       for (i = 0; i < TX_RING_SIZE; i++) {
+               uc->tx_ring[i].base = 0;
+               uc->tx_ring[i].status = 0;
+       }
+
+       /*
+        * Setup Init Block.
+        */
+       PCNET_DEBUG1("Init block at 0x%p: MAC", &lp->uc->init_block);
+
+       for (i = 0; i < 6; i++) {
+               lp->uc->init_block.phys_addr[i] = dev->enetaddr[i];
+               PCNET_DEBUG1(" %02x", lp->uc->init_block.phys_addr[i]);
+       }
+
+       uc->init_block.tlen_rlen = cpu_to_le16(TX_RING_LEN_BITS |
+                                              RX_RING_LEN_BITS);
+       uc->init_block.rx_ring = PCI_TO_MEM_LE(dev, uc->rx_ring);
+       uc->init_block.tx_ring = PCI_TO_MEM_LE(dev, uc->tx_ring);
+
+       PCNET_DEBUG1("\ntlen_rlen=0x%x rx_ring=0x%x tx_ring=0x%x\n",
+                    uc->init_block.tlen_rlen,
+                    uc->init_block.rx_ring, uc->init_block.tx_ring);
+
+       /*
+        * Tell the controller where the Init Block is located.
+        */
+       barrier();
+       addr = PCI_TO_MEM(dev, &lp->uc->init_block);
+       pcnet_write_csr(dev, 1, addr & 0xffff);
+       pcnet_write_csr(dev, 2, (addr >> 16) & 0xffff);
+
+       pcnet_write_csr(dev, 4, 0x0915);
+       pcnet_write_csr(dev, 0, 0x0001);        /* start */
+
+       /* Wait for Init Done bit */
+       for (i = 10000; i > 0; i--) {
+               if (pcnet_read_csr(dev, 0) & 0x0100)
+                       break;
+               udelay(10);
+       }
+       if (i <= 0) {
+               printf("%s: TIMEOUT: controller init failed\n", dev->name);
+               pcnet_reset(dev);
+               return -1;
+       }
+
+       /*
+        * Finally start network controller operation.
+        */
+       pcnet_write_csr(dev, 0, 0x0002);
+
+       return 0;
+}
+
+static int pcnet_send(struct eth_device *dev, void *packet, int pkt_len)
+{
+       int i, status;
+       struct pcnet_tx_head *entry = &lp->uc->tx_ring[lp->cur_tx];
+
+       PCNET_DEBUG2("Tx%d: %d bytes from 0x%p ", lp->cur_tx, pkt_len,
+                    packet);
+
+       flush_dcache_range((unsigned long)packet,
+                          (unsigned long)packet + pkt_len);
+
+       /* Wait for completion by testing the OWN bit */
+       for (i = 1000; i > 0; i--) {
+               status = readw(&entry->status);
+               if ((status & 0x8000) == 0)
+                       break;
+               udelay(100);
+               PCNET_DEBUG2(".");
+       }
+       if (i <= 0) {
+               printf("%s: TIMEOUT: Tx%d failed (status = 0x%x)\n",
+                      dev->name, lp->cur_tx, status);
+               pkt_len = 0;
+               goto failure;
+       }
+
+       /*
+        * Setup Tx ring. Caution: the write order is important here,
+        * set the status with the "ownership" bits last.
+        */
+       writew(-pkt_len, &entry->length);
+       writel(0, &entry->misc);
+       writel(PCI_TO_MEM(dev, packet), &entry->base);
+       writew(0x8300, &entry->status);
+
+       /* Trigger an immediate send poll. */
+       pcnet_write_csr(dev, 0, 0x0008);
+
+      failure:
+       if (++lp->cur_tx >= TX_RING_SIZE)
+               lp->cur_tx = 0;
+
+       PCNET_DEBUG2("done\n");
+       return pkt_len;
+}
+
+static int pcnet_recv (struct eth_device *dev)
+{
+       struct pcnet_rx_head *entry;
+       unsigned char *buf;
+       int pkt_len = 0;
+       u16 status, err_status;
+
+       while (1) {
+               entry = &lp->uc->rx_ring[lp->cur_rx];
+               /*
+                * If we own the next entry, it's a new packet. Send it up.
+                */
+               status = readw(&entry->status);
+               if ((status & 0x8000) != 0)
+                       break;
+               err_status = status >> 8;
+
+               if (err_status != 0x03) {       /* There was an error. */
+                       printf("%s: Rx%d", dev->name, lp->cur_rx);
+                       PCNET_DEBUG1(" (status=0x%x)", err_status);
+                       if (err_status & 0x20)
+                               printf(" Frame");
+                       if (err_status & 0x10)
+                               printf(" Overflow");
+                       if (err_status & 0x08)
+                               printf(" CRC");
+                       if (err_status & 0x04)
+                               printf(" Fifo");
+                       printf(" Error\n");
+                       status &= 0x03ff;
+
+               } else {
+                       pkt_len = (readl(&entry->msg_length) & 0xfff) - 4;
+                       if (pkt_len < 60) {
+                               printf("%s: Rx%d: invalid packet length %d\n",
+                                      dev->name, lp->cur_rx, pkt_len);
+                       } else {
+                               buf = (*lp->rx_buf)[lp->cur_rx];
+                               invalidate_dcache_range((unsigned long)buf,
+                                       (unsigned long)buf + pkt_len);
+                               NetReceive(buf, pkt_len);
+                               PCNET_DEBUG2("Rx%d: %d bytes from 0x%p\n",
+                                            lp->cur_rx, pkt_len, buf);
+                       }
+               }
+
+               status |= 0x8000;
+               writew(status, &entry->status);
+
+               if (++lp->cur_rx >= RX_RING_SIZE)
+                       lp->cur_rx = 0;
+       }
+       return pkt_len;
+}
+
+static void pcnet_halt(struct eth_device *dev)
+{
+       int i;
+
+       PCNET_DEBUG1("%s: pcnet_halt...\n", dev->name);
+
+       /* Reset the PCnet controller */
+       pcnet_reset(dev);
+
+       /* Wait for Stop bit */
+       for (i = 1000; i > 0; i--) {
+               if (pcnet_read_csr(dev, 0) & 0x4)
+                       break;
+               udelay(10);
+       }
+       if (i <= 0)
+               printf("%s: TIMEOUT: controller reset failed\n", dev->name);
+}