blob: e2bb90abbdf3c5b05af34a23526f75da985df62d [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Lei Wenaf62a552011-06-28 21:50:06 +00002/*
3 * Copyright 2011, Marvell Semiconductor Inc.
4 * Lei Wen <leiwen@marvell.com>
5 *
Lei Wenaf62a552011-06-28 21:50:06 +00006 * Back ported to the 8xx platform (from the 8260 platform) by
7 * Murray.Jensen@cmst.csiro.au, 27-Jan-01.
8 */
9
10#include <common.h>
Simon Glass2a809092016-06-12 23:30:27 -060011#include <errno.h>
Lei Wenaf62a552011-06-28 21:50:06 +000012#include <malloc.h>
13#include <mmc.h>
14#include <sdhci.h>
15
Stefan Roese492d3222015-06-29 14:58:09 +020016#if defined(CONFIG_FIXED_SDHCI_ALIGNED_BUFFER)
17void *aligned_buffer = (void *)CONFIG_FIXED_SDHCI_ALIGNED_BUFFER;
18#else
Lei Wenaf62a552011-06-28 21:50:06 +000019void *aligned_buffer;
Stefan Roese492d3222015-06-29 14:58:09 +020020#endif
Lei Wenaf62a552011-06-28 21:50:06 +000021
22static void sdhci_reset(struct sdhci_host *host, u8 mask)
23{
24 unsigned long timeout;
25
26 /* Wait max 100 ms */
27 timeout = 100;
28 sdhci_writeb(host, mask, SDHCI_SOFTWARE_RESET);
29 while (sdhci_readb(host, SDHCI_SOFTWARE_RESET) & mask) {
30 if (timeout == 0) {
Darwin Rambo30e6d972013-12-19 15:13:25 -080031 printf("%s: Reset 0x%x never completed.\n",
32 __func__, (int)mask);
Lei Wenaf62a552011-06-28 21:50:06 +000033 return;
34 }
35 timeout--;
36 udelay(1000);
37 }
38}
39
40static void sdhci_cmd_done(struct sdhci_host *host, struct mmc_cmd *cmd)
41{
42 int i;
43 if (cmd->resp_type & MMC_RSP_136) {
44 /* CRC is stripped so we need to do some shifting. */
45 for (i = 0; i < 4; i++) {
46 cmd->response[i] = sdhci_readl(host,
47 SDHCI_RESPONSE + (3-i)*4) << 8;
48 if (i != 3)
49 cmd->response[i] |= sdhci_readb(host,
50 SDHCI_RESPONSE + (3-i)*4-1);
51 }
52 } else {
53 cmd->response[0] = sdhci_readl(host, SDHCI_RESPONSE);
54 }
55}
56
57static void sdhci_transfer_pio(struct sdhci_host *host, struct mmc_data *data)
58{
59 int i;
60 char *offs;
61 for (i = 0; i < data->blocksize; i += 4) {
62 offs = data->dest + i;
63 if (data->flags == MMC_DATA_READ)
64 *(u32 *)offs = sdhci_readl(host, SDHCI_BUFFER);
65 else
66 sdhci_writel(host, *(u32 *)offs, SDHCI_BUFFER);
67 }
68}
Faiz Abbas37cb6262019-04-16 23:06:58 +053069
70#if CONFIG_IS_ENABLED(MMC_SDHCI_ADMA)
71static void sdhci_adma_desc(struct sdhci_host *host, char *buf, u16 len,
72 bool end)
73{
74 struct sdhci_adma_desc *desc;
75 u8 attr;
76
77 desc = &host->adma_desc_table[host->desc_slot];
78
79 attr = ADMA_DESC_ATTR_VALID | ADMA_DESC_TRANSFER_DATA;
80 if (!end)
81 host->desc_slot++;
82 else
83 attr |= ADMA_DESC_ATTR_END;
84
85 desc->attr = attr;
86 desc->len = len;
87 desc->reserved = 0;
88 desc->addr_lo = (dma_addr_t)buf;
89#ifdef CONFIG_DMA_ADDR_T_64BIT
90 desc->addr_hi = (u64)buf >> 32;
91#endif
92}
93
94static void sdhci_prepare_adma_table(struct sdhci_host *host,
95 struct mmc_data *data)
96{
97 uint trans_bytes = data->blocksize * data->blocks;
98 uint desc_count = DIV_ROUND_UP(trans_bytes, ADMA_MAX_LEN);
99 int i = desc_count;
100 char *buf;
101
102 host->desc_slot = 0;
103
104 if (data->flags & MMC_DATA_READ)
105 buf = data->dest;
106 else
107 buf = (char *)data->src;
108
109 while (--i) {
110 sdhci_adma_desc(host, buf, ADMA_MAX_LEN, false);
111 buf += ADMA_MAX_LEN;
112 trans_bytes -= ADMA_MAX_LEN;
113 }
114
115 sdhci_adma_desc(host, buf, trans_bytes, true);
116
117 flush_cache((dma_addr_t)host->adma_desc_table,
118 ROUND(desc_count * sizeof(struct sdhci_adma_desc),
119 ARCH_DMA_MINALIGN));
120}
121#elif defined(CONFIG_MMC_SDHCI_SDMA)
122static void sdhci_prepare_adma_table(struct sdhci_host *host,
123 struct mmc_data *data)
124{}
125#endif
126#if (defined(CONFIG_MMC_SDHCI_SDMA) || CONFIG_IS_ENABLED(MMC_SDHCI_ADMA))
Faiz Abbas6d6af202019-04-16 23:06:57 +0530127static void sdhci_prepare_dma(struct sdhci_host *host, struct mmc_data *data,
128 int *is_aligned, int trans_bytes)
129{
Jaehoon Chung804c7f42012-09-20 20:31:55 +0000130 unsigned char ctrl;
Faiz Abbas6d6af202019-04-16 23:06:57 +0530131
132 if (data->flags == MMC_DATA_READ)
133 host->start_addr = (dma_addr_t)data->dest;
134 else
135 host->start_addr = (dma_addr_t)data->src;
136
Faiz Abbas37cb6262019-04-16 23:06:58 +0530137 ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
138 ctrl &= ~SDHCI_CTRL_DMA_MASK;
139 if (host->flags & USE_ADMA64)
140 ctrl |= SDHCI_CTRL_ADMA64;
141 else if (host->flags & USE_ADMA)
142 ctrl |= SDHCI_CTRL_ADMA32;
143 sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
144
145 if (host->flags & USE_SDMA) {
146 if ((host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR) &&
147 (host->start_addr & 0x7) != 0x0) {
148 *is_aligned = 0;
149 host->start_addr = (unsigned long)aligned_buffer;
150 if (data->flags != MMC_DATA_READ)
151 memcpy(aligned_buffer, data->src, trans_bytes);
152 }
153
154#if defined(CONFIG_FIXED_SDHCI_ALIGNED_BUFFER)
155 /*
156 * Always use this bounce-buffer when
157 * CONFIG_FIXED_SDHCI_ALIGNED_BUFFER is defined
158 */
Faiz Abbas6d6af202019-04-16 23:06:57 +0530159 *is_aligned = 0;
160 host->start_addr = (unsigned long)aligned_buffer;
161 if (data->flags != MMC_DATA_READ)
162 memcpy(aligned_buffer, data->src, trans_bytes);
Faiz Abbas37cb6262019-04-16 23:06:58 +0530163#endif
164 sdhci_writel(host, host->start_addr, SDHCI_DMA_ADDRESS);
165
166 } else if (host->flags & (USE_ADMA | USE_ADMA64)) {
167 sdhci_prepare_adma_table(host, data);
168
169 sdhci_writel(host, (u32)host->adma_addr, SDHCI_ADMA_ADDRESS);
170 if (host->flags & USE_ADMA64)
171 sdhci_writel(host, (u64)host->adma_addr >> 32,
172 SDHCI_ADMA_ADDRESS_HI);
Faiz Abbas6d6af202019-04-16 23:06:57 +0530173 }
174
Faiz Abbas6d6af202019-04-16 23:06:57 +0530175 flush_cache(host->start_addr, ROUND(trans_bytes, ARCH_DMA_MINALIGN));
176}
177#else
178static void sdhci_prepare_dma(struct sdhci_host *host, struct mmc_data *data,
179 int *is_aligned, int trans_bytes)
180{}
181#endif
182static int sdhci_transfer_data(struct sdhci_host *host, struct mmc_data *data)
183{
184 dma_addr_t start_addr = host->start_addr;
185 unsigned int stat, rdy, mask, timeout, block = 0;
186 bool transfer_done = false;
Lei Wenaf62a552011-06-28 21:50:06 +0000187
Jaehoon Chung5d48e422012-09-20 20:31:54 +0000188 timeout = 1000000;
Lei Wenaf62a552011-06-28 21:50:06 +0000189 rdy = SDHCI_INT_SPACE_AVAIL | SDHCI_INT_DATA_AVAIL;
190 mask = SDHCI_DATA_AVAILABLE | SDHCI_SPACE_AVAILABLE;
191 do {
192 stat = sdhci_readl(host, SDHCI_INT_STATUS);
193 if (stat & SDHCI_INT_ERROR) {
Masahiro Yamada61f2e5e2017-12-30 02:00:12 +0900194 pr_debug("%s: Error detected in status(0x%X)!\n",
195 __func__, stat);
Jaehoon Chung2cb5d672016-09-26 08:10:02 +0900196 return -EIO;
Lei Wenaf62a552011-06-28 21:50:06 +0000197 }
Alex Deymo7dde50d2017-04-02 01:24:34 -0700198 if (!transfer_done && (stat & rdy)) {
Lei Wenaf62a552011-06-28 21:50:06 +0000199 if (!(sdhci_readl(host, SDHCI_PRESENT_STATE) & mask))
200 continue;
201 sdhci_writel(host, rdy, SDHCI_INT_STATUS);
202 sdhci_transfer_pio(host, data);
203 data->dest += data->blocksize;
Alex Deymo7dde50d2017-04-02 01:24:34 -0700204 if (++block >= data->blocks) {
205 /* Keep looping until the SDHCI_INT_DATA_END is
206 * cleared, even if we finished sending all the
207 * blocks.
208 */
209 transfer_done = true;
210 continue;
211 }
Lei Wenaf62a552011-06-28 21:50:06 +0000212 }
Faiz Abbas37cb6262019-04-16 23:06:58 +0530213 if ((host->flags & USE_DMA) && !transfer_done &&
Faiz Abbas6d6af202019-04-16 23:06:57 +0530214 (stat & SDHCI_INT_DMA_END)) {
Lei Wenaf62a552011-06-28 21:50:06 +0000215 sdhci_writel(host, SDHCI_INT_DMA_END, SDHCI_INT_STATUS);
Faiz Abbas37cb6262019-04-16 23:06:58 +0530216 if (host->flags & USE_SDMA) {
217 start_addr &=
218 ~(SDHCI_DEFAULT_BOUNDARY_SIZE - 1);
219 start_addr += SDHCI_DEFAULT_BOUNDARY_SIZE;
220 sdhci_writel(host, start_addr,
221 SDHCI_DMA_ADDRESS);
222 }
Lei Wenaf62a552011-06-28 21:50:06 +0000223 }
Lei Wena004abd2011-10-08 04:14:57 +0000224 if (timeout-- > 0)
225 udelay(10);
226 else {
Darwin Rambo30e6d972013-12-19 15:13:25 -0800227 printf("%s: Transfer data timeout\n", __func__);
Jaehoon Chung2cb5d672016-09-26 08:10:02 +0900228 return -ETIMEDOUT;
Lei Wena004abd2011-10-08 04:14:57 +0000229 }
Lei Wenaf62a552011-06-28 21:50:06 +0000230 } while (!(stat & SDHCI_INT_DATA_END));
231 return 0;
232}
233
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200234/*
235 * No command will be sent by driver if card is busy, so driver must wait
236 * for card ready state.
237 * Every time when card is busy after timeout then (last) timeout value will be
238 * increased twice but only if it doesn't exceed global defined maximum.
Masahiro Yamada65a25b22016-08-25 16:07:39 +0900239 * Each function call will use last timeout value.
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200240 */
Masahiro Yamada65a25b22016-08-25 16:07:39 +0900241#define SDHCI_CMD_MAX_TIMEOUT 3200
Masahiro Yamadad8ce77b2016-08-25 16:07:38 +0900242#define SDHCI_CMD_DEFAULT_TIMEOUT 100
Steve Raed90bb432016-06-29 13:42:01 -0700243#define SDHCI_READ_STATUS_TIMEOUT 1000
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200244
Simon Glasse7881d82017-07-29 11:35:31 -0600245#ifdef CONFIG_DM_MMC
Simon Glassef1e4ed2016-06-12 23:30:28 -0600246static int sdhci_send_command(struct udevice *dev, struct mmc_cmd *cmd,
247 struct mmc_data *data)
Lei Wenaf62a552011-06-28 21:50:06 +0000248{
Simon Glassef1e4ed2016-06-12 23:30:28 -0600249 struct mmc *mmc = mmc_get_mmc_dev(dev);
250
251#else
252static int sdhci_send_command(struct mmc *mmc, struct mmc_cmd *cmd,
253 struct mmc_data *data)
254{
255#endif
Pantelis Antoniou93bfd612014-03-11 19:34:20 +0200256 struct sdhci_host *host = mmc->priv;
Lei Wenaf62a552011-06-28 21:50:06 +0000257 unsigned int stat = 0;
258 int ret = 0;
259 int trans_bytes = 0, is_aligned = 1;
260 u32 mask, flags, mode;
Faiz Abbas6d6af202019-04-16 23:06:57 +0530261 unsigned int time = 0;
Simon Glass19d2e342016-05-14 14:03:04 -0600262 int mmc_dev = mmc_get_blk_desc(mmc)->devnum;
Vipul Kumar36332b62018-05-03 12:20:54 +0530263 ulong start = get_timer(0);
Lei Wenaf62a552011-06-28 21:50:06 +0000264
Faiz Abbas6d6af202019-04-16 23:06:57 +0530265 host->start_addr = 0;
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200266 /* Timeout unit - ms */
Masahiro Yamadad8ce77b2016-08-25 16:07:38 +0900267 static unsigned int cmd_timeout = SDHCI_CMD_DEFAULT_TIMEOUT;
Lei Wenaf62a552011-06-28 21:50:06 +0000268
Lei Wenaf62a552011-06-28 21:50:06 +0000269 mask = SDHCI_CMD_INHIBIT | SDHCI_DATA_INHIBIT;
270
271 /* We shouldn't wait for data inihibit for stop commands, even
272 though they might use busy signaling */
Siva Durga Prasad Paladugub88a7a42018-04-19 12:37:05 +0530273 if (cmd->cmdidx == MMC_CMD_STOP_TRANSMISSION ||
Siva Durga Prasad Paladugu1a7414f2018-06-13 11:43:01 +0530274 ((cmd->cmdidx == MMC_CMD_SEND_TUNING_BLOCK ||
275 cmd->cmdidx == MMC_CMD_SEND_TUNING_BLOCK_HS200) && !data))
Lei Wenaf62a552011-06-28 21:50:06 +0000276 mask &= ~SDHCI_DATA_INHIBIT;
277
278 while (sdhci_readl(host, SDHCI_PRESENT_STATE) & mask) {
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200279 if (time >= cmd_timeout) {
Darwin Rambo30e6d972013-12-19 15:13:25 -0800280 printf("%s: MMC: %d busy ", __func__, mmc_dev);
Masahiro Yamada65a25b22016-08-25 16:07:39 +0900281 if (2 * cmd_timeout <= SDHCI_CMD_MAX_TIMEOUT) {
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200282 cmd_timeout += cmd_timeout;
283 printf("timeout increasing to: %u ms.\n",
284 cmd_timeout);
285 } else {
286 puts("timeout.\n");
Jaehoon Chung915ffa52016-07-19 16:33:36 +0900287 return -ECOMM;
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200288 }
Lei Wenaf62a552011-06-28 21:50:06 +0000289 }
Przemyslaw Marczak56b34bc2013-10-08 18:12:09 +0200290 time++;
Lei Wenaf62a552011-06-28 21:50:06 +0000291 udelay(1000);
292 }
293
Jorge Ramirez-Ortiz713e6812017-11-02 15:10:21 +0100294 sdhci_writel(host, SDHCI_INT_ALL_MASK, SDHCI_INT_STATUS);
295
Lei Wenaf62a552011-06-28 21:50:06 +0000296 mask = SDHCI_INT_RESPONSE;
Siva Durga Prasad Paladugu1a7414f2018-06-13 11:43:01 +0530297 if ((cmd->cmdidx == MMC_CMD_SEND_TUNING_BLOCK ||
298 cmd->cmdidx == MMC_CMD_SEND_TUNING_BLOCK_HS200) && !data)
Siva Durga Prasad Paladugub88a7a42018-04-19 12:37:05 +0530299 mask = SDHCI_INT_DATA_AVAIL;
300
Lei Wenaf62a552011-06-28 21:50:06 +0000301 if (!(cmd->resp_type & MMC_RSP_PRESENT))
302 flags = SDHCI_CMD_RESP_NONE;
303 else if (cmd->resp_type & MMC_RSP_136)
304 flags = SDHCI_CMD_RESP_LONG;
305 else if (cmd->resp_type & MMC_RSP_BUSY) {
306 flags = SDHCI_CMD_RESP_SHORT_BUSY;
Jaehoon Chung17ea3c82016-07-12 21:18:46 +0900307 if (data)
308 mask |= SDHCI_INT_DATA_END;
Lei Wenaf62a552011-06-28 21:50:06 +0000309 } else
310 flags = SDHCI_CMD_RESP_SHORT;
311
312 if (cmd->resp_type & MMC_RSP_CRC)
313 flags |= SDHCI_CMD_CRC;
314 if (cmd->resp_type & MMC_RSP_OPCODE)
315 flags |= SDHCI_CMD_INDEX;
Siva Durga Prasad Paladugu434f9d42018-05-29 20:03:10 +0530316 if (data || cmd->cmdidx == MMC_CMD_SEND_TUNING_BLOCK ||
317 cmd->cmdidx == MMC_CMD_SEND_TUNING_BLOCK_HS200)
Lei Wenaf62a552011-06-28 21:50:06 +0000318 flags |= SDHCI_CMD_DATA;
319
Darwin Rambo30e6d972013-12-19 15:13:25 -0800320 /* Set Transfer mode regarding to data flag */
Heinrich Schuchardtbb7b4ef2017-11-10 21:13:34 +0100321 if (data) {
Lei Wenaf62a552011-06-28 21:50:06 +0000322 sdhci_writeb(host, 0xe, SDHCI_TIMEOUT_CONTROL);
323 mode = SDHCI_TRNS_BLK_CNT_EN;
324 trans_bytes = data->blocks * data->blocksize;
325 if (data->blocks > 1)
326 mode |= SDHCI_TRNS_MULTI;
327
328 if (data->flags == MMC_DATA_READ)
329 mode |= SDHCI_TRNS_READ;
330
Faiz Abbas37cb6262019-04-16 23:06:58 +0530331 if (host->flags & USE_DMA) {
Faiz Abbas6d6af202019-04-16 23:06:57 +0530332 mode |= SDHCI_TRNS_DMA;
333 sdhci_prepare_dma(host, data, &is_aligned, trans_bytes);
Lei Wenaf62a552011-06-28 21:50:06 +0000334 }
335
Lei Wenaf62a552011-06-28 21:50:06 +0000336 sdhci_writew(host, SDHCI_MAKE_BLKSZ(SDHCI_DEFAULT_BOUNDARY_ARG,
337 data->blocksize),
338 SDHCI_BLOCK_SIZE);
339 sdhci_writew(host, data->blocks, SDHCI_BLOCK_COUNT);
340 sdhci_writew(host, mode, SDHCI_TRANSFER_MODE);
Kevin Liu5e1c23c2015-03-23 17:57:00 -0500341 } else if (cmd->resp_type & MMC_RSP_BUSY) {
342 sdhci_writeb(host, 0xe, SDHCI_TIMEOUT_CONTROL);
Lei Wenaf62a552011-06-28 21:50:06 +0000343 }
344
345 sdhci_writel(host, cmd->cmdarg, SDHCI_ARGUMENT);
Lei Wenaf62a552011-06-28 21:50:06 +0000346 sdhci_writew(host, SDHCI_MAKE_CMD(cmd->cmdidx, flags), SDHCI_COMMAND);
Stefan Roese29905a42015-06-29 14:58:08 +0200347 start = get_timer(0);
Lei Wenaf62a552011-06-28 21:50:06 +0000348 do {
349 stat = sdhci_readl(host, SDHCI_INT_STATUS);
350 if (stat & SDHCI_INT_ERROR)
351 break;
Lei Wenaf62a552011-06-28 21:50:06 +0000352
Masahiro Yamadabae4a1f2016-07-10 00:40:22 +0900353 if (get_timer(start) >= SDHCI_READ_STATUS_TIMEOUT) {
354 if (host->quirks & SDHCI_QUIRK_BROKEN_R1B) {
355 return 0;
356 } else {
357 printf("%s: Timeout for status update!\n",
358 __func__);
Jaehoon Chung915ffa52016-07-19 16:33:36 +0900359 return -ETIMEDOUT;
Masahiro Yamadabae4a1f2016-07-10 00:40:22 +0900360 }
Jaehoon Chung3a638322012-04-23 02:36:25 +0000361 }
Masahiro Yamadabae4a1f2016-07-10 00:40:22 +0900362 } while ((stat & mask) != mask);
Jaehoon Chung3a638322012-04-23 02:36:25 +0000363
Lei Wenaf62a552011-06-28 21:50:06 +0000364 if ((stat & (SDHCI_INT_ERROR | mask)) == mask) {
365 sdhci_cmd_done(host, cmd);
366 sdhci_writel(host, mask, SDHCI_INT_STATUS);
367 } else
368 ret = -1;
369
370 if (!ret && data)
Faiz Abbas6d6af202019-04-16 23:06:57 +0530371 ret = sdhci_transfer_data(host, data);
Lei Wenaf62a552011-06-28 21:50:06 +0000372
Tushar Behera13243f22012-09-20 20:31:57 +0000373 if (host->quirks & SDHCI_QUIRK_WAIT_SEND_CMD)
374 udelay(1000);
375
Lei Wenaf62a552011-06-28 21:50:06 +0000376 stat = sdhci_readl(host, SDHCI_INT_STATUS);
377 sdhci_writel(host, SDHCI_INT_ALL_MASK, SDHCI_INT_STATUS);
378 if (!ret) {
379 if ((host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR) &&
380 !is_aligned && (data->flags == MMC_DATA_READ))
381 memcpy(data->dest, aligned_buffer, trans_bytes);
382 return 0;
383 }
384
385 sdhci_reset(host, SDHCI_RESET_CMD);
386 sdhci_reset(host, SDHCI_RESET_DATA);
387 if (stat & SDHCI_INT_TIMEOUT)
Jaehoon Chung915ffa52016-07-19 16:33:36 +0900388 return -ETIMEDOUT;
Lei Wenaf62a552011-06-28 21:50:06 +0000389 else
Jaehoon Chung915ffa52016-07-19 16:33:36 +0900390 return -ECOMM;
Lei Wenaf62a552011-06-28 21:50:06 +0000391}
392
Siva Durga Prasad Paladuguca992e82018-04-19 12:37:07 +0530393#if defined(CONFIG_DM_MMC) && defined(MMC_SUPPORTS_TUNING)
394static int sdhci_execute_tuning(struct udevice *dev, uint opcode)
395{
396 int err;
397 struct mmc *mmc = mmc_get_mmc_dev(dev);
398 struct sdhci_host *host = mmc->priv;
399
400 debug("%s\n", __func__);
401
Ramon Friedb70fe962018-05-14 15:02:30 +0300402 if (host->ops && host->ops->platform_execute_tuning) {
Siva Durga Prasad Paladuguca992e82018-04-19 12:37:07 +0530403 err = host->ops->platform_execute_tuning(mmc, opcode);
404 if (err)
405 return err;
406 return 0;
407 }
408 return 0;
409}
410#endif
Lei Wenaf62a552011-06-28 21:50:06 +0000411static int sdhci_set_clock(struct mmc *mmc, unsigned int clock)
412{
Pantelis Antoniou93bfd612014-03-11 19:34:20 +0200413 struct sdhci_host *host = mmc->priv;
Stefan Roese899fb9e2016-12-12 08:34:42 +0100414 unsigned int div, clk = 0, timeout;
Lei Wenaf62a552011-06-28 21:50:06 +0000415
Wenyou Yang79667b72015-09-22 14:59:25 +0800416 /* Wait max 20 ms */
417 timeout = 200;
418 while (sdhci_readl(host, SDHCI_PRESENT_STATE) &
419 (SDHCI_CMD_INHIBIT | SDHCI_DATA_INHIBIT)) {
420 if (timeout == 0) {
421 printf("%s: Timeout to wait cmd & data inhibit\n",
422 __func__);
Jaehoon Chung2cb5d672016-09-26 08:10:02 +0900423 return -EBUSY;
Wenyou Yang79667b72015-09-22 14:59:25 +0800424 }
425
426 timeout--;
427 udelay(100);
428 }
429
Stefan Roese899fb9e2016-12-12 08:34:42 +0100430 sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
Lei Wenaf62a552011-06-28 21:50:06 +0000431
432 if (clock == 0)
433 return 0;
434
Ramon Friedb70fe962018-05-14 15:02:30 +0300435 if (host->ops && host->ops->set_delay)
Siva Durga Prasad Paladuguca992e82018-04-19 12:37:07 +0530436 host->ops->set_delay(host);
437
Jaehoon Chung113e5df2013-07-19 17:44:49 +0900438 if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300) {
Wenyou Yang6dffdbc2016-09-18 09:01:22 +0800439 /*
440 * Check if the Host Controller supports Programmable Clock
441 * Mode.
442 */
443 if (host->clk_mul) {
444 for (div = 1; div <= 1024; div++) {
Wenyou Yang0e0dcc12017-04-26 09:32:30 +0800445 if ((host->max_clk / div) <= clock)
Lei Wenaf62a552011-06-28 21:50:06 +0000446 break;
447 }
Wenyou Yang6dffdbc2016-09-18 09:01:22 +0800448
449 /*
450 * Set Programmable Clock Mode in the Clock
451 * Control register.
452 */
453 clk = SDHCI_PROG_CLOCK_MODE;
454 div--;
455 } else {
456 /* Version 3.00 divisors must be a multiple of 2. */
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100457 if (host->max_clk <= clock) {
Wenyou Yang6dffdbc2016-09-18 09:01:22 +0800458 div = 1;
459 } else {
460 for (div = 2;
461 div < SDHCI_MAX_DIV_SPEC_300;
462 div += 2) {
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100463 if ((host->max_clk / div) <= clock)
Wenyou Yang6dffdbc2016-09-18 09:01:22 +0800464 break;
465 }
466 }
467 div >>= 1;
Lei Wenaf62a552011-06-28 21:50:06 +0000468 }
469 } else {
470 /* Version 2.00 divisors must be a power of 2. */
471 for (div = 1; div < SDHCI_MAX_DIV_SPEC_200; div *= 2) {
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100472 if ((host->max_clk / div) <= clock)
Lei Wenaf62a552011-06-28 21:50:06 +0000473 break;
474 }
Wenyou Yang6dffdbc2016-09-18 09:01:22 +0800475 div >>= 1;
Lei Wenaf62a552011-06-28 21:50:06 +0000476 }
Lei Wenaf62a552011-06-28 21:50:06 +0000477
Masahiro Yamadabf9c4d12017-01-13 11:51:51 +0900478 if (host->ops && host->ops->set_clock)
Jaehoon Chung62226b62016-12-30 15:30:18 +0900479 host->ops->set_clock(host, div);
Jaehoon Chungb09ed6e2012-08-30 16:24:11 +0000480
Wenyou Yang6dffdbc2016-09-18 09:01:22 +0800481 clk |= (div & SDHCI_DIV_MASK) << SDHCI_DIVIDER_SHIFT;
Lei Wenaf62a552011-06-28 21:50:06 +0000482 clk |= ((div & SDHCI_DIV_HI_MASK) >> SDHCI_DIV_MASK_LEN)
483 << SDHCI_DIVIDER_HI_SHIFT;
484 clk |= SDHCI_CLOCK_INT_EN;
485 sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
486
487 /* Wait max 20 ms */
488 timeout = 20;
489 while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
490 & SDHCI_CLOCK_INT_STABLE)) {
491 if (timeout == 0) {
Darwin Rambo30e6d972013-12-19 15:13:25 -0800492 printf("%s: Internal clock never stabilised.\n",
493 __func__);
Jaehoon Chung2cb5d672016-09-26 08:10:02 +0900494 return -EBUSY;
Lei Wenaf62a552011-06-28 21:50:06 +0000495 }
496 timeout--;
497 udelay(1000);
498 }
499
500 clk |= SDHCI_CLOCK_CARD_EN;
501 sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
502 return 0;
503}
504
505static void sdhci_set_power(struct sdhci_host *host, unsigned short power)
506{
507 u8 pwr = 0;
508
509 if (power != (unsigned short)-1) {
510 switch (1 << power) {
511 case MMC_VDD_165_195:
512 pwr = SDHCI_POWER_180;
513 break;
514 case MMC_VDD_29_30:
515 case MMC_VDD_30_31:
516 pwr = SDHCI_POWER_300;
517 break;
518 case MMC_VDD_32_33:
519 case MMC_VDD_33_34:
520 pwr = SDHCI_POWER_330;
521 break;
522 }
523 }
524
525 if (pwr == 0) {
526 sdhci_writeb(host, 0, SDHCI_POWER_CONTROL);
527 return;
528 }
529
530 pwr |= SDHCI_POWER_ON;
531
532 sdhci_writeb(host, pwr, SDHCI_POWER_CONTROL);
533}
534
Simon Glasse7881d82017-07-29 11:35:31 -0600535#ifdef CONFIG_DM_MMC
Simon Glassef1e4ed2016-06-12 23:30:28 -0600536static int sdhci_set_ios(struct udevice *dev)
537{
538 struct mmc *mmc = mmc_get_mmc_dev(dev);
539#else
Jaehoon Chung07b0b9c2016-12-30 15:30:16 +0900540static int sdhci_set_ios(struct mmc *mmc)
Lei Wenaf62a552011-06-28 21:50:06 +0000541{
Simon Glassef1e4ed2016-06-12 23:30:28 -0600542#endif
Lei Wenaf62a552011-06-28 21:50:06 +0000543 u32 ctrl;
Pantelis Antoniou93bfd612014-03-11 19:34:20 +0200544 struct sdhci_host *host = mmc->priv;
Lei Wenaf62a552011-06-28 21:50:06 +0000545
Masahiro Yamadabf9c4d12017-01-13 11:51:51 +0900546 if (host->ops && host->ops->set_control_reg)
Jaehoon Chung62226b62016-12-30 15:30:18 +0900547 host->ops->set_control_reg(host);
Jaehoon Chung236bfec2012-04-23 02:36:26 +0000548
Lei Wenaf62a552011-06-28 21:50:06 +0000549 if (mmc->clock != host->clock)
550 sdhci_set_clock(mmc, mmc->clock);
551
Siva Durga Prasad Paladugu2a2d7ef2018-04-19 12:37:04 +0530552 if (mmc->clk_disable)
553 sdhci_set_clock(mmc, 0);
554
Lei Wenaf62a552011-06-28 21:50:06 +0000555 /* Set bus width */
556 ctrl = sdhci_readb(host, SDHCI_HOST_CONTROL);
557 if (mmc->bus_width == 8) {
558 ctrl &= ~SDHCI_CTRL_4BITBUS;
Jaehoon Chung113e5df2013-07-19 17:44:49 +0900559 if ((SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300) ||
560 (host->quirks & SDHCI_QUIRK_USE_WIDE8))
Lei Wenaf62a552011-06-28 21:50:06 +0000561 ctrl |= SDHCI_CTRL_8BITBUS;
562 } else {
Matt Reimerf88a4292015-02-19 11:22:53 -0700563 if ((SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300) ||
564 (host->quirks & SDHCI_QUIRK_USE_WIDE8))
Lei Wenaf62a552011-06-28 21:50:06 +0000565 ctrl &= ~SDHCI_CTRL_8BITBUS;
566 if (mmc->bus_width == 4)
567 ctrl |= SDHCI_CTRL_4BITBUS;
568 else
569 ctrl &= ~SDHCI_CTRL_4BITBUS;
570 }
571
572 if (mmc->clock > 26000000)
573 ctrl |= SDHCI_CTRL_HISPD;
574 else
575 ctrl &= ~SDHCI_CTRL_HISPD;
576
Hannes Schmelzer88a57122018-03-07 08:00:56 +0100577 if ((host->quirks & SDHCI_QUIRK_NO_HISPD_BIT) ||
578 (host->quirks & SDHCI_QUIRK_BROKEN_HISPD_MODE))
Jaehoon Chung236bfec2012-04-23 02:36:26 +0000579 ctrl &= ~SDHCI_CTRL_HISPD;
580
Lei Wenaf62a552011-06-28 21:50:06 +0000581 sdhci_writeb(host, ctrl, SDHCI_HOST_CONTROL);
Jaehoon Chung07b0b9c2016-12-30 15:30:16 +0900582
Stefan Roese210841c2016-12-12 08:24:56 +0100583 /* If available, call the driver specific "post" set_ios() function */
584 if (host->ops && host->ops->set_ios_post)
585 host->ops->set_ios_post(host);
586
Simon Glassef1e4ed2016-06-12 23:30:28 -0600587 return 0;
Lei Wenaf62a552011-06-28 21:50:06 +0000588}
589
Jeroen Hofstee6588c782014-10-08 22:57:43 +0200590static int sdhci_init(struct mmc *mmc)
Lei Wenaf62a552011-06-28 21:50:06 +0000591{
Pantelis Antoniou93bfd612014-03-11 19:34:20 +0200592 struct sdhci_host *host = mmc->priv;
Lei Wenaf62a552011-06-28 21:50:06 +0000593
Masahiro Yamada8d549b62016-08-25 16:07:34 +0900594 sdhci_reset(host, SDHCI_RESET_ALL);
595
Lei Wenaf62a552011-06-28 21:50:06 +0000596 if ((host->quirks & SDHCI_QUIRK_32BIT_DMA_ADDR) && !aligned_buffer) {
597 aligned_buffer = memalign(8, 512*1024);
598 if (!aligned_buffer) {
Darwin Rambo30e6d972013-12-19 15:13:25 -0800599 printf("%s: Aligned buffer alloc failed!!!\n",
600 __func__);
Jaehoon Chung2cb5d672016-09-26 08:10:02 +0900601 return -ENOMEM;
Lei Wenaf62a552011-06-28 21:50:06 +0000602 }
603 }
604
Pantelis Antoniou93bfd612014-03-11 19:34:20 +0200605 sdhci_set_power(host, fls(mmc->cfg->voltages) - 1);
Joe Hershberger470dcc72012-08-17 10:18:55 +0000606
Masahiro Yamadabf9c4d12017-01-13 11:51:51 +0900607 if (host->ops && host->ops->get_cd)
Jaehoon Chung6f88a3a2016-12-30 15:30:15 +0900608 host->ops->get_cd(host);
Joe Hershberger470dcc72012-08-17 10:18:55 +0000609
Łukasz Majewskice0c1bc2013-01-11 05:08:54 +0000610 /* Enable only interrupts served by the SD controller */
Darwin Rambo30e6d972013-12-19 15:13:25 -0800611 sdhci_writel(host, SDHCI_INT_DATA_MASK | SDHCI_INT_CMD_MASK,
612 SDHCI_INT_ENABLE);
Łukasz Majewskice0c1bc2013-01-11 05:08:54 +0000613 /* Mask all sdhci interrupt sources */
614 sdhci_writel(host, 0x0, SDHCI_SIGNAL_ENABLE);
Lei Wenaf62a552011-06-28 21:50:06 +0000615
Lei Wenaf62a552011-06-28 21:50:06 +0000616 return 0;
617}
618
Simon Glasse7881d82017-07-29 11:35:31 -0600619#ifdef CONFIG_DM_MMC
Simon Glassef1e4ed2016-06-12 23:30:28 -0600620int sdhci_probe(struct udevice *dev)
621{
622 struct mmc *mmc = mmc_get_mmc_dev(dev);
Pantelis Antoniouab769f22014-02-26 19:28:45 +0200623
Simon Glassef1e4ed2016-06-12 23:30:28 -0600624 return sdhci_init(mmc);
625}
626
627const struct dm_mmc_ops sdhci_ops = {
628 .send_cmd = sdhci_send_command,
629 .set_ios = sdhci_set_ios,
Siva Durga Prasad Paladuguca992e82018-04-19 12:37:07 +0530630#ifdef MMC_SUPPORTS_TUNING
631 .execute_tuning = sdhci_execute_tuning,
632#endif
Simon Glassef1e4ed2016-06-12 23:30:28 -0600633};
634#else
Pantelis Antoniouab769f22014-02-26 19:28:45 +0200635static const struct mmc_ops sdhci_ops = {
636 .send_cmd = sdhci_send_command,
637 .set_ios = sdhci_set_ios,
638 .init = sdhci_init,
639};
Simon Glassef1e4ed2016-06-12 23:30:28 -0600640#endif
Pantelis Antoniouab769f22014-02-26 19:28:45 +0200641
Jaehoon Chung14bed522016-07-26 19:06:24 +0900642int sdhci_setup_cfg(struct mmc_config *cfg, struct sdhci_host *host,
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100643 u32 f_max, u32 f_min)
Simon Glass2a809092016-06-12 23:30:27 -0600644{
Siva Durga Prasad Paladugub8e25ef2018-04-19 12:37:08 +0530645 u32 caps, caps_1 = 0;
Jaehoon Chung14bed522016-07-26 19:06:24 +0900646
647 caps = sdhci_readl(host, SDHCI_CAPABILITIES);
Masahiro Yamada15bd0992016-08-25 16:07:37 +0900648
Masahiro Yamada45a68fe2016-12-07 22:10:29 +0900649#ifdef CONFIG_MMC_SDHCI_SDMA
Masahiro Yamada15bd0992016-08-25 16:07:37 +0900650 if (!(caps & SDHCI_CAN_DO_SDMA)) {
651 printf("%s: Your controller doesn't support SDMA!!\n",
652 __func__);
653 return -EINVAL;
654 }
Faiz Abbas6d6af202019-04-16 23:06:57 +0530655
656 host->flags |= USE_SDMA;
Masahiro Yamada15bd0992016-08-25 16:07:37 +0900657#endif
Faiz Abbas37cb6262019-04-16 23:06:58 +0530658#if CONFIG_IS_ENABLED(MMC_SDHCI_ADMA)
659 if (!(caps & SDHCI_CAN_DO_ADMA2)) {
660 printf("%s: Your controller doesn't support SDMA!!\n",
661 __func__);
662 return -EINVAL;
663 }
664 host->adma_desc_table = (struct sdhci_adma_desc *)
665 memalign(ARCH_DMA_MINALIGN, ADMA_TABLE_SZ);
666
667 host->adma_addr = (dma_addr_t)host->adma_desc_table;
668#ifdef CONFIG_DMA_ADDR_T_64BIT
669 host->flags |= USE_ADMA64;
670#else
671 host->flags |= USE_ADMA;
672#endif
673#endif
Jaehoon Chung895549a2016-09-26 08:10:01 +0900674 if (host->quirks & SDHCI_QUIRK_REG32_RW)
675 host->version =
676 sdhci_readl(host, SDHCI_HOST_VERSION - 2) >> 16;
677 else
678 host->version = sdhci_readw(host, SDHCI_HOST_VERSION);
Jaehoon Chung14bed522016-07-26 19:06:24 +0900679
680 cfg->name = host->name;
Simon Glasse7881d82017-07-29 11:35:31 -0600681#ifndef CONFIG_DM_MMC
Simon Glass2a809092016-06-12 23:30:27 -0600682 cfg->ops = &sdhci_ops;
683#endif
Wenyou Yang0e0dcc12017-04-26 09:32:30 +0800684
685 /* Check whether the clock multiplier is supported or not */
686 if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300) {
687 caps_1 = sdhci_readl(host, SDHCI_CAPABILITIES_1);
688 host->clk_mul = (caps_1 & SDHCI_CLOCK_MUL_MASK) >>
689 SDHCI_CLOCK_MUL_SHIFT;
690 }
691
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100692 if (host->max_clk == 0) {
Jaehoon Chung14bed522016-07-26 19:06:24 +0900693 if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300)
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100694 host->max_clk = (caps & SDHCI_CLOCK_V3_BASE_MASK) >>
Simon Glass2a809092016-06-12 23:30:27 -0600695 SDHCI_CLOCK_BASE_SHIFT;
696 else
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100697 host->max_clk = (caps & SDHCI_CLOCK_BASE_MASK) >>
Simon Glass2a809092016-06-12 23:30:27 -0600698 SDHCI_CLOCK_BASE_SHIFT;
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100699 host->max_clk *= 1000000;
Wenyou Yang0e0dcc12017-04-26 09:32:30 +0800700 if (host->clk_mul)
701 host->max_clk *= host->clk_mul;
Simon Glass2a809092016-06-12 23:30:27 -0600702 }
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100703 if (host->max_clk == 0) {
Masahiro Yamada6c679542016-08-25 16:07:35 +0900704 printf("%s: Hardware doesn't specify base clock frequency\n",
705 __func__);
Simon Glass2a809092016-06-12 23:30:27 -0600706 return -EINVAL;
Masahiro Yamada6c679542016-08-25 16:07:35 +0900707 }
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100708 if (f_max && (f_max < host->max_clk))
709 cfg->f_max = f_max;
710 else
711 cfg->f_max = host->max_clk;
712 if (f_min)
713 cfg->f_min = f_min;
Simon Glass2a809092016-06-12 23:30:27 -0600714 else {
Jaehoon Chung14bed522016-07-26 19:06:24 +0900715 if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300)
Simon Glass2a809092016-06-12 23:30:27 -0600716 cfg->f_min = cfg->f_max / SDHCI_MAX_DIV_SPEC_300;
717 else
718 cfg->f_min = cfg->f_max / SDHCI_MAX_DIV_SPEC_200;
719 }
720 cfg->voltages = 0;
721 if (caps & SDHCI_CAN_VDD_330)
722 cfg->voltages |= MMC_VDD_32_33 | MMC_VDD_33_34;
723 if (caps & SDHCI_CAN_VDD_300)
724 cfg->voltages |= MMC_VDD_29_30 | MMC_VDD_30_31;
725 if (caps & SDHCI_CAN_VDD_180)
726 cfg->voltages |= MMC_VDD_165_195;
727
Masahiro Yamada3137e642016-08-25 16:07:36 +0900728 if (host->quirks & SDHCI_QUIRK_BROKEN_VOLTAGE)
729 cfg->voltages |= host->voltages;
730
Masahiro Yamadabe165fb2017-12-30 02:00:08 +0900731 cfg->host_caps |= MMC_MODE_HS | MMC_MODE_HS_52MHz | MMC_MODE_4BIT;
Jaehoon Chung3fd0a9b2016-12-30 15:30:21 +0900732
733 /* Since Host Controller Version3.0 */
Jaehoon Chung14bed522016-07-26 19:06:24 +0900734 if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300) {
Jaehoon Chungecd7b242016-12-30 15:30:11 +0900735 if (!(caps & SDHCI_CAN_DO_8BIT))
736 cfg->host_caps &= ~MMC_MODE_8BIT;
Simon Glass2a809092016-06-12 23:30:27 -0600737 }
738
Hannes Schmelzer88a57122018-03-07 08:00:56 +0100739 if (host->quirks & SDHCI_QUIRK_BROKEN_HISPD_MODE) {
740 cfg->host_caps &= ~MMC_MODE_HS;
741 cfg->host_caps &= ~MMC_MODE_HS_52MHz;
742 }
743
Siva Durga Prasad Paladugub8e25ef2018-04-19 12:37:08 +0530744 if (SDHCI_GET_VERSION(host) >= SDHCI_SPEC_300)
745 caps_1 = sdhci_readl(host, SDHCI_CAPABILITIES_1);
746
747 if (!(cfg->voltages & MMC_VDD_165_195) ||
748 (host->quirks & SDHCI_QUIRK_NO_1_8_V))
749 caps_1 &= ~(SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
750 SDHCI_SUPPORT_DDR50);
751
752 if (caps_1 & (SDHCI_SUPPORT_SDR104 | SDHCI_SUPPORT_SDR50 |
753 SDHCI_SUPPORT_DDR50))
754 cfg->host_caps |= MMC_CAP(UHS_SDR12) | MMC_CAP(UHS_SDR25);
755
756 if (caps_1 & SDHCI_SUPPORT_SDR104) {
757 cfg->host_caps |= MMC_CAP(UHS_SDR104) | MMC_CAP(UHS_SDR50);
758 /*
759 * SD3.0: SDR104 is supported so (for eMMC) the caps2
760 * field can be promoted to support HS200.
761 */
762 cfg->host_caps |= MMC_CAP(MMC_HS_200);
763 } else if (caps_1 & SDHCI_SUPPORT_SDR50) {
764 cfg->host_caps |= MMC_CAP(UHS_SDR50);
765 }
766
767 if (caps_1 & SDHCI_SUPPORT_DDR50)
768 cfg->host_caps |= MMC_CAP(UHS_DDR50);
769
Jaehoon Chung14bed522016-07-26 19:06:24 +0900770 if (host->host_caps)
771 cfg->host_caps |= host->host_caps;
Simon Glass2a809092016-06-12 23:30:27 -0600772
773 cfg->b_max = CONFIG_SYS_MMC_MAX_BLK_COUNT;
774
775 return 0;
776}
777
Simon Glassef1e4ed2016-06-12 23:30:28 -0600778#ifdef CONFIG_BLK
779int sdhci_bind(struct udevice *dev, struct mmc *mmc, struct mmc_config *cfg)
780{
781 return mmc_bind(dev, mmc, cfg);
782}
783#else
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100784int add_sdhci(struct sdhci_host *host, u32 f_max, u32 f_min)
Lei Wenaf62a552011-06-28 21:50:06 +0000785{
Masahiro Yamada6c679542016-08-25 16:07:35 +0900786 int ret;
787
Stefan Herbrechtsmeier6d0e34b2017-01-17 15:58:48 +0100788 ret = sdhci_setup_cfg(&host->cfg, host, f_max, f_min);
Masahiro Yamada6c679542016-08-25 16:07:35 +0900789 if (ret)
790 return ret;
Jaehoon Chung236bfec2012-04-23 02:36:26 +0000791
Pantelis Antoniou93bfd612014-03-11 19:34:20 +0200792 host->mmc = mmc_create(&host->cfg, host);
793 if (host->mmc == NULL) {
794 printf("%s: mmc create fail!\n", __func__);
Jaehoon Chung2cb5d672016-09-26 08:10:02 +0900795 return -ENOMEM;
Pantelis Antoniou93bfd612014-03-11 19:34:20 +0200796 }
Lei Wenaf62a552011-06-28 21:50:06 +0000797
798 return 0;
799}
Simon Glassef1e4ed2016-06-12 23:30:28 -0600800#endif