]>
Commit | Line | Data |
---|---|---|
0af4817b MD |
1 | /* |
2 | * CPUIdle support code for SH-Mobile ARM | |
3 | * | |
4 | * Copyright (C) 2011 Magnus Damm | |
5 | * | |
6 | * This file is subject to the terms and conditions of the GNU General Public | |
7 | * License. See the file "COPYING" in the main directory of this archive | |
8 | * for more details. | |
9 | */ | |
10 | ||
11 | #include <linux/pm.h> | |
12 | #include <linux/cpuidle.h> | |
13 | #include <linux/suspend.h> | |
14 | #include <linux/module.h> | |
15 | #include <linux/err.h> | |
0af4817b MD |
16 | #include <asm/io.h> |
17 | ||
18 | static void shmobile_enter_wfi(void) | |
19 | { | |
20 | cpu_do_idle(); | |
21 | } | |
22 | ||
23 | void (*shmobile_cpuidle_modes[CPUIDLE_STATE_MAX])(void) = { | |
24 | shmobile_enter_wfi, /* regular sleep mode */ | |
25 | }; | |
26 | ||
27 | static int shmobile_cpuidle_enter(struct cpuidle_device *dev, | |
b73b5c49 MD |
28 | struct cpuidle_driver *drv, |
29 | int index) | |
0af4817b MD |
30 | { |
31 | ktime_t before, after; | |
0af4817b | 32 | |
0af4817b MD |
33 | before = ktime_get(); |
34 | ||
35 | local_irq_disable(); | |
36 | local_fiq_disable(); | |
37 | ||
b73b5c49 | 38 | shmobile_cpuidle_modes[index](); |
0af4817b MD |
39 | |
40 | local_irq_enable(); | |
41 | local_fiq_enable(); | |
42 | ||
43 | after = ktime_get(); | |
b73b5c49 MD |
44 | dev->last_residency = ktime_to_ns(ktime_sub(after, before)) >> 10; |
45 | ||
46 | return index; | |
0af4817b MD |
47 | } |
48 | ||
49 | static struct cpuidle_device shmobile_cpuidle_dev; | |
50 | static struct cpuidle_driver shmobile_cpuidle_driver = { | |
51 | .name = "shmobile_cpuidle", | |
52 | .owner = THIS_MODULE, | |
b73b5c49 MD |
53 | .states[0] = { |
54 | .name = "C1", | |
55 | .desc = "WFI", | |
56 | .exit_latency = 1, | |
57 | .target_residency = 1 * 2, | |
58 | .flags = CPUIDLE_FLAG_TIME_VALID, | |
59 | }, | |
60 | .safe_state_index = 0, /* C1 */ | |
61 | .state_count = 1, | |
0af4817b MD |
62 | }; |
63 | ||
b73b5c49 | 64 | void (*shmobile_cpuidle_setup)(struct cpuidle_driver *drv); |
0af4817b MD |
65 | |
66 | static int shmobile_cpuidle_init(void) | |
67 | { | |
68 | struct cpuidle_device *dev = &shmobile_cpuidle_dev; | |
b73b5c49 | 69 | struct cpuidle_driver *drv = &shmobile_cpuidle_driver; |
0af4817b MD |
70 | int i; |
71 | ||
b73b5c49 MD |
72 | for (i = 0; i < CPUIDLE_STATE_MAX; i++) |
73 | drv->states[i].enter = shmobile_cpuidle_enter; | |
0af4817b MD |
74 | |
75 | if (shmobile_cpuidle_setup) | |
b73b5c49 MD |
76 | shmobile_cpuidle_setup(drv); |
77 | ||
78 | cpuidle_register_driver(drv); | |
0af4817b | 79 | |
b73b5c49 | 80 | dev->state_count = drv->state_count; |
0af4817b MD |
81 | cpuidle_register_device(dev); |
82 | ||
83 | return 0; | |
84 | } | |
85 | late_initcall(shmobile_cpuidle_init); |