Merge master.kernel.org:/pub/scm/linux/kernel/git/davem/sparc-2.6
[linux-2.6] / arch / blackfin / mach-bf537 / cpu.c
1 /*
2  * File:         arch/blackfin/mach-bf537/cpu.c
3  * Based on:
4  * Author:       michael.kang@analog.com
5  *
6  * Created:
7  * Description:  clock scaling for the bf537
8  *
9  * Modified:
10  *               Copyright 2004-2006 Analog Devices Inc.
11  *
12  * Bugs:         Enter bugs at http://blackfin.uclinux.org/
13  *
14  * This program is free software; you can redistribute it and/or modify
15  * it under the terms of the GNU General Public License as published by
16  * the Free Software Foundation; either version 2 of the License, or
17  * (at your option) any later version.
18  *
19  * This program is distributed in the hope that it will be useful,
20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
22  * GNU General Public License for more details.
23  *
24  * You should have received a copy of the GNU General Public License
25  * along with this program; if not, see the file COPYING, or write
26  * to the Free Software Foundation, Inc.,
27  * 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
28  */
29
30 #include <linux/kernel.h>
31 #include <linux/types.h>
32 #include <linux/init.h>
33 #include <linux/cpufreq.h>
34 #include <asm/dpmc.h>
35 #include <linux/fs.h>
36 #include <asm/bfin-global.h>
37
38 /* CONFIG_CLKIN_HZ=11059200 */
39 #define VCO5 (CONFIG_CLKIN_HZ*45)       /*497664000 */
40 #define VCO4 (CONFIG_CLKIN_HZ*36)       /*398131200 */
41 #define VCO3 (CONFIG_CLKIN_HZ*27)       /*298598400 */
42 #define VCO2 (CONFIG_CLKIN_HZ*18)       /*199065600 */
43 #define VCO1 (CONFIG_CLKIN_HZ*9)        /*99532800 */
44 #define VCO(x) VCO##x
45
46 #define FREQ(x) {VCO(x),VCO(x)/4},{VCO(x),VCO(x)/2},{VCO(x),VCO(x)}
47 /* frequency */
48 static struct cpufreq_frequency_table bf537_freq_table[] = {
49         FREQ(1),
50         FREQ(3),
51         {VCO4, VCO4 / 2}, {VCO4, VCO4},
52         FREQ(5),
53         {0, CPUFREQ_TABLE_END},
54 };
55
56 /*
57  * dpmc_fops->ioctl()
58  * static int dpmc_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
59  */
60 static int bf537_getfreq(unsigned int cpu)
61 {
62         unsigned long cclk_mhz, vco_mhz;
63
64         /* The driver only support single cpu */
65         if (cpu == 0)
66                 dpmc_fops.ioctl(NULL, NULL, IOCTL_GET_CORECLOCK, &cclk_mhz);
67         else
68                 cclk_mhz = -1;
69         return cclk_mhz;
70 }
71
72 static int bf537_target(struct cpufreq_policy *policy,
73                             unsigned int target_freq, unsigned int relation)
74 {
75         unsigned long cclk_mhz;
76         unsigned long vco_mhz;
77         unsigned long flags;
78         unsigned int index, vco_index;
79         int i;
80
81         struct cpufreq_freqs freqs;
82         if (cpufreq_frequency_table_target
83             (policy, bf537_freq_table, target_freq, relation, &index))
84                 return -EINVAL;
85         cclk_mhz = bf537_freq_table[index].frequency;
86         vco_mhz = bf537_freq_table[index].index;
87
88         dpmc_fops.ioctl(NULL, NULL, IOCTL_CHANGE_FREQUENCY, &vco_mhz);
89         freqs.old = bf537_getfreq(0);
90         freqs.new = cclk_mhz;
91         freqs.cpu = 0;
92
93         pr_debug("cclk begin change to cclk %d,vco=%d,index=%d,target=%d,oldfreq=%d\n",
94                  cclk_mhz, vco_mhz, index, target_freq, freqs.old);
95
96         cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
97         local_irq_save(flags);
98         dpmc_fops.ioctl(NULL, NULL, IOCTL_SET_CCLK, &cclk_mhz);
99         local_irq_restore(flags);
100         cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
101
102         vco_mhz = get_vco();
103         cclk_mhz = get_cclk();
104         return 0;
105 }
106
107 /* make sure that only the "userspace" governor is run -- anything else wouldn't make sense on
108  * this platform, anyway.
109  */
110 static int bf537_verify_speed(struct cpufreq_policy *policy)
111 {
112         return cpufreq_frequency_table_verify(policy, &bf537_freq_table);
113 }
114
115 static int __init __bf537_cpu_init(struct cpufreq_policy *policy)
116 {
117         int result;
118
119         if (policy->cpu != 0)
120                 return -EINVAL;
121
122         policy->governor = CPUFREQ_DEFAULT_GOVERNOR;
123
124         policy->cpuinfo.transition_latency = CPUFREQ_ETERNAL;
125         /*Now ,only support one cpu */
126         policy->cur = bf537_getfreq(0);
127         cpufreq_frequency_table_get_attr(bf537_freq_table, policy->cpu);
128         return cpufreq_frequency_table_cpuinfo(policy, bf537_freq_table);
129 }
130
131 static struct freq_attr *bf537_freq_attr[] = {
132         &cpufreq_freq_attr_scaling_available_freqs,
133         NULL,
134 };
135
136 static struct cpufreq_driver bf537_driver = {
137         .verify = bf537_verify_speed,
138         .target = bf537_target,
139         .get = bf537_getfreq,
140         .init = __bf537_cpu_init,
141         .name = "bf537",
142         .owner = THIS_MODULE,
143         .attr = bf537_freq_attr,
144 };
145
146 static int __init bf537_cpu_init(void)
147 {
148         return cpufreq_register_driver(&bf537_driver);
149 }
150
151 static void __exit bf537_cpu_exit(void)
152 {
153         cpufreq_unregister_driver(&bf537_driver);
154 }
155
156 MODULE_AUTHOR("Mickael Kang");
157 MODULE_DESCRIPTION("cpufreq driver for BF537 CPU");
158 MODULE_LICENSE("GPL");
159
160 module_init(bf537_cpu_init);
161 module_exit(bf537_cpu_exit);