watchdog: of_xilinx_wdt: Add suspend/resume support

Add suspend/resume support to driver.

Signed-off-by: Michal Simek <michal.simek@xilinx.com>
Reviewed-by: Guenter Roeck <linux@roeck-us.net>
Signed-off-by: Guenter Roeck <linux@roeck-us.net>
Signed-off-by: Wim Van Sebroeck <wim@iguana.be>

1 files changed, 38 insertions, 0 deletions

diff --git a/drivers/watchdog/of_xilinx_wdt.c b/drivers/watchdog/of_xilinx_wdt.c
index 41edeb93a327..1cf286945b7a 100644
--- a/drivers/watchdog/of_xilinx_wdt.c
+++ b/drivers/watchdog/of_xilinx_wdt.c
@@ -264,6 +264,43 @@ static int xwdt_remove(struct platform_device *pdev)
         return 0;
 }
 
+/**
+ * xwdt_suspend - Suspend the device.
+ *
+ * @dev: handle to the device structure.
+ * Return: 0 always.
+ */
+static int __maybe_unused xwdt_suspend(struct device *dev)
+{
+        struct platform_device *pdev = to_platform_device(dev);
+        struct xwdt_device *xdev = platform_get_drvdata(pdev);
+
+        if (watchdog_active(&xdev->xilinx_wdt_wdd))
+                xilinx_wdt_stop(&xdev->xilinx_wdt_wdd);
+
+        return 0;
+}
+
+/**
+ * xwdt_resume - Resume the device.
+ *
+ * @dev: handle to the device structure.
+ * Return: 0 on success, errno otherwise.
+ */
+static int __maybe_unused xwdt_resume(struct device *dev)
+{
+        struct platform_device *pdev = to_platform_device(dev);
+        struct xwdt_device *xdev = platform_get_drvdata(pdev);
+        int ret = 0;
+
+        if (watchdog_active(&xdev->xilinx_wdt_wdd))
+                ret = xilinx_wdt_start(&xdev->xilinx_wdt_wdd);
+
+        return ret;
+}
+
+static SIMPLE_DEV_PM_OPS(xwdt_pm_ops, xwdt_suspend, xwdt_resume);
+
 /* Match table for of_platform binding */
 static const struct of_device_id xwdt_of_match[] = {
         { .compatible = "xlnx,xps-timebase-wdt-1.00.a", },
@@ -278,6 +315,7 @@ static struct platform_driver xwdt_driver = {
         .driver = {
                 .name  = WATCHDOG_NAME,
                 .of_match_table = xwdt_of_match,
+                .pm = &xwdt_pm_ops,
         },
 };