Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 1 | /* |
Yann Gautier | dbb9f57 | 2020-06-12 12:17:17 +0200 | [diff] [blame] | 2 | * Copyright (c) 2018-2020, STMicroelectronics - All Rights Reserved |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 3 | * |
| 4 | * SPDX-License-Identifier: BSD-3-Clause |
| 5 | */ |
| 6 | |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 7 | #include <assert.h> |
| 8 | #include <errno.h> |
| 9 | #include <string.h> |
| 10 | |
Yann Gautier | 57e282b | 2019-01-07 11:17:24 +0100 | [diff] [blame] | 11 | #include <libfdt.h> |
| 12 | |
| 13 | #include <platform_def.h> |
| 14 | |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 15 | #include <arch.h> |
| 16 | #include <arch_helpers.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 17 | #include <common/debug.h> |
| 18 | #include <drivers/delay_timer.h> |
| 19 | #include <drivers/mmc.h> |
Yann Gautier | 038bff2 | 2019-01-17 19:17:47 +0100 | [diff] [blame] | 20 | #include <drivers/st/stm32_gpio.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 21 | #include <drivers/st/stm32_sdmmc2.h> |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 22 | #include <drivers/st/stm32mp_reset.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 23 | #include <lib/mmio.h> |
| 24 | #include <lib/utils.h> |
| 25 | #include <plat/common/platform.h> |
| 26 | |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 27 | /* Registers offsets */ |
| 28 | #define SDMMC_POWER 0x00U |
| 29 | #define SDMMC_CLKCR 0x04U |
| 30 | #define SDMMC_ARGR 0x08U |
| 31 | #define SDMMC_CMDR 0x0CU |
| 32 | #define SDMMC_RESPCMDR 0x10U |
| 33 | #define SDMMC_RESP1R 0x14U |
| 34 | #define SDMMC_RESP2R 0x18U |
| 35 | #define SDMMC_RESP3R 0x1CU |
| 36 | #define SDMMC_RESP4R 0x20U |
| 37 | #define SDMMC_DTIMER 0x24U |
| 38 | #define SDMMC_DLENR 0x28U |
| 39 | #define SDMMC_DCTRLR 0x2CU |
| 40 | #define SDMMC_DCNTR 0x30U |
| 41 | #define SDMMC_STAR 0x34U |
| 42 | #define SDMMC_ICR 0x38U |
| 43 | #define SDMMC_MASKR 0x3CU |
| 44 | #define SDMMC_ACKTIMER 0x40U |
| 45 | #define SDMMC_IDMACTRLR 0x50U |
| 46 | #define SDMMC_IDMABSIZER 0x54U |
| 47 | #define SDMMC_IDMABASE0R 0x58U |
| 48 | #define SDMMC_IDMABASE1R 0x5CU |
| 49 | #define SDMMC_FIFOR 0x80U |
| 50 | |
| 51 | /* SDMMC power control register */ |
| 52 | #define SDMMC_POWER_PWRCTRL GENMASK(1, 0) |
| 53 | #define SDMMC_POWER_DIRPOL BIT(4) |
| 54 | |
| 55 | /* SDMMC clock control register */ |
| 56 | #define SDMMC_CLKCR_WIDBUS_4 BIT(14) |
| 57 | #define SDMMC_CLKCR_WIDBUS_8 BIT(15) |
| 58 | #define SDMMC_CLKCR_NEGEDGE BIT(16) |
| 59 | #define SDMMC_CLKCR_HWFC_EN BIT(17) |
| 60 | #define SDMMC_CLKCR_SELCLKRX_0 BIT(20) |
| 61 | |
| 62 | /* SDMMC command register */ |
| 63 | #define SDMMC_CMDR_CMDTRANS BIT(6) |
| 64 | #define SDMMC_CMDR_CMDSTOP BIT(7) |
| 65 | #define SDMMC_CMDR_WAITRESP GENMASK(9, 8) |
| 66 | #define SDMMC_CMDR_WAITRESP_SHORT BIT(8) |
| 67 | #define SDMMC_CMDR_WAITRESP_SHORT_NOCRC BIT(9) |
| 68 | #define SDMMC_CMDR_CPSMEN BIT(12) |
| 69 | |
| 70 | /* SDMMC data control register */ |
| 71 | #define SDMMC_DCTRLR_DTEN BIT(0) |
| 72 | #define SDMMC_DCTRLR_DTDIR BIT(1) |
| 73 | #define SDMMC_DCTRLR_DTMODE GENMASK(3, 2) |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 74 | #define SDMMC_DCTRLR_DBLOCKSIZE GENMASK(7, 4) |
Yann Gautier | 6d9e6a0 | 2019-06-11 20:03:07 +0200 | [diff] [blame] | 75 | #define SDMMC_DCTRLR_DBLOCKSIZE_SHIFT 4 |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 76 | #define SDMMC_DCTRLR_FIFORST BIT(13) |
| 77 | |
| 78 | #define SDMMC_DCTRLR_CLEAR_MASK (SDMMC_DCTRLR_DTEN | \ |
| 79 | SDMMC_DCTRLR_DTDIR | \ |
| 80 | SDMMC_DCTRLR_DTMODE | \ |
| 81 | SDMMC_DCTRLR_DBLOCKSIZE) |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 82 | |
| 83 | /* SDMMC status register */ |
| 84 | #define SDMMC_STAR_CCRCFAIL BIT(0) |
| 85 | #define SDMMC_STAR_DCRCFAIL BIT(1) |
| 86 | #define SDMMC_STAR_CTIMEOUT BIT(2) |
| 87 | #define SDMMC_STAR_DTIMEOUT BIT(3) |
| 88 | #define SDMMC_STAR_TXUNDERR BIT(4) |
| 89 | #define SDMMC_STAR_RXOVERR BIT(5) |
| 90 | #define SDMMC_STAR_CMDREND BIT(6) |
| 91 | #define SDMMC_STAR_CMDSENT BIT(7) |
| 92 | #define SDMMC_STAR_DATAEND BIT(8) |
| 93 | #define SDMMC_STAR_DBCKEND BIT(10) |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 94 | #define SDMMC_STAR_DPSMACT BIT(12) |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 95 | #define SDMMC_STAR_RXFIFOHF BIT(15) |
| 96 | #define SDMMC_STAR_RXFIFOE BIT(19) |
| 97 | #define SDMMC_STAR_IDMATE BIT(27) |
| 98 | #define SDMMC_STAR_IDMABTC BIT(28) |
| 99 | |
| 100 | /* SDMMC DMA control register */ |
| 101 | #define SDMMC_IDMACTRLR_IDMAEN BIT(0) |
| 102 | |
| 103 | #define SDMMC_STATIC_FLAGS (SDMMC_STAR_CCRCFAIL | \ |
| 104 | SDMMC_STAR_DCRCFAIL | \ |
| 105 | SDMMC_STAR_CTIMEOUT | \ |
| 106 | SDMMC_STAR_DTIMEOUT | \ |
| 107 | SDMMC_STAR_TXUNDERR | \ |
| 108 | SDMMC_STAR_RXOVERR | \ |
| 109 | SDMMC_STAR_CMDREND | \ |
| 110 | SDMMC_STAR_CMDSENT | \ |
| 111 | SDMMC_STAR_DATAEND | \ |
| 112 | SDMMC_STAR_DBCKEND | \ |
| 113 | SDMMC_STAR_IDMATE | \ |
| 114 | SDMMC_STAR_IDMABTC) |
| 115 | |
Etienne Carriere | f02647a | 2019-12-08 08:14:40 +0100 | [diff] [blame] | 116 | #define TIMEOUT_US_1_MS 1000U |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 117 | #define TIMEOUT_US_10_MS 10000U |
| 118 | #define TIMEOUT_US_1_S 1000000U |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 119 | |
| 120 | #define DT_SDMMC2_COMPAT "st,stm32-sdmmc2" |
| 121 | |
| 122 | static void stm32_sdmmc2_init(void); |
| 123 | static int stm32_sdmmc2_send_cmd_req(struct mmc_cmd *cmd); |
| 124 | static int stm32_sdmmc2_send_cmd(struct mmc_cmd *cmd); |
| 125 | static int stm32_sdmmc2_set_ios(unsigned int clk, unsigned int width); |
| 126 | static int stm32_sdmmc2_prepare(int lba, uintptr_t buf, size_t size); |
| 127 | static int stm32_sdmmc2_read(int lba, uintptr_t buf, size_t size); |
| 128 | static int stm32_sdmmc2_write(int lba, uintptr_t buf, size_t size); |
| 129 | |
| 130 | static const struct mmc_ops stm32_sdmmc2_ops = { |
| 131 | .init = stm32_sdmmc2_init, |
| 132 | .send_cmd = stm32_sdmmc2_send_cmd, |
| 133 | .set_ios = stm32_sdmmc2_set_ios, |
| 134 | .prepare = stm32_sdmmc2_prepare, |
| 135 | .read = stm32_sdmmc2_read, |
| 136 | .write = stm32_sdmmc2_write, |
| 137 | }; |
| 138 | |
| 139 | static struct stm32_sdmmc2_params sdmmc2_params; |
| 140 | |
| 141 | #pragma weak plat_sdmmc2_use_dma |
| 142 | bool plat_sdmmc2_use_dma(unsigned int instance, unsigned int memory) |
| 143 | { |
| 144 | return false; |
| 145 | } |
| 146 | |
| 147 | static void stm32_sdmmc2_init(void) |
| 148 | { |
| 149 | uint32_t clock_div; |
Yann Gautier | 3194afe | 2019-05-28 11:54:50 +0200 | [diff] [blame] | 150 | uint32_t freq = STM32MP_MMC_INIT_FREQ; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 151 | uintptr_t base = sdmmc2_params.reg_base; |
| 152 | |
Yann Gautier | 3194afe | 2019-05-28 11:54:50 +0200 | [diff] [blame] | 153 | if (sdmmc2_params.max_freq != 0U) { |
| 154 | freq = MIN(sdmmc2_params.max_freq, freq); |
| 155 | } |
| 156 | |
| 157 | clock_div = div_round_up(sdmmc2_params.clk_rate, freq * 2U); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 158 | |
| 159 | mmio_write_32(base + SDMMC_CLKCR, SDMMC_CLKCR_HWFC_EN | clock_div | |
| 160 | sdmmc2_params.negedge | |
| 161 | sdmmc2_params.pin_ckin); |
| 162 | |
| 163 | mmio_write_32(base + SDMMC_POWER, |
| 164 | SDMMC_POWER_PWRCTRL | sdmmc2_params.dirpol); |
| 165 | |
| 166 | mdelay(1); |
| 167 | } |
| 168 | |
| 169 | static int stm32_sdmmc2_stop_transfer(void) |
| 170 | { |
| 171 | struct mmc_cmd cmd_stop; |
| 172 | |
| 173 | zeromem(&cmd_stop, sizeof(struct mmc_cmd)); |
| 174 | |
| 175 | cmd_stop.cmd_idx = MMC_CMD(12); |
| 176 | cmd_stop.resp_type = MMC_RESPONSE_R1B; |
| 177 | |
| 178 | return stm32_sdmmc2_send_cmd(&cmd_stop); |
| 179 | } |
| 180 | |
| 181 | static int stm32_sdmmc2_send_cmd_req(struct mmc_cmd *cmd) |
| 182 | { |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 183 | uint64_t timeout; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 184 | uint32_t flags_cmd, status; |
| 185 | uint32_t flags_data = 0; |
| 186 | int err = 0; |
| 187 | uintptr_t base = sdmmc2_params.reg_base; |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 188 | unsigned int cmd_reg, arg_reg; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 189 | |
| 190 | if (cmd == NULL) { |
| 191 | return -EINVAL; |
| 192 | } |
| 193 | |
| 194 | flags_cmd = SDMMC_STAR_CTIMEOUT; |
| 195 | arg_reg = cmd->cmd_arg; |
| 196 | |
| 197 | if ((mmio_read_32(base + SDMMC_CMDR) & SDMMC_CMDR_CPSMEN) != 0U) { |
| 198 | mmio_write_32(base + SDMMC_CMDR, 0); |
| 199 | } |
| 200 | |
| 201 | cmd_reg = cmd->cmd_idx | SDMMC_CMDR_CPSMEN; |
| 202 | |
| 203 | if (cmd->resp_type == 0U) { |
| 204 | flags_cmd |= SDMMC_STAR_CMDSENT; |
| 205 | } |
| 206 | |
| 207 | if ((cmd->resp_type & MMC_RSP_48) != 0U) { |
| 208 | if ((cmd->resp_type & MMC_RSP_136) != 0U) { |
| 209 | flags_cmd |= SDMMC_STAR_CMDREND; |
| 210 | cmd_reg |= SDMMC_CMDR_WAITRESP; |
| 211 | } else if ((cmd->resp_type & MMC_RSP_CRC) != 0U) { |
| 212 | flags_cmd |= SDMMC_STAR_CMDREND | SDMMC_STAR_CCRCFAIL; |
| 213 | cmd_reg |= SDMMC_CMDR_WAITRESP_SHORT; |
| 214 | } else { |
| 215 | flags_cmd |= SDMMC_STAR_CMDREND; |
| 216 | cmd_reg |= SDMMC_CMDR_WAITRESP_SHORT_NOCRC; |
| 217 | } |
| 218 | } |
| 219 | |
| 220 | switch (cmd->cmd_idx) { |
| 221 | case MMC_CMD(1): |
| 222 | arg_reg |= OCR_POWERUP; |
| 223 | break; |
| 224 | case MMC_CMD(8): |
| 225 | if (sdmmc2_params.device_info->mmc_dev_type == MMC_IS_EMMC) { |
| 226 | cmd_reg |= SDMMC_CMDR_CMDTRANS; |
| 227 | } |
| 228 | break; |
| 229 | case MMC_CMD(12): |
| 230 | cmd_reg |= SDMMC_CMDR_CMDSTOP; |
| 231 | break; |
| 232 | case MMC_CMD(17): |
| 233 | case MMC_CMD(18): |
| 234 | cmd_reg |= SDMMC_CMDR_CMDTRANS; |
| 235 | if (sdmmc2_params.use_dma) { |
| 236 | flags_data |= SDMMC_STAR_DCRCFAIL | |
| 237 | SDMMC_STAR_DTIMEOUT | |
| 238 | SDMMC_STAR_DATAEND | |
| 239 | SDMMC_STAR_RXOVERR | |
| 240 | SDMMC_STAR_IDMATE; |
| 241 | } |
| 242 | break; |
| 243 | case MMC_ACMD(41): |
| 244 | arg_reg |= OCR_3_2_3_3 | OCR_3_3_3_4; |
| 245 | break; |
| 246 | case MMC_ACMD(51): |
| 247 | cmd_reg |= SDMMC_CMDR_CMDTRANS; |
| 248 | if (sdmmc2_params.use_dma) { |
| 249 | flags_data |= SDMMC_STAR_DCRCFAIL | |
| 250 | SDMMC_STAR_DTIMEOUT | |
| 251 | SDMMC_STAR_DATAEND | |
| 252 | SDMMC_STAR_RXOVERR | |
| 253 | SDMMC_STAR_IDMATE | |
| 254 | SDMMC_STAR_DBCKEND; |
| 255 | } |
| 256 | break; |
| 257 | default: |
| 258 | break; |
| 259 | } |
| 260 | |
Yann Gautier | 1045422 | 2020-06-12 14:14:26 +0200 | [diff] [blame] | 261 | mmio_write_32(base + SDMMC_ICR, SDMMC_STATIC_FLAGS); |
| 262 | |
| 263 | /* |
| 264 | * Clear the SDMMC_DCTRLR if the command does not await data. |
| 265 | * Skip CMD55 as the next command could be data related, and |
| 266 | * the register could have been set in prepare function. |
| 267 | */ |
| 268 | if (((cmd_reg & SDMMC_CMDR_CMDTRANS) == 0U) && |
| 269 | (cmd->cmd_idx != MMC_CMD(55))) { |
| 270 | mmio_write_32(base + SDMMC_DCTRLR, 0U); |
| 271 | } |
| 272 | |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 273 | if ((cmd->resp_type & MMC_RSP_BUSY) != 0U) { |
| 274 | mmio_write_32(base + SDMMC_DTIMER, UINT32_MAX); |
| 275 | } |
| 276 | |
| 277 | mmio_write_32(base + SDMMC_ARGR, arg_reg); |
| 278 | |
| 279 | mmio_write_32(base + SDMMC_CMDR, cmd_reg); |
| 280 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 281 | status = mmio_read_32(base + SDMMC_STAR); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 282 | |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 283 | timeout = timeout_init_us(TIMEOUT_US_10_MS); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 284 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 285 | while ((status & flags_cmd) == 0U) { |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 286 | if (timeout_elapsed(timeout)) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 287 | err = -ETIMEDOUT; |
| 288 | ERROR("%s: timeout 10ms (cmd = %d,status = %x)\n", |
| 289 | __func__, cmd->cmd_idx, status); |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 290 | goto err_exit; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 291 | } |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 292 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 293 | status = mmio_read_32(base + SDMMC_STAR); |
| 294 | } |
| 295 | |
| 296 | if ((status & (SDMMC_STAR_CTIMEOUT | SDMMC_STAR_CCRCFAIL)) != 0U) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 297 | if ((status & SDMMC_STAR_CTIMEOUT) != 0U) { |
| 298 | err = -ETIMEDOUT; |
| 299 | /* |
| 300 | * Those timeouts can occur, and framework will handle |
| 301 | * the retries. CMD8 is expected to return this timeout |
| 302 | * for eMMC |
| 303 | */ |
| 304 | if (!((cmd->cmd_idx == MMC_CMD(1)) || |
| 305 | (cmd->cmd_idx == MMC_CMD(13)) || |
| 306 | ((cmd->cmd_idx == MMC_CMD(8)) && |
| 307 | (cmd->resp_type == MMC_RESPONSE_R7)))) { |
| 308 | ERROR("%s: CTIMEOUT (cmd = %d,status = %x)\n", |
| 309 | __func__, cmd->cmd_idx, status); |
| 310 | } |
| 311 | } else { |
| 312 | err = -EIO; |
| 313 | ERROR("%s: CRCFAIL (cmd = %d,status = %x)\n", |
| 314 | __func__, cmd->cmd_idx, status); |
| 315 | } |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 316 | |
| 317 | goto err_exit; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 318 | } |
| 319 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 320 | if ((cmd_reg & SDMMC_CMDR_WAITRESP) != 0U) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 321 | if ((cmd->cmd_idx == MMC_CMD(9)) && |
| 322 | ((cmd_reg & SDMMC_CMDR_WAITRESP) == SDMMC_CMDR_WAITRESP)) { |
| 323 | /* Need to invert response to match CSD structure */ |
| 324 | cmd->resp_data[0] = mmio_read_32(base + SDMMC_RESP4R); |
| 325 | cmd->resp_data[1] = mmio_read_32(base + SDMMC_RESP3R); |
| 326 | cmd->resp_data[2] = mmio_read_32(base + SDMMC_RESP2R); |
| 327 | cmd->resp_data[3] = mmio_read_32(base + SDMMC_RESP1R); |
| 328 | } else { |
| 329 | cmd->resp_data[0] = mmio_read_32(base + SDMMC_RESP1R); |
| 330 | if ((cmd_reg & SDMMC_CMDR_WAITRESP) == |
| 331 | SDMMC_CMDR_WAITRESP) { |
| 332 | cmd->resp_data[1] = mmio_read_32(base + |
| 333 | SDMMC_RESP2R); |
| 334 | cmd->resp_data[2] = mmio_read_32(base + |
| 335 | SDMMC_RESP3R); |
| 336 | cmd->resp_data[3] = mmio_read_32(base + |
| 337 | SDMMC_RESP4R); |
| 338 | } |
| 339 | } |
| 340 | } |
| 341 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 342 | if (flags_data == 0U) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 343 | mmio_write_32(base + SDMMC_ICR, SDMMC_STATIC_FLAGS); |
| 344 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 345 | return 0; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 346 | } |
| 347 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 348 | status = mmio_read_32(base + SDMMC_STAR); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 349 | |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 350 | timeout = timeout_init_us(TIMEOUT_US_10_MS); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 351 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 352 | while ((status & flags_data) == 0U) { |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 353 | if (timeout_elapsed(timeout)) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 354 | ERROR("%s: timeout 10ms (cmd = %d,status = %x)\n", |
| 355 | __func__, cmd->cmd_idx, status); |
| 356 | err = -ETIMEDOUT; |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 357 | goto err_exit; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 358 | } |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 359 | |
| 360 | status = mmio_read_32(base + SDMMC_STAR); |
| 361 | }; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 362 | |
| 363 | if ((status & (SDMMC_STAR_DTIMEOUT | SDMMC_STAR_DCRCFAIL | |
| 364 | SDMMC_STAR_TXUNDERR | SDMMC_STAR_RXOVERR | |
| 365 | SDMMC_STAR_IDMATE)) != 0U) { |
| 366 | ERROR("%s: Error flag (cmd = %d,status = %x)\n", __func__, |
| 367 | cmd->cmd_idx, status); |
| 368 | err = -EIO; |
| 369 | } |
| 370 | |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 371 | err_exit: |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 372 | mmio_write_32(base + SDMMC_ICR, SDMMC_STATIC_FLAGS); |
| 373 | mmio_clrbits_32(base + SDMMC_CMDR, SDMMC_CMDR_CMDTRANS); |
| 374 | |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 375 | if ((err != 0) && ((status & SDMMC_STAR_DPSMACT) != 0U)) { |
Yann Gautier | e88fdd7 | 2018-11-30 15:22:11 +0100 | [diff] [blame] | 376 | int ret_stop = stm32_sdmmc2_stop_transfer(); |
| 377 | |
| 378 | if (ret_stop != 0) { |
| 379 | return ret_stop; |
| 380 | } |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 381 | } |
| 382 | |
| 383 | return err; |
| 384 | } |
| 385 | |
| 386 | static int stm32_sdmmc2_send_cmd(struct mmc_cmd *cmd) |
| 387 | { |
Yann Gautier | dbb9f57 | 2020-06-12 12:17:17 +0200 | [diff] [blame] | 388 | uint8_t retry; |
| 389 | int err; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 390 | |
| 391 | assert(cmd != NULL); |
| 392 | |
Yann Gautier | dbb9f57 | 2020-06-12 12:17:17 +0200 | [diff] [blame] | 393 | for (retry = 0U; retry < 3U; retry++) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 394 | err = stm32_sdmmc2_send_cmd_req(cmd); |
| 395 | if (err == 0) { |
Yann Gautier | dbb9f57 | 2020-06-12 12:17:17 +0200 | [diff] [blame] | 396 | return 0; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 397 | } |
| 398 | |
| 399 | if ((cmd->cmd_idx == MMC_CMD(1)) || |
| 400 | (cmd->cmd_idx == MMC_CMD(13))) { |
| 401 | return 0; /* Retry managed by framework */ |
| 402 | } |
| 403 | |
| 404 | /* Command 8 is expected to fail for eMMC */ |
Yann Gautier | dbb9f57 | 2020-06-12 12:17:17 +0200 | [diff] [blame] | 405 | if (cmd->cmd_idx != MMC_CMD(8)) { |
| 406 | WARN(" CMD%u, Retry: %u, Error: %d\n", |
| 407 | cmd->cmd_idx, retry + 1U, err); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 408 | } |
| 409 | |
Yann Gautier | dbb9f57 | 2020-06-12 12:17:17 +0200 | [diff] [blame] | 410 | udelay(10U); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 411 | } |
| 412 | |
| 413 | return err; |
| 414 | } |
| 415 | |
| 416 | static int stm32_sdmmc2_set_ios(unsigned int clk, unsigned int width) |
| 417 | { |
| 418 | uintptr_t base = sdmmc2_params.reg_base; |
| 419 | uint32_t bus_cfg = 0; |
Yann Gautier | 3194afe | 2019-05-28 11:54:50 +0200 | [diff] [blame] | 420 | uint32_t clock_div, max_freq, freq; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 421 | uint32_t clk_rate = sdmmc2_params.clk_rate; |
| 422 | uint32_t max_bus_freq = sdmmc2_params.device_info->max_bus_freq; |
| 423 | |
| 424 | switch (width) { |
| 425 | case MMC_BUS_WIDTH_1: |
| 426 | break; |
| 427 | case MMC_BUS_WIDTH_4: |
| 428 | bus_cfg |= SDMMC_CLKCR_WIDBUS_4; |
| 429 | break; |
| 430 | case MMC_BUS_WIDTH_8: |
| 431 | bus_cfg |= SDMMC_CLKCR_WIDBUS_8; |
| 432 | break; |
| 433 | default: |
| 434 | panic(); |
| 435 | break; |
| 436 | } |
| 437 | |
| 438 | if (sdmmc2_params.device_info->mmc_dev_type == MMC_IS_EMMC) { |
| 439 | if (max_bus_freq >= 52000000U) { |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 440 | max_freq = STM32MP_EMMC_HIGH_SPEED_MAX_FREQ; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 441 | } else { |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 442 | max_freq = STM32MP_EMMC_NORMAL_SPEED_MAX_FREQ; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 443 | } |
| 444 | } else { |
| 445 | if (max_bus_freq >= 50000000U) { |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 446 | max_freq = STM32MP_SD_HIGH_SPEED_MAX_FREQ; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 447 | } else { |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 448 | max_freq = STM32MP_SD_NORMAL_SPEED_MAX_FREQ; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 449 | } |
| 450 | } |
| 451 | |
Yann Gautier | 3194afe | 2019-05-28 11:54:50 +0200 | [diff] [blame] | 452 | if (sdmmc2_params.max_freq != 0U) { |
| 453 | freq = MIN(sdmmc2_params.max_freq, max_freq); |
| 454 | } else { |
| 455 | freq = max_freq; |
| 456 | } |
| 457 | |
| 458 | clock_div = div_round_up(clk_rate, freq * 2U); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 459 | |
| 460 | mmio_write_32(base + SDMMC_CLKCR, |
| 461 | SDMMC_CLKCR_HWFC_EN | clock_div | bus_cfg | |
| 462 | sdmmc2_params.negedge | |
| 463 | sdmmc2_params.pin_ckin); |
| 464 | |
| 465 | return 0; |
| 466 | } |
| 467 | |
| 468 | static int stm32_sdmmc2_prepare(int lba, uintptr_t buf, size_t size) |
| 469 | { |
| 470 | struct mmc_cmd cmd; |
| 471 | int ret; |
| 472 | uintptr_t base = sdmmc2_params.reg_base; |
| 473 | uint32_t data_ctrl = SDMMC_DCTRLR_DTDIR; |
Yann Gautier | 6d9e6a0 | 2019-06-11 20:03:07 +0200 | [diff] [blame] | 474 | uint32_t arg_size; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 475 | |
Yann Gautier | 6d9e6a0 | 2019-06-11 20:03:07 +0200 | [diff] [blame] | 476 | assert(size != 0U); |
| 477 | |
| 478 | if (size > MMC_BLOCK_SIZE) { |
| 479 | arg_size = MMC_BLOCK_SIZE; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 480 | } else { |
Yann Gautier | 6d9e6a0 | 2019-06-11 20:03:07 +0200 | [diff] [blame] | 481 | arg_size = size; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 482 | } |
| 483 | |
| 484 | sdmmc2_params.use_dma = plat_sdmmc2_use_dma(base, buf); |
| 485 | |
| 486 | if (sdmmc2_params.use_dma) { |
| 487 | inv_dcache_range(buf, size); |
| 488 | } |
| 489 | |
| 490 | /* Prepare CMD 16*/ |
Yann Gautier | 1a3fc9f | 2019-01-17 14:35:22 +0100 | [diff] [blame] | 491 | mmio_write_32(base + SDMMC_DTIMER, 0); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 492 | |
| 493 | mmio_write_32(base + SDMMC_DLENR, 0); |
| 494 | |
Yann Gautier | 1a3fc9f | 2019-01-17 14:35:22 +0100 | [diff] [blame] | 495 | mmio_write_32(base + SDMMC_DCTRLR, 0); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 496 | |
| 497 | zeromem(&cmd, sizeof(struct mmc_cmd)); |
| 498 | |
| 499 | cmd.cmd_idx = MMC_CMD(16); |
Yann Gautier | 6d9e6a0 | 2019-06-11 20:03:07 +0200 | [diff] [blame] | 500 | cmd.cmd_arg = arg_size; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 501 | cmd.resp_type = MMC_RESPONSE_R1; |
| 502 | |
| 503 | ret = stm32_sdmmc2_send_cmd(&cmd); |
| 504 | if (ret != 0) { |
| 505 | ERROR("CMD16 failed\n"); |
| 506 | return ret; |
| 507 | } |
| 508 | |
| 509 | /* Prepare data command */ |
| 510 | mmio_write_32(base + SDMMC_DTIMER, UINT32_MAX); |
| 511 | |
| 512 | mmio_write_32(base + SDMMC_DLENR, size); |
| 513 | |
| 514 | if (sdmmc2_params.use_dma) { |
| 515 | mmio_write_32(base + SDMMC_IDMACTRLR, |
| 516 | SDMMC_IDMACTRLR_IDMAEN); |
| 517 | mmio_write_32(base + SDMMC_IDMABASE0R, buf); |
| 518 | |
| 519 | flush_dcache_range(buf, size); |
| 520 | } |
| 521 | |
Yann Gautier | 6d9e6a0 | 2019-06-11 20:03:07 +0200 | [diff] [blame] | 522 | data_ctrl |= __builtin_ctz(arg_size) << SDMMC_DCTRLR_DBLOCKSIZE_SHIFT; |
| 523 | |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 524 | mmio_clrsetbits_32(base + SDMMC_DCTRLR, |
| 525 | SDMMC_DCTRLR_CLEAR_MASK, |
| 526 | data_ctrl); |
| 527 | |
| 528 | return 0; |
| 529 | } |
| 530 | |
| 531 | static int stm32_sdmmc2_read(int lba, uintptr_t buf, size_t size) |
| 532 | { |
| 533 | uint32_t error_flags = SDMMC_STAR_RXOVERR | SDMMC_STAR_DCRCFAIL | |
| 534 | SDMMC_STAR_DTIMEOUT; |
| 535 | uint32_t flags = error_flags | SDMMC_STAR_DATAEND; |
| 536 | uint32_t status; |
| 537 | uint32_t *buffer; |
| 538 | uintptr_t base = sdmmc2_params.reg_base; |
| 539 | uintptr_t fifo_reg = base + SDMMC_FIFOR; |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 540 | uint64_t timeout; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 541 | int ret; |
| 542 | |
| 543 | /* Assert buf is 4 bytes aligned */ |
| 544 | assert((buf & GENMASK(1, 0)) == 0U); |
| 545 | |
| 546 | buffer = (uint32_t *)buf; |
| 547 | |
| 548 | if (sdmmc2_params.use_dma) { |
| 549 | inv_dcache_range(buf, size); |
| 550 | |
| 551 | return 0; |
| 552 | } |
| 553 | |
| 554 | if (size <= MMC_BLOCK_SIZE) { |
| 555 | flags |= SDMMC_STAR_DBCKEND; |
| 556 | } |
| 557 | |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 558 | timeout = timeout_init_us(TIMEOUT_US_1_S); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 559 | |
| 560 | do { |
| 561 | status = mmio_read_32(base + SDMMC_STAR); |
| 562 | |
| 563 | if ((status & error_flags) != 0U) { |
| 564 | ERROR("%s: Read error (status = %x)\n", __func__, |
| 565 | status); |
| 566 | mmio_write_32(base + SDMMC_DCTRLR, |
| 567 | SDMMC_DCTRLR_FIFORST); |
| 568 | |
| 569 | mmio_write_32(base + SDMMC_ICR, |
| 570 | SDMMC_STATIC_FLAGS); |
| 571 | |
| 572 | ret = stm32_sdmmc2_stop_transfer(); |
| 573 | if (ret != 0) { |
| 574 | return ret; |
| 575 | } |
| 576 | |
| 577 | return -EIO; |
| 578 | } |
| 579 | |
Yann Gautier | 2299d57 | 2019-02-14 11:14:39 +0100 | [diff] [blame] | 580 | if (timeout_elapsed(timeout)) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 581 | ERROR("%s: timeout 1s (status = %x)\n", |
| 582 | __func__, status); |
| 583 | mmio_write_32(base + SDMMC_ICR, |
| 584 | SDMMC_STATIC_FLAGS); |
| 585 | |
| 586 | ret = stm32_sdmmc2_stop_transfer(); |
| 587 | if (ret != 0) { |
| 588 | return ret; |
| 589 | } |
| 590 | |
| 591 | return -ETIMEDOUT; |
| 592 | } |
| 593 | |
| 594 | if (size < (8U * sizeof(uint32_t))) { |
| 595 | if ((mmio_read_32(base + SDMMC_DCNTR) > 0U) && |
| 596 | ((status & SDMMC_STAR_RXFIFOE) == 0U)) { |
| 597 | *buffer = mmio_read_32(fifo_reg); |
| 598 | buffer++; |
| 599 | } |
| 600 | } else if ((status & SDMMC_STAR_RXFIFOHF) != 0U) { |
| 601 | uint32_t count; |
| 602 | |
| 603 | /* Read data from SDMMC Rx FIFO */ |
| 604 | for (count = 0; count < 8U; count++) { |
| 605 | *buffer = mmio_read_32(fifo_reg); |
| 606 | buffer++; |
| 607 | } |
| 608 | } |
| 609 | } while ((status & flags) == 0U); |
| 610 | |
| 611 | mmio_write_32(base + SDMMC_ICR, SDMMC_STATIC_FLAGS); |
| 612 | |
| 613 | if ((status & SDMMC_STAR_DPSMACT) != 0U) { |
| 614 | WARN("%s: DPSMACT=1, send stop\n", __func__); |
| 615 | return stm32_sdmmc2_stop_transfer(); |
| 616 | } |
| 617 | |
| 618 | return 0; |
| 619 | } |
| 620 | |
| 621 | static int stm32_sdmmc2_write(int lba, uintptr_t buf, size_t size) |
| 622 | { |
| 623 | return 0; |
| 624 | } |
| 625 | |
| 626 | static int stm32_sdmmc2_dt_get_config(void) |
| 627 | { |
| 628 | int sdmmc_node; |
| 629 | void *fdt = NULL; |
| 630 | const fdt32_t *cuint; |
Yann Gautier | e289cb0 | 2019-11-04 14:27:23 +0100 | [diff] [blame] | 631 | struct dt_node_info dt_info; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 632 | |
| 633 | if (fdt_get_address(&fdt) == 0) { |
| 634 | return -FDT_ERR_NOTFOUND; |
| 635 | } |
| 636 | |
| 637 | if (fdt == NULL) { |
| 638 | return -FDT_ERR_NOTFOUND; |
| 639 | } |
| 640 | |
Yann Gautier | e289cb0 | 2019-11-04 14:27:23 +0100 | [diff] [blame] | 641 | sdmmc_node = dt_match_instance_by_compatible(DT_SDMMC2_COMPAT, |
| 642 | sdmmc2_params.reg_base); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 643 | if (sdmmc_node == -FDT_ERR_NOTFOUND) { |
| 644 | return -FDT_ERR_NOTFOUND; |
| 645 | } |
| 646 | |
Yann Gautier | e289cb0 | 2019-11-04 14:27:23 +0100 | [diff] [blame] | 647 | dt_fill_device_info(&dt_info, sdmmc_node); |
| 648 | if (dt_info.status == DT_DISABLED) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 649 | return -FDT_ERR_NOTFOUND; |
| 650 | } |
| 651 | |
| 652 | if (dt_set_pinctrl_config(sdmmc_node) != 0) { |
| 653 | return -FDT_ERR_BADVALUE; |
| 654 | } |
| 655 | |
Yann Gautier | e289cb0 | 2019-11-04 14:27:23 +0100 | [diff] [blame] | 656 | sdmmc2_params.clock_id = dt_info.clock; |
| 657 | sdmmc2_params.reset_id = dt_info.reset; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 658 | |
Yann Gautier | 7b7e4bf | 2019-01-17 19:16:03 +0100 | [diff] [blame] | 659 | if ((fdt_getprop(fdt, sdmmc_node, "st,use-ckin", NULL)) != NULL) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 660 | sdmmc2_params.pin_ckin = SDMMC_CLKCR_SELCLKRX_0; |
| 661 | } |
| 662 | |
Yann Gautier | 7b7e4bf | 2019-01-17 19:16:03 +0100 | [diff] [blame] | 663 | if ((fdt_getprop(fdt, sdmmc_node, "st,sig-dir", NULL)) != NULL) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 664 | sdmmc2_params.dirpol = SDMMC_POWER_DIRPOL; |
| 665 | } |
| 666 | |
Yann Gautier | 7b7e4bf | 2019-01-17 19:16:03 +0100 | [diff] [blame] | 667 | if ((fdt_getprop(fdt, sdmmc_node, "st,neg-edge", NULL)) != NULL) { |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 668 | sdmmc2_params.negedge = SDMMC_CLKCR_NEGEDGE; |
| 669 | } |
| 670 | |
| 671 | cuint = fdt_getprop(fdt, sdmmc_node, "bus-width", NULL); |
| 672 | if (cuint != NULL) { |
| 673 | switch (fdt32_to_cpu(*cuint)) { |
| 674 | case 4: |
| 675 | sdmmc2_params.bus_width = MMC_BUS_WIDTH_4; |
| 676 | break; |
| 677 | |
| 678 | case 8: |
| 679 | sdmmc2_params.bus_width = MMC_BUS_WIDTH_8; |
| 680 | break; |
| 681 | |
| 682 | default: |
| 683 | break; |
| 684 | } |
| 685 | } |
| 686 | |
Yann Gautier | 3194afe | 2019-05-28 11:54:50 +0200 | [diff] [blame] | 687 | cuint = fdt_getprop(fdt, sdmmc_node, "max-frequency", NULL); |
| 688 | if (cuint != NULL) { |
| 689 | sdmmc2_params.max_freq = fdt32_to_cpu(*cuint); |
| 690 | } |
| 691 | |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 692 | return 0; |
| 693 | } |
| 694 | |
| 695 | unsigned long long stm32_sdmmc2_mmc_get_device_size(void) |
| 696 | { |
| 697 | return sdmmc2_params.device_info->device_size; |
| 698 | } |
| 699 | |
| 700 | int stm32_sdmmc2_mmc_init(struct stm32_sdmmc2_params *params) |
| 701 | { |
Etienne Carriere | f02647a | 2019-12-08 08:14:40 +0100 | [diff] [blame] | 702 | int rc; |
| 703 | |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 704 | assert((params != NULL) && |
| 705 | ((params->reg_base & MMC_BLOCK_MASK) == 0U) && |
| 706 | ((params->bus_width == MMC_BUS_WIDTH_1) || |
| 707 | (params->bus_width == MMC_BUS_WIDTH_4) || |
| 708 | (params->bus_width == MMC_BUS_WIDTH_8))); |
| 709 | |
| 710 | memcpy(&sdmmc2_params, params, sizeof(struct stm32_sdmmc2_params)); |
| 711 | |
| 712 | if (stm32_sdmmc2_dt_get_config() != 0) { |
| 713 | ERROR("%s: DT error\n", __func__); |
| 714 | return -ENOMEM; |
| 715 | } |
| 716 | |
Yann Gautier | e4a3c35 | 2019-02-14 10:53:33 +0100 | [diff] [blame] | 717 | stm32mp_clk_enable(sdmmc2_params.clock_id); |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 718 | |
Etienne Carriere | f02647a | 2019-12-08 08:14:40 +0100 | [diff] [blame] | 719 | rc = stm32mp_reset_assert(sdmmc2_params.reset_id, TIMEOUT_US_1_MS); |
| 720 | if (rc != 0) { |
| 721 | panic(); |
| 722 | } |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 723 | udelay(2); |
Etienne Carriere | f02647a | 2019-12-08 08:14:40 +0100 | [diff] [blame] | 724 | rc = stm32mp_reset_deassert(sdmmc2_params.reset_id, TIMEOUT_US_1_MS); |
| 725 | if (rc != 0) { |
| 726 | panic(); |
| 727 | } |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 728 | mdelay(1); |
| 729 | |
Yann Gautier | a2e2a30 | 2019-02-14 11:13:39 +0100 | [diff] [blame] | 730 | sdmmc2_params.clk_rate = stm32mp_clk_get_rate(sdmmc2_params.clock_id); |
Yann Gautier | c8fa1aa | 2019-03-08 10:59:00 +0100 | [diff] [blame] | 731 | sdmmc2_params.device_info->ocr_voltage = OCR_3_2_3_3 | OCR_3_3_3_4; |
Yann Gautier | 5380b0d | 2018-10-15 09:36:04 +0200 | [diff] [blame] | 732 | |
| 733 | return mmc_init(&stm32_sdmmc2_ops, sdmmc2_params.clk_rate, |
| 734 | sdmmc2_params.bus_width, sdmmc2_params.flags, |
| 735 | sdmmc2_params.device_info); |
| 736 | } |