Signed-off-by: Joshua Emele <jem...@gmail.com>
---
 drivers/cpufreq/omap-cpufreq.c |   18 ++++++++++++++++++
 1 files changed, 18 insertions(+), 0 deletions(-)

diff --git a/drivers/cpufreq/omap-cpufreq.c b/drivers/cpufreq/omap-cpufreq.c
index d8a751f..e8bcad8 100644
--- a/drivers/cpufreq/omap-cpufreq.c
+++ b/drivers/cpufreq/omap-cpufreq.c
@@ -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;
 }
 
-- 
1.7.6.5

--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to