Reuse TPS65941 regulator driver to adds support for
TPS65224 PMIC's regulators. 4 BUCKs and 3 LDOs, where
BUCK1 and BUCK2 can be configured in dual phase mode.

Signed-off-by: Bhargav Raviprakash <bharga...@ltts.com>
---
 drivers/power/regulator/tps65941_regulator.c | 280 ++++++++++++++++++-
 1 file changed, 267 insertions(+), 13 deletions(-)

diff --git a/drivers/power/regulator/tps65941_regulator.c 
b/drivers/power/regulator/tps65941_regulator.c
index d879c2301b..5809a53fa2 100644
--- a/drivers/power/regulator/tps65941_regulator.c
+++ b/drivers/power/regulator/tps65941_regulator.c
@@ -37,6 +37,8 @@
 
 #define TPS65941_BUCK_CONV_OPS_IDX  0
 #define TPS65941_LDO_CONV_OPS_IDX   0
+#define TPS65224_LDO_CONV_OPS_IDX   1
+#define TPS65224_BUCK_CONV_OPS_IDX  1
 
 struct tps65941_reg_conv_ops {
        int volt_mask;
@@ -55,6 +57,11 @@ static const char tps65941_ldo_ctrl[TPS65941_BUCK_NUM] = 
{0x1D, 0x1E, 0x1F,
 static const char tps65941_ldo_vout[TPS65941_BUCK_NUM] = {0x23, 0x24, 0x25,
                                                                0x26};
 
+static inline int tps65941_get_chip_id(struct udevice *dev)
+{
+       return dev->parent->driver_data;
+}
+
 static int tps65941_buck_enable(struct udevice *dev, int op, bool *enable)
 {
        int ret;
@@ -146,6 +153,112 @@ int tps65941_lookup_slew(int id)
        }
 }
 
+static int tps65224_buck_volt2val(int idx, int uV)
+{
+       /* This functions maps a value which is in micro Volts to the VSET 
value.
+        * The mapping is as per the datasheet of TPS65224.
+        */
+
+       if (uV > TPS65224_BUCK_VOLT_MAX)
+               return -EINVAL;
+
+       if (idx > 0) {
+               /* Buck2, Buck3 and Buck4 of TPS65224 has a different schema in
+                * converting b/w micro_volt and VSET hex values
+                *
+                * VSET value starts from 0x00 for 0.5V, and for every increment
+                * in VSET value the output voltage increases by 25mV. This is 
upto
+                * 1.15V where VSET is 0x1A.
+                *
+                * For 0x1B the output voltage is 1.2V, and for every increment 
of
+                * VSET the output voltage increases by 50mV upto the max 
voltage of
+                * 3.3V
+                *
+                * | Voltage Ranges  | VSET Ranges  | Voltage Step |
+                * +-----------------+--------------+--------------+
+                * | 0.5V to 1.50V   | 0x00 to 0x1A |  25mV        |
+                * | 1.2V to 3.3V    | 0x1B to 0x45 |  50mV        |
+                */
+               if (uV >= 1200000)
+                       return (uV - 1200000) / 50000 + 0x1B;
+               else if (uV >= 500000)
+                       return (uV - 500000) / 25000;
+               else
+                       return -EINVAL;
+       }
+
+       /* Buck1 and Buck12(dual phase) has a different mapping b/w output
+        * voltage and VSET value.
+        *
+        * | Voltage Ranges  | VSET Ranges  | Voltage Step |
+        * +-----------------+--------------+--------------+
+        * | 0.5V to 0.58V   | 0xA to 0xE   |  20mV        |
+        * | 0.6V to 1.095V  | 0xF to 0x72  |  5mV         |
+        * | 1.1V to 1.65V   | 0x73 to 0xAA |  10mV        |
+        * | 1.6V to 3.3V    | 0xAB to 0xFD |  20mV        |
+        *
+        */
+       if (uV >= 1660000)
+               return (uV - 1660000) / 20000 + 0xAB;
+       else if (uV >= 1100000)
+               return (uV - 1100000) / 10000 + 0x73;
+       else if (uV >= 600000)
+               return (uV - 600000) / 5000 + 0x0F;
+       else if (uV >= 500000)
+               return (uV - 500000) / 20000 + 0x0A;
+       else
+               return -EINVAL;
+}
+
+static int tps65224_buck_val2volt(int idx, int val)
+{
+       /* This function does the opposite to the tps65224_buck_volt2val 
function
+        * described above.
+        * This maps the VSET value to micro volts. Please refer to the ranges
+        * mentioned the comments of tps65224_buck_volt2val.
+        */
+
+       if (idx > 0) {
+               if (val > TPS65224_BUCK234_VOLT_MAX_HEX)
+                       return -EINVAL;
+               else if (val >= 0x1B)
+                       return 1200000 + (val - 0x1B) * 50000;
+               else if (val >= 0x00)
+                       return 500000 + (val - 0x00) * 25000;
+               else
+                       return -EINVAL;
+       }
+
+       if (val > TPS65224_BUCK1_VOLT_MAX_HEX)
+               return -EINVAL;
+       else if (val >= 0xAB)
+               return 1660000 + (val - 0xAB) * 20000;
+       else if (val >= 0x73)
+               return 1100000 + (val - 0x73) * 10000;
+       else if (val >= 0xF)
+               return 600000 + (val - 0xF) * 5000;
+       else if (val >= 0xA)
+               return 500000 + (val - 0xA) * 20000;
+       else
+               return -EINVAL;
+}
+
+int tps65224_lookup_slew(int id)
+{
+       switch (id) {
+       case 0:
+               return 10000;
+       case 1:
+               return 5000;
+       case 2:
+               return 2500;
+       case 3:
+               return 1250;
+       default:
+               return -1;
+       }
+}
+
 static const struct tps65941_reg_conv_ops buck_conv_ops[] = {
        [TPS65941_BUCK_CONV_OPS_IDX] = {
                .volt_mask = TPS65941_BUCK_VOLT_MASK,
@@ -154,6 +267,13 @@ static const struct tps65941_reg_conv_ops buck_conv_ops[] 
= {
                .slew_mask = TP65941_BUCK_CONF_SLEW_MASK,
                .lookup_slew = tps65941_lookup_slew,
        },
+       [TPS65224_BUCK_CONV_OPS_IDX] = {
+               .volt_mask = TPS65941_BUCK_VOLT_MASK,
+               .volt2val = tps65224_buck_volt2val,
+               .val2volt = tps65224_buck_val2volt,
+               .slew_mask = TPS65224_BUCK_CONF_SLEW_MASK,
+               .lookup_slew = tps65224_lookup_slew,
+       },
 };
 
 static int tps65941_buck_val(struct udevice *dev, int op, int *uV)
@@ -162,9 +282,23 @@ static int tps65941_buck_val(struct udevice *dev, int op, 
int *uV)
        int ret, delta, uwait, slew, idx;
        struct dm_regulator_uclass_plat *uc_pdata;
        const struct tps65941_reg_conv_ops *conv_ops;
+       ulong chip_id;
 
        idx = dev->driver_data;
-       conv_ops = &buck_conv_ops[TPS65941_BUCK_CONV_OPS_IDX];
+       chip_id = tps65941_get_chip_id(dev);
+       if (chip_id == TPS65224) {
+               /* idx is the buck id number as per devicetree node which will 
be same
+                * as the regulator name in the datasheet.
+                * The idx for buck1. buck2, buck3, buck4, buck12 will be 1, 2, 
3, 4
+                * and 12 respectively.
+                * In the driver the numbering is from 0. Hence the -1.
+                */
+               idx = (idx == TPS65941_BUCK_ID_12) ? 0 : (idx - 1);
+               conv_ops = &buck_conv_ops[TPS65224_BUCK_CONV_OPS_IDX];
+       } else {
+               conv_ops = &buck_conv_ops[TPS65941_BUCK_CONV_OPS_IDX];
+       }
+
        uc_pdata = dev_get_uclass_plat(dev);
 
        if (op == PMIC_OP_GET)
@@ -265,23 +399,99 @@ static int tps65941_ldo_val2volt(__maybe_unused int idx, 
int val)
                return -EINVAL;
 }
 
+static int tps65224_ldo_volt2val(int idx, int uV)
+{
+       int base = TPS65224_LDO1_VOLT_MIN;
+       int max = TPS65224_LDO1_VOLT_MAX;
+       int offset = TPS65224_LDO1_VOLT_MIN_HEX;
+       int step = TPS65224_LDO_STEP;
+
+       if (idx > 0) {
+               base = TPS65224_LDO23_VOLT_MIN;
+               max = TPS65224_LDO23_VOLT_MAX;
+               offset = TPS65224_LDO23_VOLT_MIN_HEX;
+       }
+
+       if (uV > max)
+               return -EINVAL;
+       else if (uV >= base)
+               return (uV - base) / step + offset;
+       else
+               return -EINVAL;
+}
+
+static int tps65224_ldo_val2volt(int idx, int val)
+{
+       int reg_base = TPS65224_LDO1_VOLT_MIN_HEX;
+       int reg_max = TPS65224_LDO1_VOLT_MAX_HEX;
+       int base = TPS65224_LDO1_VOLT_MIN;
+       int max = TPS65224_LDO1_VOLT_MAX;
+       int step = TPS65224_LDO_STEP;
+       /* In LDOx_VOUT reg the BIT0 is reserved and the
+        * vout value is stored from BIT1 to BIT7.
+        * Hence the below bit shit is done.
+        */
+       int mask = TPS65224_LDO_VOLT_MASK >> 1;
+
+       if (idx > 0) {
+               base = TPS65224_LDO23_VOLT_MIN;
+               max = TPS65224_LDO23_VOLT_MAX;
+               reg_base = TPS65224_LDO23_VOLT_MIN_HEX;
+               reg_max = TPS65224_LDO23_VOLT_MAX_HEX;
+       }
+
+       /* The VSET register of LDO has its 0th bit as reserved
+        * hence shifting the value to right by 1 bit.
+        */
+       val = val >> 1;
+
+       if (val < 0 || val > mask)
+               return -EINVAL;
+
+       if (val <= reg_base)
+               return base;
+
+       if (val >= reg_max)
+               return max;
+
+       return base + (step * (val - reg_base));
+}
+
 static const struct tps65941_reg_conv_ops ldo_conv_ops[] = {
        [TPS65941_LDO_CONV_OPS_IDX] = {
                .volt_mask = TPS65941_LDO_VOLT_MASK,
                .volt2val = tps65941_buck_volt2val,
                .val2volt = tps65941_ldo_val2volt,
        },
+       [TPS65224_LDO_CONV_OPS_IDX] = {
+               .volt_mask = TPS65224_LDO_VOLT_MASK,
+               .volt2val = tps65224_ldo_volt2val,
+               .val2volt = tps65224_ldo_val2volt,
+       },
 };
 
 static int tps65941_ldo_val(struct udevice *dev, int op, int *uV)
 {
        unsigned int hex, adr;
-       int ret, idx;
+       int ret, ret_volt, idx;
        struct dm_regulator_uclass_plat *uc_pdata;
        const struct tps65941_reg_conv_ops *conv_ops;
+       ulong chip_id;
 
+       chip_id = tps65941_get_chip_id(dev);
        idx = dev->driver_data;
-       conv_ops = &ldo_conv_ops[TPS65941_LDO_CONV_OPS_IDX];
+       if (chip_id == TPS65224) {
+               /* idx is the ldo id number as per devicetree node which will 
be same
+                * as the regulator name in the datasheet.
+                * The idx for ldo1, ldo2, ldo3 will be 1, 2 & 3 respectively.
+                * In the driver the numbering is from 0. Hence the -1.
+                */
+               idx = idx - 1;
+               conv_ops = &ldo_conv_ops[TPS65224_LDO_CONV_OPS_IDX];
+       } else {
+               conv_ops = &ldo_conv_ops[TPS65941_LDO_CONV_OPS_IDX];
+       }
+
        uc_pdata = dev_get_uclass_plat(dev);
 
        if (op == PMIC_OP_GET)
@@ -294,21 +504,36 @@ static int tps65941_ldo_val(struct udevice *dev, int op, 
int *uV)
                return ret;
 
        ret &= conv_ops->volt_mask;
-       ret = conv_ops->val2volt(idx, ret);
-       if (ret < 0)
-               return ret;
+       ret_volt = conv_ops->val2volt(idx, ret);
+       if (ret_volt < 0)
+               return ret_volt;
 
        if (op == PMIC_OP_GET) {
-               *uV = ret;
+               *uV = ret_volt;
                return 0;
        }
 
+       /* TPS65224 LDO1 in BYPASS mode only supports 2.2V min to 3.6V max */
+       if (chip_id == TPS65224 && idx == 0 && (ret & 
BIT(TPS65224_LDO_BYP_CONFIG)) &&
+           *uV < TPS65224_LDO1_VOLT_BYP_MIN)
+               return -EINVAL;
+
+       /* TPS65224 LDO2 & LDO3 in BYPASS mode supports 1.5V min to 5.5V max */
+       if (chip_id == TPS65224 && idx > 0 && (ret & 
BIT(TPS65224_LDO_BYP_CONFIG)) &&
+           *uV < TPS65224_LDO23_VOLT_BYP_MIN)
+               return -EINVAL;
+
        hex = conv_ops->volt2val(idx, *uV);
        if (hex < 0)
                return hex;
 
-       ret &= 0x0;
-       ret = hex;
+       if (chip_id == TPS65224) {
+               hex = hex << TPS65941_LDO_MODE_MASK;
+               ret &= ~TPS65224_LDO_VOLT_MASK;
+               ret |= hex;
+       } else {
+               ret = hex;
+       }
 
        ret = pmic_reg_write(dev->parent, adr, ret);
 
@@ -319,6 +544,9 @@ static int tps65941_ldo_probe(struct udevice *dev)
 {
        struct dm_regulator_uclass_plat *uc_pdata;
        int idx;
+       ulong chip_id;
+
+       chip_id = tps65941_get_chip_id(dev);
 
        uc_pdata = dev_get_uclass_plat(dev);
        uc_pdata->type = REGULATOR_TYPE_LDO;
@@ -328,9 +556,13 @@ static int tps65941_ldo_probe(struct udevice *dev)
        case TPS65941_LDO_ID_1:
        case TPS65941_LDO_ID_2:
        case TPS65941_LDO_ID_3:
-       case TPS65941_LDO_ID_4:
                debug("Single phase regulator\n");
                break;
+       case TPS65941_LDO_ID_4:
+               if (chip_id != TPS65224) {
+                       debug("Single phase regulator\n");
+                       break;
+               }
        default:
                pr_err("Wrong ID for regulator\n");
                return -EINVAL;
@@ -346,6 +578,9 @@ static int tps65941_buck_probe(struct udevice *dev)
 {
        struct dm_regulator_uclass_plat *uc_pdata;
        int idx;
+       ulong chip_id;
+
+       chip_id = tps65941_get_chip_id(dev);
 
        uc_pdata = dev_get_uclass_plat(dev);
        uc_pdata->type = REGULATOR_TYPE_BUCK;
@@ -356,16 +591,35 @@ static int tps65941_buck_probe(struct udevice *dev)
        case TPS65941_BUCK_ID_2:
        case TPS65941_BUCK_ID_3:
        case TPS65941_BUCK_ID_4:
-       case TPS65941_BUCK_ID_5:
                debug("Single phase regulator\n");
                break;
+       case TPS65941_BUCK_ID_5:
+               if (chip_id != TPS65224) {
+                       debug("Single phase regulator\n");
+               } else {
+                       pr_err("Wrong ID for regulator\n");
+                       return -EINVAL;
+               }
+               break;
        case TPS65941_BUCK_ID_12:
+               idx = 1;
+               break;
        case TPS65941_BUCK_ID_123:
        case TPS65941_BUCK_ID_1234:
-               idx = 1;
+               if (chip_id != TPS65224) {
+                       idx = 1;
+               } else {
+                       pr_err("Wrong ID for regulator\n");
+                       return -EINVAL;
+               }
                break;
        case TPS65941_BUCK_ID_34:
-               idx = 3;
+               if (chip_id != TPS65224) {
+                       idx = 3;
+               } else {
+                       pr_err("Wrong ID for regulator\n");
+                       return -EINVAL;
+               }
                break;
        default:
                pr_err("Wrong ID for regulator\n");
-- 
2.25.1

Reply via email to