Commit f4fd094c authored by Robert Jarzmik's avatar Robert Jarzmik Committed by Felipe Balbi

usb: gadget: pxa27x_udc: fix clock prepare and enable

As the udc clock controls both the output signals and the internal IP,
it must be enabled before any UDC register is touched.

The bug is revealed when the clock framework disables the clock for a
couple of milliseconds during the boot sequence, and the endpoint
configuration is lost. The bug is hidden when clock framework is not
used, because no "unused clocks disable" occurs.

This patch fixes the wrong behaviour by ensuring that :
 - whenever a UDC register is read or written, the clock is enabled
 - reworks the endpoints programming to have it done under running clock
 - reworks suspend/resume to ensure the same thing
Signed-off-by: default avatarRobert Jarzmik <robert.jarzmik@free.fr>
Signed-off-by: default avatarFelipe Balbi <balbi@ti.com>
parent 95fcc6a9
...@@ -1698,10 +1698,10 @@ static void udc_disable(struct pxa_udc *udc) ...@@ -1698,10 +1698,10 @@ static void udc_disable(struct pxa_udc *udc)
udc_writel(udc, UDCICR1, 0); udc_writel(udc, UDCICR1, 0);
udc_clear_mask_UDCCR(udc, UDCCR_UDE); udc_clear_mask_UDCCR(udc, UDCCR_UDE);
clk_disable(udc->clk);
ep0_idle(udc); ep0_idle(udc);
udc->gadget.speed = USB_SPEED_UNKNOWN; udc->gadget.speed = USB_SPEED_UNKNOWN;
clk_disable(udc->clk);
udc->enabled = 0; udc->enabled = 0;
} }
...@@ -1754,16 +1754,16 @@ static void udc_enable(struct pxa_udc *udc) ...@@ -1754,16 +1754,16 @@ static void udc_enable(struct pxa_udc *udc)
if (udc->enabled) if (udc->enabled)
return; return;
clk_enable(udc->clk);
udc_writel(udc, UDCICR0, 0); udc_writel(udc, UDCICR0, 0);
udc_writel(udc, UDCICR1, 0); udc_writel(udc, UDCICR1, 0);
udc_clear_mask_UDCCR(udc, UDCCR_UDE); udc_clear_mask_UDCCR(udc, UDCCR_UDE);
clk_enable(udc->clk);
ep0_idle(udc); ep0_idle(udc);
udc->gadget.speed = USB_SPEED_FULL; udc->gadget.speed = USB_SPEED_FULL;
memset(&udc->stats, 0, sizeof(udc->stats)); memset(&udc->stats, 0, sizeof(udc->stats));
pxa_eps_setup(udc);
udc_set_mask_UDCCR(udc, UDCCR_UDE); udc_set_mask_UDCCR(udc, UDCCR_UDE);
ep_write_UDCCSR(&udc->pxa_ep[0], UDCCSR0_ACM); ep_write_UDCCSR(&udc->pxa_ep[0], UDCCSR0_ACM);
udelay(2); udelay(2);
...@@ -2469,7 +2469,6 @@ static int pxa_udc_probe(struct platform_device *pdev) ...@@ -2469,7 +2469,6 @@ static int pxa_udc_probe(struct platform_device *pdev)
the_controller = udc; the_controller = udc;
platform_set_drvdata(pdev, udc); platform_set_drvdata(pdev, udc);
udc_init_data(udc); udc_init_data(udc);
pxa_eps_setup(udc);
/* irq setup after old hardware state is cleaned up */ /* irq setup after old hardware state is cleaned up */
retval = devm_request_irq(&pdev->dev, udc->irq, pxa_udc_irq, retval = devm_request_irq(&pdev->dev, udc->irq, pxa_udc_irq,
...@@ -2485,7 +2484,8 @@ static int pxa_udc_probe(struct platform_device *pdev) ...@@ -2485,7 +2484,8 @@ static int pxa_udc_probe(struct platform_device *pdev)
goto err; goto err;
pxa_init_debugfs(udc); pxa_init_debugfs(udc);
if (should_enable_udc(udc))
udc_enable(udc);
return 0; return 0;
err: err:
clk_unprepare(udc->clk); clk_unprepare(udc->clk);
...@@ -2538,19 +2538,11 @@ extern void pxa27x_clear_otgph(void); ...@@ -2538,19 +2538,11 @@ extern void pxa27x_clear_otgph(void);
*/ */
static int pxa_udc_suspend(struct platform_device *_dev, pm_message_t state) static int pxa_udc_suspend(struct platform_device *_dev, pm_message_t state)
{ {
int i;
struct pxa_udc *udc = platform_get_drvdata(_dev); struct pxa_udc *udc = platform_get_drvdata(_dev);
struct pxa_ep *ep; struct pxa_ep *ep;
ep = &udc->pxa_ep[0]; ep = &udc->pxa_ep[0];
udc->udccsr0 = udc_ep_readl(ep, UDCCSR); udc->udccsr0 = udc_ep_readl(ep, UDCCSR);
for (i = 1; i < NR_PXA_ENDPOINTS; i++) {
ep = &udc->pxa_ep[i];
ep->udccsr_value = udc_ep_readl(ep, UDCCSR);
ep->udccr_value = udc_ep_readl(ep, UDCCR);
ep_dbg(ep, "udccsr:0x%03x, udccr:0x%x\n",
ep->udccsr_value, ep->udccr_value);
}
udc_disable(udc); udc_disable(udc);
udc->pullup_resume = udc->pullup_on; udc->pullup_resume = udc->pullup_on;
...@@ -2568,19 +2560,11 @@ static int pxa_udc_suspend(struct platform_device *_dev, pm_message_t state) ...@@ -2568,19 +2560,11 @@ static int pxa_udc_suspend(struct platform_device *_dev, pm_message_t state)
*/ */
static int pxa_udc_resume(struct platform_device *_dev) static int pxa_udc_resume(struct platform_device *_dev)
{ {
int i;
struct pxa_udc *udc = platform_get_drvdata(_dev); struct pxa_udc *udc = platform_get_drvdata(_dev);
struct pxa_ep *ep; struct pxa_ep *ep;
ep = &udc->pxa_ep[0]; ep = &udc->pxa_ep[0];
udc_ep_writel(ep, UDCCSR, udc->udccsr0 & (UDCCSR0_FST | UDCCSR0_DME)); udc_ep_writel(ep, UDCCSR, udc->udccsr0 & (UDCCSR0_FST | UDCCSR0_DME));
for (i = 1; i < NR_PXA_ENDPOINTS; i++) {
ep = &udc->pxa_ep[i];
udc_ep_writel(ep, UDCCSR, ep->udccsr_value);
udc_ep_writel(ep, UDCCR, ep->udccr_value);
ep_dbg(ep, "udccsr:0x%03x, udccr:0x%x\n",
ep->udccsr_value, ep->udccr_value);
}
dplus_pullup(udc, udc->pullup_resume); dplus_pullup(udc, udc->pullup_resume);
if (should_enable_udc(udc)) if (should_enable_udc(udc))
......
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