@@ -220,6 +220,9 @@ static inline void clk_free(void)
static int __cpuinit omap_iva_init(struct cpufreq_policy *policy)
{
int result;
+ unsigned long iva_rate;
+ unsigned int opp_index, mpu_freq = omap_getspeed(policy->cpu);
+
if (!iva_clk_name) {
pr_info("%s: iva unavailable\n", __func__);
return 0;
@@ -241,6 +244,21 @@ static int __cpuinit omap_iva_init(struct cpufreq_policy *policy)
__func__, policy->cpu, result);
return result;
}
+ result = cpufreq_frequency_table_target(policy, freq_table, mpu_freq,
+ CPUFREQ_RELATION_L, &opp_index);
+ if (result) {
+ dev_err(mpu_dev, "%s: cpu%d: no freq match for %u[%d]\n",
+ __func__, policy->cpu, mpu_freq, result);
+ return result;
+ }
+ iva_rate = iva_freq_table[opp_index].frequency * 1000;
+ result = clk_set_rate(iva_clk, iva_rate);
+ if (result) {
+ pr_err("%s: cpu%d: failed to set %s rate %lu[%d]\n",
+ __func__, policy->cpu, iva_clk->name, iva_rate,
+ result);
+ return result;
+ }
return 0;
}
Signed-off-by: Joshua Emele <jemele@gmail.com> --- drivers/cpufreq/omap-cpufreq.c | 18 ++++++++++++++++++ 1 files changed, 18 insertions(+), 0 deletions(-)