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

Merge branch 'stmmac-devvm_stmmac_probe_config_dt-conversion'

Jisheng Zhang says:

====================
stmmac: convert to devm_stmmac_probe_config_dt

Russell pointed out there's a new devm_stmmac_probe_config_dt()
helper now when reviewing my starfive gmac error handling patch[1].
After greping the code, this nice helper was introduced by Bartosz in
[2], I think it's time to convert all dwmac users to this helper and
finally complete the TODO in [2] "but once all users of the old
stmmac_pltfr_remove() are converted to the devres helper, it will be
renamed back to stmmac_pltfr_remove() and the no_dt function removed."

Link: https://lore.kernel.org/netdev/ZOtWmedBsa6wQQ6+@shell.armlinux.org.uk/ [1]
Link: https://lore.kernel.org/all/20230623100417.93592-1-brgl@bgdev.pl/  [2]

Since v1:
 - rebase on new net-next
 - add make stmmac_{probe|remove}_config_dt static as suggested by Russell.
====================
Reviewed-by: default avatarEmil Renner Berthing <emil.renner.berthing@canonical.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parents e8535bfb b2504f64
...@@ -115,7 +115,7 @@ static int anarion_dwmac_probe(struct platform_device *pdev) ...@@ -115,7 +115,7 @@ static int anarion_dwmac_probe(struct platform_device *pdev)
if (IS_ERR(gmac)) if (IS_ERR(gmac))
return PTR_ERR(gmac); return PTR_ERR(gmac);
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
...@@ -124,13 +124,7 @@ static int anarion_dwmac_probe(struct platform_device *pdev) ...@@ -124,13 +124,7 @@ static int anarion_dwmac_probe(struct platform_device *pdev)
anarion_gmac_init(pdev, gmac); anarion_gmac_init(pdev, gmac);
plat_dat->bsp_priv = gmac; plat_dat->bsp_priv = gmac;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret) {
stmmac_remove_config_dt(pdev, plat_dat);
return ret;
}
return 0;
} }
static const struct of_device_id anarion_dwmac_match[] = { static const struct of_device_id anarion_dwmac_match[] = {
......
...@@ -435,15 +435,14 @@ static int dwc_eth_dwmac_probe(struct platform_device *pdev) ...@@ -435,15 +435,14 @@ static int dwc_eth_dwmac_probe(struct platform_device *pdev)
if (IS_ERR(stmmac_res.addr)) if (IS_ERR(stmmac_res.addr))
return PTR_ERR(stmmac_res.addr); return PTR_ERR(stmmac_res.addr);
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
ret = data->probe(pdev, plat_dat, &stmmac_res); ret = data->probe(pdev, plat_dat, &stmmac_res);
if (ret < 0) { if (ret < 0) {
dev_err_probe(&pdev->dev, ret, "failed to probe subdriver\n"); dev_err_probe(&pdev->dev, ret, "failed to probe subdriver\n");
return ret;
goto remove_config;
} }
ret = dwc_eth_dwmac_config_dt(pdev, plat_dat); ret = dwc_eth_dwmac_config_dt(pdev, plat_dat);
...@@ -458,25 +457,17 @@ static int dwc_eth_dwmac_probe(struct platform_device *pdev) ...@@ -458,25 +457,17 @@ static int dwc_eth_dwmac_probe(struct platform_device *pdev)
remove: remove:
data->remove(pdev); data->remove(pdev);
remove_config:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
static void dwc_eth_dwmac_remove(struct platform_device *pdev) static void dwc_eth_dwmac_remove(struct platform_device *pdev)
{ {
struct net_device *ndev = platform_get_drvdata(pdev); const struct dwc_eth_dwmac_data *data = device_get_match_data(&pdev->dev);
struct stmmac_priv *priv = netdev_priv(ndev);
const struct dwc_eth_dwmac_data *data;
data = device_get_match_data(&pdev->dev);
stmmac_dvr_remove(&pdev->dev); stmmac_dvr_remove(&pdev->dev);
data->remove(pdev); data->remove(pdev);
stmmac_remove_config_dt(pdev, priv->plat);
} }
static const struct of_device_id dwc_eth_dwmac_match[] = { static const struct of_device_id dwc_eth_dwmac_match[] = {
......
...@@ -27,7 +27,7 @@ static int dwmac_generic_probe(struct platform_device *pdev) ...@@ -27,7 +27,7 @@ static int dwmac_generic_probe(struct platform_device *pdev)
return ret; return ret;
if (pdev->dev.of_node) { if (pdev->dev.of_node) {
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) { if (IS_ERR(plat_dat)) {
dev_err(&pdev->dev, "dt configuration failed\n"); dev_err(&pdev->dev, "dt configuration failed\n");
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
...@@ -46,17 +46,7 @@ static int dwmac_generic_probe(struct platform_device *pdev) ...@@ -46,17 +46,7 @@ static int dwmac_generic_probe(struct platform_device *pdev)
plat_dat->unicast_filter_entries = 1; plat_dat->unicast_filter_entries = 1;
} }
ret = stmmac_pltfr_probe(pdev, plat_dat, &stmmac_res); return devm_stmmac_pltfr_probe(pdev, plat_dat, &stmmac_res);
if (ret)
goto err_remove_config_dt;
return 0;
err_remove_config_dt:
if (pdev->dev.of_node)
stmmac_remove_config_dt(pdev, plat_dat);
return ret;
} }
static const struct of_device_id dwmac_generic_match[] = { static const struct of_device_id dwmac_generic_match[] = {
...@@ -77,7 +67,6 @@ MODULE_DEVICE_TABLE(of, dwmac_generic_match); ...@@ -77,7 +67,6 @@ MODULE_DEVICE_TABLE(of, dwmac_generic_match);
static struct platform_driver dwmac_generic_driver = { static struct platform_driver dwmac_generic_driver = {
.probe = dwmac_generic_probe, .probe = dwmac_generic_probe,
.remove_new = stmmac_pltfr_remove,
.driver = { .driver = {
.name = STMMAC_RESOURCE_NAME, .name = STMMAC_RESOURCE_NAME,
.pm = &stmmac_pltfr_pm_ops, .pm = &stmmac_pltfr_pm_ops,
......
...@@ -331,15 +331,14 @@ static int imx_dwmac_probe(struct platform_device *pdev) ...@@ -331,15 +331,14 @@ static int imx_dwmac_probe(struct platform_device *pdev)
if (!dwmac) if (!dwmac)
return -ENOMEM; return -ENOMEM;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
data = of_device_get_match_data(&pdev->dev); data = of_device_get_match_data(&pdev->dev);
if (!data) { if (!data) {
dev_err(&pdev->dev, "failed to get match data\n"); dev_err(&pdev->dev, "failed to get match data\n");
ret = -EINVAL; return -EINVAL;
goto err_match_data;
} }
dwmac->ops = data; dwmac->ops = data;
...@@ -348,7 +347,7 @@ static int imx_dwmac_probe(struct platform_device *pdev) ...@@ -348,7 +347,7 @@ static int imx_dwmac_probe(struct platform_device *pdev)
ret = imx_dwmac_parse_dt(dwmac, &pdev->dev); ret = imx_dwmac_parse_dt(dwmac, &pdev->dev);
if (ret) { if (ret) {
dev_err(&pdev->dev, "failed to parse OF data\n"); dev_err(&pdev->dev, "failed to parse OF data\n");
goto err_parse_dt; return ret;
} }
if (data->flags & STMMAC_FLAG_HWTSTAMP_CORRECT_LATENCY) if (data->flags & STMMAC_FLAG_HWTSTAMP_CORRECT_LATENCY)
...@@ -365,7 +364,7 @@ static int imx_dwmac_probe(struct platform_device *pdev) ...@@ -365,7 +364,7 @@ static int imx_dwmac_probe(struct platform_device *pdev)
ret = imx_dwmac_clks_config(dwmac, true); ret = imx_dwmac_clks_config(dwmac, true);
if (ret) if (ret)
goto err_clks_config; return ret;
ret = imx_dwmac_init(pdev, dwmac); ret = imx_dwmac_init(pdev, dwmac);
if (ret) if (ret)
...@@ -385,10 +384,6 @@ static int imx_dwmac_probe(struct platform_device *pdev) ...@@ -385,10 +384,6 @@ static int imx_dwmac_probe(struct platform_device *pdev)
imx_dwmac_exit(pdev, plat_dat->bsp_priv); imx_dwmac_exit(pdev, plat_dat->bsp_priv);
err_dwmac_init: err_dwmac_init:
imx_dwmac_clks_config(dwmac, false); imx_dwmac_clks_config(dwmac, false);
err_clks_config:
err_parse_dt:
err_match_data:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -241,29 +241,25 @@ static int ingenic_mac_probe(struct platform_device *pdev) ...@@ -241,29 +241,25 @@ static int ingenic_mac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
mac = devm_kzalloc(&pdev->dev, sizeof(*mac), GFP_KERNEL); mac = devm_kzalloc(&pdev->dev, sizeof(*mac), GFP_KERNEL);
if (!mac) { if (!mac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
data = of_device_get_match_data(&pdev->dev); data = of_device_get_match_data(&pdev->dev);
if (!data) { if (!data) {
dev_err(&pdev->dev, "No of match data provided\n"); dev_err(&pdev->dev, "No of match data provided\n");
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
} }
/* Get MAC PHY control register */ /* Get MAC PHY control register */
mac->regmap = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, "mode-reg"); mac->regmap = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, "mode-reg");
if (IS_ERR(mac->regmap)) { if (IS_ERR(mac->regmap)) {
dev_err(&pdev->dev, "%s: Failed to get syscon regmap\n", __func__); dev_err(&pdev->dev, "%s: Failed to get syscon regmap\n", __func__);
ret = PTR_ERR(mac->regmap); return PTR_ERR(mac->regmap);
goto err_remove_config_dt;
} }
if (!of_property_read_u32(pdev->dev.of_node, "tx-clk-delay-ps", &tx_delay_ps)) { if (!of_property_read_u32(pdev->dev.of_node, "tx-clk-delay-ps", &tx_delay_ps)) {
...@@ -272,8 +268,7 @@ static int ingenic_mac_probe(struct platform_device *pdev) ...@@ -272,8 +268,7 @@ static int ingenic_mac_probe(struct platform_device *pdev)
mac->tx_delay = tx_delay_ps * 1000; mac->tx_delay = tx_delay_ps * 1000;
} else { } else {
dev_err(&pdev->dev, "Invalid TX clock delay: %dps\n", tx_delay_ps); dev_err(&pdev->dev, "Invalid TX clock delay: %dps\n", tx_delay_ps);
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
} }
} }
...@@ -283,8 +278,7 @@ static int ingenic_mac_probe(struct platform_device *pdev) ...@@ -283,8 +278,7 @@ static int ingenic_mac_probe(struct platform_device *pdev)
mac->rx_delay = rx_delay_ps * 1000; mac->rx_delay = rx_delay_ps * 1000;
} else { } else {
dev_err(&pdev->dev, "Invalid RX clock delay: %dps\n", rx_delay_ps); dev_err(&pdev->dev, "Invalid RX clock delay: %dps\n", rx_delay_ps);
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
} }
} }
...@@ -295,18 +289,9 @@ static int ingenic_mac_probe(struct platform_device *pdev) ...@@ -295,18 +289,9 @@ static int ingenic_mac_probe(struct platform_device *pdev)
ret = ingenic_mac_init(plat_dat); ret = ingenic_mac_init(plat_dat);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret)
goto err_remove_config_dt;
return 0;
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
} }
#ifdef CONFIG_PM_SLEEP #ifdef CONFIG_PM_SLEEP
......
...@@ -85,17 +85,15 @@ static int intel_eth_plat_probe(struct platform_device *pdev) ...@@ -85,17 +85,15 @@ static int intel_eth_plat_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) { if (IS_ERR(plat_dat)) {
dev_err(&pdev->dev, "dt configuration failed\n"); dev_err(&pdev->dev, "dt configuration failed\n");
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
} }
dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
if (!dwmac) { if (!dwmac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
dwmac->dev = &pdev->dev; dwmac->dev = &pdev->dev;
dwmac->tx_clk = NULL; dwmac->tx_clk = NULL;
...@@ -110,10 +108,8 @@ static int intel_eth_plat_probe(struct platform_device *pdev) ...@@ -110,10 +108,8 @@ static int intel_eth_plat_probe(struct platform_device *pdev)
/* Enable TX clock */ /* Enable TX clock */
if (dwmac->data->tx_clk_en) { if (dwmac->data->tx_clk_en) {
dwmac->tx_clk = devm_clk_get(&pdev->dev, "tx_clk"); dwmac->tx_clk = devm_clk_get(&pdev->dev, "tx_clk");
if (IS_ERR(dwmac->tx_clk)) { if (IS_ERR(dwmac->tx_clk))
ret = PTR_ERR(dwmac->tx_clk); return PTR_ERR(dwmac->tx_clk);
goto err_remove_config_dt;
}
clk_prepare_enable(dwmac->tx_clk); clk_prepare_enable(dwmac->tx_clk);
...@@ -126,7 +122,7 @@ static int intel_eth_plat_probe(struct platform_device *pdev) ...@@ -126,7 +122,7 @@ static int intel_eth_plat_probe(struct platform_device *pdev)
if (ret) { if (ret) {
dev_err(&pdev->dev, dev_err(&pdev->dev,
"Failed to set tx_clk\n"); "Failed to set tx_clk\n");
goto err_remove_config_dt; return ret;
} }
} }
} }
...@@ -140,7 +136,7 @@ static int intel_eth_plat_probe(struct platform_device *pdev) ...@@ -140,7 +136,7 @@ static int intel_eth_plat_probe(struct platform_device *pdev)
if (ret) { if (ret) {
dev_err(&pdev->dev, dev_err(&pdev->dev,
"Failed to set clk_ptp_ref\n"); "Failed to set clk_ptp_ref\n");
goto err_remove_config_dt; return ret;
} }
} }
} }
...@@ -158,15 +154,10 @@ static int intel_eth_plat_probe(struct platform_device *pdev) ...@@ -158,15 +154,10 @@ static int intel_eth_plat_probe(struct platform_device *pdev)
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret) { if (ret) {
clk_disable_unprepare(dwmac->tx_clk); clk_disable_unprepare(dwmac->tx_clk);
goto err_remove_config_dt; return ret;
} }
return 0; return 0;
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret;
} }
static void intel_eth_plat_remove(struct platform_device *pdev) static void intel_eth_plat_remove(struct platform_device *pdev)
......
...@@ -384,22 +384,20 @@ static int ipq806x_gmac_probe(struct platform_device *pdev) ...@@ -384,22 +384,20 @@ static int ipq806x_gmac_probe(struct platform_device *pdev)
if (val) if (val)
return val; return val;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
gmac = devm_kzalloc(dev, sizeof(*gmac), GFP_KERNEL); gmac = devm_kzalloc(dev, sizeof(*gmac), GFP_KERNEL);
if (!gmac) { if (!gmac)
err = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
gmac->pdev = pdev; gmac->pdev = pdev;
err = ipq806x_gmac_of_parse(gmac); err = ipq806x_gmac_of_parse(gmac);
if (err) { if (err) {
dev_err(dev, "device tree parsing error\n"); dev_err(dev, "device tree parsing error\n");
goto err_remove_config_dt; return err;
} }
regmap_write(gmac->qsgmii_csr, QSGMII_PCS_CAL_LCKDT_CTL, regmap_write(gmac->qsgmii_csr, QSGMII_PCS_CAL_LCKDT_CTL,
...@@ -459,11 +457,11 @@ static int ipq806x_gmac_probe(struct platform_device *pdev) ...@@ -459,11 +457,11 @@ static int ipq806x_gmac_probe(struct platform_device *pdev)
if (gmac->phy_mode == PHY_INTERFACE_MODE_SGMII) { if (gmac->phy_mode == PHY_INTERFACE_MODE_SGMII) {
err = ipq806x_gmac_configure_qsgmii_params(gmac); err = ipq806x_gmac_configure_qsgmii_params(gmac);
if (err) if (err)
goto err_remove_config_dt; return err;
err = ipq806x_gmac_configure_qsgmii_pcs_speed(gmac); err = ipq806x_gmac_configure_qsgmii_pcs_speed(gmac);
if (err) if (err)
goto err_remove_config_dt; return err;
} }
plat_dat->has_gmac = true; plat_dat->has_gmac = true;
...@@ -473,21 +471,12 @@ static int ipq806x_gmac_probe(struct platform_device *pdev) ...@@ -473,21 +471,12 @@ static int ipq806x_gmac_probe(struct platform_device *pdev)
plat_dat->tx_fifo_size = 8192; plat_dat->tx_fifo_size = 8192;
plat_dat->rx_fifo_size = 8192; plat_dat->rx_fifo_size = 8192;
err = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (err)
goto err_remove_config_dt;
return 0;
err_unsupported_phy: err_unsupported_phy:
dev_err(&pdev->dev, "Unsupported PHY mode: \"%s\"\n", dev_err(&pdev->dev, "Unsupported PHY mode: \"%s\"\n",
phy_modes(gmac->phy_mode)); phy_modes(gmac->phy_mode));
err = -EINVAL; return -EINVAL;
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return err;
} }
static const struct of_device_id ipq806x_gmac_dwmac_match[] = { static const struct of_device_id ipq806x_gmac_dwmac_match[] = {
......
...@@ -37,7 +37,7 @@ static int lpc18xx_dwmac_probe(struct platform_device *pdev) ...@@ -37,7 +37,7 @@ static int lpc18xx_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
...@@ -46,8 +46,7 @@ static int lpc18xx_dwmac_probe(struct platform_device *pdev) ...@@ -46,8 +46,7 @@ static int lpc18xx_dwmac_probe(struct platform_device *pdev)
reg = syscon_regmap_lookup_by_compatible("nxp,lpc1850-creg"); reg = syscon_regmap_lookup_by_compatible("nxp,lpc1850-creg");
if (IS_ERR(reg)) { if (IS_ERR(reg)) {
dev_err(&pdev->dev, "syscon lookup failed\n"); dev_err(&pdev->dev, "syscon lookup failed\n");
ret = PTR_ERR(reg); return PTR_ERR(reg);
goto err_remove_config_dt;
} }
if (plat_dat->mac_interface == PHY_INTERFACE_MODE_MII) { if (plat_dat->mac_interface == PHY_INTERFACE_MODE_MII) {
...@@ -56,23 +55,13 @@ static int lpc18xx_dwmac_probe(struct platform_device *pdev) ...@@ -56,23 +55,13 @@ static int lpc18xx_dwmac_probe(struct platform_device *pdev)
ethmode = LPC18XX_CREG_CREG6_ETHMODE_RMII; ethmode = LPC18XX_CREG_CREG6_ETHMODE_RMII;
} else { } else {
dev_err(&pdev->dev, "Only MII and RMII mode supported\n"); dev_err(&pdev->dev, "Only MII and RMII mode supported\n");
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
} }
regmap_update_bits(reg, LPC18XX_CREG_CREG6, regmap_update_bits(reg, LPC18XX_CREG_CREG6,
LPC18XX_CREG_CREG6_ETHMODE_MASK, ethmode); LPC18XX_CREG_CREG6_ETHMODE_MASK, ethmode);
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret)
goto err_remove_config_dt;
return 0;
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret;
} }
static const struct of_device_id lpc18xx_dwmac_match[] = { static const struct of_device_id lpc18xx_dwmac_match[] = {
......
...@@ -656,7 +656,7 @@ static int mediatek_dwmac_probe(struct platform_device *pdev) ...@@ -656,7 +656,7 @@ static int mediatek_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
...@@ -665,7 +665,7 @@ static int mediatek_dwmac_probe(struct platform_device *pdev) ...@@ -665,7 +665,7 @@ static int mediatek_dwmac_probe(struct platform_device *pdev)
ret = mediatek_dwmac_clks_config(priv_plat, true); ret = mediatek_dwmac_clks_config(priv_plat, true);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret) if (ret)
...@@ -675,8 +675,6 @@ static int mediatek_dwmac_probe(struct platform_device *pdev) ...@@ -675,8 +675,6 @@ static int mediatek_dwmac_probe(struct platform_device *pdev)
err_drv_probe: err_drv_probe:
mediatek_dwmac_clks_config(priv_plat, false); mediatek_dwmac_clks_config(priv_plat, false);
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -52,35 +52,22 @@ static int meson6_dwmac_probe(struct platform_device *pdev) ...@@ -52,35 +52,22 @@ static int meson6_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
if (!dwmac) { if (!dwmac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
dwmac->reg = devm_platform_ioremap_resource(pdev, 1); dwmac->reg = devm_platform_ioremap_resource(pdev, 1);
if (IS_ERR(dwmac->reg)) { if (IS_ERR(dwmac->reg))
ret = PTR_ERR(dwmac->reg); return PTR_ERR(dwmac->reg);
goto err_remove_config_dt;
}
plat_dat->bsp_priv = dwmac; plat_dat->bsp_priv = dwmac;
plat_dat->fix_mac_speed = meson6_dwmac_fix_mac_speed; plat_dat->fix_mac_speed = meson6_dwmac_fix_mac_speed;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret)
goto err_remove_config_dt;
return 0;
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret;
} }
static const struct of_device_id meson6_dwmac_match[] = { static const struct of_device_id meson6_dwmac_match[] = {
......
...@@ -400,33 +400,27 @@ static int meson8b_dwmac_probe(struct platform_device *pdev) ...@@ -400,33 +400,27 @@ static int meson8b_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
if (!dwmac) { if (!dwmac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
dwmac->data = (const struct meson8b_dwmac_data *) dwmac->data = (const struct meson8b_dwmac_data *)
of_device_get_match_data(&pdev->dev); of_device_get_match_data(&pdev->dev);
if (!dwmac->data) { if (!dwmac->data)
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
}
dwmac->regs = devm_platform_ioremap_resource(pdev, 1); dwmac->regs = devm_platform_ioremap_resource(pdev, 1);
if (IS_ERR(dwmac->regs)) { if (IS_ERR(dwmac->regs))
ret = PTR_ERR(dwmac->regs); return PTR_ERR(dwmac->regs);
goto err_remove_config_dt;
}
dwmac->dev = &pdev->dev; dwmac->dev = &pdev->dev;
ret = of_get_phy_mode(pdev->dev.of_node, &dwmac->phy_mode); ret = of_get_phy_mode(pdev->dev.of_node, &dwmac->phy_mode);
if (ret) { if (ret) {
dev_err(&pdev->dev, "missing phy-mode property\n"); dev_err(&pdev->dev, "missing phy-mode property\n");
goto err_remove_config_dt; return ret;
} }
/* use 2ns as fallback since this value was previously hardcoded */ /* use 2ns as fallback since this value was previously hardcoded */
...@@ -448,53 +442,40 @@ static int meson8b_dwmac_probe(struct platform_device *pdev) ...@@ -448,53 +442,40 @@ static int meson8b_dwmac_probe(struct platform_device *pdev)
if (dwmac->rx_delay_ps > 3000 || dwmac->rx_delay_ps % 200) { if (dwmac->rx_delay_ps > 3000 || dwmac->rx_delay_ps % 200) {
dev_err(dwmac->dev, dev_err(dwmac->dev,
"The RGMII RX delay range is 0..3000ps in 200ps steps"); "The RGMII RX delay range is 0..3000ps in 200ps steps");
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
} }
} else { } else {
if (dwmac->rx_delay_ps != 0 && dwmac->rx_delay_ps != 2000) { if (dwmac->rx_delay_ps != 0 && dwmac->rx_delay_ps != 2000) {
dev_err(dwmac->dev, dev_err(dwmac->dev,
"The only allowed RGMII RX delays values are: 0ps, 2000ps"); "The only allowed RGMII RX delays values are: 0ps, 2000ps");
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
} }
} }
dwmac->timing_adj_clk = devm_clk_get_optional(dwmac->dev, dwmac->timing_adj_clk = devm_clk_get_optional(dwmac->dev,
"timing-adjustment"); "timing-adjustment");
if (IS_ERR(dwmac->timing_adj_clk)) { if (IS_ERR(dwmac->timing_adj_clk))
ret = PTR_ERR(dwmac->timing_adj_clk); return PTR_ERR(dwmac->timing_adj_clk);
goto err_remove_config_dt;
}
ret = meson8b_init_rgmii_delays(dwmac); ret = meson8b_init_rgmii_delays(dwmac);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = meson8b_init_rgmii_tx_clk(dwmac); ret = meson8b_init_rgmii_tx_clk(dwmac);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = dwmac->data->set_phy_mode(dwmac); ret = dwmac->data->set_phy_mode(dwmac);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = meson8b_init_prg_eth(dwmac); ret = meson8b_init_prg_eth(dwmac);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
plat_dat->bsp_priv = dwmac; plat_dat->bsp_priv = dwmac;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret)
goto err_remove_config_dt;
return 0;
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret;
} }
static const struct meson8b_dwmac_data meson8b_dwmac_data = { static const struct meson8b_dwmac_data meson8b_dwmac_data = {
......
...@@ -1824,7 +1824,7 @@ static int rk_gmac_probe(struct platform_device *pdev) ...@@ -1824,7 +1824,7 @@ static int rk_gmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
...@@ -1836,18 +1836,16 @@ static int rk_gmac_probe(struct platform_device *pdev) ...@@ -1836,18 +1836,16 @@ static int rk_gmac_probe(struct platform_device *pdev)
plat_dat->fix_mac_speed = rk_fix_speed; plat_dat->fix_mac_speed = rk_fix_speed;
plat_dat->bsp_priv = rk_gmac_setup(pdev, plat_dat, data); plat_dat->bsp_priv = rk_gmac_setup(pdev, plat_dat, data);
if (IS_ERR(plat_dat->bsp_priv)) { if (IS_ERR(plat_dat->bsp_priv))
ret = PTR_ERR(plat_dat->bsp_priv); return PTR_ERR(plat_dat->bsp_priv);
goto err_remove_config_dt;
}
ret = rk_gmac_clk_init(plat_dat); ret = rk_gmac_clk_init(plat_dat);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = rk_gmac_powerup(plat_dat->bsp_priv); ret = rk_gmac_powerup(plat_dat->bsp_priv);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret) if (ret)
...@@ -1857,8 +1855,6 @@ static int rk_gmac_probe(struct platform_device *pdev) ...@@ -1857,8 +1855,6 @@ static int rk_gmac_probe(struct platform_device *pdev)
err_gmac_powerdown: err_gmac_powerdown:
rk_gmac_powerdown(plat_dat->bsp_priv); rk_gmac_powerdown(plat_dat->bsp_priv);
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -400,21 +400,19 @@ static int socfpga_dwmac_probe(struct platform_device *pdev) ...@@ -400,21 +400,19 @@ static int socfpga_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
dwmac = devm_kzalloc(dev, sizeof(*dwmac), GFP_KERNEL); dwmac = devm_kzalloc(dev, sizeof(*dwmac), GFP_KERNEL);
if (!dwmac) { if (!dwmac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
dwmac->stmmac_ocp_rst = devm_reset_control_get_optional(dev, "stmmaceth-ocp"); dwmac->stmmac_ocp_rst = devm_reset_control_get_optional(dev, "stmmaceth-ocp");
if (IS_ERR(dwmac->stmmac_ocp_rst)) { if (IS_ERR(dwmac->stmmac_ocp_rst)) {
ret = PTR_ERR(dwmac->stmmac_ocp_rst); ret = PTR_ERR(dwmac->stmmac_ocp_rst);
dev_err(dev, "error getting reset control of ocp %d\n", ret); dev_err(dev, "error getting reset control of ocp %d\n", ret);
goto err_remove_config_dt; return ret;
} }
reset_control_deassert(dwmac->stmmac_ocp_rst); reset_control_deassert(dwmac->stmmac_ocp_rst);
...@@ -422,7 +420,7 @@ static int socfpga_dwmac_probe(struct platform_device *pdev) ...@@ -422,7 +420,7 @@ static int socfpga_dwmac_probe(struct platform_device *pdev)
ret = socfpga_dwmac_parse_data(dwmac, dev); ret = socfpga_dwmac_parse_data(dwmac, dev);
if (ret) { if (ret) {
dev_err(dev, "Unable to parse OF data\n"); dev_err(dev, "Unable to parse OF data\n");
goto err_remove_config_dt; return ret;
} }
dwmac->ops = ops; dwmac->ops = ops;
...@@ -431,7 +429,7 @@ static int socfpga_dwmac_probe(struct platform_device *pdev) ...@@ -431,7 +429,7 @@ static int socfpga_dwmac_probe(struct platform_device *pdev)
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ndev = platform_get_drvdata(pdev); ndev = platform_get_drvdata(pdev);
stpriv = netdev_priv(ndev); stpriv = netdev_priv(ndev);
...@@ -492,8 +490,6 @@ static int socfpga_dwmac_probe(struct platform_device *pdev) ...@@ -492,8 +490,6 @@ static int socfpga_dwmac_probe(struct platform_device *pdev)
err_dvr_remove: err_dvr_remove:
stmmac_dvr_remove(&pdev->dev); stmmac_dvr_remove(&pdev->dev);
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -105,7 +105,7 @@ static int starfive_dwmac_probe(struct platform_device *pdev) ...@@ -105,7 +105,7 @@ static int starfive_dwmac_probe(struct platform_device *pdev)
return dev_err_probe(&pdev->dev, err, return dev_err_probe(&pdev->dev, err,
"failed to get resources\n"); "failed to get resources\n");
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return dev_err_probe(&pdev->dev, PTR_ERR(plat_dat), return dev_err_probe(&pdev->dev, PTR_ERR(plat_dat),
"dt configuration failed\n"); "dt configuration failed\n");
...@@ -141,13 +141,7 @@ static int starfive_dwmac_probe(struct platform_device *pdev) ...@@ -141,13 +141,7 @@ static int starfive_dwmac_probe(struct platform_device *pdev)
if (err) if (err)
return err; return err;
err = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (err) {
stmmac_remove_config_dt(pdev, plat_dat);
return err;
}
return 0;
} }
static const struct of_device_id starfive_dwmac_match[] = { static const struct of_device_id starfive_dwmac_match[] = {
......
...@@ -273,20 +273,18 @@ static int sti_dwmac_probe(struct platform_device *pdev) ...@@ -273,20 +273,18 @@ static int sti_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
if (!dwmac) { if (!dwmac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
ret = sti_dwmac_parse_data(dwmac, pdev); ret = sti_dwmac_parse_data(dwmac, pdev);
if (ret) { if (ret) {
dev_err(&pdev->dev, "Unable to parse OF data\n"); dev_err(&pdev->dev, "Unable to parse OF data\n");
goto err_remove_config_dt; return ret;
} }
dwmac->fix_retime_src = data->fix_retime_src; dwmac->fix_retime_src = data->fix_retime_src;
...@@ -296,7 +294,7 @@ static int sti_dwmac_probe(struct platform_device *pdev) ...@@ -296,7 +294,7 @@ static int sti_dwmac_probe(struct platform_device *pdev)
ret = clk_prepare_enable(dwmac->clk); ret = clk_prepare_enable(dwmac->clk);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = sti_dwmac_set_mode(dwmac); ret = sti_dwmac_set_mode(dwmac);
if (ret) if (ret)
...@@ -310,8 +308,6 @@ static int sti_dwmac_probe(struct platform_device *pdev) ...@@ -310,8 +308,6 @@ static int sti_dwmac_probe(struct platform_device *pdev)
disable_clk: disable_clk:
clk_disable_unprepare(dwmac->clk); clk_disable_unprepare(dwmac->clk);
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -370,21 +370,18 @@ static int stm32_dwmac_probe(struct platform_device *pdev) ...@@ -370,21 +370,18 @@ static int stm32_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
if (!dwmac) { if (!dwmac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
data = of_device_get_match_data(&pdev->dev); data = of_device_get_match_data(&pdev->dev);
if (!data) { if (!data) {
dev_err(&pdev->dev, "no of match data provided\n"); dev_err(&pdev->dev, "no of match data provided\n");
ret = -EINVAL; return -EINVAL;
goto err_remove_config_dt;
} }
dwmac->ops = data; dwmac->ops = data;
...@@ -393,14 +390,14 @@ static int stm32_dwmac_probe(struct platform_device *pdev) ...@@ -393,14 +390,14 @@ static int stm32_dwmac_probe(struct platform_device *pdev)
ret = stm32_dwmac_parse_data(dwmac, &pdev->dev); ret = stm32_dwmac_parse_data(dwmac, &pdev->dev);
if (ret) { if (ret) {
dev_err(&pdev->dev, "Unable to parse OF data\n"); dev_err(&pdev->dev, "Unable to parse OF data\n");
goto err_remove_config_dt; return ret;
} }
plat_dat->bsp_priv = dwmac; plat_dat->bsp_priv = dwmac;
ret = stm32_dwmac_init(plat_dat); ret = stm32_dwmac_init(plat_dat);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret) if (ret)
...@@ -410,8 +407,6 @@ static int stm32_dwmac_probe(struct platform_device *pdev) ...@@ -410,8 +407,6 @@ static int stm32_dwmac_probe(struct platform_device *pdev)
err_clk_disable: err_clk_disable:
stm32_dwmac_clk_disable(dwmac); stm32_dwmac_clk_disable(dwmac);
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -1224,7 +1224,7 @@ static int sun8i_dwmac_probe(struct platform_device *pdev) ...@@ -1224,7 +1224,7 @@ static int sun8i_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return -EINVAL; return -EINVAL;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
...@@ -1244,7 +1244,7 @@ static int sun8i_dwmac_probe(struct platform_device *pdev) ...@@ -1244,7 +1244,7 @@ static int sun8i_dwmac_probe(struct platform_device *pdev)
ret = sun8i_dwmac_set_syscon(&pdev->dev, plat_dat); ret = sun8i_dwmac_set_syscon(&pdev->dev, plat_dat);
if (ret) if (ret)
goto dwmac_deconfig; return ret;
ret = sun8i_dwmac_init(pdev, plat_dat->bsp_priv); ret = sun8i_dwmac_init(pdev, plat_dat->bsp_priv);
if (ret) if (ret)
...@@ -1295,8 +1295,6 @@ static int sun8i_dwmac_probe(struct platform_device *pdev) ...@@ -1295,8 +1295,6 @@ static int sun8i_dwmac_probe(struct platform_device *pdev)
sun8i_dwmac_exit(pdev, gmac); sun8i_dwmac_exit(pdev, gmac);
dwmac_syscon: dwmac_syscon:
sun8i_dwmac_unset_syscon(gmac); sun8i_dwmac_unset_syscon(gmac);
dwmac_deconfig:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -108,36 +108,31 @@ static int sun7i_gmac_probe(struct platform_device *pdev) ...@@ -108,36 +108,31 @@ static int sun7i_gmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
gmac = devm_kzalloc(dev, sizeof(*gmac), GFP_KERNEL); gmac = devm_kzalloc(dev, sizeof(*gmac), GFP_KERNEL);
if (!gmac) { if (!gmac)
ret = -ENOMEM; return -ENOMEM;
goto err_remove_config_dt;
}
ret = of_get_phy_mode(dev->of_node, &gmac->interface); ret = of_get_phy_mode(dev->of_node, &gmac->interface);
if (ret && ret != -ENODEV) { if (ret && ret != -ENODEV) {
dev_err(dev, "Can't get phy-mode\n"); dev_err(dev, "Can't get phy-mode\n");
goto err_remove_config_dt; return ret;
} }
gmac->tx_clk = devm_clk_get(dev, "allwinner_gmac_tx"); gmac->tx_clk = devm_clk_get(dev, "allwinner_gmac_tx");
if (IS_ERR(gmac->tx_clk)) { if (IS_ERR(gmac->tx_clk)) {
dev_err(dev, "could not get tx clock\n"); dev_err(dev, "could not get tx clock\n");
ret = PTR_ERR(gmac->tx_clk); return PTR_ERR(gmac->tx_clk);
goto err_remove_config_dt;
} }
/* Optional regulator for PHY */ /* Optional regulator for PHY */
gmac->regulator = devm_regulator_get_optional(dev, "phy"); gmac->regulator = devm_regulator_get_optional(dev, "phy");
if (IS_ERR(gmac->regulator)) { if (IS_ERR(gmac->regulator)) {
if (PTR_ERR(gmac->regulator) == -EPROBE_DEFER) { if (PTR_ERR(gmac->regulator) == -EPROBE_DEFER)
ret = -EPROBE_DEFER; return -EPROBE_DEFER;
goto err_remove_config_dt;
}
dev_info(dev, "no regulator found\n"); dev_info(dev, "no regulator found\n");
gmac->regulator = NULL; gmac->regulator = NULL;
} }
...@@ -155,7 +150,7 @@ static int sun7i_gmac_probe(struct platform_device *pdev) ...@@ -155,7 +150,7 @@ static int sun7i_gmac_probe(struct platform_device *pdev)
ret = sun7i_gmac_init(pdev, plat_dat->bsp_priv); ret = sun7i_gmac_init(pdev, plat_dat->bsp_priv);
if (ret) if (ret)
goto err_remove_config_dt; return ret;
ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res); ret = stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
if (ret) if (ret)
...@@ -165,8 +160,6 @@ static int sun7i_gmac_probe(struct platform_device *pdev) ...@@ -165,8 +160,6 @@ static int sun7i_gmac_probe(struct platform_device *pdev)
err_gmac_exit: err_gmac_exit:
sun7i_gmac_exit(pdev, plat_dat->bsp_priv); sun7i_gmac_exit(pdev, plat_dat->bsp_priv);
err_remove_config_dt:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
......
...@@ -284,7 +284,7 @@ static int tegra_mgbe_probe(struct platform_device *pdev) ...@@ -284,7 +284,7 @@ static int tegra_mgbe_probe(struct platform_device *pdev)
if (err < 0) if (err < 0)
goto disable_clks; goto disable_clks;
plat = stmmac_probe_config_dt(pdev, res.mac); plat = devm_stmmac_probe_config_dt(pdev, res.mac);
if (IS_ERR(plat)) { if (IS_ERR(plat)) {
err = PTR_ERR(plat); err = PTR_ERR(plat);
goto disable_clks; goto disable_clks;
...@@ -303,7 +303,7 @@ static int tegra_mgbe_probe(struct platform_device *pdev) ...@@ -303,7 +303,7 @@ static int tegra_mgbe_probe(struct platform_device *pdev)
GFP_KERNEL); GFP_KERNEL);
if (!plat->mdio_bus_data) { if (!plat->mdio_bus_data) {
err = -ENOMEM; err = -ENOMEM;
goto remove; goto disable_clks;
} }
} }
...@@ -321,7 +321,7 @@ static int tegra_mgbe_probe(struct platform_device *pdev) ...@@ -321,7 +321,7 @@ static int tegra_mgbe_probe(struct platform_device *pdev)
500, 500 * 2000); 500, 500 * 2000);
if (err < 0) { if (err < 0) {
dev_err(mgbe->dev, "timeout waiting for TX lane to become enabled\n"); dev_err(mgbe->dev, "timeout waiting for TX lane to become enabled\n");
goto remove; goto disable_clks;
} }
plat->serdes_powerup = mgbe_uphy_lane_bringup_serdes_up; plat->serdes_powerup = mgbe_uphy_lane_bringup_serdes_up;
...@@ -342,12 +342,10 @@ static int tegra_mgbe_probe(struct platform_device *pdev) ...@@ -342,12 +342,10 @@ static int tegra_mgbe_probe(struct platform_device *pdev)
err = stmmac_dvr_probe(&pdev->dev, plat, &res); err = stmmac_dvr_probe(&pdev->dev, plat, &res);
if (err < 0) if (err < 0)
goto remove; goto disable_clks;
return 0; return 0;
remove:
stmmac_remove_config_dt(pdev, plat);
disable_clks: disable_clks:
clk_bulk_disable_unprepare(ARRAY_SIZE(mgbe_clks), mgbe->clks); clk_bulk_disable_unprepare(ARRAY_SIZE(mgbe_clks), mgbe->clks);
......
...@@ -220,15 +220,13 @@ static int visconti_eth_dwmac_probe(struct platform_device *pdev) ...@@ -220,15 +220,13 @@ static int visconti_eth_dwmac_probe(struct platform_device *pdev)
if (ret) if (ret)
return ret; return ret;
plat_dat = stmmac_probe_config_dt(pdev, stmmac_res.mac); plat_dat = devm_stmmac_probe_config_dt(pdev, stmmac_res.mac);
if (IS_ERR(plat_dat)) if (IS_ERR(plat_dat))
return PTR_ERR(plat_dat); return PTR_ERR(plat_dat);
dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL); dwmac = devm_kzalloc(&pdev->dev, sizeof(*dwmac), GFP_KERNEL);
if (!dwmac) { if (!dwmac)
ret = -ENOMEM; return -ENOMEM;
goto remove_config;
}
spin_lock_init(&dwmac->lock); spin_lock_init(&dwmac->lock);
dwmac->reg = stmmac_res.addr; dwmac->reg = stmmac_res.addr;
...@@ -238,7 +236,7 @@ static int visconti_eth_dwmac_probe(struct platform_device *pdev) ...@@ -238,7 +236,7 @@ static int visconti_eth_dwmac_probe(struct platform_device *pdev)
ret = visconti_eth_clock_probe(pdev, plat_dat); ret = visconti_eth_clock_probe(pdev, plat_dat);
if (ret) if (ret)
goto remove_config; return ret;
visconti_eth_init_hw(pdev, plat_dat); visconti_eth_init_hw(pdev, plat_dat);
...@@ -252,22 +250,14 @@ static int visconti_eth_dwmac_probe(struct platform_device *pdev) ...@@ -252,22 +250,14 @@ static int visconti_eth_dwmac_probe(struct platform_device *pdev)
remove: remove:
visconti_eth_clock_remove(pdev); visconti_eth_clock_remove(pdev);
remove_config:
stmmac_remove_config_dt(pdev, plat_dat);
return ret; return ret;
} }
static void visconti_eth_dwmac_remove(struct platform_device *pdev) static void visconti_eth_dwmac_remove(struct platform_device *pdev)
{ {
struct net_device *ndev = platform_get_drvdata(pdev);
struct stmmac_priv *priv = netdev_priv(ndev);
stmmac_pltfr_remove(pdev); stmmac_pltfr_remove(pdev);
visconti_eth_clock_remove(pdev); visconti_eth_clock_remove(pdev);
stmmac_remove_config_dt(pdev, priv->plat);
} }
static const struct of_device_id visconti_eth_dwmac_match[] = { static const struct of_device_id visconti_eth_dwmac_match[] = {
......
...@@ -387,6 +387,22 @@ static int stmmac_of_get_mac_mode(struct device_node *np) ...@@ -387,6 +387,22 @@ static int stmmac_of_get_mac_mode(struct device_node *np)
return -ENODEV; return -ENODEV;
} }
/**
* stmmac_remove_config_dt - undo the effects of stmmac_probe_config_dt()
* @pdev: platform_device structure
* @plat: driver data platform structure
*
* Release resources claimed by stmmac_probe_config_dt().
*/
static void stmmac_remove_config_dt(struct platform_device *pdev,
struct plat_stmmacenet_data *plat)
{
clk_disable_unprepare(plat->stmmac_clk);
clk_disable_unprepare(plat->pclk);
of_node_put(plat->phy_node);
of_node_put(plat->mdio_node);
}
/** /**
* stmmac_probe_config_dt - parse device-tree driver parameters * stmmac_probe_config_dt - parse device-tree driver parameters
* @pdev: platform_device structure * @pdev: platform_device structure
...@@ -395,7 +411,7 @@ static int stmmac_of_get_mac_mode(struct device_node *np) ...@@ -395,7 +411,7 @@ static int stmmac_of_get_mac_mode(struct device_node *np)
* this function is to read the driver parameters from device-tree and * this function is to read the driver parameters from device-tree and
* set some private fields that will be used by the main at runtime. * set some private fields that will be used by the main at runtime.
*/ */
struct plat_stmmacenet_data * static struct plat_stmmacenet_data *
stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac) stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac)
{ {
struct device_node *np = pdev->dev.of_node; struct device_node *np = pdev->dev.of_node;
...@@ -665,43 +681,14 @@ devm_stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac) ...@@ -665,43 +681,14 @@ devm_stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac)
return plat; return plat;
} }
/**
* stmmac_remove_config_dt - undo the effects of stmmac_probe_config_dt()
* @pdev: platform_device structure
* @plat: driver data platform structure
*
* Release resources claimed by stmmac_probe_config_dt().
*/
void stmmac_remove_config_dt(struct platform_device *pdev,
struct plat_stmmacenet_data *plat)
{
clk_disable_unprepare(plat->stmmac_clk);
clk_disable_unprepare(plat->pclk);
of_node_put(plat->phy_node);
of_node_put(plat->mdio_node);
}
#else #else
struct plat_stmmacenet_data *
stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac)
{
return ERR_PTR(-EINVAL);
}
struct plat_stmmacenet_data * struct plat_stmmacenet_data *
devm_stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac) devm_stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac)
{ {
return ERR_PTR(-EINVAL); return ERR_PTR(-EINVAL);
} }
void stmmac_remove_config_dt(struct platform_device *pdev,
struct plat_stmmacenet_data *plat)
{
}
#endif /* CONFIG_OF */ #endif /* CONFIG_OF */
EXPORT_SYMBOL_GPL(stmmac_probe_config_dt);
EXPORT_SYMBOL_GPL(devm_stmmac_probe_config_dt); EXPORT_SYMBOL_GPL(devm_stmmac_probe_config_dt);
EXPORT_SYMBOL_GPL(stmmac_remove_config_dt);
int stmmac_get_platform_resources(struct platform_device *pdev, int stmmac_get_platform_resources(struct platform_device *pdev,
struct stmmac_resources *stmmac_res) struct stmmac_resources *stmmac_res)
...@@ -810,7 +797,7 @@ static void devm_stmmac_pltfr_remove(void *data) ...@@ -810,7 +797,7 @@ static void devm_stmmac_pltfr_remove(void *data)
{ {
struct platform_device *pdev = data; struct platform_device *pdev = data;
stmmac_pltfr_remove_no_dt(pdev); stmmac_pltfr_remove(pdev);
} }
/** /**
...@@ -837,12 +824,12 @@ int devm_stmmac_pltfr_probe(struct platform_device *pdev, ...@@ -837,12 +824,12 @@ int devm_stmmac_pltfr_probe(struct platform_device *pdev,
EXPORT_SYMBOL_GPL(devm_stmmac_pltfr_probe); EXPORT_SYMBOL_GPL(devm_stmmac_pltfr_probe);
/** /**
* stmmac_pltfr_remove_no_dt * stmmac_pltfr_remove
* @pdev: pointer to the platform device * @pdev: pointer to the platform device
* Description: This undoes the effects of stmmac_pltfr_probe() by removing the * Description: This undoes the effects of stmmac_pltfr_probe() by removing the
* driver and calling the platform's exit() callback. * driver and calling the platform's exit() callback.
*/ */
void stmmac_pltfr_remove_no_dt(struct platform_device *pdev) void stmmac_pltfr_remove(struct platform_device *pdev)
{ {
struct net_device *ndev = platform_get_drvdata(pdev); struct net_device *ndev = platform_get_drvdata(pdev);
struct stmmac_priv *priv = netdev_priv(ndev); struct stmmac_priv *priv = netdev_priv(ndev);
...@@ -851,23 +838,6 @@ void stmmac_pltfr_remove_no_dt(struct platform_device *pdev) ...@@ -851,23 +838,6 @@ void stmmac_pltfr_remove_no_dt(struct platform_device *pdev)
stmmac_dvr_remove(&pdev->dev); stmmac_dvr_remove(&pdev->dev);
stmmac_pltfr_exit(pdev, plat); stmmac_pltfr_exit(pdev, plat);
} }
EXPORT_SYMBOL_GPL(stmmac_pltfr_remove_no_dt);
/**
* stmmac_pltfr_remove
* @pdev: platform device pointer
* Description: this function calls the main to free the net resources
* and calls the platforms hook and release the resources (e.g. mem).
*/
void stmmac_pltfr_remove(struct platform_device *pdev)
{
struct net_device *ndev = platform_get_drvdata(pdev);
struct stmmac_priv *priv = netdev_priv(ndev);
struct plat_stmmacenet_data *plat = priv->plat;
stmmac_pltfr_remove_no_dt(pdev);
stmmac_remove_config_dt(pdev, plat);
}
EXPORT_SYMBOL_GPL(stmmac_pltfr_remove); EXPORT_SYMBOL_GPL(stmmac_pltfr_remove);
/** /**
......
...@@ -11,12 +11,8 @@ ...@@ -11,12 +11,8 @@
#include "stmmac.h" #include "stmmac.h"
struct plat_stmmacenet_data *
stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac);
struct plat_stmmacenet_data * struct plat_stmmacenet_data *
devm_stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac); devm_stmmac_probe_config_dt(struct platform_device *pdev, u8 *mac);
void stmmac_remove_config_dt(struct platform_device *pdev,
struct plat_stmmacenet_data *plat);
int stmmac_get_platform_resources(struct platform_device *pdev, int stmmac_get_platform_resources(struct platform_device *pdev,
struct stmmac_resources *stmmac_res); struct stmmac_resources *stmmac_res);
...@@ -32,7 +28,6 @@ int stmmac_pltfr_probe(struct platform_device *pdev, ...@@ -32,7 +28,6 @@ int stmmac_pltfr_probe(struct platform_device *pdev,
int devm_stmmac_pltfr_probe(struct platform_device *pdev, int devm_stmmac_pltfr_probe(struct platform_device *pdev,
struct plat_stmmacenet_data *plat, struct plat_stmmacenet_data *plat,
struct stmmac_resources *res); struct stmmac_resources *res);
void stmmac_pltfr_remove_no_dt(struct platform_device *pdev);
void stmmac_pltfr_remove(struct platform_device *pdev); void stmmac_pltfr_remove(struct platform_device *pdev);
extern const struct dev_pm_ops stmmac_pltfr_pm_ops; extern const struct dev_pm_ops stmmac_pltfr_pm_ops;
......
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