|
@@ -542,8 +542,7 @@ unlock:
|
|
}
|
|
}
|
|
|
|
|
|
static int _set_opp_voltage(struct device *dev, struct regulator *reg,
|
|
static int _set_opp_voltage(struct device *dev, struct regulator *reg,
|
|
- unsigned long u_volt, unsigned long u_volt_min,
|
|
|
|
- unsigned long u_volt_max)
|
|
|
|
|
|
+ struct dev_pm_opp_supply *supply)
|
|
{
|
|
{
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
@@ -554,14 +553,15 @@ static int _set_opp_voltage(struct device *dev, struct regulator *reg,
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
- dev_dbg(dev, "%s: voltages (mV): %lu %lu %lu\n", __func__, u_volt_min,
|
|
|
|
- u_volt, u_volt_max);
|
|
|
|
|
|
+ dev_dbg(dev, "%s: voltages (mV): %lu %lu %lu\n", __func__,
|
|
|
|
+ supply->u_volt_min, supply->u_volt, supply->u_volt_max);
|
|
|
|
|
|
- ret = regulator_set_voltage_triplet(reg, u_volt_min, u_volt,
|
|
|
|
- u_volt_max);
|
|
|
|
|
|
+ ret = regulator_set_voltage_triplet(reg, supply->u_volt_min,
|
|
|
|
+ supply->u_volt, supply->u_volt_max);
|
|
if (ret)
|
|
if (ret)
|
|
dev_err(dev, "%s: failed to set voltage (%lu %lu %lu mV): %d\n",
|
|
dev_err(dev, "%s: failed to set voltage (%lu %lu %lu mV): %d\n",
|
|
- __func__, u_volt_min, u_volt, u_volt_max, ret);
|
|
|
|
|
|
+ __func__, supply->u_volt_min, supply->u_volt,
|
|
|
|
+ supply->u_volt_max, ret);
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -583,8 +583,7 @@ int dev_pm_opp_set_rate(struct device *dev, unsigned long target_freq)
|
|
struct regulator *reg;
|
|
struct regulator *reg;
|
|
struct clk *clk;
|
|
struct clk *clk;
|
|
unsigned long freq, old_freq;
|
|
unsigned long freq, old_freq;
|
|
- unsigned long u_volt, u_volt_min, u_volt_max;
|
|
|
|
- unsigned long old_u_volt, old_u_volt_min, old_u_volt_max;
|
|
|
|
|
|
+ struct dev_pm_opp_supply old_supply, new_supply;
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
if (unlikely(!target_freq)) {
|
|
if (unlikely(!target_freq)) {
|
|
@@ -634,17 +633,12 @@ int dev_pm_opp_set_rate(struct device *dev, unsigned long target_freq)
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
- if (IS_ERR(old_opp)) {
|
|
|
|
- old_u_volt = 0;
|
|
|
|
- } else {
|
|
|
|
- old_u_volt = old_opp->supply.u_volt;
|
|
|
|
- old_u_volt_min = old_opp->supply.u_volt_min;
|
|
|
|
- old_u_volt_max = old_opp->supply.u_volt_max;
|
|
|
|
- }
|
|
|
|
|
|
+ if (IS_ERR(old_opp))
|
|
|
|
+ old_supply.u_volt = 0;
|
|
|
|
+ else
|
|
|
|
+ memcpy(&old_supply, &old_opp->supply, sizeof(old_supply));
|
|
|
|
|
|
- u_volt = opp->supply.u_volt;
|
|
|
|
- u_volt_min = opp->supply.u_volt_min;
|
|
|
|
- u_volt_max = opp->supply.u_volt_max;
|
|
|
|
|
|
+ memcpy(&new_supply, &opp->supply, sizeof(new_supply));
|
|
|
|
|
|
reg = opp_table->regulator;
|
|
reg = opp_table->regulator;
|
|
|
|
|
|
@@ -652,8 +646,7 @@ int dev_pm_opp_set_rate(struct device *dev, unsigned long target_freq)
|
|
|
|
|
|
/* Scaling up? Scale voltage before frequency */
|
|
/* Scaling up? Scale voltage before frequency */
|
|
if (freq > old_freq) {
|
|
if (freq > old_freq) {
|
|
- ret = _set_opp_voltage(dev, reg, u_volt, u_volt_min,
|
|
|
|
- u_volt_max);
|
|
|
|
|
|
+ ret = _set_opp_voltage(dev, reg, &new_supply);
|
|
if (ret)
|
|
if (ret)
|
|
goto restore_voltage;
|
|
goto restore_voltage;
|
|
}
|
|
}
|
|
@@ -672,8 +665,7 @@ int dev_pm_opp_set_rate(struct device *dev, unsigned long target_freq)
|
|
|
|
|
|
/* Scaling down? Scale voltage after frequency */
|
|
/* Scaling down? Scale voltage after frequency */
|
|
if (freq < old_freq) {
|
|
if (freq < old_freq) {
|
|
- ret = _set_opp_voltage(dev, reg, u_volt, u_volt_min,
|
|
|
|
- u_volt_max);
|
|
|
|
|
|
+ ret = _set_opp_voltage(dev, reg, &new_supply);
|
|
if (ret)
|
|
if (ret)
|
|
goto restore_freq;
|
|
goto restore_freq;
|
|
}
|
|
}
|
|
@@ -686,10 +678,8 @@ restore_freq:
|
|
__func__, old_freq);
|
|
__func__, old_freq);
|
|
restore_voltage:
|
|
restore_voltage:
|
|
/* This shouldn't harm even if the voltages weren't updated earlier */
|
|
/* This shouldn't harm even if the voltages weren't updated earlier */
|
|
- if (old_u_volt) {
|
|
|
|
- _set_opp_voltage(dev, reg, old_u_volt, old_u_volt_min,
|
|
|
|
- old_u_volt_max);
|
|
|
|
- }
|
|
|
|
|
|
+ if (old_supply.u_volt)
|
|
|
|
+ _set_opp_voltage(dev, reg, &old_supply);
|
|
|
|
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|