lkml.org 
[lkml]   [2019]   [Mar]   [28]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH RFC 7/9] cpufreq: qcom: Add support to update cpu node's OPP tables
    Date
    Add support to parse and update OPP tables attached to the cpu nodes.

    Signed-off-by: Sibi Sankar <sibis@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);
    + } 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);
    + 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
    \
     
     \ /
      Last update: 2019-03-28 16:30    [W:3.805 / U:0.012 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site