Kernel/linux
1
0
Fork 0
mirror of https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git synced 2024-12-29 09:13:38 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

mmc: sdhci-uhs2: add set_ios()

Browse Source 
This is a sdhci version of mmc's set_ios operation.
This is used to handle basic IO bus setting.
It covers both UHS-I and UHS-II.

Signed-off-by: Ben Chuang <ben.chuang@genesyslogic.com.tw>
Signed-off-by: AKASHI Takahiro <takahiro.akashi@linaro.org>
Signed-off-by: Victor Shih <victor.shih@genesyslogic.com.tw>
Acked-by: Adrian Hunter <adrian.hunter@intel.com>
Message-ID: <20241018105333.4569-10-victorshihgli@gmail.com>
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
This commit is contained in:
Victor Shih 2024-10-18 18:53:26 +08:00 committed by Ulf Hansson
parent 06a0d072ba
commit 10c8298a05
4 changed files with 165 additions and 21 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

128
drivers/mmc/host/sdhci-uhs2.c
View File

@ -208,12 +208,136 @@ void sdhci_uhs2_set_timeout(struct sdhci_host *host, struct mmc_command *cmd)
}
EXPORT_SYMBOL_GPL(sdhci_uhs2_set_timeout);
/**
* sdhci_uhs2_clear_set_irqs - set Error Interrupt Status Enable register
* @host: SDHCI host
* @clear: bit-wise clear mask
* @set: bit-wise set mask
*
* Set/unset bits in UHS-II Error Interrupt Status Enable register
*/
void sdhci_uhs2_clear_set_irqs(struct sdhci_host *host, u32 clear, u32 set)
{
u32 ier;
ier = sdhci_readl(host, SDHCI_UHS2_INT_STATUS_ENABLE);
ier &= ~clear;
ier |= set;
sdhci_writel(host, ier, SDHCI_UHS2_INT_STATUS_ENABLE);
sdhci_writel(host, ier, SDHCI_UHS2_INT_SIGNAL_ENABLE);
}
EXPORT_SYMBOL_GPL(sdhci_uhs2_clear_set_irqs);
static void __sdhci_uhs2_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
{
struct sdhci_host *host = mmc_priv(mmc);
u8 cmd_res, dead_lock;
u16 ctrl_2;
/* UHS2 Timeout Control */
sdhci_calc_timeout_uhs2(host, &cmd_res, &dead_lock);
/* change to use calculate value */
cmd_res |= FIELD_PREP(SDHCI_UHS2_TIMER_CTRL_DEADLOCK_MASK, dead_lock);
sdhci_uhs2_clear_set_irqs(host,
SDHCI_UHS2_INT_CMD_TIMEOUT |
SDHCI_UHS2_INT_DEADLOCK_TIMEOUT,
0);
sdhci_writeb(host, cmd_res, SDHCI_UHS2_TIMER_CTRL);
sdhci_uhs2_clear_set_irqs(host, 0,
SDHCI_UHS2_INT_CMD_TIMEOUT |
SDHCI_UHS2_INT_DEADLOCK_TIMEOUT);
/* UHS2 timing. Note, UHS2 timing is disabled when powering off */
ctrl_2 = sdhci_readw(host, SDHCI_HOST_CONTROL2);
if (ios->power_mode != MMC_POWER_OFF &&
(ios->timing == MMC_TIMING_UHS2_SPEED_A ||
ios->timing == MMC_TIMING_UHS2_SPEED_A_HD ||
ios->timing == MMC_TIMING_UHS2_SPEED_B ||
ios->timing == MMC_TIMING_UHS2_SPEED_B_HD))
ctrl_2 |= SDHCI_CTRL_UHS2 | SDHCI_CTRL_UHS2_ENABLE;
else
ctrl_2 &= ~(SDHCI_CTRL_UHS2 | SDHCI_CTRL_UHS2_ENABLE);
sdhci_writew(host, ctrl_2, SDHCI_HOST_CONTROL2);
host->timing = ios->timing;
if (!(host->quirks2 & SDHCI_QUIRK2_PRESET_VALUE_BROKEN))
sdhci_enable_preset_value(host, true);
if (host->ops->set_power)
host->ops->set_power(host, ios->power_mode, ios->vdd);
else
sdhci_uhs2_set_power(host, ios->power_mode, ios->vdd);
sdhci_set_clock(host, host->clock);
}
static int sdhci_uhs2_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
{
struct sdhci_host *host = mmc_priv(mmc);
pr_debug("%s: clock %uHz powermode %u Vdd %u timing %u\n",
mmc_hostname(mmc), ios->clock, ios->power_mode, ios->vdd, ios->timing);
if (!mmc_card_uhs2(mmc)) {
sdhci_set_ios(mmc, ios);
return 0;
}
if (ios->power_mode == MMC_POWER_UNDEFINED)
return 0;
if (host->flags & SDHCI_DEVICE_DEAD) {
if (ios->power_mode == MMC_POWER_OFF) {
mmc_opt_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
mmc_regulator_set_vqmmc2(mmc, ios);
}
return -1;
}
sdhci_set_ios_common(mmc, ios);
__sdhci_uhs2_set_ios(mmc, ios);
return 0;
}
static int sdhci_uhs2_control(struct mmc_host *mmc, enum sd_uhs2_operation op)
{
struct sdhci_host *host = mmc_priv(mmc);
struct mmc_ios *ios = &mmc->ios;
int err = 0;
DBG("Begin uhs2 control, act %d.\n", op);
switch (op) {
case UHS2_SET_IOS:
err = sdhci_uhs2_set_ios(mmc, ios);
break;
default:
pr_err("%s: input sd uhs2 operation %d is wrong!\n",
mmc_hostname(host->mmc), op);
err = -EIO;
break;
}
return err;
}
/*****************************************************************************\
* *
* Driver init/exit *
* *
\*****************************************************************************/
static int sdhci_uhs2_host_ops_init(struct sdhci_host *host)
{
host->mmc_host_ops.uhs2_control = sdhci_uhs2_control;
return 0;
}
static int __init sdhci_uhs2_mod_init(void)
{
return 0;
@ -288,6 +412,10 @@ int sdhci_uhs2_add_host(struct sdhci_host *host)
/* host doesn't want to enable UHS2 support */
mmc->caps2 &= ~MMC_CAP2_SD_UHS2;
/* overwrite ops */
if (mmc->caps2 & MMC_CAP2_SD_UHS2)
sdhci_uhs2_host_ops_init(host);
/* LED support not implemented for UHS2 */
host->quirks |= SDHCI_QUIRK_NO_LED;

1
drivers/mmc/host/sdhci-uhs2.h
View File

@ -181,5 +181,6 @@ void sdhci_uhs2_set_power(struct sdhci_host *host, unsigned char mode, unsigned
void sdhci_uhs2_set_timeout(struct sdhci_host *host, struct mmc_command *cmd);
int sdhci_uhs2_add_host(struct sdhci_host *host);
void sdhci_uhs2_remove_host(struct sdhci_host *host, int dead);
void sdhci_uhs2_clear_set_irqs(struct sdhci_host *host, u32 clear, u32 set);
#endif /* __SDHCI_UHS2_H */

55
drivers/mmc/host/sdhci.c
View File

@ -47,8 +47,6 @@
static unsigned int debug_quirks = 0;
static unsigned int debug_quirks2;
static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable);
static bool sdhci_send_command(struct sdhci_host *host, struct mmc_command *cmd);
void sdhci_dumpregs(struct sdhci_host *host)
@ -1877,6 +1875,12 @@ static u16 sdhci_get_preset_value(struct sdhci_host *host)
case MMC_TIMING_MMC_HS400:
preset = sdhci_readw(host, SDHCI_PRESET_FOR_HS400);
break;
case MMC_TIMING_UHS2_SPEED_A:
case MMC_TIMING_UHS2_SPEED_A_HD:
case MMC_TIMING_UHS2_SPEED_B:
case MMC_TIMING_UHS2_SPEED_B_HD:
preset = sdhci_readw(host, SDHCI_PRESET_FOR_UHS2);
break;
default:
pr_warn("%s: Invalid UHS-I mode selected\n",
mmc_hostname(host->mmc));
@ -2323,24 +2327,9 @@ static bool sdhci_presetable_values_change(struct sdhci_host *host, struct mmc_i
(sdhci_preset_needed(host, ios->timing) || host->drv_type != ios->drv_type);
}
void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
void sdhci_set_ios_common(struct mmc_host *mmc, struct mmc_ios *ios)
{
struct sdhci_host *host = mmc_priv(mmc);
bool reinit_uhs = host->reinit_uhs;
bool turning_on_clk = false;
u8 ctrl;
host->reinit_uhs = false;
if (ios->power_mode == MMC_POWER_UNDEFINED)
return;
if (host->flags & SDHCI_DEVICE_DEAD) {
if (!IS_ERR(mmc->supply.vmmc) &&
ios->power_mode == MMC_POWER_OFF)
mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
return;
}
/*
* Reset the chip on each power off.
@ -2357,8 +2346,6 @@ void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
sdhci_enable_preset_value(host, false);
if (!ios->clock || ios->clock != host->clock) {
turning_on_clk = ios->clock && !host->clock;
host->ops->set_clock(host, ios->clock);
host->clock = ios->clock;
@ -2374,6 +2361,31 @@ void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
mmc->max_busy_timeout /= host->timeout_clk;
}
}
}
EXPORT_SYMBOL_GPL(sdhci_set_ios_common);
void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
{
struct sdhci_host *host = mmc_priv(mmc);
bool reinit_uhs = host->reinit_uhs;
bool turning_on_clk;
u8 ctrl;
host->reinit_uhs = false;
if (ios->power_mode == MMC_POWER_UNDEFINED)
return;
if (host->flags & SDHCI_DEVICE_DEAD) {
if (!IS_ERR(mmc->supply.vmmc) &&
ios->power_mode == MMC_POWER_OFF)
mmc_regulator_set_ocr(mmc, mmc->supply.vmmc, 0);
return;
}
turning_on_clk = ios->clock != host->clock && ios->clock && !host->clock;
sdhci_set_ios_common(mmc, ios);
if (host->ops->set_power)
host->ops->set_power(host, ios->power_mode, ios->vdd);
@ -2942,7 +2954,7 @@ int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode)
}
EXPORT_SYMBOL_GPL(sdhci_execute_tuning);
static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
{
/* Host Controller v3.00 defines preset value registers */
if (host->version < SDHCI_SPEC_300)
@ -2970,6 +2982,7 @@ static void sdhci_enable_preset_value(struct sdhci_host *host, bool enable)
host->preset_enabled = enable;
}
}
EXPORT_SYMBOL_GPL(sdhci_enable_preset_value);
static void sdhci_post_req(struct mmc_host *mmc, struct mmc_request *mrq,
int err)

2
drivers/mmc/host/sdhci.h
View File

@ -848,6 +848,8 @@ void sdhci_reset(struct sdhci_host *host, u8 mask);
void sdhci_set_uhs_signaling(struct sdhci_host *host, unsigned timing);
int sdhci_execute_tuning(struct mmc_host *mmc, u32 opcode);
int __sdhci_execute_tuning(struct sdhci_host *host, u32 opcode);
void sdhci_enable_preset_value(struct sdhci_host *host, bool enable);
void sdhci_set_ios_common(struct mmc_host *mmc, struct mmc_ios *ios);
void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios);
int sdhci_start_signal_voltage_switch(struct mmc_host *mmc,
struct mmc_ios *ios);