|
@@ -51,15 +51,23 @@ static unsigned int scpi_cpufreq_get_rate(unsigned int cpu)
|
|
|
static int
|
|
|
scpi_cpufreq_set_target(struct cpufreq_policy *policy, unsigned int index)
|
|
|
{
|
|
|
+ unsigned long freq = policy->freq_table[index].frequency;
|
|
|
struct scpi_data *priv = policy->driver_data;
|
|
|
- u64 rate = policy->freq_table[index].frequency * 1000;
|
|
|
+ u64 rate = freq * 1000;
|
|
|
int ret;
|
|
|
|
|
|
ret = clk_set_rate(priv->clk, rate);
|
|
|
- if (!ret && (clk_get_rate(priv->clk) != rate))
|
|
|
- ret = -EIO;
|
|
|
|
|
|
- return ret;
|
|
|
+ if (ret)
|
|
|
+ return ret;
|
|
|
+
|
|
|
+ if (clk_get_rate(priv->clk) != rate)
|
|
|
+ return -EIO;
|
|
|
+
|
|
|
+ arch_set_freq_scale(policy->related_cpus, freq,
|
|
|
+ policy->cpuinfo.max_freq);
|
|
|
+
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
static int
|