Use the generic power domains support to implement support for power domain on EXYNOS4210. I refer to the following patch to implement what configure the clock-gating control register for block to turn off/on: http://git.infradead.org/users/kmpark/linux-2.6-samsung/commit/39a81876d034dcbdc2a4c4c4b847b3b49e38870c This patch is based on following "pm-domains" branch. http://git.kernel.org/?p=linux/kernel/git/rafael/suspend-2.6.git;a=shortlog;h=refs/heads/pm-domains Signed-off-by: Chanwoo Choi <cw00.choi@xxxxxxxxxxx> Signed-off-by: MyungJoo Ham <myungjoo.ham@xxxxxxxxxxx> Signed-off-by: Kyungmin.park <kyungmin.park@xxxxxxxxxxx> --- arch/arm/mach-exynos4/Kconfig | 1 + arch/arm/mach-exynos4/Makefile | 1 + arch/arm/mach-exynos4/include/mach/pm-exynos4210.h | 69 ++++++++ arch/arm/mach-exynos4/include/mach/regs-clock.h | 8 + arch/arm/mach-exynos4/mach-nuri.c | 20 +++ arch/arm/mach-exynos4/pm-exynos4210.c | 170 ++++++++++++++++++++ arch/arm/plat-samsung/include/plat/pd.h | 3 +- 7 files changed, 271 insertions(+), 1 deletions(-) create mode 100644 arch/arm/mach-exynos4/include/mach/pm-exynos4210.h create mode 100644 arch/arm/mach-exynos4/pm-exynos4210.c diff --git a/arch/arm/mach-exynos4/Kconfig b/arch/arm/mach-exynos4/Kconfig index 1435fc3..266e7f6 100644 --- a/arch/arm/mach-exynos4/Kconfig +++ b/arch/arm/mach-exynos4/Kconfig @@ -183,6 +183,7 @@ config MACH_NURI select EXYNOS4_SETUP_SDHCI select EXYNOS4_SETUP_USB_PHY select SAMSUNG_DEV_PWM + select PM_GENERIC_DOMAINS help Machine support for Samsung Mobile NURI Board. diff --git a/arch/arm/mach-exynos4/Makefile b/arch/arm/mach-exynos4/Makefile index 60fe5ec..0e9461f 100644 --- a/arch/arm/mach-exynos4/Makefile +++ b/arch/arm/mach-exynos4/Makefile @@ -17,6 +17,7 @@ obj-$(CONFIG_CPU_EXYNOS4210) += setup-i2c0.o irq-eint.o dma.o obj-$(CONFIG_PM) += pm.o sleep.o obj-$(CONFIG_CPU_FREQ) += cpufreq.o obj-$(CONFIG_CPU_IDLE) += cpuidle.o +obj-$(CONFIG_CPU_EXYNOS4210) += pm-exynos4210.o obj-$(CONFIG_SMP) += platsmp.o headsmp.o diff --git a/arch/arm/mach-exynos4/include/mach/pm-exynos4210.h b/arch/arm/mach-exynos4/include/mach/pm-exynos4210.h new file mode 100644 index 0000000..ff924a8 --- /dev/null +++ b/arch/arm/mach-exynos4/include/mach/pm-exynos4210.h @@ -0,0 +1,69 @@ +/* linux/arch/arm/mach-exynos4/include/mach/pm-exynos4.h + * + * Exynos4 Power management support + * + * Copyright (c) 2010-2011 Samsung Electronics Co., Ltd. + * http://www.samsung.com + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#ifndef __PM_EXYNOS4210_H__ +#define __PM_EXYNOS4210_H__ + +#include <linux/pm_domain.h> +#include <plat/pd.h> + +struct platform_device; + +struct exynos4210_pm_domain { + struct generic_pm_domain genpd; + + const char *name; + void __iomem *base; + unsigned long gate_mask; + int boot_on; +}; + +static inline struct exynos4210_pm_domain *to_exynos4210_pd( + struct generic_pm_domain *pd) +{ + return container_of(pd, struct exynos4210_pm_domain, genpd); +} + +#ifdef CONFIG_PM +extern struct exynos4210_pm_domain exynos4210_pd_list[PD_MAX_NUM]; +#define EXYNOS4210_MFC (&exynos4210_pd_list[PD_MFC]) +#define EXYNOS4210_G3D (&exynos4210_pd_list[PD_G3D]) +#define EXYNOS4210_LCD0 (&exynos4210_pd_list[PD_LCD0]) +#define EXYNOS4210_LCD1 (&exynos4210_pd_list[PD_LCD1]) +#define EXYNOS4210_TV (&exynos4210_pd_list[PD_TV]) +#define EXYNOS4210_CAM (&exynos4210_pd_list[PD_CAM]) +#define EXYNOS4210_GPS (&exynos4210_pd_list[PD_GPS]) + +int exynos4210_pd_init(struct exynos4210_pm_domain *domain); +int exynos4210_add_device_to_domain(struct exynos4210_pm_domain *domain, + struct platform_device *pdev); +#else +#define EXYNOS4210_MFC NULL +#define EXYNOS4210_G3D NULL +#define EXYNOS4210_LCD0 NULL +#define EXYNOS4210_LCD1 NULL +#define EXYNOS4210_TV NULL +#define EXYNOS4210_CAM NULL +#define EXYNOS4210_GPS NULL + +static inline int exynos4210_pd_init(struct exynos4210_pm_domain *domain) +{ + return 0; +} +static inline int exynos4_add_device_to_domain(struct exynos4210_pm_domain *domain, + struct platform_device *pdev) +{ + return 0; +} +#endif /* CONFIG_PM */ + +#endif /* __PM_EXYNOS4210_H__ */ diff --git a/arch/arm/mach-exynos4/include/mach/regs-clock.h b/arch/arm/mach-exynos4/include/mach/regs-clock.h index 6e311c1..bc0fda9 100644 --- a/arch/arm/mach-exynos4/include/mach/regs-clock.h +++ b/arch/arm/mach-exynos4/include/mach/regs-clock.h @@ -171,6 +171,14 @@ #define S5P_CLKDIV_BUS_GPLR_SHIFT (4) #define S5P_CLKDIV_BUS_GPLR_MASK (0x7 << S5P_CLKDIV_BUS_GPLR_SHIFT) +#define S5P_CLKGATE_BLOCK_CAM (1<<0) +#define S5P_CLKGATE_BLOCK_TV (1<<1) +#define S5P_CLKGATE_BLOCK_MFC (1<<2) +#define S5P_CLKGATE_BLOCK_G3D (1<<3) +#define S5P_CLKGATE_BLOCK_LCD0 (1<<4) +#define S5P_CLKGATE_BLOCK_LCD1 (1<<5) +#define S5P_CLKGATE_BLOCK_GPS (1<<7) + /* Compatibility defines and inclusion */ #include <mach/regs-pmu.h> diff --git a/arch/arm/mach-exynos4/mach-nuri.c b/arch/arm/mach-exynos4/mach-nuri.c index 642702b..805c6d5 100644 --- a/arch/arm/mach-exynos4/mach-nuri.c +++ b/arch/arm/mach-exynos4/mach-nuri.c @@ -37,6 +37,7 @@ #include <plat/iic.h> #include <mach/map.h> +#include <mach/pm-exynos4210.h> /* Following are default values for UCON, ULCON and UFCON UART registers */ #define NURI_UCON_DEFAULT (S3C2410_UCON_TXILEVEL | \ @@ -376,6 +377,23 @@ static struct platform_device *nuri_devices[] __initdata = { &nuri_backlight_device, }; +static void __init nuri_power_domain_init(void) +{ + int i; + + for (i = 0 ; i < PD_MAX_NUM ; i++) + exynos4210_pd_init(&exynos4210_pd_list[i]); + + /* Add device to power-domain */ + exynos4210_add_device_to_domain(EXYNOS4210_MFC, NULL); + exynos4210_add_device_to_domain(EXYNOS4210_G3D, NULL); + exynos4210_add_device_to_domain(EXYNOS4210_LCD0, &nuri_lcd_device); + exynos4210_add_device_to_domain(EXYNOS4210_LCD1, NULL); + exynos4210_add_device_to_domain(EXYNOS4210_TV, NULL); + exynos4210_add_device_to_domain(EXYNOS4210_CAM, NULL); + exynos4210_add_device_to_domain(EXYNOS4210_GPS, NULL); +} + static void __init nuri_map_io(void) { s5p_init_io(NULL, 0, S5P_VA_CHIPID); @@ -398,6 +416,8 @@ static void __init nuri_machine_init(void) /* Last */ platform_add_devices(nuri_devices, ARRAY_SIZE(nuri_devices)); + + nuri_power_domain_init(); } MACHINE_START(NURI, "NURI") diff --git a/arch/arm/mach-exynos4/pm-exynos4210.c b/arch/arm/mach-exynos4/pm-exynos4210.c new file mode 100644 index 0000000..a2061a7 --- /dev/null +++ b/arch/arm/mach-exynos4/pm-exynos4210.c @@ -0,0 +1,170 @@ +/* linux/arch/arm/mach-exynos4/pm-exynos4210.c + * + * Exynos4210 Power management support + * + * Copyright (c) 2010-2011 Samsung Electronics Co., Ltd. + * http://www.samsung.com + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#include <linux/pm.h> +#include <linux/module.h> +#include <linux/delay.h> +#include <linux/err.h> +#include <linux/slab.h> +#include <linux/platform_device.h> +#include <linux/pm_runtime.h> +#include <linux/pm_domain.h> +#include <linux/io.h> + +#include <mach/regs-pmu.h> +#include <mach/regs-clock.h> +#include <mach/pm-exynos4210.h> + +struct exynos4210_pm_domain exynos4210_pd_list[] = { + { + .name = "PD_MFC", + .base = S5P_PMU_MFC_CONF, + .gate_mask = S5P_CLKGATE_BLOCK_MFC, + .boot_on = 0, + }, { + .name = "PD_G3D", + .base = S5P_PMU_G3D_CONF, + .gate_mask = S5P_CLKGATE_BLOCK_G3D, + .boot_on = 0, + }, { + .name = "PD_LCD0", + .base = S5P_PMU_LCD0_CONF, + .gate_mask = S5P_CLKGATE_BLOCK_LCD0, + .boot_on = 1, + }, { + .name = "PD_LCD1", + .base = S5P_PMU_LCD1_CONF, + .gate_mask = S5P_CLKGATE_BLOCK_LCD1, + .boot_on = 0, + }, { + .name = "PD_TV", + .base = S5P_PMU_TV_CONF, + .gate_mask = S5P_CLKGATE_BLOCK_TV, + .boot_on = 0, + }, { + .name = "PD_CAM", + .base = S5P_PMU_CAM_CONF, + .gate_mask = S5P_CLKGATE_BLOCK_CAM, + .boot_on = 0, + }, { + .name = "PD_GPS", + .base = S5P_PMU_GPS_CONF, + .gate_mask = S5P_CLKGATE_BLOCK_GPS, + .boot_on = 0, + }, +}; + +static DEFINE_SPINLOCK(clkgate_block_lock); + +static int pd_power_down(struct generic_pm_domain *genpd) +{ + struct exynos4210_pm_domain *domain = to_exynos4210_pd(genpd); + u32 timeout; + + /* Disable the power of power-domain */ + __raw_writel(0, domain->base); + + /* Wait max 1ms */ + timeout = 10; + while (__raw_readl(domain->base + 0x4) & S5P_INT_LOCAL_PWR_EN) { + if (timeout == 0) { + printk(KERN_ERR "Power domain %s disable failed.\n", + domain->name); + return -ETIMEDOUT; + } + timeout--; + udelay(100); + } + + /* Configure the clock-gating control register for block to turn off */ + if (domain->gate_mask) { + unsigned long flags; + unsigned long value; + + spin_lock_irqsave(&clkgate_block_lock, flags); + + value = __raw_readl(S5P_CLKGATE_BLOCK); + value &= ~domain->gate_mask; + __raw_writel(value, S5P_CLKGATE_BLOCK); + + spin_unlock_irqrestore(&clkgate_block_lock, flags); + } + + return 0; +} + +static int pd_power_up(struct generic_pm_domain *genpd) +{ + struct exynos4210_pm_domain *domain = to_exynos4210_pd(genpd); + u32 timeout; + + /* Enable power domain */ + __raw_writel(S5P_INT_LOCAL_PWR_EN, domain->base); + + /* Wait max 1ms */ + timeout = 10; + while ((__raw_readl(domain->base + 0x4) & S5P_INT_LOCAL_PWR_EN) + != S5P_INT_LOCAL_PWR_EN) { + if (timeout == 0) { + printk(KERN_ERR "Power domain %s enable failed.\n", + domain->name); + return -ETIMEDOUT; + } + timeout--; + udelay(100); + } + + /* Configure the clock-gating control register for block to turn on */ + if (domain->gate_mask) { + unsigned long flags; + unsigned long value; + + spin_lock_irqsave(&clkgate_block_lock, flags); + + value = __raw_readl(S5P_CLKGATE_BLOCK); + value |= domain->gate_mask; + __raw_writel(value, S5P_CLKGATE_BLOCK); + + spin_unlock_irqrestore(&clkgate_block_lock, flags); + } + + return 0; +} + +int exynos4210_pd_init(struct exynos4210_pm_domain *domain) +{ + struct generic_pm_domain *genpd = &domain->genpd; + + pm_genpd_init(genpd, NULL, false); + + genpd->stop_device = pm_runtime_clk_suspend; + genpd->start_device = pm_runtime_clk_resume; + genpd->power_off = pd_power_down; + genpd->power_on = pd_power_up; + + if (domain->boot_on) + pd_power_up(genpd); + + return 0; +} + +int exynos4210_add_device_to_domain(struct exynos4210_pm_domain *domain, + struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct generic_pm_domain *genpd = &domain->genpd; + + if (pdev) + return pm_genpd_add_device(genpd, dev); + + return -EINVAL; +} diff --git a/arch/arm/plat-samsung/include/plat/pd.h b/arch/arm/plat-samsung/include/plat/pd.h index abb4bc3..fcd803b 100644 --- a/arch/arm/plat-samsung/include/plat/pd.h +++ b/arch/arm/plat-samsung/include/plat/pd.h @@ -24,7 +24,8 @@ enum exynos4_pd_block { PD_LCD1, PD_TV, PD_CAM, - PD_GPS + PD_GPS, + PD_MAX_NUM }; #endif /* __ASM_PLAT_SAMSUNG_PD_H */ -- 1.7.0.4 _______________________________________________ linux-pm mailing list linux-pm@xxxxxxxxxxxxxxxxxxxxxxxxxx https://lists.linux-foundation.org/mailman/listinfo/linux-pm
