|
@@ -27,6 +27,7 @@
|
|
|
#include <linux/phy.h>
|
|
|
#include <linux/of.h>
|
|
|
#include <linux/of_device.h>
|
|
|
+#include <linux/of_mdio.h>
|
|
|
#include <linux/of_net.h>
|
|
|
#include <linux/pinctrl/consumer.h>
|
|
|
|
|
@@ -314,6 +315,7 @@ static int macb_mii_probe(struct net_device *dev)
|
|
|
int macb_mii_init(struct macb *bp)
|
|
|
{
|
|
|
struct macb_platform_data *pdata;
|
|
|
+ struct device_node *np;
|
|
|
int err = -ENXIO, i;
|
|
|
|
|
|
/* Enable management port */
|
|
@@ -335,21 +337,46 @@ int macb_mii_init(struct macb *bp)
|
|
|
bp->mii_bus->parent = &bp->dev->dev;
|
|
|
pdata = bp->pdev->dev.platform_data;
|
|
|
|
|
|
- if (pdata)
|
|
|
- bp->mii_bus->phy_mask = pdata->phy_mask;
|
|
|
-
|
|
|
bp->mii_bus->irq = kmalloc(sizeof(int)*PHY_MAX_ADDR, GFP_KERNEL);
|
|
|
if (!bp->mii_bus->irq) {
|
|
|
err = -ENOMEM;
|
|
|
goto err_out_free_mdiobus;
|
|
|
}
|
|
|
|
|
|
- for (i = 0; i < PHY_MAX_ADDR; i++)
|
|
|
- bp->mii_bus->irq[i] = PHY_POLL;
|
|
|
-
|
|
|
dev_set_drvdata(&bp->dev->dev, bp->mii_bus);
|
|
|
|
|
|
- if (mdiobus_register(bp->mii_bus))
|
|
|
+ np = bp->pdev->dev.of_node;
|
|
|
+ if (np) {
|
|
|
+ /* try dt phy registration */
|
|
|
+ err = of_mdiobus_register(bp->mii_bus, np);
|
|
|
+
|
|
|
+ /* fallback to standard phy registration if no phy were
|
|
|
+ found during dt phy registration */
|
|
|
+ if (!err && !phy_find_first(bp->mii_bus)) {
|
|
|
+ for (i = 0; i < PHY_MAX_ADDR; i++) {
|
|
|
+ struct phy_device *phydev;
|
|
|
+
|
|
|
+ phydev = mdiobus_scan(bp->mii_bus, i);
|
|
|
+ if (IS_ERR(phydev)) {
|
|
|
+ err = PTR_ERR(phydev);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (err)
|
|
|
+ goto err_out_unregister_bus;
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ for (i = 0; i < PHY_MAX_ADDR; i++)
|
|
|
+ bp->mii_bus->irq[i] = PHY_POLL;
|
|
|
+
|
|
|
+ if (pdata)
|
|
|
+ bp->mii_bus->phy_mask = pdata->phy_mask;
|
|
|
+
|
|
|
+ err = mdiobus_register(bp->mii_bus);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (err)
|
|
|
goto err_out_free_mdio_irq;
|
|
|
|
|
|
if (macb_mii_probe(bp->dev) != 0) {
|