Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 1 | /* |
| 2 | * SDHCI support for SiRF primaII and marco SoCs |
| 3 | * |
| 4 | * Copyright (c) 2011 Cambridge Silicon Radio Limited, a CSR plc group company. |
| 5 | * |
| 6 | * Licensed under GPLv2 or later. |
| 7 | */ |
| 8 | |
| 9 | #include <linux/delay.h> |
| 10 | #include <linux/device.h> |
| 11 | #include <linux/mmc/host.h> |
| 12 | #include <linux/module.h> |
| 13 | #include <linux/of.h> |
| 14 | #include <linux/of_gpio.h> |
| 15 | #include <linux/mmc/slot-gpio.h> |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 16 | #include "sdhci-pltfm.h" |
| 17 | |
Minda Chen | fc0b638 | 2014-12-04 20:09:20 +0800 | [diff] [blame] | 18 | #define SDHCI_CLK_DELAY_SETTING 0x4C |
Minda Chen | 1ba4c32 | 2014-08-26 10:50:42 +0800 | [diff] [blame] | 19 | #define SDHCI_SIRF_8BITBUS BIT(3) |
Minda Chen | fc0b638 | 2014-12-04 20:09:20 +0800 | [diff] [blame] | 20 | #define SIRF_TUNING_COUNT 128 |
Minda Chen | 1ba4c32 | 2014-08-26 10:50:42 +0800 | [diff] [blame] | 21 | |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 22 | struct sdhci_sirf_priv { |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 23 | int gpio_cd; |
| 24 | }; |
| 25 | |
Minda Chen | 1ba4c32 | 2014-08-26 10:50:42 +0800 | [diff] [blame] | 26 | static void sdhci_sirf_set_bus_width(struct sdhci_host *host, int width) |
| 27 | { |
| 28 | u8 ctrl; |
| 29 | |
| 30 | ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL); |
| 31 | ctrl &= ~(SDHCI_CTRL_4BITBUS | SDHCI_SIRF_8BITBUS); |
| 32 | |
| 33 | /* |
| 34 | * CSR atlas7 and prima2 SD host version is not 3.0 |
| 35 | * 8bit-width enable bit of CSR SD hosts is 3, |
| 36 | * while stardard hosts use bit 5 |
| 37 | */ |
| 38 | if (width == MMC_BUS_WIDTH_8) |
| 39 | ctrl |= SDHCI_SIRF_8BITBUS; |
| 40 | else if (width == MMC_BUS_WIDTH_4) |
| 41 | ctrl |= SDHCI_CTRL_4BITBUS; |
| 42 | |
| 43 | sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL); |
| 44 | } |
| 45 | |
Minda Chen | fc0b638 | 2014-12-04 20:09:20 +0800 | [diff] [blame] | 46 | static int sdhci_sirf_execute_tuning(struct sdhci_host *host, u32 opcode) |
| 47 | { |
| 48 | int tuning_seq_cnt = 3; |
| 49 | u8 phase, tuned_phases[SIRF_TUNING_COUNT]; |
| 50 | u8 tuned_phase_cnt = 0; |
weijun yang | b36ac1b | 2015-02-15 23:43:51 +0800 | [diff] [blame] | 51 | int rc = 0, longest_range = 0; |
Minda Chen | fc0b638 | 2014-12-04 20:09:20 +0800 | [diff] [blame] | 52 | int start = -1, end = 0, tuning_value = -1, range = 0; |
| 53 | u16 clock_setting; |
| 54 | struct mmc_host *mmc = host->mmc; |
| 55 | |
| 56 | clock_setting = sdhci_readw(host, SDHCI_CLK_DELAY_SETTING); |
| 57 | clock_setting &= ~0x3fff; |
| 58 | |
| 59 | retry: |
| 60 | phase = 0; |
| 61 | do { |
| 62 | sdhci_writel(host, |
weijun yang | b36ac1b | 2015-02-15 23:43:51 +0800 | [diff] [blame] | 63 | clock_setting | phase, |
Minda Chen | fc0b638 | 2014-12-04 20:09:20 +0800 | [diff] [blame] | 64 | SDHCI_CLK_DELAY_SETTING); |
| 65 | |
| 66 | if (!mmc_send_tuning(mmc)) { |
| 67 | /* Tuning is successful at this tuning point */ |
| 68 | tuned_phases[tuned_phase_cnt++] = phase; |
| 69 | dev_dbg(mmc_dev(mmc), "%s: Found good phase = %d\n", |
| 70 | mmc_hostname(mmc), phase); |
| 71 | if (start == -1) |
| 72 | start = phase; |
| 73 | end = phase; |
| 74 | range++; |
| 75 | if (phase == (SIRF_TUNING_COUNT - 1) |
| 76 | && range > longest_range) |
| 77 | tuning_value = (start + end) / 2; |
| 78 | } else { |
| 79 | dev_dbg(mmc_dev(mmc), "%s: Found bad phase = %d\n", |
| 80 | mmc_hostname(mmc), phase); |
| 81 | if (range > longest_range) { |
| 82 | tuning_value = (start + end) / 2; |
| 83 | longest_range = range; |
| 84 | } |
| 85 | start = -1; |
| 86 | end = range = 0; |
| 87 | } |
| 88 | } while (++phase < ARRAY_SIZE(tuned_phases)); |
| 89 | |
| 90 | if (tuned_phase_cnt && tuning_value > 0) { |
| 91 | /* |
| 92 | * Finally set the selected phase in delay |
| 93 | * line hw block. |
| 94 | */ |
| 95 | phase = tuning_value; |
| 96 | sdhci_writel(host, |
weijun yang | b36ac1b | 2015-02-15 23:43:51 +0800 | [diff] [blame] | 97 | clock_setting | phase, |
Minda Chen | fc0b638 | 2014-12-04 20:09:20 +0800 | [diff] [blame] | 98 | SDHCI_CLK_DELAY_SETTING); |
| 99 | |
| 100 | dev_dbg(mmc_dev(mmc), "%s: Setting the tuning phase to %d\n", |
| 101 | mmc_hostname(mmc), phase); |
| 102 | } else { |
| 103 | if (--tuning_seq_cnt) |
| 104 | goto retry; |
| 105 | /* Tuning failed */ |
| 106 | dev_dbg(mmc_dev(mmc), "%s: No tuning point found\n", |
| 107 | mmc_hostname(mmc)); |
| 108 | rc = -EIO; |
| 109 | } |
| 110 | |
| 111 | return rc; |
| 112 | } |
| 113 | |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 114 | static struct sdhci_ops sdhci_sirf_ops = { |
Minda Chen | fc0b638 | 2014-12-04 20:09:20 +0800 | [diff] [blame] | 115 | .platform_execute_tuning = sdhci_sirf_execute_tuning, |
Russell King | 1771059 | 2014-04-25 12:58:55 +0100 | [diff] [blame] | 116 | .set_clock = sdhci_set_clock, |
Kevin Hao | e46af29 | 2015-02-27 15:47:28 +0800 | [diff] [blame] | 117 | .get_max_clock = sdhci_pltfm_clk_get_max_clock, |
Minda Chen | 1ba4c32 | 2014-08-26 10:50:42 +0800 | [diff] [blame] | 118 | .set_bus_width = sdhci_sirf_set_bus_width, |
Russell King | 03231f9 | 2014-04-25 12:57:12 +0100 | [diff] [blame] | 119 | .reset = sdhci_reset, |
Russell King | 96d7b78 | 2014-04-25 12:59:26 +0100 | [diff] [blame] | 120 | .set_uhs_signaling = sdhci_set_uhs_signaling, |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 121 | }; |
| 122 | |
| 123 | static struct sdhci_pltfm_data sdhci_sirf_pdata = { |
| 124 | .ops = &sdhci_sirf_ops, |
| 125 | .quirks = SDHCI_QUIRK_BROKEN_TIMEOUT_VAL | |
| 126 | SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK | |
| 127 | SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN | |
| 128 | SDHCI_QUIRK_INVERTED_WRITE_PROTECT | |
| 129 | SDHCI_QUIRK_DELAY_AFTER_POWER, |
| 130 | }; |
| 131 | |
| 132 | static int sdhci_sirf_probe(struct platform_device *pdev) |
| 133 | { |
| 134 | struct sdhci_host *host; |
| 135 | struct sdhci_pltfm_host *pltfm_host; |
| 136 | struct sdhci_sirf_priv *priv; |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 137 | struct clk *clk; |
| 138 | int gpio_cd; |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 139 | int ret; |
| 140 | |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 141 | clk = devm_clk_get(&pdev->dev, NULL); |
| 142 | if (IS_ERR(clk)) { |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 143 | dev_err(&pdev->dev, "unable to get clock"); |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 144 | return PTR_ERR(clk); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 145 | } |
| 146 | |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 147 | if (pdev->dev.of_node) |
| 148 | gpio_cd = of_get_named_gpio(pdev->dev.of_node, "cd-gpios", 0); |
| 149 | else |
| 150 | gpio_cd = -EINVAL; |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 151 | |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 152 | host = sdhci_pltfm_init(pdev, &sdhci_sirf_pdata, sizeof(struct sdhci_sirf_priv)); |
| 153 | if (IS_ERR(host)) |
| 154 | return PTR_ERR(host); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 155 | |
| 156 | pltfm_host = sdhci_priv(host); |
Kevin Hao | e46af29 | 2015-02-27 15:47:28 +0800 | [diff] [blame] | 157 | pltfm_host->clk = clk; |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 158 | priv = sdhci_pltfm_priv(pltfm_host); |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 159 | priv->gpio_cd = gpio_cd; |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 160 | |
| 161 | sdhci_get_of_property(pdev); |
| 162 | |
Kevin Hao | e46af29 | 2015-02-27 15:47:28 +0800 | [diff] [blame] | 163 | ret = clk_prepare_enable(pltfm_host->clk); |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 164 | if (ret) |
| 165 | goto err_clk_prepare; |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 166 | |
| 167 | ret = sdhci_add_host(host); |
| 168 | if (ret) |
| 169 | goto err_sdhci_add; |
| 170 | |
| 171 | /* |
| 172 | * We must request the IRQ after sdhci_add_host(), as the tasklet only |
| 173 | * gets setup in sdhci_add_host() and we oops. |
| 174 | */ |
| 175 | if (gpio_is_valid(priv->gpio_cd)) { |
Laurent Pinchart | 214fc30 | 2013-08-08 12:38:31 +0200 | [diff] [blame] | 176 | ret = mmc_gpio_request_cd(host->mmc, priv->gpio_cd, 0); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 177 | if (ret) { |
| 178 | dev_err(&pdev->dev, "card detect irq request failed: %d\n", |
| 179 | ret); |
| 180 | goto err_request_cd; |
| 181 | } |
Stephen Warren | d4d1144 | 2014-09-22 09:57:42 -0600 | [diff] [blame] | 182 | mmc_gpiod_request_cd_irq(host->mmc); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 183 | } |
| 184 | |
| 185 | return 0; |
| 186 | |
| 187 | err_request_cd: |
| 188 | sdhci_remove_host(host, 0); |
| 189 | err_sdhci_add: |
Kevin Hao | e46af29 | 2015-02-27 15:47:28 +0800 | [diff] [blame] | 190 | clk_disable_unprepare(pltfm_host->clk); |
Arnd Bergmann | e2f6aac | 2013-06-27 11:17:25 -0400 | [diff] [blame] | 191 | err_clk_prepare: |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 192 | sdhci_pltfm_free(pdev); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 193 | return ret; |
| 194 | } |
| 195 | |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 196 | #ifdef CONFIG_PM_SLEEP |
| 197 | static int sdhci_sirf_suspend(struct device *dev) |
| 198 | { |
| 199 | struct sdhci_host *host = dev_get_drvdata(dev); |
| 200 | struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 201 | int ret; |
| 202 | |
| 203 | ret = sdhci_suspend_host(host); |
| 204 | if (ret) |
| 205 | return ret; |
| 206 | |
Kevin Hao | e46af29 | 2015-02-27 15:47:28 +0800 | [diff] [blame] | 207 | clk_disable(pltfm_host->clk); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 208 | |
| 209 | return 0; |
| 210 | } |
| 211 | |
| 212 | static int sdhci_sirf_resume(struct device *dev) |
| 213 | { |
| 214 | struct sdhci_host *host = dev_get_drvdata(dev); |
| 215 | struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 216 | int ret; |
| 217 | |
Kevin Hao | e46af29 | 2015-02-27 15:47:28 +0800 | [diff] [blame] | 218 | ret = clk_enable(pltfm_host->clk); |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 219 | if (ret) { |
| 220 | dev_dbg(dev, "Resume: Error enabling clock\n"); |
| 221 | return ret; |
| 222 | } |
| 223 | |
| 224 | return sdhci_resume_host(host); |
| 225 | } |
| 226 | |
| 227 | static SIMPLE_DEV_PM_OPS(sdhci_sirf_pm_ops, sdhci_sirf_suspend, sdhci_sirf_resume); |
| 228 | #endif |
| 229 | |
| 230 | static const struct of_device_id sdhci_sirf_of_match[] = { |
| 231 | { .compatible = "sirf,prima2-sdhc" }, |
| 232 | { } |
| 233 | }; |
| 234 | MODULE_DEVICE_TABLE(of, sdhci_sirf_of_match); |
| 235 | |
| 236 | static struct platform_driver sdhci_sirf_driver = { |
| 237 | .driver = { |
| 238 | .name = "sdhci-sirf", |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 239 | .of_match_table = sdhci_sirf_of_match, |
| 240 | #ifdef CONFIG_PM_SLEEP |
| 241 | .pm = &sdhci_sirf_pm_ops, |
| 242 | #endif |
| 243 | }, |
| 244 | .probe = sdhci_sirf_probe, |
Kevin Hao | caebcae | 2015-02-27 15:47:31 +0800 | [diff] [blame^] | 245 | .remove = sdhci_pltfm_unregister, |
Barry Song | b3b665b | 2013-03-21 16:27:19 +0800 | [diff] [blame] | 246 | }; |
| 247 | |
| 248 | module_platform_driver(sdhci_sirf_driver); |
| 249 | |
| 250 | MODULE_DESCRIPTION("SDHCI driver for SiRFprimaII/SiRFmarco"); |
| 251 | MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>"); |
| 252 | MODULE_LICENSE("GPL v2"); |