mmc: esdhc: Fix bug when writing to SDHCI_HOST_CONTROL register

The P2020 has a non-standard implementation of the SDHCI_HOST_CONTROL
register. This patch adds a QUIRK in the SDHCI header to signal that
a host controller has a non-standard SDHCI_HOST_CONTROL register. The
patch adds a check to the function esdhc_writeb in file
sdhci-of-esdhc.c, where it checks if the write is done to the
SDHCI_HOST_CONTROL register and th host has the above mentioned QUIRK,
then the function simply returns instead of writing to the register.
The patch also detects if the processor is P2020 (by looking in dev
tree) and if so, adds the QUIRK to the host->quirk2

Signed-off-by: Oded Gabbay <ogabbay@advaoptical.com>
Reviewed-by: Anton Vorontsov <anton@enomsg.org>
Signed-off-by: Chris Ball <cjb@laptop.org>

2 files changed, 19 insertions, 0 deletions

diff --git a/drivers/mmc/host/sdhci-of-esdhc.c b/drivers/mmc/host/sdhci-of-esdhc.c
index b2a635e73aee..15039e2d1c12 100644
--- a/drivers/mmc/host/sdhci-of-esdhc.c
+++ b/drivers/mmc/host/sdhci-of-esdhc.c
@@ -121,6 +121,13 @@ static void esdhc_writeb(struct sdhci_host *host, u8 val, int reg)
         if (reg == SDHCI_HOST_CONTROL) {
                 u32 dma_bits;
 
+                /*
+                 * If host control register is not standard, exit
+                 * this function
+                 */
+                if (host->quirks2 & SDHCI_QUIRK2_BROKEN_HOST_CONTROL)
+                        return;
+
                 /* DMA select is 22,23 bits in Protocol Control Register */
                 dma_bits = (val & SDHCI_CTRL_DMA_MASK) << 5;
                 clrsetbits_be32(host->ioaddr + reg , SDHCI_CTRL_DMA_MASK << 5,
@@ -289,6 +296,7 @@ static const struct sdhci_pltfm_data sdhci_esdhc_pdata = {
 static int sdhci_esdhc_probe(struct platform_device *pdev)
 {
         struct sdhci_host *host;
+        struct device_node *np;
         int ret;
 
         host = sdhci_pltfm_init(pdev, &sdhci_esdhc_pdata, 0);
@@ -297,6 +305,15 @@ static int sdhci_esdhc_probe(struct platform_device *pdev)
 
         sdhci_get_of_property(pdev);
 
+        np = pdev->dev.of_node;
+        if (of_device_is_compatible(np, "fsl,p2020-esdhc")) {
+                /*
+                 * Freescale messed up with P2020 as it has a non-standard
+                 * host control register
+                 */
+                host->quirks2 |= SDHCI_QUIRK2_BROKEN_HOST_CONTROL;
+        }
+
         /* call to generic mmc_of_parse to support additional capabilities */
         mmc_of_parse(host->mmc);
 
diff --git a/include/linux/mmc/sdhci.h b/include/linux/mmc/sdhci.h
index a74518009099..e3c6a74d980a 100644
--- a/include/linux/mmc/sdhci.h
+++ b/include/linux/mmc/sdhci.h
@@ -96,6 +96,8 @@ struct sdhci_host {
 #define SDHCI_QUIRK2_NO_1_8_V                           (1<<2)
 #define SDHCI_QUIRK2_PRESET_VALUE_BROKEN                (1<<3)
 #define SDHCI_QUIRK2_CARD_ON_NEEDS_BUS_ON               (1<<4)
+/* Controller has a non-standard host control register */
+#define SDHCI_QUIRK2_BROKEN_HOST_CONTROL                (1<<5)
 
         int irq;                /* Device IRQ */
         void __iomem *ioaddr;   /* Mapped address */