cpuidle.c 3.8 KB
Newer Older
1
/* linux/arch/arm/mach-exynos/cpuidle.c
J
Jaecheol Lee 已提交
2 3 4 5 6 7 8 9 10 11 12 13
 *
 * Copyright (c) 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/kernel.h>
#include <linux/init.h>
#include <linux/cpuidle.h>
14
#include <linux/cpu_pm.h>
J
Jaecheol Lee 已提交
15
#include <linux/io.h>
16
#include <linux/export.h>
17
#include <linux/module.h>
18
#include <linux/time.h>
19
#include <linux/platform_device.h>
J
Jaecheol Lee 已提交
20 21

#include <asm/proc-fns.h>
22 23 24
#include <asm/smp_scu.h>
#include <asm/suspend.h>
#include <asm/unified.h>
25
#include <asm/cpuidle.h>
26 27

#include <plat/cpu.h>
28
#include <plat/pm.h>
29

30 31
#include <mach/map.h>

32
#include "common.h"
33
#include "regs-pmu.h"
34

35 36 37 38 39 40 41 42
#define REG_DIRECTGO_ADDR	(samsung_rev() == EXYNOS4210_REV_1_1 ? \
			S5P_INFORM7 : (samsung_rev() == EXYNOS4210_REV_1_0 ? \
			(S5P_VA_SYSRAM + 0x24) : S5P_INFORM0))
#define REG_DIRECTGO_FLAG	(samsung_rev() == EXYNOS4210_REV_1_1 ? \
			S5P_INFORM6 : (samsung_rev() == EXYNOS4210_REV_1_0 ? \
			(S5P_VA_SYSRAM + 0x20) : S5P_INFORM1))

#define S5P_CHECK_AFTR		0xFCBA0D10
J
Jaecheol Lee 已提交
43

44
/* Ext-GIC nIRQ/nFIQ is the only wakeup source in AFTR */
45
static void exynos_set_wakeupmask(void)
46 47 48 49 50 51
{
	__raw_writel(0x0000ff3e, S5P_WAKEUP_MASK);
}

static int idle_finisher(unsigned long flags)
{
52 53 54 55 56 57 58 59
	exynos_set_wakeupmask();

	__raw_writel(virt_to_phys(s3c_cpu_resume), REG_DIRECTGO_ADDR);
	__raw_writel(S5P_CHECK_AFTR, REG_DIRECTGO_FLAG);

	/* Set value of power down register for aftr mode */
	exynos_sys_powerdown_conf(SYS_AFTR);

60
	cpu_do_idle();
61

62 63 64
	return 1;
}

65
static int exynos_enter_core0_aftr(struct cpuidle_device *dev,
66 67 68 69 70 71 72 73 74 75 76 77 78 79
				struct cpuidle_driver *drv,
				int index)
{
	unsigned long tmp;

	/* Setting Central Sequence Register for power down mode */
	tmp = __raw_readl(S5P_CENTRAL_SEQ_CONFIGURATION);
	tmp &= ~S5P_CENTRAL_LOWPWR_CFG;
	__raw_writel(tmp, S5P_CENTRAL_SEQ_CONFIGURATION);

	cpu_pm_enter();
	cpu_suspend(0, idle_finisher);

#ifdef CONFIG_SMP
80 81
	if (!soc_is_exynos5250())
		scu_enable(S5P_VA_SCU);
82 83 84 85 86 87 88 89 90 91 92 93 94
#endif
	cpu_pm_exit();

	/*
	 * If PMU failed while entering sleep mode, WFI will be
	 * ignored by PMU and then exiting cpu_do_idle().
	 * S5P_CENTRAL_LOWPWR_CFG bit will not be set automatically
	 * in this situation.
	 */
	tmp = __raw_readl(S5P_CENTRAL_SEQ_CONFIGURATION);
	if (!(tmp & S5P_CENTRAL_LOWPWR_CFG)) {
		tmp |= S5P_CENTRAL_LOWPWR_CFG;
		__raw_writel(tmp, S5P_CENTRAL_SEQ_CONFIGURATION);
95 96
		/* Clear wakeup state register */
		__raw_writel(0x0, S5P_WAKEUP_STAT);
97 98
	}

99
	return index;
J
Jaecheol Lee 已提交
100 101
}

102
static int exynos_enter_lowpower(struct cpuidle_device *dev,
103 104 105 106 107
				struct cpuidle_driver *drv,
				int index)
{
	int new_index = index;

108 109
	/* AFTR can only be entered when cores other than CPU0 are offline */
	if (num_online_cpus() > 1 || dev->cpu != 0)
110 111 112
		new_index = drv->safe_state_index;

	if (new_index == 0)
113
		return arm_cpuidle_simple_enter(dev, drv, new_index);
114
	else
115
		return exynos_enter_core0_aftr(dev, drv, new_index);
116 117
}

118 119
static struct cpuidle_driver exynos_idle_driver = {
	.name			= "exynos_idle",
120 121 122 123
	.owner			= THIS_MODULE,
	.states = {
		[0] = ARM_CPUIDLE_WFI_STATE,
		[1] = {
124
			.enter			= exynos_enter_lowpower,
125 126 127 128 129 130 131 132 133 134 135
			.exit_latency		= 300,
			.target_residency	= 100000,
			.flags			= CPUIDLE_FLAG_TIME_VALID,
			.name			= "C1",
			.desc			= "ARM power down",
		},
	},
	.state_count = 2,
	.safe_state_index = 0,
};

136
static int exynos_cpuidle_probe(struct platform_device *pdev)
J
Jaecheol Lee 已提交
137
{
138
	int ret;
139

140
	if (soc_is_exynos5440())
141
		exynos_idle_driver.state_count = 1;
142

143
	ret = cpuidle_register(&exynos_idle_driver, NULL);
144
	if (ret) {
145
		dev_err(&pdev->dev, "failed to register cpuidle driver\n");
146
		return ret;
147
	}
J
Jaecheol Lee 已提交
148 149 150

	return 0;
}
151 152 153 154 155 156 157 158 159 160

static struct platform_driver exynos_cpuidle_driver = {
	.probe	= exynos_cpuidle_probe,
	.driver = {
		.name = "exynos_cpuidle",
		.owner = THIS_MODULE,
	},
};

module_platform_driver(exynos_cpuidle_driver);