diff mbox

[U-Boot,v2,1/2] TI: netdev: add driver for cpsw ethernet device

Message ID 1320928830-16221-2-git-send-email-chandan.nath@ti.com
State Changes Requested
Headers show

Commit Message

Chandan Nath Nov. 10, 2011, 12:40 p.m. UTC
From: Cyril Chemparathy <cyril@ti.com>

CPSW is an on-chip ethernet switch that is found on various SoCs from Texas
Instruments.  This patch adds a simple driver (based on the Linux driver) for
this hardware module.

Signed-off-by: Cyril Chemparathy <cyril@ti.com>
---
Changes since v1:
 - Code cleanup and removal of cpsw_eth_set_mac_addr function

 drivers/net/Makefile |    1 +
 drivers/net/cpsw.c   |  862 ++++++++++++++++++++++++++++++++++++++++++++++++++
 include/netdev.h     |   29 ++
 3 files changed, 892 insertions(+), 0 deletions(-)
 create mode 100644 drivers/net/cpsw.c

Comments

Mike Frysinger Nov. 10, 2011, 4:26 p.m. UTC | #1
On Thursday 10 November 2011 07:40:28 Chandan Nath wrote:
> +#define mac_hi(mac)    (((mac)[0] << 0) | ((mac)[1] << 8) |    \
> +                        ((mac)[2] << 16) | ((mac)[3] << 24))

looks like __get_unaligned_u32()

> +#define mac_lo(mac)    (((mac)[4] << 0) | ((mac)[5] << 8))

looks like __get_unaligned_u16()
-mike
Tom Rini Nov. 10, 2011, 4:39 p.m. UTC | #2
On Thu, Nov 10, 2011 at 9:26 AM, Mike Frysinger <vapier@gentoo.org> wrote:
> On Thursday 10 November 2011 07:40:28 Chandan Nath wrote:
>> +#define mac_hi(mac)    (((mac)[0] << 0) | ((mac)[1] << 8) |    \
>> +                        ((mac)[2] << 16) | ((mac)[3] << 24))
>
> looks like __get_unaligned_u32()
>
>> +#define mac_lo(mac)    (((mac)[4] << 0) | ((mac)[5] << 8))
>
> looks like __get_unaligned_u16()

It's the regular MAC shifting around everyone does.  Are you saying
there's a general cleanup to be done here?
Mike Frysinger Nov. 10, 2011, 5:06 p.m. UTC | #3
On Thursday 10 November 2011 11:39:49 Tom Rini wrote:
> On Thu, Nov 10, 2011 at 9:26 AM, Mike Frysinger <vapier@gentoo.org> wrote:
> > On Thursday 10 November 2011 07:40:28 Chandan Nath wrote:
> >> +#define mac_hi(mac)    (((mac)[0] << 0) | ((mac)[1] << 8) |    \
> >> +                        ((mac)[2] << 16) | ((mac)[3] << 24))
> > 
> > looks like __get_unaligned_u32()
> > 
> >> +#define mac_lo(mac)    (((mac)[4] << 0) | ((mac)[5] << 8))
> > 
> > looks like __get_unaligned_u16()
> 
> It's the regular MAC shifting around everyone does.  Are you saying
> there's a general cleanup to be done here?

other drivers probably could benefit from using the unaligned helpers.  but it 
isn't something we could generally unify as it requires assumption on 
core/system endian, and the layout of the registers in the peripheral.
-mike
Andy Fleming Nov. 10, 2011, 10:43 p.m. UTC | #4
On Thu, Nov 10, 2011 at 6:40 AM, Chandan Nath <chandan.nath@ti.com> wrote:
> From: Cyril Chemparathy <cyril@ti.com>
>
> CPSW is an on-chip ethernet switch that is found on various SoCs from Texas
> Instruments.  This patch adds a simple driver (based on the Linux driver) for
> this hardware module.


Which Linux driver is this based on?


>
> Signed-off-by: Cyril Chemparathy <cyril@ti.com>
> ---
> Changes since v1:
>  - Code cleanup and removal of cpsw_eth_set_mac_addr function
>
>  drivers/net/Makefile |    1 +
>  drivers/net/cpsw.c   |  862 ++++++++++++++++++++++++++++++++++++++++++++++++++
>  include/netdev.h     |   29 ++
>  3 files changed, 892 insertions(+), 0 deletions(-)
>  create mode 100644 drivers/net/cpsw.c
>
> +
> +#define BIT(x)                 (1 << (x))
> +#define BITMASK(bits)          (BIT(bits) - 1)
> +#define PHY_REG_MASK           0x1f
> +#define PHY_ID_MASK            0x1f

These 4 defines seem very generic


> +struct cpsw_priv {
> +       struct eth_device               *dev;
> +       struct cpsw_platform_data       data;
> +       int                             host_port;
> +
> +       struct cpsw_regs                *regs;
> +       void                            *dma_regs;
> +       struct cpsw_host_regs           *host_port_regs;
> +       void                            *ale_regs;
> +
> +       struct cpdma_desc               descs[NUM_DESCS];
> +       struct cpdma_desc               *desc_free;
> +       struct cpdma_chan               rx_chan, tx_chan;
> +
> +       struct cpsw_slave               *slaves;
> +#define for_each_slave(priv, func, arg...)                     \
> +       do {                                                    \
> +               int idx;                                        \
> +               for (idx = 0; idx < (priv)->data.slaves; idx++) \
> +                       (func)((priv)->slaves + idx, ##arg);    \
> +       } while (0)
> +};


It seems a bit awkward to me to put a complex macro like this inside
the structure definition. After further review, I think it should also
be defined differently, more like the list macros:

#define for_each_slave(slave, priv) \
        for (slave = (priv)->slaves; slave != (priv)->slaves +
(priv)->data.slaves; slave++)

It makes the code more maintainable, as the macro no longer contains
the implicit assumption that "func" has a slave pointer as its first
argument.


> +
> +static inline int cpsw_ale_get_field(u32 *ale_entry, u32 start, u32 bits)
> +{
> +       int idx;
> +
> +       idx    = start / 32;
> +       start -= idx * 32;
> +       idx    = 2 - idx; /* flip */
> +       return (ale_entry[idx] >> start) & BITMASK(bits);
> +}
> +
> +static inline void cpsw_ale_set_field(u32 *ale_entry, u32 start, u32 bits,
> +                                     u32 value)
> +{
> +       int idx;
> +
> +       value &= BITMASK(bits);
> +       idx    = start / 32;
> +       start -= idx * 32;
> +       idx    = 2 - idx; /* flip */
> +       ale_entry[idx] &= ~(BITMASK(bits) << start);
> +       ale_entry[idx] |=  (value << start);
> +}


These two functions seem both very generic, and also over-worked.


> +
> +#define DEFINE_ALE_FIELD(name, start, bits)                            \
> +static inline int cpsw_ale_get_##name(u32 *ale_entry)                  \
> +{                                                                      \
> +       return cpsw_ale_get_field(ale_entry, start, bits);              \
> +}                                                                      \
> +static inline void cpsw_ale_set_##name(u32 *ale_entry, u32 value)      \
> +{                                                                      \
> +       cpsw_ale_set_field(ale_entry, start, bits, value);              \
> +}
> +
> +DEFINE_ALE_FIELD(entry_type,           60,     2)
> +DEFINE_ALE_FIELD(mcast_state,          62,     2)
> +DEFINE_ALE_FIELD(port_mask,            64,     3)
> +DEFINE_ALE_FIELD(ucast_type,           66,     2)
> +DEFINE_ALE_FIELD(port_num,             64,     2)
> +DEFINE_ALE_FIELD(blocked,              63,     1)
> +DEFINE_ALE_FIELD(secure,               62,     1)
> +DEFINE_ALE_FIELD(mcast,                        47,     1)
> +
> +/* The MAC address field in the ALE entry cannot be macroized as above */
> +static inline void cpsw_ale_get_addr(u32 *ale_entry, u8 *addr)
> +{
> +       int i;
> +
> +       for (i = 0; i < 6; i++)
> +               addr[i] = cpsw_ale_get_field(ale_entry, 40 - 8*i, 8);
> +}
> +
> +static inline void cpsw_ale_set_addr(u32 *ale_entry, u8 *addr)
> +{
> +       int i;
> +
> +       for (i = 0; i < 6; i++)
> +               cpsw_ale_set_field(ale_entry, 40 - 8*i, 8, addr[i]);
> +}
> +
> +static int cpsw_ale_read(struct cpsw_priv *priv, int idx, u32 *ale_entry)
> +{
> +       int i;
> +
> +       __raw_writel(idx, priv->ale_regs + ALE_TABLE_CONTROL);
> +
> +       for (i = 0; i < ALE_ENTRY_WORDS; i++)
> +               ale_entry[i] = __raw_readl(priv->ale_regs + ALE_TABLE + 4 * i);
> +
> +       return idx;
> +}
> +
> +static int cpsw_ale_write(struct cpsw_priv *priv, int idx, u32 *ale_entry)
> +{
> +       int i;
> +
> +       for (i = 0; i < ALE_ENTRY_WORDS; i++)
> +               __raw_writel(ale_entry[i], priv->ale_regs + ALE_TABLE + 4 * i);
> +
> +       __raw_writel(idx | ALE_TABLE_WRITE, priv->ale_regs + ALE_TABLE_CONTROL);
> +
> +       return idx;
> +}


I don't know how your device works, but it seems odd to me to have to
read out a large table, and modify it, and then write it back out.

I'm also highly suspicious of the overworked bitfield math. Are
standard C bitfields not usable for some reason? It borders on code
obfuscation, IMO. I've spent far too much time, already, just trying
to figure out what that code was doing, and why.


> +static inline void cpsw_ale_port_state(struct cpsw_priv *priv, int port,
> +                                      int val)
> +{
> +       int offset = ALE_PORTCTL + 4 * port;
> +       u32 tmp, mask = 0x3;
> +
> +       tmp  = __raw_readl(priv->ale_regs + offset);
> +       tmp &= ~mask;
> +       tmp |= val & 0x3;

All of this can probably be done with more generic setbits functions,
but at least use "mask" consistently for both the clearing and the
masking of "val".

> +       __raw_writel(tmp, priv->ale_regs + offset);
> +}
> +
> +static struct cpsw_mdio_regs *mdio_regs;


Global variables like this shouldn't be necessary. Especially with the
new PHY API



> +
> +static int cpsw_mdio_read(char *devname, unsigned char phy_id,
> +                         unsigned char phy_reg, unsigned short *data)
> +{

This is the legacy interface for PHY interactions. You should look
into using the new "PHYLIB" code.


> +       u32 reg;
> +
> +       if (phy_reg & ~PHY_REG_MASK || phy_id & ~PHY_ID_MASK)
> +               return -EINVAL;
> +
> +       wait_for_user_access();
> +       reg = (USERACCESS_GO | USERACCESS_READ | (phy_reg << 21) |
> +              (phy_id << 16));
> +       __raw_writel(reg, &mdio_regs->user[0].access);
> +       reg = wait_for_user_access();
> +
> +       *data = (reg & USERACCESS_ACK) ? (reg & USERACCESS_DATA) : -1;
> +       return (reg & USERACCESS_ACK) ? 0 : -EIO;
> +}
> +
> +static int cpsw_mdio_write(char *devname, unsigned char phy_id,
> +                          unsigned char phy_reg, unsigned short data)

Same comment as above.


> +static void cpsw_mdio_init(char *name, u32 mdio_base, u32 div)
> +{
> +       mdio_regs = (struct cpsw_mdio_regs *)mdio_base;
> +
> +       /* set enable and clock divider */
> +       __raw_writel(div | CONTROL_ENABLE, &mdio_regs->control);
> +
> +       /*
> +        * wait for scan logic to settle:
> +        * the scan time consists of (a) a large fixed component, and (b) a
> +        * small component that varies with the mii bus frequency.  These
> +        * were estimated using measurements at 1.1 and 2.2 MHz on tnetv107x
> +        * silicon.  Since the effect of (b) was found to be largely
> +        * negligible, we keep things simple here.
> +        */
> +       udelay(1000);

This seems sketchy. Is there no way to *know* the bus is ready, other
than to wait?

> +
> +       miiphy_register(name, cpsw_mdio_read, cpsw_mdio_write);


This is the legacy API.


> +}
> +
> +static inline void soft_reset(void *reg)
> +{
> +       __raw_writel(1, reg);
> +       while (__raw_readl(reg) & 1)
> +               ;
> +}


???

Can reg be *any* reg? Use a better name. Also, name "1" something sensible.

Perhaps a cleaner implementation (which might be usable in other
people's code) would be something like:

/* Set a self-clearing bit in a register, and wait for it to clear */
static inline void setbit_and_wait_for_clear32(void *addr, u32 mask)
{
   __raw_writel(val, addr);
  while (__raw_readl(addr) & val)
    ;
}


> +static void cpsw_slave_update_link(struct cpsw_slave *slave,
> +                                  struct cpsw_priv *priv, int *link)
> +{
> +       char *name = priv->dev->name;
> +       int phy_id = slave->data->phy_id;
> +       int speed, duplex;
> +       unsigned short reg;
> +       u32 mac_control = 0;
> +
> +       if (miiphy_read(name, phy_id, MII_BMSR, &reg))
> +               return; /* could not read, assume no link */


Please use phy_read(), with the new API.


> +
> +       if (reg & BMSR_LSTATUS) { /* link up */
> +               speed = miiphy_speed(name, phy_id);
> +               duplex = miiphy_duplex(name, phy_id);
> +
> +               *link = 1;
> +               mac_control = priv->data.mac_control;
> +               if (speed == 1000)
> +                       mac_control |= BIT(7);  /* GIGABITEN    */
> +               if (duplex == FULL)
> +                       mac_control |= BIT(0);  /* FULLDUPLEXEN */

Why not:
    mac_control |= GIGABITEN;

etc



> +static int cpsw_update_link(struct cpsw_priv *priv)
> +{
> +       int link = 0;
> +       for_each_slave(priv, cpsw_slave_update_link, priv, &link);

As I mentioned, there are a lot of similarly-named macros in Linux and
U-boot. Usually they act exactly like for-loops, where you provide an
iterator, and then use it in each iteration:

struct cpsw_slave *slave;

for_each_slave(slave, priv)
  cpsw_slave_update_link(slave, priv, &link);

I think this is much easier to understand and maintain.

> +       return link;

Also, link looks useless. It will always be the value in the last
slave. Is that what you meant to do?


> +}
> +
> +static void cpsw_slave_init(struct cpsw_slave *slave, struct cpsw_priv *priv)
> +{

[...]

> +
> +       priv->data.phy_init(priv->dev->name, slave->data->phy_id);

What does this do? Probably needs to be converted to the newer API.


> +}
> +
> +static struct cpdma_desc *cpdma_desc_alloc(struct cpsw_priv *priv)
> +{
> +       struct cpdma_desc *desc = priv->desc_free;
> +
> +       if (desc)
> +               priv->desc_free = desc_read_ptr(desc, hw_next);
> +       return desc;
> +}
> +
> +static void cpdma_desc_free(struct cpsw_priv *priv, struct cpdma_desc *desc)
> +{
> +       if (desc) {
> +               desc_write(desc, hw_next, priv->desc_free);
> +               priv->desc_free = desc;
> +       }
> +}
> +
> +static int cpdma_submit(struct cpsw_priv *priv, struct cpdma_chan *chan,
> +                       volatile void *buffer, int len)
> +{
> +       struct cpdma_desc *desc, *prev;
> +       u32 mode;
> +
> +       desc = cpdma_desc_alloc(priv);
> +       if (!desc)
> +               return -ENOMEM;
> +
> +       if (len < PKT_MIN)
> +               len = PKT_MIN;
> +
> +       mode = CPDMA_DESC_OWNER | CPDMA_DESC_SOP | CPDMA_DESC_EOP;
> +
> +       desc_write(desc, hw_next,   0);
> +       desc_write(desc, hw_buffer, buffer);
> +       desc_write(desc, hw_len,    len);
> +       desc_write(desc, hw_mode,   mode | len);
> +       desc_write(desc, sw_buffer, buffer);
> +       desc_write(desc, sw_len,    len);
> +
> +       if (!chan->head) {
> +               /* simple case - first packet enqueued */
> +               chan->head = desc;
> +               chan->tail = desc;
> +               chan_write(chan, hdp, desc);
> +               goto done;
> +       }
> +
> +       /* not the first packet - enqueue at the tail */
> +       prev = chan->tail;
> +       desc_write(prev, hw_next, desc);
> +       chan->tail = desc;
> +
> +       /* next check if EOQ has been triggered already */
> +       if (desc_read(prev, hw_mode) & CPDMA_DESC_EOQ)
> +               chan_write(chan, hdp, desc);
> +
> +done:
> +       if (chan->rxfree)
> +               chan_write(chan, rxfree, 1);
> +       return 0;
> +}
> +
> +static int cpdma_process(struct cpsw_priv *priv, struct cpdma_chan *chan,
> +                        void **buffer, int *len)
> +{
> +       struct cpdma_desc *desc = chan->head;
> +       u32 status;
> +
> +       if (!desc)
> +               return -ENOENT;
> +
> +       status  = desc_read(desc, hw_mode);
> +
> +       if (len)
> +               *len = status & 0x7ff;
> +
> +       if (buffer)
> +               *buffer = desc_read_ptr(desc, sw_buffer);
> +
> +       if (status & CPDMA_DESC_OWNER)
> +               return -EBUSY;
> +
> +       chan->head = desc_read_ptr(desc, hw_next);
> +       chan_write(chan, cp, desc);
> +
> +       cpdma_desc_free(priv, desc);
> +       return 0;
> +}
> +
> +static int cpsw_init(struct eth_device *dev, bd_t *bis)
> +{
> +       struct cpsw_priv        *priv = dev->priv;
> +       int i, ret;
> +
> +       priv->data.control(1);

1 what? The "control" function probably needs a better name. And maybe
so does "1".

> +
> +       /* soft reset the controller and initialize priv */
> +       soft_reset(&priv->regs->soft_reset);
> +

See comment about soft_reset, above.

> +
> +       cpsw_ale_port_state(priv, priv->host_port, ALE_PORT_STATE_FORWARD);
> +
> +       cpsw_ale_add_ucast(priv, priv->dev->enetaddr, priv->host_port,
> +                          ALE_SECURE);
> +       cpsw_ale_add_mcast(priv, NetBcastAddr, 1 << priv->host_port);
> +
> +       for_each_slave(priv, cpsw_slave_init, priv);

Same comment as before about the for-loop construct.

[...]

> +       eth_register(dev);
> +
> +       cpsw_mdio_init(dev->name, data->mdio_base, data->mdio_div);

I bet you only need one MDIO bus, and the new PHY API makes that
straightforward.

> +
> +       return 1;
> +}
> diff --git a/include/netdev.h b/include/netdev.h
> index 96c7b9b..740213e 100644
> --- a/include/netdev.h
> +++ b/include/netdev.h
> @@ -185,4 +185,33 @@ struct mv88e61xx_config {
>  int mv88e61xx_switch_initialize(struct mv88e61xx_config *swconfig);
>  #endif /* CONFIG_MV88E61XX_SWITCH */
>
> +#ifdef CONFIG_DRIVER_TI_CPSW
> +
> +struct cpsw_slave_data {
> +       u32             slave_reg_ofs;
> +       u32             sliver_reg_ofs;
> +       int             phy_id;
> +};
> +
> +struct cpsw_platform_data {
> +       u32     mdio_base;
> +       u32     cpsw_base;
> +       int     mdio_div;
> +       int     channels;       /* number of cpdma channels (symmetric) */
> +       u32     cpdma_reg_ofs;  /* cpdma register offset                */
> +       int     slaves;         /* number of slave cpgmac ports         */
> +       u32     ale_reg_ofs;    /* address lookup engine reg offset     */
> +       int     ale_entries;    /* ale table size                       */
> +       u32     host_port_reg_ofs;      /* cpdma host port registers    */
> +       u32     hw_stats_reg_ofs;       /* cpsw hw stats counters       */
> +       u32     mac_control;
> +       struct cpsw_slave_data  *slave_data;
> +       void    (*control)(int enabled);
> +       void    (*phy_init)(char *name, int addr);
> +};
> +
> +int cpsw_register(struct cpsw_platform_data *data);
> +
> +#endif /* CONFIG_DRIVER_TI_CPSW */

Hmmm... nothing here seems like it should be in a generic header like
"netdev.h". Only cpsw_register(), and probably not that, either. I see
there's some Marvell stuff in there, too, which is suspect, but let's
not propagate that issue. There's a cpu_eth_init() and a
board_eth_init(). Surely one of those can call cpsw_register(), and
then you can put the cpsw-specific structures in something like
include/cpsw.h.

Andy
Tom Rini Nov. 10, 2011, 11:16 p.m. UTC | #5
On Thu, Nov 10, 2011 at 3:43 PM, Andy Fleming <afleming@gmail.com> wrote:
> On Thu, Nov 10, 2011 at 6:40 AM, Chandan Nath <chandan.nath@ti.com> wrote:
>> From: Cyril Chemparathy <cyril@ti.com>
>>
>> CPSW is an on-chip ethernet switch that is found on various SoCs from Texas
>> Instruments.  This patch adds a simple driver (based on the Linux driver) for
>> this hardware module.
>
> Which Linux driver is this based on?

drivers/net/cpsw.c, which isn't in mainline (and I didn't go running
about other maintainer trees).  There's a copy over in
http://arago-project.org/git/projects/?p=linux-am33x.git
Chandan Nath Nov. 28, 2011, 10:33 a.m. UTC | #6
Andy,

> -----Original Message-----
> From: Andy Fleming [mailto:afleming@gmail.com]
> Sent: Friday, November 11, 2011 4:14 AM
> To: Kumar Nath, Chandan
> Cc: u-boot@lists.denx.de; Chemparathy, Cyril
> Subject: Re: [U-Boot] [PATCH v2 1/2] TI: netdev: add driver for cpsw
> ethernet device
> 
> On Thu, Nov 10, 2011 at 6:40 AM, Chandan Nath <chandan.nath@ti.com>
> wrote:
> > From: Cyril Chemparathy <cyril@ti.com>
> >
> > CPSW is an on-chip ethernet switch that is found on various SoCs from
> Texas
> > Instruments.  This patch adds a simple driver (based on the Linux
> driver) for
> > this hardware module.
> 
> 
> Which Linux driver is this based on?

This is based on linux CPSW driver, which is yet to be up streamed.

> 
> 
> >
> > Signed-off-by: Cyril Chemparathy <cyril@ti.com>
> > ---
> > Changes since v1:
> >  - Code cleanup and removal of cpsw_eth_set_mac_addr function
> >
> >  drivers/net/Makefile |    1 +
> >  drivers/net/cpsw.c   |  862
> ++++++++++++++++++++++++++++++++++++++++++++++++++
> >  include/netdev.h     |   29 ++
> >  3 files changed, 892 insertions(+), 0 deletions(-)
> >  create mode 100644 drivers/net/cpsw.c
> >
> > +
> > +#define BIT(x)                 (1 << (x))
> > +#define BITMASK(bits)          (BIT(bits) - 1)
> > +#define PHY_REG_MASK           0x1f
> > +#define PHY_ID_MASK            0x1f
> 
> These 4 defines seem very generic

I did not find any generic code for these definitions in arch/arm
and so keeping these definitions here.

> 
> 
> > +struct cpsw_priv {
> > +       struct eth_device               *dev;
> > +       struct cpsw_platform_data       data;
> > +       int                             host_port;
> > +
> > +       struct cpsw_regs                *regs;
> > +       void                            *dma_regs;
> > +       struct cpsw_host_regs           *host_port_regs;
> > +       void                            *ale_regs;
> > +
> > +       struct cpdma_desc               descs[NUM_DESCS];
> > +       struct cpdma_desc               *desc_free;
> > +       struct cpdma_chan               rx_chan, tx_chan;
> > +
> > +       struct cpsw_slave               *slaves;
> > +#define for_each_slave(priv, func, arg...)                     \
> > +       do {                                                    \
> > +               int idx;                                        \
> > +               for (idx = 0; idx < (priv)->data.slaves; idx++) \
> > +                       (func)((priv)->slaves + idx, ##arg);    \
> > +       } while (0)
> > +};
> 
> 
> It seems a bit awkward to me to put a complex macro like this inside
> the structure definition. After further review, I think it should also
> be defined differently, more like the list macros:
> 
> #define for_each_slave(slave, priv) \
>         for (slave = (priv)->slaves; slave != (priv)->slaves +
> (priv)->data.slaves; slave++)
> 
> It makes the code more maintainable, as the macro no longer contains
> the implicit assumption that "func" has a slave pointer as its first
> argument.
> 

This complex macro will be separated out and will be defined like list macros as you have
mentioned above.

> 
> > +
> > +static inline int cpsw_ale_get_field(u32 *ale_entry, u32 start, u32
> bits)
> > +{
> > +       int idx;
> > +
> > +       idx    = start / 32;
> > +       start -= idx * 32;
> > +       idx    = 2 - idx; /* flip */
> > +       return (ale_entry[idx] >> start) & BITMASK(bits);
> > +}
> > +
> > +static inline void cpsw_ale_set_field(u32 *ale_entry, u32 start, u32
> bits,
> > +                                     u32 value)
> > +{
> > +       int idx;
> > +
> > +       value &= BITMASK(bits);
> > +       idx    = start / 32;
> > +       start -= idx * 32;
> > +       idx    = 2 - idx; /* flip */
> > +       ale_entry[idx] &= ~(BITMASK(bits) << start);
> > +       ale_entry[idx] |=  (value << start);
> > +}
> 
> 
> These two functions seem both very generic, and also over-worked.
> 

Should this be changed to a different implementation?

> 
> > +
> > +#define DEFINE_ALE_FIELD(name, start, bits)
>    \
> > +static inline int cpsw_ale_get_##name(u32 *ale_entry)
>    \
> > +{
>    \
> > +       return cpsw_ale_get_field(ale_entry, start, bits);
>    \
> > +}
>    \
> > +static inline void cpsw_ale_set_##name(u32 *ale_entry, u32 value)
>    \
> > +{
>    \
> > +       cpsw_ale_set_field(ale_entry, start, bits, value);
>    \
> > +}
> > +
> > +DEFINE_ALE_FIELD(entry_type,           60,     2)
> > +DEFINE_ALE_FIELD(mcast_state,          62,     2)
> > +DEFINE_ALE_FIELD(port_mask,            64,     3)
> > +DEFINE_ALE_FIELD(ucast_type,           66,     2)
> > +DEFINE_ALE_FIELD(port_num,             64,     2)
> > +DEFINE_ALE_FIELD(blocked,              63,     1)
> > +DEFINE_ALE_FIELD(secure,               62,     1)
> > +DEFINE_ALE_FIELD(mcast,                        47,     1)
> > +
> > +/* The MAC address field in the ALE entry cannot be macroized as
> above */
> > +static inline void cpsw_ale_get_addr(u32 *ale_entry, u8 *addr)
> > +{
> > +       int i;
> > +
> > +       for (i = 0; i < 6; i++)
> > +               addr[i] = cpsw_ale_get_field(ale_entry, 40 - 8*i, 8);
> > +}
> > +
> > +static inline void cpsw_ale_set_addr(u32 *ale_entry, u8 *addr)
> > +{
> > +       int i;
> > +
> > +       for (i = 0; i < 6; i++)
> > +               cpsw_ale_set_field(ale_entry, 40 - 8*i, 8, addr[i]);
> > +}
> > +
> > +static int cpsw_ale_read(struct cpsw_priv *priv, int idx, u32
> *ale_entry)
> > +{
> > +       int i;
> > +
> > +       __raw_writel(idx, priv->ale_regs + ALE_TABLE_CONTROL);
> > +
> > +       for (i = 0; i < ALE_ENTRY_WORDS; i++)
> > +               ale_entry[i] = __raw_readl(priv->ale_regs + ALE_TABLE
> + 4 * i);
> > +
> > +       return idx;
> > +}
> > +
> > +static int cpsw_ale_write(struct cpsw_priv *priv, int idx, u32
> *ale_entry)
> > +{
> > +       int i;
> > +
> > +       for (i = 0; i < ALE_ENTRY_WORDS; i++)
> > +               __raw_writel(ale_entry[i], priv->ale_regs + ALE_TABLE
> + 4 * i);
> > +
> > +       __raw_writel(idx | ALE_TABLE_WRITE, priv->ale_regs +
> ALE_TABLE_CONTROL);
> > +
> > +       return idx;
> > +}
> 
> 
> I don't know how your device works, but it seems odd to me to have to
> read out a large table, and modify it, and then write it back out.
> 
> I'm also highly suspicious of the overworked bitfield math. Are
> standard C bitfields not usable for some reason? It borders on code
> obfuscation, IMO. I've spent far too much time, already, just trying
> to figure out what that code was doing, and why.
> 

I will think of some standard C bitfields to make it simpler.

> > +static inline void cpsw_ale_port_state(struct cpsw_priv *priv, int
> port,
> > +                                      int val)
> > +{
> > +       int offset = ALE_PORTCTL + 4 * port;
> > +       u32 tmp, mask = 0x3;
> > +
> > +       tmp  = __raw_readl(priv->ale_regs + offset);
> > +       tmp &= ~mask;
> > +       tmp |= val & 0x3;
> 
> All of this can probably be done with more generic setbits functions,
> but at least use "mask" consistently for both the clearing and the
> masking of "val".
> 

Ok, mask will be used consistently.

> > +       __raw_writel(tmp, priv->ale_regs + offset);
> > +}
> > +
> > +static struct cpsw_mdio_regs *mdio_regs;
> 
> 
> Global variables like this shouldn't be necessary. Especially with the
> new PHY API
>

This global variable is required to access mdio registers across different functions.
 
> 	
> 
> > +
> > +static int cpsw_mdio_read(char *devname, unsigned char phy_id,
> > +                         unsigned char phy_reg, unsigned short
> *data)
> > +{
> 
> This is the legacy interface for PHY interactions. You should look
> into using the new "PHYLIB" code.
> 

Sure, I will be using new "PHYLIB" code instead of this legacy code.

> 
> > +       u32 reg;
> > +
> > +       if (phy_reg & ~PHY_REG_MASK || phy_id & ~PHY_ID_MASK)
> > +               return -EINVAL;
> > +
> > +       wait_for_user_access();
> > +       reg = (USERACCESS_GO | USERACCESS_READ | (phy_reg << 21) |
> > +              (phy_id << 16));
> > +       __raw_writel(reg, &mdio_regs->user[0].access);
> > +       reg = wait_for_user_access();
> > +
> > +       *data = (reg & USERACCESS_ACK) ? (reg & USERACCESS_DATA) : -
> 1;
> > +       return (reg & USERACCESS_ACK) ? 0 : -EIO;
> > +}
> > +
> > +static int cpsw_mdio_write(char *devname, unsigned char phy_id,
> > +                          unsigned char phy_reg, unsigned short
> data)
> 
> Same comment as above.
> 

Yes, I will use "PHYLIB" code instead of legacy code.

> 
> > +static void cpsw_mdio_init(char *name, u32 mdio_base, u32 div)
> > +{
> > +       mdio_regs = (struct cpsw_mdio_regs *)mdio_base;
> > +
> > +       /* set enable and clock divider */
> > +       __raw_writel(div | CONTROL_ENABLE, &mdio_regs->control);
> > +
> > +       /*
> > +        * wait for scan logic to settle:
> > +        * the scan time consists of (a) a large fixed component, and
> (b) a
> > +        * small component that varies with the mii bus frequency.
>  These
> > +        * were estimated using measurements at 1.1 and 2.2 MHz on
> tnetv107x
> > +        * silicon.  Since the effect of (b) was found to be largely
> > +        * negligible, we keep things simple here.
> > +        */
> > +       udelay(1000);
> 
> This seems sketchy. Is there no way to *know* the bus is ready, other
> than to wait?
> 
> > +
> > +       miiphy_register(name, cpsw_mdio_read, cpsw_mdio_write);
> 
> 
> This is the legacy API.
> 

PHYLIB code will be used instead of this.

> 
> > +}
> > +
> > +static inline void soft_reset(void *reg)
> > +{
> > +       __raw_writel(1, reg);
> > +       while (__raw_readl(reg) & 1)
> > +               ;
> > +}
> 
> 
> ???
> 
> Can reg be *any* reg? Use a better name. Also, name "1" something
> sensible.
> 
> Perhaps a cleaner implementation (which might be usable in other
> people's code) would be something like:
> 
> /* Set a self-clearing bit in a register, and wait for it to clear */
> static inline void setbit_and_wait_for_clear32(void *addr, u32 mask)
> {
>    __raw_writel(val, addr);
>   while (__raw_readl(addr) & val)
>     ;
> }
> 
> 

Ok, I will implement this in a cleaner manner.

> > +static void cpsw_slave_update_link(struct cpsw_slave *slave,
> > +                                  struct cpsw_priv *priv, int *link)
> > +{
> > +       char *name = priv->dev->name;
> > +       int phy_id = slave->data->phy_id;
> > +       int speed, duplex;
> > +       unsigned short reg;
> > +       u32 mac_control = 0;
> > +
> > +       if (miiphy_read(name, phy_id, MII_BMSR, &reg))
> > +               return; /* could not read, assume no link */
> 
> 
> Please use phy_read(), with the new API.
>

Ok, I will use phy_read(), instead of miiphy_read.
 
> 
> > +
> > +       if (reg & BMSR_LSTATUS) { /* link up */
> > +               speed = miiphy_speed(name, phy_id);
> > +               duplex = miiphy_duplex(name, phy_id);
> > +
> > +               *link = 1;
> > +               mac_control = priv->data.mac_control;
> > +               if (speed == 1000)
> > +                       mac_control |= BIT(7);  /* GIGABITEN    */
> > +               if (duplex == FULL)
> > +                       mac_control |= BIT(0);  /* FULLDUPLEXEN */
> 
> Why not:
>     mac_control |= GIGABITEN;
> 
> etc
> 

Sure, I will make this change.

> 
> 
> > +static int cpsw_update_link(struct cpsw_priv *priv)
> > +{
> > +       int link = 0;
> > +       for_each_slave(priv, cpsw_slave_update_link, priv, &link);
> 
> As I mentioned, there are a lot of similarly-named macros in Linux and
> U-boot. Usually they act exactly like for-loops, where you provide an
> iterator, and then use it in each iteration:
> 
> struct cpsw_slave *slave;
> 
> for_each_slave(slave, priv)
>   cpsw_slave_update_link(slave, priv, &link);
> 
> I think this is much easier to understand and maintain.
> 
> > +       return link;
> 
> Also, link looks useless. It will always be the value in the last
> slave. Is that what you meant to do?
> 
> 

Ok, I will use this as per your comment.
for_each_slave(slave, priv)
	cpsw_slave_update_link(slave, priv, &link);

Also, I am returning link which returns the value of last slave.

> > +}
> > +
> > +static void cpsw_slave_init(struct cpsw_slave *slave, struct
> cpsw_priv *priv)
> > +{
> 
> [...]
> 
> > +
> > +       priv->data.phy_init(priv->dev->name, slave->data->phy_id);
> 
> What does this do? Probably needs to be converted to the newer API.
> 

I will remove this and new PHYLIB APIs will be used instead.

> 
> > +}
> > +
> > +static struct cpdma_desc *cpdma_desc_alloc(struct cpsw_priv *priv)
> > +{
> > +       struct cpdma_desc *desc = priv->desc_free;
> > +
> > +       if (desc)
> > +               priv->desc_free = desc_read_ptr(desc, hw_next);
> > +       return desc;
> > +}
> > +
> > +static void cpdma_desc_free(struct cpsw_priv *priv, struct
> cpdma_desc *desc)
> > +{
> > +       if (desc) {
> > +               desc_write(desc, hw_next, priv->desc_free);
> > +               priv->desc_free = desc;
> > +       }
> > +}
> > +
> > +static int cpdma_submit(struct cpsw_priv *priv, struct cpdma_chan
> *chan,
> > +                       volatile void *buffer, int len)
> > +{
> > +       struct cpdma_desc *desc, *prev;
> > +       u32 mode;
> > +
> > +       desc = cpdma_desc_alloc(priv);
> > +       if (!desc)
> > +               return -ENOMEM;
> > +
> > +       if (len < PKT_MIN)
> > +               len = PKT_MIN;
> > +
> > +       mode = CPDMA_DESC_OWNER | CPDMA_DESC_SOP | CPDMA_DESC_EOP;
> > +
> > +       desc_write(desc, hw_next,   0);
> > +       desc_write(desc, hw_buffer, buffer);
> > +       desc_write(desc, hw_len,    len);
> > +       desc_write(desc, hw_mode,   mode | len);
> > +       desc_write(desc, sw_buffer, buffer);
> > +       desc_write(desc, sw_len,    len);
> > +
> > +       if (!chan->head) {
> > +               /* simple case - first packet enqueued */
> > +               chan->head = desc;
> > +               chan->tail = desc;
> > +               chan_write(chan, hdp, desc);
> > +               goto done;
> > +       }
> > +
> > +       /* not the first packet - enqueue at the tail */
> > +       prev = chan->tail;
> > +       desc_write(prev, hw_next, desc);
> > +       chan->tail = desc;
> > +
> > +       /* next check if EOQ has been triggered already */
> > +       if (desc_read(prev, hw_mode) & CPDMA_DESC_EOQ)
> > +               chan_write(chan, hdp, desc);
> > +
> > +done:
> > +       if (chan->rxfree)
> > +               chan_write(chan, rxfree, 1);
> > +       return 0;
> > +}
> > +
> > +static int cpdma_process(struct cpsw_priv *priv, struct cpdma_chan
> *chan,
> > +                        void **buffer, int *len)
> > +{
> > +       struct cpdma_desc *desc = chan->head;
> > +       u32 status;
> > +
> > +       if (!desc)
> > +               return -ENOENT;
> > +
> > +       status  = desc_read(desc, hw_mode);
> > +
> > +       if (len)
> > +               *len = status & 0x7ff;
> > +
> > +       if (buffer)
> > +               *buffer = desc_read_ptr(desc, sw_buffer);
> > +
> > +       if (status & CPDMA_DESC_OWNER)
> > +               return -EBUSY;
> > +
> > +       chan->head = desc_read_ptr(desc, hw_next);
> > +       chan_write(chan, cp, desc);
> > +
> > +       cpdma_desc_free(priv, desc);
> > +       return 0;
> > +}
> > +
> > +static int cpsw_init(struct eth_device *dev, bd_t *bis)
> > +{
> > +       struct cpsw_priv        *priv = dev->priv;
> > +       int i, ret;
> > +
> > +       priv->data.control(1);
> 
> 1 what? The "control" function probably needs a better name. And maybe
> so does "1".
> 

This is not required and will be removed from the code.

> > +
> > +       /* soft reset the controller and initialize priv */
> > +       soft_reset(&priv->regs->soft_reset);
> > +
> 
> See comment about soft_reset, above.
> 

Ok, I will address this as above.

> > +
> > +       cpsw_ale_port_state(priv, priv->host_port,
> ALE_PORT_STATE_FORWARD);
> > +
> > +       cpsw_ale_add_ucast(priv, priv->dev->enetaddr, priv-
> >host_port,
> > +                          ALE_SECURE);
> > +       cpsw_ale_add_mcast(priv, NetBcastAddr, 1 << priv->host_port);
> > +
> > +       for_each_slave(priv, cpsw_slave_init, priv);
> 
> Same comment as before about the for-loop construct.
> 

Ok, will address in similar way as above.

> [...]
> 
> > +       eth_register(dev);
> > +
> > +       cpsw_mdio_init(dev->name, data->mdio_base, data->mdio_div);
> 
> I bet you only need one MDIO bus, and the new PHY API makes that
> straightforward.
>

Yes, I will use new PHYLIB APIs.
 
> > +
> > +       return 1;
> > +}
> > diff --git a/include/netdev.h b/include/netdev.h
> > index 96c7b9b..740213e 100644
> > --- a/include/netdev.h
> > +++ b/include/netdev.h
> > @@ -185,4 +185,33 @@ struct mv88e61xx_config {
> >  int mv88e61xx_switch_initialize(struct mv88e61xx_config *swconfig);
> >  #endif /* CONFIG_MV88E61XX_SWITCH */
> >
> > +#ifdef CONFIG_DRIVER_TI_CPSW
> > +
> > +struct cpsw_slave_data {
> > +       u32             slave_reg_ofs;
> > +       u32             sliver_reg_ofs;
> > +       int             phy_id;
> > +};
> > +
> > +struct cpsw_platform_data {
> > +       u32     mdio_base;
> > +       u32     cpsw_base;
> > +       int     mdio_div;
> > +       int     channels;       /* number of cpdma channels
> (symmetric) */
> > +       u32     cpdma_reg_ofs;  /* cpdma register offset
>    */
> > +       int     slaves;         /* number of slave cpgmac ports
>   */
> > +       u32     ale_reg_ofs;    /* address lookup engine reg offset
>   */
> > +       int     ale_entries;    /* ale table size
>   */
> > +       u32     host_port_reg_ofs;      /* cpdma host port registers
>    */
> > +       u32     hw_stats_reg_ofs;       /* cpsw hw stats counters
>   */
> > +       u32     mac_control;
> > +       struct cpsw_slave_data  *slave_data;
> > +       void    (*control)(int enabled);
> > +       void    (*phy_init)(char *name, int addr);
> > +};
> > +
> > +int cpsw_register(struct cpsw_platform_data *data);
> > +
> > +#endif /* CONFIG_DRIVER_TI_CPSW */
> 
> Hmmm... nothing here seems like it should be in a generic header like
> "netdev.h". Only cpsw_register(), and probably not that, either. I see
> there's some Marvell stuff in there, too, which is suspect, but let's
> not propagate that issue. There's a cpu_eth_init() and a
> board_eth_init(). Surely one of those can call cpsw_register(), and
> then you can put the cpsw-specific structures in something like
> include/cpsw.h.
> 

Sure, I will remove this code from netdev.h and will keep in separate cpsw header, i.e. cpsw.h

> Andy
diff mbox

Patch

diff --git a/drivers/net/Makefile b/drivers/net/Makefile
index 819b197..080f767 100644
--- a/drivers/net/Makefile
+++ b/drivers/net/Makefile
@@ -80,6 +80,7 @@  COBJS-$(CONFIG_TIGON3) += bcm570x_autoneg.o
 COBJS-$(CONFIG_TIGON3) += 5701rls.o
 COBJS-$(CONFIG_DRIVER_TI_EMAC) += davinci_emac.o
 COBJS-$(CONFIG_TSEC_ENET) += tsec.o fsl_mdio.o
+COBJS-$(CONFIG_DRIVER_TI_CPSW) += cpsw.o
 COBJS-$(CONFIG_TSI108_ETH) += tsi108_eth.o
 COBJS-$(CONFIG_ULI526X) += uli526x.o
 COBJS-$(CONFIG_VSC7385_ENET) += vsc7385.o
diff --git a/drivers/net/cpsw.c b/drivers/net/cpsw.c
new file mode 100644
index 0000000..4cef4cf
--- /dev/null
+++ b/drivers/net/cpsw.c
@@ -0,0 +1,862 @@ 
+/*
+ * CPSW Ethernet Switch Driver
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ */
+
+#include <common.h>
+#include <command.h>
+#include <net.h>
+#include <miiphy.h>
+#include <malloc.h>
+#include <net.h>
+#include <netdev.h>
+#include <asm/errno.h>
+#include <asm/io.h>
+#include <linux/mii.h>
+
+#define BIT(x)			(1 << (x))
+#define BITMASK(bits)		(BIT(bits) - 1)
+#define PHY_REG_MASK		0x1f
+#define PHY_ID_MASK		0x1f
+#define NUM_DESCS		(PKTBUFSRX * 2)
+#define PKT_MIN			60
+#define PKT_MAX			(1500 + 14 + 4 + 4)
+
+/* DMA Registers */
+#define CPDMA_TXCONTROL		0x004
+#define CPDMA_RXCONTROL		0x014
+#define CPDMA_SOFTRESET		0x01c
+#define CPDMA_RXFREE		0x0e0
+#define CPDMA_TXHDP		0x100
+#define CPDMA_RXHDP		0x120
+#define CPDMA_TXCP		0x140
+#define CPDMA_RXCP		0x160
+
+/* Descriptor mode bits */
+#define CPDMA_DESC_SOP		BIT(31)
+#define CPDMA_DESC_EOP		BIT(30)
+#define CPDMA_DESC_OWNER	BIT(29)
+#define CPDMA_DESC_EOQ		BIT(28)
+
+struct cpsw_mdio_regs {
+	u32	version;
+	u32	control;
+#define CONTROL_IDLE		(1 << 31)
+#define CONTROL_ENABLE		(1 << 30)
+
+	u32	alive;
+	u32	link;
+	u32	linkintraw;
+	u32	linkintmasked;
+	u32	__reserved_0[2];
+	u32	userintraw;
+	u32	userintmasked;
+	u32	userintmaskset;
+	u32	userintmaskclr;
+	u32	__reserved_1[20];
+
+	struct {
+		u32		access;
+		u32		physel;
+#define USERACCESS_GO		(1 << 31)
+#define USERACCESS_WRITE	(1 << 30)
+#define USERACCESS_ACK		(1 << 29)
+#define USERACCESS_READ		(0)
+#define USERACCESS_DATA		(0xffff)
+	} user[0];
+};
+
+struct cpsw_regs {
+	u32	id_ver;
+	u32	control;
+	u32	soft_reset;
+	u32	stat_port_en;
+	u32	ptype;
+};
+
+struct cpsw_slave_regs {
+	u32	max_blks;
+	u32	blk_cnt;
+	u32	flow_thresh;
+	u32	port_vlan;
+	u32	tx_pri_map;
+	u32	gap_thresh;
+	u32	sa_lo;
+	u32	sa_hi;
+};
+
+struct cpsw_host_regs {
+	u32	max_blks;
+	u32	blk_cnt;
+	u32	flow_thresh;
+	u32	port_vlan;
+	u32	tx_pri_map;
+	u32	cpdma_tx_pri_map;
+	u32	cpdma_rx_chan_map;
+};
+
+struct cpsw_sliver_regs {
+	u32	id_ver;
+	u32	mac_control;
+	u32	mac_status;
+	u32	soft_reset;
+	u32	rx_maxlen;
+	u32	__reserved_0;
+	u32	rx_pause;
+	u32	tx_pause;
+	u32	__reserved_1;
+	u32	rx_pri_map;
+};
+
+#define ALE_ENTRY_BITS		68
+#define ALE_ENTRY_WORDS		DIV_ROUND_UP(ALE_ENTRY_BITS, 32)
+
+/* ALE Registers */
+#define ALE_CONTROL		0x08
+#define ALE_UNKNOWNVLAN		0x18
+#define ALE_TABLE_CONTROL	0x20
+#define ALE_TABLE		0x34
+#define ALE_PORTCTL		0x40
+
+#define ALE_TABLE_WRITE		BIT(31)
+
+#define ALE_TYPE_FREE			0
+#define ALE_TYPE_ADDR			1
+#define ALE_TYPE_VLAN			2
+#define ALE_TYPE_VLAN_ADDR		3
+
+#define ALE_UCAST_PERSISTANT		0
+#define ALE_UCAST_UNTOUCHED		1
+#define ALE_UCAST_OUI			2
+#define ALE_UCAST_TOUCHED		3
+
+#define ALE_MCAST_FWD			0
+#define ALE_MCAST_BLOCK_LEARN_FWD	1
+#define ALE_MCAST_FWD_LEARN		2
+#define ALE_MCAST_FWD_2			3
+
+enum cpsw_ale_port_state {
+	ALE_PORT_STATE_DISABLE	= 0x00,
+	ALE_PORT_STATE_BLOCK	= 0x01,
+	ALE_PORT_STATE_LEARN	= 0x02,
+	ALE_PORT_STATE_FORWARD	= 0x03,
+};
+
+/* ALE unicast entry flags - passed into cpsw_ale_add_ucast() */
+#define ALE_SECURE	1
+#define ALE_BLOCKED	2
+
+struct cpsw_slave {
+	struct cpsw_slave_regs		*regs;
+	struct cpsw_sliver_regs		*sliver;
+	int				slave_num;
+	u32				mac_control;
+	struct cpsw_slave_data		*data;
+};
+
+struct cpdma_desc {
+	/* hardware fields */
+	u32			hw_next;
+	u32			hw_buffer;
+	u32			hw_len;
+	u32			hw_mode;
+	/* software fields */
+	u32			sw_buffer;
+	u32			sw_len;
+};
+
+struct cpdma_chan {
+	struct cpdma_desc	*head, *tail;
+	void			*hdp, *cp, *rxfree;
+};
+
+#define desc_write(desc, fld, val)	__raw_writel((u32)(val), &(desc)->fld)
+#define desc_read(desc, fld)		__raw_readl(&(desc)->fld)
+#define desc_read_ptr(desc, fld)	((void *)__raw_readl(&(desc)->fld))
+
+#define chan_write(chan, fld, val)	__raw_writel((u32)(val), (chan)->fld)
+#define chan_read(chan, fld)		__raw_readl((chan)->fld)
+#define chan_read_ptr(chan, fld)	((void *)__raw_readl((chan)->fld))
+
+struct cpsw_priv {
+	struct eth_device		*dev;
+	struct cpsw_platform_data	data;
+	int				host_port;
+
+	struct cpsw_regs		*regs;
+	void				*dma_regs;
+	struct cpsw_host_regs		*host_port_regs;
+	void				*ale_regs;
+
+	struct cpdma_desc		descs[NUM_DESCS];
+	struct cpdma_desc		*desc_free;
+	struct cpdma_chan		rx_chan, tx_chan;
+
+	struct cpsw_slave		*slaves;
+#define for_each_slave(priv, func, arg...)			\
+	do {							\
+		int idx;					\
+		for (idx = 0; idx < (priv)->data.slaves; idx++)	\
+			(func)((priv)->slaves + idx, ##arg);	\
+	} while (0)
+};
+
+static inline int cpsw_ale_get_field(u32 *ale_entry, u32 start, u32 bits)
+{
+	int idx;
+
+	idx    = start / 32;
+	start -= idx * 32;
+	idx    = 2 - idx; /* flip */
+	return (ale_entry[idx] >> start) & BITMASK(bits);
+}
+
+static inline void cpsw_ale_set_field(u32 *ale_entry, u32 start, u32 bits,
+				      u32 value)
+{
+	int idx;
+
+	value &= BITMASK(bits);
+	idx    = start / 32;
+	start -= idx * 32;
+	idx    = 2 - idx; /* flip */
+	ale_entry[idx] &= ~(BITMASK(bits) << start);
+	ale_entry[idx] |=  (value << start);
+}
+
+#define DEFINE_ALE_FIELD(name, start, bits)				\
+static inline int cpsw_ale_get_##name(u32 *ale_entry)			\
+{									\
+	return cpsw_ale_get_field(ale_entry, start, bits);		\
+}									\
+static inline void cpsw_ale_set_##name(u32 *ale_entry, u32 value)	\
+{									\
+	cpsw_ale_set_field(ale_entry, start, bits, value);		\
+}
+
+DEFINE_ALE_FIELD(entry_type,		60,	2)
+DEFINE_ALE_FIELD(mcast_state,		62,	2)
+DEFINE_ALE_FIELD(port_mask,		64,	3)
+DEFINE_ALE_FIELD(ucast_type,		66,	2)
+DEFINE_ALE_FIELD(port_num,		64,	2)
+DEFINE_ALE_FIELD(blocked,		63,	1)
+DEFINE_ALE_FIELD(secure,		62,	1)
+DEFINE_ALE_FIELD(mcast,			47,	1)
+
+/* The MAC address field in the ALE entry cannot be macroized as above */
+static inline void cpsw_ale_get_addr(u32 *ale_entry, u8 *addr)
+{
+	int i;
+
+	for (i = 0; i < 6; i++)
+		addr[i] = cpsw_ale_get_field(ale_entry, 40 - 8*i, 8);
+}
+
+static inline void cpsw_ale_set_addr(u32 *ale_entry, u8 *addr)
+{
+	int i;
+
+	for (i = 0; i < 6; i++)
+		cpsw_ale_set_field(ale_entry, 40 - 8*i, 8, addr[i]);
+}
+
+static int cpsw_ale_read(struct cpsw_priv *priv, int idx, u32 *ale_entry)
+{
+	int i;
+
+	__raw_writel(idx, priv->ale_regs + ALE_TABLE_CONTROL);
+
+	for (i = 0; i < ALE_ENTRY_WORDS; i++)
+		ale_entry[i] = __raw_readl(priv->ale_regs + ALE_TABLE + 4 * i);
+
+	return idx;
+}
+
+static int cpsw_ale_write(struct cpsw_priv *priv, int idx, u32 *ale_entry)
+{
+	int i;
+
+	for (i = 0; i < ALE_ENTRY_WORDS; i++)
+		__raw_writel(ale_entry[i], priv->ale_regs + ALE_TABLE + 4 * i);
+
+	__raw_writel(idx | ALE_TABLE_WRITE, priv->ale_regs + ALE_TABLE_CONTROL);
+
+	return idx;
+}
+
+static int cpsw_ale_match_addr(struct cpsw_priv *priv, u8* addr)
+{
+	u32 ale_entry[ALE_ENTRY_WORDS];
+	int type, idx;
+
+	for (idx = 0; idx < priv->data.ale_entries; idx++) {
+		u8 entry_addr[6];
+
+		cpsw_ale_read(priv, idx, ale_entry);
+		type = cpsw_ale_get_entry_type(ale_entry);
+		if (type != ALE_TYPE_ADDR && type != ALE_TYPE_VLAN_ADDR)
+			continue;
+		cpsw_ale_get_addr(ale_entry, entry_addr);
+		if (memcmp(entry_addr, addr, 6) == 0)
+			return idx;
+	}
+	return -ENOENT;
+}
+
+static int cpsw_ale_match_free(struct cpsw_priv *priv)
+{
+	u32 ale_entry[ALE_ENTRY_WORDS];
+	int type, idx;
+
+	for (idx = 0; idx < priv->data.ale_entries; idx++) {
+		cpsw_ale_read(priv, idx, ale_entry);
+		type = cpsw_ale_get_entry_type(ale_entry);
+		if (type == ALE_TYPE_FREE)
+			return idx;
+	}
+	return -ENOENT;
+}
+
+static int cpsw_ale_find_ageable(struct cpsw_priv *priv)
+{
+	u32 ale_entry[ALE_ENTRY_WORDS];
+	int type, idx;
+
+	for (idx = 0; idx < priv->data.ale_entries; idx++) {
+		cpsw_ale_read(priv, idx, ale_entry);
+		type = cpsw_ale_get_entry_type(ale_entry);
+		if (type != ALE_TYPE_ADDR && type != ALE_TYPE_VLAN_ADDR)
+			continue;
+		if (cpsw_ale_get_mcast(ale_entry))
+			continue;
+		type = cpsw_ale_get_ucast_type(ale_entry);
+		if (type != ALE_UCAST_PERSISTANT &&
+		    type != ALE_UCAST_OUI)
+			return idx;
+	}
+	return -ENOENT;
+}
+
+static int cpsw_ale_add_ucast(struct cpsw_priv *priv, u8 *addr,
+			      int port, int flags)
+{
+	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
+	int idx;
+
+	cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_ADDR);
+	cpsw_ale_set_addr(ale_entry, addr);
+	cpsw_ale_set_ucast_type(ale_entry, ALE_UCAST_PERSISTANT);
+	cpsw_ale_set_secure(ale_entry, (flags & ALE_SECURE) ? 1 : 0);
+	cpsw_ale_set_blocked(ale_entry, (flags & ALE_BLOCKED) ? 1 : 0);
+	cpsw_ale_set_port_num(ale_entry, port);
+
+	idx = cpsw_ale_match_addr(priv, addr);
+	if (idx < 0)
+		idx = cpsw_ale_match_free(priv);
+	if (idx < 0)
+		idx = cpsw_ale_find_ageable(priv);
+	if (idx < 0)
+		return -ENOMEM;
+
+	cpsw_ale_write(priv, idx, ale_entry);
+	return 0;
+}
+
+static int cpsw_ale_add_mcast(struct cpsw_priv *priv, u8 *addr, int port_mask)
+{
+	u32 ale_entry[ALE_ENTRY_WORDS] = {0, 0, 0};
+	int idx, mask;
+
+	idx = cpsw_ale_match_addr(priv, addr);
+	if (idx >= 0)
+		cpsw_ale_read(priv, idx, ale_entry);
+
+	cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_ADDR);
+	cpsw_ale_set_addr(ale_entry, addr);
+	cpsw_ale_set_mcast_state(ale_entry, ALE_MCAST_FWD_2);
+
+	mask = cpsw_ale_get_port_mask(ale_entry);
+	port_mask |= mask;
+	cpsw_ale_set_port_mask(ale_entry, port_mask);
+
+	if (idx < 0)
+		idx = cpsw_ale_match_free(priv);
+	if (idx < 0)
+		idx = cpsw_ale_find_ageable(priv);
+	if (idx < 0)
+		return -ENOMEM;
+
+	cpsw_ale_write(priv, idx, ale_entry);
+	return 0;
+}
+
+static inline void cpsw_ale_control(struct cpsw_priv *priv, int bit, int val)
+{
+	u32 tmp, mask = BIT(bit);
+
+	tmp  = __raw_readl(priv->ale_regs + ALE_CONTROL);
+	tmp &= ~mask;
+	tmp |= val ? mask : 0;
+	__raw_writel(tmp, priv->ale_regs + ALE_CONTROL);
+}
+
+#define cpsw_ale_enable(priv, val)	cpsw_ale_control(priv, 31, val)
+#define cpsw_ale_clear(priv, val)	cpsw_ale_control(priv, 30, val)
+#define cpsw_ale_vlan_aware(priv, val)	cpsw_ale_control(priv,  2, val)
+
+static inline void cpsw_ale_port_state(struct cpsw_priv *priv, int port,
+				       int val)
+{
+	int offset = ALE_PORTCTL + 4 * port;
+	u32 tmp, mask = 0x3;
+
+	tmp  = __raw_readl(priv->ale_regs + offset);
+	tmp &= ~mask;
+	tmp |= val & 0x3;
+	__raw_writel(tmp, priv->ale_regs + offset);
+}
+
+static struct cpsw_mdio_regs *mdio_regs;
+
+/* wait until hardware is ready for another user access */
+static inline u32 wait_for_user_access(void)
+{
+	u32 reg;
+
+	while ((reg = __raw_readl(&mdio_regs->user[0].access)) & USERACCESS_GO)
+		;
+
+	return reg;
+}
+
+/* wait until hardware state machine is idle */
+static inline void wait_for_idle(void)
+{
+	while ((__raw_readl(&mdio_regs->control) & CONTROL_IDLE) == 0)
+		;
+}
+
+static int cpsw_mdio_read(char *devname, unsigned char phy_id,
+			  unsigned char phy_reg, unsigned short *data)
+{
+	u32 reg;
+
+	if (phy_reg & ~PHY_REG_MASK || phy_id & ~PHY_ID_MASK)
+		return -EINVAL;
+
+	wait_for_user_access();
+	reg = (USERACCESS_GO | USERACCESS_READ | (phy_reg << 21) |
+	       (phy_id << 16));
+	__raw_writel(reg, &mdio_regs->user[0].access);
+	reg = wait_for_user_access();
+
+	*data = (reg & USERACCESS_ACK) ? (reg & USERACCESS_DATA) : -1;
+	return (reg & USERACCESS_ACK) ? 0 : -EIO;
+}
+
+static int cpsw_mdio_write(char *devname, unsigned char phy_id,
+			   unsigned char phy_reg, unsigned short data)
+{
+	u32 reg;
+
+	if (phy_reg & ~PHY_REG_MASK || phy_id & ~PHY_ID_MASK)
+		return -EINVAL;
+
+	wait_for_user_access();
+	reg = (USERACCESS_GO | USERACCESS_WRITE | (phy_reg << 21) |
+		   (phy_id << 16) | (data & USERACCESS_DATA));
+	__raw_writel(reg, &mdio_regs->user[0].access);
+	wait_for_user_access();
+
+	return 0;
+}
+
+static void cpsw_mdio_init(char *name, u32 mdio_base, u32 div)
+{
+	mdio_regs = (struct cpsw_mdio_regs *)mdio_base;
+
+	/* set enable and clock divider */
+	__raw_writel(div | CONTROL_ENABLE, &mdio_regs->control);
+
+	/*
+	 * wait for scan logic to settle:
+	 * the scan time consists of (a) a large fixed component, and (b) a
+	 * small component that varies with the mii bus frequency.  These
+	 * were estimated using measurements at 1.1 and 2.2 MHz on tnetv107x
+	 * silicon.  Since the effect of (b) was found to be largely
+	 * negligible, we keep things simple here.
+	 */
+	udelay(1000);
+
+	miiphy_register(name, cpsw_mdio_read, cpsw_mdio_write);
+}
+
+static inline void soft_reset(void *reg)
+{
+	__raw_writel(1, reg);
+	while (__raw_readl(reg) & 1)
+		;
+}
+
+#define mac_hi(mac)	(((mac)[0] << 0) | ((mac)[1] << 8) |	\
+			 ((mac)[2] << 16) | ((mac)[3] << 24))
+#define mac_lo(mac)	(((mac)[4] << 0) | ((mac)[5] << 8))
+
+static void cpsw_set_slave_mac(struct cpsw_slave *slave,
+			       struct cpsw_priv *priv)
+{
+	__raw_writel(mac_hi(priv->dev->enetaddr), &slave->regs->sa_hi);
+	__raw_writel(mac_lo(priv->dev->enetaddr), &slave->regs->sa_lo);
+}
+
+static void cpsw_slave_update_link(struct cpsw_slave *slave,
+				   struct cpsw_priv *priv, int *link)
+{
+	char *name = priv->dev->name;
+	int phy_id = slave->data->phy_id;
+	int speed, duplex;
+	unsigned short reg;
+	u32 mac_control = 0;
+
+	if (miiphy_read(name, phy_id, MII_BMSR, &reg))
+		return; /* could not read, assume no link */
+
+	if (reg & BMSR_LSTATUS) { /* link up */
+		speed = miiphy_speed(name, phy_id);
+		duplex = miiphy_duplex(name, phy_id);
+
+		*link = 1;
+		mac_control = priv->data.mac_control;
+		if (speed == 1000)
+			mac_control |= BIT(7);	/* GIGABITEN	*/
+		if (duplex == FULL)
+			mac_control |= BIT(0);	/* FULLDUPLEXEN	*/
+	}
+
+	if (mac_control == slave->mac_control)
+		return;
+
+	if (mac_control) {
+		printf("link up on port %d, speed %d, %s duplex\n",
+				slave->slave_num, speed,
+				(duplex == FULL) ?  "full" : "half");
+	} else {
+		printf("link down on port %d\n", slave->slave_num);
+	}
+
+	__raw_writel(mac_control, &slave->sliver->mac_control);
+	slave->mac_control = mac_control;
+}
+
+static int cpsw_update_link(struct cpsw_priv *priv)
+{
+	int link = 0;
+	for_each_slave(priv, cpsw_slave_update_link, priv, &link);
+	return link;
+}
+
+static void cpsw_slave_init(struct cpsw_slave *slave, struct cpsw_priv *priv)
+{
+	soft_reset(&slave->sliver->soft_reset);
+
+	/* setup priority mapping */
+	__raw_writel(0x76543210, &slave->sliver->rx_pri_map);
+	__raw_writel(0x33221100, &slave->regs->tx_pri_map);
+
+	/* setup max packet size, and mac address */
+	__raw_writel(PKT_MAX, &slave->sliver->rx_maxlen);
+	cpsw_set_slave_mac(slave, priv);
+
+	slave->mac_control = 0;	/* no link yet */
+
+	/* enable forwarding */
+	cpsw_ale_port_state(priv, slave->slave_num, ALE_PORT_STATE_FORWARD);
+
+	cpsw_ale_add_mcast(priv, NetBcastAddr, 1 << slave->slave_num);
+
+	priv->data.phy_init(priv->dev->name, slave->data->phy_id);
+}
+
+static struct cpdma_desc *cpdma_desc_alloc(struct cpsw_priv *priv)
+{
+	struct cpdma_desc *desc = priv->desc_free;
+
+	if (desc)
+		priv->desc_free = desc_read_ptr(desc, hw_next);
+	return desc;
+}
+
+static void cpdma_desc_free(struct cpsw_priv *priv, struct cpdma_desc *desc)
+{
+	if (desc) {
+		desc_write(desc, hw_next, priv->desc_free);
+		priv->desc_free = desc;
+	}
+}
+
+static int cpdma_submit(struct cpsw_priv *priv, struct cpdma_chan *chan,
+			volatile void *buffer, int len)
+{
+	struct cpdma_desc *desc, *prev;
+	u32 mode;
+
+	desc = cpdma_desc_alloc(priv);
+	if (!desc)
+		return -ENOMEM;
+
+	if (len < PKT_MIN)
+		len = PKT_MIN;
+
+	mode = CPDMA_DESC_OWNER | CPDMA_DESC_SOP | CPDMA_DESC_EOP;
+
+	desc_write(desc, hw_next,   0);
+	desc_write(desc, hw_buffer, buffer);
+	desc_write(desc, hw_len,    len);
+	desc_write(desc, hw_mode,   mode | len);
+	desc_write(desc, sw_buffer, buffer);
+	desc_write(desc, sw_len,    len);
+
+	if (!chan->head) {
+		/* simple case - first packet enqueued */
+		chan->head = desc;
+		chan->tail = desc;
+		chan_write(chan, hdp, desc);
+		goto done;
+	}
+
+	/* not the first packet - enqueue at the tail */
+	prev = chan->tail;
+	desc_write(prev, hw_next, desc);
+	chan->tail = desc;
+
+	/* next check if EOQ has been triggered already */
+	if (desc_read(prev, hw_mode) & CPDMA_DESC_EOQ)
+		chan_write(chan, hdp, desc);
+
+done:
+	if (chan->rxfree)
+		chan_write(chan, rxfree, 1);
+	return 0;
+}
+
+static int cpdma_process(struct cpsw_priv *priv, struct cpdma_chan *chan,
+			 void **buffer, int *len)
+{
+	struct cpdma_desc *desc = chan->head;
+	u32 status;
+
+	if (!desc)
+		return -ENOENT;
+
+	status	= desc_read(desc, hw_mode);
+
+	if (len)
+		*len = status & 0x7ff;
+
+	if (buffer)
+		*buffer = desc_read_ptr(desc, sw_buffer);
+
+	if (status & CPDMA_DESC_OWNER)
+		return -EBUSY;
+
+	chan->head = desc_read_ptr(desc, hw_next);
+	chan_write(chan, cp, desc);
+
+	cpdma_desc_free(priv, desc);
+	return 0;
+}
+
+static int cpsw_init(struct eth_device *dev, bd_t *bis)
+{
+	struct cpsw_priv	*priv = dev->priv;
+	int i, ret;
+
+	priv->data.control(1);
+
+	/* soft reset the controller and initialize priv */
+	soft_reset(&priv->regs->soft_reset);
+
+	/* initialize and reset the address lookup engine */
+	cpsw_ale_enable(priv, 1);
+	cpsw_ale_clear(priv, 1);
+	cpsw_ale_vlan_aware(priv, 0); /* vlan unaware mode */
+
+	/* setup host port priority mapping */
+	__raw_writel(0x76543210, &priv->host_port_regs->cpdma_tx_pri_map);
+	__raw_writel(0, &priv->host_port_regs->cpdma_rx_chan_map);
+
+	/* disable priority elevation and enable statistics on all ports */
+	__raw_writel(0, &priv->regs->ptype);
+
+	/* enable statistics collection only on the host port */
+	__raw_writel(BIT(priv->host_port), &priv->regs->stat_port_en);
+
+	cpsw_ale_port_state(priv, priv->host_port, ALE_PORT_STATE_FORWARD);
+
+	cpsw_ale_add_ucast(priv, priv->dev->enetaddr, priv->host_port,
+			   ALE_SECURE);
+	cpsw_ale_add_mcast(priv, NetBcastAddr, 1 << priv->host_port);
+
+	for_each_slave(priv, cpsw_slave_init, priv);
+
+	cpsw_update_link(priv);
+
+	/* init descriptor pool */
+	for (i = 0; i < NUM_DESCS; i++) {
+		desc_write(&priv->descs[i], hw_next,
+			   (i == (NUM_DESCS - 1)) ? 0 : &priv->descs[i+1]);
+	}
+	priv->desc_free = &priv->descs[0];
+
+	/* initialize channels */
+	memset(&priv->rx_chan, 0, sizeof(struct cpdma_chan));
+	priv->rx_chan.hdp	= priv->dma_regs + CPDMA_RXHDP;
+	priv->rx_chan.cp	= priv->dma_regs + CPDMA_RXCP;
+	priv->rx_chan.rxfree	= priv->dma_regs + CPDMA_RXFREE;
+
+	memset(&priv->tx_chan, 0, sizeof(struct cpdma_chan));
+	priv->tx_chan.hdp	= priv->dma_regs + CPDMA_TXHDP;
+	priv->tx_chan.cp	= priv->dma_regs + CPDMA_TXCP;
+
+	/* clear dma state */
+	soft_reset(priv->dma_regs + CPDMA_SOFTRESET);
+
+	for (i = 0; i < priv->data.channels; i++) {
+		__raw_writel(0, priv->dma_regs + CPDMA_RXHDP + 4 * i);
+		__raw_writel(0, priv->dma_regs + CPDMA_RXFREE + 4 * i);
+		__raw_writel(0, priv->dma_regs + CPDMA_RXCP + 4 * i);
+		__raw_writel(0, priv->dma_regs + CPDMA_TXHDP + 4 * i);
+		__raw_writel(0, priv->dma_regs + CPDMA_TXCP + 4 * i);
+	}
+	__raw_writel(1, priv->dma_regs + CPDMA_TXCONTROL);
+	__raw_writel(1, priv->dma_regs + CPDMA_RXCONTROL);
+
+	/* submit rx descs */
+	for (i = 0; i < PKTBUFSRX; i++) {
+		ret = cpdma_submit(priv, &priv->rx_chan, NetRxPackets[i],
+				   PKTSIZE);
+		if (ret < 0) {
+			printf("error %d submitting rx desc\n", ret);
+			break;
+		}
+	}
+
+	return 0;
+}
+
+static void cpsw_halt(struct eth_device *dev)
+{
+	struct cpsw_priv	*priv = dev->priv;
+	priv->data.control(0);
+}
+
+static int cpsw_send(struct eth_device *dev, volatile void *packet, int length)
+{
+	struct cpsw_priv	*priv = dev->priv;
+	void *buffer;
+	int len;
+
+	if (!cpsw_update_link(priv))
+		return -EIO;
+
+	/* first reap completed packets */
+	while (cpdma_process(priv, &priv->tx_chan, &buffer, &len) >= 0)
+		;
+
+	return cpdma_submit(priv, &priv->tx_chan, packet, length);
+}
+
+static int cpsw_recv(struct eth_device *dev)
+{
+	struct cpsw_priv	*priv = dev->priv;
+	void *buffer;
+	int len;
+
+	cpsw_update_link(priv);
+
+	while (cpdma_process(priv, &priv->rx_chan, &buffer, &len) >= 0) {
+		NetReceive(buffer, len);
+		cpdma_submit(priv, &priv->rx_chan, buffer, PKTSIZE);
+	}
+
+	return 0;
+}
+
+static void cpsw_slave_setup(struct cpsw_slave *slave, int slave_num,
+			    struct cpsw_priv *priv)
+{
+	void			*regs = priv->regs;
+	struct cpsw_slave_data	*data = priv->data.slave_data + slave_num;
+
+	slave->slave_num = slave_num;
+	slave->data	= data;
+	slave->regs	= regs + data->slave_reg_ofs;
+	slave->sliver	= regs + data->sliver_reg_ofs;
+}
+
+int cpsw_register(struct cpsw_platform_data *data)
+{
+	struct cpsw_priv	*priv;
+	void			*regs = (void *)data->cpsw_base;
+	struct eth_device	*dev;
+
+	dev = malloc(sizeof(*dev));
+	if (!dev)
+		return -ENOMEM;
+	memset(dev, 0, sizeof(*dev));
+
+	priv = malloc(sizeof(*priv));
+	if (!priv) {
+		free(dev);
+		return -ENOMEM;
+	}
+	memset(priv, 0, sizeof(*priv));
+
+	priv->data = *data;
+	priv->dev  = dev;
+
+	priv->slaves = malloc(sizeof(struct cpsw_slave) * data->slaves);
+	if (!priv->slaves) {
+		free(dev);
+		free(priv);
+		return -ENOMEM;
+	}
+
+	priv->host_port		= data->slaves;
+	priv->regs		= regs;
+	priv->host_port_regs	= regs + data->host_port_reg_ofs;
+	priv->dma_regs		= regs + data->cpdma_reg_ofs;
+	priv->ale_regs		= regs + data->ale_reg_ofs;
+
+	for_each_slave(priv, cpsw_slave_setup, idx, priv);
+
+	strcpy(dev->name, "cpsw");
+	dev->iobase	= 0;
+	dev->init	= cpsw_init;
+	dev->halt	= cpsw_halt;
+	dev->send	= cpsw_send;
+	dev->recv	= cpsw_recv;
+	dev->priv	= priv;
+
+	eth_register(dev);
+
+	cpsw_mdio_init(dev->name, data->mdio_base, data->mdio_div);
+
+	return 1;
+}
diff --git a/include/netdev.h b/include/netdev.h
index 96c7b9b..740213e 100644
--- a/include/netdev.h
+++ b/include/netdev.h
@@ -185,4 +185,33 @@  struct mv88e61xx_config {
 int mv88e61xx_switch_initialize(struct mv88e61xx_config *swconfig);
 #endif /* CONFIG_MV88E61XX_SWITCH */
 
+#ifdef CONFIG_DRIVER_TI_CPSW
+
+struct cpsw_slave_data {
+	u32		slave_reg_ofs;
+	u32		sliver_reg_ofs;
+	int		phy_id;
+};
+
+struct cpsw_platform_data {
+	u32	mdio_base;
+	u32	cpsw_base;
+	int	mdio_div;
+	int	channels;       /* number of cpdma channels (symmetric)	*/
+	u32     cpdma_reg_ofs;  /* cpdma register offset		*/
+	int     slaves;         /* number of slave cpgmac ports		*/
+	u32     ale_reg_ofs;    /* address lookup engine reg offset	*/
+	int     ale_entries;	/* ale table size			*/
+	u32	host_port_reg_ofs;	/* cpdma host port registers	*/
+	u32	hw_stats_reg_ofs;	/* cpsw hw stats counters	*/
+	u32	mac_control;
+	struct cpsw_slave_data  *slave_data;
+	void	(*control)(int enabled);
+	void	(*phy_init)(char *name, int addr);
+};
+
+int cpsw_register(struct cpsw_platform_data *data);
+
+#endif /* CONFIG_DRIVER_TI_CPSW */
+
 #endif /* _NETDEV_H_ */