Commit 6501330f authored by Claudiu Beznea's avatar Claudiu Beznea Committed by Nicolas Ferre
Browse files

ARM: at91: pm: add pm support for SAMA7G5 



Add support for SAMA7G5 power management modes: standby, ulp0, ulp1, backup.

Signed-off-by: default avatarClaudiu Beznea <claudiu.beznea@microchip.com>
Signed-off-by: default avatarNicolas Ferre <nicolas.ferre@microchip.com>
Link: https://lore.kernel.org/r/20210415105010.569620-24-claudiu.beznea@microchip.com
parent 9d464cc5

arch/arm/mach-at91/generic.h

+2 −0
Original line number Diff line number Diff line
@@ -14,12 +14,14 @@ extern void __init at91sam9_pm_init(void); 
extern void __init sam9x60_pm_init(void);

extern void __init sama5_pm_init(void);

extern void __init sama5d2_pm_init(void);

extern void __init sama7_pm_init(void);

#else

static inline void __init at91rm9200_pm_init(void) { }

static inline void __init at91sam9_pm_init(void) { }

static inline void __init sam9x60_pm_init(void) { }

static inline void __init sama5_pm_init(void) { }

static inline void __init sama5d2_pm_init(void) { }

static inline void __init sama7_pm_init(void) { }

#endif



#endif /* _AT91_GENERIC_H */

arch/arm/mach-at91/pm.c

+37 −0
Original line number Diff line number Diff line
@@ -152,6 +152,17 @@ static const struct of_device_id sam9x60_ws_ids[] = { 
	{ /* sentinel */ }

};



static const struct of_device_id sama7g5_ws_ids[] = {

	{ .compatible = "atmel,at91sam9x5-rtc",		.data = &ws_info[1] },

	{ .compatible = "microchip,sama7g5-ohci",	.data = &ws_info[2] },

	{ .compatible = "usb-ohci",			.data = &ws_info[2] },

	{ .compatible = "atmel,at91sam9g45-ehci",	.data = &ws_info[2] },

	{ .compatible = "usb-ehci",			.data = &ws_info[2] },

	{ .compatible = "microchip,sama7g5-sdhci",	.data = &ws_info[3] },

	{ .compatible = "atmel,at91sam9260-rtt",	.data = &ws_info[4] },

	{ /* sentinel */ }

};



static int at91_pm_config_ws(unsigned int pm_mode, bool set)

{

	const struct wakeup_source_info *wsi;
@@ -1103,6 +1114,32 @@ void __init sama5d2_pm_init(void) 
	soc_pm.config_pmc_ws = at91_sama5d2_config_pmc_ws;

}



void __init sama7_pm_init(void)

{

	static const int modes[] __initconst = {

		AT91_PM_STANDBY, AT91_PM_ULP0, AT91_PM_ULP1, AT91_PM_BACKUP,

	};

	static const u32 iomaps[] __initconst = {

		[AT91_PM_ULP0]		= AT91_PM_IOMAP(SFRBU),

		[AT91_PM_ULP1]		= AT91_PM_IOMAP(SFRBU) |

					  AT91_PM_IOMAP(SHDWC),

		[AT91_PM_BACKUP]	= AT91_PM_IOMAP(SFRBU) |

					  AT91_PM_IOMAP(SHDWC),

	};



	if (!IS_ENABLED(CONFIG_SOC_SAMA7))

		return;



	at91_pm_modes_validate(modes, ARRAY_SIZE(modes));



	at91_dt_ramc(true);

	at91_pm_modes_init(iomaps, ARRAY_SIZE(iomaps));

	at91_pm_init(NULL);



	soc_pm.ws_ids = sama7g5_ws_ids;

	soc_pm.config_pmc_ws = at91_sam9x60_config_pmc_ws;

}



static int __init at91_pm_modes_select(char *str)

{

	char *s;

arch/arm/mach-at91/sama7.c

+1 −0
Original line number Diff line number Diff line
@@ -17,6 +17,7 @@ 
static void __init sama7_dt_device_init(void)

{

	of_platform_default_populate(NULL, NULL, NULL);

	sama7_pm_init();

}



static const char *const sama7_dt_board_compat[] __initconst = {