cpufreq: CPPC: Initialize shared perf capabilities of CPUs

When multiple CPUs are related in one cpufreq policy, the first online
CPU will be chosen by default to handle cpufreq operations. Let's take
cpu0 and cpu1 as an example.

When cpu0 is offline, policy->cpu will be shifted to cpu1. cpu1's perf
capabilities should be initialized. Otherwise, perf capabilities are 0s
and speed change can not take effect.

This patch copies perf capabilities of the first online CPU to other
shared CPUs when policy shared type is CPUFREQ_SHARED_TYPE_ANY.

Acked-by: Viresh Kumar <viresh.kumar@linaro.org>
Signed-off-by: Shunyong Yang <shunyong.yang@hxt-semitech.com>
Signed-off-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com>

1 files changed, 12 insertions, 2 deletions

diff --git a/drivers/cpufreq/cppc_cpufreq.c b/drivers/cpufreq/cppc_cpufreq.c
index 38f65c371139..bc5fc1630876 100644
--- a/drivers/cpufreq/cppc_cpufreq.c
+++ b/drivers/cpufreq/cppc_cpufreq.c
@@ -166,9 +166,19 @@ static int cppc_cpufreq_cpu_init(struct cpufreq_policy *policy)
                 NSEC_PER_USEC;
         policy->shared_type = cpu->shared_type;
 
-        if (policy->shared_type == CPUFREQ_SHARED_TYPE_ANY)
+        if (policy->shared_type == CPUFREQ_SHARED_TYPE_ANY) {
+                int i;
+
                 cpumask_copy(policy->cpus, cpu->shared_cpu_map);
-        else if (policy->shared_type == CPUFREQ_SHARED_TYPE_ALL) {
+
+                for_each_cpu(i, policy->cpus) {
+                        if (unlikely(i == policy->cpu))
+                                continue;
+
+                        memcpy(&all_cpu_data[i]->perf_caps, &cpu->perf_caps,
+                               sizeof(cpu->perf_caps));
+                }
+        } else if (policy->shared_type == CPUFREQ_SHARED_TYPE_ALL) {
                 /* Support only SW_ANY for now. */
                 pr_debug("Unsupported CPU co-ord type\n");
                 return -EFAULT;