This patch add suspend/resume with wakeup support for Atmel USBA.
On suspend: We stay continuously clocked if Vbus signal is not
available. If Vbus signal is available we set the Vbus signal as a wake
up source then we stop the USBA itself and all clocks used by USBA.
On resume: We recover clocks and USBA we stopped them. If a device is
connected, i.e. connected while we were suspended without wakeup
enabled, we enable the controller.
Signed-off-by: Sylvain Rochet sylvain.roc...@finsecur.com
---
drivers/usb/gadget/udc/atmel_usba_udc.c | 61 +
1 file changed, 61 insertions(+)
diff --git a/drivers/usb/gadget/udc/atmel_usba_udc.c
b/drivers/usb/gadget/udc/atmel_usba_udc.c
index 963e398..326725e 100644
--- a/drivers/usb/gadget/udc/atmel_usba_udc.c
+++ b/drivers/usb/gadget/udc/atmel_usba_udc.c
@@ -2115,6 +2115,7 @@ static int usba_udc_probe(struct platform_device *pdev)
ret = usb_add_gadget_udc(pdev-dev, udc-gadget);
if (ret)
return ret;
+ device_init_wakeup(pdev-dev, 1);
usba_init_debugfs(udc);
for (i = 1; i udc-num_ep; i++)
@@ -2130,6 +2131,7 @@ static int __exit usba_udc_remove(struct platform_device
*pdev)
udc = platform_get_drvdata(pdev);
+ device_init_wakeup(pdev-dev, 0);
usb_del_gadget_udc(udc-gadget);
for (i = 1; i udc-num_ep; i++)
@@ -2139,6 +2141,62 @@ static int __exit usba_udc_remove(struct platform_device
*pdev)
return 0;
}
+#ifdef CONFIG_PM
+static int usba_udc_suspend(struct device *dev)
+{
+ struct usba_udc *udc = dev_get_drvdata(dev);
+
+ /* Not started */
+ if (!udc-driver)
+ return 0;
+
+ if (!device_may_wakeup(dev)) {
+ usba_stop(udc);
+ return 0;
+ }
+
+ /*
+* Device may wake up. We stay clocked if we failed
+* to request vbus irq, assuming always on.
+*/
+ if (gpio_is_valid(udc-vbus_pin)) {
+ usba_stop(udc);
+ /* Only wake up on device connection */
+ irq_set_irq_type(gpio_to_irq(udc-vbus_pin),
+ udc-vbus_pin_inverted ?
+ IRQ_TYPE_EDGE_FALLING : IRQ_TYPE_EDGE_RISING);
+ enable_irq_wake(gpio_to_irq(udc-vbus_pin));
+ }
+
+ return 0;
+}
+
+static int usba_udc_resume(struct device *dev)
+{
+ struct usba_udc *udc = dev_get_drvdata(dev);
+
+ /* Not started */
+ if (!udc-driver)
+ return 0;
+
+ if (device_may_wakeup(dev) gpio_is_valid(udc-vbus_pin)) {
+ disable_irq_wake(gpio_to_irq(udc-vbus_pin));
+ irq_set_irq_type(gpio_to_irq(udc-vbus_pin),
IRQ_TYPE_EDGE_BOTH);
+ }
+
+ /* If Vbus is present, enable the controller and wait for reset */
+ mutex_lock(udc-vbus_mutex);
+ udc-vbus_prev = vbus_is_present(udc);
+
+ if (udc-vbus_prev)
+ usba_start(udc);
+
+ mutex_unlock(udc-vbus_mutex);
+
+ return 0;
+}
+#endif
+
#if defined(CONFIG_OF)
static const struct of_device_id atmel_udc_dt_ids[] = {
{ .compatible = atmel,at91sam9rl-udc },
@@ -2148,10 +2206,13 @@ static const struct of_device_id atmel_udc_dt_ids[] = {
MODULE_DEVICE_TABLE(of, atmel_udc_dt_ids);
#endif
+static SIMPLE_DEV_PM_OPS(usba_udc_pm_ops, usba_udc_suspend, usba_udc_resume);
+
static struct platform_driver udc_driver = {
.remove = __exit_p(usba_udc_remove),
.driver = {
.name = atmel_usba_udc,
+ .pm = usba_udc_pm_ops,
.of_match_table = of_match_ptr(atmel_udc_dt_ids),
},
};
--
2.1.4
--
To unsubscribe from this list: send the line unsubscribe linux-usb in
the body of a message to majord...@vger.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html