diff --git a/drivers/regulator/s2mps11.c b/drivers/regulator/s2mps11.c index 570b61420f3a..66de87e782a9 100644 --- a/drivers/regulator/s2mps11.c +++ b/drivers/regulator/s2mps11.c @@ -1117,6 +1117,57 @@ static const struct regulator_desc s2mpu02_regulators[] = { regulator_desc_s2mpu02_buck7(7), }; +static int s2mps11_pmic_ethonoff(struct platform_device *pdev, bool onoff) +{ + struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent); + unsigned int reg_val = 0; + int ret = 0; + + ret = regmap_read(iodev->regmap_pmic, S2MPS11_REG_L15CTRL, ®_val); + if (ret) { + dev_err(&pdev->dev, "failed to read S2MPS11_REG_L15CTRL value\n"); + return ret; + } + + ret = regmap_read(iodev->regmap_pmic, S2MPS11_REG_L17CTRL, ®_val); + if (ret) { + dev_err(&pdev->dev, "failed to read S2MPS11_REG_L17CTRL value\n"); + return ret; + } + + if (onoff) { + /* ETH VDD0 ON */ + ret = regmap_update_bits(iodev->regmap_pmic, S2MPS11_REG_L15CTRL, 0xFF, 0x72); + if (ret) { + dev_err(&pdev->dev, "cannot update S2MPS11 LDO CTRL15 register\n"); + return ret; + } + + /* ETH VDD1 ON */ + ret = regmap_update_bits(iodev->regmap_pmic, S2MPS11_REG_L17CTRL, 0xFF, 0x72); + if (ret) { + dev_err(&pdev->dev, "cannot update S2MPS11 LDO CTRL17 register\n"); + return ret; + } + } else { + /* ETH VDD0 OFF */ + ret = regmap_update_bits(iodev->regmap_pmic, S2MPS11_REG_L15CTRL, 0x3F, 0x00); + if (ret) { + dev_err(&pdev->dev, "cannot update S2MPS11 LDO CTRL15 register\n"); + return ret; + } + + /* ETH VDD1 OFF */ + ret = regmap_update_bits(iodev->regmap_pmic, S2MPS11_REG_L17CTRL, 0x3F, 0x00); + if (ret) { + dev_err(&pdev->dev, "cannot update S2MPS11 LDO CTRL17 register\n"); + return ret; + } + } + + return ret; +} + static int s2mps11_pmic_probe(struct platform_device *pdev) { struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent); @@ -1225,6 +1276,34 @@ out: return ret; } +static void s2mps11_pmic_shutdown(struct platform_device *pdev) +{ + struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent); + unsigned int reg_val, ret; + + ret = regmap_read(iodev->regmap_pmic, S2MPS11_REG_CTRL1, ®_val); + if (ret < 0) { + dev_crit(&pdev->dev, "could not read S2MPS11_REG_CTRL1 value\n"); + } else { + /* + * s2mps11-pmic: S2MPS11_REG_CTRL1 reg value + * is 00000000000000000000000000010000 + * clear the S2MPS11_REG_CTRL1 0x10 value to shutdown. + */ + if (reg_val & BIT(4)) { + ret = regmap_update_bits(iodev->regmap_pmic, + S2MPS11_REG_CTRL1, + BIT(4), BIT(0)); + if (ret) + dev_crit(&pdev->dev, + "could not write S2MPS11_REG_CTRL1 value\n"); + } + } + s2mps11_pmic_ethonoff(pdev, false); + mdelay(10); + s2mps11_pmic_ethonoff(pdev, true); +} + static const struct platform_device_id s2mps11_pmic_id[] = { { "s2mps11-regulator", S2MPS11X}, { "s2mps13-regulator", S2MPS13X}, @@ -1241,6 +1320,7 @@ static struct platform_driver s2mps11_pmic_driver = { .probe_type = PROBE_PREFER_ASYNCHRONOUS, }, .probe = s2mps11_pmic_probe, + .shutdown = s2mps11_pmic_shutdown, .id_table = s2mps11_pmic_id, };