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:
parent
ef62b8bc2c
commit
229f329265
|
@ -269,8 +269,11 @@ static int omap_hsmmc_set_power(struct device *dev, int power_on, int vdd)
|
|||
if (host->pbias) {
|
||||
if (host->pbias_enabled == 1) {
|
||||
ret = regulator_disable(host->pbias);
|
||||
if (!ret)
|
||||
host->pbias_enabled = 0;
|
||||
if (ret) {
|
||||
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.
|
||||
*/
|
||||
if (power_on) {
|
||||
if (mmc->supply.vmmc)
|
||||
if (mmc->supply.vmmc) {
|
||||
ret = mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, vdd);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Enable interface voltage rail, if needed */
|
||||
if (ret == 0 && mmc->supply.vqmmc) {
|
||||
if (mmc->supply.vqmmc) {
|
||||
ret = regulator_enable(mmc->supply.vqmmc);
|
||||
if (ret < 0 && mmc->supply.vmmc)
|
||||
ret = mmc_regulator_set_ocr(mmc,
|
||||
mmc->supply.vmmc,
|
||||
0);
|
||||
if (ret) {
|
||||
dev_err(dev, "vmmc_aux reg enable failed\n");
|
||||
goto err_set_vqmmc;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
/* Shut down the rail */
|
||||
if (mmc->supply.vqmmc)
|
||||
if (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) {
|
||||
/* Then proceed to shut down the local regulator */
|
||||
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,
|
||||
VDD_3V0);
|
||||
if (ret < 0)
|
||||
goto error_set_power;
|
||||
goto err_set_voltage;
|
||||
|
||||
if (host->pbias_enabled == 0) {
|
||||
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;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (mmc_pdata(host)->after_set_reg)
|
||||
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;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue