Commit | Line | Data |
---|---|---|
7c1a70e9 | 1 | /* |
7c1a70e9 | 2 | * Copyright (C) STMicroelectronics 2009 |
0baf066f | 3 | * Copyright (C) ST-Ericsson SA 2010-2012 |
7c1a70e9 MP |
4 | * |
5 | * License Terms: GNU General Public License v2 | |
7c1a70e9 MP |
6 | * Author: Sundar Iyer <sundar.iyer@stericsson.com> |
7 | * Author: Martin Persson <martin.persson@stericsson.com> | |
8 | * Author: Jonas Aaberg <jonas.aberg@stericsson.com> | |
7c1a70e9 | 9 | */ |
0baf066f | 10 | |
b4689444 | 11 | #include <linux/module.h> |
7c1a70e9 MP |
12 | #include <linux/kernel.h> |
13 | #include <linux/cpufreq.h> | |
14 | #include <linux/delay.h> | |
72b2fd5c | 15 | #include <linux/slab.h> |
b4689444 | 16 | #include <linux/platform_device.h> |
78e30d12 | 17 | #include <linux/clk.h> |
7c1a70e9 | 18 | |
fdb44464 | 19 | static struct cpufreq_frequency_table *freq_table; |
78e30d12 | 20 | static struct clk *armss_clk; |
72b2fd5c | 21 | |
edb10c11 | 22 | static int dbx500_cpufreq_target(struct cpufreq_policy *policy, |
9c0ebcf7 | 23 | unsigned int index) |
7c1a70e9 | 24 | { |
78e30d12 | 25 | /* update armss clk frequency */ |
d4019f0a | 26 | return clk_set_rate(armss_clk, freq_table[index].frequency * 1000); |
7c1a70e9 MP |
27 | } |
28 | ||
edb10c11 | 29 | static unsigned int dbx500_cpufreq_getspeed(unsigned int cpu) |
7c1a70e9 | 30 | { |
fdb44464 | 31 | int i = 0; |
78e30d12 | 32 | unsigned long freq = clk_get_rate(armss_clk) / 1000; |
fdb44464 | 33 | |
c7789669 MF |
34 | /* The value is rounded to closest frequency in the defined table. */ |
35 | while (freq_table[i + 1].frequency != CPUFREQ_TABLE_END) { | |
36 | if (freq < freq_table[i].frequency + | |
37 | (freq_table[i + 1].frequency - freq_table[i].frequency) / 2) | |
fdb44464 UH |
38 | return freq_table[i].frequency; |
39 | i++; | |
40 | } | |
41 | ||
c7789669 | 42 | return freq_table[i].frequency; |
7c1a70e9 MP |
43 | } |
44 | ||
2760984f | 45 | static int dbx500_cpufreq_init(struct cpufreq_policy *policy) |
7c1a70e9 | 46 | { |
2b3dc761 | 47 | return cpufreq_generic_init(policy, freq_table, 20 * 1000); |
7c1a70e9 MP |
48 | } |
49 | ||
edb10c11 | 50 | static struct cpufreq_driver dbx500_cpufreq_driver = { |
ae6b4271 VK |
51 | .flags = CPUFREQ_STICKY | CPUFREQ_CONST_LOOPS | |
52 | CPUFREQ_NEED_INITIAL_FREQ_CHECK, | |
47150e98 | 53 | .verify = cpufreq_generic_frequency_table_verify, |
9c0ebcf7 | 54 | .target_index = dbx500_cpufreq_target, |
edb10c11 LJ |
55 | .get = dbx500_cpufreq_getspeed, |
56 | .init = dbx500_cpufreq_init, | |
57 | .name = "DBX500", | |
47150e98 | 58 | .attr = cpufreq_generic_attr, |
7c1a70e9 MP |
59 | }; |
60 | ||
edb10c11 | 61 | static int dbx500_cpufreq_probe(struct platform_device *pdev) |
b4689444 | 62 | { |
3e27996c | 63 | int i = 0; |
fdb44464 | 64 | |
3e27996c | 65 | freq_table = dev_get_platdata(&pdev->dev); |
fdb44464 | 66 | if (!freq_table) { |
edb10c11 | 67 | pr_err("dbx500-cpufreq: Failed to fetch cpufreq table\n"); |
fdb44464 UH |
68 | return -ENODEV; |
69 | } | |
70 | ||
3e27996c UH |
71 | armss_clk = clk_get(&pdev->dev, "armss"); |
72 | if (IS_ERR(armss_clk)) { | |
9291cf9d | 73 | pr_err("dbx500-cpufreq: Failed to get armss clk\n"); |
3e27996c UH |
74 | return PTR_ERR(armss_clk); |
75 | } | |
76 | ||
9291cf9d | 77 | pr_info("dbx500-cpufreq: Available frequencies:\n"); |
3e27996c UH |
78 | while (freq_table[i].frequency != CPUFREQ_TABLE_END) { |
79 | pr_info(" %d Mhz\n", freq_table[i].frequency/1000); | |
80 | i++; | |
81 | } | |
82 | ||
edb10c11 | 83 | return cpufreq_register_driver(&dbx500_cpufreq_driver); |
b4689444 UH |
84 | } |
85 | ||
edb10c11 | 86 | static struct platform_driver dbx500_cpufreq_plat_driver = { |
b4689444 | 87 | .driver = { |
edb10c11 | 88 | .name = "cpufreq-ux500", |
b4689444 UH |
89 | .owner = THIS_MODULE, |
90 | }, | |
edb10c11 | 91 | .probe = dbx500_cpufreq_probe, |
b4689444 UH |
92 | }; |
93 | ||
edb10c11 | 94 | static int __init dbx500_cpufreq_register(void) |
7c1a70e9 | 95 | { |
edb10c11 | 96 | return platform_driver_register(&dbx500_cpufreq_plat_driver); |
7c1a70e9 | 97 | } |
edb10c11 | 98 | device_initcall(dbx500_cpufreq_register); |
b4689444 UH |
99 | |
100 | MODULE_LICENSE("GPL v2"); | |
edb10c11 | 101 | MODULE_DESCRIPTION("cpufreq driver for DBX500"); |