mmc: host: omap_hsmmc: return error if any of the regulator APIs fail

Return error if any of the regulator APIs (regulator_enable,
regulator_disable, regulator_set_voltage) fails in
omap_hsmmc_set_power to avoid undefined behavior.

Signed-off-by: Kishon Vijay Abraham I <kishon@ti.com>
Tested-by: Tony Lindgren <tony@atomide.com>
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
This commit is contained in:
Kishon Vijay Abraham I 2015-08-27 14:43:59 +05:30 committed by Ulf Hansson
parent ef62b8bc2c
commit 229f329265
1 changed files with 40 additions and 12 deletions

View File

@ -269,8 +269,11 @@ static int omap_hsmmc_set_power(struct device *dev, int power_on, int vdd)
if (host->pbias) { if (host->pbias) {
if (host->pbias_enabled == 1) { if (host->pbias_enabled == 1) {
ret = regulator_disable(host->pbias); ret = regulator_disable(host->pbias);
if (!ret) if (ret) {
host->pbias_enabled = 0; dev_err(dev, "pbias reg disable failed\n");
return ret;
}
host->pbias_enabled = 0;
} }
} }
@ -288,23 +291,35 @@ static int omap_hsmmc_set_power(struct device *dev, int power_on, int vdd)
* chips/cards need an interface voltage rail too. * chips/cards need an interface voltage rail too.
*/ */
if (power_on) { if (power_on) {
if (mmc->supply.vmmc) if (mmc->supply.vmmc) {
ret = mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, vdd); ret = mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, vdd);
if (ret)
return ret;
}
/* Enable interface voltage rail, if needed */ /* Enable interface voltage rail, if needed */
if (ret == 0 && mmc->supply.vqmmc) { if (mmc->supply.vqmmc) {
ret = regulator_enable(mmc->supply.vqmmc); ret = regulator_enable(mmc->supply.vqmmc);
if (ret < 0 && mmc->supply.vmmc) if (ret) {
ret = mmc_regulator_set_ocr(mmc, dev_err(dev, "vmmc_aux reg enable failed\n");
mmc->supply.vmmc, goto err_set_vqmmc;
0); }
} }
} else { } else {
/* Shut down the rail */ /* Shut down the rail */
if (mmc->supply.vqmmc) if (mmc->supply.vqmmc) {
ret = regulator_disable(mmc->supply.vqmmc); ret = regulator_disable(mmc->supply.vqmmc);
if (ret) {
dev_err(dev, "vmmc_aux reg disable failed\n");
return ret;
}
}
if (mmc->supply.vmmc) { if (mmc->supply.vmmc) {
/* Then proceed to shut down the local regulator */ /* Then proceed to shut down the local regulator */
ret = mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0); ret = mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
if (ret)
return ret;
} }
} }
@ -316,19 +331,32 @@ static int omap_hsmmc_set_power(struct device *dev, int power_on, int vdd)
ret = regulator_set_voltage(host->pbias, VDD_3V0, ret = regulator_set_voltage(host->pbias, VDD_3V0,
VDD_3V0); VDD_3V0);
if (ret < 0) if (ret < 0)
goto error_set_power; goto err_set_voltage;
if (host->pbias_enabled == 0) { if (host->pbias_enabled == 0) {
ret = regulator_enable(host->pbias); ret = regulator_enable(host->pbias);
if (!ret) if (ret) {
dev_err(dev, "pbias reg enable failed\n");
goto err_set_voltage;
} else {
host->pbias_enabled = 1; host->pbias_enabled = 1;
}
} }
} }
if (mmc_pdata(host)->after_set_reg) if (mmc_pdata(host)->after_set_reg)
mmc_pdata(host)->after_set_reg(dev, power_on, vdd); mmc_pdata(host)->after_set_reg(dev, power_on, vdd);
error_set_power: return 0;
err_set_voltage:
if (mmc->supply.vqmmc)
regulator_disable(mmc->supply.vqmmc);
err_set_vqmmc:
if (mmc->supply.vmmc)
mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
return ret; return ret;
} }