0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021
0022
0023
0024
0025
0026
0027
0028
0029
0030
0031
0032
0033
0034
0035
0036
0037
0038
0039
0040
0041
0042
0043
0044
0045
0046
0047
0048
0049
0050
0051
0052
0053
0054
0055
0056
0057
0058
0059
0060
0061
0062
0063
0064
0065
0066
0067
0068
0069
0070 #include <linux/kernel.h>
0071 #include <linux/types.h>
0072 #include <linux/init.h>
0073 #include <linux/cpufreq.h>
0074 #include <linux/io.h>
0075
0076 #include <asm/cputype.h>
0077
0078 #include <mach/generic.h>
0079 #include <mach/hardware.h>
0080
0081 struct sa1100_dram_regs {
0082 int speed;
0083 u32 mdcnfg;
0084 u32 mdcas0;
0085 u32 mdcas1;
0086 u32 mdcas2;
0087 };
0088
0089
0090 static struct cpufreq_driver sa1100_driver;
0091
0092 static struct sa1100_dram_regs sa1100_dram_settings[] = {
0093
0094 { 59000, 0x00dc88a3, 0xcccccccf, 0xfffffffc, 0xffffffff},
0095 { 73700, 0x011490a3, 0xcccccccf, 0xfffffffc, 0xffffffff},
0096 { 88500, 0x014e90a3, 0xcccccccf, 0xfffffffc, 0xffffffff},
0097 {103200, 0x01889923, 0xcccccccf, 0xfffffffc, 0xffffffff},
0098 {118000, 0x01c29923, 0x9999998f, 0xfffffff9, 0xffffffff},
0099 {132700, 0x01fb2123, 0x9999998f, 0xfffffff9, 0xffffffff},
0100 {147500, 0x02352123, 0x3333330f, 0xfffffff3, 0xffffffff},
0101 {162200, 0x026b29a3, 0x38e38e1f, 0xfff8e38e, 0xffffffff},
0102 {176900, 0x02a329a3, 0x71c71c1f, 0xfff1c71c, 0xffffffff},
0103 {191700, 0x02dd31a3, 0xe38e383f, 0xffe38e38, 0xffffffff},
0104 {206400, 0x03153223, 0xc71c703f, 0xffc71c71, 0xffffffff},
0105 {221200, 0x034fba23, 0xc71c703f, 0xffc71c71, 0xffffffff},
0106 {235900, 0x03853a23, 0xe1e1e07f, 0xe1e1e1e1, 0xffffffe1},
0107 {250700, 0x03bf3aa3, 0xc3c3c07f, 0xc3c3c3c3, 0xffffffc3},
0108 {265400, 0x03f7c2a3, 0xc3c3c07f, 0xc3c3c3c3, 0xffffffc3},
0109 {280200, 0x0431c2a3, 0x878780ff, 0x87878787, 0xffffff87},
0110 { 0, 0, 0, 0, 0 }
0111 };
0112
0113 static void sa1100_update_dram_timings(int current_speed, int new_speed)
0114 {
0115 struct sa1100_dram_regs *settings = sa1100_dram_settings;
0116
0117
0118 while (settings->speed != 0) {
0119 if (new_speed == settings->speed)
0120 break;
0121
0122 settings++;
0123 }
0124
0125 if (settings->speed == 0) {
0126 panic("%s: couldn't find dram setting for speed %d\n",
0127 __func__, new_speed);
0128 }
0129
0130
0131 if (new_speed > current_speed) {
0132
0133
0134
0135
0136
0137 MDCNFG |= MDCNFG_CDB2;
0138
0139
0140
0141
0142 MDCAS2 = settings->mdcas2;
0143 MDCAS1 = settings->mdcas1;
0144 MDCAS0 = settings->mdcas0;
0145 MDCNFG = settings->mdcnfg;
0146 } else {
0147
0148
0149
0150
0151
0152 MDCNFG |= MDCNFG_CDB2;
0153
0154
0155
0156
0157 MDCAS0 = settings->mdcas0;
0158 MDCAS1 = settings->mdcas1;
0159 MDCAS2 = settings->mdcas2;
0160 MDCNFG = settings->mdcnfg;
0161 }
0162 }
0163
0164 static int sa1100_target(struct cpufreq_policy *policy, unsigned int ppcr)
0165 {
0166 unsigned int cur = sa11x0_getspeed(0);
0167 unsigned int new_freq;
0168
0169 new_freq = sa11x0_freq_table[ppcr].frequency;
0170
0171 if (new_freq > cur)
0172 sa1100_update_dram_timings(cur, new_freq);
0173
0174 PPCR = ppcr;
0175
0176 if (new_freq < cur)
0177 sa1100_update_dram_timings(cur, new_freq);
0178
0179 return 0;
0180 }
0181
0182 static int __init sa1100_cpu_init(struct cpufreq_policy *policy)
0183 {
0184 cpufreq_generic_init(policy, sa11x0_freq_table, 0);
0185 return 0;
0186 }
0187
0188 static struct cpufreq_driver sa1100_driver __refdata = {
0189 .flags = CPUFREQ_NEED_INITIAL_FREQ_CHECK |
0190 CPUFREQ_NO_AUTO_DYNAMIC_SWITCHING,
0191 .verify = cpufreq_generic_frequency_table_verify,
0192 .target_index = sa1100_target,
0193 .get = sa11x0_getspeed,
0194 .init = sa1100_cpu_init,
0195 .name = "sa1100",
0196 };
0197
0198 static int __init sa1100_dram_init(void)
0199 {
0200 if (cpu_is_sa1100())
0201 return cpufreq_register_driver(&sa1100_driver);
0202 else
0203 return -ENODEV;
0204 }
0205
0206 arch_initcall(sa1100_dram_init);