On 28-03-19, 20:58, Sibi Sankar wrote:
> Add support to parse and update OPP tables attached to the cpu nodes.
> 
> Signed-off-by: Sibi Sankar <si...@codeaurora.org>
> ---
>  drivers/cpufreq/qcom-cpufreq-hw.c | 29 +++++++++++++++++++++++++++--
>  1 file changed, 27 insertions(+), 2 deletions(-)
> 
> diff --git a/drivers/cpufreq/qcom-cpufreq-hw.c 
> b/drivers/cpufreq/qcom-cpufreq-hw.c
> index 4b0b50403901..5c268dd2346c 100644
> --- a/drivers/cpufreq/qcom-cpufreq-hw.c
> +++ b/drivers/cpufreq/qcom-cpufreq-hw.c
> @@ -73,6 +73,25 @@ static unsigned int qcom_cpufreq_hw_fast_switch(struct 
> cpufreq_policy *policy,
>       return policy->freq_table[index].frequency;
>  }
>  
> +static int qcom_find_update_opp(struct device *cpu_dev, unsigned long freq,
> +                             unsigned long volt)
> +{
> +     int ret;
> +     struct dev_pm_opp *opp;
> +
> +     opp = dev_pm_opp_find_freq_exact(cpu_dev, freq, true);
> +     if (IS_ERR(opp)) {
> +             ret = dev_pm_opp_add(cpu_dev, freq, volt);

With my comment on the other patch, you can just call
dev_pm_opp_update_voltage() and if that fails then call dev_pm_opp_add().

> +     } else {
> +             dev_pm_opp_disable(cpu_dev, freq);
> +             ret = dev_pm_opp_update_voltage(cpu_dev, freq, volt);
> +             dev_pm_opp_enable(cpu_dev, freq);

Perhaps no one else should be using the CPU OPP table at this point of time and
so we can get away with disable and enable stuff ? Just add a comment on why
that works.

> +             dev_pm_opp_put(opp);
> +     }
> +
> +     return ret;
> +}
> +
>  static int qcom_cpufreq_hw_read_lut(struct device *cpu_dev,
>                                   struct cpufreq_policy *policy,
>                                   void __iomem *base)
> @@ -81,11 +100,16 @@ static int qcom_cpufreq_hw_read_lut(struct device 
> *cpu_dev,
>       u32 volt;
>       unsigned int max_cores = cpumask_weight(policy->cpus);
>       struct cpufreq_frequency_table  *table;
> +     int ret;
>  
>       table = kcalloc(LUT_MAX_ENTRIES + 1, sizeof(*table), GFP_KERNEL);
>       if (!table)
>               return -ENOMEM;
>  
> +     ret = dev_pm_opp_of_add_table(cpu_dev);
> +     if (ret)
> +             dev_dbg(cpu_dev, "Couldn't add OPP table\n");
> +
>       for (i = 0; i < LUT_MAX_ENTRIES; i++) {
>               data = readl_relaxed(base + REG_FREQ_LUT +
>                                     i * LUT_ROW_SIZE);
> @@ -104,7 +128,7 @@ static int qcom_cpufreq_hw_read_lut(struct device 
> *cpu_dev,
>  
>               if (freq != prev_freq && core_count == max_cores) {
>                       table[i].frequency = freq;
> -                     dev_pm_opp_add(cpu_dev, freq * 1000, volt);
> +                     qcom_find_update_opp(cpu_dev, freq * 1000, volt);
>                       dev_dbg(cpu_dev, "index=%d freq=%d, core_count %d\n", i,
>                               freq, core_count);
>               } else {
> @@ -125,7 +149,8 @@ static int qcom_cpufreq_hw_read_lut(struct device 
> *cpu_dev,
>                       if (prev_cc != max_cores) {
>                               prev->frequency = prev_freq;
>                               prev->flags = CPUFREQ_BOOST_FREQ;
> -                             dev_pm_opp_add(cpu_dev, prev_freq * 1000, volt);
> +                             qcom_find_update_opp(cpu_dev, prev_freq * 1000,
> +                                                  volt);
>                       }
>  
>                       break;
> -- 
> The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum,
> a Linux Foundation Collaborative Project

-- 
viresh

Reply via email to