From: "peter.guo" <peter....@bayhubtech.com>

Apply SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12 for some SD Host Controller.
Apply SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC for some SD Host Controller.
Add O2Micro/BayHubTech SD Host Controller specified Init.

Signed-off-by: peter.guo <peter....@bayhubtech.com>
---
 drivers/mmc/host/sdhci-pci.c |  129 ++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 129 insertions(+)

diff --git a/drivers/mmc/host/sdhci-pci.c b/drivers/mmc/host/sdhci-pci.c
index d7d6bc8..cf6070f 100644
--- a/drivers/mmc/host/sdhci-pci.c
+++ b/drivers/mmc/host/sdhci-pci.c
@@ -364,11 +364,49 @@ static const struct sdhci_pci_fixes sdhci_intel_byt_sd = {
 #define O2_SD_ADMA1            0xE2
 #define O2_SD_ADMA2            0xE7
 #define O2_SD_INF_MOD          0xF1
+#define        O2_SD_PLL_SETTING       0x304
+#define        O2_SD_CLK_SETTING       0x328
+#define        O2_SD_UHS1_CAP_SETTING  0x33C
+#define        O2_SD_VENDOR_SETTING 0x110
+
+/* O2Micro SD Host Devices PCI IDs */
+#define PCI_DEVICE_ID_O2_8520          0x8520
+#define        PCI_DEVICE_ID_O2_8420           0x8420
+#define        PCI_DEVICE_ID_O2_8421           0x8421
+#define        PCI_DEVICE_ID_O2_8620           0x8620
+#define        PCI_DEVICE_ID_O2_8621           0x8621
+
+static int o2_probe_slot(struct sdhci_pci_slot *slot)
+{
+       struct sdhci_pci_chip   *chip;
+       struct sdhci_host       *host;
+       u32                     reg;
+
+       chip = slot->chip;
+       host = slot->host;
+       switch (chip->pdev->device) {
+       case PCI_DEVICE_ID_O2_8420:
+       case PCI_DEVICE_ID_O2_8421:
+       case PCI_DEVICE_ID_O2_8520:
+       case PCI_DEVICE_ID_O2_8620:
+       case PCI_DEVICE_ID_O2_8621:
+               reg = sdhci_readl(host, O2_SD_VENDOR_SETTING);
+               if (reg & 0x1)
+                       host->quirks |= SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12;
+
+               break;
+       default:
+               break;
+       }
+
+       return 0;
+}
 
 static int o2_probe(struct sdhci_pci_chip *chip)
 {
        int ret;
        u8 scratch;
+       u32 scratch_32;
 
        switch (chip->pdev->device) {
        case PCI_DEVICE_ID_O2_8220:
@@ -419,6 +457,59 @@ static int o2_probe(struct sdhci_pci_chip *chip)
                        return ret;
                scratch |= 0x80;
                pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch);
+               break;
+
+       case PCI_DEVICE_ID_O2_8420:
+       case PCI_DEVICE_ID_O2_8421:
+       case PCI_DEVICE_ID_O2_8520:
+       case PCI_DEVICE_ID_O2_8620:
+       case PCI_DEVICE_ID_O2_8621:
+           /* UnLock WP */
+               ret = pci_read_config_byte(chip->pdev, O2_SD_LOCK_WP, &scratch);
+               if (ret)
+                       return ret;
+               scratch &= 0x7f;
+               pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch);
+
+               ret = pci_read_config_dword(chip->pdev,
+                               O2_SD_PLL_SETTING, &scratch_32);
+               if (ret)
+                       return ret;
+               /* Set timeout CLK */
+               ret = pci_read_config_dword(chip->pdev,
+                               O2_SD_CLK_SETTING, &scratch_32);
+               if (ret)
+                       return ret;
+               scratch_32 |= 0x07E00000;
+               pci_write_config_dword(chip->pdev,
+                               O2_SD_CLK_SETTING, scratch_32);
+
+               ret = pci_read_config_dword(chip->pdev,
+                               O2_SD_CLKREQ, &scratch_32);
+               if (ret)
+                       return ret;
+               scratch_32 |= 0x3;
+               pci_write_config_dword(chip->pdev, O2_SD_CLKREQ, scratch_32);
+               if (chip->pdev->device == PCI_DEVICE_ID_O2_8520) {
+
+                       ret = pci_read_config_dword(chip->pdev,
+                               O2_SD_UHS1_CAP_SETTING, &scratch_32);
+                       if (ret)
+                               return ret;
+                       scratch_32 |= (1 << 21);
+                       pci_write_config_dword(chip->pdev,
+                               O2_SD_UHS1_CAP_SETTING, scratch_32);
+               }
+
+               /* Lock WP */
+               ret = pci_read_config_byte(chip->pdev,
+                               O2_SD_LOCK_WP, &scratch);
+               if (ret)
+                       return ret;
+               scratch |= 0x80;
+               pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch);
+
+               break;
        }
 
        return 0;
@@ -615,6 +706,8 @@ static int jmicron_resume(struct sdhci_pci_chip *chip)
 
 static const struct sdhci_pci_fixes sdhci_o2 = {
        .probe          = o2_probe,
+       .quirks         = SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC,
+       .probe_slot = o2_probe_slot,
 };
 
 static const struct sdhci_pci_fixes sdhci_jmicron = {
@@ -979,6 +1072,42 @@ static const struct pci_device_id pci_ids[] = {
                .driver_data    = (kernel_ulong_t)&sdhci_o2,
        },
 
+       {
+               .vendor         = PCI_VENDOR_ID_O2,
+               .device         = PCI_DEVICE_ID_O2_8520,
+               .subvendor      = PCI_ANY_ID,
+               .subdevice      = PCI_ANY_ID,
+               .driver_data    = (kernel_ulong_t)&sdhci_o2,
+       },
+       {
+               .vendor         = PCI_VENDOR_ID_O2,
+               .device         = PCI_DEVICE_ID_O2_8420,
+               .subvendor      = PCI_ANY_ID,
+               .subdevice      = PCI_ANY_ID,
+               .driver_data    = (kernel_ulong_t)&sdhci_o2,
+       },
+       {
+               .vendor         = PCI_VENDOR_ID_O2,
+               .device         = PCI_DEVICE_ID_O2_8421,
+               .subvendor      = PCI_ANY_ID,
+               .subdevice      = PCI_ANY_ID,
+               .driver_data    = (kernel_ulong_t)&sdhci_o2,
+       },
+       {
+               .vendor         = PCI_VENDOR_ID_O2,
+               .device         = PCI_DEVICE_ID_O2_8620,
+               .subvendor      = PCI_ANY_ID,
+               .subdevice      = PCI_ANY_ID,
+               .driver_data    = (kernel_ulong_t)&sdhci_o2,
+       },
+       {
+               .vendor         = PCI_VENDOR_ID_O2,
+               .device         = PCI_DEVICE_ID_O2_8621,
+               .subvendor      = PCI_ANY_ID,
+               .subdevice      = PCI_ANY_ID,
+               .driver_data    = (kernel_ulong_t)&sdhci_o2,
+       },
+
        {       /* Generic SD host controller */
                PCI_DEVICE_CLASS((PCI_CLASS_SYSTEM_SDHCI << 8), 0xFFFF00)
        },
-- 
1.7.9.5

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to