release/src-rt-6.x/linux/linux-2.6/arch/blackfin/mach-bf533/cpu.c

   1 /*
   2  * File:         arch/blackfin/mach-bf533/cpu.c
   3  * Based on:
   4  * Author:       michael.kang@analog.com
   5  *
   6  * Created:
   7  * Description:  clock scaling for the bf533
   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 bf533_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 bf533_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 bf533_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, bf533_freq_table, target_freq, relation, &index))
  84                 return -EINVAL;
  85         cclk_mhz = bf533_freq_table[index].frequency;
  86         vco_mhz = bf533_freq_table[index].index;
  87
  88         dpmc_fops.ioctl(NULL, NULL, IOCTL_CHANGE_FREQUENCY, &vco_mhz);
  89         freqs.old = bf533_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 bf533_verify_speed(struct cpufreq_policy *policy)
 111 {
 112         return cpufreq_frequency_table_verify(policy, &bf533_freq_table);
 113 }
 114
 115 static int __init __bf533_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 = bf533_getfreq(0);
 127         cpufreq_frequency_table_get_attr(bf533_freq_table, policy->cpu);
 128         return cpufreq_frequency_table_cpuinfo(policy, bf533_freq_table);
 129 }
 130
 131 static struct freq_attr *bf533_freq_attr[] = {
 132         &cpufreq_freq_attr_scaling_available_freqs,
 133         NULL,
 134 };
 135
 136 static struct cpufreq_driver bf533_driver = {
 137         .verify = bf533_verify_speed,
 138         .target = bf533_target,
 139         .get = bf533_getfreq,
 140         .init = __bf533_cpu_init,
 141         .name = "bf533",
 142         .owner = THIS_MODULE,
 143         .attr = bf533_freq_attr,
 144 };
 145
 146 static int __init bf533_cpu_init(void)
 147 {
 148         return cpufreq_register_driver(&bf533_driver);
 149 }
 150
 151 static void __exit bf533_cpu_exit(void)
 152 {
 153         cpufreq_unregister_driver(&bf533_driver);
 154 }
 155
 156 MODULE_AUTHOR("Mickael Kang");
 157 MODULE_DESCRIPTION("cpufreq driver for BF533 CPU");
 158 MODULE_LICENSE("GPL");
 159
 160 module_init(bf533_cpu_init);
 161 module_exit(bf533_cpu_exit);