Commit c3f51d5f authored by David S. Miller's avatar David S. Miller

Merge branch 'fec'

Fabio Estevam says:

====================
This series improves clock handling in the driver by not enabling/disabling
the optional ptp and enet_out clocks unconditionally, check for the return value
of clk_prepare_enable and also handle clk_ptp in suspend/resume.

Remove an unneeded check in platform_get_resource() and also use
devm_request_irq() that can help to simplify the code.
====================
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
Acked-by: default avatarFrank Li <lznuaa@gmail.com>
parents eda29772 0d9b2ab1
...@@ -2033,10 +2033,6 @@ fec_probe(struct platform_device *pdev) ...@@ -2033,10 +2033,6 @@ fec_probe(struct platform_device *pdev)
if (of_id) if (of_id)
pdev->id_entry = of_id->data; pdev->id_entry = of_id->data;
r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (!r)
return -ENXIO;
/* Init network device */ /* Init network device */
ndev = alloc_etherdev(sizeof(struct fec_enet_private)); ndev = alloc_etherdev(sizeof(struct fec_enet_private));
if (!ndev) if (!ndev)
...@@ -2054,6 +2050,7 @@ fec_probe(struct platform_device *pdev) ...@@ -2054,6 +2050,7 @@ fec_probe(struct platform_device *pdev)
fep->pause_flag |= FEC_PAUSE_FLAG_AUTONEG; fep->pause_flag |= FEC_PAUSE_FLAG_AUTONEG;
#endif #endif
r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
fep->hwp = devm_ioremap_resource(&pdev->dev, r); fep->hwp = devm_ioremap_resource(&pdev->dev, r);
if (IS_ERR(fep->hwp)) { if (IS_ERR(fep->hwp)) {
ret = PTR_ERR(fep->hwp); ret = PTR_ERR(fep->hwp);
...@@ -2103,10 +2100,25 @@ fec_probe(struct platform_device *pdev) ...@@ -2103,10 +2100,25 @@ fec_probe(struct platform_device *pdev)
fep->bufdesc_ex = 0; fep->bufdesc_ex = 0;
} }
clk_prepare_enable(fep->clk_ahb); ret = clk_prepare_enable(fep->clk_ahb);
clk_prepare_enable(fep->clk_ipg); if (ret)
clk_prepare_enable(fep->clk_enet_out); goto failed_clk;
clk_prepare_enable(fep->clk_ptp);
ret = clk_prepare_enable(fep->clk_ipg);
if (ret)
goto failed_clk_ipg;
if (fep->clk_enet_out) {
ret = clk_prepare_enable(fep->clk_enet_out);
if (ret)
goto failed_clk_enet_out;
}
if (fep->clk_ptp) {
ret = clk_prepare_enable(fep->clk_ptp);
if (ret)
goto failed_clk_ptp;
}
fep->reg_phy = devm_regulator_get(&pdev->dev, "phy"); fep->reg_phy = devm_regulator_get(&pdev->dev, "phy");
if (!IS_ERR(fep->reg_phy)) { if (!IS_ERR(fep->reg_phy)) {
...@@ -2137,14 +2149,10 @@ fec_probe(struct platform_device *pdev) ...@@ -2137,14 +2149,10 @@ fec_probe(struct platform_device *pdev)
ret = irq; ret = irq;
goto failed_irq; goto failed_irq;
} }
ret = request_irq(irq, fec_enet_interrupt, IRQF_DISABLED, pdev->name, ndev); ret = devm_request_irq(&pdev->dev, irq, fec_enet_interrupt,
if (ret) { IRQF_DISABLED, pdev->name, ndev);
while (--i >= 0) { if (ret)
irq = platform_get_irq(pdev, i);
free_irq(irq, ndev);
}
goto failed_irq; goto failed_irq;
}
} }
ret = fec_enet_mii_init(pdev); ret = fec_enet_mii_init(pdev);
...@@ -2168,19 +2176,19 @@ fec_probe(struct platform_device *pdev) ...@@ -2168,19 +2176,19 @@ fec_probe(struct platform_device *pdev)
fec_enet_mii_remove(fep); fec_enet_mii_remove(fep);
failed_mii_init: failed_mii_init:
failed_irq: failed_irq:
for (i = 0; i < FEC_IRQ_NUM; i++) {
irq = platform_get_irq(pdev, i);
if (irq > 0)
free_irq(irq, ndev);
}
failed_init: failed_init:
if (fep->reg_phy) if (fep->reg_phy)
regulator_disable(fep->reg_phy); regulator_disable(fep->reg_phy);
failed_regulator: failed_regulator:
clk_disable_unprepare(fep->clk_ahb); if (fep->clk_ptp)
clk_disable_unprepare(fep->clk_ptp);
failed_clk_ptp:
if (fep->clk_enet_out)
clk_disable_unprepare(fep->clk_enet_out);
failed_clk_enet_out:
clk_disable_unprepare(fep->clk_ipg); clk_disable_unprepare(fep->clk_ipg);
clk_disable_unprepare(fep->clk_enet_out); failed_clk_ipg:
clk_disable_unprepare(fep->clk_ptp); clk_disable_unprepare(fep->clk_ahb);
failed_clk: failed_clk:
failed_ioremap: failed_ioremap:
free_netdev(ndev); free_netdev(ndev);
...@@ -2193,25 +2201,21 @@ fec_drv_remove(struct platform_device *pdev) ...@@ -2193,25 +2201,21 @@ fec_drv_remove(struct platform_device *pdev)
{ {
struct net_device *ndev = platform_get_drvdata(pdev); struct net_device *ndev = platform_get_drvdata(pdev);
struct fec_enet_private *fep = netdev_priv(ndev); struct fec_enet_private *fep = netdev_priv(ndev);
int i;
cancel_delayed_work_sync(&(fep->delay_work.delay_work)); cancel_delayed_work_sync(&(fep->delay_work.delay_work));
unregister_netdev(ndev); unregister_netdev(ndev);
fec_enet_mii_remove(fep); fec_enet_mii_remove(fep);
del_timer_sync(&fep->time_keep); del_timer_sync(&fep->time_keep);
for (i = 0; i < FEC_IRQ_NUM; i++) {
int irq = platform_get_irq(pdev, i);
if (irq > 0)
free_irq(irq, ndev);
}
if (fep->reg_phy) if (fep->reg_phy)
regulator_disable(fep->reg_phy); regulator_disable(fep->reg_phy);
clk_disable_unprepare(fep->clk_ptp); if (fep->clk_ptp)
clk_disable_unprepare(fep->clk_ptp);
if (fep->ptp_clock) if (fep->ptp_clock)
ptp_clock_unregister(fep->ptp_clock); ptp_clock_unregister(fep->ptp_clock);
clk_disable_unprepare(fep->clk_enet_out); if (fep->clk_enet_out)
clk_disable_unprepare(fep->clk_ahb); clk_disable_unprepare(fep->clk_enet_out);
clk_disable_unprepare(fep->clk_ipg); clk_disable_unprepare(fep->clk_ipg);
clk_disable_unprepare(fep->clk_ahb);
free_netdev(ndev); free_netdev(ndev);
return 0; return 0;
...@@ -2228,9 +2232,12 @@ fec_suspend(struct device *dev) ...@@ -2228,9 +2232,12 @@ fec_suspend(struct device *dev)
fec_stop(ndev); fec_stop(ndev);
netif_device_detach(ndev); netif_device_detach(ndev);
} }
clk_disable_unprepare(fep->clk_enet_out); if (fep->clk_ptp)
clk_disable_unprepare(fep->clk_ahb); clk_disable_unprepare(fep->clk_ptp);
if (fep->clk_enet_out)
clk_disable_unprepare(fep->clk_enet_out);
clk_disable_unprepare(fep->clk_ipg); clk_disable_unprepare(fep->clk_ipg);
clk_disable_unprepare(fep->clk_ahb);
if (fep->reg_phy) if (fep->reg_phy)
regulator_disable(fep->reg_phy); regulator_disable(fep->reg_phy);
...@@ -2251,15 +2258,44 @@ fec_resume(struct device *dev) ...@@ -2251,15 +2258,44 @@ fec_resume(struct device *dev)
return ret; return ret;
} }
clk_prepare_enable(fep->clk_enet_out); ret = clk_prepare_enable(fep->clk_ahb);
clk_prepare_enable(fep->clk_ahb); if (ret)
clk_prepare_enable(fep->clk_ipg); goto failed_clk_ahb;
ret = clk_prepare_enable(fep->clk_ipg);
if (ret)
goto failed_clk_ipg;
if (fep->clk_enet_out) {
ret = clk_prepare_enable(fep->clk_enet_out);
if (ret)
goto failed_clk_enet_out;
}
if (fep->clk_ptp) {
ret = clk_prepare_enable(fep->clk_ptp);
if (ret)
goto failed_clk_ptp;
}
if (netif_running(ndev)) { if (netif_running(ndev)) {
fec_restart(ndev, fep->full_duplex); fec_restart(ndev, fep->full_duplex);
netif_device_attach(ndev); netif_device_attach(ndev);
} }
return 0; return 0;
failed_clk_ptp:
if (fep->clk_enet_out)
clk_disable_unprepare(fep->clk_enet_out);
failed_clk_enet_out:
clk_disable_unprepare(fep->clk_ipg);
failed_clk_ipg:
clk_disable_unprepare(fep->clk_ahb);
failed_clk_ahb:
if (fep->reg_phy)
regulator_disable(fep->reg_phy);
return ret;
} }
#endif /* CONFIG_PM_SLEEP */ #endif /* CONFIG_PM_SLEEP */
......
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