drivers: net: cpsw: convert driver to adopt device driver model
adopt cpsw driver to device driver model Signed-off-by: Mugunthan V N <mugunthanvnm@ti.com> Reviewed-by: Simon Glass <sjg@chromium.org>
This commit is contained in:
Mugunthan V N
Tom Rini
parent
bcd5eedf8f
commit
4cc77895eb
|
|
@ -25,6 +25,9 @@
|
|||
#include <asm/io.h>
|
||||
#include <phy.h>
|
||||
#include <asm/arch/cpu.h>
|
||||
#include <dm.h>
|
||||
|
||||
DECLARE_GLOBAL_DATA_PTR;
|
||||
|
||||
#define BITMASK(bits) (BIT(bits) - 1)
|
||||
#define PHY_REG_MASK 0x1f
|
||||
|
|
@ -37,6 +40,23 @@
|
|||
#define FULLDUPLEXEN BIT(0)
|
||||
#define MIIEN BIT(15)
|
||||
|
||||
/* reg offset */
|
||||
#define CPSW_HOST_PORT_OFFSET 0x108
|
||||
#define CPSW_SLAVE0_OFFSET 0x208
|
||||
#define CPSW_SLAVE1_OFFSET 0x308
|
||||
#define CPSW_SLAVE_SIZE 0x100
|
||||
#define CPSW_CPDMA_OFFSET 0x800
|
||||
#define CPSW_HW_STATS 0x900
|
||||
#define CPSW_STATERAM_OFFSET 0xa00
|
||||
#define CPSW_CPTS_OFFSET 0xc00
|
||||
#define CPSW_ALE_OFFSET 0xd00
|
||||
#define CPSW_SLIVER0_OFFSET 0xd80
|
||||
#define CPSW_SLIVER1_OFFSET 0xdc0
|
||||
#define CPSW_BD_OFFSET 0x2000
|
||||
#define CPSW_MDIO_DIV 0xff
|
||||
|
||||
#define AM335X_GMII_SEL_OFFSET 0x630
|
||||
|
||||
/* DMA Registers */
|
||||
#define CPDMA_TXCONTROL 0x004
|
||||
#define CPDMA_RXCONTROL 0x014
|
||||
|
|
@ -218,7 +238,11 @@ struct cpdma_chan {
|
|||
(priv)->data.slaves; slave++)
|
||||
|
||||
struct cpsw_priv {
|
||||
#ifdef CONFIG_DM_ETH
|
||||
struct udevice *dev;
|
||||
#else
|
||||
struct eth_device *dev;
|
||||
#endif
|
||||
struct cpsw_platform_data data;
|
||||
int host_port;
|
||||
|
||||
|
|
@ -522,7 +546,7 @@ static int cpsw_mdio_write(struct mii_dev *bus, int phy_id, int dev_addr,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void cpsw_mdio_init(char *name, u32 mdio_base, u32 div)
|
||||
static void cpsw_mdio_init(const char *name, u32 mdio_base, u32 div)
|
||||
{
|
||||
struct mii_dev *bus = mdio_alloc();
|
||||
|
||||
|
|
@ -563,8 +587,15 @@ static inline void setbit_and_wait_for_clear32(void *addr)
|
|||
static void cpsw_set_slave_mac(struct cpsw_slave *slave,
|
||||
struct cpsw_priv *priv)
|
||||
{
|
||||
#ifdef CONFIG_DM_ETH
|
||||
struct eth_pdata *pdata = dev_get_platdata(priv->dev);
|
||||
|
||||
writel(mac_hi(pdata->enetaddr), &slave->regs->sa_hi);
|
||||
writel(mac_lo(pdata->enetaddr), &slave->regs->sa_lo);
|
||||
#else
|
||||
__raw_writel(mac_hi(priv->dev->enetaddr), &slave->regs->sa_hi);
|
||||
__raw_writel(mac_lo(priv->dev->enetaddr), &slave->regs->sa_lo);
|
||||
#endif
|
||||
}
|
||||
|
||||
static void cpsw_slave_update_link(struct cpsw_slave *slave,
|
||||
|
|
@ -973,6 +1004,7 @@ int _cpsw_register(struct cpsw_priv *priv)
|
|||
return 0;
|
||||
}
|
||||
|
||||
#ifndef CONFIG_DM_ETH
|
||||
static int cpsw_init(struct eth_device *dev, bd_t *bis)
|
||||
{
|
||||
struct cpsw_priv *priv = dev->priv;
|
||||
|
|
@ -1049,3 +1081,214 @@ int cpsw_register(struct cpsw_platform_data *data)
|
|||
|
||||
return 1;
|
||||
}
|
||||
#else
|
||||
static int cpsw_eth_start(struct udevice *dev)
|
||||
{
|
||||
struct eth_pdata *pdata = dev_get_platdata(dev);
|
||||
struct cpsw_priv *priv = dev_get_priv(dev);
|
||||
|
||||
return _cpsw_init(priv, pdata->enetaddr);
|
||||
}
|
||||
|
||||
static int cpsw_eth_send(struct udevice *dev, void *packet, int length)
|
||||
{
|
||||
struct cpsw_priv *priv = dev_get_priv(dev);
|
||||
|
||||
return _cpsw_send(priv, packet, length);
|
||||
}
|
||||
|
||||
static int cpsw_eth_recv(struct udevice *dev, int flags, uchar **packetp)
|
||||
{
|
||||
struct cpsw_priv *priv = dev_get_priv(dev);
|
||||
|
||||
return _cpsw_recv(priv, packetp);
|
||||
}
|
||||
|
||||
static int cpsw_eth_free_pkt(struct udevice *dev, uchar *packet,
|
||||
int length)
|
||||
{
|
||||
struct cpsw_priv *priv = dev_get_priv(dev);
|
||||
|
||||
return cpdma_submit(priv, &priv->rx_chan, packet, PKTSIZE);
|
||||
}
|
||||
|
||||
static void cpsw_eth_stop(struct udevice *dev)
|
||||
{
|
||||
struct cpsw_priv *priv = dev_get_priv(dev);
|
||||
|
||||
return _cpsw_halt(priv);
|
||||
}
|
||||
|
||||
|
||||
static int cpsw_eth_probe(struct udevice *dev)
|
||||
{
|
||||
struct cpsw_priv *priv = dev_get_priv(dev);
|
||||
|
||||
priv->dev = dev;
|
||||
|
||||
return _cpsw_register(priv);
|
||||
}
|
||||
|
||||
static const struct eth_ops cpsw_eth_ops = {
|
||||
.start = cpsw_eth_start,
|
||||
.send = cpsw_eth_send,
|
||||
.recv = cpsw_eth_recv,
|
||||
.free_pkt = cpsw_eth_free_pkt,
|
||||
.stop = cpsw_eth_stop,
|
||||
};
|
||||
|
||||
static int cpsw_eth_ofdata_to_platdata(struct udevice *dev)
|
||||
{
|
||||
struct eth_pdata *pdata = dev_get_platdata(dev);
|
||||
struct cpsw_priv *priv = dev_get_priv(dev);
|
||||
const char *phy_mode;
|
||||
const void *fdt = gd->fdt_blob;
|
||||
int node = dev->of_offset;
|
||||
int subnode;
|
||||
int slave_index = 0;
|
||||
uint32_t mac_hi, mac_lo;
|
||||
fdt32_t gmii = 0;
|
||||
int active_slave;
|
||||
|
||||
pdata->iobase = dev_get_addr(dev);
|
||||
priv->data.version = CPSW_CTRL_VERSION_2;
|
||||
priv->data.bd_ram_ofs = CPSW_BD_OFFSET;
|
||||
priv->data.ale_reg_ofs = CPSW_ALE_OFFSET;
|
||||
priv->data.cpdma_reg_ofs = CPSW_CPDMA_OFFSET;
|
||||
priv->data.mdio_div = CPSW_MDIO_DIV;
|
||||
priv->data.host_port_reg_ofs = CPSW_HOST_PORT_OFFSET,
|
||||
|
||||
pdata->phy_interface = -1;
|
||||
|
||||
priv->data.cpsw_base = pdata->iobase;
|
||||
priv->data.channels = fdtdec_get_int(fdt, node, "cpdma_channels", -1);
|
||||
if (priv->data.channels <= 0) {
|
||||
printf("error: cpdma_channels not found in dt\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
priv->data.slaves = fdtdec_get_int(fdt, node, "slaves", -1);
|
||||
if (priv->data.slaves <= 0) {
|
||||
printf("error: slaves not found in dt\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
priv->data.slave_data = malloc(sizeof(struct cpsw_slave_data) *
|
||||
priv->data.slaves);
|
||||
|
||||
priv->data.ale_entries = fdtdec_get_int(fdt, node, "ale_entries", -1);
|
||||
if (priv->data.ale_entries <= 0) {
|
||||
printf("error: ale_entries not found in dt\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
priv->data.bd_ram_ofs = fdtdec_get_int(fdt, node, "bd_ram_size", -1);
|
||||
if (priv->data.bd_ram_ofs <= 0) {
|
||||
printf("error: bd_ram_size not found in dt\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
priv->data.mac_control = fdtdec_get_int(fdt, node, "mac_control", -1);
|
||||
if (priv->data.mac_control <= 0) {
|
||||
printf("error: ale_entries not found in dt\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
active_slave = fdtdec_get_int(fdt, node, "active_slave", 0);
|
||||
priv->data.active_slave = active_slave;
|
||||
|
||||
fdt_for_each_subnode(fdt, subnode, node) {
|
||||
int len;
|
||||
const char *name;
|
||||
|
||||
name = fdt_get_name(fdt, subnode, &len);
|
||||
if (!strncmp(name, "mdio", 4)) {
|
||||
priv->data.mdio_base = fdtdec_get_addr(fdt, subnode,
|
||||
"reg");
|
||||
}
|
||||
|
||||
if (!strncmp(name, "slave", 5)) {
|
||||
u32 phy_id[2];
|
||||
|
||||
if (slave_index >= priv->data.slaves) {
|
||||
printf("error: num slaves and slave nodes did not match\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
phy_mode = fdt_getprop(fdt, subnode, "phy-mode", NULL);
|
||||
if (phy_mode)
|
||||
priv->data.slave_data[slave_index].phy_if =
|
||||
phy_get_interface_by_name(phy_mode);
|
||||
fdtdec_get_int_array(fdt, subnode, "phy_id", phy_id, 2);
|
||||
priv->data.slave_data[slave_index].phy_addr = phy_id[1];
|
||||
slave_index++;
|
||||
}
|
||||
|
||||
if (!strncmp(name, "cpsw-phy-sel", 12)) {
|
||||
priv->data.gmii_sel = fdtdec_get_addr(fdt, subnode,
|
||||
"reg");
|
||||
}
|
||||
}
|
||||
|
||||
priv->data.slave_data[0].slave_reg_ofs = CPSW_SLAVE0_OFFSET;
|
||||
priv->data.slave_data[0].sliver_reg_ofs = CPSW_SLIVER0_OFFSET;
|
||||
|
||||
if (priv->data.slaves == 2) {
|
||||
priv->data.slave_data[1].slave_reg_ofs = CPSW_SLAVE1_OFFSET;
|
||||
priv->data.slave_data[1].sliver_reg_ofs = CPSW_SLIVER1_OFFSET;
|
||||
}
|
||||
|
||||
subnode = fdtdec_lookup_phandle(fdt, node, "syscon");
|
||||
priv->data.mac_id = fdt_translate_address((void *)fdt, subnode, &gmii);
|
||||
priv->data.mac_id += AM335X_GMII_SEL_OFFSET;
|
||||
priv->data.mac_id += active_slave * 8;
|
||||
|
||||
/* try reading mac address from efuse */
|
||||
mac_lo = readl(priv->data.mac_id);
|
||||
mac_hi = readl(priv->data.mac_id + 4);
|
||||
pdata->enetaddr[0] = mac_hi & 0xFF;
|
||||
pdata->enetaddr[1] = (mac_hi & 0xFF00) >> 8;
|
||||
pdata->enetaddr[2] = (mac_hi & 0xFF0000) >> 16;
|
||||
pdata->enetaddr[3] = (mac_hi & 0xFF000000) >> 24;
|
||||
pdata->enetaddr[4] = mac_lo & 0xFF;
|
||||
pdata->enetaddr[5] = (mac_lo & 0xFF00) >> 8;
|
||||
|
||||
pdata->phy_interface = priv->data.slave_data[active_slave].phy_if;
|
||||
if (pdata->phy_interface == -1) {
|
||||
debug("%s: Invalid PHY interface '%s'\n", __func__, phy_mode);
|
||||
return -EINVAL;
|
||||
}
|
||||
switch (pdata->phy_interface) {
|
||||
case PHY_INTERFACE_MODE_MII:
|
||||
writel(MII_MODE_ENABLE, priv->data.gmii_sel);
|
||||
break;
|
||||
case PHY_INTERFACE_MODE_RMII:
|
||||
writel(RMII_MODE_ENABLE, priv->data.gmii_sel);
|
||||
break;
|
||||
case PHY_INTERFACE_MODE_RGMII:
|
||||
case PHY_INTERFACE_MODE_RGMII_ID:
|
||||
case PHY_INTERFACE_MODE_RGMII_RXID:
|
||||
case PHY_INTERFACE_MODE_RGMII_TXID:
|
||||
writel(RGMII_MODE_ENABLE, priv->data.gmii_sel);
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static const struct udevice_id cpsw_eth_ids[] = {
|
||||
{ .compatible = "ti,cpsw" },
|
||||
{ .compatible = "ti,am335x-cpsw" },
|
||||
{ }
|
||||
};
|
||||
|
||||
U_BOOT_DRIVER(eth_cpsw) = {
|
||||
.name = "eth_cpsw",
|
||||
.id = UCLASS_ETH,
|
||||
.of_match = cpsw_eth_ids,
|
||||
.ofdata_to_platdata = cpsw_eth_ofdata_to_platdata,
|
||||
.probe = cpsw_eth_probe,
|
||||
.ops = &cpsw_eth_ops,
|
||||
.priv_auto_alloc_size = sizeof(struct cpsw_priv),
|
||||
.platdata_auto_alloc_size = sizeof(struct eth_pdata),
|
||||
.flags = DM_FLAG_ALLOC_PRIV_DMA,
|
||||
};
|
||||
#endif /* CONFIG_DM_ETH */
|
||||
|
|
|
|||
|
|
@ -31,6 +31,8 @@ enum {
|
|||
struct cpsw_platform_data {
|
||||
u32 mdio_base;
|
||||
u32 cpsw_base;
|
||||
u32 mac_id;
|
||||
u32 gmii_sel;
|
||||
int mdio_div;
|
||||
int channels; /* number of cpdma channels (symmetric) */
|
||||
u32 cpdma_reg_ofs; /* cpdma register offset */
|
||||
|
|
|
|||
Loading…
Reference in New Issue