s2mps11: Add proper reset for ethernet controller

Original patch by Memeka
This commit is contained in:
MastaG
2024-08-05 11:21:44 +02:00
parent 30c3784c60
commit ee0a8c1c44

View File

@@ -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, &reg_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, &reg_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, &reg_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,
};