pm.c 999 B

123456789101112131415161718192021222324252627282930313233343536373839404142434445
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2019 Paul Cercueil <paul@crapouillou.net>
  4. */
  5. #include "cgu.h"
  6. #include "pm.h"
  7. #include <linux/io.h>
  8. #include <linux/syscore_ops.h>
  9. #define CGU_REG_LCR 0x04
  10. #define LCR_LOW_POWER_MODE BIT(0)
  11. static void __iomem * __maybe_unused ingenic_cgu_base;
  12. static int __maybe_unused ingenic_cgu_pm_suspend(void)
  13. {
  14. u32 val = readl(ingenic_cgu_base + CGU_REG_LCR);
  15. writel(val | LCR_LOW_POWER_MODE, ingenic_cgu_base + CGU_REG_LCR);
  16. return 0;
  17. }
  18. static void __maybe_unused ingenic_cgu_pm_resume(void)
  19. {
  20. u32 val = readl(ingenic_cgu_base + CGU_REG_LCR);
  21. writel(val & ~LCR_LOW_POWER_MODE, ingenic_cgu_base + CGU_REG_LCR);
  22. }
  23. static struct syscore_ops __maybe_unused ingenic_cgu_pm_ops = {
  24. .suspend = ingenic_cgu_pm_suspend,
  25. .resume = ingenic_cgu_pm_resume,
  26. };
  27. void ingenic_cgu_register_syscore_ops(struct ingenic_cgu *cgu)
  28. {
  29. if (IS_ENABLED(CONFIG_PM_SLEEP)) {
  30. ingenic_cgu_base = cgu->base;
  31. register_syscore_ops(&ingenic_cgu_pm_ops);
  32. }
  33. }