Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 LT |
2 | * cpufreq driver for the SuperH processors. |
3 | * | |
3bccf467 | 4 | * Copyright (C) 2002 - 2012 Paul Mundt |
1da177e4 LT |
5 | * Copyright (C) 2002 M. R. Brown |
6 | * | |
cb5ec75b PM |
7 | * Clock framework bits from arch/avr32/mach-at32ap/cpufreq.c |
8 | * | |
9 | * Copyright (C) 2004-2007 Atmel Corporation | |
10 | * | |
11 | * This file is subject to the terms and conditions of the GNU General Public | |
12 | * License. See the file "COPYING" in the main directory of this archive | |
13 | * for more details. | |
1da177e4 | 14 | */ |
ecbef17a PM |
15 | #define pr_fmt(fmt) "cpufreq: " fmt |
16 | ||
1da177e4 LT |
17 | #include <linux/types.h> |
18 | #include <linux/cpufreq.h> | |
19 | #include <linux/kernel.h> | |
20 | #include <linux/module.h> | |
1da177e4 | 21 | #include <linux/init.h> |
cb5ec75b | 22 | #include <linux/err.h> |
1da177e4 | 23 | #include <linux/cpumask.h> |
ecbef17a | 24 | #include <linux/cpu.h> |
1da177e4 | 25 | #include <linux/smp.h> |
4e57b681 | 26 | #include <linux/sched.h> /* set_cpus_allowed() */ |
cb5ec75b | 27 | #include <linux/clk.h> |
3bccf467 PM |
28 | #include <linux/percpu.h> |
29 | #include <linux/sh_clk.h> | |
1da177e4 | 30 | |
3bccf467 | 31 | static DEFINE_PER_CPU(struct clk, sh_cpuclk); |
1da177e4 | 32 | |
205dcc1e TG |
33 | struct cpufreq_target { |
34 | struct cpufreq_policy *policy; | |
35 | unsigned int freq; | |
36 | }; | |
37 | ||
cb5ec75b | 38 | static unsigned int sh_cpufreq_get(unsigned int cpu) |
1da177e4 | 39 | { |
3bccf467 | 40 | return (clk_get_rate(&per_cpu(sh_cpuclk, cpu)) + 500) / 1000; |
1da177e4 LT |
41 | } |
42 | ||
205dcc1e | 43 | static long __sh_cpufreq_target(void *arg) |
1da177e4 | 44 | { |
205dcc1e TG |
45 | struct cpufreq_target *target = arg; |
46 | struct cpufreq_policy *policy = target->policy; | |
47 | int cpu = policy->cpu; | |
3bccf467 | 48 | struct clk *cpuclk = &per_cpu(sh_cpuclk, cpu); |
1da177e4 | 49 | struct cpufreq_freqs freqs; |
ecbef17a | 50 | struct device *dev; |
cb5ec75b | 51 | long freq; |
1da177e4 | 52 | |
205dcc1e TG |
53 | if (smp_processor_id() != cpu) |
54 | return -ENODEV; | |
1da177e4 | 55 | |
ecbef17a PM |
56 | dev = get_cpu_device(cpu); |
57 | ||
cb5ec75b | 58 | /* Convert target_freq from kHz to Hz */ |
205dcc1e | 59 | freq = clk_round_rate(cpuclk, target->freq * 1000); |
1da177e4 | 60 | |
cb5ec75b PM |
61 | if (freq < (policy->min * 1000) || freq > (policy->max * 1000)) |
62 | return -EINVAL; | |
63 | ||
205dcc1e | 64 | dev_dbg(dev, "requested frequency %u Hz\n", target->freq * 1000); |
1da177e4 | 65 | |
cb5ec75b PM |
66 | freqs.old = sh_cpufreq_get(cpu); |
67 | freqs.new = (freq + 500) / 1000; | |
68 | freqs.flags = 0; | |
69 | ||
205dcc1e | 70 | cpufreq_freq_transition_begin(target->policy, &freqs); |
cb5ec75b | 71 | clk_set_rate(cpuclk, freq); |
205dcc1e | 72 | cpufreq_freq_transition_end(target->policy, &freqs, 0); |
1da177e4 | 73 | |
ecbef17a | 74 | dev_dbg(dev, "set frequency %lu Hz\n", freq); |
1da177e4 LT |
75 | return 0; |
76 | } | |
77 | ||
205dcc1e TG |
78 | /* |
79 | * Here we notify other drivers of the proposed change and the final change. | |
80 | */ | |
81 | static int sh_cpufreq_target(struct cpufreq_policy *policy, | |
82 | unsigned int target_freq, | |
83 | unsigned int relation) | |
84 | { | |
85 | struct cpufreq_target data = { .policy = policy, .freq = target_freq }; | |
86 | ||
87 | return work_on_cpu(policy->cpu, __sh_cpufreq_target, &data); | |
88 | } | |
89 | ||
1bcfc723 PM |
90 | static int sh_cpufreq_verify(struct cpufreq_policy *policy) |
91 | { | |
92 | struct clk *cpuclk = &per_cpu(sh_cpuclk, policy->cpu); | |
93 | struct cpufreq_frequency_table *freq_table; | |
94 | ||
95 | freq_table = cpuclk->nr_freqs ? cpuclk->freq_table : NULL; | |
96 | if (freq_table) | |
97 | return cpufreq_frequency_table_verify(policy, freq_table); | |
98 | ||
be49e346 | 99 | cpufreq_verify_within_cpu_limits(policy); |
1bcfc723 PM |
100 | |
101 | policy->min = (clk_round_rate(cpuclk, 1) + 500) / 1000; | |
102 | policy->max = (clk_round_rate(cpuclk, ~0UL) + 500) / 1000; | |
103 | ||
be49e346 | 104 | cpufreq_verify_within_cpu_limits(policy); |
1bcfc723 PM |
105 | return 0; |
106 | } | |
107 | ||
1da177e4 LT |
108 | static int sh_cpufreq_cpu_init(struct cpufreq_policy *policy) |
109 | { | |
3bccf467 PM |
110 | unsigned int cpu = policy->cpu; |
111 | struct clk *cpuclk = &per_cpu(sh_cpuclk, cpu); | |
1bcfc723 | 112 | struct cpufreq_frequency_table *freq_table; |
ecbef17a | 113 | struct device *dev; |
3bccf467 | 114 | |
ecbef17a PM |
115 | dev = get_cpu_device(cpu); |
116 | ||
117 | cpuclk = clk_get(dev, "cpu_clk"); | |
cb5ec75b | 118 | if (IS_ERR(cpuclk)) { |
ecbef17a | 119 | dev_err(dev, "couldn't get CPU clk\n"); |
cb5ec75b PM |
120 | return PTR_ERR(cpuclk); |
121 | } | |
1da177e4 | 122 | |
1bcfc723 PM |
123 | freq_table = cpuclk->nr_freqs ? cpuclk->freq_table : NULL; |
124 | if (freq_table) { | |
ec8d2cc6 | 125 | policy->freq_table = freq_table; |
1bcfc723 | 126 | } else { |
1a565cf0 PM |
127 | dev_notice(dev, "no frequency table found, falling back " |
128 | "to rate rounding.\n"); | |
129 | ||
eb2f50ff | 130 | policy->min = policy->cpuinfo.min_freq = |
1a565cf0 | 131 | (clk_round_rate(cpuclk, 1) + 500) / 1000; |
eb2f50ff | 132 | policy->max = policy->cpuinfo.max_freq = |
1a565cf0 | 133 | (clk_round_rate(cpuclk, ~0UL) + 500) / 1000; |
cb5ec75b | 134 | } |
1da177e4 | 135 | |
cb5ec75b PM |
136 | return 0; |
137 | } | |
1da177e4 | 138 | |
1bcfc723 | 139 | static int sh_cpufreq_cpu_exit(struct cpufreq_policy *policy) |
cb5ec75b | 140 | { |
1bcfc723 PM |
141 | unsigned int cpu = policy->cpu; |
142 | struct clk *cpuclk = &per_cpu(sh_cpuclk, cpu); | |
cb5ec75b | 143 | |
cb5ec75b | 144 | clk_put(cpuclk); |
1bcfc723 | 145 | |
1da177e4 LT |
146 | return 0; |
147 | } | |
148 | ||
ec8d2cc6 VK |
149 | static void sh_cpufreq_cpu_ready(struct cpufreq_policy *policy) |
150 | { | |
151 | struct device *dev = get_cpu_device(policy->cpu); | |
152 | ||
153 | dev_info(dev, "CPU Frequencies - Minimum %u.%03u MHz, " | |
154 | "Maximum %u.%03u MHz.\n", | |
155 | policy->min / 1000, policy->min % 1000, | |
156 | policy->max / 1000, policy->max % 1000); | |
157 | } | |
158 | ||
1da177e4 | 159 | static struct cpufreq_driver sh_cpufreq_driver = { |
cb5ec75b | 160 | .name = "sh", |
fe829ed8 | 161 | .flags = CPUFREQ_NO_AUTO_DYNAMIC_SWITCHING, |
cb5ec75b | 162 | .get = sh_cpufreq_get, |
1bcfc723 PM |
163 | .target = sh_cpufreq_target, |
164 | .verify = sh_cpufreq_verify, | |
165 | .init = sh_cpufreq_cpu_init, | |
166 | .exit = sh_cpufreq_cpu_exit, | |
ec8d2cc6 | 167 | .ready = sh_cpufreq_cpu_ready, |
a8f64dec | 168 | .attr = cpufreq_generic_attr, |
1da177e4 LT |
169 | }; |
170 | ||
cb5ec75b | 171 | static int __init sh_cpufreq_module_init(void) |
1da177e4 | 172 | { |
ecbef17a | 173 | pr_notice("SuperH CPU frequency driver.\n"); |
cb5ec75b | 174 | return cpufreq_register_driver(&sh_cpufreq_driver); |
1da177e4 LT |
175 | } |
176 | ||
cb5ec75b | 177 | static void __exit sh_cpufreq_module_exit(void) |
1da177e4 LT |
178 | { |
179 | cpufreq_unregister_driver(&sh_cpufreq_driver); | |
180 | } | |
181 | ||
cb5ec75b PM |
182 | module_init(sh_cpufreq_module_init); |
183 | module_exit(sh_cpufreq_module_exit); | |
1da177e4 LT |
184 | |
185 | MODULE_AUTHOR("Paul Mundt <lethal@linux-sh.org>"); | |
186 | MODULE_DESCRIPTION("cpufreq driver for SuperH"); | |
187 | MODULE_LICENSE("GPL"); |