1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2013 BayHub Technology Ltd. 4 * 5 * Authors: Peter Guo <peter.guo@bayhubtech.com> 6 * Adam Lee <adam.lee@canonical.com> 7 * Ernest Zhang <ernest.zhang@bayhubtech.com> 8 */ 9 10 #include <linux/pci.h> 11 #include <linux/mmc/host.h> 12 #include <linux/mmc/mmc.h> 13 #include <linux/delay.h> 14 #include <linux/iopoll.h> 15 #include <linux/bitfield.h> 16 17 #include "sdhci.h" 18 #include "sdhci-pci.h" 19 20 /* 21 * O2Micro device registers 22 */ 23 24 #define O2_SD_MISC_REG5 0x64 25 #define O2_SD_LD0_CTRL 0x68 26 #define O2_SD_DEV_CTRL 0x88 27 #define O2_SD_LOCK_WP 0xD3 28 #define O2_SD_TEST_REG 0xD4 29 #define O2_SD_FUNC_REG0 0xDC 30 #define O2_SD_MULTI_VCC3V 0xEE 31 #define O2_SD_CLKREQ 0xEC 32 #define O2_SD_CAPS 0xE0 33 #define O2_SD_ADMA1 0xE2 34 #define O2_SD_ADMA2 0xE7 35 #define O2_SD_INF_MOD 0xF1 36 #define O2_SD_MISC_CTRL4 0xFC 37 #define O2_SD_MISC_CTRL 0x1C0 38 #define O2_SD_PWR_FORCE_L0 0x0002 39 #define O2_SD_TUNING_CTRL 0x300 40 #define O2_SD_PLL_SETTING 0x304 41 #define O2_SD_MISC_SETTING 0x308 42 #define O2_SD_CLK_SETTING 0x328 43 #define O2_SD_CAP_REG2 0x330 44 #define O2_SD_CAP_REG0 0x334 45 #define O2_SD_UHS1_CAP_SETTING 0x33C 46 #define O2_SD_DELAY_CTRL 0x350 47 #define O2_SD_OUTPUT_CLK_SOURCE_SWITCH 0x354 48 #define O2_SD_UHS2_L1_CTRL 0x35C 49 #define O2_SD_FUNC_REG3 0x3E0 50 #define O2_SD_FUNC_REG4 0x3E4 51 #define O2_SD_LED_ENABLE BIT(6) 52 #define O2_SD_FREG0_LEDOFF BIT(13) 53 #define O2_SD_SEL_DLL BIT(16) 54 #define O2_SD_FREG4_ENABLE_CLK_SET BIT(22) 55 #define O2_SD_PHASE_MASK GENMASK(23, 20) 56 #define O2_SD_FIX_PHASE FIELD_PREP(O2_SD_PHASE_MASK, 0x9) 57 58 #define O2_SD_VENDOR_SETTING 0x110 59 #define O2_SD_VENDOR_SETTING2 0x1C8 60 #define O2_SD_HW_TUNING_DISABLE BIT(4) 61 62 #define O2_PLL_DLL_WDT_CONTROL1 0x1CC 63 #define O2_PLL_FORCE_ACTIVE BIT(18) 64 #define O2_PLL_LOCK_STATUS BIT(14) 65 #define O2_PLL_SOFT_RESET BIT(12) 66 #define O2_DLL_LOCK_STATUS BIT(11) 67 68 #define O2_SD_DETECT_SETTING 0x324 69 70 static const u32 dmdn_table[] = {0x2B1C0000, 71 0x2C1A0000, 0x371B0000, 0x35100000}; 72 #define DMDN_SZ ARRAY_SIZE(dmdn_table) 73 74 struct o2_host { 75 u8 dll_adjust_count; 76 }; 77 78 static void sdhci_o2_wait_card_detect_stable(struct sdhci_host *host) 79 { 80 ktime_t timeout; 81 u32 scratch32; 82 83 /* Wait max 50 ms */ 84 timeout = ktime_add_ms(ktime_get(), 50); 85 while (1) { 86 bool timedout = ktime_after(ktime_get(), timeout); 87 88 scratch32 = sdhci_readl(host, SDHCI_PRESENT_STATE); 89 if ((scratch32 & SDHCI_CARD_PRESENT) >> SDHCI_CARD_PRES_SHIFT 90 == (scratch32 & SDHCI_CD_LVL) >> SDHCI_CD_LVL_SHIFT) 91 break; 92 93 if (timedout) { 94 pr_err("%s: Card Detect debounce never finished.\n", 95 mmc_hostname(host->mmc)); 96 sdhci_dumpregs(host); 97 return; 98 } 99 udelay(10); 100 } 101 } 102 103 static void sdhci_o2_enable_internal_clock(struct sdhci_host *host) 104 { 105 ktime_t timeout; 106 u16 scratch; 107 u32 scratch32; 108 109 /* PLL software reset */ 110 scratch32 = sdhci_readl(host, O2_PLL_DLL_WDT_CONTROL1); 111 scratch32 |= O2_PLL_SOFT_RESET; 112 sdhci_writel(host, scratch32, O2_PLL_DLL_WDT_CONTROL1); 113 udelay(1); 114 scratch32 &= ~(O2_PLL_SOFT_RESET); 115 sdhci_writel(host, scratch32, O2_PLL_DLL_WDT_CONTROL1); 116 117 /* PLL force active */ 118 scratch32 |= O2_PLL_FORCE_ACTIVE; 119 sdhci_writel(host, scratch32, O2_PLL_DLL_WDT_CONTROL1); 120 121 /* Wait max 20 ms */ 122 timeout = ktime_add_ms(ktime_get(), 20); 123 while (1) { 124 bool timedout = ktime_after(ktime_get(), timeout); 125 126 scratch = sdhci_readw(host, O2_PLL_DLL_WDT_CONTROL1); 127 if (scratch & O2_PLL_LOCK_STATUS) 128 break; 129 if (timedout) { 130 pr_err("%s: Internal clock never stabilised.\n", 131 mmc_hostname(host->mmc)); 132 sdhci_dumpregs(host); 133 goto out; 134 } 135 udelay(10); 136 } 137 138 /* Wait for card detect finish */ 139 udelay(1); 140 sdhci_o2_wait_card_detect_stable(host); 141 142 out: 143 /* Cancel PLL force active */ 144 scratch32 = sdhci_readl(host, O2_PLL_DLL_WDT_CONTROL1); 145 scratch32 &= ~O2_PLL_FORCE_ACTIVE; 146 sdhci_writel(host, scratch32, O2_PLL_DLL_WDT_CONTROL1); 147 } 148 149 static int sdhci_o2_get_cd(struct mmc_host *mmc) 150 { 151 struct sdhci_host *host = mmc_priv(mmc); 152 153 if (!(sdhci_readw(host, O2_PLL_DLL_WDT_CONTROL1) & O2_PLL_LOCK_STATUS)) 154 sdhci_o2_enable_internal_clock(host); 155 else 156 sdhci_o2_wait_card_detect_stable(host); 157 158 return !!(sdhci_readl(host, SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT); 159 } 160 161 static void o2_pci_set_baseclk(struct sdhci_pci_chip *chip, u32 value) 162 { 163 u32 scratch_32; 164 165 pci_read_config_dword(chip->pdev, 166 O2_SD_PLL_SETTING, &scratch_32); 167 168 scratch_32 &= 0x0000FFFF; 169 scratch_32 |= value; 170 171 pci_write_config_dword(chip->pdev, 172 O2_SD_PLL_SETTING, scratch_32); 173 } 174 175 static u32 sdhci_o2_pll_dll_wdt_control(struct sdhci_host *host) 176 { 177 return sdhci_readl(host, O2_PLL_DLL_WDT_CONTROL1); 178 } 179 180 /* 181 * This function is used to detect dll lock status. 182 * Since the dll lock status bit will toggle randomly 183 * with very short interval which needs to be polled 184 * as fast as possible. Set sleep_us as 1 microsecond. 185 */ 186 static int sdhci_o2_wait_dll_detect_lock(struct sdhci_host *host) 187 { 188 u32 scratch32 = 0; 189 190 return readx_poll_timeout(sdhci_o2_pll_dll_wdt_control, host, 191 scratch32, !(scratch32 & O2_DLL_LOCK_STATUS), 1, 1000000); 192 } 193 194 static void sdhci_o2_set_tuning_mode(struct sdhci_host *host) 195 { 196 u16 reg; 197 198 /* enable hardware tuning */ 199 reg = sdhci_readw(host, O2_SD_VENDOR_SETTING); 200 reg &= ~O2_SD_HW_TUNING_DISABLE; 201 sdhci_writew(host, reg, O2_SD_VENDOR_SETTING); 202 } 203 204 static void __sdhci_o2_execute_tuning(struct sdhci_host *host, u32 opcode) 205 { 206 int i; 207 208 sdhci_send_tuning(host, opcode); 209 210 for (i = 0; i < 150; i++) { 211 u16 ctrl = sdhci_readw(host, SDHCI_HOST_CONTROL2); 212 213 if (!(ctrl & SDHCI_CTRL_EXEC_TUNING)) { 214 if (ctrl & SDHCI_CTRL_TUNED_CLK) { 215 host->tuning_done = true; 216 return; 217 } 218 pr_warn("%s: HW tuning failed !\n", 219 mmc_hostname(host->mmc)); 220 break; 221 } 222 223 mdelay(1); 224 } 225 226 pr_info("%s: Tuning failed, falling back to fixed sampling clock\n", 227 mmc_hostname(host->mmc)); 228 sdhci_reset_tuning(host); 229 } 230 231 /* 232 * This function is used to fix o2 dll shift issue. 233 * It isn't necessary to detect card present before recovery. 234 * Firstly, it is used by bht emmc card, which is embedded. 235 * Second, before call recovery card present will be detected 236 * outside of the execute tuning function. 237 */ 238 static int sdhci_o2_dll_recovery(struct sdhci_host *host) 239 { 240 int ret = 0; 241 u8 scratch_8 = 0; 242 u32 scratch_32 = 0; 243 struct sdhci_pci_slot *slot = sdhci_priv(host); 244 struct sdhci_pci_chip *chip = slot->chip; 245 struct o2_host *o2_host = sdhci_pci_priv(slot); 246 247 /* UnLock WP */ 248 pci_read_config_byte(chip->pdev, 249 O2_SD_LOCK_WP, &scratch_8); 250 scratch_8 &= 0x7f; 251 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch_8); 252 while (o2_host->dll_adjust_count < DMDN_SZ && !ret) { 253 /* Disable clock */ 254 sdhci_writeb(host, 0, SDHCI_CLOCK_CONTROL); 255 256 /* PLL software reset */ 257 scratch_32 = sdhci_readl(host, O2_PLL_DLL_WDT_CONTROL1); 258 scratch_32 |= O2_PLL_SOFT_RESET; 259 sdhci_writel(host, scratch_32, O2_PLL_DLL_WDT_CONTROL1); 260 261 pci_read_config_dword(chip->pdev, 262 O2_SD_FUNC_REG4, 263 &scratch_32); 264 /* Enable Base Clk setting change */ 265 scratch_32 |= O2_SD_FREG4_ENABLE_CLK_SET; 266 pci_write_config_dword(chip->pdev, O2_SD_FUNC_REG4, scratch_32); 267 o2_pci_set_baseclk(chip, dmdn_table[o2_host->dll_adjust_count]); 268 269 /* Enable internal clock */ 270 scratch_8 = SDHCI_CLOCK_INT_EN; 271 sdhci_writeb(host, scratch_8, SDHCI_CLOCK_CONTROL); 272 273 if (sdhci_o2_get_cd(host->mmc)) { 274 /* 275 * need wait at least 5ms for dll status stable, 276 * after enable internal clock 277 */ 278 usleep_range(5000, 6000); 279 if (sdhci_o2_wait_dll_detect_lock(host)) { 280 scratch_8 |= SDHCI_CLOCK_CARD_EN; 281 sdhci_writeb(host, scratch_8, 282 SDHCI_CLOCK_CONTROL); 283 ret = 1; 284 } else { 285 pr_warn("%s: DLL unlocked when dll_adjust_count is %d.\n", 286 mmc_hostname(host->mmc), 287 o2_host->dll_adjust_count); 288 } 289 } else { 290 pr_err("%s: card present detect failed.\n", 291 mmc_hostname(host->mmc)); 292 break; 293 } 294 295 o2_host->dll_adjust_count++; 296 } 297 if (!ret && o2_host->dll_adjust_count == DMDN_SZ) 298 pr_err("%s: DLL adjust over max times\n", 299 mmc_hostname(host->mmc)); 300 /* Lock WP */ 301 pci_read_config_byte(chip->pdev, 302 O2_SD_LOCK_WP, &scratch_8); 303 scratch_8 |= 0x80; 304 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch_8); 305 return ret; 306 } 307 308 static int sdhci_o2_execute_tuning(struct mmc_host *mmc, u32 opcode) 309 { 310 struct sdhci_host *host = mmc_priv(mmc); 311 struct sdhci_pci_slot *slot = sdhci_priv(host); 312 struct sdhci_pci_chip *chip = slot->chip; 313 int current_bus_width = 0; 314 u32 scratch32 = 0; 315 u16 scratch = 0; 316 u8 scratch_8 = 0; 317 u32 reg_val; 318 319 /* 320 * This handler implements the hardware tuning that is specific to 321 * this controller. Fall back to the standard method for other TIMING. 322 */ 323 if ((host->timing != MMC_TIMING_MMC_HS200) && 324 (host->timing != MMC_TIMING_UHS_SDR104) && 325 (host->timing != MMC_TIMING_UHS_SDR50)) 326 return sdhci_execute_tuning(mmc, opcode); 327 328 if (WARN_ON((opcode != MMC_SEND_TUNING_BLOCK_HS200) && 329 (opcode != MMC_SEND_TUNING_BLOCK))) 330 return -EINVAL; 331 332 /* Force power mode enter L0 */ 333 scratch = sdhci_readw(host, O2_SD_MISC_CTRL); 334 scratch |= O2_SD_PWR_FORCE_L0; 335 sdhci_writew(host, scratch, O2_SD_MISC_CTRL); 336 337 /* Stop clk */ 338 reg_val = sdhci_readw(host, SDHCI_CLOCK_CONTROL); 339 reg_val &= ~SDHCI_CLOCK_CARD_EN; 340 sdhci_writew(host, reg_val, SDHCI_CLOCK_CONTROL); 341 342 /* UnLock WP */ 343 pci_read_config_byte(chip->pdev, O2_SD_LOCK_WP, &scratch_8); 344 scratch_8 &= 0x7f; 345 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch_8); 346 347 /* Set pcr 0x354[16] to choose dll clock, and set the default phase */ 348 pci_read_config_dword(chip->pdev, O2_SD_OUTPUT_CLK_SOURCE_SWITCH, ®_val); 349 reg_val &= ~(O2_SD_SEL_DLL | O2_SD_PHASE_MASK); 350 reg_val |= (O2_SD_SEL_DLL | O2_SD_FIX_PHASE); 351 pci_write_config_dword(chip->pdev, O2_SD_OUTPUT_CLK_SOURCE_SWITCH, reg_val); 352 353 /* Lock WP */ 354 pci_read_config_byte(chip->pdev, O2_SD_LOCK_WP, &scratch_8); 355 scratch_8 |= 0x80; 356 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch_8); 357 358 /* Start clk */ 359 reg_val = sdhci_readw(host, SDHCI_CLOCK_CONTROL); 360 reg_val |= SDHCI_CLOCK_CARD_EN; 361 sdhci_writew(host, reg_val, SDHCI_CLOCK_CONTROL); 362 363 /* wait DLL lock, timeout value 5ms */ 364 if (readx_poll_timeout(sdhci_o2_pll_dll_wdt_control, host, 365 scratch32, (scratch32 & O2_DLL_LOCK_STATUS), 1, 5000)) 366 pr_warn("%s: DLL can't lock in 5ms after force L0 during tuning.\n", 367 mmc_hostname(host->mmc)); 368 /* 369 * Judge the tuning reason, whether caused by dll shift 370 * If cause by dll shift, should call sdhci_o2_dll_recovery 371 */ 372 if (!sdhci_o2_wait_dll_detect_lock(host)) 373 if (!sdhci_o2_dll_recovery(host)) { 374 pr_err("%s: o2 dll recovery failed\n", 375 mmc_hostname(host->mmc)); 376 return -EINVAL; 377 } 378 /* 379 * o2 sdhci host didn't support 8bit emmc tuning 380 */ 381 if (mmc->ios.bus_width == MMC_BUS_WIDTH_8) { 382 current_bus_width = mmc->ios.bus_width; 383 mmc->ios.bus_width = MMC_BUS_WIDTH_4; 384 sdhci_set_bus_width(host, MMC_BUS_WIDTH_4); 385 } 386 387 sdhci_o2_set_tuning_mode(host); 388 389 sdhci_start_tuning(host); 390 391 __sdhci_o2_execute_tuning(host, opcode); 392 393 sdhci_end_tuning(host); 394 395 if (current_bus_width == MMC_BUS_WIDTH_8) { 396 mmc->ios.bus_width = MMC_BUS_WIDTH_8; 397 sdhci_set_bus_width(host, current_bus_width); 398 } 399 400 /* Cancel force power mode enter L0 */ 401 scratch = sdhci_readw(host, O2_SD_MISC_CTRL); 402 scratch &= ~(O2_SD_PWR_FORCE_L0); 403 sdhci_writew(host, scratch, O2_SD_MISC_CTRL); 404 405 sdhci_reset(host, SDHCI_RESET_CMD); 406 sdhci_reset(host, SDHCI_RESET_DATA); 407 408 host->flags &= ~SDHCI_HS400_TUNING; 409 return 0; 410 } 411 412 static void o2_pci_led_enable(struct sdhci_pci_chip *chip) 413 { 414 int ret; 415 u32 scratch_32; 416 417 /* Set led of SD host function enable */ 418 ret = pci_read_config_dword(chip->pdev, 419 O2_SD_FUNC_REG0, &scratch_32); 420 if (ret) 421 return; 422 423 scratch_32 &= ~O2_SD_FREG0_LEDOFF; 424 pci_write_config_dword(chip->pdev, 425 O2_SD_FUNC_REG0, scratch_32); 426 427 ret = pci_read_config_dword(chip->pdev, 428 O2_SD_TEST_REG, &scratch_32); 429 if (ret) 430 return; 431 432 scratch_32 |= O2_SD_LED_ENABLE; 433 pci_write_config_dword(chip->pdev, 434 O2_SD_TEST_REG, scratch_32); 435 } 436 437 static void sdhci_pci_o2_fujin2_pci_init(struct sdhci_pci_chip *chip) 438 { 439 u32 scratch_32; 440 int ret; 441 /* Improve write performance for SD3.0 */ 442 ret = pci_read_config_dword(chip->pdev, O2_SD_DEV_CTRL, &scratch_32); 443 if (ret) 444 return; 445 scratch_32 &= ~((1 << 12) | (1 << 13) | (1 << 14)); 446 pci_write_config_dword(chip->pdev, O2_SD_DEV_CTRL, scratch_32); 447 448 /* Enable Link abnormal reset generating Reset */ 449 ret = pci_read_config_dword(chip->pdev, O2_SD_MISC_REG5, &scratch_32); 450 if (ret) 451 return; 452 scratch_32 &= ~((1 << 19) | (1 << 11)); 453 scratch_32 |= (1 << 10); 454 pci_write_config_dword(chip->pdev, O2_SD_MISC_REG5, scratch_32); 455 456 /* set card power over current protection */ 457 ret = pci_read_config_dword(chip->pdev, O2_SD_TEST_REG, &scratch_32); 458 if (ret) 459 return; 460 scratch_32 |= (1 << 4); 461 pci_write_config_dword(chip->pdev, O2_SD_TEST_REG, scratch_32); 462 463 /* adjust the output delay for SD mode */ 464 pci_write_config_dword(chip->pdev, O2_SD_DELAY_CTRL, 0x00002492); 465 466 /* Set the output voltage setting of Aux 1.2v LDO */ 467 ret = pci_read_config_dword(chip->pdev, O2_SD_LD0_CTRL, &scratch_32); 468 if (ret) 469 return; 470 scratch_32 &= ~(3 << 12); 471 pci_write_config_dword(chip->pdev, O2_SD_LD0_CTRL, scratch_32); 472 473 /* Set Max power supply capability of SD host */ 474 ret = pci_read_config_dword(chip->pdev, O2_SD_CAP_REG0, &scratch_32); 475 if (ret) 476 return; 477 scratch_32 &= ~(0x01FE); 478 scratch_32 |= 0x00CC; 479 pci_write_config_dword(chip->pdev, O2_SD_CAP_REG0, scratch_32); 480 /* Set DLL Tuning Window */ 481 ret = pci_read_config_dword(chip->pdev, 482 O2_SD_TUNING_CTRL, &scratch_32); 483 if (ret) 484 return; 485 scratch_32 &= ~(0x000000FF); 486 scratch_32 |= 0x00000066; 487 pci_write_config_dword(chip->pdev, O2_SD_TUNING_CTRL, scratch_32); 488 489 /* Set UHS2 T_EIDLE */ 490 ret = pci_read_config_dword(chip->pdev, 491 O2_SD_UHS2_L1_CTRL, &scratch_32); 492 if (ret) 493 return; 494 scratch_32 &= ~(0x000000FC); 495 scratch_32 |= 0x00000084; 496 pci_write_config_dword(chip->pdev, O2_SD_UHS2_L1_CTRL, scratch_32); 497 498 /* Set UHS2 Termination */ 499 ret = pci_read_config_dword(chip->pdev, O2_SD_FUNC_REG3, &scratch_32); 500 if (ret) 501 return; 502 scratch_32 &= ~((1 << 21) | (1 << 30)); 503 504 pci_write_config_dword(chip->pdev, O2_SD_FUNC_REG3, scratch_32); 505 506 /* Set L1 Entrance Timer */ 507 ret = pci_read_config_dword(chip->pdev, O2_SD_CAPS, &scratch_32); 508 if (ret) 509 return; 510 scratch_32 &= ~(0xf0000000); 511 scratch_32 |= 0x30000000; 512 pci_write_config_dword(chip->pdev, O2_SD_CAPS, scratch_32); 513 514 ret = pci_read_config_dword(chip->pdev, 515 O2_SD_MISC_CTRL4, &scratch_32); 516 if (ret) 517 return; 518 scratch_32 &= ~(0x000f0000); 519 scratch_32 |= 0x00080000; 520 pci_write_config_dword(chip->pdev, O2_SD_MISC_CTRL4, scratch_32); 521 } 522 523 static void sdhci_pci_o2_enable_msi(struct sdhci_pci_chip *chip, 524 struct sdhci_host *host) 525 { 526 int ret; 527 528 ret = pci_find_capability(chip->pdev, PCI_CAP_ID_MSI); 529 if (!ret) { 530 pr_info("%s: unsupported MSI, use INTx irq\n", 531 mmc_hostname(host->mmc)); 532 return; 533 } 534 535 ret = pci_alloc_irq_vectors(chip->pdev, 1, 1, 536 PCI_IRQ_MSI | PCI_IRQ_MSIX); 537 if (ret < 0) { 538 pr_err("%s: enable PCI MSI failed, err=%d\n", 539 mmc_hostname(host->mmc), ret); 540 return; 541 } 542 543 host->irq = pci_irq_vector(chip->pdev, 0); 544 } 545 546 static void sdhci_o2_enable_clk(struct sdhci_host *host, u16 clk) 547 { 548 /* Enable internal clock */ 549 clk |= SDHCI_CLOCK_INT_EN; 550 sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL); 551 552 sdhci_o2_enable_internal_clock(host); 553 if (sdhci_o2_get_cd(host->mmc)) { 554 clk |= SDHCI_CLOCK_CARD_EN; 555 sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL); 556 } 557 } 558 559 static void sdhci_pci_o2_set_clock(struct sdhci_host *host, unsigned int clock) 560 { 561 u16 clk; 562 u8 scratch; 563 u32 scratch_32; 564 struct sdhci_pci_slot *slot = sdhci_priv(host); 565 struct sdhci_pci_chip *chip = slot->chip; 566 567 host->mmc->actual_clock = 0; 568 569 sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL); 570 571 if (clock == 0) 572 return; 573 574 /* UnLock WP */ 575 pci_read_config_byte(chip->pdev, O2_SD_LOCK_WP, &scratch); 576 scratch &= 0x7f; 577 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 578 579 if ((host->timing == MMC_TIMING_UHS_SDR104) && (clock == 200000000)) { 580 pci_read_config_dword(chip->pdev, O2_SD_PLL_SETTING, &scratch_32); 581 582 if ((scratch_32 & 0xFFFF0000) != 0x2c280000) 583 o2_pci_set_baseclk(chip, 0x2c280000); 584 } else { 585 pci_read_config_dword(chip->pdev, O2_SD_PLL_SETTING, &scratch_32); 586 587 if ((scratch_32 & 0xFFFF0000) != 0x25100000) 588 o2_pci_set_baseclk(chip, 0x25100000); 589 } 590 591 pci_read_config_dword(chip->pdev, O2_SD_OUTPUT_CLK_SOURCE_SWITCH, &scratch_32); 592 scratch_32 &= ~(O2_SD_SEL_DLL | O2_SD_PHASE_MASK); 593 pci_write_config_dword(chip->pdev, O2_SD_OUTPUT_CLK_SOURCE_SWITCH, scratch_32); 594 595 /* Lock WP */ 596 pci_read_config_byte(chip->pdev, O2_SD_LOCK_WP, &scratch); 597 scratch |= 0x80; 598 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 599 600 clk = sdhci_calc_clk(host, clock, &host->mmc->actual_clock); 601 sdhci_o2_enable_clk(host, clk); 602 } 603 604 static int sdhci_pci_o2_probe_slot(struct sdhci_pci_slot *slot) 605 { 606 struct sdhci_pci_chip *chip; 607 struct sdhci_host *host; 608 struct o2_host *o2_host = sdhci_pci_priv(slot); 609 u32 reg, caps; 610 int ret; 611 612 chip = slot->chip; 613 host = slot->host; 614 615 o2_host->dll_adjust_count = 0; 616 caps = sdhci_readl(host, SDHCI_CAPABILITIES); 617 618 /* 619 * mmc_select_bus_width() will test the bus to determine the actual bus 620 * width. 621 */ 622 if (caps & SDHCI_CAN_DO_8BIT) 623 host->mmc->caps |= MMC_CAP_8_BIT_DATA; 624 625 switch (chip->pdev->device) { 626 case PCI_DEVICE_ID_O2_SDS0: 627 case PCI_DEVICE_ID_O2_SEABIRD0: 628 case PCI_DEVICE_ID_O2_SEABIRD1: 629 case PCI_DEVICE_ID_O2_SDS1: 630 case PCI_DEVICE_ID_O2_FUJIN2: 631 reg = sdhci_readl(host, O2_SD_VENDOR_SETTING); 632 if (reg & 0x1) 633 host->quirks |= SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12; 634 635 host->quirks2 |= SDHCI_QUIRK2_BROKEN_DDR50; 636 637 sdhci_pci_o2_enable_msi(chip, host); 638 639 if (chip->pdev->device == PCI_DEVICE_ID_O2_SEABIRD0) { 640 ret = pci_read_config_dword(chip->pdev, 641 O2_SD_MISC_SETTING, ®); 642 if (ret) 643 return -EIO; 644 if (reg & (1 << 4)) { 645 pr_info("%s: emmc 1.8v flag is set, force 1.8v signaling voltage\n", 646 mmc_hostname(host->mmc)); 647 host->flags &= ~SDHCI_SIGNALING_330; 648 host->flags |= SDHCI_SIGNALING_180; 649 host->mmc->caps2 |= MMC_CAP2_NO_SD; 650 host->mmc->caps2 |= MMC_CAP2_NO_SDIO; 651 pci_write_config_dword(chip->pdev, 652 O2_SD_DETECT_SETTING, 3); 653 } 654 655 slot->host->mmc_host_ops.get_cd = sdhci_o2_get_cd; 656 } 657 658 if (chip->pdev->device == PCI_DEVICE_ID_O2_SEABIRD1) { 659 slot->host->mmc_host_ops.get_cd = sdhci_o2_get_cd; 660 host->mmc->caps2 |= MMC_CAP2_NO_SDIO; 661 host->quirks2 |= SDHCI_QUIRK2_PRESET_VALUE_BROKEN; 662 } 663 664 host->mmc_host_ops.execute_tuning = sdhci_o2_execute_tuning; 665 666 if (chip->pdev->device != PCI_DEVICE_ID_O2_FUJIN2) 667 break; 668 /* set dll watch dog timer */ 669 reg = sdhci_readl(host, O2_SD_VENDOR_SETTING2); 670 reg |= (1 << 12); 671 sdhci_writel(host, reg, O2_SD_VENDOR_SETTING2); 672 673 break; 674 default: 675 break; 676 } 677 678 return 0; 679 } 680 681 static int sdhci_pci_o2_probe(struct sdhci_pci_chip *chip) 682 { 683 int ret; 684 u8 scratch; 685 u32 scratch_32; 686 687 switch (chip->pdev->device) { 688 case PCI_DEVICE_ID_O2_8220: 689 case PCI_DEVICE_ID_O2_8221: 690 case PCI_DEVICE_ID_O2_8320: 691 case PCI_DEVICE_ID_O2_8321: 692 /* This extra setup is required due to broken ADMA. */ 693 ret = pci_read_config_byte(chip->pdev, 694 O2_SD_LOCK_WP, &scratch); 695 if (ret) 696 return ret; 697 scratch &= 0x7f; 698 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 699 700 /* Set Multi 3 to VCC3V# */ 701 pci_write_config_byte(chip->pdev, O2_SD_MULTI_VCC3V, 0x08); 702 703 /* Disable CLK_REQ# support after media DET */ 704 ret = pci_read_config_byte(chip->pdev, 705 O2_SD_CLKREQ, &scratch); 706 if (ret) 707 return ret; 708 scratch |= 0x20; 709 pci_write_config_byte(chip->pdev, O2_SD_CLKREQ, scratch); 710 711 /* Choose capabilities, enable SDMA. We have to write 0x01 712 * to the capabilities register first to unlock it. 713 */ 714 ret = pci_read_config_byte(chip->pdev, O2_SD_CAPS, &scratch); 715 if (ret) 716 return ret; 717 scratch |= 0x01; 718 pci_write_config_byte(chip->pdev, O2_SD_CAPS, scratch); 719 pci_write_config_byte(chip->pdev, O2_SD_CAPS, 0x73); 720 721 /* Disable ADMA1/2 */ 722 pci_write_config_byte(chip->pdev, O2_SD_ADMA1, 0x39); 723 pci_write_config_byte(chip->pdev, O2_SD_ADMA2, 0x08); 724 725 /* Disable the infinite transfer mode */ 726 ret = pci_read_config_byte(chip->pdev, 727 O2_SD_INF_MOD, &scratch); 728 if (ret) 729 return ret; 730 scratch |= 0x08; 731 pci_write_config_byte(chip->pdev, O2_SD_INF_MOD, scratch); 732 733 /* Lock WP */ 734 ret = pci_read_config_byte(chip->pdev, 735 O2_SD_LOCK_WP, &scratch); 736 if (ret) 737 return ret; 738 scratch |= 0x80; 739 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 740 break; 741 case PCI_DEVICE_ID_O2_SDS0: 742 case PCI_DEVICE_ID_O2_SDS1: 743 case PCI_DEVICE_ID_O2_FUJIN2: 744 /* UnLock WP */ 745 ret = pci_read_config_byte(chip->pdev, 746 O2_SD_LOCK_WP, &scratch); 747 if (ret) 748 return ret; 749 750 scratch &= 0x7f; 751 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 752 753 /* DevId=8520 subId= 0x11 or 0x12 Type Chip support */ 754 if (chip->pdev->device == PCI_DEVICE_ID_O2_FUJIN2) { 755 ret = pci_read_config_dword(chip->pdev, 756 O2_SD_FUNC_REG0, 757 &scratch_32); 758 if (ret) 759 return ret; 760 scratch_32 = ((scratch_32 & 0xFF000000) >> 24); 761 762 /* Check Whether subId is 0x11 or 0x12 */ 763 if ((scratch_32 == 0x11) || (scratch_32 == 0x12)) { 764 scratch_32 = 0x25100000; 765 766 o2_pci_set_baseclk(chip, scratch_32); 767 ret = pci_read_config_dword(chip->pdev, 768 O2_SD_FUNC_REG4, 769 &scratch_32); 770 if (ret) 771 return ret; 772 773 /* Enable Base Clk setting change */ 774 scratch_32 |= O2_SD_FREG4_ENABLE_CLK_SET; 775 pci_write_config_dword(chip->pdev, 776 O2_SD_FUNC_REG4, 777 scratch_32); 778 779 /* Set Tuning Window to 4 */ 780 pci_write_config_byte(chip->pdev, 781 O2_SD_TUNING_CTRL, 0x44); 782 783 break; 784 } 785 } 786 787 /* Enable 8520 led function */ 788 o2_pci_led_enable(chip); 789 790 /* Set timeout CLK */ 791 ret = pci_read_config_dword(chip->pdev, 792 O2_SD_CLK_SETTING, &scratch_32); 793 if (ret) 794 return ret; 795 796 scratch_32 &= ~(0xFF00); 797 scratch_32 |= 0x07E0C800; 798 pci_write_config_dword(chip->pdev, 799 O2_SD_CLK_SETTING, scratch_32); 800 801 ret = pci_read_config_dword(chip->pdev, 802 O2_SD_CLKREQ, &scratch_32); 803 if (ret) 804 return ret; 805 scratch_32 |= 0x3; 806 pci_write_config_dword(chip->pdev, O2_SD_CLKREQ, scratch_32); 807 808 ret = pci_read_config_dword(chip->pdev, 809 O2_SD_PLL_SETTING, &scratch_32); 810 if (ret) 811 return ret; 812 813 scratch_32 &= ~(0x1F3F070E); 814 scratch_32 |= 0x18270106; 815 pci_write_config_dword(chip->pdev, 816 O2_SD_PLL_SETTING, scratch_32); 817 818 /* Disable UHS1 funciton */ 819 ret = pci_read_config_dword(chip->pdev, 820 O2_SD_CAP_REG2, &scratch_32); 821 if (ret) 822 return ret; 823 scratch_32 &= ~(0xE0); 824 pci_write_config_dword(chip->pdev, 825 O2_SD_CAP_REG2, scratch_32); 826 827 if (chip->pdev->device == PCI_DEVICE_ID_O2_FUJIN2) 828 sdhci_pci_o2_fujin2_pci_init(chip); 829 830 /* Lock WP */ 831 ret = pci_read_config_byte(chip->pdev, 832 O2_SD_LOCK_WP, &scratch); 833 if (ret) 834 return ret; 835 scratch |= 0x80; 836 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 837 break; 838 case PCI_DEVICE_ID_O2_SEABIRD0: 839 case PCI_DEVICE_ID_O2_SEABIRD1: 840 /* UnLock WP */ 841 ret = pci_read_config_byte(chip->pdev, 842 O2_SD_LOCK_WP, &scratch); 843 if (ret) 844 return ret; 845 846 scratch &= 0x7f; 847 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 848 849 ret = pci_read_config_dword(chip->pdev, 850 O2_SD_PLL_SETTING, &scratch_32); 851 if (ret) 852 return ret; 853 854 if ((scratch_32 & 0xff000000) == 0x01000000) { 855 scratch_32 &= 0x0000FFFF; 856 scratch_32 |= 0x1F340000; 857 858 pci_write_config_dword(chip->pdev, 859 O2_SD_PLL_SETTING, scratch_32); 860 } else { 861 scratch_32 &= 0x0000FFFF; 862 scratch_32 |= 0x25100000; 863 864 pci_write_config_dword(chip->pdev, 865 O2_SD_PLL_SETTING, scratch_32); 866 867 ret = pci_read_config_dword(chip->pdev, 868 O2_SD_FUNC_REG4, 869 &scratch_32); 870 if (ret) 871 return ret; 872 scratch_32 |= (1 << 22); 873 pci_write_config_dword(chip->pdev, 874 O2_SD_FUNC_REG4, scratch_32); 875 } 876 877 /* Set Tuning Windows to 5 */ 878 pci_write_config_byte(chip->pdev, 879 O2_SD_TUNING_CTRL, 0x55); 880 /* Lock WP */ 881 ret = pci_read_config_byte(chip->pdev, 882 O2_SD_LOCK_WP, &scratch); 883 if (ret) 884 return ret; 885 scratch |= 0x80; 886 pci_write_config_byte(chip->pdev, O2_SD_LOCK_WP, scratch); 887 break; 888 } 889 890 return 0; 891 } 892 893 #ifdef CONFIG_PM_SLEEP 894 static int sdhci_pci_o2_resume(struct sdhci_pci_chip *chip) 895 { 896 sdhci_pci_o2_probe(chip); 897 return sdhci_pci_resume_host(chip); 898 } 899 #endif 900 901 static const struct sdhci_ops sdhci_pci_o2_ops = { 902 .set_clock = sdhci_pci_o2_set_clock, 903 .enable_dma = sdhci_pci_enable_dma, 904 .set_bus_width = sdhci_set_bus_width, 905 .reset = sdhci_reset, 906 .set_uhs_signaling = sdhci_set_uhs_signaling, 907 }; 908 909 const struct sdhci_pci_fixes sdhci_o2 = { 910 .probe = sdhci_pci_o2_probe, 911 .quirks = SDHCI_QUIRK_NO_ENDATTR_IN_NOPDESC, 912 .quirks2 = SDHCI_QUIRK2_CLEAR_TRANSFERMODE_REG_BEFORE_CMD, 913 .probe_slot = sdhci_pci_o2_probe_slot, 914 #ifdef CONFIG_PM_SLEEP 915 .resume = sdhci_pci_o2_resume, 916 #endif 917 .ops = &sdhci_pci_o2_ops, 918 .priv_size = sizeof(struct o2_host), 919 }; 920