1 #include <linux/init.h>
2 #include <linux/module.h>
3 #include <linux/cpufreq.h>
4 #include <hwregs/reg_map.h>
5 #include <arch/hwregs/reg_rdwr.h>
6 #include <arch/hwregs/config_defs.h>
7 #include <arch/hwregs/bif_core_defs.h>
10 cris_sdram_freq_notifier(struct notifier_block
*nb
, unsigned long val
,
13 static struct notifier_block cris_sdram_freq_notifier_block
= {
14 .notifier_call
= cris_sdram_freq_notifier
17 static struct cpufreq_frequency_table cris_freq_table
[] = {
20 {0, CPUFREQ_TABLE_END
},
23 static unsigned int cris_freq_get_cpu_frequency(unsigned int cpu
)
25 reg_config_rw_clk_ctrl clk_ctrl
;
26 clk_ctrl
= REG_RD(config
, regi_config
, rw_clk_ctrl
);
27 return clk_ctrl
.pll
? 200000 : 6000;
30 static int cris_freq_target(struct cpufreq_policy
*policy
, unsigned int state
)
32 struct cpufreq_freqs freqs
;
33 reg_config_rw_clk_ctrl clk_ctrl
;
34 clk_ctrl
= REG_RD(config
, regi_config
, rw_clk_ctrl
);
36 freqs
.old
= cris_freq_get_cpu_frequency(policy
->cpu
);
37 freqs
.new = cris_freq_table
[state
].frequency
;
39 cpufreq_notify_transition(policy
, &freqs
, CPUFREQ_PRECHANGE
);
43 /* Even though we may be SMP they will share the same clock
44 * so all settings are made on CPU0. */
45 if (cris_freq_table
[state
].frequency
== 200000)
49 REG_WR(config
, regi_config
, rw_clk_ctrl
, clk_ctrl
);
53 cpufreq_notify_transition(policy
, &freqs
, CPUFREQ_POSTCHANGE
);
58 static int cris_freq_cpu_init(struct cpufreq_policy
*policy
)
60 return cpufreq_generic_init(policy
, cris_freq_table
, 1000000);
63 static struct cpufreq_driver cris_freq_driver
= {
64 .get
= cris_freq_get_cpu_frequency
,
65 .verify
= cpufreq_generic_frequency_table_verify
,
66 .target_index
= cris_freq_target
,
67 .init
= cris_freq_cpu_init
,
68 .exit
= cpufreq_generic_exit
,
70 .attr
= cpufreq_generic_attr
,
73 static int __init
cris_freq_init(void)
76 ret
= cpufreq_register_driver(&cris_freq_driver
);
77 cpufreq_register_notifier(&cris_sdram_freq_notifier_block
,
78 CPUFREQ_TRANSITION_NOTIFIER
);
83 cris_sdram_freq_notifier(struct notifier_block
*nb
, unsigned long val
,
87 struct cpufreq_freqs
*freqs
= data
;
88 if (val
== CPUFREQ_PRECHANGE
) {
89 reg_bif_core_rw_sdram_timing timing
=
90 REG_RD(bif_core
, regi_bif_core
, rw_sdram_timing
);
91 timing
.cpd
= (freqs
->new == 200000 ? 0 : 1);
93 if (freqs
->new == 200000)
94 for (i
= 0; i
< 50000; i
++) ;
95 REG_WR(bif_core
, regi_bif_core
, rw_sdram_timing
, timing
);
100 module_init(cris_freq_init
);