Merge https://gitlab.denx.de/u-boot/custodians/u-boot-spi into next
[platform/kernel/u-boot.git] / drivers / net / rtl8139.c
index 6aed7bd..8a6f305 100644 (file)
@@ -1,3 +1,4 @@
+// SPDX-License-Identifier: GPL-2.0
 /*
  * rtl8139.c : U-Boot driver for the RealTek RTL8139
  *
@@ -8,82 +9,82 @@
  */
 
 /* rtl8139.c - etherboot driver for the Realtek 8139 chipset
-
-  ported from the linux driver written by Donald Becker
-  by Rainer Bawidamann (Rainer.Bawidamann@informatik.uni-ulm.de) 1999
-
-  This software may be used and distributed according to the terms
-  of the GNU Public License, incorporated herein by reference.
-
-  changes to the original driver:
-  - removed support for interrupts, switching to polling mode (yuck!)
-  - removed support for the 8129 chip (external MII)
-
-*/
+ *
+ * ported from the linux driver written by Donald Becker
+ * by Rainer Bawidamann (Rainer.Bawidamann@informatik.uni-ulm.de) 1999
+ *
+ * changes to the original driver:
+ * - removed support for interrupts, switching to polling mode (yuck!)
+ * - removed support for the 8129 chip (external MII)
+ */
 
 /*********************************************************************/
 /* Revision History                                                 */
 /*********************************************************************/
 
 /*
 28 Dec 2002  ken_yap@users.sourceforge.net (Ken Yap)
-     Put in virt_to_bus calls to allow Etherboot relocation.
-
 06 Apr 2001  ken_yap@users.sourceforge.net (Ken Yap)
-     Following email from Hyun-Joon Cha, added a disable routine, otherwise
-     NIC remains live and can crash the kernel later.
-
 4 Feb 2000   espenlaub@informatik.uni-ulm.de (Klaus Espenlaub)
-     Shuffled things around, removed the leftovers from the 8129 support
-     that was in the Linux driver and added a bit more 8139 definitions.
-     Moved the 8K receive buffer to a fixed, available address outside the
    0x98000-0x9ffff range.  This is a bit of a hack, but currently the only
-     way to make room for the Etherboot features that need substantial amounts
    of code like the ANSI console support.  Currently the buffer is just below
-     0x10000, so this even conforms to the tagged boot image specification,
    which reserves the ranges 0x00000-0x10000 and 0x98000-0xA0000.  My
-     interpretation of this "reserved" is that Etherboot may do whatever it
-     likes, as long as its environment is kept intact (like the BIOS
    variables).  Hopefully fixed rtl8139_recv() once and for all.     The symptoms
-     were that if Etherboot was left at the boot menu for several minutes, the
    first eth_poll failed.  Seems like I am the only person who does this.
-     First of all I fixed the debugging code and then set out for a long bug
    hunting session.  It took me about a week full time work - poking around
-     various places in the driver, reading Don Becker's and Jeff Garzik's Linux
-     driver and even the FreeBSD driver (what a piece of crap!) - and
-     eventually spotted the nasty thing: the transmit routine was acknowledging
-     each and every interrupt pending, including the RxOverrun and RxFIFIOver
    interrupts.  This confused the RTL8139 thoroughly.         It destroyed the
-     Rx ring contents by dumping the 2K FIFO contents right where we wanted to
    get the next packet.  Oh well, what fun.
-
 18 Jan 2000  mdc@thinguin.org (Marty Connor)
    Drastically simplified error handling.  Basically, if any error
-     in transmission or reception occurs, the card is reset.
-     Also, pointed all transmit descriptors to the same buffer to
    save buffer space.         This should decrease driver size and avoid
-     corruption because of exceeding 32K during runtime.
-
 28 Jul 1999  (Matthias Meixner - meixner@rbg.informatik.tu-darmstadt.de)
-     rtl8139_recv was quite broken: it used the RxOK interrupt flag instead
-     of the RxBufferEmpty flag which often resulted in very bad
-     transmission performace - below 1kBytes/s.
-
-*/
* 28 Dec 2002 ken_yap@users.sourceforge.net (Ken Yap)
*    Put in virt_to_bus calls to allow Etherboot relocation.
+ *
* 06 Apr 2001 ken_yap@users.sourceforge.net (Ken Yap)
*    Following email from Hyun-Joon Cha, added a disable routine, otherwise
*    NIC remains live and can crash the kernel later.
+ *
* 4 Feb 2000 espenlaub@informatik.uni-ulm.de (Klaus Espenlaub)
*    Shuffled things around, removed the leftovers from the 8129 support
*    that was in the Linux driver and added a bit more 8139 definitions.
*    Moved the 8K receive buffer to a fixed, available address outside the
*    0x98000-0x9ffff range. This is a bit of a hack, but currently the only
*    way to make room for the Etherboot features that need substantial amounts
*    of code like the ANSI console support. Currently the buffer is just below
*    0x10000, so this even conforms to the tagged boot image specification,
*    which reserves the ranges 0x00000-0x10000 and 0x98000-0xA0000. My
*    interpretation of this "reserved" is that Etherboot may do whatever it
*    likes, as long as its environment is kept intact (like the BIOS
*    variables). Hopefully fixed rtl8139_recv() once and for all. The symptoms
*    were that if Etherboot was left at the boot menu for several minutes, the
*    first eth_poll failed. Seems like I am the only person who does this.
*    First of all I fixed the debugging code and then set out for a long bug
*    hunting session. It took me about a week full time work - poking around
*    various places in the driver, reading Don Becker's and Jeff Garzik's Linux
*    driver and even the FreeBSD driver (what a piece of crap!) - and
*    eventually spotted the nasty thing: the transmit routine was acknowledging
*    each and every interrupt pending, including the RxOverrun and RxFIFIOver
*    interrupts. This confused the RTL8139 thoroughly. It destroyed the
*    Rx ring contents by dumping the 2K FIFO contents right where we wanted to
*    get the next packet. Oh well, what fun.
+ *
* 18 Jan 2000 mdc@thinguin.org (Marty Connor)
*    Drastically simplified error handling. Basically, if any error
*    in transmission or reception occurs, the card is reset.
*    Also, pointed all transmit descriptors to the same buffer to
*    save buffer space. This should decrease driver size and avoid
*    corruption because of exceeding 32K during runtime.
+ *
* 28 Jul 1999 (Matthias Meixner - meixner@rbg.informatik.tu-darmstadt.de)
*    rtl8139_recv was quite broken: it used the RxOK interrupt flag instead
*    of the RxBufferEmpty flag which often resulted in very bad
*    transmission performace - below 1kBytes/s.
+ *
+ */
 
 #include <common.h>
 #include <cpu_func.h>
-#include <linux/types.h>
+#include <dm.h>
+#include <log.h>
 #include <malloc.h>
 #include <net.h>
 #include <netdev.h>
 #include <asm/io.h>
 #include <pci.h>
+#include <linux/bitops.h>
+#include <linux/delay.h>
+#include <linux/types.h>
 
 #define RTL_TIMEOUT    100000
 
-/* PCI Tuning Parameters
-   Threshold is bytes transferred to chip before transmission starts. */
+/* PCI Tuning Parameters */
+/* Threshold is bytes transferred to chip before transmission starts. */
 #define TX_FIFO_THRESH 256     /* In bytes, rounded down to 32 byte units. */
 #define RX_FIFO_THRESH 4       /* Rx buffer level before first PCI xfer.  */
 #define RX_DMA_BURST   4       /* Maximum PCI burst, '4' is 256 bytes */
 #define DEBUG_TX       0       /* set to 1 to enable debug code */
 #define DEBUG_RX       0       /* set to 1 to enable debug code */
 
-#define bus_to_phys(a) pci_mem_to_phys((pci_dev_t)dev->priv, a)
-#define phys_to_bus(a) pci_phys_to_mem((pci_dev_t)dev->priv, a)
+#ifdef CONFIG_DM_ETH
+#define bus_to_phys(devno, a)  dm_pci_mem_to_phys((devno), (a))
+#define phys_to_bus(devno, a)  dm_pci_phys_to_mem((devno), (a))
+#else
+#define bus_to_phys(devno, a)  pci_mem_to_phys((pci_dev_t)(devno), (a))
+#define phys_to_bus(devno, a)  pci_phys_to_mem((pci_dev_t)(devno), (a))
+#endif
 
 /* Symbolic offsets to registers. */
 /* Ethernet hardware address. */
 #define RTL_STS_RXBADALIGN                     BIT(1)
 #define RTL_STS_RXSTATUSOK                     BIT(0)
 
-static int ioaddr;
-static unsigned int cur_rx,cur_tx;
-
-/* The RTL8139 can only transmit from a contiguous, aligned memory block.  */
-static unsigned char tx_buffer[TX_BUF_SIZE] __attribute__((aligned(4)));
-static unsigned char rx_ring[RX_BUF_LEN+16] __attribute__((aligned(4)));
-
-static int rtl8139_probe(struct eth_device *dev, bd_t *bis);
-static int rtl8139_read_eeprom(unsigned int location, unsigned int addr_len);
-static void rtl8139_reset(struct eth_device *dev);
-static int rtl8139_send(struct eth_device *dev, void *packet, int length);
-static int rtl8139_recv(struct eth_device *dev);
-static void rtl8139_stop(struct eth_device *dev);
-static int rtl_bcast_addr(struct eth_device *dev, const u8 *bcast_mac, int join)
-{
-       return (0);
-}
-
-static struct pci_device_id supported[] = {
-       {PCI_VENDOR_ID_REALTEK, PCI_DEVICE_ID_REALTEK_8139},
-       {PCI_VENDOR_ID_DLINK, PCI_DEVICE_ID_DLINK_8139},
-       {}
+struct rtl8139_priv {
+#ifndef CONFIG_DM_ETH
+       struct eth_device       dev;
+       pci_dev_t               devno;
+#else
+       struct udevice          *devno;
+#endif
+       unsigned int            rxstatus;
+       unsigned int            cur_rx;
+       unsigned int            cur_tx;
+       unsigned long           ioaddr;
+       unsigned char           enetaddr[6];
 };
 
-int rtl8139_initialize(bd_t *bis)
-{
-       pci_dev_t devno;
-       int card_number = 0;
-       struct eth_device *dev;
-       u32 iobase;
-       int idx=0;
-
-       while(1){
-               /* Find RTL8139 */
-               if ((devno = pci_find_devices(supported, idx++)) < 0)
-                       break;
-
-               pci_read_config_dword(devno, PCI_BASE_ADDRESS_1, &iobase);
-               iobase &= ~0xf;
-
-               debug ("rtl8139: REALTEK RTL8139 @0x%x\n", iobase);
-
-               dev = (struct eth_device *)malloc(sizeof *dev);
-               if (!dev) {
-                       printf("Can not allocate memory of rtl8139\n");
-                       break;
-               }
-               memset(dev, 0, sizeof(*dev));
-
-               sprintf (dev->name, "RTL8139#%d", card_number);
-
-               dev->priv = (void *) devno;
-               dev->iobase = (int)bus_to_phys(iobase);
-               dev->init = rtl8139_probe;
-               dev->halt = rtl8139_stop;
-               dev->send = rtl8139_send;
-               dev->recv = rtl8139_recv;
-               dev->mcast = rtl_bcast_addr;
-
-               eth_register (dev);
-
-               card_number++;
-
-               pci_write_config_byte (devno, PCI_LATENCY_TIMER, 0x20);
-
-               udelay (10 * 1000);
-       }
-
-       return card_number;
-}
-
-static int rtl8139_probe(struct eth_device *dev, bd_t *bis)
-{
-       int i;
-       int addr_len;
-       unsigned short *ap = (unsigned short *)dev->enetaddr;
-
-       ioaddr = dev->iobase;
-
-       /* Bring the chip out of low-power mode. */
-       outb(0x00, ioaddr + RTL_REG_CONFIG1);
-
-       addr_len = rtl8139_read_eeprom(0,8) == 0x8129 ? 8 : 6;
-       for (i = 0; i < 3; i++)
-               *ap++ = le16_to_cpu (rtl8139_read_eeprom(i + 7, addr_len));
-
-       rtl8139_reset(dev);
-
-       if (inb(ioaddr + RTL_REG_MEDIASTATUS) & RTL_REG_MEDIASTATUS_MSRLINKFAIL) {
-               printf("Cable not connected or other link failure\n");
-               return -1 ;
-       }
-
-       return 0;
-}
+/* The RTL8139 can only transmit from a contiguous, aligned memory block.  */
+static unsigned char tx_buffer[TX_BUF_SIZE] __aligned(4);
+static unsigned char rx_ring[RX_BUF_LEN + 16] __aligned(4);
 
 /* Serial EEPROM section. */
 
@@ -303,51 +231,52 @@ static int rtl8139_probe(struct eth_device *dev, bd_t *bis)
 #define EE_READ_CMD    6
 #define EE_ERASE_CMD   7
 
-static void rtl8139_eeprom_delay(uintptr_t regbase)
+static void rtl8139_eeprom_delay(struct rtl8139_priv *priv)
 {
        /*
         * Delay between EEPROM clock transitions.
         * No extra delay is needed with 33MHz PCI, but 66MHz may change this.
         */
-       inl(regbase + RTL_REG_CFG9346);
+       inl(priv->ioaddr + RTL_REG_CFG9346);
 }
 
-static int rtl8139_read_eeprom(unsigned int location, unsigned int addr_len)
+static int rtl8139_read_eeprom(struct rtl8139_priv *priv,
+                              unsigned int location, unsigned int addr_len)
 {
        unsigned int read_cmd = location | (EE_READ_CMD << addr_len);
-       uintptr_t ee_addr = ioaddr + RTL_REG_CFG9346;
+       uintptr_t ee_addr = priv->ioaddr + RTL_REG_CFG9346;
        unsigned int retval = 0;
        u8 dataval;
        int i;
 
        outb(EE_ENB & ~EE_CS, ee_addr);
        outb(EE_ENB, ee_addr);
-       rtl8139_eeprom_delay(ioaddr);
+       rtl8139_eeprom_delay(priv);
 
        /* Shift the read command bits out. */
        for (i = 4 + addr_len; i >= 0; i--) {
                dataval = (read_cmd & BIT(i)) ? EE_DATA_WRITE : 0;
                outb(EE_ENB | dataval, ee_addr);
-               rtl8139_eeprom_delay(ioaddr);
+               rtl8139_eeprom_delay(priv);
                outb(EE_ENB | dataval | EE_SHIFT_CLK, ee_addr);
-               rtl8139_eeprom_delay(ioaddr);
+               rtl8139_eeprom_delay(priv);
        }
 
        outb(EE_ENB, ee_addr);
-       rtl8139_eeprom_delay(ioaddr);
+       rtl8139_eeprom_delay(priv);
 
        for (i = 16; i > 0; i--) {
                outb(EE_ENB | EE_SHIFT_CLK, ee_addr);
-               rtl8139_eeprom_delay(ioaddr);
+               rtl8139_eeprom_delay(priv);
                retval <<= 1;
                retval |= inb(ee_addr) & EE_DATA_READ;
                outb(EE_ENB, ee_addr);
-               rtl8139_eeprom_delay(ioaddr);
+               rtl8139_eeprom_delay(priv);
        }
 
        /* Terminate the EEPROM access. */
        outb(~EE_CS, ee_addr);
-       rtl8139_eeprom_delay(ioaddr);
+       rtl8139_eeprom_delay(priv);
 
        return retval;
 }
@@ -357,49 +286,55 @@ static const unsigned int rtl8139_rx_config =
        (RX_FIFO_THRESH << 13) |
        (RX_DMA_BURST << 8);
 
-static void rtl8139_set_rx_mode(struct eth_device *dev)
+static void rtl8139_set_rx_mode(struct rtl8139_priv *priv)
 {
        /* !IFF_PROMISC */
        unsigned int rx_mode = RTL_REG_RXCONFIG_ACCEPTBROADCAST |
                               RTL_REG_RXCONFIG_ACCEPTMULTICAST |
                               RTL_REG_RXCONFIG_ACCEPTMYPHYS;
 
-       outl(rtl8139_rx_config | rx_mode, ioaddr + RTL_REG_RXCONFIG);
+       outl(rtl8139_rx_config | rx_mode, priv->ioaddr + RTL_REG_RXCONFIG);
 
-       outl(0xffffffff, ioaddr + RTL_REG_MAR0 + 0);
-       outl(0xffffffff, ioaddr + RTL_REG_MAR0 + 4);
+       outl(0xffffffff, priv->ioaddr + RTL_REG_MAR0 + 0);
+       outl(0xffffffff, priv->ioaddr + RTL_REG_MAR0 + 4);
 }
 
-static void rtl8139_reset(struct eth_device *dev)
+static void rtl8139_hw_reset(struct rtl8139_priv *priv)
 {
        u8 reg;
        int i;
 
-       outb(RTL_REG_CHIPCMD_CMDRESET, ioaddr + RTL_REG_CHIPCMD);
-
-       cur_rx = 0;
-       cur_tx = 0;
+       outb(RTL_REG_CHIPCMD_CMDRESET, priv->ioaddr + RTL_REG_CHIPCMD);
 
        /* Give the chip 10ms to finish the reset. */
        for (i = 0; i < 100; i++) {
-               reg = inb(ioaddr + RTL_REG_CHIPCMD);
+               reg = inb(priv->ioaddr + RTL_REG_CHIPCMD);
                if (!(reg & RTL_REG_CHIPCMD_CMDRESET))
                        break;
 
                udelay(100);
        }
+}
+
+static void rtl8139_reset(struct rtl8139_priv *priv)
+{
+       int i;
 
+       priv->cur_rx = 0;
+       priv->cur_tx = 0;
+
+       rtl8139_hw_reset(priv);
 
        for (i = 0; i < ETH_ALEN; i++)
-               outb(dev->enetaddr[i], ioaddr + RTL_REG_MAC0 + i);
+               outb(priv->enetaddr[i], priv->ioaddr + RTL_REG_MAC0 + i);
 
        /* Must enable Tx/Rx before setting transfer thresholds! */
        outb(RTL_REG_CHIPCMD_CMDRXENB | RTL_REG_CHIPCMD_CMDTXENB,
-            ioaddr + RTL_REG_CHIPCMD);
+            priv->ioaddr + RTL_REG_CHIPCMD);
 
        /* accept no frames yet! */
-       outl(rtl8139_rx_config, ioaddr + RTL_REG_RXCONFIG);
-       outl((TX_DMA_BURST << 8) | 0x03000000, ioaddr + RTL_REG_TXCONFIG);
+       outl(rtl8139_rx_config, priv->ioaddr + RTL_REG_RXCONFIG);
+       outl((TX_DMA_BURST << 8) | 0x03000000, priv->ioaddr + RTL_REG_TXCONFIG);
 
        /*
         * The Linux driver changes RTL_REG_CONFIG1 here to use a different
@@ -414,7 +349,7 @@ static void rtl8139_reset(struct eth_device *dev)
        debug_cond(DEBUG_RX, "rx ring address is %p\n", rx_ring);
 
        flush_cache((unsigned long)rx_ring, RX_BUF_LEN);
-       outl(phys_to_bus((int)rx_ring), ioaddr + RTL_REG_RXBUF);
+       outl(phys_to_bus(priv->devno, (int)rx_ring), priv->ioaddr + RTL_REG_RXBUF);
 
        /*
         * If we add multicast support, the RTL_REG_MAR0 register would have
@@ -423,28 +358,27 @@ static void rtl8139_reset(struct eth_device *dev)
         * unicast.
         */
        outb(RTL_REG_CHIPCMD_CMDRXENB | RTL_REG_CHIPCMD_CMDTXENB,
-            ioaddr + RTL_REG_CHIPCMD);
+            priv->ioaddr + RTL_REG_CHIPCMD);
 
-       outl(rtl8139_rx_config, ioaddr + RTL_REG_RXCONFIG);
+       outl(rtl8139_rx_config, priv->ioaddr + RTL_REG_RXCONFIG);
 
        /* Start the chip's Tx and Rx process. */
-       outl(0, ioaddr + RTL_REG_RXMISSED);
+       outl(0, priv->ioaddr + RTL_REG_RXMISSED);
 
-       rtl8139_set_rx_mode(dev);
+       rtl8139_set_rx_mode(priv);
 
        /* Disable all known interrupts by setting the interrupt mask. */
-       outw(0, ioaddr + RTL_REG_INTRMASK);
+       outw(0, priv->ioaddr + RTL_REG_INTRMASK);
 }
 
-static int rtl8139_send(struct eth_device *dev, void *packet, int length)
+static int rtl8139_send_common(struct rtl8139_priv *priv,
+                              void *packet, int length)
 {
        unsigned int len = length;
        unsigned long txstatus;
        unsigned int status;
        int i = 0;
 
-       ioaddr = dev->iobase;
-
        memcpy(tx_buffer, packet, length);
 
        debug_cond(DEBUG_TX, "sending %d bytes\n", len);
@@ -457,13 +391,13 @@ static int rtl8139_send(struct eth_device *dev, void *packet, int length)
                tx_buffer[len++] = '\0';
 
        flush_cache((unsigned long)tx_buffer, length);
-       outl(phys_to_bus((unsigned long)tx_buffer),
-            ioaddr + RTL_REG_TXADDR0 + cur_tx * 4);
+       outl(phys_to_bus(priv->devno, (unsigned long)tx_buffer),
+            priv->ioaddr + RTL_REG_TXADDR0 + priv->cur_tx * 4);
        outl(((TX_FIFO_THRESH << 11) & 0x003f0000) | len,
-            ioaddr + RTL_REG_TXSTATUS0 + cur_tx * 4);
+            priv->ioaddr + RTL_REG_TXSTATUS0 + priv->cur_tx * 4);
 
        do {
-               status = inw(ioaddr + RTL_REG_INTRSTATUS);
+               status = inw(priv->ioaddr + RTL_REG_INTRSTATUS);
                /*
                 * Only acknlowledge interrupt sources we can properly
                 * handle here - the RTL_REG_INTRSTATUS_RXOVERFLOW/
@@ -472,26 +406,26 @@ static int rtl8139_send(struct eth_device *dev, void *packet, int length)
                 */
                status &= RTL_REG_INTRSTATUS_TXOK | RTL_REG_INTRSTATUS_TXERR |
                          RTL_REG_INTRSTATUS_PCIERR;
-               outw(status, ioaddr + RTL_REG_INTRSTATUS);
+               outw(status, priv->ioaddr + RTL_REG_INTRSTATUS);
                if (status)
                        break;
 
                udelay(10);
        } while (i++ < RTL_TIMEOUT);
 
-       txstatus = inl(ioaddr + RTL_REG_TXSTATUS0 + cur_tx * 4);
+       txstatus = inl(priv->ioaddr + RTL_REG_TXSTATUS0 + priv->cur_tx * 4);
 
        if (!(status & RTL_REG_INTRSTATUS_TXOK)) {
                debug_cond(DEBUG_TX,
                           "tx timeout/error (%d usecs), status %hX txstatus %lX\n",
                           10 * i, status, txstatus);
 
-               rtl8139_reset(dev);
+               rtl8139_reset(priv);
 
                return 0;
        }
 
-       cur_tx = (cur_tx + 1) % NUM_TX_DESC;
+       priv->cur_tx = (priv->cur_tx + 1) % NUM_TX_DESC;
 
        debug_cond(DEBUG_TX, "tx done, status %hX txstatus %lX\n",
                   status, txstatus);
@@ -499,28 +433,26 @@ static int rtl8139_send(struct eth_device *dev, void *packet, int length)
        return length;
 }
 
-static int rtl8139_recv(struct eth_device *dev)
+static int rtl8139_recv_common(struct rtl8139_priv *priv, unsigned char *rxdata,
+                              uchar **packetp)
 {
        const unsigned int rxstat = RTL_REG_INTRSTATUS_RXFIFOOVER |
                                    RTL_REG_INTRSTATUS_RXOVERFLOW |
                                    RTL_REG_INTRSTATUS_RXOK;
        unsigned int rx_size, rx_status;
        unsigned int ring_offs;
-       unsigned int status;
        int length = 0;
 
-       ioaddr = dev->iobase;
-
-       if (inb(ioaddr + RTL_REG_CHIPCMD) & RTL_REG_CHIPCMD_RXBUFEMPTY)
+       if (inb(priv->ioaddr + RTL_REG_CHIPCMD) & RTL_REG_CHIPCMD_RXBUFEMPTY)
                return 0;
 
-       status = inw(ioaddr + RTL_REG_INTRSTATUS);
+       priv->rxstatus = inw(priv->ioaddr + RTL_REG_INTRSTATUS);
        /* See below for the rest of the interrupt acknowledges.  */
-       outw(status & ~rxstat, ioaddr + RTL_REG_INTRSTATUS);
+       outw(priv->rxstatus & ~rxstat, priv->ioaddr + RTL_REG_INTRSTATUS);
 
-       debug_cond(DEBUG_RX, "%s: int %hX ", __func__, status);
+       debug_cond(DEBUG_RX, "%s: int %hX ", __func__, priv->rxstatus);
 
-       ring_offs = cur_rx % RX_BUF_LEN;
+       ring_offs = priv->cur_rx % RX_BUF_LEN;
        /* ring_offs is guaranteed being 4-byte aligned */
        rx_status = le32_to_cpu(*(unsigned int *)(rx_ring + ring_offs));
        rx_size = rx_status >> 16;
@@ -533,56 +465,315 @@ static int rtl8139_recv(struct eth_device *dev)
            (rx_size > ETH_FRAME_LEN + 4)) {
                printf("rx error %hX\n", rx_status);
                /* this clears all interrupts still pending */
-               rtl8139_reset(dev);
+               rtl8139_reset(priv);
                return 0;
        }
 
        /* Received a good packet */
        length = rx_size - 4;   /* no one cares about the FCS */
        if (ring_offs + 4 + rx_size - 4 > RX_BUF_LEN) {
-               unsigned char rxdata[RX_BUF_LEN];
                int semi_count = RX_BUF_LEN - ring_offs - 4;
 
                memcpy(rxdata, rx_ring + ring_offs + 4, semi_count);
                memcpy(&rxdata[semi_count], rx_ring,
                       rx_size - 4 - semi_count);
 
-               net_process_received_packet(rxdata, length);
+               *packetp = rxdata;
                debug_cond(DEBUG_RX, "rx packet %d+%d bytes",
                           semi_count, rx_size - 4 - semi_count);
        } else {
-               net_process_received_packet(rx_ring + ring_offs + 4, length);
+               *packetp = rx_ring + ring_offs + 4;
                debug_cond(DEBUG_RX, "rx packet %d bytes", rx_size - 4);
        }
+
+       return length;
+}
+
+static int rtl8139_free_pkt_common(struct rtl8139_priv *priv, unsigned int len)
+{
+       const unsigned int rxstat = RTL_REG_INTRSTATUS_RXFIFOOVER |
+                                   RTL_REG_INTRSTATUS_RXOVERFLOW |
+                                   RTL_REG_INTRSTATUS_RXOK;
+       unsigned int rx_size = len + 4;
+
        flush_cache((unsigned long)rx_ring, RX_BUF_LEN);
 
-       cur_rx = ROUND(cur_rx + rx_size + 4, 4);
-       outw(cur_rx - 16, ioaddr + RTL_REG_RXBUFPTR);
+       priv->cur_rx = ROUND(priv->cur_rx + rx_size + 4, 4);
+       outw(priv->cur_rx - 16, priv->ioaddr + RTL_REG_RXBUFPTR);
        /*
         * See RTL8139 Programming Guide V0.1 for the official handling of
         * Rx overflow situations. The document itself contains basically
         * no usable information, except for a few exception handling rules.
         */
-       outw(status & rxstat, ioaddr + RTL_REG_INTRSTATUS);
+       outw(priv->rxstatus & rxstat, priv->ioaddr + RTL_REG_INTRSTATUS);
 
-       return length;
+       return 0;
 }
 
-static void rtl8139_stop(struct eth_device *dev)
+static int rtl8139_init_common(struct rtl8139_priv *priv)
 {
        u8 reg;
-       int i;
 
-       ioaddr = dev->iobase;
+       /* Bring the chip out of low-power mode. */
+       outb(0x00, priv->ioaddr + RTL_REG_CONFIG1);
 
-       /* reset the chip */
-       outb(RTL_REG_CHIPCMD_CMDRESET, ioaddr + RTL_REG_CHIPCMD);
+       rtl8139_reset(priv);
 
-       /* Give the chip 10ms to finish the reset. */
-       for (i = 0; i < 100; i++) {
-               reg = inb(ioaddr + RTL_REG_CHIPCMD);
-               if (!(reg & RTL_REG_CHIPCMD_CMDRESET))
+       reg = inb(priv->ioaddr + RTL_REG_MEDIASTATUS);
+       if (reg & RTL_REG_MEDIASTATUS_MSRLINKFAIL) {
+               printf("Cable not connected or other link failure\n");
+               return -1;
+       }
+
+       return 0;
+}
+
+static void rtl8139_stop_common(struct rtl8139_priv *priv)
+{
+       rtl8139_hw_reset(priv);
+}
+
+static void rtl8139_get_hwaddr(struct rtl8139_priv *priv)
+{
+       unsigned short *ap = (unsigned short *)priv->enetaddr;
+       int i, addr_len;
+
+       /* Bring the chip out of low-power mode. */
+       outb(0x00, priv->ioaddr + RTL_REG_CONFIG1);
+
+       addr_len = rtl8139_read_eeprom(priv, 0, 8) == 0x8129 ? 8 : 6;
+       for (i = 0; i < 3; i++)
+               *ap++ = le16_to_cpu(rtl8139_read_eeprom(priv, i + 7, addr_len));
+}
+
+static void rtl8139_name(char *str, int card_number)
+{
+       sprintf(str, "RTL8139#%u", card_number);
+}
+
+static struct pci_device_id supported[] = {
+       { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, PCI_DEVICE_ID_REALTEK_8139) },
+       { PCI_DEVICE(PCI_VENDOR_ID_DLINK, PCI_DEVICE_ID_DLINK_8139) },
+       { }
+};
+
+#ifndef CONFIG_DM_ETH
+static int rtl8139_bcast_addr(struct eth_device *dev, const u8 *bcast_mac,
+                             int join)
+{
+       return 0;
+}
+
+static int rtl8139_init(struct eth_device *dev, bd_t *bis)
+{
+       struct rtl8139_priv *priv = container_of(dev, struct rtl8139_priv, dev);
+
+       return rtl8139_init_common(priv);
+}
+
+static void rtl8139_stop(struct eth_device *dev)
+{
+       struct rtl8139_priv *priv = container_of(dev, struct rtl8139_priv, dev);
+
+       return rtl8139_stop_common(priv);
+}
+
+static int rtl8139_send(struct eth_device *dev, void *packet, int length)
+{
+       struct rtl8139_priv *priv = container_of(dev, struct rtl8139_priv, dev);
+
+       return rtl8139_send_common(priv, packet, length);
+}
+
+static int rtl8139_recv(struct eth_device *dev)
+{
+       struct rtl8139_priv *priv = container_of(dev, struct rtl8139_priv, dev);
+       unsigned char rxdata[RX_BUF_LEN];
+       uchar *packet;
+       int ret;
+
+       ret = rtl8139_recv_common(priv, rxdata, &packet);
+       if (ret) {
+               net_process_received_packet(packet, ret);
+               rtl8139_free_pkt_common(priv, ret);
+       }
+
+       return ret;
+}
+
+int rtl8139_initialize(bd_t *bis)
+{
+       struct rtl8139_priv *priv;
+       struct eth_device *dev;
+       int card_number = 0;
+       pci_dev_t devno;
+       int idx = 0;
+       u32 iobase;
+
+       while (1) {
+               /* Find RTL8139 */
+               devno = pci_find_devices(supported, idx++);
+               if (devno < 0)
                        break;
-               udelay (100); /* wait 100us */
+
+               pci_read_config_dword(devno, PCI_BASE_ADDRESS_1, &iobase);
+               iobase &= ~0xf;
+
+               debug("rtl8139: REALTEK RTL8139 @0x%x\n", iobase);
+
+               priv = calloc(1, sizeof(*priv));
+               if (!priv) {
+                       printf("Can not allocate memory of rtl8139\n");
+                       break;
+               }
+
+               priv->devno = devno;
+               priv->ioaddr = (unsigned long)bus_to_phys(devno, iobase);
+
+               dev = &priv->dev;
+
+               rtl8139_name(dev->name, card_number);
+
+               dev->iobase = priv->ioaddr;     /* Non-DM compatibility */
+               dev->init = rtl8139_init;
+               dev->halt = rtl8139_stop;
+               dev->send = rtl8139_send;
+               dev->recv = rtl8139_recv;
+               dev->mcast = rtl8139_bcast_addr;
+
+               rtl8139_get_hwaddr(priv);
+
+               /* Non-DM compatibility */
+               memcpy(priv->dev.enetaddr, priv->enetaddr, 6);
+
+               eth_register(dev);
+
+               card_number++;
+
+               pci_write_config_byte(devno, PCI_LATENCY_TIMER, 0x20);
+
+               udelay(10 * 1000);
        }
+
+       return card_number;
 }
+#else /* DM_ETH */
+static int rtl8139_start(struct udevice *dev)
+{
+       struct eth_pdata *plat = dev_get_platdata(dev);
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+
+       memcpy(priv->enetaddr, plat->enetaddr, sizeof(plat->enetaddr));
+
+       return rtl8139_init_common(priv);
+}
+
+static void rtl8139_stop(struct udevice *dev)
+{
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+
+       rtl8139_stop_common(priv);
+}
+
+static int rtl8139_send(struct udevice *dev, void *packet, int length)
+{
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+       int ret;
+
+       ret = rtl8139_send_common(priv, packet, length);
+
+       return ret ? 0 : -ETIMEDOUT;
+}
+
+static int rtl8139_recv(struct udevice *dev, int flags, uchar **packetp)
+{
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+       static unsigned char rxdata[RX_BUF_LEN];
+
+       return rtl8139_recv_common(priv, rxdata, packetp);
+}
+
+static int rtl8139_free_pkt(struct udevice *dev, uchar *packet, int length)
+{
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+
+       rtl8139_free_pkt_common(priv, length);
+
+       return 0;
+}
+
+static int rtl8139_write_hwaddr(struct udevice *dev)
+{
+       struct eth_pdata *plat = dev_get_platdata(dev);
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+
+       memcpy(priv->enetaddr, plat->enetaddr, sizeof(plat->enetaddr));
+
+       rtl8139_reset(priv);
+
+       return 0;
+}
+
+static int rtl8139_read_rom_hwaddr(struct udevice *dev)
+{
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+
+       rtl8139_get_hwaddr(priv);
+
+       return 0;
+}
+
+static int rtl8139_bind(struct udevice *dev)
+{
+       static int card_number;
+       char name[16];
+
+       rtl8139_name(name, card_number++);
+
+       return device_set_name(dev, name);
+}
+
+static int rtl8139_probe(struct udevice *dev)
+{
+       struct eth_pdata *plat = dev_get_platdata(dev);
+       struct rtl8139_priv *priv = dev_get_priv(dev);
+       u32 iobase;
+
+       dm_pci_read_config32(dev, PCI_BASE_ADDRESS_1, &iobase);
+       iobase &= ~0xf;
+
+       debug("rtl8139: REALTEK RTL8139 @0x%x\n", iobase);
+
+       priv->devno = dev;
+       priv->ioaddr = (unsigned long)bus_to_phys(dev, iobase);
+
+       rtl8139_get_hwaddr(priv);
+       memcpy(plat->enetaddr, priv->enetaddr, sizeof(priv->enetaddr));
+
+       dm_pci_write_config8(dev, PCI_LATENCY_TIMER, 0x20);
+
+       return 0;
+}
+
+static const struct eth_ops rtl8139_ops = {
+       .start          = rtl8139_start,
+       .send           = rtl8139_send,
+       .recv           = rtl8139_recv,
+       .stop           = rtl8139_stop,
+       .free_pkt       = rtl8139_free_pkt,
+       .write_hwaddr   = rtl8139_write_hwaddr,
+       .read_rom_hwaddr = rtl8139_read_rom_hwaddr,
+};
+
+U_BOOT_DRIVER(eth_rtl8139) = {
+       .name   = "eth_rtl8139",
+       .id     = UCLASS_ETH,
+       .bind   = rtl8139_bind,
+       .probe  = rtl8139_probe,
+       .ops    = &rtl8139_ops,
+       .priv_auto_alloc_size = sizeof(struct rtl8139_priv),
+       .platdata_auto_alloc_size = sizeof(struct eth_pdata),
+};
+
+U_BOOT_PCI_DEVICE(eth_rtl8139, supported);
+#endif