-From 0759cdff49f1cf361bf503c13f7bcb33da43ab95 Mon Sep 17 00:00:00 2001
-From: Georgi Djakov <georgi.djakov@linaro.org>
-Date: Tue, 8 Sep 2015 11:24:41 +0300
-Subject: [PATCH 55/69] cpufreq-dt: Add L2 frequency scaling support
-
-Signed-off-by: Georgi Djakov <georgi.djakov@linaro.org>
----
- drivers/cpufreq/cpufreq-dt.c | 41 ++++++++++++++++++++++++++++++++++++++++-
- include/linux/cpufreq.h | 2 ++
- 2 files changed, 42 insertions(+), 1 deletion(-)
-
--- a/drivers/cpufreq/cpufreq-dt.c
+++ b/drivers/cpufreq/cpufreq-dt.c
-@@ -49,11 +49,40 @@ static int set_target(struct cpufreq_pol
+@@ -48,16 +48,71 @@ static int set_target(struct cpufreq_pol
+ {
struct private_data *priv = policy->driver_data;
unsigned long freq = policy->freq_table[index].frequency;
- int ret;
+ struct clk *l2_clk = policy->l2_clk;
-+ unsigned int l2_freq;
-+ unsigned long new_l2_freq = 0;
++ struct regulator *l2_regulator = policy->l2_regulator;
++ unsigned long l2_freq, target_l2_freq;
++ unsigned long l2_vol, target_l2_vol;
++ unsigned long target_freq;
+ int ret;
mutex_lock(&priv->lock);
ret = dev_pm_opp_set_rate(priv->cpu_dev, freq * 1000);
if (!ret) {
-+ if (!IS_ERR(l2_clk) && policy->l2_rate[0] && policy->l2_rate[1] &&
-+ policy->l2_rate[2]) {
++ if (policy->l2_rate_set) {
+ static unsigned long krait_l2[CONFIG_NR_CPUS] = { };
-+ int cpu, ret = 0;
-+ unsigned long target_freq = freq * 1000;
++ int cpu, l2_index, tol = 0;
+
-+ if (target_freq >= policy->l2_rate[2])
-+ new_l2_freq = policy->l2_rate[2];
-+ else if (target_freq >= policy->l2_rate[1])
-+ new_l2_freq = policy->l2_rate[1];
-+ else
-+ new_l2_freq = policy->l2_rate[0];
++ target_freq = freq * 1000;
+
-+ krait_l2[policy->cpu] = new_l2_freq;
++ krait_l2[policy->cpu] = target_freq;
+ for_each_present_cpu(cpu)
-+ new_l2_freq = max(new_l2_freq, krait_l2[cpu]);
++ target_freq = max(target_freq, krait_l2[cpu]);
++
++ for (l2_index = 2; l2_index >= 0; l2_index--)
++ if (target_freq >= policy->l2_cpufreq[l2_index])
++ break;
+
+ l2_freq = clk_get_rate(l2_clk);
++ target_l2_freq = policy->l2_rate[l2_index];
+
-+ if (l2_freq != new_l2_freq) {
-+ ret = clk_set_rate(l2_clk, policy->l2_rate[0]);
++ if (l2_freq != target_l2_freq) {
++
++ /*
++ * Set to idle bin if switching from normal to high bin
++ * or vice versa
++ */
++ if ( (l2_index == 2 && l2_freq == policy->l2_rate[1]) ||
++ (l2_index == 1 && l2_freq == policy->l2_rate[2]) ) {
++ ret = clk_set_rate(l2_clk, policy->l2_rate[0]);
++ if (ret)
++ goto exit;
++ }
+ /* scale l2 with the core */
-+ ret = clk_set_rate(l2_clk, new_l2_freq);
++ ret = clk_set_rate(l2_clk, target_l2_freq);
++ if (ret)
++ goto exit;
++
++ if (policy->l2_volt_set) {
++
++ l2_vol = regulator_get_voltage(l2_regulator);
++ target_l2_vol = policy->l2_volt[l2_index];
++
++ if (l2_vol != target_l2_vol) {
++ tol = target_l2_vol * policy->l2_volt_tol / 100;
++ ret = regulator_set_voltage_tol(l2_regulator,target_l2_vol,tol);
++ if (ret)
++ goto exit;
++ }
++ }
+ }
+ }
-+
priv->opp_freq = freq * 1000;
arch_set_freq_scale(policy->related_cpus, freq,
policy->cpuinfo.max_freq);
-@@ -201,6 +230,8 @@ static int cpufreq_init(struct cpufreq_p
- bool fallback = false;
+ }
++
++exit:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+@@ -202,6 +257,9 @@ static int cpufreq_init(struct cpufreq_p
+ bool fallback = false;
const char *name;
int ret;
-+ struct device_node *l2_np;
++ struct device_node *np, *l2_np;
+ struct clk *l2_clk = NULL;
++ struct regulator *l2_regulator = NULL;
cpu_dev = get_cpu_device(policy->cpu);
if (!cpu_dev) {
-@@ -307,6 +338,13 @@ static int cpufreq_init(struct cpufreq_p
+@@ -309,6 +367,57 @@ static int cpufreq_init(struct cpufreq_p
policy->suspend_freq = dev_pm_opp_get_suspend_opp_freq(cpu_dev) / 1000;
++ policy->l2_rate_set = false;
++ policy->l2_volt_set = false;
++
+ l2_clk = clk_get(cpu_dev, "l2");
+ if (!IS_ERR(l2_clk))
+ policy->l2_clk = l2_clk;
++
+ l2_np = of_find_node_by_name(NULL, "qcom,l2");
-+ if (l2_np)
++ if (l2_np) {
++ struct device_node *vdd;
++ np = of_node_get(priv->cpu_dev->of_node);
++
++ if (np)
++ of_property_read_u32(np, "voltage-tolerance", &policy->l2_volt_tol);
++
+ of_property_read_u32_array(l2_np, "qcom,l2-rates", policy->l2_rate, 3);
++ if (policy->l2_rate[0] && policy->l2_rate[1] && policy->l2_rate[2]) {
++ policy->l2_rate_set = true;
++ of_property_read_u32_array(l2_np, "qcom,l2-cpufreq", policy->l2_cpufreq, 3);
++ of_property_read_u32_array(l2_np, "qcom,l2-volt", policy->l2_volt, 3);
++ } else
++ pr_warn("L2: failed to parse L2 rates\n");
++
++ if (!policy->l2_cpufreq[0] && !policy->l2_cpufreq[1] &&
++ !policy->l2_cpufreq[2] && policy->l2_rate_set) {
++ int i;
++
++ pr_warn("L2: failed to parse target cpu freq, using defaults\n");
++ for (i = 0; i < 3; i++)
++ policy->l2_cpufreq[i] = policy->l2_rate[i];
++ }
++
++ if (policy->l2_volt[0] && policy->l2_volt[1] && policy->l2_volt[2] &&
++ policy->l2_volt_tol && policy->l2_rate_set) {
++ vdd = of_parse_phandle(l2_np, "qcom,l2-supply", 0);
++
++ if (vdd) {
++ l2_regulator = devm_regulator_get(cpu_dev, vdd->name);
++ if (!IS_ERR(l2_regulator)) {
++ policy->l2_regulator = l2_regulator;
++ policy->l2_volt_set = true;
++ } else {
++ pr_warn("failed to get l2 supply\n");
++ l2_regulator = NULL;
++ }
++
++ of_node_put(vdd);
++ }
++ }
++ }
+
/* Support turbo/boost mode */
if (policy_has_boost_freq(policy)) {
/* This gets disabled by core on driver unregister */
--- a/include/linux/cpufreq.h
+++ b/include/linux/cpufreq.h
-@@ -73,6 +73,8 @@ struct cpufreq_policy {
+@@ -72,7 +72,15 @@ struct cpufreq_policy {
+ should set cpufreq */
unsigned int cpu; /* cpu managing this policy, must be online */
- struct clk *clk;
-+ struct clk *l2_clk; /* L2 clock */
-+ unsigned int l2_rate[3]; /* L2 bus clock rate thresholds */
+- struct clk *clk;
++ struct clk *clk;
++ struct clk *l2_clk; /* L2 clock */
++ struct regulator *l2_regulator; /* L2 supply */
++ unsigned int l2_rate[3]; /* L2 bus clock rate */
++ bool l2_rate_set;
++ unsigned int l2_cpufreq[3]; /* L2 target CPU frequency */
++ unsigned int l2_volt[3]; /* L2 voltage array */
++ bool l2_volt_set;
++ unsigned int l2_volt_tol; /* L2 voltage tolerance */
struct cpufreq_cpuinfo cpuinfo;/* see above */
unsigned int min; /* in kHz */
projects / openwrt / staging / wigyori.git / commitdiff