Adding support for the twl6025. Major difference in the twl6025 is the group functionality has been removed from the chip so this affects how regulators are enabled and disabled. The names of the regulators also changed. The DCDCs of the 6025 are software controllable as well. Signed-off-by: Graeme Gregory <gg@xxxxxxxxxxxxxxx> --- drivers/regulator/twl-regulator.c | 447 ++++++++++++++++++++++++++++++++++--- 1 files changed, 412 insertions(+), 35 deletions(-) diff --git a/drivers/regulator/twl-regulator.c b/drivers/regulator/twl-regulator.c index 2a808c2..c08a0de 100644 --- a/drivers/regulator/twl-regulator.c +++ b/drivers/regulator/twl-regulator.c @@ -51,6 +51,8 @@ struct twlreg_info { u16 min_mV; u16 max_mV; + u8 flags; + /* used by regulator core */ struct regulator_desc desc; }; @@ -70,6 +72,7 @@ struct twlreg_info { #define VREG_TRANS 1 #define VREG_STATE 2 #define VREG_VOLTAGE 3 +#define VREG_VOLTAGE_DCDC 4 /* TWL6030 Misc register offsets */ #define VREG_BC_ALL 1 #define VREG_BC_REF 2 @@ -87,6 +90,17 @@ struct twlreg_info { #define TWL6030_CFG_STATE_APP(v) (((v) & TWL6030_CFG_STATE_APP_MASK) >>\ TWL6030_CFG_STATE_APP_SHIFT) +/* Flags for DCDC Voltage reading */ +#define DCDC_OFFSET_EN BIT(0) +#define DCDC_EXTENDED_EN BIT(1) + +/* twl6025 SMPS EPROM values */ +#define TWL6030_SMPS_OFFSET 0xB0 +#define TWL6030_SMPS_MULT 0xB3 +#define SMPS_MULTOFFSET_SMPS4 BIT(0) +#define SMPS_MULTOFFSET_VIO BIT(1) +#define SMPS_MULTOFFSET_SMPS3 BIT(6) + static inline int twlreg_read(struct twlreg_info *info, unsigned slave_subgp, unsigned offset) { @@ -144,11 +158,14 @@ static int twl6030reg_is_enabled(struct regulator_dev *rdev) struct twlreg_info *info = rdev_get_drvdata(rdev); int grp, val; - grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); - if (grp < 0) - return grp; + if (!(twl_features() & TWL6025_SUBCLASS)) { + grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); + if (grp < 0) + return grp; - grp &= P1_GRP_6030; + grp &= P1_GRP_6030; + } else + grp = 1; val = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_STATE); val = TWL6030_CFG_STATE_APP(val); @@ -159,19 +176,22 @@ static int twl6030reg_is_enabled(struct regulator_dev *rdev) static int twlreg_enable(struct regulator_dev *rdev) { struct twlreg_info *info = rdev_get_drvdata(rdev); - int grp; - int ret; + int grp = 0; + int ret = 0; - grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); - if (grp < 0) - return grp; + if (!(twl_class_is_6030() && (twl_features() & TWL6025_SUBCLASS))) { + grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); + if (grp < 0) + return grp; - if (twl_class_is_4030()) - grp |= P1_GRP_4030; - else - grp |= P1_GRP_6030; + if (twl_class_is_4030()) + grp |= P1_GRP_4030; + else + grp |= P1_GRP_6030; - ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_GRP, grp); + ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, + VREG_GRP, grp); + } if (!ret && twl_class_is_6030()) ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_STATE, @@ -186,29 +206,34 @@ static int twlreg_enable(struct regulator_dev *rdev) static int twlreg_disable(struct regulator_dev *rdev) { struct twlreg_info *info = rdev_get_drvdata(rdev); - int grp; - int ret; - - grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); - if (grp < 0) - return grp; - - /* For 6030, set the off state for all grps enabled */ - if (twl_class_is_6030()) { - ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_STATE, - (grp & (P1_GRP_6030 | P2_GRP_6030 | P3_GRP_6030)) << - TWL6030_CFG_STATE_GRP_SHIFT | - TWL6030_CFG_STATE_OFF); + int grp = 0; + int ret = 0; + + if (!(twl_class_is_6030() && (twl_features() & TWL6025_SUBCLASS))) { + grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); + if (grp < 0) + return grp; + + /* For 6030, set the off state for all grps enabled */ + if (twl_class_is_6030()) { + ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, + VREG_STATE, + (grp & (P1_GRP_6030 | P2_GRP_6030 | + P3_GRP_6030)) << + TWL6030_CFG_STATE_GRP_SHIFT | + TWL6030_CFG_STATE_OFF); if (ret) return ret; - } + } - if (twl_class_is_4030()) - grp &= ~(P1_GRP_4030 | P2_GRP_4030 | P3_GRP_4030); - else - grp &= ~(P1_GRP_6030 | P2_GRP_6030 | P3_GRP_6030); + if (twl_class_is_4030()) + grp &= ~(P1_GRP_4030 | P2_GRP_4030 | P3_GRP_4030); + else + grp &= ~(P1_GRP_6030 | P2_GRP_6030 | P3_GRP_6030); - ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_GRP, grp); + ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, + VREG_GRP, grp); + } /* Next, associate cleared grp in state register */ if (!ret && twl_class_is_6030()) @@ -299,10 +324,11 @@ static int twl4030reg_set_mode(struct regulator_dev *rdev, unsigned mode) static int twl6030reg_set_mode(struct regulator_dev *rdev, unsigned mode) { struct twlreg_info *info = rdev_get_drvdata(rdev); - int grp; + int grp = 0; int val; - grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); + if (!(twl_class_is_6030() && (twl_features() & TWL6025_SUBCLASS))) + grp = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_GRP); if (grp < 0) return grp; @@ -594,6 +620,270 @@ static struct regulator_ops twl6030_fixed_resource = { .get_status = twl6030reg_get_status, }; +/* + * DCDC status and control + */ + +static int twl6030dcdc_list_voltage(struct regulator_dev *rdev, unsigned index) +{ + struct twlreg_info *info = rdev_get_drvdata(rdev); + + int voltage = 0; + + switch (info->flags) { + case 0: + if (index == 0) + voltage = 0; + else if (index < 58) + voltage = (600000 + (12500 * (index - 1))); + else if (index == 58) + voltage = 1350 * 1000; + else if (index == 59) + voltage = 1500 * 1000; + else if (index == 60) + voltage = 1800 * 1000; + else if (index == 61) + voltage = 1900 * 1000; + else if (index == 62) + voltage = 2100 * 1000; + break; + case DCDC_OFFSET_EN: + if (index == 0) + voltage = 0; + else if (index < 58) + voltage = (700000 + (12500 * (index - 1))); + else if (index == 58) + voltage = 1350 * 1000; + else if (index == 59) + voltage = 1500 * 1000; + else if (index == 60) + voltage = 1800 * 1000; + else if (index == 61) + voltage = 1900 * 1000; + else if (index == 62) + voltage = 2100 * 1000; + break; + case DCDC_EXTENDED_EN: + if (index == 0) + voltage = 0; + else if (index < 58) + voltage = (1852000 + (38600 * (index - 1))); + else if (index == 58) + voltage = 2084 * 1000; + else if (index == 59) + voltage = 2315 * 1000; + else if (index == 60) + voltage = 2778 * 1000; + else if (index == 61) + voltage = 2932 * 1000; + else if (index == 62) + voltage = 3241 * 1000; + break; + case DCDC_OFFSET_EN|DCDC_EXTENDED_EN: + if (index == 0) + voltage = 0; + else if (index < 58) + voltage = (2161000 + (38600 * (index - 1))); + else if (index == 58) + voltage = 4167 * 1000; + else if (index == 59) + voltage = 2315 * 1000; + else if (index == 60) + voltage = 2778 * 1000; + else if (index == 61) + voltage = 2932 * 1000; + else if (index == 62) + voltage = 3241 * 1000; + break; + } + + return voltage; +} + +static int +twl6030dcdc_set_voltage(struct regulator_dev *rdev, int min_uV, int max_uV, + unsigned int *selector) +{ + struct twlreg_info *info = rdev_get_drvdata(rdev); + int vsel = 0; + + switch (info->flags) { + case 0: + if (min_uV == 0) + vsel = 0; + else if ((min_uV >= 600000) && (max_uV <= 1300000)) { + vsel = (min_uV - 600000) / 125; + if (vsel % 100) + vsel += 100; + vsel /= 100; + vsel++; + } + /* Values 1..57 for vsel are linear and can be calculated + * values 58..62 are non linear. + */ + else if ((min_uV > 1900000) && (max_uV >= 2100000)) + vsel = 62; + else if ((min_uV > 1800000) && (max_uV >= 1900000)) + vsel = 61; + else if ((min_uV > 1500000) && (max_uV >= 1800000)) + vsel = 60; + else if ((min_uV > 1350000) && (max_uV >= 1500000)) + vsel = 59; + else if ((min_uV > 1300000) && (max_uV >= 1350000)) + vsel = 58; + else + return -EINVAL; + break; + case DCDC_OFFSET_EN: + if (min_uV == 0) + vsel = 0; + else if ((min_uV >= 700000) && (max_uV <= 1420000)) { + vsel = (min_uV - 600000) / 125; + if (vsel % 100) + vsel += 100; + vsel /= 100; + vsel++; + } + /* Values 1..57 for vsel are linear and can be calculated + * values 58..62 are non linear. + */ + else if ((min_uV > 1900000) && (max_uV >= 2100000)) + vsel = 62; + else if ((min_uV > 1800000) && (max_uV >= 1900000)) + vsel = 61; + else if ((min_uV > 1350000) && (max_uV >= 1800000)) + vsel = 60; + else if ((min_uV > 1350000) && (max_uV >= 1500000)) + vsel = 59; + else if ((min_uV > 1300000) && (max_uV >= 1350000)) + vsel = 58; + else + return -EINVAL; + break; + case DCDC_EXTENDED_EN: + if (min_uV == 0) + vsel = 0; + else if ((min_uV >= 1852000) && (max_uV <= 4013600)) { + vsel = (min_uV - 1852000) / 386; + if (vsel % 100) + vsel += 100; + vsel /= 100; + vsel++; + } + break; + case DCDC_OFFSET_EN|DCDC_EXTENDED_EN: + if (min_uV == 0) + vsel = 0; + else if ((min_uV >= 2161000) && (max_uV <= 4321000)) { + vsel = (min_uV - 1852000) / 386; + if (vsel % 100) + vsel += 100; + vsel /= 100; + vsel++; + } + break; + } + + *selector = vsel; + + return twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_VOLTAGE_DCDC, + vsel); +} + +static int twl6030dcdc_get_voltage(struct regulator_dev *rdev) +{ + struct twlreg_info *info = rdev_get_drvdata(rdev); + int vsel = twlreg_read(info, TWL_MODULE_PM_RECEIVER, + VREG_VOLTAGE_DCDC); + int voltage = 0; + + if (vsel < 0) + return vsel; + switch (info->flags) { + case 0: + if (vsel == 0) + voltage = 0; + else if (vsel < 58) + voltage = (600000 + (12500 * (vsel - 1))); + else if (vsel == 58) + voltage = 1350 * 1000; + else if (vsel == 59) + voltage = 1500 * 1000; + else if (vsel == 60) + voltage = 1800 * 1000; + else if (vsel == 61) + voltage = 1900 * 1000; + else if (vsel == 62) + voltage = 2100 * 1000; + break; + case DCDC_OFFSET_EN: + if (vsel == 0) + voltage = 0; + else if (vsel < 58) + voltage = (700000 + (12500 * (vsel - 1))); + else if (vsel == 58) + voltage = 1350 * 1000; + else if (vsel == 59) + voltage = 1500 * 1000; + else if (vsel == 60) + voltage = 1800 * 1000; + else if (vsel == 61) + voltage = 1900 * 1000; + else if (vsel == 62) + voltage = 2100 * 1000; + break; + case DCDC_EXTENDED_EN: + if (vsel == 0) + voltage = 0; + else if (vsel < 58) + voltage = (1852000 + (38600 * (vsel - 1))); + else if (vsel == 58) + voltage = 2084 * 1000; + else if (vsel == 59) + voltage = 2315 * 1000; + else if (vsel == 60) + voltage = 2778 * 1000; + else if (vsel == 61) + voltage = 2932 * 1000; + else if (vsel == 62) + voltage = 3241 * 1000; + break; + case DCDC_EXTENDED_EN|DCDC_OFFSET_EN: + if (vsel == 0) + voltage = 0; + else if (vsel < 58) + voltage = (2161000 + (38600 * (vsel - 1))); + else if (vsel == 58) + voltage = 4167 * 1000; + else if (vsel == 59) + voltage = 2315 * 1000; + else if (vsel == 60) + voltage = 2778 * 1000; + else if (vsel == 61) + voltage = 2932 * 1000; + else if (vsel == 62) + voltage = 3241 * 1000; + break; + } + + return voltage; +} + +static struct regulator_ops twldcdc_ops = { + .list_voltage = twl6030dcdc_list_voltage, + + .set_voltage = twl6030dcdc_set_voltage, + .get_voltage = twl6030dcdc_get_voltage, + + .enable = twlreg_enable, + .disable = twlreg_disable, + .is_enabled = twl6030reg_is_enabled, + + .set_mode = twl6030reg_set_mode, + + .get_status = twl6030reg_get_status, +}; + /*----------------------------------------------------------------------*/ #define TWL4030_FIXED_LDO(label, offset, mVolts, num, turnon_delay, \ @@ -636,6 +926,22 @@ static struct regulator_ops twl6030_fixed_resource = { }, \ } +#define TWL6025_ADJUSTABLE_LDO(label, offset, min_mVolts, max_mVolts, num, \ + remap_conf) { \ + .base = offset, \ + .id = num, \ + .min_mV = min_mVolts, \ + .max_mV = max_mVolts, \ + .remap = remap_conf, \ + .desc = { \ + .name = #label, \ + .id = TWL6025_REG_##label, \ + .n_voltages = ((max_mVolts - min_mVolts)/100) + 1, \ + .ops = &twl6030ldo_ops, \ + .type = REGULATOR_VOLTAGE, \ + .owner = THIS_MODULE, \ + }, \ + } #define TWL_FIXED_LDO(label, offset, mVolts, num, turnon_delay, remap_conf, \ family, operations) { \ @@ -667,6 +973,23 @@ static struct regulator_ops twl6030_fixed_resource = { }, \ } +#define TWL6025_ADJUSTABLE_DCDC(label, offset, num, \ + remap_conf) { \ + .base = offset, \ + .id = num, \ + .min_mV = 600, \ + .max_mV = 2100, \ + .remap = remap_conf, \ + .desc = { \ + .name = #label, \ + .id = TWL6025_REG_##label, \ + .n_voltages = 63, \ + .ops = &twldcdc_ops, \ + .type = REGULATOR_VOLTAGE, \ + .owner = THIS_MODULE, \ + }, \ + } + /* * We list regulators here if systems need some level of * software control over them after boot. @@ -708,8 +1031,41 @@ static struct twlreg_info twl_regs[] = { TWL6030_FIXED_LDO(VDAC, 0x64, 1800, 17, 0), TWL6030_FIXED_LDO(VUSB, 0x70, 3300, 18, 0), TWL6030_FIXED_RESOURCE(CLK32KG, 0x8C, 48, 0), + + /* 6025 are renamed compared to 6030 versions */ + TWL6025_ADJUSTABLE_LDO(LDO2, 0x54, 1000, 3300, 1, 0x21), + TWL6025_ADJUSTABLE_LDO(LDO4, 0x58, 1000, 3300, 2, 0x21), + TWL6025_ADJUSTABLE_LDO(LDO3, 0x5c, 1000, 3300, 3, 0x21), + TWL6025_ADJUSTABLE_LDO(LDO5, 0x68, 1000, 3300, 4, 0x21), + TWL6025_ADJUSTABLE_LDO(LDO1, 0x6c, 1000, 3300, 5, 0x21), + TWL6025_ADJUSTABLE_LDO(LDO7, 0x74, 1000, 3300, 7, 0x21), + TWL6025_ADJUSTABLE_LDO(LDO6, 0x60, 1000, 3300, 16, 0x21), + TWL6025_ADJUSTABLE_LDO(LDOLN, 0x64, 1000, 3300, 17, 0x21), + TWL6025_ADJUSTABLE_LDO(LDOUSB, 0x70, 1000, 3300, 18, 0x21), + + TWL6025_ADJUSTABLE_DCDC(SMPS3, 0x34, 1, 0x21), + TWL6025_ADJUSTABLE_DCDC(SMPS4, 0x10, 2, 0x21), + TWL6025_ADJUSTABLE_DCDC(VIO, 0x16, 3, 0x21), }; +static u8 twl_get_smps_offset(void) +{ + u8 value; + + twl_i2c_read_u8(TWL_MODULE_PM_RECEIVER, &value, + TWL6030_SMPS_OFFSET); + return value; +} + +static u8 twl_get_smps_mult(void) +{ + u8 value; + + twl_i2c_read_u8(TWL_MODULE_PM_RECEIVER, &value, + TWL6030_SMPS_MULT); + return value; +} + static int __devinit twlreg_probe(struct platform_device *pdev) { int i; @@ -753,6 +1109,27 @@ static int __devinit twlreg_probe(struct platform_device *pdev) break; } + switch (pdev->id) { + case TWL6025_REG_SMPS3: + if (twl_get_smps_mult() & SMPS_MULTOFFSET_SMPS3) + info->flags |= DCDC_EXTENDED_EN; + if (twl_get_smps_offset() & SMPS_MULTOFFSET_SMPS3) + info->flags |= DCDC_OFFSET_EN; + break; + case TWL6025_REG_SMPS4: + if (twl_get_smps_mult() & SMPS_MULTOFFSET_SMPS4) + info->flags |= DCDC_EXTENDED_EN; + if (twl_get_smps_offset() & SMPS_MULTOFFSET_SMPS4) + info->flags |= DCDC_OFFSET_EN; + break; + case TWL6025_REG_VIO: + if (twl_get_smps_mult() & SMPS_MULTOFFSET_VIO) + info->flags |= DCDC_EXTENDED_EN; + if (twl_get_smps_offset() & SMPS_MULTOFFSET_VIO) + info->flags |= DCDC_OFFSET_EN; + break; + } + rdev = regulator_register(&info->desc, &pdev->dev, initdata, info); if (IS_ERR(rdev)) { dev_err(&pdev->dev, "can't register %s, %ld\n", -- 1.7.4.1 -- To unsubscribe from this list: send the line "unsubscribe linux-omap" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html