Their implementations are quite similar, lets modify
cpufreq_update_current_freq() a little and use it from __cpufreq_get().

Also rename cpufreq_update_current_freq() to
cpufreq_verify_current_freq(), as that's what it is doing.

Signed-off-by: Viresh Kumar <viresh.ku...@linaro.org>
---
 drivers/cpufreq/cpufreq.c | 70 ++++++++++++++++-----------------------
 1 file changed, 28 insertions(+), 42 deletions(-)

diff --git a/drivers/cpufreq/cpufreq.c b/drivers/cpufreq/cpufreq.c
index 5f5c7a516c74..4556a53fc764 100644
--- a/drivers/cpufreq/cpufreq.c
+++ b/drivers/cpufreq/cpufreq.c
@@ -1547,6 +1547,30 @@ static void cpufreq_out_of_sync(struct cpufreq_policy 
*policy,
        cpufreq_freq_transition_end(policy, &freqs, 0);
 }
 
+static unsigned int cpufreq_verify_current_freq(struct cpufreq_policy *policy, 
bool update)
+{
+       unsigned int new_freq;
+
+       new_freq = cpufreq_driver->get(policy->cpu);
+       if (!new_freq)
+               return 0;
+
+       /*
+        * If fast frequency switching is used with the given policy, the check
+        * against policy->cur is pointless, so skip it in that case.
+        */
+       if (policy->fast_switch_enabled || !has_target())
+               return new_freq;
+
+       if (policy->cur != new_freq) {
+               cpufreq_out_of_sync(policy, new_freq);
+               if (update)
+                       schedule_work(&policy->update);
+       }
+
+       return new_freq;
+}
+
 /**
  * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
  * @cpu: CPU number
@@ -1602,30 +1626,10 @@ EXPORT_SYMBOL(cpufreq_quick_get_max);
 
 static unsigned int __cpufreq_get(struct cpufreq_policy *policy)
 {
-       unsigned int ret_freq = 0;
-
        if (unlikely(policy_is_inactive(policy)))
-               return ret_freq;
-
-       ret_freq = cpufreq_driver->get(policy->cpu);
-
-       /*
-        * If fast frequency switching is used with the given policy, the check
-        * against policy->cur is pointless, so skip it in that case too.
-        */
-       if (policy->fast_switch_enabled)
-               return ret_freq;
-
-       if (has_target() && ret_freq && policy->cur) {
-               /* verify no discrepancy between actual and
-                                       saved value exists */
-               if (unlikely(ret_freq != policy->cur)) {
-                       cpufreq_out_of_sync(policy, ret_freq);
-                       schedule_work(&policy->update);
-               }
-       }
+               return 0;
 
-       return ret_freq;
+       return cpufreq_verify_current_freq(policy, true);
 }
 
 /**
@@ -1652,24 +1656,6 @@ unsigned int cpufreq_get(unsigned int cpu)
 }
 EXPORT_SYMBOL(cpufreq_get);
 
-static unsigned int cpufreq_update_current_freq(struct cpufreq_policy *policy)
-{
-       unsigned int new_freq;
-
-       new_freq = cpufreq_driver->get(policy->cpu);
-       if (!new_freq)
-               return 0;
-
-       if (!policy->cur) {
-               pr_debug("cpufreq: Driver did not initialize current freq\n");
-               policy->cur = new_freq;
-       } else if (policy->cur != new_freq && has_target()) {
-               cpufreq_out_of_sync(policy, new_freq);
-       }
-
-       return new_freq;
-}
-
 static struct subsys_interface cpufreq_interface = {
        .name           = "cpufreq",
        .subsys         = &cpu_subsys,
@@ -2151,7 +2137,7 @@ static int cpufreq_start_governor(struct cpufreq_policy 
*policy)
        pr_debug("%s: for CPU %u\n", __func__, policy->cpu);
 
        if (cpufreq_driver->get)
-               cpufreq_update_current_freq(policy);
+               cpufreq_verify_current_freq(policy, false);
 
        if (policy->governor->start) {
                ret = policy->governor->start(policy);
@@ -2402,7 +2388,7 @@ void cpufreq_update_policy(unsigned int cpu)
         * -> ask driver for current freq and notify governors about a change
         */
        if (cpufreq_driver->get && has_target() &&
-           (cpufreq_suspended || 
WARN_ON(!cpufreq_update_current_freq(policy))))
+           (cpufreq_suspended || WARN_ON(!cpufreq_verify_current_freq(policy, 
false))))
                goto unlock;
 
        pr_debug("updating policy for CPU %u\n", cpu);
-- 
2.21.0.rc0.269.g1a574e7a288b

Reply via email to