[U-Boot] [PATCH V2 5/5] dm9000: rework dm9000 to support multiple devices
Joe Hershberger
joe.hershberger at gmail.com
Wed Aug 12 21:07:44 CEST 2015
Hi Andrew,
On Wed, Aug 12, 2015 at 12:24 PM, Andrew Ruder
<andrew.ruder at elecsyscorp.com> wrote:
> The DM9000 was hard-coded to only support one DM9000 device. This patch
> changes the initialization function - dm9000_initialize - to support
> registering multiple (and possibly dynamic) numbers of dm9000 devices.
> This patch consists of:
>
> * Change the board_info struct to a private struct under eth_device.
> * Add io address/data address/srom availability information to this
> private struct.
> * Replace all uses of DM9000_IO/DM9000_DATA with new members, ensure
> that the eth_device struct propagates down to all helper functions.
> * Call dm9000_initialize_ex() with filled in information from the old
> preprocessor symbols (DM9000_IO,
> DM9000_DATA, etc.)
>
> Overall the following parameters have been moved over to being a
> per-chip setting:
>
> DM9000_IO, DM9000_DATA, CONFIG_DM9000_NO_SROM
>
> while the following is still a global setting affecting all chips:
>
> CONFIG_DM9000_BYTE_SWAPPED
>
> And the following has been removed entirely:
>
> CONFIG_DM9000_BASE (was only used in a single printf)
>
> Signed-off-by: Andrew Ruder <andrew.ruder at elecsyscorp.com>
> Cc: Joe Hershberger <joe.hershberger at gmail.com>
> ---
> drivers/net/dm9000x.c | 382 +++++++++++++++++++++++++++++---------------------
> include/dm9000.h | 2 -
> 2 files changed, 220 insertions(+), 164 deletions(-)
>
> diff --git a/drivers/net/dm9000x.c b/drivers/net/dm9000x.c
> index 9778ef9..d0ea5d7 100644
> --- a/drivers/net/dm9000x.c
> +++ b/drivers/net/dm9000x.c
> @@ -55,6 +55,7 @@ TODO: external MII is not functional, only internal at the moment.
> #include <asm/io.h>
> #include <dm9000.h>
> #include <linux/compiler.h>
> +#include <malloc.h>
>
> #include "dm9000x.h"
>
> @@ -80,7 +81,9 @@ TODO: external MII is not functional, only internal at the moment.
> #endif
>
> /* Structure/enum declaration ------------------------------- */
> -typedef struct board_info {
> +struct dm9000_priv {
> + ulong data_base;
> + ulong io_base;
> u32 runt_length_counter; /* counter: RX length < 64byte */
> u32 long_length_counter; /* counter: RX length > 1514byte */
> u32 reset_counter; /* counter: RESET */
> @@ -89,23 +92,22 @@ typedef struct board_info {
> u16 tx_pkt_cnt;
> u16 queue_start_addr;
> u16 dbug_cnt;
> + u8 has_srom;
> u8 phy_addr;
> u8 device_wait_reset; /* device state */
> unsigned char srom[128];
> - void (*outblk)(void *data_ptr, int count);
> - void (*inblk)(void *data_ptr, int count);
> - void (*rx_status)(u16 *rx_status, u16 *rx_len);
> - struct eth_device netdev;
> -} board_info_t;
> -static board_info_t dm9000_info;
> + void (*outblk)(struct eth_device *dev, void *data_ptr, int count);
> + void (*inblk)(struct eth_device *dev, void *data_ptr, int count);
> + void (*rx_status)(struct eth_device *dev, u16 *rx_status, u16 *rx_len);
It will be much better to pass the priv ptr to all the functions
instead of eth_device. It appears that every place you added it you
simply dereference dev->priv. For the cases where you actually need a
member of eth_device you should pas that as a separate parameter
pointer.
The reason for this is the eth_device structure is going away. In the
driver model implementation everything is a udevice pointer. You still
have your priv inside there, so that's the thing to pass around. It
will make far less churn when adding driver model support to DM9000.
> +};
>
>
> /* function declaration ------------------------------------- */
> -static int dm9000_probe(void);
> -static u16 dm9000_phy_read(int);
> -static void dm9000_phy_write(int, u16);
> -static u8 DM9000_ior(int);
> -static void DM9000_iow(int reg, u8 value);
> +static int dm9000_probe(struct eth_device *);
> +static u16 dm9000_phy_read(struct eth_device *, int);
> +static void dm9000_phy_write(struct eth_device *, int, u16);
> +static u8 DM9000_ior(struct eth_device *, int);
> +static void DM9000_iow(struct eth_device *, int reg, u8 value);
Please include the parameter names in the prototypes.
>
> /* DM9000 network board routine ---------------------------- */
> #ifndef CONFIG_DM9000_BYTE_SWAPPED
> @@ -126,125 +128,147 @@ static void DM9000_iow(int reg, u8 value);
>
> #ifdef CONFIG_DM9000_DEBUG
> static __maybe_unused void
> -dump_regs(void)
> +dump_regs(struct eth_device *dev)
> {
> DM9000_DBG("\n");
> - DM9000_DBG("NCR (0x00): %02x\n", DM9000_ior(0));
> - DM9000_DBG("NSR (0x01): %02x\n", DM9000_ior(1));
> - DM9000_DBG("TCR (0x02): %02x\n", DM9000_ior(2));
> - DM9000_DBG("TSRI (0x03): %02x\n", DM9000_ior(3));
> - DM9000_DBG("TSRII (0x04): %02x\n", DM9000_ior(4));
> - DM9000_DBG("RCR (0x05): %02x\n", DM9000_ior(5));
> - DM9000_DBG("RSR (0x06): %02x\n", DM9000_ior(6));
> - DM9000_DBG("ISR (0xFE): %02x\n", DM9000_ior(DM9000_ISR));
> + DM9000_DBG("NCR (0x00): %02x\n", DM9000_ior(dev, 0));
> + DM9000_DBG("NSR (0x01): %02x\n", DM9000_ior(dev, 1));
> + DM9000_DBG("TCR (0x02): %02x\n", DM9000_ior(dev, 2));
> + DM9000_DBG("TSRI (0x03): %02x\n", DM9000_ior(dev, 3));
> + DM9000_DBG("TSRII (0x04): %02x\n", DM9000_ior(dev, 4));
> + DM9000_DBG("RCR (0x05): %02x\n", DM9000_ior(dev, 5));
> + DM9000_DBG("RSR (0x06): %02x\n", DM9000_ior(dev, 6));
> + DM9000_DBG("ISR (0xFE): %02x\n", DM9000_ior(dev, DM9000_ISR));
> DM9000_DBG("\n");
> }
> #endif
>
> -static void dm9000_outblk_8bit(void *data_ptr, int count)
> +static void
> +dm9000_outblk_8bit(struct eth_device *dev, void *data_ptr, int count)
> {
> int i;
> + struct dm9000_priv *priv = dev->priv;
> for (i = 0; i < count; i++)
> - DM9000_outb((((u8 *)data_ptr)[i] & 0xff), DM9000_DATA);
> + DM9000_outb((((u8 *)data_ptr)[i] & 0xff), priv->data_base);
> }
>
> -static void dm9000_outblk_16bit(void *data_ptr, int count)
> +static void
> +dm9000_outblk_16bit(struct eth_device *dev, void *data_ptr, int count)
> {
> int i;
> u32 tmplen = (count + 1) / 2;
> + struct dm9000_priv *priv = dev->priv;
>
> for (i = 0; i < tmplen; i++)
> - DM9000_outw(((u16 *)data_ptr)[i], DM9000_DATA);
> + DM9000_outw(((u16 *)data_ptr)[i], priv->data_base);
> }
> -static void dm9000_outblk_32bit(void *data_ptr, int count)
> +static void
> +dm9000_outblk_32bit(struct eth_device *dev, void *data_ptr, int count)
> {
> int i;
> u32 tmplen = (count + 3) / 4;
> + struct dm9000_priv *priv = dev->priv;
>
> for (i = 0; i < tmplen; i++)
> - DM9000_outl(((u32 *)data_ptr)[i], DM9000_DATA);
> + DM9000_outl(((u32 *)data_ptr)[i], priv->data_base);
> }
>
> -static void dm9000_inblk_8bit(void *data_ptr, int count)
> +static void
> +dm9000_inblk_8bit(struct eth_device *dev, void *data_ptr, int count)
> {
> int i;
> + struct dm9000_priv *priv = dev->priv;
> +
> for (i = 0; i < count; i++)
> - ((u8 *)data_ptr)[i] = DM9000_inb(DM9000_DATA);
> + ((u8 *)data_ptr)[i] = DM9000_inb(priv->data_base);
> }
>
> -static void dm9000_inblk_16bit(void *data_ptr, int count)
> +static void
> +dm9000_inblk_16bit(struct eth_device *dev, void *data_ptr, int count)
> {
> int i;
> u32 tmplen = (count + 1) / 2;
> + struct dm9000_priv *priv = dev->priv;
>
> for (i = 0; i < tmplen; i++)
> - ((u16 *)data_ptr)[i] = DM9000_inw(DM9000_DATA);
> + ((u16 *)data_ptr)[i] = DM9000_inw(priv->data_base);
> }
> -static void dm9000_inblk_32bit(void *data_ptr, int count)
> +static void
> +dm9000_inblk_32bit(struct eth_device *dev, void *data_ptr, int count)
> {
> int i;
> u32 tmplen = (count + 3) / 4;
> + struct dm9000_priv *priv = dev->priv;
>
> for (i = 0; i < tmplen; i++)
> - ((u32 *)data_ptr)[i] = DM9000_inl(DM9000_DATA);
> + ((u32 *)data_ptr)[i] = DM9000_inl(priv->data_base);
> }
>
> -static void dm9000_rx_status_32bit(u16 *rx_status, u16 *rx_len)
> +static void
> +dm9000_rx_status_32bit(struct eth_device *dev, u16 *rx_status, u16 *rx_len)
> {
> u32 tmpdata;
> + struct dm9000_priv *priv = dev->priv;
>
> - DM9000_outb(DM9000_MRCMD, DM9000_IO);
> + DM9000_outb(DM9000_MRCMD, priv->io_base);
>
> - tmpdata = DM9000_inl(DM9000_DATA);
> + tmpdata = DM9000_inl(priv->data_base);
> *rx_status = __le16_to_cpu(tmpdata);
> *rx_len = __le16_to_cpu(tmpdata >> 16);
> }
>
> -static void dm9000_rx_status_16bit(u16 *rx_status, u16 *rx_len)
> +static void
> +dm9000_rx_status_16bit(struct eth_device *dev, u16 *rx_status, u16 *rx_len)
> {
> - DM9000_outb(DM9000_MRCMD, DM9000_IO);
> + struct dm9000_priv *priv = dev->priv;
>
> - *rx_status = __le16_to_cpu(DM9000_inw(DM9000_DATA));
> - *rx_len = __le16_to_cpu(DM9000_inw(DM9000_DATA));
> + DM9000_outb(DM9000_MRCMD, priv->io_base);
> +
> + *rx_status = __le16_to_cpu(DM9000_inw(priv->data_base));
> + *rx_len = __le16_to_cpu(DM9000_inw(priv->data_base));
> }
>
> -static void dm9000_rx_status_8bit(u16 *rx_status, u16 *rx_len)
> +static void
> +dm9000_rx_status_8bit(struct eth_device *dev, u16 *rx_status, u16 *rx_len)
> {
> - DM9000_outb(DM9000_MRCMD, DM9000_IO);
> + struct dm9000_priv *priv = dev->priv;
> +
> + DM9000_outb(DM9000_MRCMD, priv->io_base);
>
> *rx_status =
> - __le16_to_cpu(DM9000_inb(DM9000_DATA) +
> - (DM9000_inb(DM9000_DATA) << 8));
> + __le16_to_cpu(DM9000_inb(priv->data_base) +
> + (DM9000_inb(priv->data_base) << 8));
> *rx_len =
> - __le16_to_cpu(DM9000_inb(DM9000_DATA) +
> - (DM9000_inb(DM9000_DATA) << 8));
> + __le16_to_cpu(DM9000_inb(priv->data_base) +
> + (DM9000_inb(priv->data_base) << 8));
> }
>
> /*
> Search DM9000 board, allocate space and register it
> */
> int
> -dm9000_probe(void)
> +dm9000_probe(struct eth_device *dev)
> {
> + struct dm9000_priv *priv = dev->priv;
> u32 id_val;
> - id_val = DM9000_ior(DM9000_VIDL);
> - id_val |= DM9000_ior(DM9000_VIDH) << 8;
> - id_val |= DM9000_ior(DM9000_PIDL) << 16;
> - id_val |= DM9000_ior(DM9000_PIDH) << 24;
> + id_val = DM9000_ior(dev, DM9000_VIDL);
> + id_val |= DM9000_ior(dev, DM9000_VIDH) << 8;
> + id_val |= DM9000_ior(dev, DM9000_PIDL) << 16;
> + id_val |= DM9000_ior(dev, DM9000_PIDH) << 24;
> if (id_val == DM9000_ID) {
> - printf("dm9000 i/o: 0x%x, id: 0x%x\n", CONFIG_DM9000_BASE,
> + printf("dm9000 i/o: 0x%lx, id: 0x%x\n", priv->io_base,
> id_val);
> return 0;
> } else {
> - printf("dm9000 not found at 0x%08x id: 0x%08x\n",
> - CONFIG_DM9000_BASE, id_val);
> + printf("dm9000 not found at 0x%08lx id: 0x%08x\n",
> + priv->io_base, id_val);
> return -1;
> }
> }
>
> /* General Purpose dm9000 reset routine */
> static void
> -dm9000_reset(void)
> +dm9000_reset(struct eth_device *dev)
> {
> DM9000_DBG("resetting DM9000\n");
>
> @@ -252,29 +276,29 @@ dm9000_reset(void)
> see DM9000 Application Notes V1.22 Jun 11, 2004 page 29 */
>
> /* DEBUG: Make all GPIO0 outputs, all others inputs */
> - DM9000_iow(DM9000_GPCR, GPCR_GPIO0_OUT);
> + DM9000_iow(dev, DM9000_GPCR, GPCR_GPIO0_OUT);
> /* Step 1: Power internal PHY by writing 0 to GPIO0 pin */
> - DM9000_iow(DM9000_GPR, 0);
> + DM9000_iow(dev, DM9000_GPR, 0);
> /* Step 2: Software reset */
> - DM9000_iow(DM9000_NCR, (NCR_LBK_INT_MAC | NCR_RST));
> + DM9000_iow(dev, DM9000_NCR, (NCR_LBK_INT_MAC | NCR_RST));
>
> do {
> DM9000_DBG("resetting the DM9000, 1st reset\n");
> udelay(25); /* Wait at least 20 us */
> - } while (DM9000_ior(DM9000_NCR) & 1);
> + } while (DM9000_ior(dev, DM9000_NCR) & 1);
>
> - DM9000_iow(DM9000_NCR, 0);
> + DM9000_iow(dev, DM9000_NCR, 0);
> /* Issue a second reset */
> - DM9000_iow(DM9000_NCR, (NCR_LBK_INT_MAC | NCR_RST));
> + DM9000_iow(dev, DM9000_NCR, (NCR_LBK_INT_MAC | NCR_RST));
>
> do {
> DM9000_DBG("resetting the DM9000, 2nd reset\n");
> udelay(25); /* Wait at least 20 us */
> - } while (DM9000_ior(DM9000_NCR) & 1);
> + } while (DM9000_ior(dev, DM9000_NCR) & 1);
>
> /* Check whether the ethernet controller is present */
> - if ((DM9000_ior(DM9000_PIDL) != 0x0) ||
> - (DM9000_ior(DM9000_PIDH) != 0x90))
> + if ((DM9000_ior(dev, DM9000_PIDL) != 0x0) ||
> + (DM9000_ior(dev, DM9000_PIDH) != 0x90))
> printf("ERROR: resetting DM9000 -> not responding\n");
> }
>
> @@ -284,63 +308,63 @@ static int dm9000_init(struct eth_device *dev, bd_t *bd)
> {
> int i, oft, lnk;
> u8 io_mode;
> - struct board_info *db = &dm9000_info;
> + struct dm9000_priv *priv = dev->priv;
>
> DM9000_DBG("%s\n", __func__);
>
> /* RESET device */
> - dm9000_reset();
> + dm9000_reset(dev);
>
> - if (dm9000_probe() < 0)
> + if (dm9000_probe(dev) < 0)
> return -1;
>
> /* Auto-detect 8/16/32 bit mode, ISR Bit 6+7 indicate bus width */
> - io_mode = DM9000_ior(DM9000_ISR) >> 6;
> + io_mode = DM9000_ior(dev, DM9000_ISR) >> 6;
>
> switch (io_mode) {
> case 0x0: /* 16-bit mode */
> printf("DM9000: running in 16 bit mode\n");
> - db->outblk = dm9000_outblk_16bit;
> - db->inblk = dm9000_inblk_16bit;
> - db->rx_status = dm9000_rx_status_16bit;
> + priv->outblk = dm9000_outblk_16bit;
> + priv->inblk = dm9000_inblk_16bit;
> + priv->rx_status = dm9000_rx_status_16bit;
> break;
> case 0x01: /* 32-bit mode */
> printf("DM9000: running in 32 bit mode\n");
> - db->outblk = dm9000_outblk_32bit;
> - db->inblk = dm9000_inblk_32bit;
> - db->rx_status = dm9000_rx_status_32bit;
> + priv->outblk = dm9000_outblk_32bit;
> + priv->inblk = dm9000_inblk_32bit;
> + priv->rx_status = dm9000_rx_status_32bit;
> break;
> case 0x02: /* 8 bit mode */
> printf("DM9000: running in 8 bit mode\n");
> - db->outblk = dm9000_outblk_8bit;
> - db->inblk = dm9000_inblk_8bit;
> - db->rx_status = dm9000_rx_status_8bit;
> + priv->outblk = dm9000_outblk_8bit;
> + priv->inblk = dm9000_inblk_8bit;
> + priv->rx_status = dm9000_rx_status_8bit;
> break;
> default:
> /* Assume 8 bit mode, will probably not work anyway */
> printf("DM9000: Undefined IO-mode:0x%x\n", io_mode);
> - db->outblk = dm9000_outblk_8bit;
> - db->inblk = dm9000_inblk_8bit;
> - db->rx_status = dm9000_rx_status_8bit;
> + priv->outblk = dm9000_outblk_8bit;
> + priv->inblk = dm9000_inblk_8bit;
> + priv->rx_status = dm9000_rx_status_8bit;
> break;
> }
>
> /* Program operating register, only internal phy supported */
> - DM9000_iow(DM9000_NCR, 0x0);
> + DM9000_iow(dev, DM9000_NCR, 0x0);
> /* TX Polling clear */
> - DM9000_iow(DM9000_TCR, 0);
> + DM9000_iow(dev, DM9000_TCR, 0);
> /* Less 3Kb, 200us */
> - DM9000_iow(DM9000_BPTR, BPTR_BPHW(3) | BPTR_JPT_600US);
> + DM9000_iow(dev, DM9000_BPTR, BPTR_BPHW(3) | BPTR_JPT_600US);
> /* Flow Control : High/Low Water */
> - DM9000_iow(DM9000_FCTR, FCTR_HWOT(3) | FCTR_LWOT(8));
> + DM9000_iow(dev, DM9000_FCTR, FCTR_HWOT(3) | FCTR_LWOT(8));
> /* SH FIXME: This looks strange! Flow Control */
> - DM9000_iow(DM9000_FCR, 0x0);
> + DM9000_iow(dev, DM9000_FCR, 0x0);
> /* Special Mode */
> - DM9000_iow(DM9000_SMCR, 0);
> + DM9000_iow(dev, DM9000_SMCR, 0);
> /* clear TX status */
> - DM9000_iow(DM9000_NSR, NSR_WAKEST | NSR_TX2END | NSR_TX1END);
> + DM9000_iow(dev, DM9000_NSR, NSR_WAKEST | NSR_TX2END | NSR_TX1END);
> /* Clear interrupt status */
> - DM9000_iow(DM9000_ISR, ISR_ROOS | ISR_ROS | ISR_PTS | ISR_PRS);
> + DM9000_iow(dev, DM9000_ISR, ISR_ROOS | ISR_ROS | ISR_PTS | ISR_PRS);
>
> printf("MAC: %pM\n", dev->enetaddr);
> if (!is_valid_ethaddr(dev->enetaddr)) {
> @@ -349,23 +373,24 @@ static int dm9000_init(struct eth_device *dev, bd_t *bd)
>
> /* fill device MAC address registers */
> for (i = 0, oft = DM9000_PAR; i < 6; i++, oft++)
> - DM9000_iow(oft, dev->enetaddr[i]);
> + DM9000_iow(dev, oft, dev->enetaddr[i]);
> for (i = 0, oft = 0x16; i < 8; i++, oft++)
> - DM9000_iow(oft, 0xff);
> + DM9000_iow(dev, oft, 0xff);
>
> /* read back mac, just to be sure */
> for (i = 0, oft = 0x10; i < 6; i++, oft++)
> - DM9000_DBG("%02x:", DM9000_ior(oft));
> + DM9000_DBG("%02x:", DM9000_ior(dev, oft));
> DM9000_DBG("\n");
All this MAC address handling should be implemented in the
write_hwaddr() op in the eth_device structure. If you feel like adding
a patch to the end of this series to move it that would be great!
You may also want to move the reset to the _initialize() function
instead of the init() op. I assume that resetting will clear the
ethaddr that's configured. If you decide to leave the reset in the
init() op, you'll need to call the new write_hwaddr() op yourself here
as well as register it. Hopefully this will all get better when the
network stack is smarter and doesn't call the init() op for each
command.
>
> /* Activate DM9000 */
> /* RX enable */
> - DM9000_iow(DM9000_RCR, RCR_DIS_LONG | RCR_DIS_CRC | RCR_RXEN);
> + DM9000_iow(dev, DM9000_RCR, RCR_DIS_LONG | RCR_DIS_CRC | RCR_RXEN);
> /* Enable TX/RX interrupt mask */
> - DM9000_iow(DM9000_IMR, IMR_PAR);
> + DM9000_iow(dev, DM9000_IMR, IMR_PAR);
>
> i = 0;
> - while (!(dm9000_phy_read(1) & 0x20)) { /* autonegation complete bit */
> + while (!(dm9000_phy_read(dev, 1) & 0x20)) {
> + /* autonegation complete bit */
> udelay(1000);
> i++;
> if (i == 10000) {
> @@ -375,7 +400,7 @@ static int dm9000_init(struct eth_device *dev, bd_t *bd)
> }
>
> /* see what we've got */
> - lnk = dm9000_phy_read(17) >> 12;
> + lnk = dm9000_phy_read(dev, 17) >> 12;
> printf("operating at ");
> switch (lnk) {
> case 1:
> @@ -402,38 +427,38 @@ static int dm9000_init(struct eth_device *dev, bd_t *bd)
> Hardware start transmission.
> Send a packet to media from the upper layer.
> */
> -static int dm9000_send(struct eth_device *netdev, void *packet, int length)
> +static int dm9000_send(struct eth_device *dev, void *packet, int length)
> {
> int tmo;
> - struct board_info *db = &dm9000_info;
> + struct dm9000_priv *priv = dev->priv;
>
> DM9000_DMP_PACKET(__func__ , packet, length);
>
> - DM9000_iow(DM9000_ISR, IMR_PTM); /* Clear Tx bit in ISR */
> + DM9000_iow(dev, DM9000_ISR, IMR_PTM); /* Clear Tx bit in ISR */
>
> /* Move data to DM9000 TX RAM */
> - DM9000_outb(DM9000_MWCMD, DM9000_IO); /* Prepare for TX-data */
> + DM9000_outb(DM9000_MWCMD, priv->io_base); /* Prepare for TX-data */
>
> /* push the data to the TX-fifo */
> - (db->outblk)(packet, length);
> + (priv->outblk)(dev, packet, length);
>
> /* Set TX length to DM9000 */
> - DM9000_iow(DM9000_TXPLL, length & 0xff);
> - DM9000_iow(DM9000_TXPLH, (length >> 8) & 0xff);
> + DM9000_iow(dev, DM9000_TXPLL, length & 0xff);
> + DM9000_iow(dev, DM9000_TXPLH, (length >> 8) & 0xff);
>
> /* Issue TX polling command */
> - DM9000_iow(DM9000_TCR, TCR_TXREQ); /* Cleared after TX complete */
> + DM9000_iow(dev, DM9000_TCR, TCR_TXREQ); /* Cleared after TX complete */
>
> /* wait for end of transmission */
> tmo = get_timer(0) + 5 * CONFIG_SYS_HZ;
> - while (!(DM9000_ior(DM9000_NSR) & (NSR_TX1END | NSR_TX2END)) ||
> - !(DM9000_ior(DM9000_ISR) & IMR_PTM)) {
> + while (!(DM9000_ior(dev, DM9000_NSR) & (NSR_TX1END | NSR_TX2END)) ||
> + !(DM9000_ior(dev, DM9000_ISR) & IMR_PTM)) {
> if (get_timer(0) >= tmo) {
> printf("transmission timeout\n");
> break;
> }
> }
> - DM9000_iow(DM9000_ISR, IMR_PTM); /* Clear Tx bit in ISR */
> + DM9000_iow(dev, DM9000_ISR, IMR_PTM); /* Clear Tx bit in ISR */
>
> DM9000_DBG("transmit done\n\n");
> return 0;
> @@ -443,46 +468,49 @@ static int dm9000_send(struct eth_device *netdev, void *packet, int length)
> Stop the interface.
> The interface is stopped when it is brought.
> */
> -static void dm9000_halt(struct eth_device *netdev)
> +static void dm9000_halt(struct eth_device *dev)
> {
> DM9000_DBG("%s\n", __func__);
>
> /* RESET devie */
> - dm9000_phy_write(0, 0x8000); /* PHY RESET */
> - DM9000_iow(DM9000_GPR, 0x01); /* Power-Down PHY */
> - DM9000_iow(DM9000_IMR, 0x80); /* Disable all interrupt */
> - DM9000_iow(DM9000_RCR, 0x00); /* Disable RX */
> + dm9000_phy_write(dev, 0, 0x8000); /* PHY RESET */
> + DM9000_iow(dev, DM9000_GPR, 0x01); /* Power-Down PHY */
> + DM9000_iow(dev, DM9000_IMR, 0x80); /* Disable all interrupt */
> + DM9000_iow(dev, DM9000_RCR, 0x00); /* Disable RX */
> }
>
> /*
> Received a packet and pass to upper layer
> */
> -static int dm9000_rx(struct eth_device *netdev)
> +static int dm9000_rx(struct eth_device *dev)
> {
> u8 rxbyte;
> u8 *rdptr = (u8 *)net_rx_packets[0];
> u16 rx_status, rx_len = 0;
> - struct board_info *db = &dm9000_info;
> + struct dm9000_priv *priv = dev->priv;
>
> /* Check packet ready or not, we must check
> the ISR status first for DM9000A */
> - if (!(DM9000_ior(DM9000_ISR) & 0x01)) /* Rx-ISR bit must be set. */
> + if (!(DM9000_ior(dev, DM9000_ISR) & 0x01)) /* Rx-ISR bit must be set. */
> return 0;
>
> - DM9000_iow(DM9000_ISR, 0x01); /* clear PR status latched in bit 0 */
> + /* clear PR status latched in bit 0 */
> + DM9000_iow(dev, DM9000_ISR, 0x01);
>
> /* There is _at least_ 1 package in the fifo, read them all */
> for (;;) {
> - DM9000_ior(DM9000_MRCMDX); /* Dummy read */
> + DM9000_ior(dev, DM9000_MRCMDX); /* Dummy read */
>
> /* Get most updated data,
> only look at bits 0:1, See application notes DM9000 */
> - rxbyte = DM9000_inb(DM9000_DATA) & 0x03;
> + rxbyte = DM9000_inb(priv->data_base) & 0x03;
>
> /* Status check: this byte must be 0 or 1 */
> if (rxbyte > DM9000_PKT_RDY) {
> - DM9000_iow(DM9000_RCR, 0x00); /* Stop Device */
> - DM9000_iow(DM9000_ISR, 0x80); /* Stop INT request */
> + /* Stop Device */
> + DM9000_iow(dev, DM9000_RCR, 0x00);
> + /* Stop INT request */
> + DM9000_iow(dev, DM9000_ISR, 0x80);
> printf("DM9000 error: status check fail: 0x%x\n",
> rxbyte);
> return 0;
> @@ -494,13 +522,13 @@ static int dm9000_rx(struct eth_device *netdev)
> DM9000_DBG("receiving packet\n");
>
> /* A packet ready now & Get status/length */
> - (db->rx_status)(&rx_status, &rx_len);
> + (priv->rx_status)(dev, &rx_status, &rx_len);
>
> DM9000_DBG("rx status: 0x%04x rx len: %d\n", rx_status, rx_len);
>
> /* Move data from DM9000 */
> /* Read received packet from RX SRAM */
> - (db->inblk)(rdptr, rx_len);
> + (priv->inblk)(dev, rdptr, rx_len);
>
> if ((rx_status & 0xbf00) || (rx_len < 0x40) ||
> (rx_len > DM9000_PKT_MAX)) {
> @@ -512,7 +540,7 @@ static int dm9000_rx(struct eth_device *netdev)
> printf("rx length error\n");
> if (rx_len > DM9000_PKT_MAX) {
> printf("rx length too big\n");
> - dm9000_reset();
> + dm9000_reset(dev);
> }
> } else {
> DM9000_DMP_PACKET(__func__ , rdptr, rx_len);
> @@ -530,68 +558,77 @@ static int dm9000_rx(struct eth_device *netdev)
> #if !defined(CONFIG_DM9000_NO_SROM)
> void dm9000_read_srom_word(struct eth_device *dev, int offset, u8 *to)
> {
> - DM9000_iow(DM9000_EPAR, offset);
> - DM9000_iow(DM9000_EPCR, 0x4);
> + DM9000_iow(dev, DM9000_EPAR, offset);
> + DM9000_iow(dev, DM9000_EPCR, 0x4);
> udelay(8000);
> - DM9000_iow(DM9000_EPCR, 0x0);
> - to[0] = DM9000_ior(DM9000_EPDRL);
> - to[1] = DM9000_ior(DM9000_EPDRH);
> + DM9000_iow(dev, DM9000_EPCR, 0x0);
> + to[0] = DM9000_ior(dev, DM9000_EPDRL);
> + to[1] = DM9000_ior(dev, DM9000_EPDRH);
> }
>
> void dm9000_write_srom_word(struct eth_device *dev, int offset, u16 val)
> {
> - DM9000_iow(DM9000_EPAR, offset);
> - DM9000_iow(DM9000_EPDRH, ((val >> 8) & 0xff));
> - DM9000_iow(DM9000_EPDRL, (val & 0xff));
> - DM9000_iow(DM9000_EPCR, 0x12);
> + DM9000_iow(dev, DM9000_EPAR, offset);
> + DM9000_iow(dev, DM9000_EPDRH, ((val >> 8) & 0xff));
> + DM9000_iow(dev, DM9000_EPDRL, (val & 0xff));
> + DM9000_iow(dev, DM9000_EPCR, 0x12);
> udelay(8000);
> - DM9000_iow(DM9000_EPCR, 0);
> + DM9000_iow(dev, DM9000_EPCR, 0);
> }
> #endif
>
> static void dm9000_get_enetaddr(struct eth_device *dev)
> {
This is an example where you can pass in a pointer to the enetaddr
member of the eth_device.
> -#if !defined(CONFIG_DM9000_NO_SROM)
> - int i;
> - for (i = 0; i < 3; i++)
> - dm9000_read_srom_word(dev, i, dev->enetaddr + (2 * i));
> -#endif
> + struct dm9000_priv *priv = dev->priv;
Don't forget to add a blank line between variable definitions and other code.
> + if (priv->has_srom) {
> + int i;
Same here.
> + for (i = 0; i < 3; i++)
> + dm9000_read_srom_word(dev, i, dev->enetaddr + (2 * i));
> + }
> }
>
> /*
> Read a byte from I/O port
> */
> static u8
> -DM9000_ior(int reg)
> +DM9000_ior(struct eth_device *dev, int reg)
> {
> - DM9000_outb(reg, DM9000_IO);
> - return DM9000_inb(DM9000_DATA);
> + struct dm9000_priv *priv = dev->priv;
> +
> + DM9000_outb(reg, priv->io_base);
> + return DM9000_inb(priv->data_base);
> }
>
> /*
> Write a byte to I/O port
> */
> static void
> -DM9000_iow(int reg, u8 value)
> +DM9000_iow(struct eth_device *dev, int reg, u8 value)
> {
> - DM9000_outb(reg, DM9000_IO);
> - DM9000_outb(value, DM9000_DATA);
> + struct dm9000_priv *priv = dev->priv;
> +
> + DM9000_outb(reg, priv->io_base);
> + DM9000_outb(value, priv->data_base);
> }
>
> /*
> Read a word from phyxcer
> */
> static u16
> -dm9000_phy_read(int reg)
> +dm9000_phy_read(struct eth_device *dev, int reg)
> {
> u16 val;
>
> /* Fill the phyxcer register into REG_0C */
> - DM9000_iow(DM9000_EPAR, DM9000_PHY | reg);
> - DM9000_iow(DM9000_EPCR, 0xc); /* Issue phyxcer read command */
> - udelay(100); /* Wait read complete */
> - DM9000_iow(DM9000_EPCR, 0x0); /* Clear phyxcer read command */
> - val = (DM9000_ior(DM9000_EPDRH) << 8) | DM9000_ior(DM9000_EPDRL);
> + DM9000_iow(dev, DM9000_EPAR, DM9000_PHY | reg);
> + /* Issue phyxcer read command */
> + DM9000_iow(dev, DM9000_EPCR, 0xc);
> + /* Wait read complete */
> + udelay(100);
> + /* Clear phyxcer read command */
> + DM9000_iow(dev, DM9000_EPCR, 0x0);
> + val = (DM9000_ior(dev, DM9000_EPDRH) << 8) |
> + DM9000_ior(dev, DM9000_EPDRL);
>
> /* The read data keeps on REG_0D & REG_0E */
> DM9000_DBG("dm9000_phy_read(0x%x): 0x%x\n", reg, val);
> @@ -602,34 +639,55 @@ dm9000_phy_read(int reg)
> Write a word to phyxcer
> */
> static void
> -dm9000_phy_write(int reg, u16 value)
> +dm9000_phy_write(struct eth_device *dev, int reg, u16 value)
> {
> /* Fill the phyxcer register into REG_0C */
> - DM9000_iow(DM9000_EPAR, DM9000_PHY | reg);
> + DM9000_iow(dev, DM9000_EPAR, DM9000_PHY | reg);
>
> /* Fill the written data into REG_0D & REG_0E */
> - DM9000_iow(DM9000_EPDRL, (value & 0xff));
> - DM9000_iow(DM9000_EPDRH, ((value >> 8) & 0xff));
> - DM9000_iow(DM9000_EPCR, 0xa); /* Issue phyxcer write command */
> - udelay(500); /* Wait write complete */
> - DM9000_iow(DM9000_EPCR, 0x0); /* Clear phyxcer write command */
> + DM9000_iow(dev, DM9000_EPDRL, (value & 0xff));
> + DM9000_iow(dev, DM9000_EPDRH, ((value >> 8) & 0xff));
> + /* Issue phyxcer write command */
> + DM9000_iow(dev, DM9000_EPCR, 0xa);
> + /* Wait write complete */
> + udelay(500);
> + /* Clear phyxcer write command */
> + DM9000_iow(dev, DM9000_EPCR, 0x0);
> DM9000_DBG("dm9000_phy_write(reg:0x%x, value:0x%x)\n", reg, value);
> }
>
> int dm9000_initialize(u8 dev_num, ulong addr, ulong data, u8 has_srom)
> {
If only priv is passed around, then most likely this is the only
function that needs to change to support driver model.
> - struct eth_device *dev = &(dm9000_info.netdev);
> + struct eth_device *dev;
> + struct dm9000_priv *priv;
> +
> + priv = malloc(sizeof(*priv));
> + if (!priv)
> + return 1;
> + dev = malloc(sizeof(*dev));
> + if (!dev) {
> + free(priv);
> + return 2;
> + }
>
> - /* Load MAC address from EEPROM */
> - dm9000_get_enetaddr(dev);
> + memset(dev, 0, sizeof(*dev));
> + memset(priv, 0, sizeof(*priv));
>
> + priv->io_base = addr;
> + priv->data_base = data;
> + priv->has_srom = has_srom;
> + dev->priv = priv;
> dev->init = dm9000_init;
> dev->halt = dm9000_halt;
> dev->send = dm9000_send;
> dev->recv = dm9000_rx;
> - sprintf(dev->name, "dm9000");
> + if (dev_num > 0)
> + sprintf(dev->name, "dm9000-%hu", dev_num);
> + else
> + sprintf(dev->name, "dm9000");
>
> - eth_register(dev);
> + /* Load MAC address from EEPROM */
> + dm9000_get_enetaddr(dev);
>
> - return 0;
> + return eth_register(dev);
> }
> diff --git a/include/dm9000.h b/include/dm9000.h
> index 7a7e629..c3c13ce 100644
> --- a/include/dm9000.h
> +++ b/include/dm9000.h
> @@ -9,11 +9,9 @@
> #define __DM9000_H__
>
> /****************** function prototypes **********************/
> -#if !defined(CONFIG_DM9000_NO_SROM)
> struct eth_device;
>
> void dm9000_write_srom_word(struct eth_device *dev, int offset, u16 val);
> void dm9000_read_srom_word(struct eth_device *dev, int offset, u8 *to);
> -#endif
>
> #endif /* __DM9000_H__ */
> --
> 2.1.4
>
More information about the U-Boot
mailing list