blob: 72f87e9317e31057525b0785b36d78467890a34c [file] [log] [blame]
Viresh Kumar8a67f0e2013-04-01 12:57:49 +00001/*
2 * ARM big.LITTLE Platforms CPUFreq support
3 *
4 * Copyright (C) 2013 ARM Ltd.
5 * Sudeep KarkadaNagesha <sudeep.karkadanagesha@arm.com>
6 *
7 * Copyright (C) 2013 Linaro.
8 * Viresh Kumar <viresh.kumar@linaro.org>
9 *
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.
13 *
14 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
15 * kind, whether express or implied; without even the implied warranty
16 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
18 */
19
20#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
21
22#include <linux/clk.h>
23#include <linux/cpu.h>
24#include <linux/cpufreq.h>
25#include <linux/cpumask.h>
26#include <linux/export.h>
Viresh Kumare79a23c2013-10-30 15:44:40 -040027#include <linux/mutex.h>
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000028#include <linux/of_platform.h>
Nishanth Menone4db1c72013-09-19 16:03:52 -050029#include <linux/pm_opp.h>
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000030#include <linux/slab.h>
31#include <linux/topology.h>
32#include <linux/types.h>
Viresh Kumare79a23c2013-10-30 15:44:40 -040033#include <asm/bL_switcher.h>
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000034
35#include "arm_big_little.h"
36
37/* Currently we support only two clusters */
Viresh Kumare79a23c2013-10-30 15:44:40 -040038#define A15_CLUSTER 0
39#define A7_CLUSTER 1
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000040#define MAX_CLUSTERS 2
41
Viresh Kumare79a23c2013-10-30 15:44:40 -040042#ifdef CONFIG_BL_SWITCHER
Nicolas Pitre45cac112013-10-30 15:44:41 -040043static bool bL_switching_enabled;
44#define is_bL_switching_enabled() bL_switching_enabled
45#define set_switching_enabled(x) (bL_switching_enabled = (x))
Viresh Kumare79a23c2013-10-30 15:44:40 -040046#else
47#define is_bL_switching_enabled() false
Nicolas Pitre45cac112013-10-30 15:44:41 -040048#define set_switching_enabled(x) do { } while (0)
Viresh Kumare79a23c2013-10-30 15:44:40 -040049#endif
50
51#define ACTUAL_FREQ(cluster, freq) ((cluster == A7_CLUSTER) ? freq << 1 : freq)
52#define VIRT_FREQ(cluster, freq) ((cluster == A7_CLUSTER) ? freq >> 1 : freq)
53
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000054static struct cpufreq_arm_bL_ops *arm_bL_ops;
55static struct clk *clk[MAX_CLUSTERS];
Viresh Kumare79a23c2013-10-30 15:44:40 -040056static struct cpufreq_frequency_table *freq_table[MAX_CLUSTERS + 1];
57static atomic_t cluster_usage[MAX_CLUSTERS + 1];
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000058
Viresh Kumare79a23c2013-10-30 15:44:40 -040059static unsigned int clk_big_min; /* (Big) clock frequencies */
60static unsigned int clk_little_max; /* Maximum clock frequency (Little) */
61
62static DEFINE_PER_CPU(unsigned int, physical_cluster);
63static DEFINE_PER_CPU(unsigned int, cpu_last_req_freq);
64
65static struct mutex cluster_lock[MAX_CLUSTERS];
66
67static inline int raw_cpu_to_cluster(int cpu)
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000068{
Viresh Kumare79a23c2013-10-30 15:44:40 -040069 return topology_physical_package_id(cpu);
70}
Viresh Kumar8a67f0e2013-04-01 12:57:49 +000071
Viresh Kumare79a23c2013-10-30 15:44:40 -040072static inline int cpu_to_cluster(int cpu)
73{
74 return is_bL_switching_enabled() ?
75 MAX_CLUSTERS : raw_cpu_to_cluster(cpu);
76}
77
78static unsigned int find_cluster_maxfreq(int cluster)
79{
80 int j;
81 u32 max_freq = 0, cpu_freq;
82
83 for_each_online_cpu(j) {
84 cpu_freq = per_cpu(cpu_last_req_freq, j);
85
86 if ((cluster == per_cpu(physical_cluster, j)) &&
87 (max_freq < cpu_freq))
88 max_freq = cpu_freq;
89 }
90
91 pr_debug("%s: cluster: %d, max freq: %d\n", __func__, cluster,
92 max_freq);
93
94 return max_freq;
95}
96
97static unsigned int clk_get_cpu_rate(unsigned int cpu)
98{
99 u32 cur_cluster = per_cpu(physical_cluster, cpu);
100 u32 rate = clk_get_rate(clk[cur_cluster]) / 1000;
101
102 /* For switcher we use virtual A7 clock rates */
103 if (is_bL_switching_enabled())
104 rate = VIRT_FREQ(cur_cluster, rate);
105
106 pr_debug("%s: cpu: %d, cluster: %d, freq: %u\n", __func__, cpu,
107 cur_cluster, rate);
108
109 return rate;
110}
111
112static unsigned int bL_cpufreq_get_rate(unsigned int cpu)
113{
114 if (is_bL_switching_enabled()) {
115 pr_debug("%s: freq: %d\n", __func__, per_cpu(cpu_last_req_freq,
116 cpu));
117
118 return per_cpu(cpu_last_req_freq, cpu);
119 } else {
120 return clk_get_cpu_rate(cpu);
121 }
122}
123
124static unsigned int
125bL_cpufreq_set_rate(u32 cpu, u32 old_cluster, u32 new_cluster, u32 rate)
126{
127 u32 new_rate, prev_rate;
128 int ret;
129 bool bLs = is_bL_switching_enabled();
130
131 mutex_lock(&cluster_lock[new_cluster]);
132
133 if (bLs) {
134 prev_rate = per_cpu(cpu_last_req_freq, cpu);
135 per_cpu(cpu_last_req_freq, cpu) = rate;
136 per_cpu(physical_cluster, cpu) = new_cluster;
137
138 new_rate = find_cluster_maxfreq(new_cluster);
139 new_rate = ACTUAL_FREQ(new_cluster, new_rate);
140 } else {
141 new_rate = rate;
142 }
143
144 pr_debug("%s: cpu: %d, old cluster: %d, new cluster: %d, freq: %d\n",
145 __func__, cpu, old_cluster, new_cluster, new_rate);
146
147 ret = clk_set_rate(clk[new_cluster], new_rate * 1000);
148 if (WARN_ON(ret)) {
149 pr_err("clk_set_rate failed: %d, new cluster: %d\n", ret,
150 new_cluster);
151 if (bLs) {
152 per_cpu(cpu_last_req_freq, cpu) = prev_rate;
153 per_cpu(physical_cluster, cpu) = old_cluster;
154 }
155
156 mutex_unlock(&cluster_lock[new_cluster]);
157
158 return ret;
159 }
160
161 mutex_unlock(&cluster_lock[new_cluster]);
162
163 /* Recalc freq for old cluster when switching clusters */
164 if (old_cluster != new_cluster) {
165 pr_debug("%s: cpu: %d, old cluster: %d, new cluster: %d\n",
166 __func__, cpu, old_cluster, new_cluster);
167
168 /* Switch cluster */
169 bL_switch_request(cpu, new_cluster);
170
171 mutex_lock(&cluster_lock[old_cluster]);
172
173 /* Set freq of old cluster if there are cpus left on it */
174 new_rate = find_cluster_maxfreq(old_cluster);
175 new_rate = ACTUAL_FREQ(old_cluster, new_rate);
176
177 if (new_rate) {
178 pr_debug("%s: Updating rate of old cluster: %d, to freq: %d\n",
179 __func__, old_cluster, new_rate);
180
181 if (clk_set_rate(clk[old_cluster], new_rate * 1000))
182 pr_err("%s: clk_set_rate failed: %d, old cluster: %d\n",
183 __func__, ret, old_cluster);
184 }
185 mutex_unlock(&cluster_lock[old_cluster]);
186 }
187
188 return 0;
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000189}
190
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000191/* Set clock frequency */
192static int bL_cpufreq_set_target(struct cpufreq_policy *policy,
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530193 unsigned int index)
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000194{
Viresh Kumare79a23c2013-10-30 15:44:40 -0400195 u32 cpu = policy->cpu, cur_cluster, new_cluster, actual_cluster;
Viresh Kumard4019f02013-08-14 19:38:24 +0530196 unsigned int freqs_new;
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000197
Viresh Kumare79a23c2013-10-30 15:44:40 -0400198 cur_cluster = cpu_to_cluster(cpu);
199 new_cluster = actual_cluster = per_cpu(physical_cluster, cpu);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000200
Viresh Kumard4019f02013-08-14 19:38:24 +0530201 freqs_new = freq_table[cur_cluster][index].frequency;
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000202
Viresh Kumare79a23c2013-10-30 15:44:40 -0400203 if (is_bL_switching_enabled()) {
204 if ((actual_cluster == A15_CLUSTER) &&
Viresh Kumard4019f02013-08-14 19:38:24 +0530205 (freqs_new < clk_big_min)) {
Viresh Kumare79a23c2013-10-30 15:44:40 -0400206 new_cluster = A7_CLUSTER;
207 } else if ((actual_cluster == A7_CLUSTER) &&
Viresh Kumard4019f02013-08-14 19:38:24 +0530208 (freqs_new > clk_little_max)) {
Viresh Kumare79a23c2013-10-30 15:44:40 -0400209 new_cluster = A15_CLUSTER;
210 }
211 }
212
Viresh Kumard4019f02013-08-14 19:38:24 +0530213 return bL_cpufreq_set_rate(cpu, actual_cluster, new_cluster, freqs_new);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000214}
215
Viresh Kumare79a23c2013-10-30 15:44:40 -0400216static inline u32 get_table_count(struct cpufreq_frequency_table *table)
217{
218 int count;
219
220 for (count = 0; table[count].frequency != CPUFREQ_TABLE_END; count++)
221 ;
222
223 return count;
224}
225
226/* get the minimum frequency in the cpufreq_frequency_table */
227static inline u32 get_table_min(struct cpufreq_frequency_table *table)
228{
229 int i;
230 uint32_t min_freq = ~0;
231 for (i = 0; (table[i].frequency != CPUFREQ_TABLE_END); i++)
232 if (table[i].frequency < min_freq)
233 min_freq = table[i].frequency;
234 return min_freq;
235}
236
237/* get the maximum frequency in the cpufreq_frequency_table */
238static inline u32 get_table_max(struct cpufreq_frequency_table *table)
239{
240 int i;
241 uint32_t max_freq = 0;
242 for (i = 0; (table[i].frequency != CPUFREQ_TABLE_END); i++)
243 if (table[i].frequency > max_freq)
244 max_freq = table[i].frequency;
245 return max_freq;
246}
247
248static int merge_cluster_tables(void)
249{
250 int i, j, k = 0, count = 1;
251 struct cpufreq_frequency_table *table;
252
253 for (i = 0; i < MAX_CLUSTERS; i++)
254 count += get_table_count(freq_table[i]);
255
256 table = kzalloc(sizeof(*table) * count, GFP_KERNEL);
257 if (!table)
258 return -ENOMEM;
259
260 freq_table[MAX_CLUSTERS] = table;
261
262 /* Add in reverse order to get freqs in increasing order */
263 for (i = MAX_CLUSTERS - 1; i >= 0; i--) {
264 for (j = 0; freq_table[i][j].frequency != CPUFREQ_TABLE_END;
265 j++) {
266 table[k].frequency = VIRT_FREQ(i,
267 freq_table[i][j].frequency);
268 pr_debug("%s: index: %d, freq: %d\n", __func__, k,
269 table[k].frequency);
270 k++;
271 }
272 }
273
274 table[k].driver_data = k;
275 table[k].frequency = CPUFREQ_TABLE_END;
276
277 pr_debug("%s: End, table: %p, count: %d\n", __func__, table, k);
278
279 return 0;
280}
281
282static void _put_cluster_clk_and_freq_table(struct device *cpu_dev)
283{
284 u32 cluster = raw_cpu_to_cluster(cpu_dev->id);
285
286 if (!freq_table[cluster])
287 return;
288
289 clk_put(clk[cluster]);
290 dev_pm_opp_free_cpufreq_table(cpu_dev, &freq_table[cluster]);
291 dev_dbg(cpu_dev, "%s: cluster: %d\n", __func__, cluster);
292}
293
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000294static void put_cluster_clk_and_freq_table(struct device *cpu_dev)
295{
296 u32 cluster = cpu_to_cluster(cpu_dev->id);
Viresh Kumare79a23c2013-10-30 15:44:40 -0400297 int i;
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000298
Viresh Kumare79a23c2013-10-30 15:44:40 -0400299 if (atomic_dec_return(&cluster_usage[cluster]))
300 return;
301
302 if (cluster < MAX_CLUSTERS)
303 return _put_cluster_clk_and_freq_table(cpu_dev);
304
305 for_each_present_cpu(i) {
306 struct device *cdev = get_cpu_device(i);
307 if (!cdev) {
308 pr_err("%s: failed to get cpu%d device\n", __func__, i);
309 return;
310 }
311
312 _put_cluster_clk_and_freq_table(cdev);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000313 }
Viresh Kumare79a23c2013-10-30 15:44:40 -0400314
315 /* free virtual table */
316 kfree(freq_table[cluster]);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000317}
318
Viresh Kumare79a23c2013-10-30 15:44:40 -0400319static int _get_cluster_clk_and_freq_table(struct device *cpu_dev)
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000320{
Viresh Kumare79a23c2013-10-30 15:44:40 -0400321 u32 cluster = raw_cpu_to_cluster(cpu_dev->id);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000322 char name[14] = "cpu-cluster.";
323 int ret;
324
Viresh Kumare79a23c2013-10-30 15:44:40 -0400325 if (freq_table[cluster])
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000326 return 0;
327
328 ret = arm_bL_ops->init_opp_table(cpu_dev);
329 if (ret) {
330 dev_err(cpu_dev, "%s: init_opp_table failed, cpu: %d, err: %d\n",
331 __func__, cpu_dev->id, ret);
Viresh Kumare79a23c2013-10-30 15:44:40 -0400332 goto out;
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000333 }
334
Nishanth Menon5d4879c2013-09-19 16:03:50 -0500335 ret = dev_pm_opp_init_cpufreq_table(cpu_dev, &freq_table[cluster]);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000336 if (ret) {
337 dev_err(cpu_dev, "%s: failed to init cpufreq table, cpu: %d, err: %d\n",
338 __func__, cpu_dev->id, ret);
Viresh Kumare79a23c2013-10-30 15:44:40 -0400339 goto out;
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000340 }
341
342 name[12] = cluster + '0';
Sudeep KarkadaNagesha076dec92013-10-16 14:52:39 +0100343 clk[cluster] = clk_get(cpu_dev, name);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000344 if (!IS_ERR(clk[cluster])) {
345 dev_dbg(cpu_dev, "%s: clk: %p & freq table: %p, cluster: %d\n",
346 __func__, clk[cluster], freq_table[cluster],
347 cluster);
348 return 0;
349 }
350
351 dev_err(cpu_dev, "%s: Failed to get clk for cpu: %d, cluster: %d\n",
352 __func__, cpu_dev->id, cluster);
353 ret = PTR_ERR(clk[cluster]);
Nishanth Menon5d4879c2013-09-19 16:03:50 -0500354 dev_pm_opp_free_cpufreq_table(cpu_dev, &freq_table[cluster]);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000355
Viresh Kumare79a23c2013-10-30 15:44:40 -0400356out:
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000357 dev_err(cpu_dev, "%s: Failed to get data for cluster: %d\n", __func__,
358 cluster);
359 return ret;
360}
361
Viresh Kumare79a23c2013-10-30 15:44:40 -0400362static int get_cluster_clk_and_freq_table(struct device *cpu_dev)
363{
364 u32 cluster = cpu_to_cluster(cpu_dev->id);
365 int i, ret;
366
367 if (atomic_inc_return(&cluster_usage[cluster]) != 1)
368 return 0;
369
370 if (cluster < MAX_CLUSTERS) {
371 ret = _get_cluster_clk_and_freq_table(cpu_dev);
372 if (ret)
373 atomic_dec(&cluster_usage[cluster]);
374 return ret;
375 }
376
377 /*
378 * Get data for all clusters and fill virtual cluster with a merge of
379 * both
380 */
381 for_each_present_cpu(i) {
382 struct device *cdev = get_cpu_device(i);
383 if (!cdev) {
384 pr_err("%s: failed to get cpu%d device\n", __func__, i);
385 return -ENODEV;
386 }
387
388 ret = _get_cluster_clk_and_freq_table(cdev);
389 if (ret)
390 goto put_clusters;
391 }
392
393 ret = merge_cluster_tables();
394 if (ret)
395 goto put_clusters;
396
397 /* Assuming 2 cluster, set clk_big_min and clk_little_max */
398 clk_big_min = get_table_min(freq_table[0]);
399 clk_little_max = VIRT_FREQ(1, get_table_max(freq_table[1]));
400
401 pr_debug("%s: cluster: %d, clk_big_min: %d, clk_little_max: %d\n",
402 __func__, cluster, clk_big_min, clk_little_max);
403
404 return 0;
405
406put_clusters:
407 for_each_present_cpu(i) {
408 struct device *cdev = get_cpu_device(i);
409 if (!cdev) {
410 pr_err("%s: failed to get cpu%d device\n", __func__, i);
411 return -ENODEV;
412 }
413
414 _put_cluster_clk_and_freq_table(cdev);
415 }
416
417 atomic_dec(&cluster_usage[cluster]);
418
419 return ret;
420}
421
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000422/* Per-CPU initialization */
423static int bL_cpufreq_init(struct cpufreq_policy *policy)
424{
425 u32 cur_cluster = cpu_to_cluster(policy->cpu);
426 struct device *cpu_dev;
427 int ret;
428
429 cpu_dev = get_cpu_device(policy->cpu);
430 if (!cpu_dev) {
431 pr_err("%s: failed to get cpu%d device\n", __func__,
432 policy->cpu);
433 return -ENODEV;
434 }
435
436 ret = get_cluster_clk_and_freq_table(cpu_dev);
437 if (ret)
438 return ret;
439
Viresh Kumar39b10eb2013-09-16 18:56:08 +0530440 ret = cpufreq_table_validate_and_show(policy, freq_table[cur_cluster]);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000441 if (ret) {
442 dev_err(cpu_dev, "CPU %d, cluster: %d invalid freq table\n",
443 policy->cpu, cur_cluster);
444 put_cluster_clk_and_freq_table(cpu_dev);
445 return ret;
446 }
447
Viresh Kumare79a23c2013-10-30 15:44:40 -0400448 if (cur_cluster < MAX_CLUSTERS) {
449 cpumask_copy(policy->cpus, topology_core_cpumask(policy->cpu));
450
451 per_cpu(physical_cluster, policy->cpu) = cur_cluster;
452 } else {
453 /* Assumption: during init, we are always running on A15 */
454 per_cpu(physical_cluster, policy->cpu) = A15_CLUSTER;
455 }
456
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000457 if (arm_bL_ops->get_transition_latency)
458 policy->cpuinfo.transition_latency =
459 arm_bL_ops->get_transition_latency(cpu_dev);
460 else
461 policy->cpuinfo.transition_latency = CPUFREQ_ETERNAL;
462
Viresh Kumare79a23c2013-10-30 15:44:40 -0400463 if (is_bL_switching_enabled())
464 per_cpu(cpu_last_req_freq, policy->cpu) = clk_get_cpu_rate(policy->cpu);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000465
Viresh Kumar2b80f312013-04-29 13:24:48 +0000466 dev_info(cpu_dev, "%s: CPU %d initialized\n", __func__, policy->cpu);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000467 return 0;
468}
469
470static int bL_cpufreq_exit(struct cpufreq_policy *policy)
471{
472 struct device *cpu_dev;
473
474 cpu_dev = get_cpu_device(policy->cpu);
475 if (!cpu_dev) {
476 pr_err("%s: failed to get cpu%d device\n", __func__,
477 policy->cpu);
478 return -ENODEV;
479 }
480
Viresh Kumar2457dac2013-09-16 18:56:42 +0530481 cpufreq_frequency_table_put_attr(policy->cpu);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000482 put_cluster_clk_and_freq_table(cpu_dev);
483 dev_dbg(cpu_dev, "%s: Exited, cpu: %d\n", __func__, policy->cpu);
484
485 return 0;
486}
487
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000488static struct cpufreq_driver bL_cpufreq_driver = {
489 .name = "arm-big-little",
Viresh Kumar0b981e72013-10-02 14:13:18 +0530490 .flags = CPUFREQ_STICKY |
Viresh Kumarae6b4272013-12-03 11:20:45 +0530491 CPUFREQ_HAVE_GOVERNOR_PER_POLICY |
492 CPUFREQ_NEED_INITIAL_FREQ_CHECK,
Viresh Kumar3c75a152013-10-03 20:27:57 +0530493 .verify = cpufreq_generic_frequency_table_verify,
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530494 .target_index = bL_cpufreq_set_target,
Viresh Kumare79a23c2013-10-30 15:44:40 -0400495 .get = bL_cpufreq_get_rate,
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000496 .init = bL_cpufreq_init,
497 .exit = bL_cpufreq_exit,
Viresh Kumar3c75a152013-10-03 20:27:57 +0530498 .attr = cpufreq_generic_attr,
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000499};
500
Nicolas Pitre45cac112013-10-30 15:44:41 -0400501static int bL_cpufreq_switcher_notifier(struct notifier_block *nfb,
502 unsigned long action, void *_arg)
503{
504 pr_debug("%s: action: %ld\n", __func__, action);
505
506 switch (action) {
507 case BL_NOTIFY_PRE_ENABLE:
508 case BL_NOTIFY_PRE_DISABLE:
509 cpufreq_unregister_driver(&bL_cpufreq_driver);
510 break;
511
512 case BL_NOTIFY_POST_ENABLE:
513 set_switching_enabled(true);
514 cpufreq_register_driver(&bL_cpufreq_driver);
515 break;
516
517 case BL_NOTIFY_POST_DISABLE:
518 set_switching_enabled(false);
519 cpufreq_register_driver(&bL_cpufreq_driver);
520 break;
521
522 default:
523 return NOTIFY_DONE;
524 }
525
526 return NOTIFY_OK;
527}
528
529static struct notifier_block bL_switcher_notifier = {
530 .notifier_call = bL_cpufreq_switcher_notifier,
531};
532
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000533int bL_cpufreq_register(struct cpufreq_arm_bL_ops *ops)
534{
Viresh Kumare79a23c2013-10-30 15:44:40 -0400535 int ret, i;
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000536
537 if (arm_bL_ops) {
538 pr_debug("%s: Already registered: %s, exiting\n", __func__,
539 arm_bL_ops->name);
540 return -EBUSY;
541 }
542
543 if (!ops || !strlen(ops->name) || !ops->init_opp_table) {
544 pr_err("%s: Invalid arm_bL_ops, exiting\n", __func__);
545 return -ENODEV;
546 }
547
548 arm_bL_ops = ops;
549
Nicolas Pitre45cac112013-10-30 15:44:41 -0400550 ret = bL_switcher_get_enabled();
551 set_switching_enabled(ret);
552
Viresh Kumare79a23c2013-10-30 15:44:40 -0400553 for (i = 0; i < MAX_CLUSTERS; i++)
554 mutex_init(&cluster_lock[i]);
555
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000556 ret = cpufreq_register_driver(&bL_cpufreq_driver);
557 if (ret) {
558 pr_info("%s: Failed registering platform driver: %s, err: %d\n",
559 __func__, ops->name, ret);
560 arm_bL_ops = NULL;
561 } else {
Nicolas Pitre45cac112013-10-30 15:44:41 -0400562 ret = bL_switcher_register_notifier(&bL_switcher_notifier);
563 if (ret) {
564 cpufreq_unregister_driver(&bL_cpufreq_driver);
565 arm_bL_ops = NULL;
566 } else {
567 pr_info("%s: Registered platform driver: %s\n",
568 __func__, ops->name);
569 }
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000570 }
571
Nicolas Pitre45cac112013-10-30 15:44:41 -0400572 bL_switcher_put_enabled();
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000573 return ret;
574}
575EXPORT_SYMBOL_GPL(bL_cpufreq_register);
576
577void bL_cpufreq_unregister(struct cpufreq_arm_bL_ops *ops)
578{
579 if (arm_bL_ops != ops) {
580 pr_err("%s: Registered with: %s, can't unregister, exiting\n",
581 __func__, arm_bL_ops->name);
582 return;
583 }
584
Nicolas Pitre45cac112013-10-30 15:44:41 -0400585 bL_switcher_get_enabled();
586 bL_switcher_unregister_notifier(&bL_switcher_notifier);
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000587 cpufreq_unregister_driver(&bL_cpufreq_driver);
Nicolas Pitre45cac112013-10-30 15:44:41 -0400588 bL_switcher_put_enabled();
Viresh Kumar8a67f0e2013-04-01 12:57:49 +0000589 pr_info("%s: Un-registered platform driver: %s\n", __func__,
590 arm_bL_ops->name);
591 arm_bL_ops = NULL;
592}
593EXPORT_SYMBOL_GPL(bL_cpufreq_unregister);