target/linux/at91/patches-5.15/218-ARM-at91-pm-add-pm-support-for-SAMA7G5.patch

   1 From aba3984dc7a405d20b83bff603d23719d0e26bc7 Mon Sep 17 00:00:00 2001
   2 From: Claudiu Beznea <claudiu.beznea@microchip.com>
   3 Date: Thu, 15 Apr 2021 13:50:09 +0300
   4 Subject: [PATCH 218/247] ARM: at91: pm: add pm support for SAMA7G5
   5
   6 Add support for SAMA7G5 power management modes: standby, ulp0, ulp1, backup.
   7
   8 Signed-off-by: Claudiu Beznea <claudiu.beznea@microchip.com>
   9 Signed-off-by: Nicolas Ferre <nicolas.ferre@microchip.com>
  10 Link: https://lore.kernel.org/r/20210415105010.569620-24-claudiu.beznea@microchip.com
  11 ---
  12  arch/arm/mach-at91/generic.h |  2 ++
  13  arch/arm/mach-at91/pm.c      | 37 ++++++++++++++++++++++++++++++++++++
  14  arch/arm/mach-at91/sama7.c   |  1 +
  15  3 files changed, 40 insertions(+)
  16
  17 --- a/arch/arm/mach-at91/generic.h
  18 +++ b/arch/arm/mach-at91/generic.h
  19 @@ -14,12 +14,14 @@ extern void __init at91sam9_pm_init(void
  20  extern void __init sam9x60_pm_init(void);
  21  extern void __init sama5_pm_init(void);
  22  extern void __init sama5d2_pm_init(void);
  23 +extern void __init sama7_pm_init(void);
  24  #else
  25  static inline void __init at91rm9200_pm_init(void) { }
  26  static inline void __init at91sam9_pm_init(void) { }
  27  static inline void __init sam9x60_pm_init(void) { }
  28  static inline void __init sama5_pm_init(void) { }
  29  static inline void __init sama5d2_pm_init(void) { }
  30 +static inline void __init sama7_pm_init(void) { }
  31  #endif
  32
  33  #endif /* _AT91_GENERIC_H */
  34 --- a/arch/arm/mach-at91/pm.c
  35 +++ b/arch/arm/mach-at91/pm.c
  36 @@ -152,6 +152,17 @@ static const struct of_device_id sam9x60
  37         { /* sentinel */ }
  38  };
  39
  40 +static const struct of_device_id sama7g5_ws_ids[] = {
  41 +       { .compatible = "atmel,at91sam9x5-rtc",         .data = &ws_info[1] },
  42 +       { .compatible = "microchip,sama7g5-ohci",       .data = &ws_info[2] },
  43 +       { .compatible = "usb-ohci",                     .data = &ws_info[2] },
  44 +       { .compatible = "atmel,at91sam9g45-ehci",       .data = &ws_info[2] },
  45 +       { .compatible = "usb-ehci",                     .data = &ws_info[2] },
  46 +       { .compatible = "microchip,sama7g5-sdhci",      .data = &ws_info[3] },
  47 +       { .compatible = "atmel,at91sam9260-rtt",        .data = &ws_info[4] },
  48 +       { /* sentinel */ }
  49 +};
  50 +
  51  static int at91_pm_config_ws(unsigned int pm_mode, bool set)
  52  {
  53         const struct wakeup_source_info *wsi;
  54 @@ -1139,6 +1150,32 @@ void __init sama5d2_pm_init(void)
  55         soc_pm.config_pmc_ws = at91_sama5d2_config_pmc_ws;
  56  }
  57
  58 +void __init sama7_pm_init(void)
  59 +{
  60 +       static const int modes[] __initconst = {
  61 +               AT91_PM_STANDBY, AT91_PM_ULP0, AT91_PM_ULP1, AT91_PM_BACKUP,
  62 +       };
  63 +       static const u32 iomaps[] __initconst = {
  64 +               [AT91_PM_ULP0]          = AT91_PM_IOMAP(SFRBU),
  65 +               [AT91_PM_ULP1]          = AT91_PM_IOMAP(SFRBU) |
  66 +                                         AT91_PM_IOMAP(SHDWC),
  67 +               [AT91_PM_BACKUP]        = AT91_PM_IOMAP(SFRBU) |
  68 +                                         AT91_PM_IOMAP(SHDWC),
  69 +       };
  70 +
  71 +       if (!IS_ENABLED(CONFIG_SOC_SAMA7))
  72 +               return;
  73 +
  74 +       at91_pm_modes_validate(modes, ARRAY_SIZE(modes));
  75 +
  76 +       at91_dt_ramc(true);
  77 +       at91_pm_modes_init(iomaps, ARRAY_SIZE(iomaps));
  78 +       at91_pm_init(NULL);
  79 +
  80 +       soc_pm.ws_ids = sama7g5_ws_ids;
  81 +       soc_pm.config_pmc_ws = at91_sam9x60_config_pmc_ws;
  82 +}
  83 +
  84  static int __init at91_pm_modes_select(char *str)
  85  {
  86         char *s;
  87 --- a/arch/arm/mach-at91/sama7.c
  88 +++ b/arch/arm/mach-at91/sama7.c
  89 @@ -17,6 +17,7 @@
  90  static void __init sama7_dt_device_init(void)
  91  {
  92         of_platform_default_populate(NULL, NULL, NULL);
  93 +       sama7_pm_init();
  94  }
  95
  96  static const char *const sama7_dt_board_compat[] __initconst = {