Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
aaac1b47 | 2 | * linux/drivers/mmc/core/core.c |
1da177e4 LT |
3 | * |
4 | * Copyright (C) 2003-2004 Russell King, All Rights Reserved. | |
5b4fd9ae | 5 | * SD support Copyright (C) 2004 Ian Molton, All Rights Reserved. |
ad3868b2 | 6 | * Copyright (C) 2005-2008 Pierre Ossman, All Rights Reserved. |
bce40a36 | 7 | * MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved. |
1da177e4 LT |
8 | * |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License version 2 as | |
11 | * published by the Free Software Foundation. | |
12 | */ | |
1da177e4 LT |
13 | #include <linux/module.h> |
14 | #include <linux/init.h> | |
15 | #include <linux/interrupt.h> | |
16 | #include <linux/completion.h> | |
17 | #include <linux/device.h> | |
18 | #include <linux/delay.h> | |
19 | #include <linux/pagemap.h> | |
20 | #include <linux/err.h> | |
af8350c7 | 21 | #include <linux/leds.h> |
b57c43ad | 22 | #include <linux/scatterlist.h> |
86e8286a | 23 | #include <linux/log2.h> |
5c13941a | 24 | #include <linux/regulator/consumer.h> |
e594573d | 25 | #include <linux/pm_runtime.h> |
35eb6db1 | 26 | #include <linux/suspend.h> |
1b676f70 PF |
27 | #include <linux/fault-inject.h> |
28 | #include <linux/random.h> | |
1da177e4 LT |
29 | |
30 | #include <linux/mmc/card.h> | |
31 | #include <linux/mmc/host.h> | |
da7fbe58 PO |
32 | #include <linux/mmc/mmc.h> |
33 | #include <linux/mmc/sd.h> | |
1da177e4 | 34 | |
aaac1b47 | 35 | #include "core.h" |
ffce2e7e PO |
36 | #include "bus.h" |
37 | #include "host.h" | |
e29a7d73 | 38 | #include "sdio_bus.h" |
da7fbe58 PO |
39 | |
40 | #include "mmc_ops.h" | |
41 | #include "sd_ops.h" | |
5c4e6f13 | 42 | #include "sdio_ops.h" |
1da177e4 | 43 | |
ffce2e7e PO |
44 | static struct workqueue_struct *workqueue; |
45 | ||
af517150 DB |
46 | /* |
47 | * Enabling software CRCs on the data blocks can be a significant (30%) | |
48 | * performance cost, and for other reasons may not always be desired. | |
49 | * So we allow it it to be disabled. | |
50 | */ | |
51 | int use_spi_crc = 1; | |
52 | module_param(use_spi_crc, bool, 0); | |
53 | ||
bd68e083 BH |
54 | /* |
55 | * We normally treat cards as removed during suspend if they are not | |
56 | * known to be on a non-removable bus, to avoid the risk of writing | |
57 | * back data to a different card after resume. Allow this to be | |
58 | * overridden if necessary. | |
59 | */ | |
60 | #ifdef CONFIG_MMC_UNSAFE_RESUME | |
61 | int mmc_assume_removable; | |
62 | #else | |
63 | int mmc_assume_removable = 1; | |
64 | #endif | |
71d7d3d1 | 65 | EXPORT_SYMBOL(mmc_assume_removable); |
bd68e083 BH |
66 | module_param_named(removable, mmc_assume_removable, bool, 0644); |
67 | MODULE_PARM_DESC( | |
68 | removable, | |
69 | "MMC/SD cards are removable and may be removed during suspend"); | |
70 | ||
ffce2e7e PO |
71 | /* |
72 | * Internal function. Schedule delayed work in the MMC work queue. | |
73 | */ | |
74 | static int mmc_schedule_delayed_work(struct delayed_work *work, | |
75 | unsigned long delay) | |
76 | { | |
77 | return queue_delayed_work(workqueue, work, delay); | |
78 | } | |
79 | ||
80 | /* | |
81 | * Internal function. Flush all scheduled work from the MMC work queue. | |
82 | */ | |
83 | static void mmc_flush_scheduled_work(void) | |
84 | { | |
85 | flush_workqueue(workqueue); | |
86 | } | |
87 | ||
1b676f70 PF |
88 | #ifdef CONFIG_FAIL_MMC_REQUEST |
89 | ||
90 | /* | |
91 | * Internal function. Inject random data errors. | |
92 | * If mmc_data is NULL no errors are injected. | |
93 | */ | |
94 | static void mmc_should_fail_request(struct mmc_host *host, | |
95 | struct mmc_request *mrq) | |
96 | { | |
97 | struct mmc_command *cmd = mrq->cmd; | |
98 | struct mmc_data *data = mrq->data; | |
99 | static const int data_errors[] = { | |
100 | -ETIMEDOUT, | |
101 | -EILSEQ, | |
102 | -EIO, | |
103 | }; | |
104 | ||
105 | if (!data) | |
106 | return; | |
107 | ||
108 | if (cmd->error || data->error || | |
109 | !should_fail(&host->fail_mmc_request, data->blksz * data->blocks)) | |
110 | return; | |
111 | ||
112 | data->error = data_errors[random32() % ARRAY_SIZE(data_errors)]; | |
113 | data->bytes_xfered = (random32() % (data->bytes_xfered >> 9)) << 9; | |
114 | } | |
115 | ||
116 | #else /* CONFIG_FAIL_MMC_REQUEST */ | |
117 | ||
118 | static inline void mmc_should_fail_request(struct mmc_host *host, | |
119 | struct mmc_request *mrq) | |
120 | { | |
121 | } | |
122 | ||
123 | #endif /* CONFIG_FAIL_MMC_REQUEST */ | |
124 | ||
1da177e4 | 125 | /** |
fe10c6ab RK |
126 | * mmc_request_done - finish processing an MMC request |
127 | * @host: MMC host which completed request | |
128 | * @mrq: MMC request which request | |
1da177e4 LT |
129 | * |
130 | * MMC drivers should call this function when they have completed | |
fe10c6ab | 131 | * their processing of a request. |
1da177e4 LT |
132 | */ |
133 | void mmc_request_done(struct mmc_host *host, struct mmc_request *mrq) | |
134 | { | |
135 | struct mmc_command *cmd = mrq->cmd; | |
920e70c5 RK |
136 | int err = cmd->error; |
137 | ||
af517150 DB |
138 | if (err && cmd->retries && mmc_host_is_spi(host)) { |
139 | if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND) | |
140 | cmd->retries = 0; | |
141 | } | |
142 | ||
1da177e4 | 143 | if (err && cmd->retries) { |
08a7e1df AH |
144 | /* |
145 | * Request starter must handle retries - see | |
146 | * mmc_wait_for_req_done(). | |
147 | */ | |
148 | if (mrq->done) | |
149 | mrq->done(mrq); | |
e4d21708 | 150 | } else { |
1b676f70 PF |
151 | mmc_should_fail_request(host, mrq); |
152 | ||
af8350c7 PO |
153 | led_trigger_event(host->led, LED_OFF); |
154 | ||
e4d21708 PO |
155 | pr_debug("%s: req done (CMD%u): %d: %08x %08x %08x %08x\n", |
156 | mmc_hostname(host), cmd->opcode, err, | |
157 | cmd->resp[0], cmd->resp[1], | |
158 | cmd->resp[2], cmd->resp[3]); | |
159 | ||
160 | if (mrq->data) { | |
161 | pr_debug("%s: %d bytes transferred: %d\n", | |
162 | mmc_hostname(host), | |
163 | mrq->data->bytes_xfered, mrq->data->error); | |
164 | } | |
165 | ||
166 | if (mrq->stop) { | |
167 | pr_debug("%s: (CMD%u): %d: %08x %08x %08x %08x\n", | |
168 | mmc_hostname(host), mrq->stop->opcode, | |
169 | mrq->stop->error, | |
170 | mrq->stop->resp[0], mrq->stop->resp[1], | |
171 | mrq->stop->resp[2], mrq->stop->resp[3]); | |
172 | } | |
173 | ||
174 | if (mrq->done) | |
175 | mrq->done(mrq); | |
04566831 | 176 | |
08c14071 | 177 | mmc_host_clk_release(host); |
1da177e4 LT |
178 | } |
179 | } | |
180 | ||
181 | EXPORT_SYMBOL(mmc_request_done); | |
182 | ||
39361851 | 183 | static void |
1da177e4 LT |
184 | mmc_start_request(struct mmc_host *host, struct mmc_request *mrq) |
185 | { | |
976d9276 PO |
186 | #ifdef CONFIG_MMC_DEBUG |
187 | unsigned int i, sz; | |
a84756c5 | 188 | struct scatterlist *sg; |
976d9276 PO |
189 | #endif |
190 | ||
920e70c5 RK |
191 | pr_debug("%s: starting CMD%u arg %08x flags %08x\n", |
192 | mmc_hostname(host), mrq->cmd->opcode, | |
193 | mrq->cmd->arg, mrq->cmd->flags); | |
1da177e4 | 194 | |
e4d21708 PO |
195 | if (mrq->data) { |
196 | pr_debug("%s: blksz %d blocks %d flags %08x " | |
197 | "tsac %d ms nsac %d\n", | |
198 | mmc_hostname(host), mrq->data->blksz, | |
199 | mrq->data->blocks, mrq->data->flags, | |
ce252edd | 200 | mrq->data->timeout_ns / 1000000, |
e4d21708 PO |
201 | mrq->data->timeout_clks); |
202 | } | |
203 | ||
204 | if (mrq->stop) { | |
205 | pr_debug("%s: CMD%u arg %08x flags %08x\n", | |
206 | mmc_hostname(host), mrq->stop->opcode, | |
207 | mrq->stop->arg, mrq->stop->flags); | |
208 | } | |
209 | ||
f22ee4ed | 210 | WARN_ON(!host->claimed); |
1da177e4 LT |
211 | |
212 | mrq->cmd->error = 0; | |
213 | mrq->cmd->mrq = mrq; | |
214 | if (mrq->data) { | |
fe4a3c7a | 215 | BUG_ON(mrq->data->blksz > host->max_blk_size); |
55db890a PO |
216 | BUG_ON(mrq->data->blocks > host->max_blk_count); |
217 | BUG_ON(mrq->data->blocks * mrq->data->blksz > | |
218 | host->max_req_size); | |
fe4a3c7a | 219 | |
976d9276 PO |
220 | #ifdef CONFIG_MMC_DEBUG |
221 | sz = 0; | |
a84756c5 PO |
222 | for_each_sg(mrq->data->sg, sg, mrq->data->sg_len, i) |
223 | sz += sg->length; | |
976d9276 PO |
224 | BUG_ON(sz != mrq->data->blocks * mrq->data->blksz); |
225 | #endif | |
226 | ||
1da177e4 LT |
227 | mrq->cmd->data = mrq->data; |
228 | mrq->data->error = 0; | |
229 | mrq->data->mrq = mrq; | |
230 | if (mrq->stop) { | |
231 | mrq->data->stop = mrq->stop; | |
232 | mrq->stop->error = 0; | |
233 | mrq->stop->mrq = mrq; | |
234 | } | |
235 | } | |
08c14071 | 236 | mmc_host_clk_hold(host); |
66c036e0 | 237 | led_trigger_event(host->led, LED_FULL); |
1da177e4 LT |
238 | host->ops->request(host, mrq); |
239 | } | |
240 | ||
1da177e4 LT |
241 | static void mmc_wait_done(struct mmc_request *mrq) |
242 | { | |
aa8b683a PF |
243 | complete(&mrq->completion); |
244 | } | |
245 | ||
246 | static void __mmc_start_req(struct mmc_host *host, struct mmc_request *mrq) | |
247 | { | |
248 | init_completion(&mrq->completion); | |
249 | mrq->done = mmc_wait_done; | |
250 | mmc_start_request(host, mrq); | |
251 | } | |
252 | ||
253 | static void mmc_wait_for_req_done(struct mmc_host *host, | |
254 | struct mmc_request *mrq) | |
255 | { | |
08a7e1df AH |
256 | struct mmc_command *cmd; |
257 | ||
258 | while (1) { | |
259 | wait_for_completion(&mrq->completion); | |
260 | ||
261 | cmd = mrq->cmd; | |
262 | if (!cmd->error || !cmd->retries) | |
263 | break; | |
264 | ||
265 | pr_debug("%s: req failed (CMD%u): %d, retrying...\n", | |
266 | mmc_hostname(host), cmd->opcode, cmd->error); | |
267 | cmd->retries--; | |
268 | cmd->error = 0; | |
269 | host->ops->request(host, mrq); | |
270 | } | |
aa8b683a PF |
271 | } |
272 | ||
273 | /** | |
274 | * mmc_pre_req - Prepare for a new request | |
275 | * @host: MMC host to prepare command | |
276 | * @mrq: MMC request to prepare for | |
277 | * @is_first_req: true if there is no previous started request | |
278 | * that may run in parellel to this call, otherwise false | |
279 | * | |
280 | * mmc_pre_req() is called in prior to mmc_start_req() to let | |
281 | * host prepare for the new request. Preparation of a request may be | |
282 | * performed while another request is running on the host. | |
283 | */ | |
284 | static void mmc_pre_req(struct mmc_host *host, struct mmc_request *mrq, | |
285 | bool is_first_req) | |
286 | { | |
287 | if (host->ops->pre_req) | |
288 | host->ops->pre_req(host, mrq, is_first_req); | |
289 | } | |
290 | ||
291 | /** | |
292 | * mmc_post_req - Post process a completed request | |
293 | * @host: MMC host to post process command | |
294 | * @mrq: MMC request to post process for | |
295 | * @err: Error, if non zero, clean up any resources made in pre_req | |
296 | * | |
297 | * Let the host post process a completed request. Post processing of | |
298 | * a request may be performed while another reuqest is running. | |
299 | */ | |
300 | static void mmc_post_req(struct mmc_host *host, struct mmc_request *mrq, | |
301 | int err) | |
302 | { | |
303 | if (host->ops->post_req) | |
304 | host->ops->post_req(host, mrq, err); | |
1da177e4 LT |
305 | } |
306 | ||
aa8b683a PF |
307 | /** |
308 | * mmc_start_req - start a non-blocking request | |
309 | * @host: MMC host to start command | |
310 | * @areq: async request to start | |
311 | * @error: out parameter returns 0 for success, otherwise non zero | |
312 | * | |
313 | * Start a new MMC custom command request for a host. | |
314 | * If there is on ongoing async request wait for completion | |
315 | * of that request and start the new one and return. | |
316 | * Does not wait for the new request to complete. | |
317 | * | |
318 | * Returns the completed request, NULL in case of none completed. | |
319 | * Wait for the an ongoing request (previoulsy started) to complete and | |
320 | * return the completed request. If there is no ongoing request, NULL | |
321 | * is returned without waiting. NULL is not an error condition. | |
322 | */ | |
323 | struct mmc_async_req *mmc_start_req(struct mmc_host *host, | |
324 | struct mmc_async_req *areq, int *error) | |
325 | { | |
326 | int err = 0; | |
327 | struct mmc_async_req *data = host->areq; | |
328 | ||
329 | /* Prepare a new request */ | |
330 | if (areq) | |
331 | mmc_pre_req(host, areq->mrq, !host->areq); | |
332 | ||
333 | if (host->areq) { | |
334 | mmc_wait_for_req_done(host, host->areq->mrq); | |
335 | err = host->areq->err_check(host->card, host->areq); | |
336 | if (err) { | |
7c8a2829 | 337 | /* post process the completed failed request */ |
aa8b683a PF |
338 | mmc_post_req(host, host->areq->mrq, 0); |
339 | if (areq) | |
7c8a2829 PF |
340 | /* |
341 | * Cancel the new prepared request, because | |
342 | * it can't run until the failed | |
343 | * request has been properly handled. | |
344 | */ | |
aa8b683a PF |
345 | mmc_post_req(host, areq->mrq, -EINVAL); |
346 | ||
347 | host->areq = NULL; | |
348 | goto out; | |
349 | } | |
350 | } | |
351 | ||
352 | if (areq) | |
353 | __mmc_start_req(host, areq->mrq); | |
354 | ||
355 | if (host->areq) | |
356 | mmc_post_req(host, host->areq->mrq, 0); | |
357 | ||
358 | host->areq = areq; | |
359 | out: | |
360 | if (error) | |
361 | *error = err; | |
362 | return data; | |
363 | } | |
364 | EXPORT_SYMBOL(mmc_start_req); | |
365 | ||
67a61c48 PO |
366 | /** |
367 | * mmc_wait_for_req - start a request and wait for completion | |
368 | * @host: MMC host to start command | |
369 | * @mrq: MMC request to start | |
370 | * | |
371 | * Start a new MMC custom command request for a host, and wait | |
372 | * for the command to complete. Does not attempt to parse the | |
373 | * response. | |
374 | */ | |
375 | void mmc_wait_for_req(struct mmc_host *host, struct mmc_request *mrq) | |
1da177e4 | 376 | { |
aa8b683a PF |
377 | __mmc_start_req(host, mrq); |
378 | mmc_wait_for_req_done(host, mrq); | |
1da177e4 | 379 | } |
1da177e4 LT |
380 | EXPORT_SYMBOL(mmc_wait_for_req); |
381 | ||
382 | /** | |
383 | * mmc_wait_for_cmd - start a command and wait for completion | |
384 | * @host: MMC host to start command | |
385 | * @cmd: MMC command to start | |
386 | * @retries: maximum number of retries | |
387 | * | |
388 | * Start a new MMC command for a host, and wait for the command | |
389 | * to complete. Return any error that occurred while the command | |
390 | * was executing. Do not attempt to parse the response. | |
391 | */ | |
392 | int mmc_wait_for_cmd(struct mmc_host *host, struct mmc_command *cmd, int retries) | |
393 | { | |
ad5fd972 | 394 | struct mmc_request mrq = {NULL}; |
1da177e4 | 395 | |
d84075c8 | 396 | WARN_ON(!host->claimed); |
1da177e4 | 397 | |
1da177e4 LT |
398 | memset(cmd->resp, 0, sizeof(cmd->resp)); |
399 | cmd->retries = retries; | |
400 | ||
401 | mrq.cmd = cmd; | |
402 | cmd->data = NULL; | |
403 | ||
404 | mmc_wait_for_req(host, &mrq); | |
405 | ||
406 | return cmd->error; | |
407 | } | |
408 | ||
409 | EXPORT_SYMBOL(mmc_wait_for_cmd); | |
410 | ||
d773d725 RK |
411 | /** |
412 | * mmc_set_data_timeout - set the timeout for a data command | |
413 | * @data: data phase for command | |
414 | * @card: the MMC card associated with the data transfer | |
67a61c48 PO |
415 | * |
416 | * Computes the data timeout parameters according to the | |
417 | * correct algorithm given the card type. | |
d773d725 | 418 | */ |
b146d26a | 419 | void mmc_set_data_timeout(struct mmc_data *data, const struct mmc_card *card) |
d773d725 RK |
420 | { |
421 | unsigned int mult; | |
422 | ||
e6f918bf PO |
423 | /* |
424 | * SDIO cards only define an upper 1 s limit on access. | |
425 | */ | |
426 | if (mmc_card_sdio(card)) { | |
427 | data->timeout_ns = 1000000000; | |
428 | data->timeout_clks = 0; | |
429 | return; | |
430 | } | |
431 | ||
d773d725 RK |
432 | /* |
433 | * SD cards use a 100 multiplier rather than 10 | |
434 | */ | |
435 | mult = mmc_card_sd(card) ? 100 : 10; | |
436 | ||
437 | /* | |
438 | * Scale up the multiplier (and therefore the timeout) by | |
439 | * the r2w factor for writes. | |
440 | */ | |
b146d26a | 441 | if (data->flags & MMC_DATA_WRITE) |
d773d725 RK |
442 | mult <<= card->csd.r2w_factor; |
443 | ||
444 | data->timeout_ns = card->csd.tacc_ns * mult; | |
445 | data->timeout_clks = card->csd.tacc_clks * mult; | |
446 | ||
447 | /* | |
448 | * SD cards also have an upper limit on the timeout. | |
449 | */ | |
450 | if (mmc_card_sd(card)) { | |
451 | unsigned int timeout_us, limit_us; | |
452 | ||
453 | timeout_us = data->timeout_ns / 1000; | |
e9b86841 LW |
454 | if (mmc_host_clk_rate(card->host)) |
455 | timeout_us += data->timeout_clks * 1000 / | |
456 | (mmc_host_clk_rate(card->host) / 1000); | |
d773d725 | 457 | |
b146d26a | 458 | if (data->flags & MMC_DATA_WRITE) |
493890e7 PO |
459 | /* |
460 | * The limit is really 250 ms, but that is | |
461 | * insufficient for some crappy cards. | |
462 | */ | |
463 | limit_us = 300000; | |
d773d725 RK |
464 | else |
465 | limit_us = 100000; | |
466 | ||
fba68bd2 PL |
467 | /* |
468 | * SDHC cards always use these fixed values. | |
469 | */ | |
470 | if (timeout_us > limit_us || mmc_card_blockaddr(card)) { | |
d773d725 RK |
471 | data->timeout_ns = limit_us * 1000; |
472 | data->timeout_clks = 0; | |
473 | } | |
474 | } | |
c0c88871 WM |
475 | /* |
476 | * Some cards need very high timeouts if driven in SPI mode. | |
477 | * The worst observed timeout was 900ms after writing a | |
478 | * continuous stream of data until the internal logic | |
479 | * overflowed. | |
480 | */ | |
481 | if (mmc_host_is_spi(card->host)) { | |
482 | if (data->flags & MMC_DATA_WRITE) { | |
483 | if (data->timeout_ns < 1000000000) | |
484 | data->timeout_ns = 1000000000; /* 1s */ | |
485 | } else { | |
486 | if (data->timeout_ns < 100000000) | |
487 | data->timeout_ns = 100000000; /* 100ms */ | |
488 | } | |
489 | } | |
d773d725 RK |
490 | } |
491 | EXPORT_SYMBOL(mmc_set_data_timeout); | |
492 | ||
ad3868b2 PO |
493 | /** |
494 | * mmc_align_data_size - pads a transfer size to a more optimal value | |
495 | * @card: the MMC card associated with the data transfer | |
496 | * @sz: original transfer size | |
497 | * | |
498 | * Pads the original data size with a number of extra bytes in | |
499 | * order to avoid controller bugs and/or performance hits | |
500 | * (e.g. some controllers revert to PIO for certain sizes). | |
501 | * | |
502 | * Returns the improved size, which might be unmodified. | |
503 | * | |
504 | * Note that this function is only relevant when issuing a | |
505 | * single scatter gather entry. | |
506 | */ | |
507 | unsigned int mmc_align_data_size(struct mmc_card *card, unsigned int sz) | |
508 | { | |
509 | /* | |
510 | * FIXME: We don't have a system for the controller to tell | |
511 | * the core about its problems yet, so for now we just 32-bit | |
512 | * align the size. | |
513 | */ | |
514 | sz = ((sz + 3) / 4) * 4; | |
515 | ||
516 | return sz; | |
517 | } | |
518 | EXPORT_SYMBOL(mmc_align_data_size); | |
519 | ||
8ea926b2 AH |
520 | /** |
521 | * mmc_host_enable - enable a host. | |
522 | * @host: mmc host to enable | |
523 | * | |
524 | * Hosts that support power saving can use the 'enable' and 'disable' | |
525 | * methods to exit and enter power saving states. For more information | |
526 | * see comments for struct mmc_host_ops. | |
527 | */ | |
528 | int mmc_host_enable(struct mmc_host *host) | |
529 | { | |
530 | if (!(host->caps & MMC_CAP_DISABLE)) | |
531 | return 0; | |
532 | ||
533 | if (host->en_dis_recurs) | |
534 | return 0; | |
535 | ||
536 | if (host->nesting_cnt++) | |
537 | return 0; | |
538 | ||
539 | cancel_delayed_work_sync(&host->disable); | |
540 | ||
541 | if (host->enabled) | |
542 | return 0; | |
543 | ||
544 | if (host->ops->enable) { | |
545 | int err; | |
546 | ||
547 | host->en_dis_recurs = 1; | |
548 | err = host->ops->enable(host); | |
549 | host->en_dis_recurs = 0; | |
550 | ||
551 | if (err) { | |
552 | pr_debug("%s: enable error %d\n", | |
553 | mmc_hostname(host), err); | |
554 | return err; | |
555 | } | |
556 | } | |
557 | host->enabled = 1; | |
558 | return 0; | |
559 | } | |
560 | EXPORT_SYMBOL(mmc_host_enable); | |
561 | ||
562 | static int mmc_host_do_disable(struct mmc_host *host, int lazy) | |
563 | { | |
564 | if (host->ops->disable) { | |
565 | int err; | |
566 | ||
567 | host->en_dis_recurs = 1; | |
568 | err = host->ops->disable(host, lazy); | |
569 | host->en_dis_recurs = 0; | |
570 | ||
571 | if (err < 0) { | |
572 | pr_debug("%s: disable error %d\n", | |
573 | mmc_hostname(host), err); | |
574 | return err; | |
575 | } | |
576 | if (err > 0) { | |
577 | unsigned long delay = msecs_to_jiffies(err); | |
578 | ||
579 | mmc_schedule_delayed_work(&host->disable, delay); | |
580 | } | |
581 | } | |
582 | host->enabled = 0; | |
583 | return 0; | |
584 | } | |
585 | ||
586 | /** | |
587 | * mmc_host_disable - disable a host. | |
588 | * @host: mmc host to disable | |
589 | * | |
590 | * Hosts that support power saving can use the 'enable' and 'disable' | |
591 | * methods to exit and enter power saving states. For more information | |
592 | * see comments for struct mmc_host_ops. | |
593 | */ | |
594 | int mmc_host_disable(struct mmc_host *host) | |
595 | { | |
596 | int err; | |
597 | ||
598 | if (!(host->caps & MMC_CAP_DISABLE)) | |
599 | return 0; | |
600 | ||
601 | if (host->en_dis_recurs) | |
602 | return 0; | |
603 | ||
604 | if (--host->nesting_cnt) | |
605 | return 0; | |
606 | ||
607 | if (!host->enabled) | |
608 | return 0; | |
609 | ||
610 | err = mmc_host_do_disable(host, 0); | |
611 | return err; | |
612 | } | |
613 | EXPORT_SYMBOL(mmc_host_disable); | |
614 | ||
1da177e4 | 615 | /** |
2342f332 | 616 | * __mmc_claim_host - exclusively claim a host |
1da177e4 | 617 | * @host: mmc host to claim |
2342f332 | 618 | * @abort: whether or not the operation should be aborted |
1da177e4 | 619 | * |
2342f332 NP |
620 | * Claim a host for a set of operations. If @abort is non null and |
621 | * dereference a non-zero value then this will return prematurely with | |
622 | * that non-zero value without acquiring the lock. Returns zero | |
623 | * with the lock held otherwise. | |
1da177e4 | 624 | */ |
2342f332 | 625 | int __mmc_claim_host(struct mmc_host *host, atomic_t *abort) |
1da177e4 LT |
626 | { |
627 | DECLARE_WAITQUEUE(wait, current); | |
628 | unsigned long flags; | |
2342f332 | 629 | int stop; |
1da177e4 | 630 | |
cf795bfb PO |
631 | might_sleep(); |
632 | ||
1da177e4 LT |
633 | add_wait_queue(&host->wq, &wait); |
634 | spin_lock_irqsave(&host->lock, flags); | |
635 | while (1) { | |
636 | set_current_state(TASK_UNINTERRUPTIBLE); | |
2342f332 | 637 | stop = abort ? atomic_read(abort) : 0; |
319a3f14 | 638 | if (stop || !host->claimed || host->claimer == current) |
1da177e4 LT |
639 | break; |
640 | spin_unlock_irqrestore(&host->lock, flags); | |
641 | schedule(); | |
642 | spin_lock_irqsave(&host->lock, flags); | |
643 | } | |
644 | set_current_state(TASK_RUNNING); | |
319a3f14 | 645 | if (!stop) { |
2342f332 | 646 | host->claimed = 1; |
319a3f14 AH |
647 | host->claimer = current; |
648 | host->claim_cnt += 1; | |
649 | } else | |
2342f332 | 650 | wake_up(&host->wq); |
1da177e4 LT |
651 | spin_unlock_irqrestore(&host->lock, flags); |
652 | remove_wait_queue(&host->wq, &wait); | |
8ea926b2 AH |
653 | if (!stop) |
654 | mmc_host_enable(host); | |
2342f332 | 655 | return stop; |
1da177e4 LT |
656 | } |
657 | ||
2342f332 | 658 | EXPORT_SYMBOL(__mmc_claim_host); |
1da177e4 | 659 | |
319a3f14 AH |
660 | /** |
661 | * mmc_try_claim_host - try exclusively to claim a host | |
662 | * @host: mmc host to claim | |
663 | * | |
664 | * Returns %1 if the host is claimed, %0 otherwise. | |
665 | */ | |
666 | int mmc_try_claim_host(struct mmc_host *host) | |
8ea926b2 AH |
667 | { |
668 | int claimed_host = 0; | |
669 | unsigned long flags; | |
670 | ||
671 | spin_lock_irqsave(&host->lock, flags); | |
319a3f14 | 672 | if (!host->claimed || host->claimer == current) { |
8ea926b2 | 673 | host->claimed = 1; |
319a3f14 AH |
674 | host->claimer = current; |
675 | host->claim_cnt += 1; | |
8ea926b2 AH |
676 | claimed_host = 1; |
677 | } | |
678 | spin_unlock_irqrestore(&host->lock, flags); | |
679 | return claimed_host; | |
680 | } | |
319a3f14 | 681 | EXPORT_SYMBOL(mmc_try_claim_host); |
8ea926b2 | 682 | |
ab1efd27 UH |
683 | /** |
684 | * mmc_do_release_host - release a claimed host | |
685 | * @host: mmc host to release | |
686 | * | |
687 | * If you successfully claimed a host, this function will | |
688 | * release it again. | |
689 | */ | |
690 | void mmc_do_release_host(struct mmc_host *host) | |
8ea926b2 AH |
691 | { |
692 | unsigned long flags; | |
693 | ||
694 | spin_lock_irqsave(&host->lock, flags); | |
319a3f14 AH |
695 | if (--host->claim_cnt) { |
696 | /* Release for nested claim */ | |
697 | spin_unlock_irqrestore(&host->lock, flags); | |
698 | } else { | |
699 | host->claimed = 0; | |
700 | host->claimer = NULL; | |
701 | spin_unlock_irqrestore(&host->lock, flags); | |
702 | wake_up(&host->wq); | |
703 | } | |
8ea926b2 | 704 | } |
ab1efd27 | 705 | EXPORT_SYMBOL(mmc_do_release_host); |
8ea926b2 AH |
706 | |
707 | void mmc_host_deeper_disable(struct work_struct *work) | |
708 | { | |
709 | struct mmc_host *host = | |
710 | container_of(work, struct mmc_host, disable.work); | |
711 | ||
712 | /* If the host is claimed then we do not want to disable it anymore */ | |
713 | if (!mmc_try_claim_host(host)) | |
714 | return; | |
715 | mmc_host_do_disable(host, 1); | |
716 | mmc_do_release_host(host); | |
717 | } | |
718 | ||
719 | /** | |
720 | * mmc_host_lazy_disable - lazily disable a host. | |
721 | * @host: mmc host to disable | |
722 | * | |
723 | * Hosts that support power saving can use the 'enable' and 'disable' | |
724 | * methods to exit and enter power saving states. For more information | |
725 | * see comments for struct mmc_host_ops. | |
726 | */ | |
727 | int mmc_host_lazy_disable(struct mmc_host *host) | |
728 | { | |
729 | if (!(host->caps & MMC_CAP_DISABLE)) | |
730 | return 0; | |
731 | ||
732 | if (host->en_dis_recurs) | |
733 | return 0; | |
734 | ||
735 | if (--host->nesting_cnt) | |
736 | return 0; | |
737 | ||
738 | if (!host->enabled) | |
739 | return 0; | |
740 | ||
741 | if (host->disable_delay) { | |
742 | mmc_schedule_delayed_work(&host->disable, | |
743 | msecs_to_jiffies(host->disable_delay)); | |
744 | return 0; | |
745 | } else | |
746 | return mmc_host_do_disable(host, 1); | |
747 | } | |
748 | EXPORT_SYMBOL(mmc_host_lazy_disable); | |
749 | ||
1da177e4 LT |
750 | /** |
751 | * mmc_release_host - release a host | |
752 | * @host: mmc host to release | |
753 | * | |
754 | * Release a MMC host, allowing others to claim the host | |
755 | * for their operations. | |
756 | */ | |
757 | void mmc_release_host(struct mmc_host *host) | |
758 | { | |
d84075c8 | 759 | WARN_ON(!host->claimed); |
1da177e4 | 760 | |
8ea926b2 | 761 | mmc_host_lazy_disable(host); |
1da177e4 | 762 | |
8ea926b2 | 763 | mmc_do_release_host(host); |
1da177e4 LT |
764 | } |
765 | ||
766 | EXPORT_SYMBOL(mmc_release_host); | |
767 | ||
7ea239d9 PO |
768 | /* |
769 | * Internal function that does the actual ios call to the host driver, | |
770 | * optionally printing some debug output. | |
771 | */ | |
920e70c5 RK |
772 | static inline void mmc_set_ios(struct mmc_host *host) |
773 | { | |
774 | struct mmc_ios *ios = &host->ios; | |
775 | ||
cd9277c0 PO |
776 | pr_debug("%s: clock %uHz busmode %u powermode %u cs %u Vdd %u " |
777 | "width %u timing %u\n", | |
920e70c5 RK |
778 | mmc_hostname(host), ios->clock, ios->bus_mode, |
779 | ios->power_mode, ios->chip_select, ios->vdd, | |
cd9277c0 | 780 | ios->bus_width, ios->timing); |
fba68bd2 | 781 | |
04566831 LW |
782 | if (ios->clock > 0) |
783 | mmc_set_ungated(host); | |
920e70c5 RK |
784 | host->ops->set_ios(host, ios); |
785 | } | |
786 | ||
7ea239d9 PO |
787 | /* |
788 | * Control chip select pin on a host. | |
789 | */ | |
da7fbe58 | 790 | void mmc_set_chip_select(struct mmc_host *host, int mode) |
1da177e4 | 791 | { |
778e277c | 792 | mmc_host_clk_hold(host); |
da7fbe58 PO |
793 | host->ios.chip_select = mode; |
794 | mmc_set_ios(host); | |
778e277c | 795 | mmc_host_clk_release(host); |
1da177e4 LT |
796 | } |
797 | ||
7ea239d9 PO |
798 | /* |
799 | * Sets the host clock to the highest possible frequency that | |
800 | * is below "hz". | |
801 | */ | |
778e277c | 802 | static void __mmc_set_clock(struct mmc_host *host, unsigned int hz) |
7ea239d9 PO |
803 | { |
804 | WARN_ON(hz < host->f_min); | |
805 | ||
806 | if (hz > host->f_max) | |
807 | hz = host->f_max; | |
808 | ||
809 | host->ios.clock = hz; | |
810 | mmc_set_ios(host); | |
811 | } | |
812 | ||
778e277c MW |
813 | void mmc_set_clock(struct mmc_host *host, unsigned int hz) |
814 | { | |
815 | mmc_host_clk_hold(host); | |
816 | __mmc_set_clock(host, hz); | |
817 | mmc_host_clk_release(host); | |
818 | } | |
819 | ||
04566831 LW |
820 | #ifdef CONFIG_MMC_CLKGATE |
821 | /* | |
822 | * This gates the clock by setting it to 0 Hz. | |
823 | */ | |
824 | void mmc_gate_clock(struct mmc_host *host) | |
825 | { | |
826 | unsigned long flags; | |
827 | ||
828 | spin_lock_irqsave(&host->clk_lock, flags); | |
829 | host->clk_old = host->ios.clock; | |
830 | host->ios.clock = 0; | |
831 | host->clk_gated = true; | |
832 | spin_unlock_irqrestore(&host->clk_lock, flags); | |
833 | mmc_set_ios(host); | |
834 | } | |
835 | ||
836 | /* | |
837 | * This restores the clock from gating by using the cached | |
838 | * clock value. | |
839 | */ | |
840 | void mmc_ungate_clock(struct mmc_host *host) | |
841 | { | |
842 | /* | |
843 | * We should previously have gated the clock, so the clock shall | |
844 | * be 0 here! The clock may however be 0 during initialization, | |
845 | * when some request operations are performed before setting | |
846 | * the frequency. When ungate is requested in that situation | |
847 | * we just ignore the call. | |
848 | */ | |
849 | if (host->clk_old) { | |
850 | BUG_ON(host->ios.clock); | |
851 | /* This call will also set host->clk_gated to false */ | |
778e277c | 852 | __mmc_set_clock(host, host->clk_old); |
04566831 LW |
853 | } |
854 | } | |
855 | ||
856 | void mmc_set_ungated(struct mmc_host *host) | |
857 | { | |
858 | unsigned long flags; | |
859 | ||
860 | /* | |
861 | * We've been given a new frequency while the clock is gated, | |
862 | * so make sure we regard this as ungating it. | |
863 | */ | |
864 | spin_lock_irqsave(&host->clk_lock, flags); | |
865 | host->clk_gated = false; | |
866 | spin_unlock_irqrestore(&host->clk_lock, flags); | |
867 | } | |
868 | ||
869 | #else | |
870 | void mmc_set_ungated(struct mmc_host *host) | |
871 | { | |
872 | } | |
873 | #endif | |
874 | ||
7ea239d9 PO |
875 | /* |
876 | * Change the bus mode (open drain/push-pull) of a host. | |
877 | */ | |
878 | void mmc_set_bus_mode(struct mmc_host *host, unsigned int mode) | |
879 | { | |
778e277c | 880 | mmc_host_clk_hold(host); |
7ea239d9 PO |
881 | host->ios.bus_mode = mode; |
882 | mmc_set_ios(host); | |
778e277c | 883 | mmc_host_clk_release(host); |
7ea239d9 PO |
884 | } |
885 | ||
0f8d8ea6 AH |
886 | /* |
887 | * Change data bus width of a host. | |
888 | */ | |
889 | void mmc_set_bus_width(struct mmc_host *host, unsigned int width) | |
890 | { | |
778e277c | 891 | mmc_host_clk_hold(host); |
4c4cb171 PR |
892 | host->ios.bus_width = width; |
893 | mmc_set_ios(host); | |
778e277c | 894 | mmc_host_clk_release(host); |
0f8d8ea6 AH |
895 | } |
896 | ||
86e8286a AV |
897 | /** |
898 | * mmc_vdd_to_ocrbitnum - Convert a voltage to the OCR bit number | |
899 | * @vdd: voltage (mV) | |
900 | * @low_bits: prefer low bits in boundary cases | |
901 | * | |
902 | * This function returns the OCR bit number according to the provided @vdd | |
903 | * value. If conversion is not possible a negative errno value returned. | |
904 | * | |
905 | * Depending on the @low_bits flag the function prefers low or high OCR bits | |
906 | * on boundary voltages. For example, | |
907 | * with @low_bits = true, 3300 mV translates to ilog2(MMC_VDD_32_33); | |
908 | * with @low_bits = false, 3300 mV translates to ilog2(MMC_VDD_33_34); | |
909 | * | |
910 | * Any value in the [1951:1999] range translates to the ilog2(MMC_VDD_20_21). | |
911 | */ | |
912 | static int mmc_vdd_to_ocrbitnum(int vdd, bool low_bits) | |
913 | { | |
914 | const int max_bit = ilog2(MMC_VDD_35_36); | |
915 | int bit; | |
916 | ||
917 | if (vdd < 1650 || vdd > 3600) | |
918 | return -EINVAL; | |
919 | ||
920 | if (vdd >= 1650 && vdd <= 1950) | |
921 | return ilog2(MMC_VDD_165_195); | |
922 | ||
923 | if (low_bits) | |
924 | vdd -= 1; | |
925 | ||
926 | /* Base 2000 mV, step 100 mV, bit's base 8. */ | |
927 | bit = (vdd - 2000) / 100 + 8; | |
928 | if (bit > max_bit) | |
929 | return max_bit; | |
930 | return bit; | |
931 | } | |
932 | ||
933 | /** | |
934 | * mmc_vddrange_to_ocrmask - Convert a voltage range to the OCR mask | |
935 | * @vdd_min: minimum voltage value (mV) | |
936 | * @vdd_max: maximum voltage value (mV) | |
937 | * | |
938 | * This function returns the OCR mask bits according to the provided @vdd_min | |
939 | * and @vdd_max values. If conversion is not possible the function returns 0. | |
940 | * | |
941 | * Notes wrt boundary cases: | |
942 | * This function sets the OCR bits for all boundary voltages, for example | |
943 | * [3300:3400] range is translated to MMC_VDD_32_33 | MMC_VDD_33_34 | | |
944 | * MMC_VDD_34_35 mask. | |
945 | */ | |
946 | u32 mmc_vddrange_to_ocrmask(int vdd_min, int vdd_max) | |
947 | { | |
948 | u32 mask = 0; | |
949 | ||
950 | if (vdd_max < vdd_min) | |
951 | return 0; | |
952 | ||
953 | /* Prefer high bits for the boundary vdd_max values. */ | |
954 | vdd_max = mmc_vdd_to_ocrbitnum(vdd_max, false); | |
955 | if (vdd_max < 0) | |
956 | return 0; | |
957 | ||
958 | /* Prefer low bits for the boundary vdd_min values. */ | |
959 | vdd_min = mmc_vdd_to_ocrbitnum(vdd_min, true); | |
960 | if (vdd_min < 0) | |
961 | return 0; | |
962 | ||
963 | /* Fill the mask, from max bit to min bit. */ | |
964 | while (vdd_max >= vdd_min) | |
965 | mask |= 1 << vdd_max--; | |
966 | ||
967 | return mask; | |
968 | } | |
969 | EXPORT_SYMBOL(mmc_vddrange_to_ocrmask); | |
970 | ||
5c13941a DB |
971 | #ifdef CONFIG_REGULATOR |
972 | ||
973 | /** | |
974 | * mmc_regulator_get_ocrmask - return mask of supported voltages | |
975 | * @supply: regulator to use | |
976 | * | |
977 | * This returns either a negative errno, or a mask of voltages that | |
978 | * can be provided to MMC/SD/SDIO devices using the specified voltage | |
979 | * regulator. This would normally be called before registering the | |
980 | * MMC host adapter. | |
981 | */ | |
982 | int mmc_regulator_get_ocrmask(struct regulator *supply) | |
983 | { | |
984 | int result = 0; | |
985 | int count; | |
986 | int i; | |
987 | ||
988 | count = regulator_count_voltages(supply); | |
989 | if (count < 0) | |
990 | return count; | |
991 | ||
992 | for (i = 0; i < count; i++) { | |
993 | int vdd_uV; | |
994 | int vdd_mV; | |
995 | ||
996 | vdd_uV = regulator_list_voltage(supply, i); | |
997 | if (vdd_uV <= 0) | |
998 | continue; | |
999 | ||
1000 | vdd_mV = vdd_uV / 1000; | |
1001 | result |= mmc_vddrange_to_ocrmask(vdd_mV, vdd_mV); | |
1002 | } | |
1003 | ||
1004 | return result; | |
1005 | } | |
1006 | EXPORT_SYMBOL(mmc_regulator_get_ocrmask); | |
1007 | ||
1008 | /** | |
1009 | * mmc_regulator_set_ocr - set regulator to match host->ios voltage | |
99fc5131 | 1010 | * @mmc: the host to regulate |
5c13941a | 1011 | * @supply: regulator to use |
99fc5131 | 1012 | * @vdd_bit: zero for power off, else a bit number (host->ios.vdd) |
5c13941a DB |
1013 | * |
1014 | * Returns zero on success, else negative errno. | |
1015 | * | |
1016 | * MMC host drivers may use this to enable or disable a regulator using | |
1017 | * a particular supply voltage. This would normally be called from the | |
1018 | * set_ios() method. | |
1019 | */ | |
99fc5131 LW |
1020 | int mmc_regulator_set_ocr(struct mmc_host *mmc, |
1021 | struct regulator *supply, | |
1022 | unsigned short vdd_bit) | |
5c13941a DB |
1023 | { |
1024 | int result = 0; | |
1025 | int min_uV, max_uV; | |
5c13941a DB |
1026 | |
1027 | if (vdd_bit) { | |
1028 | int tmp; | |
1029 | int voltage; | |
1030 | ||
1031 | /* REVISIT mmc_vddrange_to_ocrmask() may have set some | |
1032 | * bits this regulator doesn't quite support ... don't | |
1033 | * be too picky, most cards and regulators are OK with | |
1034 | * a 0.1V range goof (it's a small error percentage). | |
1035 | */ | |
1036 | tmp = vdd_bit - ilog2(MMC_VDD_165_195); | |
1037 | if (tmp == 0) { | |
1038 | min_uV = 1650 * 1000; | |
1039 | max_uV = 1950 * 1000; | |
1040 | } else { | |
1041 | min_uV = 1900 * 1000 + tmp * 100 * 1000; | |
1042 | max_uV = min_uV + 100 * 1000; | |
1043 | } | |
1044 | ||
1045 | /* avoid needless changes to this voltage; the regulator | |
1046 | * might not allow this operation | |
1047 | */ | |
1048 | voltage = regulator_get_voltage(supply); | |
1049 | if (voltage < 0) | |
1050 | result = voltage; | |
1051 | else if (voltage < min_uV || voltage > max_uV) | |
1052 | result = regulator_set_voltage(supply, min_uV, max_uV); | |
1053 | else | |
1054 | result = 0; | |
1055 | ||
99fc5131 | 1056 | if (result == 0 && !mmc->regulator_enabled) { |
5c13941a | 1057 | result = regulator_enable(supply); |
99fc5131 LW |
1058 | if (!result) |
1059 | mmc->regulator_enabled = true; | |
1060 | } | |
1061 | } else if (mmc->regulator_enabled) { | |
5c13941a | 1062 | result = regulator_disable(supply); |
99fc5131 LW |
1063 | if (result == 0) |
1064 | mmc->regulator_enabled = false; | |
5c13941a DB |
1065 | } |
1066 | ||
99fc5131 LW |
1067 | if (result) |
1068 | dev_err(mmc_dev(mmc), | |
1069 | "could not set regulator OCR (%d)\n", result); | |
5c13941a DB |
1070 | return result; |
1071 | } | |
1072 | EXPORT_SYMBOL(mmc_regulator_set_ocr); | |
1073 | ||
99fc5131 | 1074 | #endif /* CONFIG_REGULATOR */ |
5c13941a | 1075 | |
1da177e4 LT |
1076 | /* |
1077 | * Mask off any voltages we don't support and select | |
1078 | * the lowest voltage | |
1079 | */ | |
7ea239d9 | 1080 | u32 mmc_select_voltage(struct mmc_host *host, u32 ocr) |
1da177e4 LT |
1081 | { |
1082 | int bit; | |
1083 | ||
1084 | ocr &= host->ocr_avail; | |
1085 | ||
1086 | bit = ffs(ocr); | |
1087 | if (bit) { | |
1088 | bit -= 1; | |
1089 | ||
63ef731a | 1090 | ocr &= 3 << bit; |
1da177e4 | 1091 | |
778e277c | 1092 | mmc_host_clk_hold(host); |
1da177e4 | 1093 | host->ios.vdd = bit; |
920e70c5 | 1094 | mmc_set_ios(host); |
778e277c | 1095 | mmc_host_clk_release(host); |
1da177e4 | 1096 | } else { |
f6e10b86 DB |
1097 | pr_warning("%s: host doesn't support card's voltages\n", |
1098 | mmc_hostname(host)); | |
1da177e4 LT |
1099 | ocr = 0; |
1100 | } | |
1101 | ||
1102 | return ocr; | |
1103 | } | |
1104 | ||
261bbd46 | 1105 | int mmc_set_signal_voltage(struct mmc_host *host, int signal_voltage, bool cmd11) |
f2119df6 AN |
1106 | { |
1107 | struct mmc_command cmd = {0}; | |
1108 | int err = 0; | |
1109 | ||
1110 | BUG_ON(!host); | |
1111 | ||
1112 | /* | |
1113 | * Send CMD11 only if the request is to switch the card to | |
1114 | * 1.8V signalling. | |
1115 | */ | |
261bbd46 | 1116 | if ((signal_voltage != MMC_SIGNAL_VOLTAGE_330) && cmd11) { |
f2119df6 AN |
1117 | cmd.opcode = SD_SWITCH_VOLTAGE; |
1118 | cmd.arg = 0; | |
1119 | cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; | |
1120 | ||
1121 | err = mmc_wait_for_cmd(host, &cmd, 0); | |
1122 | if (err) | |
1123 | return err; | |
1124 | ||
1125 | if (!mmc_host_is_spi(host) && (cmd.resp[0] & R1_ERROR)) | |
1126 | return -EIO; | |
1127 | } | |
1128 | ||
1129 | host->ios.signal_voltage = signal_voltage; | |
1130 | ||
1131 | if (host->ops->start_signal_voltage_switch) | |
1132 | err = host->ops->start_signal_voltage_switch(host, &host->ios); | |
1133 | ||
1134 | return err; | |
1135 | } | |
1136 | ||
b57c43ad | 1137 | /* |
7ea239d9 | 1138 | * Select timing parameters for host. |
b57c43ad | 1139 | */ |
7ea239d9 | 1140 | void mmc_set_timing(struct mmc_host *host, unsigned int timing) |
b57c43ad | 1141 | { |
778e277c | 1142 | mmc_host_clk_hold(host); |
7ea239d9 PO |
1143 | host->ios.timing = timing; |
1144 | mmc_set_ios(host); | |
778e277c | 1145 | mmc_host_clk_release(host); |
b57c43ad PO |
1146 | } |
1147 | ||
d6d50a15 AN |
1148 | /* |
1149 | * Select appropriate driver type for host. | |
1150 | */ | |
1151 | void mmc_set_driver_type(struct mmc_host *host, unsigned int drv_type) | |
1152 | { | |
778e277c | 1153 | mmc_host_clk_hold(host); |
d6d50a15 AN |
1154 | host->ios.drv_type = drv_type; |
1155 | mmc_set_ios(host); | |
778e277c | 1156 | mmc_host_clk_release(host); |
d6d50a15 AN |
1157 | } |
1158 | ||
1da177e4 | 1159 | /* |
45f8245b RK |
1160 | * Apply power to the MMC stack. This is a two-stage process. |
1161 | * First, we enable power to the card without the clock running. | |
1162 | * We then wait a bit for the power to stabilise. Finally, | |
1163 | * enable the bus drivers and clock to the card. | |
1164 | * | |
1165 | * We must _NOT_ enable the clock prior to power stablising. | |
1166 | * | |
1167 | * If a host does all the power sequencing itself, ignore the | |
1168 | * initial MMC_POWER_UP stage. | |
1da177e4 LT |
1169 | */ |
1170 | static void mmc_power_up(struct mmc_host *host) | |
1171 | { | |
500f3564 BR |
1172 | int bit; |
1173 | ||
778e277c MW |
1174 | mmc_host_clk_hold(host); |
1175 | ||
500f3564 BR |
1176 | /* If ocr is set, we use it */ |
1177 | if (host->ocr) | |
1178 | bit = ffs(host->ocr) - 1; | |
1179 | else | |
1180 | bit = fls(host->ocr_avail) - 1; | |
1da177e4 LT |
1181 | |
1182 | host->ios.vdd = bit; | |
44669034 | 1183 | if (mmc_host_is_spi(host)) |
af517150 | 1184 | host->ios.chip_select = MMC_CS_HIGH; |
44669034 | 1185 | else |
af517150 | 1186 | host->ios.chip_select = MMC_CS_DONTCARE; |
44669034 | 1187 | host->ios.bus_mode = MMC_BUSMODE_PUSHPULL; |
1da177e4 | 1188 | host->ios.power_mode = MMC_POWER_UP; |
f218278a | 1189 | host->ios.bus_width = MMC_BUS_WIDTH_1; |
cd9277c0 | 1190 | host->ios.timing = MMC_TIMING_LEGACY; |
920e70c5 | 1191 | mmc_set_ios(host); |
1da177e4 | 1192 | |
f9996aee PO |
1193 | /* |
1194 | * This delay should be sufficient to allow the power supply | |
1195 | * to reach the minimum voltage. | |
1196 | */ | |
79bccc5a | 1197 | mmc_delay(10); |
1da177e4 | 1198 | |
88ae8b86 | 1199 | host->ios.clock = host->f_init; |
8dfd0374 | 1200 | |
1da177e4 | 1201 | host->ios.power_mode = MMC_POWER_ON; |
920e70c5 | 1202 | mmc_set_ios(host); |
1da177e4 | 1203 | |
f9996aee PO |
1204 | /* |
1205 | * This delay must be at least 74 clock sizes, or 1 ms, or the | |
1206 | * time required to reach a stable voltage. | |
1207 | */ | |
79bccc5a | 1208 | mmc_delay(10); |
778e277c MW |
1209 | |
1210 | mmc_host_clk_release(host); | |
1da177e4 LT |
1211 | } |
1212 | ||
7f7e4129 | 1213 | void mmc_power_off(struct mmc_host *host) |
1da177e4 | 1214 | { |
778e277c MW |
1215 | mmc_host_clk_hold(host); |
1216 | ||
1da177e4 LT |
1217 | host->ios.clock = 0; |
1218 | host->ios.vdd = 0; | |
b33d46c3 UH |
1219 | |
1220 | /* | |
1221 | * Reset ocr mask to be the highest possible voltage supported for | |
1222 | * this mmc host. This value will be used at next power up. | |
1223 | */ | |
1224 | host->ocr = 1 << (fls(host->ocr_avail) - 1); | |
1225 | ||
af517150 DB |
1226 | if (!mmc_host_is_spi(host)) { |
1227 | host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN; | |
1228 | host->ios.chip_select = MMC_CS_DONTCARE; | |
1229 | } | |
1da177e4 | 1230 | host->ios.power_mode = MMC_POWER_OFF; |
f218278a | 1231 | host->ios.bus_width = MMC_BUS_WIDTH_1; |
cd9277c0 | 1232 | host->ios.timing = MMC_TIMING_LEGACY; |
920e70c5 | 1233 | mmc_set_ios(host); |
778e277c | 1234 | |
041beb1d DD |
1235 | /* |
1236 | * Some configurations, such as the 802.11 SDIO card in the OLPC | |
1237 | * XO-1.5, require a short delay after poweroff before the card | |
1238 | * can be successfully turned on again. | |
1239 | */ | |
1240 | mmc_delay(1); | |
1241 | ||
778e277c | 1242 | mmc_host_clk_release(host); |
1da177e4 LT |
1243 | } |
1244 | ||
39361851 AB |
1245 | /* |
1246 | * Cleanup when the last reference to the bus operator is dropped. | |
1247 | */ | |
261172fd | 1248 | static void __mmc_release_bus(struct mmc_host *host) |
39361851 AB |
1249 | { |
1250 | BUG_ON(!host); | |
1251 | BUG_ON(host->bus_refs); | |
1252 | BUG_ON(!host->bus_dead); | |
1253 | ||
1254 | host->bus_ops = NULL; | |
1255 | } | |
1256 | ||
1257 | /* | |
1258 | * Increase reference count of bus operator | |
1259 | */ | |
1260 | static inline void mmc_bus_get(struct mmc_host *host) | |
1261 | { | |
1262 | unsigned long flags; | |
1263 | ||
1264 | spin_lock_irqsave(&host->lock, flags); | |
1265 | host->bus_refs++; | |
1266 | spin_unlock_irqrestore(&host->lock, flags); | |
1267 | } | |
1268 | ||
1269 | /* | |
1270 | * Decrease reference count of bus operator and free it if | |
1271 | * it is the last reference. | |
1272 | */ | |
1273 | static inline void mmc_bus_put(struct mmc_host *host) | |
1274 | { | |
1275 | unsigned long flags; | |
1276 | ||
1277 | spin_lock_irqsave(&host->lock, flags); | |
1278 | host->bus_refs--; | |
1279 | if ((host->bus_refs == 0) && host->bus_ops) | |
1280 | __mmc_release_bus(host); | |
1281 | spin_unlock_irqrestore(&host->lock, flags); | |
1282 | } | |
1283 | ||
1da177e4 | 1284 | /* |
7ea239d9 PO |
1285 | * Assign a mmc bus handler to a host. Only one bus handler may control a |
1286 | * host at any given time. | |
1da177e4 | 1287 | */ |
7ea239d9 | 1288 | void mmc_attach_bus(struct mmc_host *host, const struct mmc_bus_ops *ops) |
1da177e4 | 1289 | { |
7ea239d9 | 1290 | unsigned long flags; |
e45a1bd2 | 1291 | |
7ea239d9 PO |
1292 | BUG_ON(!host); |
1293 | BUG_ON(!ops); | |
b855885e | 1294 | |
d84075c8 | 1295 | WARN_ON(!host->claimed); |
bce40a36 | 1296 | |
7ea239d9 | 1297 | spin_lock_irqsave(&host->lock, flags); |
bce40a36 | 1298 | |
7ea239d9 PO |
1299 | BUG_ON(host->bus_ops); |
1300 | BUG_ON(host->bus_refs); | |
b57c43ad | 1301 | |
7ea239d9 PO |
1302 | host->bus_ops = ops; |
1303 | host->bus_refs = 1; | |
1304 | host->bus_dead = 0; | |
b57c43ad | 1305 | |
7ea239d9 | 1306 | spin_unlock_irqrestore(&host->lock, flags); |
b57c43ad PO |
1307 | } |
1308 | ||
7ea239d9 | 1309 | /* |
7f7e4129 | 1310 | * Remove the current bus handler from a host. |
7ea239d9 PO |
1311 | */ |
1312 | void mmc_detach_bus(struct mmc_host *host) | |
7ccd266e | 1313 | { |
7ea239d9 | 1314 | unsigned long flags; |
7ccd266e | 1315 | |
7ea239d9 | 1316 | BUG_ON(!host); |
7ccd266e | 1317 | |
d84075c8 PO |
1318 | WARN_ON(!host->claimed); |
1319 | WARN_ON(!host->bus_ops); | |
cd9277c0 | 1320 | |
7ea239d9 | 1321 | spin_lock_irqsave(&host->lock, flags); |
7ccd266e | 1322 | |
7ea239d9 | 1323 | host->bus_dead = 1; |
7ccd266e | 1324 | |
7ea239d9 | 1325 | spin_unlock_irqrestore(&host->lock, flags); |
1da177e4 | 1326 | |
7ea239d9 | 1327 | mmc_bus_put(host); |
1da177e4 LT |
1328 | } |
1329 | ||
1da177e4 LT |
1330 | /** |
1331 | * mmc_detect_change - process change of state on a MMC socket | |
1332 | * @host: host which changed state. | |
8dc00335 | 1333 | * @delay: optional delay to wait before detection (jiffies) |
1da177e4 | 1334 | * |
67a61c48 PO |
1335 | * MMC drivers should call this when they detect a card has been |
1336 | * inserted or removed. The MMC layer will confirm that any | |
1337 | * present card is still functional, and initialize any newly | |
1338 | * inserted. | |
1da177e4 | 1339 | */ |
8dc00335 | 1340 | void mmc_detect_change(struct mmc_host *host, unsigned long delay) |
1da177e4 | 1341 | { |
3b91e550 | 1342 | #ifdef CONFIG_MMC_DEBUG |
1efd48b3 | 1343 | unsigned long flags; |
01f41ec7 | 1344 | spin_lock_irqsave(&host->lock, flags); |
d84075c8 | 1345 | WARN_ON(host->removed); |
01f41ec7 | 1346 | spin_unlock_irqrestore(&host->lock, flags); |
3b91e550 PO |
1347 | #endif |
1348 | ||
c4028958 | 1349 | mmc_schedule_delayed_work(&host->detect, delay); |
1da177e4 LT |
1350 | } |
1351 | ||
1352 | EXPORT_SYMBOL(mmc_detect_change); | |
1353 | ||
dfe86cba AH |
1354 | void mmc_init_erase(struct mmc_card *card) |
1355 | { | |
1356 | unsigned int sz; | |
1357 | ||
1358 | if (is_power_of_2(card->erase_size)) | |
1359 | card->erase_shift = ffs(card->erase_size) - 1; | |
1360 | else | |
1361 | card->erase_shift = 0; | |
1362 | ||
1363 | /* | |
1364 | * It is possible to erase an arbitrarily large area of an SD or MMC | |
1365 | * card. That is not desirable because it can take a long time | |
1366 | * (minutes) potentially delaying more important I/O, and also the | |
1367 | * timeout calculations become increasingly hugely over-estimated. | |
1368 | * Consequently, 'pref_erase' is defined as a guide to limit erases | |
1369 | * to that size and alignment. | |
1370 | * | |
1371 | * For SD cards that define Allocation Unit size, limit erases to one | |
1372 | * Allocation Unit at a time. For MMC cards that define High Capacity | |
1373 | * Erase Size, whether it is switched on or not, limit to that size. | |
1374 | * Otherwise just have a stab at a good value. For modern cards it | |
1375 | * will end up being 4MiB. Note that if the value is too small, it | |
1376 | * can end up taking longer to erase. | |
1377 | */ | |
1378 | if (mmc_card_sd(card) && card->ssr.au) { | |
1379 | card->pref_erase = card->ssr.au; | |
1380 | card->erase_shift = ffs(card->ssr.au) - 1; | |
1381 | } else if (card->ext_csd.hc_erase_size) { | |
1382 | card->pref_erase = card->ext_csd.hc_erase_size; | |
1383 | } else { | |
1384 | sz = (card->csd.capacity << (card->csd.read_blkbits - 9)) >> 11; | |
1385 | if (sz < 128) | |
1386 | card->pref_erase = 512 * 1024 / 512; | |
1387 | else if (sz < 512) | |
1388 | card->pref_erase = 1024 * 1024 / 512; | |
1389 | else if (sz < 1024) | |
1390 | card->pref_erase = 2 * 1024 * 1024 / 512; | |
1391 | else | |
1392 | card->pref_erase = 4 * 1024 * 1024 / 512; | |
1393 | if (card->pref_erase < card->erase_size) | |
1394 | card->pref_erase = card->erase_size; | |
1395 | else { | |
1396 | sz = card->pref_erase % card->erase_size; | |
1397 | if (sz) | |
1398 | card->pref_erase += card->erase_size - sz; | |
1399 | } | |
1400 | } | |
1401 | } | |
1402 | ||
eaa02f75 AW |
1403 | static unsigned int mmc_mmc_erase_timeout(struct mmc_card *card, |
1404 | unsigned int arg, unsigned int qty) | |
dfe86cba AH |
1405 | { |
1406 | unsigned int erase_timeout; | |
1407 | ||
1408 | if (card->ext_csd.erase_group_def & 1) { | |
1409 | /* High Capacity Erase Group Size uses HC timeouts */ | |
1410 | if (arg == MMC_TRIM_ARG) | |
1411 | erase_timeout = card->ext_csd.trim_timeout; | |
1412 | else | |
1413 | erase_timeout = card->ext_csd.hc_erase_timeout; | |
1414 | } else { | |
1415 | /* CSD Erase Group Size uses write timeout */ | |
1416 | unsigned int mult = (10 << card->csd.r2w_factor); | |
1417 | unsigned int timeout_clks = card->csd.tacc_clks * mult; | |
1418 | unsigned int timeout_us; | |
1419 | ||
1420 | /* Avoid overflow: e.g. tacc_ns=80000000 mult=1280 */ | |
1421 | if (card->csd.tacc_ns < 1000000) | |
1422 | timeout_us = (card->csd.tacc_ns * mult) / 1000; | |
1423 | else | |
1424 | timeout_us = (card->csd.tacc_ns / 1000) * mult; | |
1425 | ||
1426 | /* | |
1427 | * ios.clock is only a target. The real clock rate might be | |
1428 | * less but not that much less, so fudge it by multiplying by 2. | |
1429 | */ | |
1430 | timeout_clks <<= 1; | |
1431 | timeout_us += (timeout_clks * 1000) / | |
4cf8c6dd | 1432 | (mmc_host_clk_rate(card->host) / 1000); |
dfe86cba AH |
1433 | |
1434 | erase_timeout = timeout_us / 1000; | |
1435 | ||
1436 | /* | |
1437 | * Theoretically, the calculation could underflow so round up | |
1438 | * to 1ms in that case. | |
1439 | */ | |
1440 | if (!erase_timeout) | |
1441 | erase_timeout = 1; | |
1442 | } | |
1443 | ||
1444 | /* Multiplier for secure operations */ | |
1445 | if (arg & MMC_SECURE_ARGS) { | |
1446 | if (arg == MMC_SECURE_ERASE_ARG) | |
1447 | erase_timeout *= card->ext_csd.sec_erase_mult; | |
1448 | else | |
1449 | erase_timeout *= card->ext_csd.sec_trim_mult; | |
1450 | } | |
1451 | ||
1452 | erase_timeout *= qty; | |
1453 | ||
1454 | /* | |
1455 | * Ensure at least a 1 second timeout for SPI as per | |
1456 | * 'mmc_set_data_timeout()' | |
1457 | */ | |
1458 | if (mmc_host_is_spi(card->host) && erase_timeout < 1000) | |
1459 | erase_timeout = 1000; | |
1460 | ||
eaa02f75 | 1461 | return erase_timeout; |
dfe86cba AH |
1462 | } |
1463 | ||
eaa02f75 AW |
1464 | static unsigned int mmc_sd_erase_timeout(struct mmc_card *card, |
1465 | unsigned int arg, | |
1466 | unsigned int qty) | |
dfe86cba | 1467 | { |
eaa02f75 AW |
1468 | unsigned int erase_timeout; |
1469 | ||
dfe86cba AH |
1470 | if (card->ssr.erase_timeout) { |
1471 | /* Erase timeout specified in SD Status Register (SSR) */ | |
eaa02f75 AW |
1472 | erase_timeout = card->ssr.erase_timeout * qty + |
1473 | card->ssr.erase_offset; | |
dfe86cba AH |
1474 | } else { |
1475 | /* | |
1476 | * Erase timeout not specified in SD Status Register (SSR) so | |
1477 | * use 250ms per write block. | |
1478 | */ | |
eaa02f75 | 1479 | erase_timeout = 250 * qty; |
dfe86cba AH |
1480 | } |
1481 | ||
1482 | /* Must not be less than 1 second */ | |
eaa02f75 AW |
1483 | if (erase_timeout < 1000) |
1484 | erase_timeout = 1000; | |
1485 | ||
1486 | return erase_timeout; | |
dfe86cba AH |
1487 | } |
1488 | ||
eaa02f75 AW |
1489 | static unsigned int mmc_erase_timeout(struct mmc_card *card, |
1490 | unsigned int arg, | |
1491 | unsigned int qty) | |
dfe86cba AH |
1492 | { |
1493 | if (mmc_card_sd(card)) | |
eaa02f75 | 1494 | return mmc_sd_erase_timeout(card, arg, qty); |
dfe86cba | 1495 | else |
eaa02f75 | 1496 | return mmc_mmc_erase_timeout(card, arg, qty); |
dfe86cba AH |
1497 | } |
1498 | ||
1499 | static int mmc_do_erase(struct mmc_card *card, unsigned int from, | |
1500 | unsigned int to, unsigned int arg) | |
1501 | { | |
1278dba1 | 1502 | struct mmc_command cmd = {0}; |
dfe86cba AH |
1503 | unsigned int qty = 0; |
1504 | int err; | |
1505 | ||
1506 | /* | |
1507 | * qty is used to calculate the erase timeout which depends on how many | |
1508 | * erase groups (or allocation units in SD terminology) are affected. | |
1509 | * We count erasing part of an erase group as one erase group. | |
1510 | * For SD, the allocation units are always a power of 2. For MMC, the | |
1511 | * erase group size is almost certainly also power of 2, but it does not | |
1512 | * seem to insist on that in the JEDEC standard, so we fall back to | |
1513 | * division in that case. SD may not specify an allocation unit size, | |
1514 | * in which case the timeout is based on the number of write blocks. | |
1515 | * | |
1516 | * Note that the timeout for secure trim 2 will only be correct if the | |
1517 | * number of erase groups specified is the same as the total of all | |
1518 | * preceding secure trim 1 commands. Since the power may have been | |
1519 | * lost since the secure trim 1 commands occurred, it is generally | |
1520 | * impossible to calculate the secure trim 2 timeout correctly. | |
1521 | */ | |
1522 | if (card->erase_shift) | |
1523 | qty += ((to >> card->erase_shift) - | |
1524 | (from >> card->erase_shift)) + 1; | |
1525 | else if (mmc_card_sd(card)) | |
1526 | qty += to - from + 1; | |
1527 | else | |
1528 | qty += ((to / card->erase_size) - | |
1529 | (from / card->erase_size)) + 1; | |
1530 | ||
1531 | if (!mmc_card_blockaddr(card)) { | |
1532 | from <<= 9; | |
1533 | to <<= 9; | |
1534 | } | |
1535 | ||
dfe86cba AH |
1536 | if (mmc_card_sd(card)) |
1537 | cmd.opcode = SD_ERASE_WR_BLK_START; | |
1538 | else | |
1539 | cmd.opcode = MMC_ERASE_GROUP_START; | |
1540 | cmd.arg = from; | |
1541 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC; | |
1542 | err = mmc_wait_for_cmd(card->host, &cmd, 0); | |
1543 | if (err) { | |
1544 | printk(KERN_ERR "mmc_erase: group start error %d, " | |
1545 | "status %#x\n", err, cmd.resp[0]); | |
67716327 | 1546 | err = -EIO; |
dfe86cba AH |
1547 | goto out; |
1548 | } | |
1549 | ||
1550 | memset(&cmd, 0, sizeof(struct mmc_command)); | |
1551 | if (mmc_card_sd(card)) | |
1552 | cmd.opcode = SD_ERASE_WR_BLK_END; | |
1553 | else | |
1554 | cmd.opcode = MMC_ERASE_GROUP_END; | |
1555 | cmd.arg = to; | |
1556 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC; | |
1557 | err = mmc_wait_for_cmd(card->host, &cmd, 0); | |
1558 | if (err) { | |
1559 | printk(KERN_ERR "mmc_erase: group end error %d, status %#x\n", | |
1560 | err, cmd.resp[0]); | |
67716327 | 1561 | err = -EIO; |
dfe86cba AH |
1562 | goto out; |
1563 | } | |
1564 | ||
1565 | memset(&cmd, 0, sizeof(struct mmc_command)); | |
1566 | cmd.opcode = MMC_ERASE; | |
1567 | cmd.arg = arg; | |
1568 | cmd.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC; | |
eaa02f75 | 1569 | cmd.cmd_timeout_ms = mmc_erase_timeout(card, arg, qty); |
dfe86cba AH |
1570 | err = mmc_wait_for_cmd(card->host, &cmd, 0); |
1571 | if (err) { | |
1572 | printk(KERN_ERR "mmc_erase: erase error %d, status %#x\n", | |
1573 | err, cmd.resp[0]); | |
1574 | err = -EIO; | |
1575 | goto out; | |
1576 | } | |
1577 | ||
1578 | if (mmc_host_is_spi(card->host)) | |
1579 | goto out; | |
1580 | ||
1581 | do { | |
1582 | memset(&cmd, 0, sizeof(struct mmc_command)); | |
1583 | cmd.opcode = MMC_SEND_STATUS; | |
1584 | cmd.arg = card->rca << 16; | |
1585 | cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; | |
1586 | /* Do not retry else we can't see errors */ | |
1587 | err = mmc_wait_for_cmd(card->host, &cmd, 0); | |
1588 | if (err || (cmd.resp[0] & 0xFDF92000)) { | |
1589 | printk(KERN_ERR "error %d requesting status %#x\n", | |
1590 | err, cmd.resp[0]); | |
1591 | err = -EIO; | |
1592 | goto out; | |
1593 | } | |
1594 | } while (!(cmd.resp[0] & R1_READY_FOR_DATA) || | |
7435bb79 | 1595 | R1_CURRENT_STATE(cmd.resp[0]) == R1_STATE_PRG); |
dfe86cba AH |
1596 | out: |
1597 | return err; | |
1598 | } | |
1599 | ||
1600 | /** | |
1601 | * mmc_erase - erase sectors. | |
1602 | * @card: card to erase | |
1603 | * @from: first sector to erase | |
1604 | * @nr: number of sectors to erase | |
1605 | * @arg: erase command argument (SD supports only %MMC_ERASE_ARG) | |
1606 | * | |
1607 | * Caller must claim host before calling this function. | |
1608 | */ | |
1609 | int mmc_erase(struct mmc_card *card, unsigned int from, unsigned int nr, | |
1610 | unsigned int arg) | |
1611 | { | |
1612 | unsigned int rem, to = from + nr; | |
1613 | ||
1614 | if (!(card->host->caps & MMC_CAP_ERASE) || | |
1615 | !(card->csd.cmdclass & CCC_ERASE)) | |
1616 | return -EOPNOTSUPP; | |
1617 | ||
1618 | if (!card->erase_size) | |
1619 | return -EOPNOTSUPP; | |
1620 | ||
1621 | if (mmc_card_sd(card) && arg != MMC_ERASE_ARG) | |
1622 | return -EOPNOTSUPP; | |
1623 | ||
1624 | if ((arg & MMC_SECURE_ARGS) && | |
1625 | !(card->ext_csd.sec_feature_support & EXT_CSD_SEC_ER_EN)) | |
1626 | return -EOPNOTSUPP; | |
1627 | ||
1628 | if ((arg & MMC_TRIM_ARGS) && | |
1629 | !(card->ext_csd.sec_feature_support & EXT_CSD_SEC_GB_CL_EN)) | |
1630 | return -EOPNOTSUPP; | |
1631 | ||
1632 | if (arg == MMC_SECURE_ERASE_ARG) { | |
1633 | if (from % card->erase_size || nr % card->erase_size) | |
1634 | return -EINVAL; | |
1635 | } | |
1636 | ||
1637 | if (arg == MMC_ERASE_ARG) { | |
1638 | rem = from % card->erase_size; | |
1639 | if (rem) { | |
1640 | rem = card->erase_size - rem; | |
1641 | from += rem; | |
1642 | if (nr > rem) | |
1643 | nr -= rem; | |
1644 | else | |
1645 | return 0; | |
1646 | } | |
1647 | rem = nr % card->erase_size; | |
1648 | if (rem) | |
1649 | nr -= rem; | |
1650 | } | |
1651 | ||
1652 | if (nr == 0) | |
1653 | return 0; | |
1654 | ||
1655 | to = from + nr; | |
1656 | ||
1657 | if (to <= from) | |
1658 | return -EINVAL; | |
1659 | ||
1660 | /* 'from' and 'to' are inclusive */ | |
1661 | to -= 1; | |
1662 | ||
1663 | return mmc_do_erase(card, from, to, arg); | |
1664 | } | |
1665 | EXPORT_SYMBOL(mmc_erase); | |
1666 | ||
1667 | int mmc_can_erase(struct mmc_card *card) | |
1668 | { | |
1669 | if ((card->host->caps & MMC_CAP_ERASE) && | |
1670 | (card->csd.cmdclass & CCC_ERASE) && card->erase_size) | |
1671 | return 1; | |
1672 | return 0; | |
1673 | } | |
1674 | EXPORT_SYMBOL(mmc_can_erase); | |
1675 | ||
1676 | int mmc_can_trim(struct mmc_card *card) | |
1677 | { | |
1678 | if (card->ext_csd.sec_feature_support & EXT_CSD_SEC_GB_CL_EN) | |
1679 | return 1; | |
1680 | return 0; | |
1681 | } | |
1682 | EXPORT_SYMBOL(mmc_can_trim); | |
1683 | ||
1684 | int mmc_can_secure_erase_trim(struct mmc_card *card) | |
1685 | { | |
1686 | if (card->ext_csd.sec_feature_support & EXT_CSD_SEC_ER_EN) | |
1687 | return 1; | |
1688 | return 0; | |
1689 | } | |
1690 | EXPORT_SYMBOL(mmc_can_secure_erase_trim); | |
1691 | ||
1692 | int mmc_erase_group_aligned(struct mmc_card *card, unsigned int from, | |
1693 | unsigned int nr) | |
1694 | { | |
1695 | if (!card->erase_size) | |
1696 | return 0; | |
1697 | if (from % card->erase_size || nr % card->erase_size) | |
1698 | return 0; | |
1699 | return 1; | |
1700 | } | |
1701 | EXPORT_SYMBOL(mmc_erase_group_aligned); | |
1da177e4 | 1702 | |
e056a1b5 AH |
1703 | static unsigned int mmc_do_calc_max_discard(struct mmc_card *card, |
1704 | unsigned int arg) | |
1705 | { | |
1706 | struct mmc_host *host = card->host; | |
1707 | unsigned int max_discard, x, y, qty = 0, max_qty, timeout; | |
1708 | unsigned int last_timeout = 0; | |
1709 | ||
1710 | if (card->erase_shift) | |
1711 | max_qty = UINT_MAX >> card->erase_shift; | |
1712 | else if (mmc_card_sd(card)) | |
1713 | max_qty = UINT_MAX; | |
1714 | else | |
1715 | max_qty = UINT_MAX / card->erase_size; | |
1716 | ||
1717 | /* Find the largest qty with an OK timeout */ | |
1718 | do { | |
1719 | y = 0; | |
1720 | for (x = 1; x && x <= max_qty && max_qty - x >= qty; x <<= 1) { | |
1721 | timeout = mmc_erase_timeout(card, arg, qty + x); | |
1722 | if (timeout > host->max_discard_to) | |
1723 | break; | |
1724 | if (timeout < last_timeout) | |
1725 | break; | |
1726 | last_timeout = timeout; | |
1727 | y = x; | |
1728 | } | |
1729 | qty += y; | |
1730 | } while (y); | |
1731 | ||
1732 | if (!qty) | |
1733 | return 0; | |
1734 | ||
1735 | if (qty == 1) | |
1736 | return 1; | |
1737 | ||
1738 | /* Convert qty to sectors */ | |
1739 | if (card->erase_shift) | |
1740 | max_discard = --qty << card->erase_shift; | |
1741 | else if (mmc_card_sd(card)) | |
1742 | max_discard = qty; | |
1743 | else | |
1744 | max_discard = --qty * card->erase_size; | |
1745 | ||
1746 | return max_discard; | |
1747 | } | |
1748 | ||
1749 | unsigned int mmc_calc_max_discard(struct mmc_card *card) | |
1750 | { | |
1751 | struct mmc_host *host = card->host; | |
1752 | unsigned int max_discard, max_trim; | |
1753 | ||
1754 | if (!host->max_discard_to) | |
1755 | return UINT_MAX; | |
1756 | ||
1757 | /* | |
1758 | * Without erase_group_def set, MMC erase timeout depends on clock | |
1759 | * frequence which can change. In that case, the best choice is | |
1760 | * just the preferred erase size. | |
1761 | */ | |
1762 | if (mmc_card_mmc(card) && !(card->ext_csd.erase_group_def & 1)) | |
1763 | return card->pref_erase; | |
1764 | ||
1765 | max_discard = mmc_do_calc_max_discard(card, MMC_ERASE_ARG); | |
1766 | if (mmc_can_trim(card)) { | |
1767 | max_trim = mmc_do_calc_max_discard(card, MMC_TRIM_ARG); | |
1768 | if (max_trim < max_discard) | |
1769 | max_discard = max_trim; | |
1770 | } else if (max_discard < card->erase_size) { | |
1771 | max_discard = 0; | |
1772 | } | |
1773 | pr_debug("%s: calculated max. discard sectors %u for timeout %u ms\n", | |
1774 | mmc_hostname(host), max_discard, host->max_discard_to); | |
1775 | return max_discard; | |
1776 | } | |
1777 | EXPORT_SYMBOL(mmc_calc_max_discard); | |
1778 | ||
0f8d8ea6 AH |
1779 | int mmc_set_blocklen(struct mmc_card *card, unsigned int blocklen) |
1780 | { | |
1278dba1 | 1781 | struct mmc_command cmd = {0}; |
0f8d8ea6 AH |
1782 | |
1783 | if (mmc_card_blockaddr(card) || mmc_card_ddr_mode(card)) | |
1784 | return 0; | |
1785 | ||
0f8d8ea6 AH |
1786 | cmd.opcode = MMC_SET_BLOCKLEN; |
1787 | cmd.arg = blocklen; | |
1788 | cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC; | |
1789 | return mmc_wait_for_cmd(card->host, &cmd, 5); | |
1790 | } | |
1791 | EXPORT_SYMBOL(mmc_set_blocklen); | |
1792 | ||
b2499518 AH |
1793 | static void mmc_hw_reset_for_init(struct mmc_host *host) |
1794 | { | |
1795 | if (!(host->caps & MMC_CAP_HW_RESET) || !host->ops->hw_reset) | |
1796 | return; | |
1797 | mmc_host_clk_hold(host); | |
1798 | host->ops->hw_reset(host); | |
1799 | mmc_host_clk_release(host); | |
1800 | } | |
1801 | ||
1802 | int mmc_can_reset(struct mmc_card *card) | |
1803 | { | |
1804 | u8 rst_n_function; | |
1805 | ||
1806 | if (!mmc_card_mmc(card)) | |
1807 | return 0; | |
1808 | rst_n_function = card->ext_csd.rst_n_function; | |
1809 | if ((rst_n_function & EXT_CSD_RST_N_EN_MASK) != EXT_CSD_RST_N_ENABLED) | |
1810 | return 0; | |
1811 | return 1; | |
1812 | } | |
1813 | EXPORT_SYMBOL(mmc_can_reset); | |
1814 | ||
1815 | static int mmc_do_hw_reset(struct mmc_host *host, int check) | |
1816 | { | |
1817 | struct mmc_card *card = host->card; | |
1818 | ||
1819 | if (!host->bus_ops->power_restore) | |
1820 | return -EOPNOTSUPP; | |
1821 | ||
1822 | if (!(host->caps & MMC_CAP_HW_RESET) || !host->ops->hw_reset) | |
1823 | return -EOPNOTSUPP; | |
1824 | ||
1825 | if (!card) | |
1826 | return -EINVAL; | |
1827 | ||
1828 | if (!mmc_can_reset(card)) | |
1829 | return -EOPNOTSUPP; | |
1830 | ||
1831 | mmc_host_clk_hold(host); | |
1832 | mmc_set_clock(host, host->f_init); | |
1833 | ||
1834 | host->ops->hw_reset(host); | |
1835 | ||
1836 | /* If the reset has happened, then a status command will fail */ | |
1837 | if (check) { | |
1838 | struct mmc_command cmd = {0}; | |
1839 | int err; | |
1840 | ||
1841 | cmd.opcode = MMC_SEND_STATUS; | |
1842 | if (!mmc_host_is_spi(card->host)) | |
1843 | cmd.arg = card->rca << 16; | |
1844 | cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_AC; | |
1845 | err = mmc_wait_for_cmd(card->host, &cmd, 0); | |
1846 | if (!err) { | |
1847 | mmc_host_clk_release(host); | |
1848 | return -ENOSYS; | |
1849 | } | |
1850 | } | |
1851 | ||
1852 | host->card->state &= ~(MMC_STATE_HIGHSPEED | MMC_STATE_HIGHSPEED_DDR); | |
1853 | if (mmc_host_is_spi(host)) { | |
1854 | host->ios.chip_select = MMC_CS_HIGH; | |
1855 | host->ios.bus_mode = MMC_BUSMODE_PUSHPULL; | |
1856 | } else { | |
1857 | host->ios.chip_select = MMC_CS_DONTCARE; | |
1858 | host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN; | |
1859 | } | |
1860 | host->ios.bus_width = MMC_BUS_WIDTH_1; | |
1861 | host->ios.timing = MMC_TIMING_LEGACY; | |
1862 | mmc_set_ios(host); | |
1863 | ||
1864 | mmc_host_clk_release(host); | |
1865 | ||
1866 | return host->bus_ops->power_restore(host); | |
1867 | } | |
1868 | ||
1869 | int mmc_hw_reset(struct mmc_host *host) | |
1870 | { | |
1871 | return mmc_do_hw_reset(host, 0); | |
1872 | } | |
1873 | EXPORT_SYMBOL(mmc_hw_reset); | |
1874 | ||
1875 | int mmc_hw_reset_check(struct mmc_host *host) | |
1876 | { | |
1877 | return mmc_do_hw_reset(host, 1); | |
1878 | } | |
1879 | EXPORT_SYMBOL(mmc_hw_reset_check); | |
1880 | ||
807e8e40 AR |
1881 | static int mmc_rescan_try_freq(struct mmc_host *host, unsigned freq) |
1882 | { | |
1883 | host->f_init = freq; | |
1884 | ||
1885 | #ifdef CONFIG_MMC_DEBUG | |
1886 | pr_info("%s: %s: trying to init card at %u Hz\n", | |
1887 | mmc_hostname(host), __func__, host->f_init); | |
1888 | #endif | |
1889 | mmc_power_up(host); | |
2f94e55a | 1890 | |
b2499518 AH |
1891 | /* |
1892 | * Some eMMCs (with VCCQ always on) may not be reset after power up, so | |
1893 | * do a hardware reset if possible. | |
1894 | */ | |
1895 | mmc_hw_reset_for_init(host); | |
1896 | ||
2f94e55a PR |
1897 | /* |
1898 | * sdio_reset sends CMD52 to reset card. Since we do not know | |
1899 | * if the card is being re-initialized, just send it. CMD52 | |
1900 | * should be ignored by SD/eMMC cards. | |
1901 | */ | |
807e8e40 AR |
1902 | sdio_reset(host); |
1903 | mmc_go_idle(host); | |
1904 | ||
1905 | mmc_send_if_cond(host, host->ocr_avail); | |
1906 | ||
1907 | /* Order's important: probe SDIO, then SD, then MMC */ | |
1908 | if (!mmc_attach_sdio(host)) | |
1909 | return 0; | |
1910 | if (!mmc_attach_sd(host)) | |
1911 | return 0; | |
1912 | if (!mmc_attach_mmc(host)) | |
1913 | return 0; | |
1914 | ||
1915 | mmc_power_off(host); | |
1916 | return -EIO; | |
1917 | } | |
1918 | ||
b93931a6 | 1919 | void mmc_rescan(struct work_struct *work) |
1da177e4 | 1920 | { |
807e8e40 | 1921 | static const unsigned freqs[] = { 400000, 300000, 200000, 100000 }; |
c4028958 DH |
1922 | struct mmc_host *host = |
1923 | container_of(work, struct mmc_host, detect.work); | |
88ae8b86 | 1924 | int i; |
4c2ef25f | 1925 | |
807e8e40 | 1926 | if (host->rescan_disable) |
4c2ef25f | 1927 | return; |
1da177e4 | 1928 | |
7ea239d9 | 1929 | mmc_bus_get(host); |
b855885e | 1930 | |
30201e7f OBC |
1931 | /* |
1932 | * if there is a _removable_ card registered, check whether it is | |
1933 | * still present | |
1934 | */ | |
1935 | if (host->bus_ops && host->bus_ops->detect && !host->bus_dead | |
bad3baba | 1936 | && !(host->caps & MMC_CAP_NONREMOVABLE)) |
94d89efb JS |
1937 | host->bus_ops->detect(host); |
1938 | ||
c5841798 CB |
1939 | /* |
1940 | * Let mmc_bus_put() free the bus/bus_ops if we've found that | |
1941 | * the card is no longer present. | |
1942 | */ | |
94d89efb | 1943 | mmc_bus_put(host); |
94d89efb JS |
1944 | mmc_bus_get(host); |
1945 | ||
1946 | /* if there still is a card present, stop here */ | |
1947 | if (host->bus_ops != NULL) { | |
7ea239d9 | 1948 | mmc_bus_put(host); |
94d89efb JS |
1949 | goto out; |
1950 | } | |
1da177e4 | 1951 | |
94d89efb JS |
1952 | /* |
1953 | * Only we can add a new handler, so it's safe to | |
1954 | * release the lock here. | |
1955 | */ | |
1956 | mmc_bus_put(host); | |
1da177e4 | 1957 | |
94d89efb JS |
1958 | if (host->ops->get_cd && host->ops->get_cd(host) == 0) |
1959 | goto out; | |
1da177e4 | 1960 | |
807e8e40 | 1961 | mmc_claim_host(host); |
88ae8b86 | 1962 | for (i = 0; i < ARRAY_SIZE(freqs); i++) { |
807e8e40 AR |
1963 | if (!mmc_rescan_try_freq(host, max(freqs[i], host->f_min))) |
1964 | break; | |
06b2233a | 1965 | if (freqs[i] <= host->f_min) |
807e8e40 | 1966 | break; |
88ae8b86 | 1967 | } |
807e8e40 AR |
1968 | mmc_release_host(host); |
1969 | ||
1970 | out: | |
28f52482 AV |
1971 | if (host->caps & MMC_CAP_NEEDS_POLL) |
1972 | mmc_schedule_delayed_work(&host->detect, HZ); | |
1da177e4 LT |
1973 | } |
1974 | ||
b93931a6 | 1975 | void mmc_start_host(struct mmc_host *host) |
1da177e4 | 1976 | { |
b93931a6 PO |
1977 | mmc_power_off(host); |
1978 | mmc_detect_change(host, 0); | |
1da177e4 LT |
1979 | } |
1980 | ||
b93931a6 | 1981 | void mmc_stop_host(struct mmc_host *host) |
1da177e4 | 1982 | { |
3b91e550 | 1983 | #ifdef CONFIG_MMC_DEBUG |
1efd48b3 PO |
1984 | unsigned long flags; |
1985 | spin_lock_irqsave(&host->lock, flags); | |
3b91e550 | 1986 | host->removed = 1; |
1efd48b3 | 1987 | spin_unlock_irqrestore(&host->lock, flags); |
3b91e550 PO |
1988 | #endif |
1989 | ||
8ea926b2 AH |
1990 | if (host->caps & MMC_CAP_DISABLE) |
1991 | cancel_delayed_work(&host->disable); | |
d9bcbf34 | 1992 | cancel_delayed_work_sync(&host->detect); |
3b91e550 PO |
1993 | mmc_flush_scheduled_work(); |
1994 | ||
da68c4eb NP |
1995 | /* clear pm flags now and let card drivers set them as needed */ |
1996 | host->pm_flags = 0; | |
1997 | ||
7ea239d9 PO |
1998 | mmc_bus_get(host); |
1999 | if (host->bus_ops && !host->bus_dead) { | |
2000 | if (host->bus_ops->remove) | |
2001 | host->bus_ops->remove(host); | |
2002 | ||
2003 | mmc_claim_host(host); | |
2004 | mmc_detach_bus(host); | |
7f7e4129 | 2005 | mmc_power_off(host); |
7ea239d9 | 2006 | mmc_release_host(host); |
53509f0f DK |
2007 | mmc_bus_put(host); |
2008 | return; | |
1da177e4 | 2009 | } |
7ea239d9 PO |
2010 | mmc_bus_put(host); |
2011 | ||
2012 | BUG_ON(host->card); | |
1da177e4 LT |
2013 | |
2014 | mmc_power_off(host); | |
2015 | } | |
2016 | ||
12ae637f | 2017 | int mmc_power_save_host(struct mmc_host *host) |
eae1aeee | 2018 | { |
12ae637f OBC |
2019 | int ret = 0; |
2020 | ||
bb9cab94 DD |
2021 | #ifdef CONFIG_MMC_DEBUG |
2022 | pr_info("%s: %s: powering down\n", mmc_hostname(host), __func__); | |
2023 | #endif | |
2024 | ||
eae1aeee AH |
2025 | mmc_bus_get(host); |
2026 | ||
2027 | if (!host->bus_ops || host->bus_dead || !host->bus_ops->power_restore) { | |
2028 | mmc_bus_put(host); | |
12ae637f | 2029 | return -EINVAL; |
eae1aeee AH |
2030 | } |
2031 | ||
2032 | if (host->bus_ops->power_save) | |
12ae637f | 2033 | ret = host->bus_ops->power_save(host); |
eae1aeee AH |
2034 | |
2035 | mmc_bus_put(host); | |
2036 | ||
2037 | mmc_power_off(host); | |
12ae637f OBC |
2038 | |
2039 | return ret; | |
eae1aeee AH |
2040 | } |
2041 | EXPORT_SYMBOL(mmc_power_save_host); | |
2042 | ||
12ae637f | 2043 | int mmc_power_restore_host(struct mmc_host *host) |
eae1aeee | 2044 | { |
12ae637f OBC |
2045 | int ret; |
2046 | ||
bb9cab94 DD |
2047 | #ifdef CONFIG_MMC_DEBUG |
2048 | pr_info("%s: %s: powering up\n", mmc_hostname(host), __func__); | |
2049 | #endif | |
2050 | ||
eae1aeee AH |
2051 | mmc_bus_get(host); |
2052 | ||
2053 | if (!host->bus_ops || host->bus_dead || !host->bus_ops->power_restore) { | |
2054 | mmc_bus_put(host); | |
12ae637f | 2055 | return -EINVAL; |
eae1aeee AH |
2056 | } |
2057 | ||
2058 | mmc_power_up(host); | |
12ae637f | 2059 | ret = host->bus_ops->power_restore(host); |
eae1aeee AH |
2060 | |
2061 | mmc_bus_put(host); | |
12ae637f OBC |
2062 | |
2063 | return ret; | |
eae1aeee AH |
2064 | } |
2065 | EXPORT_SYMBOL(mmc_power_restore_host); | |
2066 | ||
b1ebe384 JL |
2067 | int mmc_card_awake(struct mmc_host *host) |
2068 | { | |
2069 | int err = -ENOSYS; | |
2070 | ||
2071 | mmc_bus_get(host); | |
2072 | ||
2073 | if (host->bus_ops && !host->bus_dead && host->bus_ops->awake) | |
2074 | err = host->bus_ops->awake(host); | |
2075 | ||
2076 | mmc_bus_put(host); | |
2077 | ||
2078 | return err; | |
2079 | } | |
2080 | EXPORT_SYMBOL(mmc_card_awake); | |
2081 | ||
2082 | int mmc_card_sleep(struct mmc_host *host) | |
2083 | { | |
2084 | int err = -ENOSYS; | |
2085 | ||
2086 | mmc_bus_get(host); | |
2087 | ||
2088 | if (host->bus_ops && !host->bus_dead && host->bus_ops->awake) | |
2089 | err = host->bus_ops->sleep(host); | |
2090 | ||
2091 | mmc_bus_put(host); | |
2092 | ||
2093 | return err; | |
2094 | } | |
2095 | EXPORT_SYMBOL(mmc_card_sleep); | |
2096 | ||
2097 | int mmc_card_can_sleep(struct mmc_host *host) | |
2098 | { | |
2099 | struct mmc_card *card = host->card; | |
2100 | ||
2101 | if (card && mmc_card_mmc(card) && card->ext_csd.rev >= 3) | |
2102 | return 1; | |
2103 | return 0; | |
2104 | } | |
2105 | EXPORT_SYMBOL(mmc_card_can_sleep); | |
2106 | ||
1da177e4 LT |
2107 | #ifdef CONFIG_PM |
2108 | ||
2109 | /** | |
2110 | * mmc_suspend_host - suspend a host | |
2111 | * @host: mmc host | |
1da177e4 | 2112 | */ |
1a13f8fa | 2113 | int mmc_suspend_host(struct mmc_host *host) |
1da177e4 | 2114 | { |
95cdfb72 NP |
2115 | int err = 0; |
2116 | ||
8ea926b2 AH |
2117 | if (host->caps & MMC_CAP_DISABLE) |
2118 | cancel_delayed_work(&host->disable); | |
7de427d0 | 2119 | cancel_delayed_work(&host->detect); |
b5af25be PO |
2120 | mmc_flush_scheduled_work(); |
2121 | ||
7ea239d9 PO |
2122 | mmc_bus_get(host); |
2123 | if (host->bus_ops && !host->bus_dead) { | |
6abaa0c9 | 2124 | if (host->bus_ops->suspend) |
95cdfb72 | 2125 | err = host->bus_ops->suspend(host); |
1c8cf9c9 OBC |
2126 | if (err == -ENOSYS || !host->bus_ops->resume) { |
2127 | /* | |
2128 | * We simply "remove" the card in this case. | |
2129 | * It will be redetected on resume. | |
2130 | */ | |
2131 | if (host->bus_ops->remove) | |
2132 | host->bus_ops->remove(host); | |
2133 | mmc_claim_host(host); | |
2134 | mmc_detach_bus(host); | |
7f7e4129 | 2135 | mmc_power_off(host); |
1c8cf9c9 OBC |
2136 | mmc_release_host(host); |
2137 | host->pm_flags = 0; | |
2138 | err = 0; | |
2139 | } | |
b5af25be | 2140 | } |
7ea239d9 PO |
2141 | mmc_bus_put(host); |
2142 | ||
a5e9425d | 2143 | if (!err && !mmc_card_keep_power(host)) |
95cdfb72 | 2144 | mmc_power_off(host); |
1da177e4 | 2145 | |
95cdfb72 | 2146 | return err; |
1da177e4 LT |
2147 | } |
2148 | ||
2149 | EXPORT_SYMBOL(mmc_suspend_host); | |
2150 | ||
2151 | /** | |
2152 | * mmc_resume_host - resume a previously suspended host | |
2153 | * @host: mmc host | |
2154 | */ | |
2155 | int mmc_resume_host(struct mmc_host *host) | |
2156 | { | |
95cdfb72 NP |
2157 | int err = 0; |
2158 | ||
6abaa0c9 PO |
2159 | mmc_bus_get(host); |
2160 | if (host->bus_ops && !host->bus_dead) { | |
a5e9425d | 2161 | if (!mmc_card_keep_power(host)) { |
da68c4eb NP |
2162 | mmc_power_up(host); |
2163 | mmc_select_voltage(host, host->ocr); | |
e594573d OBC |
2164 | /* |
2165 | * Tell runtime PM core we just powered up the card, | |
2166 | * since it still believes the card is powered off. | |
2167 | * Note that currently runtime PM is only enabled | |
2168 | * for SDIO cards that are MMC_CAP_POWER_OFF_CARD | |
2169 | */ | |
2170 | if (mmc_card_sdio(host->card) && | |
2171 | (host->caps & MMC_CAP_POWER_OFF_CARD)) { | |
2172 | pm_runtime_disable(&host->card->dev); | |
2173 | pm_runtime_set_active(&host->card->dev); | |
2174 | pm_runtime_enable(&host->card->dev); | |
2175 | } | |
da68c4eb | 2176 | } |
6abaa0c9 | 2177 | BUG_ON(!host->bus_ops->resume); |
95cdfb72 NP |
2178 | err = host->bus_ops->resume(host); |
2179 | if (err) { | |
2180 | printk(KERN_WARNING "%s: error %d during resume " | |
2181 | "(card was removed?)\n", | |
2182 | mmc_hostname(host), err); | |
95cdfb72 NP |
2183 | err = 0; |
2184 | } | |
6abaa0c9 | 2185 | } |
a8e6df73 | 2186 | host->pm_flags &= ~MMC_PM_KEEP_POWER; |
6abaa0c9 PO |
2187 | mmc_bus_put(host); |
2188 | ||
95cdfb72 | 2189 | return err; |
1da177e4 | 2190 | } |
1da177e4 LT |
2191 | EXPORT_SYMBOL(mmc_resume_host); |
2192 | ||
4c2ef25f ML |
2193 | /* Do the card removal on suspend if card is assumed removeable |
2194 | * Do that in pm notifier while userspace isn't yet frozen, so we will be able | |
2195 | to sync the card. | |
2196 | */ | |
2197 | int mmc_pm_notify(struct notifier_block *notify_block, | |
2198 | unsigned long mode, void *unused) | |
2199 | { | |
2200 | struct mmc_host *host = container_of( | |
2201 | notify_block, struct mmc_host, pm_notify); | |
2202 | unsigned long flags; | |
2203 | ||
2204 | ||
2205 | switch (mode) { | |
2206 | case PM_HIBERNATION_PREPARE: | |
2207 | case PM_SUSPEND_PREPARE: | |
2208 | ||
2209 | spin_lock_irqsave(&host->lock, flags); | |
2210 | host->rescan_disable = 1; | |
2211 | spin_unlock_irqrestore(&host->lock, flags); | |
2212 | cancel_delayed_work_sync(&host->detect); | |
2213 | ||
2214 | if (!host->bus_ops || host->bus_ops->suspend) | |
2215 | break; | |
2216 | ||
2217 | mmc_claim_host(host); | |
2218 | ||
2219 | if (host->bus_ops->remove) | |
2220 | host->bus_ops->remove(host); | |
2221 | ||
2222 | mmc_detach_bus(host); | |
7f7e4129 | 2223 | mmc_power_off(host); |
4c2ef25f ML |
2224 | mmc_release_host(host); |
2225 | host->pm_flags = 0; | |
2226 | break; | |
2227 | ||
2228 | case PM_POST_SUSPEND: | |
2229 | case PM_POST_HIBERNATION: | |
274476f8 | 2230 | case PM_POST_RESTORE: |
4c2ef25f ML |
2231 | |
2232 | spin_lock_irqsave(&host->lock, flags); | |
2233 | host->rescan_disable = 0; | |
2234 | spin_unlock_irqrestore(&host->lock, flags); | |
2235 | mmc_detect_change(host, 0); | |
2236 | ||
2237 | } | |
2238 | ||
2239 | return 0; | |
2240 | } | |
1da177e4 LT |
2241 | #endif |
2242 | ||
ffce2e7e PO |
2243 | static int __init mmc_init(void) |
2244 | { | |
2245 | int ret; | |
2246 | ||
0d9ee5b2 | 2247 | workqueue = alloc_ordered_workqueue("kmmcd", 0); |
ffce2e7e PO |
2248 | if (!workqueue) |
2249 | return -ENOMEM; | |
2250 | ||
2251 | ret = mmc_register_bus(); | |
e29a7d73 PO |
2252 | if (ret) |
2253 | goto destroy_workqueue; | |
2254 | ||
2255 | ret = mmc_register_host_class(); | |
2256 | if (ret) | |
2257 | goto unregister_bus; | |
2258 | ||
2259 | ret = sdio_register_bus(); | |
2260 | if (ret) | |
2261 | goto unregister_host_class; | |
2262 | ||
2263 | return 0; | |
2264 | ||
2265 | unregister_host_class: | |
2266 | mmc_unregister_host_class(); | |
2267 | unregister_bus: | |
2268 | mmc_unregister_bus(); | |
2269 | destroy_workqueue: | |
2270 | destroy_workqueue(workqueue); | |
2271 | ||
ffce2e7e PO |
2272 | return ret; |
2273 | } | |
2274 | ||
2275 | static void __exit mmc_exit(void) | |
2276 | { | |
e29a7d73 | 2277 | sdio_unregister_bus(); |
ffce2e7e PO |
2278 | mmc_unregister_host_class(); |
2279 | mmc_unregister_bus(); | |
2280 | destroy_workqueue(workqueue); | |
2281 | } | |
2282 | ||
26074962 | 2283 | subsys_initcall(mmc_init); |
ffce2e7e PO |
2284 | module_exit(mmc_exit); |
2285 | ||
1da177e4 | 2286 | MODULE_LICENSE("GPL"); |