1 files changed, 93 insertions, 18 deletions

diff --git a/drivers/regulator/mc13892-regulator.c b/drivers/regulator/mc13892-regulator.c
index 0d84b1f33199..9891aec47b57 100644
--- a/drivers/regulator/mc13892-regulator.c
+++ b/drivers/regulator/mc13892-regulator.c
@@ -164,6 +164,14 @@ static const unsigned int mc13892_sw1[] = {
         1350000, 1375000
 };
 
+/*
+ * Note: this table is used to derive SWxVSEL by index into
+ * the array. Offset the values by the index of 1100000uV
+ * to get the actual register value for that voltage selector
+ * if the HI bit is to be set as well.
+ */
+#define MC13892_SWxHI_SEL_OFFSET                20
+
 static const unsigned int mc13892_sw[] = {
         600000,   625000,  650000,  675000,  700000,  725000,
         750000,   775000,  800000,  825000,  850000,  875000,
@@ -239,7 +247,6 @@ static const unsigned int mc13892_pwgtdrv[] = {
 };
 
 static struct regulator_ops mc13892_gpo_regulator_ops;
-/* sw regulators need special care due to the "hi bit" */
 static struct regulator_ops mc13892_sw_regulator_ops;
 
 
@@ -396,7 +403,7 @@ static int mc13892_sw_regulator_get_voltage_sel(struct regulator_dev *rdev)
 {
         struct mc13xxx_regulator_priv *priv = rdev_get_drvdata(rdev);
         int ret, id = rdev_get_id(rdev);
-        unsigned int val;
+        unsigned int val, selector;
 
         dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
 
@@ -407,12 +414,28 @@ static int mc13892_sw_regulator_get_voltage_sel(struct regulator_dev *rdev)
         if (ret)
                 return ret;
 
-        val = (val & mc13892_regulators[id].vsel_mask)
-                >> mc13892_regulators[id].vsel_shift;
+        /*
+         * Figure out if the HI bit is set inside the switcher mode register
+         * since this means the selector value we return is at a different
+         * offset into the selector table.
+         *
+         * According to the MC13892 documentation note 59 (Table 47) the SW1
+         * buck switcher does not support output range programming therefore
+         * the HI bit must always remain 0. So do not do anything strange if
+         * our register is MC13892_SWITCHERS0.
+         */
+
+        selector = val & mc13892_regulators[id].vsel_mask;
+
+        if ((mc13892_regulators[id].vsel_reg != MC13892_SWITCHERS0) &&
+            (val & MC13892_SWITCHERS0_SWxHI)) {
+                selector += MC13892_SWxHI_SEL_OFFSET;
+        }
 
-        dev_dbg(rdev_get_dev(rdev), "%s id: %d val: %d\n", __func__, id, val);
+        dev_dbg(rdev_get_dev(rdev), "%s id: %d val: 0x%08x selector: %d\n",
+                        __func__, id, val, selector);
 
-        return val;
+        return selector;
 }
 
 static int mc13892_sw_regulator_set_voltage_sel(struct regulator_dev *rdev,
@@ -425,18 +448,35 @@ static int mc13892_sw_regulator_set_voltage_sel(struct regulator_dev *rdev,
 
         volt = rdev->desc->volt_table[selector];
         mask = mc13892_regulators[id].vsel_mask;
-        reg_value = selector << mc13892_regulators[id].vsel_shift;
-
-        if (volt > 1375000) {
-                mask |= MC13892_SWITCHERS0_SWxHI;
-                reg_value |= MC13892_SWITCHERS0_SWxHI;
-        } else if (volt < 1100000) {
-                mask |= MC13892_SWITCHERS0_SWxHI;
-                reg_value &= ~MC13892_SWITCHERS0_SWxHI;
+        reg_value = selector;
+
+        /*
+         * Don't mess with the HI bit or support HI voltage offsets for SW1.
+         *
+         * Since the get_voltage_sel callback has given a fudged value for
+         * the selector offset, we need to back out that offset if HI is
+         * to be set so we write the correct value to the register.
+         *
+         * The HI bit addition and selector offset handling COULD be more
+         * complicated by shifting and masking off the voltage selector part
+         * of the register then logical OR it back in, but since the selector
+         * is at bits 4:0 there is very little point. This makes the whole
+         * thing more readable and we do far less work.
+         */
+
+        if (mc13892_regulators[id].vsel_reg != MC13892_SWITCHERS0) {
+                if (volt > 1375000) {
+                        reg_value -= MC13892_SWxHI_SEL_OFFSET;
+                        reg_value |= MC13892_SWITCHERS0_SWxHI;
+                        mask |= MC13892_SWITCHERS0_SWxHI;
+                } else if (volt < 1100000) {
+                        reg_value &= ~MC13892_SWITCHERS0_SWxHI;
+                        mask |= MC13892_SWITCHERS0_SWxHI;
+                }
         }
 
         mc13xxx_lock(priv->mc13xxx);
-        ret = mc13xxx_reg_rmw(priv->mc13xxx, mc13892_regulators[id].reg, mask,
+        ret = mc13xxx_reg_rmw(priv->mc13xxx, mc13892_regulators[id].vsel_reg, mask,
                               reg_value);
         mc13xxx_unlock(priv->mc13xxx);
 
@@ -495,15 +535,18 @@ static int mc13892_regulator_probe(struct platform_device *pdev)
         struct mc13xxx_regulator_init_data *mc13xxx_data;
         struct regulator_config config = { };
         int i, ret;
-        int num_regulators = 0;
+        int num_regulators = 0, num_parsed;
         u32 val;
 
         num_regulators = mc13xxx_get_num_regulators_dt(pdev);
+
         if (num_regulators <= 0 && pdata)
                 num_regulators = pdata->num_regulators;
         if (num_regulators <= 0)
                 return -EINVAL;
 
+        num_parsed = num_regulators;
+
         priv = devm_kzalloc(&pdev->dev, sizeof(*priv) +
                 num_regulators * sizeof(priv->regulators[0]),
                 GFP_KERNEL);
@@ -520,7 +563,7 @@ static int mc13892_regulator_probe(struct platform_device *pdev)
         if (ret)
                 goto err_unlock;
 
-        /* enable switch auto mode */
+        /* enable switch auto mode (on 2.0A silicon only) */
         if ((val & 0x0000FFFF) == 0x45d0) {
                 ret = mc13xxx_reg_rmw(mc13892, MC13892_SWITCHERS4,
                         MC13892_SWITCHERS4_SW1MODE_M |
@@ -546,7 +589,39 @@ static int mc13892_regulator_probe(struct platform_device *pdev)
                 = mc13892_vcam_get_mode;
 
         mc13xxx_data = mc13xxx_parse_regulators_dt(pdev, mc13892_regulators,
-                                        ARRAY_SIZE(mc13892_regulators));
+                                        ARRAY_SIZE(mc13892_regulators),
+                                        &num_parsed);
+
+        /*
+         * Perform a little sanity check on the regulator tree - if we found
+         * a number of regulators from mc13xxx_get_num_regulators_dt and
+         * then parsed a smaller number in mc13xxx_parse_regulators_dt then
+         * there is a regulator defined in the regulators node which has
+         * not matched any usable regulator in the driver. In this case,
+         * there is one missing and what will happen is the first regulator
+         * will get registered again.
+         *
+         * Fix this by basically making our number of registerable regulators
+         * equal to the number of regulators we parsed. We are allocating
+         * too much memory for priv, but this is unavoidable at this point.
+         *
+         * As an example of how this can happen, try making a typo in your
+         * regulators node (vviohi {} instead of viohi {}) so that the name
+         * does not match..
+         *
+         * The check will basically pass for platform data (non-DT) because
+         * mc13xxx_parse_regulators_dt for !CONFIG_OF will not touch num_parsed.
+         *
+         */
+        if (num_parsed != num_regulators) {
+                dev_warn(&pdev->dev,
+                "parsed %d != regulators %d - check your device tree!\n",
+                        num_parsed, num_regulators);
+
+                num_regulators = num_parsed;
+                priv->num_regulators = num_regulators;
+        }
+
         for (i = 0; i < num_regulators; i++) {
                 struct regulator_init_data *init_data;
                 struct regulator_desc *desc;