mmc: sdhci-of-esdhc: add/remove some quirks according to vendor version

A previous patch had removed esdhc_of_platform_init() by mistake.
static void esdhc_of_platform_init(struct sdhci_host *host)
{
	u32 vvn;

	vvn = in_be32(host->ioaddr + SDHCI_SLOT_INT_STATUS);
	vvn = (vvn & SDHCI_VENDOR_VER_MASK) >> SDHCI_VENDOR_VER_SHIFT;
	if (vvn == VENDOR_V_22)
		host->quirks2 |= SDHCI_QUIRK2_HOST_NO_CMD23;

	if (vvn > VENDOR_V_22)
		host->quirks &= ~SDHCI_QUIRK_NO_BUSY_IRQ;
}

This patch is used to fix it by add/remove some quirks according to
verdor version in probe.

Signed-off-by: Yangbo Lu <yangbo.lu@freescale.com>
Fixes: f4932cfd22f1 ("mmc: sdhci-of-esdhc: support both BE and LE host controller")
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>

1 files changed, 10 insertions, 0 deletions

diff --git a/drivers/mmc/host/sdhci-of-esdhc.c b/drivers/mmc/host/sdhci-of-esdhc.c
index 90e94a028a49..83b1226471c1 100644
--- a/drivers/mmc/host/sdhci-of-esdhc.c
+++ b/drivers/mmc/host/sdhci-of-esdhc.c
@@ -584,6 +584,8 @@ static int sdhci_esdhc_probe(struct platform_device *pdev)
 {
         struct sdhci_host *host;
         struct device_node *np;
+        struct sdhci_pltfm_host *pltfm_host;
+        struct sdhci_esdhc *esdhc;
         int ret;
 
         np = pdev->dev.of_node;
@@ -600,6 +602,14 @@ static int sdhci_esdhc_probe(struct platform_device *pdev)
 
         sdhci_get_of_property(pdev);
 
+        pltfm_host = sdhci_priv(host);
+        esdhc = pltfm_host->priv;
+        if (esdhc->vendor_ver == VENDOR_V_22)
+                host->quirks2 |= SDHCI_QUIRK2_HOST_NO_CMD23;
+
+        if (esdhc->vendor_ver > VENDOR_V_22)
+                host->quirks &= ~SDHCI_QUIRK_NO_BUSY_IRQ;
+
         if (of_device_is_compatible(np, "fsl,p5040-esdhc") ||
             of_device_is_compatible(np, "fsl,p5020-esdhc") ||
             of_device_is_compatible(np, "fsl,p4080-esdhc") ||