pwr-island.c 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * MMP PMU power island support
  4. *
  5. * Copyright (C) 2020 Lubomir Rintel <lkundrak@v3.sk>
  6. */
  7. #include <linux/pm_domain.h>
  8. #include <linux/slab.h>
  9. #include <linux/io.h>
  10. #include "clk.h"
  11. #define to_mmp_pm_domain(genpd) container_of(genpd, struct mmp_pm_domain, genpd)
  12. struct mmp_pm_domain {
  13. struct generic_pm_domain genpd;
  14. void __iomem *reg;
  15. spinlock_t *lock;
  16. u32 power_on;
  17. u32 reset;
  18. u32 clock_enable;
  19. unsigned int flags;
  20. };
  21. static int mmp_pm_domain_power_on(struct generic_pm_domain *genpd)
  22. {
  23. struct mmp_pm_domain *pm_domain = to_mmp_pm_domain(genpd);
  24. unsigned long flags = 0;
  25. u32 val;
  26. if (pm_domain->lock)
  27. spin_lock_irqsave(pm_domain->lock, flags);
  28. val = readl(pm_domain->reg);
  29. /* Turn on the power island */
  30. val |= pm_domain->power_on;
  31. writel(val, pm_domain->reg);
  32. /* Disable isolation */
  33. val |= 0x100;
  34. writel(val, pm_domain->reg);
  35. /* Some blocks need to be reset after a power up */
  36. if (pm_domain->reset || pm_domain->clock_enable) {
  37. u32 after_power_on = val;
  38. val &= ~pm_domain->reset;
  39. writel(val, pm_domain->reg);
  40. val |= pm_domain->clock_enable;
  41. writel(val, pm_domain->reg);
  42. val |= pm_domain->reset;
  43. writel(val, pm_domain->reg);
  44. writel(after_power_on, pm_domain->reg);
  45. }
  46. if (pm_domain->lock)
  47. spin_unlock_irqrestore(pm_domain->lock, flags);
  48. return 0;
  49. }
  50. static int mmp_pm_domain_power_off(struct generic_pm_domain *genpd)
  51. {
  52. struct mmp_pm_domain *pm_domain = to_mmp_pm_domain(genpd);
  53. unsigned long flags = 0;
  54. u32 val;
  55. if (pm_domain->flags & MMP_PM_DOMAIN_NO_DISABLE)
  56. return 0;
  57. if (pm_domain->lock)
  58. spin_lock_irqsave(pm_domain->lock, flags);
  59. /* Turn off and isolate the the power island. */
  60. val = readl(pm_domain->reg);
  61. val &= ~pm_domain->power_on;
  62. val &= ~0x100;
  63. writel(val, pm_domain->reg);
  64. if (pm_domain->lock)
  65. spin_unlock_irqrestore(pm_domain->lock, flags);
  66. return 0;
  67. }
  68. struct generic_pm_domain *mmp_pm_domain_register(const char *name,
  69. void __iomem *reg,
  70. u32 power_on, u32 reset, u32 clock_enable,
  71. unsigned int flags, spinlock_t *lock)
  72. {
  73. struct mmp_pm_domain *pm_domain;
  74. pm_domain = kzalloc(sizeof(*pm_domain), GFP_KERNEL);
  75. if (!pm_domain)
  76. return ERR_PTR(-ENOMEM);
  77. pm_domain->reg = reg;
  78. pm_domain->power_on = power_on;
  79. pm_domain->reset = reset;
  80. pm_domain->clock_enable = clock_enable;
  81. pm_domain->flags = flags;
  82. pm_domain->lock = lock;
  83. pm_genpd_init(&pm_domain->genpd, NULL, true);
  84. pm_domain->genpd.name = name;
  85. pm_domain->genpd.power_on = mmp_pm_domain_power_on;
  86. pm_domain->genpd.power_off = mmp_pm_domain_power_off;
  87. return &pm_domain->genpd;
  88. }