Commit 8469ab98 authored by Chunfeng Yun's avatar Chunfeng Yun Committed by Greg Kroah-Hartman

usb: xhci-rcar: convert to readl_poll_timeout_atomic()

Use readl_poll_timeout_atomic() to simplify code

Cc: Mathias Nyman <mathias.nyman@linux.intel.com>
Cc: Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>
Reviewed-by: default avatarYoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>
Signed-off-by: default avatarChunfeng Yun <chunfeng.yun@mediatek.com>
Link: https://lore.kernel.org/r/1600668815-12135-4-git-send-email-chunfeng.yun@mediatek.comSigned-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent eeae3afb
...@@ -6,6 +6,7 @@ ...@@ -6,6 +6,7 @@
*/ */
#include <linux/firmware.h> #include <linux/firmware.h>
#include <linux/iopoll.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/of.h> #include <linux/of.h>
...@@ -127,8 +128,7 @@ static int xhci_rcar_download_firmware(struct usb_hcd *hcd) ...@@ -127,8 +128,7 @@ static int xhci_rcar_download_firmware(struct usb_hcd *hcd)
void __iomem *regs = hcd->regs; void __iomem *regs = hcd->regs;
struct xhci_plat_priv *priv = hcd_to_xhci_priv(hcd); struct xhci_plat_priv *priv = hcd_to_xhci_priv(hcd);
const struct firmware *fw; const struct firmware *fw;
int retval, index, j, time; int retval, index, j;
int timeout = 10000;
u32 data, val, temp; u32 data, val, temp;
u32 quirks = 0; u32 quirks = 0;
const struct soc_device_attribute *attr; const struct soc_device_attribute *attr;
...@@ -166,32 +166,19 @@ static int xhci_rcar_download_firmware(struct usb_hcd *hcd) ...@@ -166,32 +166,19 @@ static int xhci_rcar_download_firmware(struct usb_hcd *hcd)
temp |= RCAR_USB3_DL_CTRL_FW_SET_DATA0; temp |= RCAR_USB3_DL_CTRL_FW_SET_DATA0;
writel(temp, regs + RCAR_USB3_DL_CTRL); writel(temp, regs + RCAR_USB3_DL_CTRL);
for (time = 0; time < timeout; time++) { retval = readl_poll_timeout_atomic(regs + RCAR_USB3_DL_CTRL,
val = readl(regs + RCAR_USB3_DL_CTRL); val, !(val & RCAR_USB3_DL_CTRL_FW_SET_DATA0),
if ((val & RCAR_USB3_DL_CTRL_FW_SET_DATA0) == 0) 1, 10000);
break; if (retval < 0)
udelay(1);
}
if (time == timeout) {
retval = -ETIMEDOUT;
break; break;
}
} }
temp = readl(regs + RCAR_USB3_DL_CTRL); temp = readl(regs + RCAR_USB3_DL_CTRL);
temp &= ~RCAR_USB3_DL_CTRL_ENABLE; temp &= ~RCAR_USB3_DL_CTRL_ENABLE;
writel(temp, regs + RCAR_USB3_DL_CTRL); writel(temp, regs + RCAR_USB3_DL_CTRL);
for (time = 0; time < timeout; time++) { retval = readl_poll_timeout_atomic((regs + RCAR_USB3_DL_CTRL),
val = readl(regs + RCAR_USB3_DL_CTRL); val, val & RCAR_USB3_DL_CTRL_FW_SUCCESS, 1, 10000);
if (val & RCAR_USB3_DL_CTRL_FW_SUCCESS) {
retval = 0;
break;
}
udelay(1);
}
if (time == timeout)
retval = -ETIMEDOUT;
release_firmware(fw); release_firmware(fw);
...@@ -200,18 +187,12 @@ static int xhci_rcar_download_firmware(struct usb_hcd *hcd) ...@@ -200,18 +187,12 @@ static int xhci_rcar_download_firmware(struct usb_hcd *hcd)
static bool xhci_rcar_wait_for_pll_active(struct usb_hcd *hcd) static bool xhci_rcar_wait_for_pll_active(struct usb_hcd *hcd)
{ {
int timeout = 1000; int retval;
u32 val, mask = RCAR_USB3_AXH_STA_PLL_ACTIVE_MASK; u32 val, mask = RCAR_USB3_AXH_STA_PLL_ACTIVE_MASK;
while (timeout > 0) { retval = readl_poll_timeout_atomic(hcd->regs + RCAR_USB3_AXH_STA,
val = readl(hcd->regs + RCAR_USB3_AXH_STA); val, (val & mask) == mask, 1, 1000);
if ((val & mask) == mask) return !retval;
return true;
udelay(1);
timeout--;
}
return false;
} }
/* This function needs to initialize a "phy" of usb before */ /* This function needs to initialize a "phy" of usb before */
......
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