Commit 702eca02 authored by Ben Dooks's avatar Ben Dooks Committed by David S. Miller

sh_eth: update OF PHY registeration

If the sh_eth device is registered using OF, then the driver
should call of_mdiobus_register() to register the PHYs described
in the devicetree and then use of_phy_connect() to connect the
PHYs to the device.

This ensures that any PHYs registered in the device tree are
appropriately connected to the parent devices nodes so that
the PHY drivers can access their OF properties.
Signed-off-by: default avatarBen Dooks <ben.dooks@codethink.co.uk>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent d59b7d80
...@@ -3,6 +3,7 @@ ...@@ -3,6 +3,7 @@
* Copyright (C) 2006-2012 Nobuhiro Iwamatsu * Copyright (C) 2006-2012 Nobuhiro Iwamatsu
* Copyright (C) 2008-2014 Renesas Solutions Corp. * Copyright (C) 2008-2014 Renesas Solutions Corp.
* Copyright (C) 2013-2014 Cogent Embedded, Inc. * Copyright (C) 2013-2014 Cogent Embedded, Inc.
* Copyright (C) 2014 Codethink Limited
* *
* This program is free software; you can redistribute it and/or modify it * This program is free software; you can redistribute it and/or modify it
* under the terms and conditions of the GNU General Public License, * under the terms and conditions of the GNU General Public License,
...@@ -40,6 +41,7 @@ ...@@ -40,6 +41,7 @@
#include <linux/if_vlan.h> #include <linux/if_vlan.h>
#include <linux/clk.h> #include <linux/clk.h>
#include <linux/sh_eth.h> #include <linux/sh_eth.h>
#include <linux/of_mdio.h>
#include "sh_eth.h" #include "sh_eth.h"
...@@ -1761,22 +1763,37 @@ static void sh_eth_adjust_link(struct net_device *ndev) ...@@ -1761,22 +1763,37 @@ static void sh_eth_adjust_link(struct net_device *ndev)
/* PHY init function */ /* PHY init function */
static int sh_eth_phy_init(struct net_device *ndev) static int sh_eth_phy_init(struct net_device *ndev)
{ {
struct device_node *np = ndev->dev.parent->of_node;
struct sh_eth_private *mdp = netdev_priv(ndev); struct sh_eth_private *mdp = netdev_priv(ndev);
char phy_id[MII_BUS_ID_SIZE + 3];
struct phy_device *phydev = NULL; struct phy_device *phydev = NULL;
snprintf(phy_id, sizeof(phy_id), PHY_ID_FMT,
mdp->mii_bus->id, mdp->phy_id);
mdp->link = 0; mdp->link = 0;
mdp->speed = 0; mdp->speed = 0;
mdp->duplex = -1; mdp->duplex = -1;
/* Try connect to PHY */ /* Try connect to PHY */
if (np) {
struct device_node *pn;
pn = of_parse_phandle(np, "phy-handle", 0);
phydev = of_phy_connect(ndev, pn,
sh_eth_adjust_link, 0,
mdp->phy_interface);
if (!phydev)
phydev = ERR_PTR(-ENOENT);
} else {
char phy_id[MII_BUS_ID_SIZE + 3];
snprintf(phy_id, sizeof(phy_id), PHY_ID_FMT,
mdp->mii_bus->id, mdp->phy_id);
phydev = phy_connect(ndev, phy_id, sh_eth_adjust_link, phydev = phy_connect(ndev, phy_id, sh_eth_adjust_link,
mdp->phy_interface); mdp->phy_interface);
}
if (IS_ERR(phydev)) { if (IS_ERR(phydev)) {
dev_err(&ndev->dev, "phy_connect failed\n"); dev_err(&ndev->dev, "failed to connect PHY\n");
return PTR_ERR(phydev); return PTR_ERR(phydev);
} }
...@@ -2638,13 +2655,19 @@ static int sh_mdio_init(struct net_device *ndev, int id, ...@@ -2638,13 +2655,19 @@ static int sh_mdio_init(struct net_device *ndev, int id,
goto out_free_bus; goto out_free_bus;
} }
/* register mdio bus */
if (ndev->dev.parent->of_node) {
ret = of_mdiobus_register(mdp->mii_bus,
ndev->dev.parent->of_node);
} else {
for (i = 0; i < PHY_MAX_ADDR; i++) for (i = 0; i < PHY_MAX_ADDR; i++)
mdp->mii_bus->irq[i] = PHY_POLL; mdp->mii_bus->irq[i] = PHY_POLL;
if (pd->phy_irq > 0) if (pd->phy_irq > 0)
mdp->mii_bus->irq[pd->phy] = pd->phy_irq; mdp->mii_bus->irq[pd->phy] = pd->phy_irq;
/* register mdio bus */
ret = mdiobus_register(mdp->mii_bus); ret = mdiobus_register(mdp->mii_bus);
}
if (ret) if (ret)
goto out_free_bus; goto out_free_bus;
...@@ -2719,7 +2742,6 @@ static struct sh_eth_plat_data *sh_eth_parse_dt(struct device *dev) ...@@ -2719,7 +2742,6 @@ static struct sh_eth_plat_data *sh_eth_parse_dt(struct device *dev)
{ {
struct device_node *np = dev->of_node; struct device_node *np = dev->of_node;
struct sh_eth_plat_data *pdata; struct sh_eth_plat_data *pdata;
struct device_node *phy;
const char *mac_addr; const char *mac_addr;
pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL); pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
...@@ -2728,11 +2750,6 @@ static struct sh_eth_plat_data *sh_eth_parse_dt(struct device *dev) ...@@ -2728,11 +2750,6 @@ static struct sh_eth_plat_data *sh_eth_parse_dt(struct device *dev)
pdata->phy_interface = of_get_phy_mode(np); pdata->phy_interface = of_get_phy_mode(np);
phy = of_parse_phandle(np, "phy-handle", 0);
if (of_property_read_u32(phy, "reg", &pdata->phy))
return NULL;
pdata->phy_irq = irq_of_parse_and_map(phy, 0);
mac_addr = of_get_mac_address(np); mac_addr = of_get_mac_address(np);
if (mac_addr) if (mac_addr)
memcpy(pdata->mac_addr, mac_addr, ETH_ALEN); memcpy(pdata->mac_addr, mac_addr, ETH_ALEN);
...@@ -2896,8 +2913,10 @@ static int sh_eth_drv_probe(struct platform_device *pdev) ...@@ -2896,8 +2913,10 @@ static int sh_eth_drv_probe(struct platform_device *pdev)
/* mdio bus init */ /* mdio bus init */
ret = sh_mdio_init(ndev, pdev->id, pd); ret = sh_mdio_init(ndev, pdev->id, pd);
if (ret) if (ret) {
dev_err(&ndev->dev, "failed to initialise MDIO\n");
goto out_unregister; goto out_unregister;
}
/* print device information */ /* print device information */
pr_info("Base address at 0x%x, %pM, IRQ %d.\n", pr_info("Base address at 0x%x, %pM, IRQ %d.\n",
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment