Add O2Micro/BayHubTech SD Host DeviceId 8520 support and specified Init.
Apply SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12 for SD Host Controller.
Apply SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC for SD Host Controller.

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

diff --git a/drivers/mmc/host/sdhci-pci.c b/drivers/mmc/host/sdhci-pci.c
index d7d6bc8..b0611f0 100644
--- a/drivers/mmc/host/sdhci-pci.c
+++ b/drivers/mmc/host/sdhci-pci.c
@@ -364,11 +364,155 @@ 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
+
+#define PCI_DEVICE_ID_FUJIN2           0x8520
+
+static void o2_host_pci_init(struct sdhci_pci_chip *chip)
+{
+       u32 scratch_32;
+       int ret;
+       /* Improve write performance for SD3.0 */
+       ret = pci_read_config_dword(chip->pdev, 0x88, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~((1 << 12) | (1 << 13) | (1 << 14));
+       pci_write_config_dword(chip->pdev, 0x88, scratch_32);
+
+
+       /* Enable Link abnormal reset generating Reset */
+       ret = pci_read_config_dword(chip->pdev, 0x64, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~((1 << 19) | (1 << 11));
+       scratch_32 |= (1 << 10);
+       pci_write_config_dword(chip->pdev, 0x64, scratch_32);
+
+       /* set card power over current protection       */
+       ret = pci_read_config_dword(chip->pdev, 0xd4, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 |= (1 << 4);
+       pci_write_config_dword(chip->pdev, 0xd4, scratch_32);
+
+       /* Set timeout CLK */
+       ret = pci_read_config_dword(chip->pdev,
+                               O2_SD_CLK_SETTING, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~(0xFF00);
+       scratch_32 |= 0x07E0C800;
+       pci_write_config_dword(chip->pdev,
+                               O2_SD_CLK_SETTING, scratch_32);
+
+       /* adjust the output delay for SD mode */
+       pci_write_config_dword(chip->pdev, 0x350, 0x00002492);
+
+       /* Set the output voltage setting of Aux 1.2v LDO */
+       ret = pci_read_config_dword(chip->pdev,
+                               0x68, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~(3 << 12);
+       pci_write_config_dword(chip->pdev,
+                               0x68, scratch_32);
+
+       /* Set Max power supply capability of SD host */
+       ret = pci_read_config_dword(chip->pdev,
+                               0x334, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~(0x01FE);
+       scratch_32 |= 0x00CC;
+       pci_write_config_dword(chip->pdev,
+                               0x334, scratch_32);
+       /* Set DLL Tuning Window */
+       ret = pci_read_config_dword(chip->pdev,
+                               0x300, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~(0x000000FF);
+       scratch_32 |= 0x00000066;
+       pci_write_config_dword(chip->pdev,
+                               0x300, scratch_32);
+
+       /* Set UHS2 T_EIDLE */
+       ret = pci_read_config_dword(chip->pdev,
+                               0x35C, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~(0x000000FC);
+       scratch_32 |= 0x00000084;
+       pci_write_config_dword(chip->pdev,
+                               0x35C, scratch_32);
+
+       /* Set UHS2 Termination */
+       ret = pci_read_config_dword(chip->pdev,
+                               0x3E0, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~((1 << 21) | (1 << 30));
+
+       /* Set RTD3 function disabled */
+       scratch_32 |= ((1 << 29) | (1 << 28));
+       pci_write_config_dword(chip->pdev,
+                               0x3E0, scratch_32);
+
+       /* Set L1 Entrance Timer */
+       ret = pci_read_config_dword(chip->pdev,
+                               O2_SD_CAPS, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~(0xf0000000);
+       scratch_32 |= 0x30000000;
+       pci_write_config_dword(chip->pdev,
+                               O2_SD_CAPS, scratch_32);
+
+       ret = pci_read_config_dword(chip->pdev,
+                               0xfc, &scratch_32);
+       if (ret)
+               return;
+       scratch_32 &= ~(0x000f0000);
+       scratch_32 |= 0x00080000;
+       pci_write_config_dword(chip->pdev,
+                               0xfc, scratch_32);
+}
+
+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_FUJIN2:
+               reg = sdhci_readl(host, O2_SD_VENDOR_SETTING);
+               if (reg & 0x1)
+                       host->quirks |= SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12;
+
+               /* set dll watch dog timer      */
+               reg = sdhci_readl(host, 0x1C8);
+               reg |= (1 << 12);
+               sdhci_writel(host, reg, 0x1C8);
+
+               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 +563,52 @@ 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_FUJIN2:
+           /* 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;
+               scratch_32 &= ~(0x1F3F070E);
+               scratch_32 |= 0x18270106;
+               pci_write_config_dword(chip->pdev,
+                               O2_SD_PLL_SETTING, scratch_32);
+
+               o2_host_pci_init(chip);
+
+
+               /* Disable ADMA1/ADMA2/ADMA3*/
+               ret = pci_read_config_dword(chip->pdev, 0x330, &scratch_32);
+               if (ret)
+                       return ret;
+               scratch_32 &= ~(0xE6);
+               pci_write_config_dword(chip->pdev, 0x330, 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);
+
+
+               /* 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;
@@ -613,8 +803,18 @@ static int jmicron_resume(struct sdhci_pci_chip *chip)
        return 0;
 }
 
+static int o2_resume(struct sdhci_pci_chip *chip)
+{
+       o2_probe(chip);
+       return 0;
+}
+
+
 static const struct sdhci_pci_fixes sdhci_o2 = {
        .probe          = o2_probe,
+       .quirks         = SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC,
+       .probe_slot = o2_probe_slot,
+       .resume         = o2_resume,
 };
 
 static const struct sdhci_pci_fixes sdhci_jmicron = {
@@ -979,6 +1179,14 @@ static const struct pci_device_id pci_ids[] = {
                .driver_data    = (kernel_ulong_t)&sdhci_o2,
        },
 
+       {
+               .vendor         = PCI_VENDOR_ID_O2,
+               .device         = PCI_DEVICE_ID_FUJIN2,
+               .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