From: Micky Ching <micky_ching@xxxxxxxxxxxxxx> Add support for SD4.0 card. Signed-off-by: Micky Ching <micky_ching@xxxxxxxxxxxxxx> Signed-off-by: Wei Wang <wei_wang@xxxxxxxxxxxxxx> --- drivers/mmc/host/sdhci.c | 108 ++++++++++++++++++++++++++++++++++++++++++++--- 1 file changed, 102 insertions(+), 6 deletions(-) diff --git a/drivers/mmc/host/sdhci.c b/drivers/mmc/host/sdhci.c index 15bd7c8..6ba8699 100644 --- a/drivers/mmc/host/sdhci.c +++ b/drivers/mmc/host/sdhci.c @@ -256,6 +256,9 @@ static void sdhci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios); static void sdhci_init(struct sdhci_host *host, int soft) { + if ((host->flags & SDHCI_HOST_V4_ENABLED) && !soft) + sdhci_writew(host, SDHCI_UHSII_HOST_FULL_RESET, + SDHCI_UHSII_SOFT_RESET); if (soft) sdhci_do_reset(host, SDHCI_RESET_CMD|SDHCI_RESET_DATA); else @@ -270,6 +273,17 @@ static void sdhci_init(struct sdhci_host *host, int soft) sdhci_writel(host, host->ier, SDHCI_INT_ENABLE); sdhci_writel(host, host->ier, SDHCI_SIGNAL_ENABLE); + if (host->flags & SDHCI_HOST_V4_ENABLED) { + u32 ier = SDHCI_UHSII_INT_HEADER | SDHCI_UHSII_INT_RES | + SDHCI_UHSII_INT_EXPIRED | SDHCI_UHSII_INT_CRC | + SDHCI_UHSII_INT_FRAMING | SDHCI_UHSII_INT_TID | + SDHCI_UHSII_INT_UNRECOVERABLE | SDHCI_UHSII_INT_EBSY | + SDHCI_UHSII_INT_ADMA | SDHCI_UHSII_INT_TIMEOUT; + + sdhci_writel(host, ier, SDHCI_UHSII_INT_ENABLE); + sdhci_writel(host, ier, SDHCI_UHSII_SIGNAL_ENABLE); + } + if (soft) { /* force clock reconfiguration */ host->clock = 0; @@ -2733,11 +2747,12 @@ static void sdhci_tuning_timer(unsigned long data) * * \*****************************************************************************/ -static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask, u32 *mask) +static void sdhci_cmd_irq(struct sdhci_host *host, u32 intmask, + u32 uhsii_intmask, u32 *mask) { - BUG_ON(intmask == 0); + BUG_ON(!intmask && !uhsii_intmask); - if (!host->cmd) { + if (!host->cmd && !host->tlp) { pr_err("%s: Got command interrupt 0x%08x even " "though no command operation was in progress.\n", mmc_hostname(host->mmc), (unsigned)intmask); @@ -2960,6 +2975,7 @@ static irqreturn_t sdhci_irq(int irq, void *dev_id) irqreturn_t result = IRQ_NONE; struct sdhci_host *host = dev_id; u32 intmask, mask, unexpected = 0; + u32 uhsii_intmask = 0; int max_loops = 16; spin_lock(&host->lock); @@ -2970,7 +2986,12 @@ static irqreturn_t sdhci_irq(int irq, void *dev_id) } intmask = sdhci_readl(host, SDHCI_INT_STATUS); - if (!intmask || intmask == 0xffffffff) { + + if (host->flags & SDHCI_HOST_V4_ENABLED) + uhsii_intmask = sdhci_readl(host, SDHCI_UHSII_INT_STATUS); + + if ((!intmask || intmask == 0xffffffff) && + (!uhsii_intmask || uhsii_intmask == 0xffffffff)) { result = IRQ_NONE; goto out; } @@ -3014,9 +3035,13 @@ static irqreturn_t sdhci_irq(int irq, void *dev_id) result = IRQ_WAKE_THREAD; } + if (uhsii_intmask) + sdhci_writel(host, uhsii_intmask, + SDHCI_UHSII_INT_STATUS); + if (intmask & SDHCI_INT_CMD_MASK) sdhci_cmd_irq(host, intmask & SDHCI_INT_CMD_MASK, - &intmask); + uhsii_intmask, &intmask); if (intmask & SDHCI_INT_DATA_MASK) sdhci_data_irq(host, intmask & SDHCI_INT_DATA_MASK); @@ -3340,7 +3365,7 @@ int sdhci_add_host(struct sdhci_host *host) host->version = sdhci_readw(host, SDHCI_HOST_VERSION); host->version = (host->version & SDHCI_SPEC_VER_MASK) >> SDHCI_SPEC_VER_SHIFT; - if (host->version > SDHCI_SPEC_300) { + if (host->version > SDHCI_SPEC_400) { pr_err("%s: Unknown controller version (%d). " "You may experience problems.\n", mmc_hostname(mmc), host->version); @@ -3598,6 +3623,9 @@ int sdhci_add_host(struct sdhci_host *host) caps[1] &= ~(SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 | SDHCI_SUPPORT_DDR50); + if (!(caps[1] & SDHCI_CAN_VDD2_180)) + caps[1] &= ~SDHCI_SUPPORT_UHSII; + /* Any UHS-I mode in caps implies SDR12 and SDR25 support. */ if (caps[1] & (SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 | SDHCI_SUPPORT_DDR50)) @@ -3628,6 +3656,64 @@ int sdhci_add_host(struct sdhci_host *host) !(host->quirks2 & SDHCI_QUIRK2_BROKEN_DDR50)) mmc->caps |= MMC_CAP_UHS_DDR50; + if (caps[1] & SDHCI_SUPPORT_UHSII) { + u32 uhsii_caps; + u16 ctrl2; + + /* Set Host Version 4.00 Enable */ + ctrl2 = sdhci_readw(host, SDHCI_HOST_CONTROL2); + ctrl2 |= SDHCI_CTRL_HOST_V4_ENABLE; + sdhci_writew(host, ctrl2, SDHCI_HOST_CONTROL2); + host->flags |= SDHCI_HOST_V4_ENABLED; + + host->uhsii_settings_ptr = sdhci_readw(host, + SDHCI_UHSII_SETTINGS_PTR); + host->uhsii_caps_ptr = sdhci_readw(host, + SDHCI_UHSII_HOST_CAPS_PTR); + + uhsii_caps = sdhci_readl(host, + host->uhsii_caps_ptr + SDHCI_UHSII_GENERAL_REG); + + host->lane_mode = (uhsii_caps & SDHCI_UHSII_LANES_MASK) >> + SDHCI_UHSII_LANES_SHIFT; + host->max_gap = (uhsii_caps & SDHCI_UHSII_GAP_MASK) >> + SDHCI_UHSII_GAP_SHIFT; + host->max_dap = (uhsii_caps & SDHCI_UHSII_DAP_MASK) >> + SDHCI_UHSII_DAP_SHIFT; + DBG("lane_mode: 0x%x, max_gap: 0x%x, max_dap: 0x%x\n", + host->lane_mode, host->max_gap, host->max_dap); + + uhsii_caps = sdhci_readl(host, + host->uhsii_caps_ptr + SDHCI_UHSII_PHY_REG); + + host->n_lss_dir = (uhsii_caps & SDHCI_UHSII_LSS_DIR_MASK) >> + SDHCI_UHSII_LSS_DIR_SHIFT; + host->n_lss_syn = (uhsii_caps & SDHCI_UHSII_LSS_SYN_MASK) >> + SDHCI_UHSII_LSS_SYN_SHIFT; + host->speed_range = (uhsii_caps & SDHCI_UHSII_RANGE_MASK) >> + SDHCI_UHSII_RANGE_SHIFT; + DBG("n_lss_dir: 0x%x, n_lss_syn: 0x%x, speed_range: 0x%x\n", + host->n_lss_dir, host->n_lss_syn, host->speed_range); + + uhsii_caps = sdhci_readl(host, + host->uhsii_caps_ptr + SDHCI_UHSII_LINK_REG_L); + + host->n_fcu = (uhsii_caps & SDHCI_UHSII_N_FCU_MASK) >> + SDHCI_UHSII_N_FCU_SHIFT; + DBG("n_fcu: 0x%x\n", host->n_fcu); + + uhsii_caps = sdhci_readl(host, + host->uhsii_caps_ptr + SDHCI_UHSII_LINK_REG_H); + + host->n_data_gap = uhsii_caps & SDHCI_UHSII_DATA_GAP_MASK; + DBG("n_data_gap: 0x%x\n", host->n_data_gap); + + mmc->caps |= MMC_CAP_UHSII; + + if (host->speed_range == SDHCI_UHSII_RANGE_AB) + mmc->caps2 |= MMC_CAP2_UHSII_RANGE_AB; + } + /* Does the host need tuning for SDR50? */ if (caps[1] & SDHCI_USE_SDR50_TUNING) host->flags |= SDHCI_SDR50_NEEDS_TUNING; @@ -3644,6 +3730,16 @@ int sdhci_add_host(struct sdhci_host *host) if (caps[1] & SDHCI_DRIVER_TYPE_D) mmc->caps |= MMC_CAP_DRIVER_TYPE_D; + if (host->version == SDHCI_SPEC_400) { + mmc->lane_mode = host->lane_mode; + mmc->max_gap = host->max_gap; + mmc->max_dap = host->max_dap; + mmc->n_lss_dir = host->n_lss_dir; + mmc->n_lss_syn = host->n_lss_syn; + mmc->n_data_gap = host->n_data_gap; + mmc->n_fcu = host->n_fcu; + } + /* Initial value for re-tuning timer count */ host->tuning_count = (caps[1] & SDHCI_RETUNING_TIMER_COUNT_MASK) >> SDHCI_RETUNING_TIMER_COUNT_SHIFT; -- 1.9.1 -- To unsubscribe from this list: send the line "unsubscribe linux-mmc" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html