2 * Copyright (C) 2012 Freescale Semiconductor, Inc.
4 * Copyright (C) 2014 Linaro.
5 * Viresh Kumar <viresh.kumar@linaro.org>
7 * The OPP code in function set_target() is reused from
8 * drivers/cpufreq/omap-cpufreq.c
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
15 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
17 #include <linux/clk.h>
18 #include <linux/cpu.h>
19 #include <linux/cpu_cooling.h>
20 #include <linux/cpufreq.h>
21 #include <linux/cpumask.h>
22 #include <linux/err.h>
23 #include <linux/module.h>
25 #include <linux/pm_opp.h>
26 #include <linux/platform_device.h>
27 #include <linux/regulator/consumer.h>
28 #include <linux/slab.h>
29 #include <linux/thermal.h>
32 struct device
*cpu_dev
;
33 struct regulator
*cpu_reg
;
34 struct thermal_cooling_device
*cdev
;
35 unsigned int voltage_tolerance
; /* in percentage */
38 static int set_target(struct cpufreq_policy
*policy
, unsigned int index
)
40 struct dev_pm_opp
*opp
;
41 struct cpufreq_frequency_table
*freq_table
= policy
->freq_table
;
42 struct clk
*cpu_clk
= policy
->clk
;
43 struct private_data
*priv
= policy
->driver_data
;
44 struct device
*cpu_dev
= priv
->cpu_dev
;
45 struct regulator
*cpu_reg
= priv
->cpu_reg
;
46 unsigned long volt
= 0, volt_old
= 0, tol
= 0;
47 unsigned int old_freq
, new_freq
;
48 long freq_Hz
, freq_exact
;
51 freq_Hz
= clk_round_rate(cpu_clk
, freq_table
[index
].frequency
* 1000);
53 freq_Hz
= freq_table
[index
].frequency
* 1000;
56 new_freq
= freq_Hz
/ 1000;
57 old_freq
= clk_get_rate(cpu_clk
) / 1000;
59 if (!IS_ERR(cpu_reg
)) {
61 opp
= dev_pm_opp_find_freq_ceil(cpu_dev
, &freq_Hz
);
64 dev_err(cpu_dev
, "failed to find OPP for %ld\n",
68 volt
= dev_pm_opp_get_voltage(opp
);
70 tol
= volt
* priv
->voltage_tolerance
/ 100;
71 volt_old
= regulator_get_voltage(cpu_reg
);
74 dev_dbg(cpu_dev
, "%u MHz, %ld mV --> %u MHz, %ld mV\n",
75 old_freq
/ 1000, volt_old
? volt_old
/ 1000 : -1,
76 new_freq
/ 1000, volt
? volt
/ 1000 : -1);
78 /* scaling up? scale voltage before frequency */
79 if (!IS_ERR(cpu_reg
) && new_freq
> old_freq
) {
80 ret
= regulator_set_voltage_tol(cpu_reg
, volt
, tol
);
82 dev_err(cpu_dev
, "failed to scale voltage up: %d\n",
88 ret
= clk_set_rate(cpu_clk
, freq_exact
);
90 dev_err(cpu_dev
, "failed to set clock rate: %d\n", ret
);
92 regulator_set_voltage_tol(cpu_reg
, volt_old
, tol
);
96 /* scaling down? scale voltage after frequency */
97 if (!IS_ERR(cpu_reg
) && new_freq
< old_freq
) {
98 ret
= regulator_set_voltage_tol(cpu_reg
, volt
, tol
);
100 dev_err(cpu_dev
, "failed to scale voltage down: %d\n",
102 clk_set_rate(cpu_clk
, old_freq
* 1000);
109 static int allocate_resources(int cpu
, struct device
**cdev
,
110 struct regulator
**creg
, struct clk
**cclk
)
112 struct device
*cpu_dev
;
113 struct regulator
*cpu_reg
;
116 char *reg_cpu0
= "cpu0", *reg_cpu
= "cpu", *reg
;
118 cpu_dev
= get_cpu_device(cpu
);
120 pr_err("failed to get cpu%d device\n", cpu
);
124 /* Try "cpu0" for older DTs */
131 cpu_reg
= regulator_get_optional(cpu_dev
, reg
);
132 if (IS_ERR(cpu_reg
)) {
134 * If cpu's regulator supply node is present, but regulator is
135 * not yet registered, we should try defering probe.
137 if (PTR_ERR(cpu_reg
) == -EPROBE_DEFER
) {
138 dev_dbg(cpu_dev
, "cpu%d regulator not ready, retry\n",
140 return -EPROBE_DEFER
;
143 /* Try with "cpu-supply" */
144 if (reg
== reg_cpu0
) {
149 dev_warn(cpu_dev
, "failed to get cpu%d regulator: %ld\n",
150 cpu
, PTR_ERR(cpu_reg
));
153 cpu_clk
= clk_get(cpu_dev
, NULL
);
154 if (IS_ERR(cpu_clk
)) {
156 if (!IS_ERR(cpu_reg
))
157 regulator_put(cpu_reg
);
159 ret
= PTR_ERR(cpu_clk
);
162 * If cpu's clk node is present, but clock is not yet
163 * registered, we should try defering probe.
165 if (ret
== -EPROBE_DEFER
)
166 dev_dbg(cpu_dev
, "cpu%d clock not ready, retry\n", cpu
);
168 dev_err(cpu_dev
, "failed to get cpu%d clock: %d\n", ret
,
179 static int cpufreq_init(struct cpufreq_policy
*policy
)
181 struct cpufreq_frequency_table
*freq_table
;
182 struct thermal_cooling_device
*cdev
;
183 struct device_node
*np
;
184 struct private_data
*priv
;
185 struct device
*cpu_dev
;
186 struct regulator
*cpu_reg
;
188 unsigned int transition_latency
;
191 ret
= allocate_resources(policy
->cpu
, &cpu_dev
, &cpu_reg
, &cpu_clk
);
193 pr_err("%s: Failed to allocate resources\n: %d", __func__
, ret
);
197 np
= of_node_get(cpu_dev
->of_node
);
199 dev_err(cpu_dev
, "failed to find cpu%d node\n", policy
->cpu
);
201 goto out_put_reg_clk
;
204 /* OPPs might be populated at runtime, don't check for error here */
205 of_init_opp_table(cpu_dev
);
207 ret
= dev_pm_opp_init_cpufreq_table(cpu_dev
, &freq_table
);
209 dev_err(cpu_dev
, "failed to init cpufreq table: %d\n", ret
);
213 priv
= kzalloc(sizeof(*priv
), GFP_KERNEL
);
219 of_property_read_u32(np
, "voltage-tolerance", &priv
->voltage_tolerance
);
221 if (of_property_read_u32(np
, "clock-latency", &transition_latency
))
222 transition_latency
= CPUFREQ_ETERNAL
;
224 if (!IS_ERR(cpu_reg
)) {
225 struct dev_pm_opp
*opp
;
226 unsigned long min_uV
, max_uV
;
230 * OPP is maintained in order of increasing frequency, and
231 * freq_table initialised from OPP is therefore sorted in the
234 for (i
= 0; freq_table
[i
].frequency
!= CPUFREQ_TABLE_END
; i
++)
237 opp
= dev_pm_opp_find_freq_exact(cpu_dev
,
238 freq_table
[0].frequency
* 1000, true);
239 min_uV
= dev_pm_opp_get_voltage(opp
);
240 opp
= dev_pm_opp_find_freq_exact(cpu_dev
,
241 freq_table
[i
-1].frequency
* 1000, true);
242 max_uV
= dev_pm_opp_get_voltage(opp
);
244 ret
= regulator_set_voltage_time(cpu_reg
, min_uV
, max_uV
);
246 transition_latency
+= ret
* 1000;
250 * For now, just loading the cooling device;
251 * thermal DT code takes care of matching them.
253 if (of_find_property(np
, "#cooling-cells", NULL
)) {
254 cdev
= of_cpufreq_cooling_register(np
, cpu_present_mask
);
257 "running cpufreq without cooling device: %ld\n",
263 priv
->cpu_dev
= cpu_dev
;
264 priv
->cpu_reg
= cpu_reg
;
265 policy
->driver_data
= priv
;
267 policy
->clk
= cpu_clk
;
268 ret
= cpufreq_generic_init(policy
, freq_table
, transition_latency
);
270 goto out_cooling_unregister
;
276 out_cooling_unregister
:
277 cpufreq_cooling_unregister(priv
->cdev
);
280 dev_pm_opp_free_cpufreq_table(cpu_dev
, &freq_table
);
285 if (!IS_ERR(cpu_reg
))
286 regulator_put(cpu_reg
);
291 static int cpufreq_exit(struct cpufreq_policy
*policy
)
293 struct private_data
*priv
= policy
->driver_data
;
295 cpufreq_cooling_unregister(priv
->cdev
);
296 dev_pm_opp_free_cpufreq_table(priv
->cpu_dev
, &policy
->freq_table
);
297 clk_put(policy
->clk
);
298 if (!IS_ERR(priv
->cpu_reg
))
299 regulator_put(priv
->cpu_reg
);
305 static struct cpufreq_driver dt_cpufreq_driver
= {
306 .flags
= CPUFREQ_STICKY
| CPUFREQ_NEED_INITIAL_FREQ_CHECK
,
307 .verify
= cpufreq_generic_frequency_table_verify
,
308 .target_index
= set_target
,
309 .get
= cpufreq_generic_get
,
310 .init
= cpufreq_init
,
311 .exit
= cpufreq_exit
,
312 .name
= "cpufreq-dt",
313 .attr
= cpufreq_generic_attr
,
316 static int dt_cpufreq_probe(struct platform_device
*pdev
)
318 struct device
*cpu_dev
;
319 struct regulator
*cpu_reg
;
324 * All per-cluster (CPUs sharing clock/voltages) initialization is done
325 * from ->init(). In probe(), we just need to make sure that clk and
326 * regulators are available. Else defer probe and retry.
328 * FIXME: Is checking this only for CPU0 sufficient ?
330 ret
= allocate_resources(0, &cpu_dev
, &cpu_reg
, &cpu_clk
);
335 if (!IS_ERR(cpu_reg
))
336 regulator_put(cpu_reg
);
338 ret
= cpufreq_register_driver(&dt_cpufreq_driver
);
340 dev_err(cpu_dev
, "failed register driver: %d\n", ret
);
345 static int dt_cpufreq_remove(struct platform_device
*pdev
)
347 cpufreq_unregister_driver(&dt_cpufreq_driver
);
351 static struct platform_driver dt_cpufreq_platdrv
= {
353 .name
= "cpufreq-dt",
354 .owner
= THIS_MODULE
,
356 .probe
= dt_cpufreq_probe
,
357 .remove
= dt_cpufreq_remove
,
359 module_platform_driver(dt_cpufreq_platdrv
);
361 MODULE_AUTHOR("Viresh Kumar <viresh.kumar@linaro.org>");
362 MODULE_AUTHOR("Shawn Guo <shawn.guo@linaro.org>");
363 MODULE_DESCRIPTION("Generic cpufreq driver");
364 MODULE_LICENSE("GPL");