|
@@ -33,7 +33,6 @@ struct private_data {
|
|
struct device *cpu_dev;
|
|
struct device *cpu_dev;
|
|
struct regulator *cpu_reg;
|
|
struct regulator *cpu_reg;
|
|
struct thermal_cooling_device *cdev;
|
|
struct thermal_cooling_device *cdev;
|
|
- unsigned int voltage_tolerance; /* in percentage */
|
|
|
|
const char *reg_name;
|
|
const char *reg_name;
|
|
};
|
|
};
|
|
|
|
|
|
@@ -55,24 +54,38 @@ static int set_target(struct cpufreq_policy *policy, unsigned int index)
|
|
* An earlier version of opp-v1 bindings used to name the regulator
|
|
* An earlier version of opp-v1 bindings used to name the regulator
|
|
* "cpu0-supply", we still need to handle that for backwards compatibility.
|
|
* "cpu0-supply", we still need to handle that for backwards compatibility.
|
|
*/
|
|
*/
|
|
-static const char *find_supply_name(struct device *dev, struct device_node *np)
|
|
|
|
|
|
+static const char *find_supply_name(struct device *dev)
|
|
{
|
|
{
|
|
|
|
+ struct device_node *np;
|
|
struct property *pp;
|
|
struct property *pp;
|
|
int cpu = dev->id;
|
|
int cpu = dev->id;
|
|
|
|
+ const char *name = NULL;
|
|
|
|
+
|
|
|
|
+ np = of_node_get(dev->of_node);
|
|
|
|
+
|
|
|
|
+ /* This must be valid for sure */
|
|
|
|
+ if (WARN_ON(!np))
|
|
|
|
+ return NULL;
|
|
|
|
|
|
/* Try "cpu0" for older DTs */
|
|
/* Try "cpu0" for older DTs */
|
|
if (!cpu) {
|
|
if (!cpu) {
|
|
pp = of_find_property(np, "cpu0-supply", NULL);
|
|
pp = of_find_property(np, "cpu0-supply", NULL);
|
|
- if (pp)
|
|
|
|
- return "cpu0";
|
|
|
|
|
|
+ if (pp) {
|
|
|
|
+ name = "cpu0";
|
|
|
|
+ goto node_put;
|
|
|
|
+ }
|
|
}
|
|
}
|
|
|
|
|
|
pp = of_find_property(np, "cpu-supply", NULL);
|
|
pp = of_find_property(np, "cpu-supply", NULL);
|
|
- if (pp)
|
|
|
|
- return "cpu";
|
|
|
|
|
|
+ if (pp) {
|
|
|
|
+ name = "cpu";
|
|
|
|
+ goto node_put;
|
|
|
|
+ }
|
|
|
|
|
|
dev_dbg(dev, "no regulator for cpu%d\n", cpu);
|
|
dev_dbg(dev, "no regulator for cpu%d\n", cpu);
|
|
- return NULL;
|
|
|
|
|
|
+node_put:
|
|
|
|
+ of_node_put(np);
|
|
|
|
+ return name;
|
|
}
|
|
}
|
|
|
|
|
|
static int allocate_resources(int cpu, struct device **cdev,
|
|
static int allocate_resources(int cpu, struct device **cdev,
|
|
@@ -147,7 +160,6 @@ try_again:
|
|
static int cpufreq_init(struct cpufreq_policy *policy)
|
|
static int cpufreq_init(struct cpufreq_policy *policy)
|
|
{
|
|
{
|
|
struct cpufreq_frequency_table *freq_table;
|
|
struct cpufreq_frequency_table *freq_table;
|
|
- struct device_node *np;
|
|
|
|
struct private_data *priv;
|
|
struct private_data *priv;
|
|
struct device *cpu_dev;
|
|
struct device *cpu_dev;
|
|
struct regulator *cpu_reg;
|
|
struct regulator *cpu_reg;
|
|
@@ -164,13 +176,6 @@ static int cpufreq_init(struct cpufreq_policy *policy)
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- np = of_node_get(cpu_dev->of_node);
|
|
|
|
- if (!np) {
|
|
|
|
- dev_err(cpu_dev, "failed to find cpu%d node\n", policy->cpu);
|
|
|
|
- ret = -ENOENT;
|
|
|
|
- goto out_put_reg_clk;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
/* Get OPP-sharing information from "operating-points-v2" bindings */
|
|
/* Get OPP-sharing information from "operating-points-v2" bindings */
|
|
ret = dev_pm_opp_of_get_sharing_cpus(cpu_dev, policy->cpus);
|
|
ret = dev_pm_opp_of_get_sharing_cpus(cpu_dev, policy->cpus);
|
|
if (ret) {
|
|
if (ret) {
|
|
@@ -181,20 +186,20 @@ static int cpufreq_init(struct cpufreq_policy *policy)
|
|
if (ret == -ENOENT)
|
|
if (ret == -ENOENT)
|
|
opp_v1 = true;
|
|
opp_v1 = true;
|
|
else
|
|
else
|
|
- goto out_node_put;
|
|
|
|
|
|
+ goto out_put_reg_clk;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
/*
|
|
* OPP layer will be taking care of regulators now, but it needs to know
|
|
* OPP layer will be taking care of regulators now, but it needs to know
|
|
* the name of the regulator first.
|
|
* the name of the regulator first.
|
|
*/
|
|
*/
|
|
- name = find_supply_name(cpu_dev, np);
|
|
|
|
|
|
+ name = find_supply_name(cpu_dev);
|
|
if (name) {
|
|
if (name) {
|
|
ret = dev_pm_opp_set_regulator(cpu_dev, name);
|
|
ret = dev_pm_opp_set_regulator(cpu_dev, name);
|
|
if (ret) {
|
|
if (ret) {
|
|
dev_err(cpu_dev, "Failed to set regulator for cpu%d: %d\n",
|
|
dev_err(cpu_dev, "Failed to set regulator for cpu%d: %d\n",
|
|
policy->cpu, ret);
|
|
policy->cpu, ret);
|
|
- goto out_node_put;
|
|
|
|
|
|
+ goto out_put_reg_clk;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
@@ -244,7 +249,6 @@ static int cpufreq_init(struct cpufreq_policy *policy)
|
|
}
|
|
}
|
|
|
|
|
|
priv->reg_name = name;
|
|
priv->reg_name = name;
|
|
- of_property_read_u32(np, "voltage-tolerance", &priv->voltage_tolerance);
|
|
|
|
|
|
|
|
ret = dev_pm_opp_init_cpufreq_table(cpu_dev, &freq_table);
|
|
ret = dev_pm_opp_init_cpufreq_table(cpu_dev, &freq_table);
|
|
if (ret) {
|
|
if (ret) {
|
|
@@ -286,8 +290,6 @@ static int cpufreq_init(struct cpufreq_policy *policy)
|
|
|
|
|
|
policy->cpuinfo.transition_latency = transition_latency;
|
|
policy->cpuinfo.transition_latency = transition_latency;
|
|
|
|
|
|
- of_node_put(np);
|
|
|
|
-
|
|
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
out_free_cpufreq_table:
|
|
out_free_cpufreq_table:
|
|
@@ -298,8 +300,6 @@ out_free_opp:
|
|
dev_pm_opp_of_cpumask_remove_table(policy->cpus);
|
|
dev_pm_opp_of_cpumask_remove_table(policy->cpus);
|
|
if (name)
|
|
if (name)
|
|
dev_pm_opp_put_regulator(cpu_dev);
|
|
dev_pm_opp_put_regulator(cpu_dev);
|
|
-out_node_put:
|
|
|
|
- of_node_put(np);
|
|
|
|
out_put_reg_clk:
|
|
out_put_reg_clk:
|
|
clk_put(cpu_clk);
|
|
clk_put(cpu_clk);
|
|
if (!IS_ERR(cpu_reg))
|
|
if (!IS_ERR(cpu_reg))
|