提交 8e84f8aa 编写于 作者: M Masahiro Yamada 提交者: Greg Kroah-Hartman

usb: ehci-platform: use reset array API

Generic drivers like this need to control arbitrary number of reset
lines.  Instead of hard-coding the maximum number of resets, use the
reset array API.  It can manage a bunch of resets behind the scene.
Signed-off-by: NMasahiro Yamada <yamada.masahiro@socionext.com>
Acked-by: NAlan Stern <stern@rowland.harvard.edu>
Signed-off-by: NGreg Kroah-Hartman <gregkh@linuxfoundation.org>
上级 2bb80de7
...@@ -40,12 +40,11 @@ ...@@ -40,12 +40,11 @@
#define DRIVER_DESC "EHCI generic platform driver" #define DRIVER_DESC "EHCI generic platform driver"
#define EHCI_MAX_CLKS 4 #define EHCI_MAX_CLKS 4
#define EHCI_MAX_RSTS 4
#define hcd_to_ehci_priv(h) ((struct ehci_platform_priv *)hcd_to_ehci(h)->priv) #define hcd_to_ehci_priv(h) ((struct ehci_platform_priv *)hcd_to_ehci(h)->priv)
struct ehci_platform_priv { struct ehci_platform_priv {
struct clk *clks[EHCI_MAX_CLKS]; struct clk *clks[EHCI_MAX_CLKS];
struct reset_control *rsts[EHCI_MAX_RSTS]; struct reset_control *rsts;
struct phy **phys; struct phy **phys;
int num_phys; int num_phys;
bool reset_on_resume; bool reset_on_resume;
...@@ -151,7 +150,7 @@ static int ehci_platform_probe(struct platform_device *dev) ...@@ -151,7 +150,7 @@ static int ehci_platform_probe(struct platform_device *dev)
struct usb_ehci_pdata *pdata = dev_get_platdata(&dev->dev); struct usb_ehci_pdata *pdata = dev_get_platdata(&dev->dev);
struct ehci_platform_priv *priv; struct ehci_platform_priv *priv;
struct ehci_hcd *ehci; struct ehci_hcd *ehci;
int err, irq, phy_num, clk = 0, rst; int err, irq, phy_num, clk = 0;
if (usb_disabled()) if (usb_disabled())
return -ENODEV; return -ENODEV;
...@@ -239,22 +238,16 @@ static int ehci_platform_probe(struct platform_device *dev) ...@@ -239,22 +238,16 @@ static int ehci_platform_probe(struct platform_device *dev)
} }
} }
for (rst = 0; rst < EHCI_MAX_RSTS; rst++) { priv->rsts = devm_reset_control_array_get_optional_shared(&dev->dev);
priv->rsts[rst] = devm_reset_control_get_shared_by_index( if (IS_ERR(priv->rsts)) {
&dev->dev, rst); err = PTR_ERR(priv->rsts);
if (IS_ERR(priv->rsts[rst])) { goto err_put_clks;
err = PTR_ERR(priv->rsts[rst]);
if (err == -EPROBE_DEFER)
goto err_reset;
priv->rsts[rst] = NULL;
break;
}
err = reset_control_deassert(priv->rsts[rst]);
if (err)
goto err_reset;
} }
err = reset_control_deassert(priv->rsts);
if (err)
goto err_put_clks;
if (pdata->big_endian_desc) if (pdata->big_endian_desc)
ehci->big_endian_desc = 1; ehci->big_endian_desc = 1;
if (pdata->big_endian_mmio) if (pdata->big_endian_mmio)
...@@ -310,8 +303,7 @@ static int ehci_platform_probe(struct platform_device *dev) ...@@ -310,8 +303,7 @@ static int ehci_platform_probe(struct platform_device *dev)
if (pdata->power_off) if (pdata->power_off)
pdata->power_off(dev); pdata->power_off(dev);
err_reset: err_reset:
while (--rst >= 0) reset_control_assert(priv->rsts);
reset_control_assert(priv->rsts[rst]);
err_put_clks: err_put_clks:
while (--clk >= 0) while (--clk >= 0)
clk_put(priv->clks[clk]); clk_put(priv->clks[clk]);
...@@ -329,15 +321,14 @@ static int ehci_platform_remove(struct platform_device *dev) ...@@ -329,15 +321,14 @@ static int ehci_platform_remove(struct platform_device *dev)
struct usb_hcd *hcd = platform_get_drvdata(dev); struct usb_hcd *hcd = platform_get_drvdata(dev);
struct usb_ehci_pdata *pdata = dev_get_platdata(&dev->dev); struct usb_ehci_pdata *pdata = dev_get_platdata(&dev->dev);
struct ehci_platform_priv *priv = hcd_to_ehci_priv(hcd); struct ehci_platform_priv *priv = hcd_to_ehci_priv(hcd);
int clk, rst; int clk;
usb_remove_hcd(hcd); usb_remove_hcd(hcd);
if (pdata->power_off) if (pdata->power_off)
pdata->power_off(dev); pdata->power_off(dev);
for (rst = 0; rst < EHCI_MAX_RSTS && priv->rsts[rst]; rst++) reset_control_assert(priv->rsts);
reset_control_assert(priv->rsts[rst]);
for (clk = 0; clk < EHCI_MAX_CLKS && priv->clks[clk]; clk++) for (clk = 0; clk < EHCI_MAX_CLKS && priv->clks[clk]; clk++)
clk_put(priv->clks[clk]); clk_put(priv->clks[clk]);
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册