Commit 9269e556 authored by Fugang Duan's avatar Fugang Duan Committed by David S. Miller

net: fec: add phy-reset-gpios PROBE_DEFER check

Many boards use i2c/spi expander gpio as phy-reset-gpios and these
gpios maybe registered after fec port, driver should check the return
value of .of_get_named_gpio().
Signed-off-by: default avatarFugang Duan <B38611@freescale.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 94920128
...@@ -3187,7 +3187,7 @@ static int fec_enet_init(struct net_device *ndev) ...@@ -3187,7 +3187,7 @@ static int fec_enet_init(struct net_device *ndev)
} }
#ifdef CONFIG_OF #ifdef CONFIG_OF
static void fec_reset_phy(struct platform_device *pdev) static int fec_reset_phy(struct platform_device *pdev)
{ {
int err, phy_reset; int err, phy_reset;
bool active_high = false; bool active_high = false;
...@@ -3195,7 +3195,7 @@ static void fec_reset_phy(struct platform_device *pdev) ...@@ -3195,7 +3195,7 @@ static void fec_reset_phy(struct platform_device *pdev)
struct device_node *np = pdev->dev.of_node; struct device_node *np = pdev->dev.of_node;
if (!np) if (!np)
return; return 0;
err = of_property_read_u32(np, "phy-reset-duration", &msec); err = of_property_read_u32(np, "phy-reset-duration", &msec);
/* A sane reset duration should not be longer than 1s */ /* A sane reset duration should not be longer than 1s */
...@@ -3203,8 +3203,10 @@ static void fec_reset_phy(struct platform_device *pdev) ...@@ -3203,8 +3203,10 @@ static void fec_reset_phy(struct platform_device *pdev)
msec = 1; msec = 1;
phy_reset = of_get_named_gpio(np, "phy-reset-gpios", 0); phy_reset = of_get_named_gpio(np, "phy-reset-gpios", 0);
if (!gpio_is_valid(phy_reset)) if (phy_reset == -EPROBE_DEFER)
return; return phy_reset;
else if (!gpio_is_valid(phy_reset))
return 0;
active_high = of_property_read_bool(np, "phy-reset-active-high"); active_high = of_property_read_bool(np, "phy-reset-active-high");
...@@ -3213,7 +3215,7 @@ static void fec_reset_phy(struct platform_device *pdev) ...@@ -3213,7 +3215,7 @@ static void fec_reset_phy(struct platform_device *pdev)
"phy-reset"); "phy-reset");
if (err) { if (err) {
dev_err(&pdev->dev, "failed to get phy-reset-gpios: %d\n", err); dev_err(&pdev->dev, "failed to get phy-reset-gpios: %d\n", err);
return; return err;
} }
if (msec > 20) if (msec > 20)
...@@ -3222,14 +3224,17 @@ static void fec_reset_phy(struct platform_device *pdev) ...@@ -3222,14 +3224,17 @@ static void fec_reset_phy(struct platform_device *pdev)
usleep_range(msec * 1000, msec * 1000 + 1000); usleep_range(msec * 1000, msec * 1000 + 1000);
gpio_set_value_cansleep(phy_reset, !active_high); gpio_set_value_cansleep(phy_reset, !active_high);
return 0;
} }
#else /* CONFIG_OF */ #else /* CONFIG_OF */
static void fec_reset_phy(struct platform_device *pdev) static int fec_reset_phy(struct platform_device *pdev)
{ {
/* /*
* In case of platform probe, the reset has been done * In case of platform probe, the reset has been done
* by machine code. * by machine code.
*/ */
return 0;
} }
#endif /* CONFIG_OF */ #endif /* CONFIG_OF */
...@@ -3400,6 +3405,7 @@ fec_probe(struct platform_device *pdev) ...@@ -3400,6 +3405,7 @@ fec_probe(struct platform_device *pdev)
if (ret) { if (ret) {
dev_err(&pdev->dev, dev_err(&pdev->dev,
"Failed to enable phy regulator: %d\n", ret); "Failed to enable phy regulator: %d\n", ret);
clk_disable_unprepare(fep->clk_ipg);
goto failed_regulator; goto failed_regulator;
} }
} else { } else {
...@@ -3412,7 +3418,9 @@ fec_probe(struct platform_device *pdev) ...@@ -3412,7 +3418,9 @@ fec_probe(struct platform_device *pdev)
pm_runtime_set_active(&pdev->dev); pm_runtime_set_active(&pdev->dev);
pm_runtime_enable(&pdev->dev); pm_runtime_enable(&pdev->dev);
fec_reset_phy(pdev); ret = fec_reset_phy(pdev);
if (ret)
goto failed_reset;
if (fep->bufdesc_ex) if (fep->bufdesc_ex)
fec_ptp_init(pdev); fec_ptp_init(pdev);
...@@ -3473,8 +3481,10 @@ fec_probe(struct platform_device *pdev) ...@@ -3473,8 +3481,10 @@ fec_probe(struct platform_device *pdev)
fec_ptp_stop(pdev); fec_ptp_stop(pdev);
if (fep->reg_phy) if (fep->reg_phy)
regulator_disable(fep->reg_phy); regulator_disable(fep->reg_phy);
failed_reset:
pm_runtime_put(&pdev->dev);
pm_runtime_disable(&pdev->dev);
failed_regulator: failed_regulator:
clk_disable_unprepare(fep->clk_ipg);
failed_clk_ipg: failed_clk_ipg:
fec_enet_clk_enable(ndev, false); fec_enet_clk_enable(ndev, false);
failed_clk: failed_clk:
......
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