Commit 7b239903 authored by Axel Lin's avatar Axel Lin Committed by Chris Ball
Browse files

mmc: wmt-sdmmc: Simplify wmt_set_sd_power implementation 



Simplify the code to set/clear BM_SD_OFF bit:

          | power_inverted: 0  | power_inverted: 1
-------------------------------------------------
enable: 0 | SET BM_SD_OFF      | CLEAR BM_SD_OFF
-------------------------------------------------
enable: 1 | CLEAR BM_SD_OFF    | SET BM_SD_OFF

Signed-off-by: default avatarAxel Lin <axel.lin@ingics.com>
Acked-by: default avatarTony Prisk <linux@prisktech.co.nz>
Signed-off-by: default avatarChris Ball <cjb@laptop.org>
parent 8776a165

drivers/mmc/host/wmt-sdmmc.c

+8 −22
Original line number Diff line number Diff line
@@ -212,28 +212,14 @@ struct wmt_mci_priv { 


static void wmt_set_sd_power(struct wmt_mci_priv *priv, int enable)

{

	u32 reg_tmp;

	if (enable) {

		if (priv->power_inverted) {

			reg_tmp = readb(priv->sdmmc_base + SDMMC_BUSMODE);

			writeb(reg_tmp | BM_SD_OFF,

			       priv->sdmmc_base + SDMMC_BUSMODE);

		} else {

			reg_tmp = readb(priv->sdmmc_base + SDMMC_BUSMODE);

			writeb(reg_tmp & (~BM_SD_OFF),

			       priv->sdmmc_base + SDMMC_BUSMODE);

		}

	} else {

		if (priv->power_inverted) {

			reg_tmp = readb(priv->sdmmc_base + SDMMC_BUSMODE);

			writeb(reg_tmp & (~BM_SD_OFF),

			       priv->sdmmc_base + SDMMC_BUSMODE);

		} else {

			reg_tmp = readb(priv->sdmmc_base + SDMMC_BUSMODE);

			writeb(reg_tmp | BM_SD_OFF,

			       priv->sdmmc_base + SDMMC_BUSMODE);

		}

	}

	u32 reg_tmp = readb(priv->sdmmc_base + SDMMC_BUSMODE);



	if (enable ^ priv->power_inverted)

		reg_tmp &= ~BM_SD_OFF;

	else

		reg_tmp |= BM_SD_OFF;



	writeb(reg_tmp, priv->sdmmc_base + SDMMC_BUSMODE);

}



static void wmt_mci_read_response(struct mmc_host *mmc)

CRA Git | Maintained and supported by SUSTech CRA and CCSE