net: davinci_emac: switch to new mdio
This patch switches the emac implementation over to the newly separated MDIO driver. With this, the mdio bus frequency defaults to a safe 2.2MHz. Boards may optionally specify a bus frequency via platform data. The phy identification scheme has been modified to use a phy bus id instead of a mask. This largely serves to eliminate the "phy search" code in emac init. Signed-off-by: Cyril Chemparathy <cyril@ti.com> Acked-by: David S. Miller <davem@davemloft.net> Tested-by: Michael Williamson <michael.williamson@criticallink.com> Tested-by: Caglar Akyuz <caglarakyuz@gmail.com> Signed-off-by: Kevin Hilman <khilman@deeprootsystems.com>
This commit is contained in:
parent
433cdb0ac4
commit
5d69e0076a
@ -951,6 +951,7 @@ config NET_NETX
|
|||||||
config TI_DAVINCI_EMAC
|
config TI_DAVINCI_EMAC
|
||||||
tristate "TI DaVinci EMAC Support"
|
tristate "TI DaVinci EMAC Support"
|
||||||
depends on ARM && ( ARCH_DAVINCI || ARCH_OMAP3 )
|
depends on ARM && ( ARCH_DAVINCI || ARCH_OMAP3 )
|
||||||
|
select TI_DAVINCI_MDIO
|
||||||
select PHYLIB
|
select PHYLIB
|
||||||
help
|
help
|
||||||
This driver supports TI's DaVinci Ethernet .
|
This driver supports TI's DaVinci Ethernet .
|
||||||
|
@ -500,6 +500,7 @@ struct emac_priv {
|
|||||||
u32 phy_mask;
|
u32 phy_mask;
|
||||||
/* mii_bus,phy members */
|
/* mii_bus,phy members */
|
||||||
struct mii_bus *mii_bus;
|
struct mii_bus *mii_bus;
|
||||||
|
const char *phy_id;
|
||||||
struct phy_device *phydev;
|
struct phy_device *phydev;
|
||||||
spinlock_t lock;
|
spinlock_t lock;
|
||||||
/*platform specific members*/
|
/*platform specific members*/
|
||||||
@ -686,7 +687,7 @@ static int emac_get_settings(struct net_device *ndev,
|
|||||||
struct ethtool_cmd *ecmd)
|
struct ethtool_cmd *ecmd)
|
||||||
{
|
{
|
||||||
struct emac_priv *priv = netdev_priv(ndev);
|
struct emac_priv *priv = netdev_priv(ndev);
|
||||||
if (priv->phy_mask)
|
if (priv->phydev)
|
||||||
return phy_ethtool_gset(priv->phydev, ecmd);
|
return phy_ethtool_gset(priv->phydev, ecmd);
|
||||||
else
|
else
|
||||||
return -EOPNOTSUPP;
|
return -EOPNOTSUPP;
|
||||||
@ -704,7 +705,7 @@ static int emac_get_settings(struct net_device *ndev,
|
|||||||
static int emac_set_settings(struct net_device *ndev, struct ethtool_cmd *ecmd)
|
static int emac_set_settings(struct net_device *ndev, struct ethtool_cmd *ecmd)
|
||||||
{
|
{
|
||||||
struct emac_priv *priv = netdev_priv(ndev);
|
struct emac_priv *priv = netdev_priv(ndev);
|
||||||
if (priv->phy_mask)
|
if (priv->phydev)
|
||||||
return phy_ethtool_sset(priv->phydev, ecmd);
|
return phy_ethtool_sset(priv->phydev, ecmd);
|
||||||
else
|
else
|
||||||
return -EOPNOTSUPP;
|
return -EOPNOTSUPP;
|
||||||
@ -841,7 +842,7 @@ static void emac_update_phystatus(struct emac_priv *priv)
|
|||||||
mac_control = emac_read(EMAC_MACCONTROL);
|
mac_control = emac_read(EMAC_MACCONTROL);
|
||||||
cur_duplex = (mac_control & EMAC_MACCONTROL_FULLDUPLEXEN) ?
|
cur_duplex = (mac_control & EMAC_MACCONTROL_FULLDUPLEXEN) ?
|
||||||
DUPLEX_FULL : DUPLEX_HALF;
|
DUPLEX_FULL : DUPLEX_HALF;
|
||||||
if (priv->phy_mask)
|
if (priv->phydev)
|
||||||
new_duplex = priv->phydev->duplex;
|
new_duplex = priv->phydev->duplex;
|
||||||
else
|
else
|
||||||
new_duplex = DUPLEX_FULL;
|
new_duplex = DUPLEX_FULL;
|
||||||
@ -2485,6 +2486,11 @@ static int emac_devioctl(struct net_device *ndev, struct ifreq *ifrq, int cmd)
|
|||||||
return -EOPNOTSUPP;
|
return -EOPNOTSUPP;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int match_first_device(struct device *dev, void *data)
|
||||||
|
{
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* emac_dev_open: EMAC device open
|
* emac_dev_open: EMAC device open
|
||||||
* @ndev: The DaVinci EMAC network adapter
|
* @ndev: The DaVinci EMAC network adapter
|
||||||
@ -2499,7 +2505,6 @@ static int emac_dev_open(struct net_device *ndev)
|
|||||||
{
|
{
|
||||||
struct device *emac_dev = &ndev->dev;
|
struct device *emac_dev = &ndev->dev;
|
||||||
u32 rc, cnt, ch;
|
u32 rc, cnt, ch;
|
||||||
int phy_addr;
|
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
int q, m;
|
int q, m;
|
||||||
int i = 0;
|
int i = 0;
|
||||||
@ -2560,28 +2565,26 @@ static int emac_dev_open(struct net_device *ndev)
|
|||||||
emac_set_coalesce(ndev, &coal);
|
emac_set_coalesce(ndev, &coal);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* find the first phy */
|
|
||||||
priv->phydev = NULL;
|
priv->phydev = NULL;
|
||||||
if (priv->phy_mask) {
|
/* use the first phy on the bus if pdata did not give us a phy id */
|
||||||
emac_mii_reset(priv->mii_bus);
|
if (!priv->phy_id) {
|
||||||
for (phy_addr = 0; phy_addr < PHY_MAX_ADDR; phy_addr++) {
|
struct device *phy;
|
||||||
if (priv->mii_bus->phy_map[phy_addr]) {
|
|
||||||
priv->phydev = priv->mii_bus->phy_map[phy_addr];
|
phy = bus_find_device(&mdio_bus_type, NULL, NULL,
|
||||||
break;
|
match_first_device);
|
||||||
}
|
if (phy)
|
||||||
|
priv->phy_id = dev_name(phy);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (!priv->phydev) {
|
if (priv->phy_id && *priv->phy_id) {
|
||||||
printk(KERN_ERR "%s: no PHY found\n", ndev->name);
|
priv->phydev = phy_connect(ndev, priv->phy_id,
|
||||||
return -1;
|
&emac_adjust_link, 0,
|
||||||
}
|
PHY_INTERFACE_MODE_MII);
|
||||||
|
|
||||||
priv->phydev = phy_connect(ndev, dev_name(&priv->phydev->dev),
|
|
||||||
&emac_adjust_link, 0, PHY_INTERFACE_MODE_MII);
|
|
||||||
|
|
||||||
if (IS_ERR(priv->phydev)) {
|
if (IS_ERR(priv->phydev)) {
|
||||||
printk(KERN_ERR "%s: Could not attach to PHY\n",
|
dev_err(emac_dev, "could not connect to phy %s\n",
|
||||||
ndev->name);
|
priv->phy_id);
|
||||||
|
priv->phydev = NULL;
|
||||||
return PTR_ERR(priv->phydev);
|
return PTR_ERR(priv->phydev);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -2589,12 +2592,13 @@ static int emac_dev_open(struct net_device *ndev)
|
|||||||
priv->speed = 0;
|
priv->speed = 0;
|
||||||
priv->duplex = ~0;
|
priv->duplex = ~0;
|
||||||
|
|
||||||
printk(KERN_INFO "%s: attached PHY driver [%s] "
|
dev_info(emac_dev, "attached PHY driver [%s] "
|
||||||
"(mii_bus:phy_addr=%s, id=%x)\n", ndev->name,
|
"(mii_bus:phy_addr=%s, id=%x)\n",
|
||||||
priv->phydev->drv->name, dev_name(&priv->phydev->dev),
|
priv->phydev->drv->name, dev_name(&priv->phydev->dev),
|
||||||
priv->phydev->phy_id);
|
priv->phydev->phy_id);
|
||||||
} else{
|
} else {
|
||||||
/* No PHY , fix the link, speed and duplex settings */
|
/* No PHY , fix the link, speed and duplex settings */
|
||||||
|
dev_notice(emac_dev, "no phy, defaulting to 100/full\n");
|
||||||
priv->link = 1;
|
priv->link = 1;
|
||||||
priv->speed = SPEED_100;
|
priv->speed = SPEED_100;
|
||||||
priv->duplex = DUPLEX_FULL;
|
priv->duplex = DUPLEX_FULL;
|
||||||
@ -2607,7 +2611,7 @@ static int emac_dev_open(struct net_device *ndev)
|
|||||||
if (netif_msg_drv(priv))
|
if (netif_msg_drv(priv))
|
||||||
dev_notice(emac_dev, "DaVinci EMAC: Opened %s\n", ndev->name);
|
dev_notice(emac_dev, "DaVinci EMAC: Opened %s\n", ndev->name);
|
||||||
|
|
||||||
if (priv->phy_mask)
|
if (priv->phydev)
|
||||||
phy_start(priv->phydev);
|
phy_start(priv->phydev);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
@ -2794,7 +2798,7 @@ static int __devinit davinci_emac_probe(struct platform_device *pdev)
|
|||||||
|
|
||||||
/* MAC addr and PHY mask , RMII enable info from platform_data */
|
/* MAC addr and PHY mask , RMII enable info from platform_data */
|
||||||
memcpy(priv->mac_addr, pdata->mac_addr, 6);
|
memcpy(priv->mac_addr, pdata->mac_addr, 6);
|
||||||
priv->phy_mask = pdata->phy_mask;
|
priv->phy_id = pdata->phy_id;
|
||||||
priv->rmii_en = pdata->rmii_en;
|
priv->rmii_en = pdata->rmii_en;
|
||||||
priv->version = pdata->version;
|
priv->version = pdata->version;
|
||||||
priv->int_enable = pdata->interrupt_enable;
|
priv->int_enable = pdata->interrupt_enable;
|
||||||
@ -2871,32 +2875,6 @@ static int __devinit davinci_emac_probe(struct platform_device *pdev)
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/* MII/Phy intialisation, mdio bus registration */
|
|
||||||
emac_mii = mdiobus_alloc();
|
|
||||||
if (emac_mii == NULL) {
|
|
||||||
dev_err(emac_dev, "DaVinci EMAC: Error allocating mii_bus\n");
|
|
||||||
rc = -ENOMEM;
|
|
||||||
goto mdio_alloc_err;
|
|
||||||
}
|
|
||||||
|
|
||||||
priv->mii_bus = emac_mii;
|
|
||||||
emac_mii->name = "emac-mii",
|
|
||||||
emac_mii->read = emac_mii_read,
|
|
||||||
emac_mii->write = emac_mii_write,
|
|
||||||
emac_mii->reset = emac_mii_reset,
|
|
||||||
emac_mii->irq = mii_irqs,
|
|
||||||
emac_mii->phy_mask = ~(priv->phy_mask);
|
|
||||||
emac_mii->parent = &pdev->dev;
|
|
||||||
emac_mii->priv = priv->remap_addr + pdata->mdio_reg_offset;
|
|
||||||
snprintf(priv->mii_bus->id, MII_BUS_ID_SIZE, "%x", priv->pdev->id);
|
|
||||||
mdio_max_freq = pdata->mdio_max_freq;
|
|
||||||
emac_mii->reset(emac_mii);
|
|
||||||
|
|
||||||
/* Register the MII bus */
|
|
||||||
rc = mdiobus_register(emac_mii);
|
|
||||||
if (rc)
|
|
||||||
goto mdiobus_quit;
|
|
||||||
|
|
||||||
if (netif_msg_probe(priv)) {
|
if (netif_msg_probe(priv)) {
|
||||||
dev_notice(emac_dev, "DaVinci EMAC Probe found device "\
|
dev_notice(emac_dev, "DaVinci EMAC Probe found device "\
|
||||||
"(regs: %p, irq: %d)\n",
|
"(regs: %p, irq: %d)\n",
|
||||||
@ -2904,11 +2882,7 @@ static int __devinit davinci_emac_probe(struct platform_device *pdev)
|
|||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
mdiobus_quit:
|
|
||||||
mdiobus_free(emac_mii);
|
|
||||||
|
|
||||||
netdev_reg_err:
|
netdev_reg_err:
|
||||||
mdio_alloc_err:
|
|
||||||
clk_disable(emac_clk);
|
clk_disable(emac_clk);
|
||||||
no_irq_res:
|
no_irq_res:
|
||||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||||
@ -2938,8 +2912,6 @@ static int __devexit davinci_emac_remove(struct platform_device *pdev)
|
|||||||
|
|
||||||
platform_set_drvdata(pdev, NULL);
|
platform_set_drvdata(pdev, NULL);
|
||||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||||
mdiobus_unregister(priv->mii_bus);
|
|
||||||
mdiobus_free(priv->mii_bus);
|
|
||||||
|
|
||||||
release_mem_region(res->start, res->end - res->start + 1);
|
release_mem_region(res->start, res->end - res->start + 1);
|
||||||
|
|
||||||
|
@ -28,6 +28,15 @@ struct emac_platform_data {
|
|||||||
u32 ctrl_ram_size;
|
u32 ctrl_ram_size;
|
||||||
u32 phy_mask;
|
u32 phy_mask;
|
||||||
u32 mdio_max_freq;
|
u32 mdio_max_freq;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* phy_id can be one of the following:
|
||||||
|
* - NULL : use the first phy on the bus,
|
||||||
|
* - "" : force to 100/full, no mdio control
|
||||||
|
* - "<bus>:<addr>" : use the specified bus and phy
|
||||||
|
*/
|
||||||
|
const char *phy_id;
|
||||||
|
|
||||||
u8 rmii_en;
|
u8 rmii_en;
|
||||||
u8 version;
|
u8 version;
|
||||||
void (*interrupt_enable) (void);
|
void (*interrupt_enable) (void);
|
||||||
|
Loading…
Reference in New Issue
Block a user