1. Force to assign some property at sdhci_add_host() function if chip is JMB388. 2. Jmicron doesn't support CMD19, install of tuning command, Jmicron run a procedure to tune the clock delay, command delay and data delay. Actually I want to define a quirks such like "SDHCI_QUIRK_NONSTANDARD_TUNE", but it run out the quirks defination. so I share SDHCI_QUIRK_UNSTABLE_RO_DETECT temporarily, looking for anyone provide any suggestion :-) The tuning procddure is very simple -- try to get card status and read data under totally 32 different clock delay setting, and record the result those operations, then choose a proper delay setting from this result. 3. Jmicron using an nonstandard clock setting. this patch implement a function to set host clock by this nonstandard way. 4. The tuning procedure is put in host/sdhci.c temporarily, I am not sure it is a proper location or not, any suggestion? Signed-off-by: arieslee <arieslee@xxxxxxxxxxx> --- drivers/mmc/card/block.c | 24 +++- drivers/mmc/core/bus.c | 4 +- drivers/mmc/core/core.c | 96 ++++++++++++- drivers/mmc/core/core.h | 3 +- drivers/mmc/core/mmc_ops.c | 14 ++ drivers/mmc/core/mmc_ops.h | 2 +- drivers/mmc/core/sd.c | 18 ++- drivers/mmc/host/sdhci-pci.c | 301 +++++++++++++++++++++++++++++++++----- drivers/mmc/host/sdhci.c | 336 +++++++++++++++++++++++++++++++++++++++++- drivers/mmc/host/sdhci.h | 48 ++++++ include/linux/mmc/host.h | 8 +- 11 files changed, 799 insertions(+), 55 deletions(-) diff --git a/drivers/mmc/card/block.c b/drivers/mmc/card/block.c index f85e422..9cb4fe0 100644 --- a/drivers/mmc/card/block.c +++ b/drivers/mmc/card/block.c @@ -772,7 +772,7 @@ static int mmc_blk_issue_rw_rq(struct mmc_queue *mq, struct request *req) brq.sbc.flags = MMC_RSP_R1 | MMC_CMD_AC; brq.mrq.sbc = &brq.sbc; } - +re_access: mmc_set_data_timeout(&brq.data, card); brq.data.sg = mq->sg; @@ -802,6 +802,19 @@ static int mmc_blk_issue_rw_rq(struct mmc_queue *mq, struct request *req) mmc_wait_for_req(card->host, &brq.mrq); mmc_queue_bounce_post(mq); + /* + * tuning clock delay is based on reading(CMD18), the result may + * not suit with writing, if an error occured in accessing, we + * need to slow down the clock and re-tuning again. + */ + if (brq.cmd.error || brq.data.error || brq.stop.error) { + if (mmc_card_sd(card) && + (card->host->ops->tune_delay)) { + card->host->ops->tune_delay(card->host, + card->host->ios.clock-1); + goto re_access; + } + } /* * Check for errors here, but don't jump to cmd_err @@ -908,10 +921,10 @@ static int mmc_blk_issue_rw_rq(struct mmc_queue *mq, struct request *req) return 1; cmd_err: - /* - * If this is an SD card and we're writing, we can first - * mark the known good sectors as ok. - * + /* + * If this is an SD card and we're writing, we can first + * mark the known good sectors as ok. + * * If the card is not SD, we can still ok written sectors * as reported by the controller (which might be less than * the real number of written sectors, but never more). @@ -1389,4 +1402,3 @@ module_exit(mmc_blk_exit); MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("Multimedia Card (MMC) block device driver"); - diff --git a/drivers/mmc/core/bus.c b/drivers/mmc/core/bus.c index 393d817..b6e832b 100644 --- a/drivers/mmc/core/bus.c +++ b/drivers/mmc/core/bus.c @@ -333,6 +333,9 @@ void mmc_remove_card(struct mmc_card *card) #endif if (mmc_card_present(card)) { + if (mmc_card_sd(card) && (card->host->ops->set_default_delay)) + card->host->ops->set_default_delay(card->host); + if (mmc_host_is_spi(card->host)) { printk(KERN_INFO "%s: SPI card removed\n", mmc_hostname(card->host)); @@ -345,4 +348,3 @@ void mmc_remove_card(struct mmc_card *card) put_device(&card->dev); } - diff --git a/drivers/mmc/core/core.c b/drivers/mmc/core/core.c index 7843efe..533f4cc 100644 --- a/drivers/mmc/core/core.c +++ b/drivers/mmc/core/core.c @@ -23,7 +23,7 @@ #include <linux/log2.h> #include <linux/regulator/consumer.h> #include <linux/pm_runtime.h> - +#include <linux/slab.h> #include <linux/mmc/card.h> #include <linux/mmc/host.h> #include <linux/mmc/mmc.h> @@ -1741,6 +1741,95 @@ int mmc_card_can_sleep(struct mmc_host *host) } EXPORT_SYMBOL(mmc_card_can_sleep); +int mmc_stop_status_cmd(struct mmc_host *host, u32 opcode, u32 *buf) +{ + int ret; + + mmc_claim_host(host); + if (opcode == MMC_SEND_STATUS) + ret = mmc_send_status(host->card, buf); + else + ret = mmc_send_stop(host); + mmc_release_host(host); + return ret; +} +EXPORT_SYMBOL(mmc_stop_status_cmd); + +#define OFFSET_DATA_ERROR -1000 +#define OFFSET_CMD_ERROR -2000 +int mmc_read_data(struct mmc_host *host, u8 *buffer) +{ + struct mmc_request mrq; + struct mmc_command cmd, stop; + struct mmc_data data; + struct scatterlist sg; + int ret, count_loop = 0; + u32 response; + u8 *sg_buffer; + + sg_buffer = kzalloc(TEST_BUFFER_SIZE, GFP_KERNEL); + if (!sg_buffer) + return -ENOMEM; + + mmc_claim_host(host); + memset(&cmd, 0, sizeof(struct mmc_command)); + cmd.opcode = MMC_SET_BLOCKLEN; + cmd.arg = 512; + cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; + ret = mmc_wait_for_cmd(host, &cmd, 1); + + if (ret) + goto exit_readdata; + sg_init_one(&sg, sg_buffer, TEST_BUFFER_SIZE); + + memset(&mrq, 0, sizeof(struct mmc_request)); + memset(&cmd, 0, sizeof(struct mmc_command)); + memset(&data, 0, sizeof(struct mmc_data)); + memset(&stop, 0, sizeof(struct mmc_command)); + mrq.cmd = &cmd; + mrq.data = &data; + mrq.stop = &stop; + + cmd.opcode = MMC_READ_MULTIPLE_BLOCK; + cmd.arg = 0; + cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC; + stop.opcode = MMC_STOP_TRANSMISSION; + stop.arg = 0; + stop.flags = MMC_RSP_R1B | MMC_CMD_AC; + data.blksz = 512; + data.blocks = TEST_BUFFER_SIZE / 512; + data.flags = MMC_DATA_READ; + data.sg = &sg; + data.sg_len = 1; + cmd.data = &data; + + mmc_set_data_timeout(mrq.data, host->card); + mmc_wait_for_req(host, &mrq); + do { + mmc_stop_status_cmd(host, MMC_SEND_STATUS, &response); + mdelay(5); + } while ((!(response & R1_READY_FOR_DATA)) && (++count_loop < 10)); + if (!(count_loop < 10)) { + ret = -ETIME; + goto exit_readdata; + } + if (cmd.error) + ret = OFFSET_CMD_ERROR + cmd.error; + if (cmd.data->error) + ret = OFFSET_DATA_ERROR + cmd.data->error; + if (cmd.data->bytes_xfered != (cmd.data->blocks * cmd.data->blksz)) + ret = -EIO; + if (ret == -EINVAL) + goto exit_readdata; + + sg_copy_to_buffer(&sg, 1, buffer, TEST_BUFFER_SIZE); +exit_readdata: + kfree(sg_buffer); + mmc_release_host(host); + return ret; +} +EXPORT_SYMBOL(mmc_read_data); + #ifdef CONFIG_PM /** @@ -1826,6 +1915,11 @@ int mmc_resume_host(struct mmc_host *host) } EXPORT_SYMBOL(mmc_resume_host); +void mmc_reinit_card(struct mmc_host *host) +{ + mmc_sd_resume(host); +} +EXPORT_SYMBOL(mmc_reinit_card); /* Do the card removal on suspend if card is assumed removeable * Do that in pm notifier while userspace isn't yet frozen, so we will be able to sync the card. diff --git a/drivers/mmc/core/core.h b/drivers/mmc/core/core.h index d9411ed..44bab71 100644 --- a/drivers/mmc/core/core.h +++ b/drivers/mmc/core/core.h @@ -61,7 +61,7 @@ void mmc_stop_host(struct mmc_host *host); int mmc_attach_mmc(struct mmc_host *host); int mmc_attach_sd(struct mmc_host *host); int mmc_attach_sdio(struct mmc_host *host); - +int mmc_sd_resume(struct mmc_host *host); /* Module parameters */ extern int use_spi_crc; @@ -73,4 +73,3 @@ void mmc_add_card_debugfs(struct mmc_card *card); void mmc_remove_card_debugfs(struct mmc_card *card); #endif - diff --git a/drivers/mmc/core/mmc_ops.c b/drivers/mmc/core/mmc_ops.c index 845ce7c..af0690b 100644 --- a/drivers/mmc/core/mmc_ops.c +++ b/drivers/mmc/core/mmc_ops.c @@ -450,6 +450,20 @@ int mmc_send_status(struct mmc_card *card, u32 *status) return 0; } +int mmc_send_stop(struct mmc_host *host) +{ + int err; + struct mmc_command cmd = {0}; + + BUG_ON(!host); + + cmd.opcode = MMC_STOP_TRANSMISSION; + cmd.arg = 0; + cmd.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC; + err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES); + return err; +} + static int mmc_send_bus_test(struct mmc_card *card, struct mmc_host *host, u8 opcode, u8 len) diff --git a/drivers/mmc/core/mmc_ops.h b/drivers/mmc/core/mmc_ops.h index 9276946..7074118 100644 --- a/drivers/mmc/core/mmc_ops.h +++ b/drivers/mmc/core/mmc_ops.h @@ -21,6 +21,7 @@ int mmc_set_relative_addr(struct mmc_card *card); int mmc_send_csd(struct mmc_card *card, u32 *csd); int mmc_send_ext_csd(struct mmc_card *card, u8 *ext_csd); int mmc_send_status(struct mmc_card *card, u32 *status); +int mmc_send_stop(struct mmc_host *host); int mmc_send_cid(struct mmc_host *host, u32 *cid); int mmc_spi_read_ocr(struct mmc_host *host, int highcap, u32 *ocrp); int mmc_spi_set_crc(struct mmc_host *host, int use_crc); @@ -28,4 +29,3 @@ int mmc_card_sleepawake(struct mmc_host *host, int sleep); int mmc_bus_test(struct mmc_card *card, u8 bus_width); #endif - diff --git a/drivers/mmc/core/sd.c b/drivers/mmc/core/sd.c index ff27741..f8c2fb7 100644 --- a/drivers/mmc/core/sd.c +++ b/drivers/mmc/core/sd.c @@ -17,6 +17,7 @@ #include <linux/mmc/card.h> #include <linux/mmc/mmc.h> #include <linux/mmc/sd.h> +#include <linux/mmc/sdhci.h> #include "core.h" #include "bus.h" @@ -463,6 +464,7 @@ static int sd_set_bus_speed_mode(struct mmc_card *card, u8 *status) { unsigned int bus_speed = 0, timing = 0; int err; + struct sdhci_host *sdhost = NULL; /* * If the host doesn't support any of the UHS-I modes, fallback on @@ -513,6 +515,10 @@ static int sd_set_bus_speed_mode(struct mmc_card *card, u8 *status) mmc_hostname(card->host)); else { mmc_set_timing(card->host, timing); + sdhost = mmc_priv(card->host); + if (sdhost != NULL) + if (sdhost->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT) + return 0; mmc_set_clock(card->host, card->sw_caps.uhs_max_dtr); } @@ -1035,7 +1041,7 @@ static int mmc_sd_suspend(struct mmc_host *host) * This function tries to determine if the same card is still present * and, if so, restore all state to it. */ -static int mmc_sd_resume(struct mmc_host *host) +int mmc_sd_resume(struct mmc_host *host) { int err; @@ -1164,6 +1170,15 @@ int mmc_attach_sd(struct mmc_host *host) goto err; mmc_release_host(host); + if (host->ops->tune_delay) { + if (host->card->state & MMC_STATE_ULTRAHIGHSPEED) + host->ops->tune_delay(host, min(host->f_max, + host->card->sw_caps.uhs_max_dtr)); + else + host->ops->tune_delay(host, host->ios.clock); + } + + err = mmc_add_card(host->card); mmc_claim_host(host); if (err) @@ -1184,4 +1199,3 @@ err: return err; } - diff --git a/drivers/mmc/host/sdhci-pci.c b/drivers/mmc/host/sdhci-pci.c index 936bbca..b4e082f 100644 --- a/drivers/mmc/host/sdhci-pci.c +++ b/drivers/mmc/host/sdhci-pci.c @@ -36,40 +36,6 @@ #define PCI_SLOT_INFO_SLOTS(x) ((x >> 4) & 7) #define PCI_SLOT_INFO_FIRST_BAR_MASK 0x07 -#define MAX_SLOTS 8 - -struct sdhci_pci_chip; -struct sdhci_pci_slot; - -struct sdhci_pci_fixes { - unsigned int quirks; - - int (*probe) (struct sdhci_pci_chip *); - - int (*probe_slot) (struct sdhci_pci_slot *); - void (*remove_slot) (struct sdhci_pci_slot *, int); - - int (*suspend) (struct sdhci_pci_chip *, - pm_message_t); - int (*resume) (struct sdhci_pci_chip *); -}; - -struct sdhci_pci_slot { - struct sdhci_pci_chip *chip; - struct sdhci_host *host; - - int pci_bar; -}; - -struct sdhci_pci_chip { - struct pci_dev *pdev; - - unsigned int quirks; - const struct sdhci_pci_fixes *fixes; - - int num_slots; /* Slots on controller */ - struct sdhci_pci_slot *slots[MAX_SLOTS]; /* Pointers to host slots */ -}; /*************************************************************************** **\ @@ -242,6 +208,262 @@ static int o2_probe(struct sdhci_pci_chip *chip) return 0; } + +#define JM_DEFAULT_IC_DRIVING_380B 0x03053333 +#define JM_MAX_IC_DRIVING_380B 0x07077777 +#define JM_IC_DRIVING_B8_MASK_380B 0x00700000 +#define JM_IC_DRIVING_E4_MASK_380B 0x7FFF0000 + +#define JMCR_PCICNFG_PAGESEL_OFFSET 0xBF +#define JMCR_CFGPAGE_MASK 0xE0 +#define JMCR_CFGPAGE_SHIFT 5 +#define JMCR_CFGPAGE_CHIPID 0x01 +#define JMCR_CFGPAGE_ASPM 0x03 +#define JMCR_CFGPAGE_SCRATCH 0x05 +#define JMCR_CFGPAGE_PAD_DELAY_CTRL 0x06 +#define JMCR_CFGPAGE_PAD_DELAY_CTRL2 0x07 + +#define JMCR_PCICNFG_PAGE_DATA0_OFFSET 0xE8 +#define JMCR_PCICNFG_PAGE_DATA1_OFFSET 0xEC +#define JMCR_PCICNFG_PAGE_DATA2_OFFSET 0xE4 +#define PCICNFG_REG_TIMING_DELAY 0xB0 +#define TIMING_DELAY_BIT_MASK_SLOTA 0x0f00 +#define TIMING_DELAY_SLOTA_SHIFT 8 +#define JMCR_TIMING_DELAY_COUNT 8 +#define JMCR_EXTEND_DELAY_COUNT 6 + +void jmicron_set_clock_delay(struct sdhci_pci_chip *chip, const u16 i) +{ + u8 page; + u16 delay, cfg_b0; + u32 cfg_ec; + struct pci_dev *pdev = chip->pdev; + + delay = (i & 0x1F); + pci_read_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, &page); + page &= ~JMCR_CFGPAGE_MASK; + page |= (JMCR_CFGPAGE_PAD_DELAY_CTRL2 << JMCR_CFGPAGE_SHIFT); + pci_write_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, page); + + /* ClkDelay[4] = reg_ec_p7[0] */ + pci_read_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA1_OFFSET, &cfg_ec); + if (delay & 0x10) + cfg_ec |= 0x01; + else + cfg_ec &= ~(0x01); + pci_write_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA1_OFFSET, cfg_ec); + + pci_read_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, &page); + page &= ~JMCR_CFGPAGE_MASK; + pci_write_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, page); + + pci_read_config_word(pdev, PCICNFG_REG_TIMING_DELAY, &cfg_b0); + delay &= 0x0F; + delay <<= TIMING_DELAY_SLOTA_SHIFT; + cfg_b0 &= ~(TIMING_DELAY_BIT_MASK_SLOTA); + cfg_b0 |= delay; + pci_write_config_word(pdev, PCICNFG_REG_TIMING_DELAY, cfg_b0); + return; +} + +void jmicron_set_cmddata_delay(struct sdhci_pci_chip *chip, const u16 i) +{ + u8 page; + u16 delay; + u32 cfg_ec, cfg_e8; + struct pci_dev *pdev = chip->pdev; + + delay = i & 0x1F; + + pci_read_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, &page); + page &= ~JMCR_CFGPAGE_MASK; + page |= (JMCR_CFGPAGE_PAD_DELAY_CTRL << JMCR_CFGPAGE_SHIFT); + pci_write_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, page); + + pci_read_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA0_OFFSET, &cfg_e8); + cfg_e8 &= ~0x1F1F1F1F; + cfg_e8 |= delay; + cfg_e8 |= delay << 8; + cfg_e8 |= delay << 16; + cfg_e8 |= delay << 24; + pci_write_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA0_OFFSET, cfg_e8); + + page &= ~JMCR_CFGPAGE_MASK; + page |= (JMCR_CFGPAGE_PAD_DELAY_CTRL2 << JMCR_CFGPAGE_SHIFT); + pci_write_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, page); + + pci_read_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA0_OFFSET, &cfg_e8); + cfg_e8 &= ~0x1F1F1F1F; + cfg_e8 |= delay; + cfg_e8 |= delay << 8; + cfg_e8 |= delay << 16; + cfg_e8 |= delay << 24; + pci_write_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA0_OFFSET, cfg_e8); + + + page &= ~JMCR_CFGPAGE_MASK; + page |= (JMCR_CFGPAGE_PAD_DELAY_CTRL << JMCR_CFGPAGE_SHIFT); + pci_write_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, page); + + /* CmdDelay[3:0] = reg_ec_p6[3:0] */ + pci_read_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA1_OFFSET, &cfg_ec); + cfg_ec &= ~0x0000000F; + cfg_ec |= i & 0x0F; + pci_write_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA1_OFFSET, cfg_ec); + + page &= ~JMCR_CFGPAGE_MASK; + page |= (JMCR_CFGPAGE_PAD_DELAY_CTRL2 << JMCR_CFGPAGE_SHIFT); + pci_write_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, page); + + /* CmdDelay[4] = reg_ec_p7[1] */ + pci_read_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA1_OFFSET, &cfg_ec); + if (i & 0x10) + cfg_ec |= 0x02; + else + cfg_ec &= ~(0x02); + pci_write_config_dword(pdev, JMCR_PCICNFG_PAGE_DATA1_OFFSET, cfg_ec); + + pci_read_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, &page); + page &= ~JMCR_CFGPAGE_MASK; + pci_write_config_byte(pdev, JMCR_PCICNFG_PAGESEL_OFFSET, page); + + return; +} + +void jmicron_set_ic_driving(struct sdhci_pci_chip *chip, const u32 driving) +{ + u32 val, tmp; + struct pci_dev *pdev = chip->pdev; + + if (pdev == NULL) { + printk(KERN_ERR "pdev == NULL\n"); + return; + } + pci_read_config_dword(pdev, 0xE4, &val); + val &= ~JM_IC_DRIVING_E4_MASK_380B; + tmp = ((driving >> 24) & 0x07) << 28; /* CMD/BS*/ + val |= tmp; + tmp = ((driving >> 12) & 0x07) << 16; /* Data[0]*/ + val |= tmp; + tmp = ((driving >> 8) & 0x07) << 19; /* Data[1]*/ + val |= tmp; + tmp = ((driving >> 4) & 0x07) << 22; /* Data[2]*/ + val |= tmp; + tmp = (driving & 0x07) << 25; /* Data[3]*/ + val |= tmp; + dev_dbg(&pdev->dev, "%s - Set E4h to 0x%08x\n", __func__, val); + pci_write_config_dword(pdev, 0xE4, val); + + pci_read_config_dword(pdev, 0xB8, &val); + val &= ~JM_IC_DRIVING_B8_MASK_380B; + tmp = ((driving >> 16) & 0x07) << 20; + val |= tmp; + dev_dbg(&pdev->dev, "%s - Set B8h to 0x%08x\n", __func__, val); + pci_write_config_dword(pdev, 0xB8, val); +} +/* JMicron Clock Mux Control Register D4h + D[31:4] Reserved + D[3] Force MMIO Control. 0: Control by PCI CNFG, 1: Control by MMIO. + D[2:0] Clock MUX Select +*/ +#define SDHCI_CLOCK_MUX_CONTROL 0xD4 +#define SDHCI_EXTERN_OE 0xE4 +#define SDHCI_CLKMUX_CONTROL_BY_MMIO 0x00000008 +#define SDHCI_CLKMUX_CLK_40MHZ 0x00000001 +#define SDHCI_CLKMUX_CLK_50MHZ 0x00000002 +#define SDHCI_CLKMUX_CLK_62_5MHZ 0x00000004 +#define SDHCI_CLKMUX_CLK_OFF 0x00000000 +#define SDHCI_CLKMUX_CLK_MASK 0x00000007 +/* For Host which supports SD 3.0 */ +#define SDHCI_CLKMUX_CLK_83MHZ 0x00000010 +#define SDHCI_CLKMUX_CLK_100MHZ 0x00000020 +#define SDHCI_CLKMUX_CLK_125MHZ 0x00000040 +#define SDHCI_CLKMUX_CLK_156MHZ 0x00000080 +#define SDHCI_CLKMUX_CLK_178MHZ 0x00000100 +#define SDHCI_CLKMUX_CLK_208MHZ 0x00000200 +#define SDHCI_CLKMUX_CLK_MASK2 0x000003F7 +void jmicron_set_clock(struct sdhci_host *host, unsigned int clock) +{ + u16 clk, wTmp; + u32 muxclk, div; + u32 reg_extern_oe = 0; + unsigned long timeout; + struct sdhci_pci_slot *slot = sdhci_priv(host); + + sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL); + if (clock == 0) + goto out; + + reg_extern_oe = sdhci_readl(host , SDHCI_EXTERN_OE); + if (clock >= CLK_100MHZ) { + jmicron_set_ic_driving(slot->chip, JM_MAX_IC_DRIVING_380B); + reg_extern_oe |= 1<<23; + reg_extern_oe |= 1<<22; + } else { + jmicron_set_ic_driving(slot->chip, JM_DEFAULT_IC_DRIVING_380B); + reg_extern_oe &= ~(1<<23); + reg_extern_oe &= ~(1<<22); + } + sdhci_writel(host , reg_extern_oe , SDHCI_EXTERN_OE); + + /* Disable Clock First for safe */ + sdhci_writew(host, SDHCI_CLKMUX_CONTROL_BY_MMIO, + SDHCI_CLOCK_MUX_CONTROL); + div = 0; + switch (clock) { + case 208000000: + wTmp = SDHCI_CLKMUX_CONTROL_BY_MMIO | SDHCI_CLKMUX_CLK_208MHZ; + break; + case 178000000: + wTmp = SDHCI_CLKMUX_CONTROL_BY_MMIO | SDHCI_CLKMUX_CLK_178MHZ; + break; + case 156000000: + wTmp = SDHCI_CLKMUX_CONTROL_BY_MMIO | SDHCI_CLKMUX_CLK_156MHZ; + break; + case 125000000: + wTmp = SDHCI_CLKMUX_CONTROL_BY_MMIO | SDHCI_CLKMUX_CLK_125MHZ; + break; + case 100000000: + wTmp = SDHCI_CLKMUX_CONTROL_BY_MMIO | SDHCI_CLKMUX_CLK_100MHZ; + break; + case 83000000: + wTmp = SDHCI_CLKMUX_CONTROL_BY_MMIO | SDHCI_CLKMUX_CLK_83MHZ; + break; + default: + wTmp = SDHCI_CLKMUX_CONTROL_BY_MMIO | SDHCI_CLKMUX_CLK_50MHZ; + muxclk = 50000000; + } + + for (div = 1; div < 256; div *= 2) { + if ((muxclk / div) <= clock) + break; + } + div >>= 1; + + sdhci_writew(host, wTmp, SDHCI_CLOCK_MUX_CONTROL); + + clk = div << SDHCI_DIVIDER_SHIFT; + clk |= SDHCI_CLOCK_INT_EN; + sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL); + + /* Wait max 20 ms */ + timeout = 20; + while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL)) & + SDHCI_CLOCK_INT_STABLE)) { + if (timeout == 0) { + printk(KERN_ERR "%s: Internal clock never " + "stabilised.\n", mmc_hostname(host->mmc)); + return; + } + timeout--; + mdelay(1); + } + clk |= SDHCI_CLOCK_CARD_EN; + sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL); +out: + host->clock = clock; +} + static int jmicron_pmos(struct sdhci_pci_chip *chip, int on) { u8 scratch; @@ -267,6 +489,7 @@ static int jmicron_pmos(struct sdhci_pci_chip *chip, int on) return 0; } +static struct sdhci_ops sdhci_pci_ops; static int jmicron_probe(struct sdhci_pci_chip *chip) { int ret; @@ -329,9 +552,13 @@ static int jmicron_probe(struct sdhci_pci_chip *chip) /* quirk for unsable RO-detection on JM388 chips */ if (chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB388_SD || - chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB388_ESD) - chip->quirks |= SDHCI_QUIRK_UNSTABLE_RO_DETECT; + chip->pdev->device == PCI_DEVICE_ID_JMICRON_JMB388_ESD){ + chip->quirks |= SDHCI_QUIRK_UNSTABLE_RO_DETECT | \ + SDHCI_QUIRK_NONSTANDARD_CLOCK | \ + SDHCI_QUIRK_BROKEN_TIMEOUT_VAL; + sdhci_pci_ops.set_clock = jmicron_set_clock; + } return 0; } @@ -443,6 +670,8 @@ static const struct sdhci_pci_fixes sdhci_jmicron = { .suspend = jmicron_suspend, .resume = jmicron_resume, + .set_clock_delay = jmicron_set_clock_delay, + .set_cmddata_delay = jmicron_set_cmddata_delay, }; /* SysKonnect CardBus2SDIO extra registers */ diff --git a/drivers/mmc/host/sdhci.c b/drivers/mmc/host/sdhci.c index 58d5436..43eb3d9 100644 --- a/drivers/mmc/host/sdhci.c +++ b/drivers/mmc/host/sdhci.c @@ -1593,6 +1593,312 @@ static int sdhci_start_signal_voltage_switch(struct mmc_host *mmc, return 0; } +void total_reset_host(struct sdhci_host *host) +{ + u32 clock; + + DBG("Enter total_reset_host()\n"); + clock = host->mmc->ios.clock; + /* mmc_power_off() */ + host->mmc->ios.clock = 0; + host->mmc->ios.vdd = 0; + host->mmc->ios.bus_mode = MMC_BUSMODE_OPENDRAIN; + host->mmc->ios.chip_select = MMC_CS_DONTCARE; + host->mmc->ios.power_mode = MMC_POWER_OFF; + host->mmc->ios.bus_width = MMC_BUS_WIDTH_1; + host->mmc->ios.timing = MMC_TIMING_LEGACY; + sdhci_set_ios(host->mmc, &host->mmc->ios); + mdelay(10); + /* mmc_power_up() */ + if (host->mmc->ocr) + host->mmc->ios.vdd = ffs(host->mmc->ocr) - 1; + else + host->mmc->ios.vdd = fls(host->mmc->ocr_avail) - 1; + host->mmc->ios.power_mode = MMC_POWER_UP; + sdhci_set_ios(host->mmc, &host->mmc->ios); + mdelay(10); + host->mmc->ios.clock = host->mmc->f_init; + host->mmc->ios.power_mode = MMC_POWER_ON; + sdhci_set_ios(host->mmc, &host->mmc->ios); + mdelay(10); + + sdhci_reinit(host); + sdhci_writeb(host, SDHCI_POWER_330|SDHCI_POWER_ON, + SDHCI_POWER_CONTROL); + msleep(600); + mmc_reinit_card(host->mmc); + mdelay(10); + host->mmc->ios.clock = clock; + sdhci_set_clock(host, clock); + + return ; +} + +/* test if the HW work in this delay setting */ +int delay_testing(struct sdhci_host *host, u8 *buffer, u8 *sec_buffer) +{ + int ret; + u16 card_status; + u32 response; + struct sdhci_pci_slot *slot = NULL; + + slot = sdhci_priv(host); + sdhci_reset(host, SDHCI_RESET_CMD|SDHCI_RESET_DATA); + + /* test by CMD 13 */ + ret = mmc_stop_status_cmd(host->mmc, MMC_SEND_STATUS, &response); + card_status = R1_CURRENT_STATE(response); + if (!ret) { + mmc_stop_status_cmd(host->mmc, MMC_STOP_TRANSMISSION, NULL); + mmc_stop_status_cmd(host->mmc, MMC_SEND_STATUS, &response); + if ((card_status == 5) || (card_status == 6)) { + DBG("Totally Reset Host!\n"); + total_reset_host(host); + return -EIO; + } + } else + return -EIO; + /* test by CMD18 */ + ret = mmc_read_data(host->mmc, buffer); + if (!ret) { + /* Read Twice for Safe */ + ret = mmc_read_data(host->mmc, sec_buffer); + if (!ret && memcmp(sec_buffer, buffer, TEST_BUFFER_SIZE)) + return -ENODATA; + } + return ret; +} + +/* Find Largest Range of Successful Timing Delay Setting */ +void find_largest_range(u32 test_result, u8 *max_cont_start, + u8 *max_cont_count) +{ + int i; + u8 cont_start = 0, cont_count = 0; + u8 lock_range = false; + u32 test_bit; + + if (test_result == 0) + *max_cont_count = 0; + else if (test_result == 0xFFFFFFFF) + *max_cont_count = 31; + else { + for (i = 0, test_bit = 1 ; i < 32 ; i++, test_bit <<= 1) { + if (test_result & test_bit) { + if (!lock_range) { + cont_start = i; + cont_count = 1; + lock_range = true; + } else { + cont_count++; + if (cont_count > *max_cont_count) { + *max_cont_start = cont_start; + *max_cont_count = cont_count; + } + } + } else + lock_range = false; + } + } + return; +} + +u8 calculate_cmd_delay(u32 test_result_cmd, u8 clk_delay, u8 *max_cont_start, + u8 *max_cont_count) +{ + int i; + u8 cmd_delay = 0; + u8 cont_start = 0; + u32 test_bit; + + if (test_result_cmd == 0) + *max_cont_count = 0; + else if (test_result_cmd == 0xFFFFFFFF) + *max_cont_count = 31; + else { + if (*max_cont_start > 0) { + cont_start = *max_cont_start - 1; + test_bit = 1 << cont_start; + for (i = cont_start; i > 0; i--, test_bit >>= 1) { + if ((test_result_cmd & test_bit) == 0) + break; + } + test_bit = 1 << i; + if ((test_result_cmd & test_bit) == 0) + i++; + cont_start = i; + } else + cont_start = 0; + i = *max_cont_start + *max_cont_count; + test_bit = 1 << i; + for ( ; i < 32 ; i++, test_bit <<= 1) { + if ((test_result_cmd & test_bit) == 0) + break; + } + *max_cont_start = cont_start; + *max_cont_count = i - *max_cont_start; + } + + if (*max_cont_count == 0) { + DBG("Cannot Find Succeed Cmd Delay Setting!?\n"); + cmd_delay = 0; + } else { + cmd_delay = *max_cont_start + ((*max_cont_count-1) / 2); + if (cmd_delay > clk_delay) + cmd_delay -= clk_delay; + else + cmd_delay = 0; + DBG("Modified Cmd Delay = %02xh.\n", cmd_delay); + } + + return cmd_delay; +} + +int test_tuning_result(struct mmc_host *mmc, u8 *buffer) +{ + int ret; + u32 response; + + ret = mmc_stop_status_cmd(mmc, MMC_SEND_STATUS, &response); + if (ret) + return ret; + ret = mmc_read_data(mmc, buffer); + return ret; +} + +#define OFFSET_DATA_ERROR -1000 +#define OFFSET_CMD_ERROR -2000 +int tuning_in_clock(struct sdhci_host *host, const u32 clock) +{ + u8 max_cont_start, max_cont_count; + u8 clk_delay = (u8)-1 , cmd_delay = (u8)-1, i; + u32 test_result, test_bit, test_result_cmd; + u8 *sec_buffer, *buffer; + u32 ret = 0; + struct sdhci_pci_slot *slot = sdhci_priv(host); + + sec_buffer = kzalloc(TEST_BUFFER_SIZE, GFP_KERNEL); + buffer = kzalloc(TEST_BUFFER_SIZE, GFP_KERNEL); + host->mmc->ios.clock = clock; + sdhci_set_clock(host, clock); + + test_result = 0; + test_bit = 1; + test_result_cmd = 0; + /* testing the delay from 0x00 to 0x1F and save the result */ + slot->chip->fixes->set_cmddata_delay(slot->chip, 0); + for (i = 0 ; i < 0x20 ; i++, test_bit <<= 1) { + memset(buffer, 0, TEST_BUFFER_SIZE); + memset(sec_buffer, 0xFF, TEST_BUFFER_SIZE); + if (!(sdhci_readl(host, SDHCI_PRESENT_STATE) & + SDHCI_CARD_PRESENT)){ + DBG("Found Card Removed during tuning!\n"); + test_result = 0; + ret = -ENODEV; + goto err_exit; + } + + slot->chip->fixes->set_clock_delay(slot->chip, i); + ret = delay_testing(host, buffer, sec_buffer); + if (!ret) { + test_result |= test_bit; + test_result_cmd |= test_bit; + } else if ((ret > OFFSET_CMD_ERROR) && + (ret < OFFSET_DATA_ERROR)) { + test_result_cmd |= test_bit; + } else if (ret == -ENODATA) { + total_reset_host(host); + ret = -ENODATA; + goto err_exit; + } + } + + DBG("Clock Test Result: 0x%08x, Cmd Test Result: 0x%08x\n", + test_result, test_result_cmd); + max_cont_start = 0; + max_cont_count = 0; + find_largest_range(test_result, &max_cont_start, &max_cont_count); + if (max_cont_count == 0) { + DBG("Cannot Find Succeed Clock Delay Setting!?\n"); + ret = -ERANGE; + goto err_exit; + } + total_reset_host(host); + clk_delay = max_cont_start + ((max_cont_count-1) / 2); + slot->chip->fixes->set_clock_delay(slot->chip, clk_delay); + cmd_delay = calculate_cmd_delay(test_result_cmd, clk_delay, + &max_cont_start, &max_cont_count); + slot->chip->fixes->set_cmddata_delay(slot->chip, cmd_delay); + memset(buffer, 0, TEST_BUFFER_SIZE); + + ret = test_tuning_result(host->mmc, buffer); +err_exit: + kfree(buffer); + kfree(sec_buffer); + return ret; +} + +u32 get_proper_clock(const u32 max_clock) +{ + if (max_clock < CLK_50MHZ) + return CLK_25MHZ; + else if (max_clock < CLK_60MHZ) + return CLK_50MHZ; + else if (max_clock < CLK_62_5MHZ) + return CLK_60MHZ; + else if (max_clock < CLK_83MHZ) + return CLK_62_5MHZ; + else if (max_clock < CLK_100MHZ) + return CLK_83MHZ; + else if (max_clock < CLK_125MHZ) + return CLK_100MHZ; + else if (max_clock < CLK_156MHZ) + return CLK_125MHZ; + else if (max_clock < CLK_178MHZ) + return CLK_156MHZ; + else if (max_clock < CLK_208MHZ) + return CLK_178MHZ; + else + return CLK_208MHZ; +} + +/* tune a proper clock, command delay and data delay */ +static int jmicron_tuning(struct mmc_host *mmc, const u32 max_clock) +{ + struct sdhci_host *host = NULL; + u32 response, clk; + + host = mmc_priv(mmc); + clk = max_clock; + for (;;) { + clk = get_proper_clock(clk); + if (tuning_in_clock(host, clk)) { + msleep(20); + mmc_stop_status_cmd(mmc, MMC_STOP_TRANSMISSION, NULL); + mmc_stop_status_cmd(mmc, MMC_SEND_STATUS, &response); + DBG("tuning in [%d]HZ is fail, try slower\n", clk); + clk--; + } else { + printk(KERN_INFO DRIVER_NAME + ":tuning delay in [%d]HZ is OK\n", clk); + break; + } + if (clk == CLK_25MHZ) + break; + } + return 0; +} + +void jmicron_set_default_delay(struct mmc_host *mmc) +{ + struct sdhci_host *host = mmc_priv(mmc); + struct sdhci_pci_slot *slot = sdhci_priv(host); + + slot->chip->fixes->set_clock_delay(slot->chip, 0); + slot->chip->fixes->set_cmddata_delay(slot->chip, 0); +} + + static int sdhci_execute_tuning(struct mmc_host *mmc) { struct sdhci_host *host; @@ -1799,7 +2105,7 @@ static void sdhci_enable_preset_value(struct mmc_host *mmc, bool enable) spin_unlock_irqrestore(&host->lock, flags); } -static const struct mmc_host_ops sdhci_ops = { +static struct mmc_host_ops sdhci_ops = { .request = sdhci_request, .set_ios = sdhci_set_ios, .get_ro = sdhci_get_ro, @@ -1945,7 +2251,8 @@ static void sdhci_tuning_timer(unsigned long data) unsigned long flags; host = (struct sdhci_host *)data; - + if (host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT) + return ; spin_lock_irqsave(&host->lock, flags); host->flags |= SDHCI_NEEDS_RETUNING; @@ -2277,6 +2584,8 @@ int sdhci_resume_host(struct sdhci_host *host) sdhci_enable_card_detection(host); /* Set the re-tuning expiration flag */ + if (host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT) + return ret; if ((host->version >= SDHCI_SPEC_300) && host->tuning_count && (host->tuning_mode == SDHCI_TUNING_MODE_1)) host->flags |= SDHCI_NEEDS_RETUNING; @@ -2352,6 +2661,9 @@ int sdhci_add_host(struct sdhci_host *host) host->version); } + if (host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT) + host->version = SDHCI_SPEC_300; + caps[0] = (host->quirks & SDHCI_QUIRK_MISSING_CAPS) ? host->caps : sdhci_readl(host, SDHCI_CAPABILITIES); @@ -2476,6 +2788,17 @@ int sdhci_add_host(struct sdhci_host *host) * Set host parameters. */ mmc->ops = &sdhci_ops; + if (host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT) { + ((struct mmc_host_ops *)mmc->ops)->tune_delay = jmicron_tuning; + ((struct mmc_host_ops *)mmc->ops)->set_default_delay = + jmicron_set_default_delay; + ((struct mmc_host_ops *)mmc->ops)->execute_tuning = NULL; + } else { + ((struct mmc_host_ops *)mmc->ops)->tune_delay = NULL; + ((struct mmc_host_ops *)mmc->ops)->set_default_delay = NULL; + } + + mmc->f_max = host->max_clk; if (host->ops->get_min_clock) mmc->f_min = host->ops->get_min_clock(host); @@ -2488,6 +2811,9 @@ int sdhci_add_host(struct sdhci_host *host) } else mmc->f_min = host->max_clk / SDHCI_MAX_DIV_SPEC_200; + if (host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT) + mmc->f_max = CLK_208MHZ; + mmc->caps |= MMC_CAP_SDIO_IRQ | MMC_CAP_ERASE | MMC_CAP_CMD23; if (host->quirks & SDHCI_QUIRK_MULTIBLOCK_READ_ACMD12) @@ -2513,7 +2839,8 @@ int sdhci_add_host(struct sdhci_host *host) if (!(host->quirks & SDHCI_QUIRK_FORCE_1_BIT_DATA)) mmc->caps |= MMC_CAP_4_BIT_DATA; - if (caps[0] & SDHCI_CAN_DO_HISPD) + if (caps[0] & SDHCI_CAN_DO_HISPD || + (host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT)) mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED; if ((host->quirks & SDHCI_QUIRK_BROKEN_CARD_DETECTION) && @@ -2569,7 +2896,8 @@ int sdhci_add_host(struct sdhci_host *host) * value. */ max_current_caps = sdhci_readl(host, SDHCI_MAX_CURRENT); - + if (host->quirks & SDHCI_QUIRK_UNSTABLE_RO_DETECT) + max_current_caps = 0x800000; if (caps[0] & SDHCI_CAN_VDD_330) { int max_current_330; diff --git a/drivers/mmc/host/sdhci.h b/drivers/mmc/host/sdhci.h index 745c42f..ac60ee9 100644 --- a/drivers/mmc/host/sdhci.h +++ b/drivers/mmc/host/sdhci.h @@ -168,6 +168,17 @@ #define SDHCI_CTRL_TUNED_CLK 0x0080 #define SDHCI_CTRL_PRESET_VAL_ENABLE 0x8000 +#define CLK_208MHZ 208000000 +#define CLK_178MHZ 178000000 +#define CLK_156MHZ 156000000 +#define CLK_125MHZ 125000000 +#define CLK_100MHZ 100000000 +#define CLK_83MHZ 83000000 +#define CLK_62_5MHZ 62500000 +#define CLK_60MHZ 60000000 +#define CLK_50MHZ 50000000 +#define CLK_25MHZ 25000000 + #define SDHCI_CAPABILITIES 0x40 #define SDHCI_TIMEOUT_CLK_MASK 0x0000003F #define SDHCI_TIMEOUT_CLK_SHIFT 0 @@ -276,6 +287,43 @@ struct sdhci_ops { }; +#define MAX_SLOTS 8 +struct sdhci_pci_chip; +struct sdhci_pci_slot; +struct sdhci_pci_fixes { + unsigned int quirks; + + int (*probe) (struct sdhci_pci_chip *); + + int (*probe_slot) (struct sdhci_pci_slot *); + void (*remove_slot) (struct sdhci_pci_slot *, int); + + int (*suspend) (struct sdhci_pci_chip *, + pm_message_t); + int (*resume) (struct sdhci_pci_chip *); + void (*set_clock_delay)(struct sdhci_pci_chip *, + const u16); + void (*set_cmddata_delay)(struct sdhci_pci_chip *, + const u16); +}; + +struct sdhci_pci_slot { + struct sdhci_pci_chip *chip; + struct sdhci_host *host; + + int pci_bar; +}; + +struct sdhci_pci_chip { + struct pci_dev *pdev; + + unsigned int quirks; + const struct sdhci_pci_fixes *fixes; + + int num_slots; /* Slots on controller */ + struct sdhci_pci_slot *slots[MAX_SLOTS]; /* Pointers to host slots */ +}; + #ifdef CONFIG_MMC_SDHCI_IO_ACCESSORS static inline void sdhci_writel(struct sdhci_host *host, u32 val, int reg) diff --git a/include/linux/mmc/host.h b/include/linux/mmc/host.h index 1ee4424..0d6b063 100644 --- a/include/linux/mmc/host.h +++ b/include/linux/mmc/host.h @@ -139,6 +139,8 @@ struct mmc_host_ops { int (*start_signal_voltage_switch)(struct mmc_host *host, struct mmc_ios *ios); int (*execute_tuning)(struct mmc_host *host); void (*enable_preset_value)(struct mmc_host *host, bool enable); + int (*tune_delay)(struct mmc_host *host, const u32 max_clock); + void (*set_default_delay)(struct mmc_host *mmc); }; struct mmc_card; @@ -305,7 +307,7 @@ extern int mmc_resume_host(struct mmc_host *); extern int mmc_power_save_host(struct mmc_host *host); extern int mmc_power_restore_host(struct mmc_host *host); - +extern void mmc_reinit_card(struct mmc_host *); extern void mmc_detect_change(struct mmc_host *, unsigned long delay); extern void mmc_request_done(struct mmc_host *, struct mmc_request *); @@ -344,6 +346,9 @@ int mmc_host_enable(struct mmc_host *host); int mmc_host_disable(struct mmc_host *host); int mmc_host_lazy_disable(struct mmc_host *host); int mmc_pm_notify(struct notifier_block *notify_block, unsigned long, void *); +int mmc_stop_status_cmd(struct mmc_host *host, u32 opcode, u32 *buf); +int mmc_read_data(struct mmc_host *host, u8 *buffer); +#define TEST_BUFFER_SIZE (32*512) static inline void mmc_set_disable_delay(struct mmc_host *host, unsigned int disable_delay) @@ -374,4 +379,3 @@ static inline int mmc_host_cmd23(struct mmc_host *host) return host->caps & MMC_CAP_CMD23; } #endif - -- 1.7.3.4 -- To unsubscribe from this list: send the line "unsubscribe linux-mmc" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html