clk/ingenic/pm.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /*
0003  * Copyright (C) 2019 Paul Cercueil <paul@crapouillou.net>
0004  */
0005
0006 #include "cgu.h"
0007 #include "pm.h"
0008
0009 #include <linux/io.h>
0010 #include <linux/syscore_ops.h>
0011
0012 #define CGU_REG_LCR     0x04
0013
0014 #define LCR_LOW_POWER_MODE  BIT(0)
0015
0016 static void __iomem * __maybe_unused ingenic_cgu_base;
0017
0018 static int __maybe_unused ingenic_cgu_pm_suspend(void)
0019 {
0020     u32 val = readl(ingenic_cgu_base + CGU_REG_LCR);
0021
0022     writel(val | LCR_LOW_POWER_MODE, ingenic_cgu_base + CGU_REG_LCR);
0023
0024     return 0;
0025 }
0026
0027 static void __maybe_unused ingenic_cgu_pm_resume(void)
0028 {
0029     u32 val = readl(ingenic_cgu_base + CGU_REG_LCR);
0030
0031     writel(val & ~LCR_LOW_POWER_MODE, ingenic_cgu_base + CGU_REG_LCR);
0032 }
0033
0034 static struct syscore_ops __maybe_unused ingenic_cgu_pm_ops = {
0035     .suspend = ingenic_cgu_pm_suspend,
0036     .resume = ingenic_cgu_pm_resume,
0037 };
0038
0039 void ingenic_cgu_register_syscore_ops(struct ingenic_cgu *cgu)
0040 {
0041     if (IS_ENABLED(CONFIG_PM_SLEEP)) {
0042         ingenic_cgu_base = cgu->base;
0043         register_syscore_ops(&ingenic_cgu_pm_ops);
0044     }
0045 }