|
@@ -94,62 +94,18 @@ int mc13xxx_regulator_list_voltage(struct regulator_dev *rdev,
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(mc13xxx_regulator_list_voltage);
|
|
|
|
|
|
-int mc13xxx_get_best_voltage_index(struct regulator_dev *rdev,
|
|
|
- int min_uV, int max_uV)
|
|
|
+static int mc13xxx_regulator_set_voltage_sel(struct regulator_dev *rdev,
|
|
|
+ unsigned selector)
|
|
|
{
|
|
|
struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
|
|
|
struct mc13xxx_regulator *mc13xxx_regulators = priv->mc13xxx_regulators;
|
|
|
- int reg_id = rdev_get_id(rdev);
|
|
|
- int i;
|
|
|
- int bestmatch;
|
|
|
- int bestindex;
|
|
|
-
|
|
|
- /*
|
|
|
- * Locate the minimum voltage fitting the criteria on
|
|
|
- * this regulator. The switchable voltages are not
|
|
|
- * in strict falling order so we need to check them
|
|
|
- * all for the best match.
|
|
|
- */
|
|
|
- bestmatch = INT_MAX;
|
|
|
- bestindex = -1;
|
|
|
- for (i = 0; i < mc13xxx_regulators[reg_id].desc.n_voltages; i++) {
|
|
|
- if (mc13xxx_regulators[reg_id].voltages[i] >= min_uV &&
|
|
|
- mc13xxx_regulators[reg_id].voltages[i] < bestmatch) {
|
|
|
- bestmatch = mc13xxx_regulators[reg_id].voltages[i];
|
|
|
- bestindex = i;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- if (bestindex < 0 || bestmatch > max_uV) {
|
|
|
- dev_warn(&rdev->dev, "no possible value for %d<=x<=%d uV\n",
|
|
|
- min_uV, max_uV);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
- return bestindex;
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(mc13xxx_get_best_voltage_index);
|
|
|
-
|
|
|
-static int mc13xxx_regulator_set_voltage(struct regulator_dev *rdev, int min_uV,
|
|
|
- int max_uV, unsigned *selector)
|
|
|
-{
|
|
|
- struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
|
|
|
- struct mc13xxx_regulator *mc13xxx_regulators = priv->mc13xxx_regulators;
|
|
|
- int value, id = rdev_get_id(rdev);
|
|
|
+ int id = rdev_get_id(rdev);
|
|
|
int ret;
|
|
|
|
|
|
- dev_dbg(rdev_get_dev(rdev), "%s id: %d min_uV: %d max_uV: %d\n",
|
|
|
- __func__, id, min_uV, max_uV);
|
|
|
-
|
|
|
- /* Find the best index */
|
|
|
- value = mc13xxx_get_best_voltage_index(rdev, min_uV, max_uV);
|
|
|
- dev_dbg(rdev_get_dev(rdev), "%s best value: %d\n", __func__, value);
|
|
|
- if (value < 0)
|
|
|
- return value;
|
|
|
-
|
|
|
mc13xxx_lock(priv->mc13xxx);
|
|
|
ret = mc13xxx_reg_rmw(priv->mc13xxx, mc13xxx_regulators[id].vsel_reg,
|
|
|
mc13xxx_regulators[id].vsel_mask,
|
|
|
- value << mc13xxx_regulators[id].vsel_shift);
|
|
|
+ selector << mc13xxx_regulators[id].vsel_shift);
|
|
|
mc13xxx_unlock(priv->mc13xxx);
|
|
|
|
|
|
return ret;
|
|
@@ -187,7 +143,7 @@ struct regulator_ops mc13xxx_regulator_ops = {
|
|
|
.disable = mc13xxx_regulator_disable,
|
|
|
.is_enabled = mc13xxx_regulator_is_enabled,
|
|
|
.list_voltage = mc13xxx_regulator_list_voltage,
|
|
|
- .set_voltage = mc13xxx_regulator_set_voltage,
|
|
|
+ .set_voltage_sel = mc13xxx_regulator_set_voltage_sel,
|
|
|
.get_voltage = mc13xxx_regulator_get_voltage,
|
|
|
};
|
|
|
EXPORT_SYMBOL_GPL(mc13xxx_regulator_ops);
|