clk: vc5: Add suspend/resume support

Add simple suspend/resume handlers to the driver to restore the chip
configuration after resume. It is possible that the chip was configured
with non-default values before suspend-resume cycle and that the chip
is powered down during this cycle, so the configuration could get lost.

Signed-off-by: Marek Vasut <marek.vasut+renesas@gmail.com>
Cc: Alexey Firago <alexey_firago@mentor.com>
Cc: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Cc: Michael Turquette <mturquette@baylibre.com>
Cc: Stephen Boyd <sboyd@codeaurora.org>
Cc: linux-renesas-soc@vger.kernel.org
Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Tested-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: Stephen Boyd <sboyd@kernel.org>

diff --git a/drivers/clk/clk-versaclock5.c b/drivers/clk/clk-versaclock5.c
index decffb3826ece8be3206c8c9da2d535ddcbf5be1..5b393e711e94b28559a23b215810c5bdbf3d0666 100644 (file)
--- a/drivers/clk/clk-versaclock5.c
+++ b/drivers/clk/clk-versaclock5.c
@@ -906,6 +906,28 @@ static int vc5_remove(struct i2c_client *client)
        return 0;
 }
 
+static int __maybe_unused vc5_suspend(struct device *dev)
+{
+       struct vc5_driver_data *vc5 = dev_get_drvdata(dev);
+
+       regcache_cache_only(vc5->regmap, true);
+       regcache_mark_dirty(vc5->regmap);
+
+       return 0;
+}
+
+static int __maybe_unused vc5_resume(struct device *dev)
+{
+       struct vc5_driver_data *vc5 = dev_get_drvdata(dev);
+       int ret;
+
+       regcache_cache_only(vc5->regmap, false);
+       ret = regcache_sync(vc5->regmap);
+       if (ret)
+               dev_err(dev, "Failed to restore register map: %d\n", ret);
+       return ret;
+}
+
 static const struct vc5_chip_info idt_5p49v5923_info = {
        .model = IDT_VC5_5P49V5923,
        .clk_fod_cnt = 2,
@@ -961,9 +983,12 @@ static const struct of_device_id clk_vc5_of_match[] = {
 };
 MODULE_DEVICE_TABLE(of, clk_vc5_of_match);
 
+static SIMPLE_DEV_PM_OPS(vc5_pm_ops, vc5_suspend, vc5_resume);
+
 static struct i2c_driver vc5_driver = {
        .driver = {
                .name = "vc5",
+               .pm     = &vc5_pm_ops,
                .of_match_table = clk_vc5_of_match,
        },
        .probe          = vc5_probe,