1
2
3
4
5
6
7
8
9
10
11
12
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>
21#include <linux/leds.h>
22#include <linux/scatterlist.h>
23#include <linux/log2.h>
24#include <linux/regulator/consumer.h>
25#include <linux/pm_runtime.h>
26#include <linux/suspend.h>
27#include <linux/fault-inject.h>
28#include <linux/random.h>
29#include <linux/slab.h>
30
31#include <linux/mmc/card.h>
32#include <linux/mmc/host.h>
33#include <linux/mmc/mmc.h>
34#include <linux/mmc/sd.h>
35
36#include "core.h"
37#include "bus.h"
38#include "host.h"
39#include "sdio_bus.h"
40
41#include "mmc_ops.h"
42#include "sd_ops.h"
43#include "sdio_ops.h"
44
45
46#define MMC_CORE_TIMEOUT_MS (10 * 60 * 1000)
47
48
49
50
51
52#define MMC_BKOPS_MAX_TIMEOUT (4 * 60 * 1000)
53
54static struct workqueue_struct *workqueue;
55static const unsigned freqs[] = { 400000, 300000, 200000, 100000 };
56
57
58
59
60
61
62bool use_spi_crc = 1;
63module_param(use_spi_crc, bool, 0);
64
65
66
67
68
69
70
71#ifdef CONFIG_MMC_UNSAFE_RESUME
72bool mmc_assume_removable;
73#else
74bool mmc_assume_removable = 1;
75#endif
76EXPORT_SYMBOL(mmc_assume_removable);
77module_param_named(removable, mmc_assume_removable, bool, 0644);
78MODULE_PARM_DESC(
79 removable,
80 "MMC/SD cards are removable and may be removed during suspend");
81
82
83
84
85static int mmc_schedule_delayed_work(struct delayed_work *work,
86 unsigned long delay)
87{
88 return queue_delayed_work(workqueue, work, delay);
89}
90
91
92
93
94static void mmc_flush_scheduled_work(void)
95{
96 flush_workqueue(workqueue);
97}
98
99#ifdef CONFIG_FAIL_MMC_REQUEST
100
101
102
103
104
105static void mmc_should_fail_request(struct mmc_host *host,
106 struct mmc_request *mrq)
107{
108 struct mmc_command *cmd = mrq->cmd;
109 struct mmc_data *data = mrq->data;
110 static const int data_errors[] = {
111 -ETIMEDOUT,
112 -EILSEQ,
113 -EIO,
114 };
115
116 if (!data)
117 return;
118
119 if (cmd->error || data->error ||
120 !should_fail(&host->fail_mmc_request, data->blksz * data->blocks))
121 return;
122
123 data->error = data_errors[random32() % ARRAY_SIZE(data_errors)];
124 data->bytes_xfered = (random32() % (data->bytes_xfered >> 9)) << 9;
125}
126
127#else
128
129static inline void mmc_should_fail_request(struct mmc_host *host,
130 struct mmc_request *mrq)
131{
132}
133
134#endif
135
136
137
138
139
140
141
142
143
144void mmc_request_done(struct mmc_host *host, struct mmc_request *mrq)
145{
146 struct mmc_command *cmd = mrq->cmd;
147 int err = cmd->error;
148
149 if (err && cmd->retries && mmc_host_is_spi(host)) {
150 if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND)
151 cmd->retries = 0;
152 }
153
154 if (err && cmd->retries && !mmc_card_removed(host->card)) {
155
156
157
158
159 if (mrq->done)
160 mrq->done(mrq);
161 } else {
162 mmc_should_fail_request(host, mrq);
163
164 led_trigger_event(host->led, LED_OFF);
165
166 pr_debug("%s: req done (CMD%u): %d: %08x %08x %08x %08x\n",
167 mmc_hostname(host), cmd->opcode, err,
168 cmd->resp[0], cmd->resp[1],
169 cmd->resp[2], cmd->resp[3]);
170
171 if (mrq->data) {
172 pr_debug("%s: %d bytes transferred: %d\n",
173 mmc_hostname(host),
174 mrq->data->bytes_xfered, mrq->data->error);
175 }
176
177 if (mrq->stop) {
178 pr_debug("%s: (CMD%u): %d: %08x %08x %08x %08x\n",
179 mmc_hostname(host), mrq->stop->opcode,
180 mrq->stop->error,
181 mrq->stop->resp[0], mrq->stop->resp[1],
182 mrq->stop->resp[2], mrq->stop->resp[3]);
183 }
184
185 if (mrq->done)
186 mrq->done(mrq);
187
188 mmc_host_clk_release(host);
189 }
190}
191
192EXPORT_SYMBOL(mmc_request_done);
193
194static void
195mmc_start_request(struct mmc_host *host, struct mmc_request *mrq)
196{
197#ifdef CONFIG_MMC_DEBUG
198 unsigned int i, sz;
199 struct scatterlist *sg;
200#endif
201
202 if (mrq->sbc) {
203 pr_debug("<%s: starting CMD%u arg %08x flags %08x>\n",
204 mmc_hostname(host), mrq->sbc->opcode,
205 mrq->sbc->arg, mrq->sbc->flags);
206 }
207
208 pr_debug("%s: starting CMD%u arg %08x flags %08x\n",
209 mmc_hostname(host), mrq->cmd->opcode,
210 mrq->cmd->arg, mrq->cmd->flags);
211
212 if (mrq->data) {
213 pr_debug("%s: blksz %d blocks %d flags %08x "
214 "tsac %d ms nsac %d\n",
215 mmc_hostname(host), mrq->data->blksz,
216 mrq->data->blocks, mrq->data->flags,
217 mrq->data->timeout_ns / 1000000,
218 mrq->data->timeout_clks);
219 }
220
221 if (mrq->stop) {
222 pr_debug("%s: CMD%u arg %08x flags %08x\n",
223 mmc_hostname(host), mrq->stop->opcode,
224 mrq->stop->arg, mrq->stop->flags);
225 }
226
227 WARN_ON(!host->claimed);
228
229 mrq->cmd->error = 0;
230 mrq->cmd->mrq = mrq;
231 if (mrq->data) {
232 BUG_ON(mrq->data->blksz > host->max_blk_size);
233 BUG_ON(mrq->data->blocks > host->max_blk_count);
234 BUG_ON(mrq->data->blocks * mrq->data->blksz >
235 host->max_req_size);
236
237#ifdef CONFIG_MMC_DEBUG
238 sz = 0;
239 for_each_sg(mrq->data->sg, sg, mrq->data->sg_len, i)
240 sz += sg->length;
241 BUG_ON(sz != mrq->data->blocks * mrq->data->blksz);
242#endif
243
244 mrq->cmd->data = mrq->data;
245 mrq->data->error = 0;
246 mrq->data->mrq = mrq;
247 if (mrq->stop) {
248 mrq->data->stop = mrq->stop;
249 mrq->stop->error = 0;
250 mrq->stop->mrq = mrq;
251 }
252 }
253 mmc_host_clk_hold(host);
254 led_trigger_event(host->led, LED_FULL);
255 host->ops->request(host, mrq);
256}
257
258
259
260
261
262
263
264
265
266
267
268void mmc_start_bkops(struct mmc_card *card, bool from_exception)
269{
270 int err;
271 int timeout;
272 bool use_busy_signal;
273
274 BUG_ON(!card);
275
276 if (!card->ext_csd.bkops_en || mmc_card_doing_bkops(card))
277 return;
278
279 err = mmc_read_bkops_status(card);
280 if (err) {
281 pr_err("%s: Failed to read bkops status: %d\n",
282 mmc_hostname(card->host), err);
283 return;
284 }
285
286 if (!card->ext_csd.raw_bkops_status)
287 return;
288
289 if (card->ext_csd.raw_bkops_status < EXT_CSD_BKOPS_LEVEL_2 &&
290 from_exception)
291 return;
292
293 mmc_claim_host(card->host);
294 if (card->ext_csd.raw_bkops_status >= EXT_CSD_BKOPS_LEVEL_2) {
295 timeout = MMC_BKOPS_MAX_TIMEOUT;
296 use_busy_signal = true;
297 } else {
298 timeout = 0;
299 use_busy_signal = false;
300 }
301
302 err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
303 EXT_CSD_BKOPS_START, 1, timeout, use_busy_signal);
304 if (err) {
305 pr_warn("%s: Error %d starting bkops\n",
306 mmc_hostname(card->host), err);
307 goto out;
308 }
309
310
311
312
313
314
315 if (!use_busy_signal)
316 mmc_card_set_doing_bkops(card);
317out:
318 mmc_release_host(card->host);
319}
320EXPORT_SYMBOL(mmc_start_bkops);
321
322
323
324
325
326
327
328static void mmc_wait_data_done(struct mmc_request *mrq)
329{
330 mrq->host->context_info.is_done_rcv = true;
331 wake_up_interruptible(&mrq->host->context_info.wait);
332}
333
334static void mmc_wait_done(struct mmc_request *mrq)
335{
336 complete(&mrq->completion);
337}
338
339
340
341
342
343
344
345
346
347static int __mmc_start_data_req(struct mmc_host *host, struct mmc_request *mrq)
348{
349 mrq->done = mmc_wait_data_done;
350 mrq->host = host;
351 if (mmc_card_removed(host->card)) {
352 mrq->cmd->error = -ENOMEDIUM;
353 mmc_wait_data_done(mrq);
354 return -ENOMEDIUM;
355 }
356 mmc_start_request(host, mrq);
357
358 return 0;
359}
360
361static int __mmc_start_req(struct mmc_host *host, struct mmc_request *mrq)
362{
363 init_completion(&mrq->completion);
364 mrq->done = mmc_wait_done;
365 if (mmc_card_removed(host->card)) {
366 mrq->cmd->error = -ENOMEDIUM;
367 complete(&mrq->completion);
368 return -ENOMEDIUM;
369 }
370 mmc_start_request(host, mrq);
371 return 0;
372}
373
374
375
376
377
378
379
380
381
382
383
384
385static int mmc_wait_for_data_req_done(struct mmc_host *host,
386 struct mmc_request *mrq,
387 struct mmc_async_req *next_req)
388{
389 struct mmc_command *cmd;
390 struct mmc_context_info *context_info = &host->context_info;
391 int err;
392 unsigned long flags;
393
394 while (1) {
395 wait_event_interruptible(context_info->wait,
396 (context_info->is_done_rcv ||
397 context_info->is_new_req));
398 spin_lock_irqsave(&context_info->lock, flags);
399 context_info->is_waiting_last_req = false;
400 spin_unlock_irqrestore(&context_info->lock, flags);
401 if (context_info->is_done_rcv) {
402 context_info->is_done_rcv = false;
403 context_info->is_new_req = false;
404 cmd = mrq->cmd;
405 if (!cmd->error || !cmd->retries ||
406 mmc_card_removed(host->card)) {
407 err = host->areq->err_check(host->card,
408 host->areq);
409 break;
410 } else {
411 pr_info("%s: req failed (CMD%u): %d, retrying...\n",
412 mmc_hostname(host),
413 cmd->opcode, cmd->error);
414 cmd->retries--;
415 cmd->error = 0;
416 host->ops->request(host, mrq);
417 continue;
418 }
419 } else if (context_info->is_new_req) {
420 context_info->is_new_req = false;
421 if (!next_req) {
422 err = MMC_BLK_NEW_REQUEST;
423 break;
424 }
425 }
426 }
427 return err;
428}
429
430static void mmc_wait_for_req_done(struct mmc_host *host,
431 struct mmc_request *mrq)
432{
433 struct mmc_command *cmd;
434
435 while (1) {
436 wait_for_completion(&mrq->completion);
437
438 cmd = mrq->cmd;
439 if (!cmd->error || !cmd->retries ||
440 mmc_card_removed(host->card))
441 break;
442
443 pr_debug("%s: req failed (CMD%u): %d, retrying...\n",
444 mmc_hostname(host), cmd->opcode, cmd->error);
445 cmd->retries--;
446 cmd->error = 0;
447 host->ops->request(host, mrq);
448 }
449}
450
451
452
453
454
455
456
457
458
459
460
461
462static void mmc_pre_req(struct mmc_host *host, struct mmc_request *mrq,
463 bool is_first_req)
464{
465 if (host->ops->pre_req) {
466 mmc_host_clk_hold(host);
467 host->ops->pre_req(host, mrq, is_first_req);
468 mmc_host_clk_release(host);
469 }
470}
471
472
473
474
475
476
477
478
479
480
481static void mmc_post_req(struct mmc_host *host, struct mmc_request *mrq,
482 int err)
483{
484 if (host->ops->post_req) {
485 mmc_host_clk_hold(host);
486 host->ops->post_req(host, mrq, err);
487 mmc_host_clk_release(host);
488 }
489}
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507struct mmc_async_req *mmc_start_req(struct mmc_host *host,
508 struct mmc_async_req *areq, int *error)
509{
510 int err = 0;
511 int start_err = 0;
512 struct mmc_async_req *data = host->areq;
513
514
515 if (areq)
516 mmc_pre_req(host, areq->mrq, !host->areq);
517
518 if (host->areq) {
519 err = mmc_wait_for_data_req_done(host, host->areq->mrq, areq);
520 if (err == MMC_BLK_NEW_REQUEST) {
521 if (error)
522 *error = err;
523
524
525
526
527 return NULL;
528 }
529
530
531
532 if (host->card && mmc_card_mmc(host->card) &&
533 ((mmc_resp_type(host->areq->mrq->cmd) == MMC_RSP_R1) ||
534 (mmc_resp_type(host->areq->mrq->cmd) == MMC_RSP_R1B)) &&
535 (host->areq->mrq->cmd->resp[0] & R1_EXCEPTION_EVENT))
536 mmc_start_bkops(host->card, true);
537 }
538
539 if (!err && areq)
540 start_err = __mmc_start_data_req(host, areq->mrq);
541
542 if (host->areq)
543 mmc_post_req(host, host->areq->mrq, 0);
544
545
546 if ((err || start_err) && areq)
547 mmc_post_req(host, areq->mrq, -EINVAL);
548
549 if (err)
550 host->areq = NULL;
551 else
552 host->areq = areq;
553
554 if (error)
555 *error = err;
556 return data;
557}
558EXPORT_SYMBOL(mmc_start_req);
559
560
561
562
563
564
565
566
567
568
569void mmc_wait_for_req(struct mmc_host *host, struct mmc_request *mrq)
570{
571 __mmc_start_req(host, mrq);
572 mmc_wait_for_req_done(host, mrq);
573}
574EXPORT_SYMBOL(mmc_wait_for_req);
575
576
577
578
579
580
581
582
583int mmc_interrupt_hpi(struct mmc_card *card)
584{
585 int err;
586 u32 status;
587 unsigned long prg_wait;
588
589 BUG_ON(!card);
590
591 if (!card->ext_csd.hpi_en) {
592 pr_info("%s: HPI enable bit unset\n", mmc_hostname(card->host));
593 return 1;
594 }
595
596 mmc_claim_host(card->host);
597 err = mmc_send_status(card, &status);
598 if (err) {
599 pr_err("%s: Get card status fail\n", mmc_hostname(card->host));
600 goto out;
601 }
602
603 switch (R1_CURRENT_STATE(status)) {
604 case R1_STATE_IDLE:
605 case R1_STATE_READY:
606 case R1_STATE_STBY:
607 case R1_STATE_TRAN:
608
609
610
611
612 goto out;
613 case R1_STATE_PRG:
614 break;
615 default:
616
617 pr_debug("%s: HPI cannot be sent. Card state=%d\n",
618 mmc_hostname(card->host), R1_CURRENT_STATE(status));
619 err = -EINVAL;
620 goto out;
621 }
622
623 err = mmc_send_hpi_cmd(card, &status);
624 if (err)
625 goto out;
626
627 prg_wait = jiffies + msecs_to_jiffies(card->ext_csd.out_of_int_time);
628 do {
629 err = mmc_send_status(card, &status);
630
631 if (!err && R1_CURRENT_STATE(status) == R1_STATE_TRAN)
632 break;
633 if (time_after(jiffies, prg_wait))
634 err = -ETIMEDOUT;
635 } while (!err);
636
637out:
638 mmc_release_host(card->host);
639 return err;
640}
641EXPORT_SYMBOL(mmc_interrupt_hpi);
642
643
644
645
646
647
648
649
650
651
652
653int mmc_wait_for_cmd(struct mmc_host *host, struct mmc_command *cmd, int retries)
654{
655 struct mmc_request mrq = {NULL};
656
657 WARN_ON(!host->claimed);
658
659 memset(cmd->resp, 0, sizeof(cmd->resp));
660 cmd->retries = retries;
661
662 mrq.cmd = cmd;
663 cmd->data = NULL;
664
665 mmc_wait_for_req(host, &mrq);
666
667 return cmd->error;
668}
669
670EXPORT_SYMBOL(mmc_wait_for_cmd);
671
672
673
674
675
676
677
678
679
680
681int mmc_stop_bkops(struct mmc_card *card)
682{
683 int err = 0;
684
685 BUG_ON(!card);
686 err = mmc_interrupt_hpi(card);
687
688
689
690
691
692 if (!err || (err == -EINVAL)) {
693 mmc_card_clr_doing_bkops(card);
694 err = 0;
695 }
696
697 return err;
698}
699EXPORT_SYMBOL(mmc_stop_bkops);
700
701int mmc_read_bkops_status(struct mmc_card *card)
702{
703 int err;
704 u8 *ext_csd;
705
706
707
708
709 ext_csd = kmalloc(512, GFP_KERNEL);
710 if (!ext_csd) {
711 pr_err("%s: could not allocate buffer to receive the ext_csd.\n",
712 mmc_hostname(card->host));
713 return -ENOMEM;
714 }
715
716 mmc_claim_host(card->host);
717 err = mmc_send_ext_csd(card, ext_csd);
718 mmc_release_host(card->host);
719 if (err)
720 goto out;
721
722 card->ext_csd.raw_bkops_status = ext_csd[EXT_CSD_BKOPS_STATUS];
723 card->ext_csd.raw_exception_status = ext_csd[EXT_CSD_EXP_EVENTS_STATUS];
724out:
725 kfree(ext_csd);
726 return err;
727}
728EXPORT_SYMBOL(mmc_read_bkops_status);
729
730
731
732
733
734
735
736
737
738void mmc_set_data_timeout(struct mmc_data *data, const struct mmc_card *card)
739{
740 unsigned int mult;
741
742
743
744
745 if (mmc_card_sdio(card)) {
746 data->timeout_ns = 1000000000;
747 data->timeout_clks = 0;
748 return;
749 }
750
751
752
753
754 mult = mmc_card_sd(card) ? 100 : 10;
755
756
757
758
759
760 if (data->flags & MMC_DATA_WRITE)
761 mult <<= card->csd.r2w_factor;
762
763 data->timeout_ns = card->csd.tacc_ns * mult;
764 data->timeout_clks = card->csd.tacc_clks * mult;
765
766
767
768
769 if (mmc_card_sd(card)) {
770 unsigned int timeout_us, limit_us;
771
772 timeout_us = data->timeout_ns / 1000;
773 if (mmc_host_clk_rate(card->host))
774 timeout_us += data->timeout_clks * 1000 /
775 (mmc_host_clk_rate(card->host) / 1000);
776
777 if (data->flags & MMC_DATA_WRITE)
778
779
780
781
782
783
784
785
786 limit_us = 3000000;
787 else
788 limit_us = 100000;
789
790
791
792
793 if (timeout_us > limit_us || mmc_card_blockaddr(card)) {
794 data->timeout_ns = limit_us * 1000;
795 data->timeout_clks = 0;
796 }
797 }
798
799
800
801
802
803
804
805 if (mmc_card_long_read_time(card) && data->flags & MMC_DATA_READ) {
806 data->timeout_ns = 300000000;
807 data->timeout_clks = 0;
808 }
809
810
811
812
813
814
815
816 if (mmc_host_is_spi(card->host)) {
817 if (data->flags & MMC_DATA_WRITE) {
818 if (data->timeout_ns < 1000000000)
819 data->timeout_ns = 1000000000;
820 } else {
821 if (data->timeout_ns < 100000000)
822 data->timeout_ns = 100000000;
823 }
824 }
825}
826EXPORT_SYMBOL(mmc_set_data_timeout);
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842unsigned int mmc_align_data_size(struct mmc_card *card, unsigned int sz)
843{
844
845
846
847
848
849 sz = ((sz + 3) / 4) * 4;
850
851 return sz;
852}
853EXPORT_SYMBOL(mmc_align_data_size);
854
855
856
857
858
859
860
861
862
863
864
865int __mmc_claim_host(struct mmc_host *host, atomic_t *abort)
866{
867 DECLARE_WAITQUEUE(wait, current);
868 unsigned long flags;
869 int stop;
870
871 might_sleep();
872
873 add_wait_queue(&host->wq, &wait);
874 spin_lock_irqsave(&host->lock, flags);
875 while (1) {
876 set_current_state(TASK_UNINTERRUPTIBLE);
877 stop = abort ? atomic_read(abort) : 0;
878 if (stop || !host->claimed || host->claimer == current)
879 break;
880 spin_unlock_irqrestore(&host->lock, flags);
881 schedule();
882 spin_lock_irqsave(&host->lock, flags);
883 }
884 set_current_state(TASK_RUNNING);
885 if (!stop) {
886 host->claimed = 1;
887 host->claimer = current;
888 host->claim_cnt += 1;
889 } else
890 wake_up(&host->wq);
891 spin_unlock_irqrestore(&host->lock, flags);
892 remove_wait_queue(&host->wq, &wait);
893 if (host->ops->enable && !stop && host->claim_cnt == 1)
894 host->ops->enable(host);
895 return stop;
896}
897
898EXPORT_SYMBOL(__mmc_claim_host);
899
900
901
902
903
904
905
906int mmc_try_claim_host(struct mmc_host *host)
907{
908 int claimed_host = 0;
909 unsigned long flags;
910
911 spin_lock_irqsave(&host->lock, flags);
912 if (!host->claimed || host->claimer == current) {
913 host->claimed = 1;
914 host->claimer = current;
915 host->claim_cnt += 1;
916 claimed_host = 1;
917 }
918 spin_unlock_irqrestore(&host->lock, flags);
919 if (host->ops->enable && claimed_host && host->claim_cnt == 1)
920 host->ops->enable(host);
921 return claimed_host;
922}
923EXPORT_SYMBOL(mmc_try_claim_host);
924
925
926
927
928
929
930
931
932void mmc_release_host(struct mmc_host *host)
933{
934 unsigned long flags;
935
936 WARN_ON(!host->claimed);
937
938 if (host->ops->disable && host->claim_cnt == 1)
939 host->ops->disable(host);
940
941 spin_lock_irqsave(&host->lock, flags);
942 if (--host->claim_cnt) {
943
944 spin_unlock_irqrestore(&host->lock, flags);
945 } else {
946 host->claimed = 0;
947 host->claimer = NULL;
948 spin_unlock_irqrestore(&host->lock, flags);
949 wake_up(&host->wq);
950 }
951}
952EXPORT_SYMBOL(mmc_release_host);
953
954
955
956
957
958static inline void mmc_set_ios(struct mmc_host *host)
959{
960 struct mmc_ios *ios = &host->ios;
961
962 pr_debug("%s: clock %uHz busmode %u powermode %u cs %u Vdd %u "
963 "width %u timing %u\n",
964 mmc_hostname(host), ios->clock, ios->bus_mode,
965 ios->power_mode, ios->chip_select, ios->vdd,
966 ios->bus_width, ios->timing);
967
968 if (ios->clock > 0)
969 mmc_set_ungated(host);
970 host->ops->set_ios(host, ios);
971}
972
973
974
975
976void mmc_set_chip_select(struct mmc_host *host, int mode)
977{
978 mmc_host_clk_hold(host);
979 host->ios.chip_select = mode;
980 mmc_set_ios(host);
981 mmc_host_clk_release(host);
982}
983
984
985
986
987
988static void __mmc_set_clock(struct mmc_host *host, unsigned int hz)
989{
990 WARN_ON(hz < host->f_min);
991
992 if (hz > host->f_max)
993 hz = host->f_max;
994
995 host->ios.clock = hz;
996 mmc_set_ios(host);
997}
998
999void mmc_set_clock(struct mmc_host *host, unsigned int hz)
1000{
1001 mmc_host_clk_hold(host);
1002 __mmc_set_clock(host, hz);
1003 mmc_host_clk_release(host);
1004}
1005
1006#ifdef CONFIG_MMC_CLKGATE
1007
1008
1009
1010void mmc_gate_clock(struct mmc_host *host)
1011{
1012 unsigned long flags;
1013
1014 spin_lock_irqsave(&host->clk_lock, flags);
1015 host->clk_old = host->ios.clock;
1016 host->ios.clock = 0;
1017 host->clk_gated = true;
1018 spin_unlock_irqrestore(&host->clk_lock, flags);
1019 mmc_set_ios(host);
1020}
1021
1022
1023
1024
1025
1026void mmc_ungate_clock(struct mmc_host *host)
1027{
1028
1029
1030
1031
1032
1033
1034
1035 if (host->clk_old) {
1036 BUG_ON(host->ios.clock);
1037
1038 __mmc_set_clock(host, host->clk_old);
1039 }
1040}
1041
1042void mmc_set_ungated(struct mmc_host *host)
1043{
1044 unsigned long flags;
1045
1046
1047
1048
1049
1050 spin_lock_irqsave(&host->clk_lock, flags);
1051 host->clk_gated = false;
1052 spin_unlock_irqrestore(&host->clk_lock, flags);
1053}
1054
1055#else
1056void mmc_set_ungated(struct mmc_host *host)
1057{
1058}
1059#endif
1060
1061
1062
1063
1064void mmc_set_bus_mode(struct mmc_host *host, unsigned int mode)
1065{
1066 mmc_host_clk_hold(host);
1067 host->ios.bus_mode = mode;
1068 mmc_set_ios(host);
1069 mmc_host_clk_release(host);
1070}
1071
1072
1073
1074
1075void mmc_set_bus_width(struct mmc_host *host, unsigned int width)
1076{
1077 mmc_host_clk_hold(host);
1078 host->ios.bus_width = width;
1079 mmc_set_ios(host);
1080 mmc_host_clk_release(host);
1081}
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098static int mmc_vdd_to_ocrbitnum(int vdd, bool low_bits)
1099{
1100 const int max_bit = ilog2(MMC_VDD_35_36);
1101 int bit;
1102
1103 if (vdd < 1650 || vdd > 3600)
1104 return -EINVAL;
1105
1106 if (vdd >= 1650 && vdd <= 1950)
1107 return ilog2(MMC_VDD_165_195);
1108
1109 if (low_bits)
1110 vdd -= 1;
1111
1112
1113 bit = (vdd - 2000) / 100 + 8;
1114 if (bit > max_bit)
1115 return max_bit;
1116 return bit;
1117}
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132u32 mmc_vddrange_to_ocrmask(int vdd_min, int vdd_max)
1133{
1134 u32 mask = 0;
1135
1136 if (vdd_max < vdd_min)
1137 return 0;
1138
1139
1140 vdd_max = mmc_vdd_to_ocrbitnum(vdd_max, false);
1141 if (vdd_max < 0)
1142 return 0;
1143
1144
1145 vdd_min = mmc_vdd_to_ocrbitnum(vdd_min, true);
1146 if (vdd_min < 0)
1147 return 0;
1148
1149
1150 while (vdd_max >= vdd_min)
1151 mask |= 1 << vdd_max--;
1152
1153 return mask;
1154}
1155EXPORT_SYMBOL(mmc_vddrange_to_ocrmask);
1156
1157#ifdef CONFIG_REGULATOR
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168int mmc_regulator_get_ocrmask(struct regulator *supply)
1169{
1170 int result = 0;
1171 int count;
1172 int i;
1173
1174 count = regulator_count_voltages(supply);
1175 if (count < 0)
1176 return count;
1177
1178 for (i = 0; i < count; i++) {
1179 int vdd_uV;
1180 int vdd_mV;
1181
1182 vdd_uV = regulator_list_voltage(supply, i);
1183 if (vdd_uV <= 0)
1184 continue;
1185
1186 vdd_mV = vdd_uV / 1000;
1187 result |= mmc_vddrange_to_ocrmask(vdd_mV, vdd_mV);
1188 }
1189
1190 return result;
1191}
1192EXPORT_SYMBOL_GPL(mmc_regulator_get_ocrmask);
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206int mmc_regulator_set_ocr(struct mmc_host *mmc,
1207 struct regulator *supply,
1208 unsigned short vdd_bit)
1209{
1210 int result = 0;
1211 int min_uV, max_uV;
1212
1213 if (vdd_bit) {
1214 int tmp;
1215 int voltage;
1216
1217
1218
1219
1220
1221
1222
1223 tmp = vdd_bit - ilog2(MMC_VDD_165_195);
1224 if (tmp == 0) {
1225 min_uV = 1650 * 1000;
1226 max_uV = 1950 * 1000;
1227 } else {
1228 min_uV = 1900 * 1000 + tmp * 100 * 1000;
1229 max_uV = min_uV + 100 * 1000;
1230 }
1231
1232
1233
1234
1235
1236 voltage = regulator_get_voltage(supply);
1237
1238 if (!regulator_can_change_voltage(supply))
1239 min_uV = max_uV = voltage;
1240
1241 if (voltage < 0)
1242 result = voltage;
1243 else if (voltage < min_uV || voltage > max_uV)
1244 result = regulator_set_voltage(supply, min_uV, max_uV);
1245 else
1246 result = 0;
1247
1248 if (result == 0 && !mmc->regulator_enabled) {
1249 result = regulator_enable(supply);
1250 if (!result)
1251 mmc->regulator_enabled = true;
1252 }
1253 } else if (mmc->regulator_enabled) {
1254 result = regulator_disable(supply);
1255 if (result == 0)
1256 mmc->regulator_enabled = false;
1257 }
1258
1259 if (result)
1260 dev_err(mmc_dev(mmc),
1261 "could not set regulator OCR (%d)\n", result);
1262 return result;
1263}
1264EXPORT_SYMBOL_GPL(mmc_regulator_set_ocr);
1265
1266int mmc_regulator_get_supply(struct mmc_host *mmc)
1267{
1268 struct device *dev = mmc_dev(mmc);
1269 struct regulator *supply;
1270 int ret;
1271
1272 supply = devm_regulator_get(dev, "vmmc");
1273 mmc->supply.vmmc = supply;
1274 mmc->supply.vqmmc = devm_regulator_get(dev, "vqmmc");
1275
1276 if (IS_ERR(supply))
1277 return PTR_ERR(supply);
1278
1279 ret = mmc_regulator_get_ocrmask(supply);
1280 if (ret > 0)
1281 mmc->ocr_avail = ret;
1282 else
1283 dev_warn(mmc_dev(mmc), "Failed getting OCR mask: %d\n", ret);
1284
1285 return 0;
1286}
1287EXPORT_SYMBOL_GPL(mmc_regulator_get_supply);
1288
1289#endif
1290
1291
1292
1293
1294
1295u32 mmc_select_voltage(struct mmc_host *host, u32 ocr)
1296{
1297 int bit;
1298
1299 ocr &= host->ocr_avail;
1300
1301 bit = ffs(ocr);
1302 if (bit) {
1303 bit -= 1;
1304
1305 ocr &= 3 << bit;
1306
1307 mmc_host_clk_hold(host);
1308 host->ios.vdd = bit;
1309 mmc_set_ios(host);
1310 mmc_host_clk_release(host);
1311 } else {
1312 pr_warning("%s: host doesn't support card's voltages\n",
1313 mmc_hostname(host));
1314 ocr = 0;
1315 }
1316
1317 return ocr;
1318}
1319
1320int __mmc_set_signal_voltage(struct mmc_host *host, int signal_voltage)
1321{
1322 int err = 0;
1323 int old_signal_voltage = host->ios.signal_voltage;
1324
1325 host->ios.signal_voltage = signal_voltage;
1326 if (host->ops->start_signal_voltage_switch) {
1327 mmc_host_clk_hold(host);
1328 err = host->ops->start_signal_voltage_switch(host, &host->ios);
1329 mmc_host_clk_release(host);
1330 }
1331
1332 if (err)
1333 host->ios.signal_voltage = old_signal_voltage;
1334
1335 return err;
1336
1337}
1338
1339int mmc_set_signal_voltage(struct mmc_host *host, int signal_voltage)
1340{
1341 struct mmc_command cmd = {0};
1342 int err = 0;
1343 u32 clock;
1344
1345 BUG_ON(!host);
1346
1347
1348
1349
1350
1351 if (signal_voltage == MMC_SIGNAL_VOLTAGE_330)
1352 return __mmc_set_signal_voltage(host, signal_voltage);
1353
1354
1355
1356
1357
1358 if (!host->ops->start_signal_voltage_switch)
1359 return -EPERM;
1360 if (!host->ops->card_busy)
1361 pr_warning("%s: cannot verify signal voltage switch\n",
1362 mmc_hostname(host));
1363
1364 cmd.opcode = SD_SWITCH_VOLTAGE;
1365 cmd.arg = 0;
1366 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
1367
1368 err = mmc_wait_for_cmd(host, &cmd, 0);
1369 if (err)
1370 return err;
1371
1372 if (!mmc_host_is_spi(host) && (cmd.resp[0] & R1_ERROR))
1373 return -EIO;
1374
1375 mmc_host_clk_hold(host);
1376
1377
1378
1379
1380 mmc_delay(1);
1381 if (host->ops->card_busy && !host->ops->card_busy(host)) {
1382 err = -EAGAIN;
1383 goto power_cycle;
1384 }
1385
1386
1387
1388
1389 clock = host->ios.clock;
1390 host->ios.clock = 0;
1391 mmc_set_ios(host);
1392
1393 if (__mmc_set_signal_voltage(host, signal_voltage)) {
1394
1395
1396
1397
1398 err = -EAGAIN;
1399 goto power_cycle;
1400 }
1401
1402
1403 mmc_delay(5);
1404 host->ios.clock = clock;
1405 mmc_set_ios(host);
1406
1407
1408 mmc_delay(1);
1409
1410
1411
1412
1413
1414 if (host->ops->card_busy && host->ops->card_busy(host))
1415 err = -EAGAIN;
1416
1417power_cycle:
1418 if (err) {
1419 pr_debug("%s: Signal voltage switch failed, "
1420 "power cycling card\n", mmc_hostname(host));
1421 mmc_power_cycle(host);
1422 }
1423
1424 mmc_host_clk_release(host);
1425
1426 return err;
1427}
1428
1429
1430
1431
1432void mmc_set_timing(struct mmc_host *host, unsigned int timing)
1433{
1434 mmc_host_clk_hold(host);
1435 host->ios.timing = timing;
1436 mmc_set_ios(host);
1437 mmc_host_clk_release(host);
1438}
1439
1440
1441
1442
1443void mmc_set_driver_type(struct mmc_host *host, unsigned int drv_type)
1444{
1445 mmc_host_clk_hold(host);
1446 host->ios.drv_type = drv_type;
1447 mmc_set_ios(host);
1448 mmc_host_clk_release(host);
1449}
1450
1451
1452
1453
1454
1455
1456
1457
1458
1459
1460
1461
1462static void mmc_power_up(struct mmc_host *host)
1463{
1464 int bit;
1465
1466 if (host->ios.power_mode == MMC_POWER_ON)
1467 return;
1468
1469 mmc_host_clk_hold(host);
1470
1471
1472 if (host->ocr)
1473 bit = ffs(host->ocr) - 1;
1474 else
1475 bit = fls(host->ocr_avail) - 1;
1476
1477 host->ios.vdd = bit;
1478 if (mmc_host_is_spi(host))
1479 host->ios.chip_select = MMC_CS_HIGH;
1480 else
1481 host->ios.chip_select = MMC_CS_DONTCARE;
1482 host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
1483 host->ios.power_mode = MMC_POWER_UP;
1484 host->ios.bus_width = MMC_BUS_WIDTH_1;
1485 host->ios.timing = MMC_TIMING_LEGACY;
1486 mmc_set_ios(host);
1487
1488
1489 __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_330);
1490
1491
1492
1493
1494
1495 mmc_delay(10);
1496
1497 host->ios.clock = host->f_init;
1498
1499 host->ios.power_mode = MMC_POWER_ON;
1500 mmc_set_ios(host);
1501
1502
1503
1504
1505
1506 mmc_delay(10);
1507
1508 mmc_host_clk_release(host);
1509}
1510
1511void mmc_power_off(struct mmc_host *host)
1512{
1513 if (host->ios.power_mode == MMC_POWER_OFF)
1514 return;
1515
1516 mmc_host_clk_hold(host);
1517
1518 host->ios.clock = 0;
1519 host->ios.vdd = 0;
1520
1521
1522
1523
1524
1525
1526 host->ocr = 1 << (fls(host->ocr_avail) - 1);
1527
1528 if (!mmc_host_is_spi(host)) {
1529 host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
1530 host->ios.chip_select = MMC_CS_DONTCARE;
1531 }
1532 host->ios.power_mode = MMC_POWER_OFF;
1533 host->ios.bus_width = MMC_BUS_WIDTH_1;
1534 host->ios.timing = MMC_TIMING_LEGACY;
1535 mmc_set_ios(host);
1536
1537
1538
1539
1540
1541
1542 mmc_delay(1);
1543
1544 mmc_host_clk_release(host);
1545}
1546
1547void mmc_power_cycle(struct mmc_host *host)
1548{
1549 mmc_power_off(host);
1550
1551 mmc_delay(1);
1552 mmc_power_up(host);
1553}
1554
1555
1556
1557
1558static void __mmc_release_bus(struct mmc_host *host)
1559{
1560 BUG_ON(!host);
1561 BUG_ON(host->bus_refs);
1562 BUG_ON(!host->bus_dead);
1563
1564 host->bus_ops = NULL;
1565}
1566
1567
1568
1569
1570static inline void mmc_bus_get(struct mmc_host *host)
1571{
1572 unsigned long flags;
1573
1574 spin_lock_irqsave(&host->lock, flags);
1575 host->bus_refs++;
1576 spin_unlock_irqrestore(&host->lock, flags);
1577}
1578
1579
1580
1581
1582
1583static inline void mmc_bus_put(struct mmc_host *host)
1584{
1585 unsigned long flags;
1586
1587 spin_lock_irqsave(&host->lock, flags);
1588 host->bus_refs--;
1589 if ((host->bus_refs == 0) && host->bus_ops)
1590 __mmc_release_bus(host);
1591 spin_unlock_irqrestore(&host->lock, flags);
1592}
1593
1594
1595
1596
1597
1598void mmc_attach_bus(struct mmc_host *host, const struct mmc_bus_ops *ops)
1599{
1600 unsigned long flags;
1601
1602 BUG_ON(!host);
1603 BUG_ON(!ops);
1604
1605 WARN_ON(!host->claimed);
1606
1607 spin_lock_irqsave(&host->lock, flags);
1608
1609 BUG_ON(host->bus_ops);
1610 BUG_ON(host->bus_refs);
1611
1612 host->bus_ops = ops;
1613 host->bus_refs = 1;
1614 host->bus_dead = 0;
1615
1616 spin_unlock_irqrestore(&host->lock, flags);
1617}
1618
1619
1620
1621
1622void mmc_detach_bus(struct mmc_host *host)
1623{
1624 unsigned long flags;
1625
1626 BUG_ON(!host);
1627
1628 WARN_ON(!host->claimed);
1629 WARN_ON(!host->bus_ops);
1630
1631 spin_lock_irqsave(&host->lock, flags);
1632
1633 host->bus_dead = 1;
1634
1635 spin_unlock_irqrestore(&host->lock, flags);
1636
1637 mmc_bus_put(host);
1638}
1639
1640
1641
1642
1643
1644
1645
1646
1647
1648
1649
1650void mmc_detect_change(struct mmc_host *host, unsigned long delay)
1651{
1652#ifdef CONFIG_MMC_DEBUG
1653 unsigned long flags;
1654 spin_lock_irqsave(&host->lock, flags);
1655 WARN_ON(host->removed);
1656 spin_unlock_irqrestore(&host->lock, flags);
1657#endif
1658 host->detect_change = 1;
1659 mmc_schedule_delayed_work(&host->detect, delay);
1660}
1661
1662EXPORT_SYMBOL(mmc_detect_change);
1663
1664void mmc_init_erase(struct mmc_card *card)
1665{
1666 unsigned int sz;
1667
1668 if (is_power_of_2(card->erase_size))
1669 card->erase_shift = ffs(card->erase_size) - 1;
1670 else
1671 card->erase_shift = 0;
1672
1673
1674
1675
1676
1677
1678
1679
1680
1681
1682
1683
1684
1685
1686
1687
1688 if (mmc_card_sd(card) && card->ssr.au) {
1689 card->pref_erase = card->ssr.au;
1690 card->erase_shift = ffs(card->ssr.au) - 1;
1691 } else if (card->ext_csd.hc_erase_size) {
1692 card->pref_erase = card->ext_csd.hc_erase_size;
1693 } else {
1694 sz = (card->csd.capacity << (card->csd.read_blkbits - 9)) >> 11;
1695 if (sz < 128)
1696 card->pref_erase = 512 * 1024 / 512;
1697 else if (sz < 512)
1698 card->pref_erase = 1024 * 1024 / 512;
1699 else if (sz < 1024)
1700 card->pref_erase = 2 * 1024 * 1024 / 512;
1701 else
1702 card->pref_erase = 4 * 1024 * 1024 / 512;
1703 if (card->pref_erase < card->erase_size)
1704 card->pref_erase = card->erase_size;
1705 else {
1706 sz = card->pref_erase % card->erase_size;
1707 if (sz)
1708 card->pref_erase += card->erase_size - sz;
1709 }
1710 }
1711}
1712
1713static unsigned int mmc_mmc_erase_timeout(struct mmc_card *card,
1714 unsigned int arg, unsigned int qty)
1715{
1716 unsigned int erase_timeout;
1717
1718 if (arg == MMC_DISCARD_ARG ||
1719 (arg == MMC_TRIM_ARG && card->ext_csd.rev >= 6)) {
1720 erase_timeout = card->ext_csd.trim_timeout;
1721 } else if (card->ext_csd.erase_group_def & 1) {
1722
1723 if (arg == MMC_TRIM_ARG)
1724 erase_timeout = card->ext_csd.trim_timeout;
1725 else
1726 erase_timeout = card->ext_csd.hc_erase_timeout;
1727 } else {
1728
1729 unsigned int mult = (10 << card->csd.r2w_factor);
1730 unsigned int timeout_clks = card->csd.tacc_clks * mult;
1731 unsigned int timeout_us;
1732
1733
1734 if (card->csd.tacc_ns < 1000000)
1735 timeout_us = (card->csd.tacc_ns * mult) / 1000;
1736 else
1737 timeout_us = (card->csd.tacc_ns / 1000) * mult;
1738
1739
1740
1741
1742
1743 timeout_clks <<= 1;
1744 timeout_us += (timeout_clks * 1000) /
1745 (mmc_host_clk_rate(card->host) / 1000);
1746
1747 erase_timeout = timeout_us / 1000;
1748
1749
1750
1751
1752
1753 if (!erase_timeout)
1754 erase_timeout = 1;
1755 }
1756
1757
1758 if (arg & MMC_SECURE_ARGS) {
1759 if (arg == MMC_SECURE_ERASE_ARG)
1760 erase_timeout *= card->ext_csd.sec_erase_mult;
1761 else
1762 erase_timeout *= card->ext_csd.sec_trim_mult;
1763 }
1764
1765 erase_timeout *= qty;
1766
1767
1768
1769
1770
1771 if (mmc_host_is_spi(card->host) && erase_timeout < 1000)
1772 erase_timeout = 1000;
1773
1774 return erase_timeout;
1775}
1776
1777static unsigned int mmc_sd_erase_timeout(struct mmc_card *card,
1778 unsigned int arg,
1779 unsigned int qty)
1780{
1781 unsigned int erase_timeout;
1782
1783 if (card->ssr.erase_timeout) {
1784
1785 erase_timeout = card->ssr.erase_timeout * qty +
1786 card->ssr.erase_offset;
1787 } else {
1788
1789
1790
1791
1792 erase_timeout = 250 * qty;
1793 }
1794
1795
1796 if (erase_timeout < 1000)
1797 erase_timeout = 1000;
1798
1799 return erase_timeout;
1800}
1801
1802static unsigned int mmc_erase_timeout(struct mmc_card *card,
1803 unsigned int arg,
1804 unsigned int qty)
1805{
1806 if (mmc_card_sd(card))
1807 return mmc_sd_erase_timeout(card, arg, qty);
1808 else
1809 return mmc_mmc_erase_timeout(card, arg, qty);
1810}
1811
1812static int mmc_do_erase(struct mmc_card *card, unsigned int from,
1813 unsigned int to, unsigned int arg)
1814{
1815 struct mmc_command cmd = {0};
1816 unsigned int qty = 0;
1817 unsigned long timeout;
1818 int err;
1819
1820
1821
1822
1823
1824
1825
1826
1827
1828
1829
1830
1831
1832
1833
1834
1835
1836 if (card->erase_shift)
1837 qty += ((to >> card->erase_shift) -
1838 (from >> card->erase_shift)) + 1;
1839 else if (mmc_card_sd(card))
1840 qty += to - from + 1;
1841 else
1842 qty += ((to / card->erase_size) -
1843 (from / card->erase_size)) + 1;
1844
1845 if (!mmc_card_blockaddr(card)) {
1846 from <<= 9;
1847 to <<= 9;
1848 }
1849
1850 if (mmc_card_sd(card))
1851 cmd.opcode = SD_ERASE_WR_BLK_START;
1852 else
1853 cmd.opcode = MMC_ERASE_GROUP_START;
1854 cmd.arg = from;
1855 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
1856 err = mmc_wait_for_cmd(card->host, &cmd, 0);
1857 if (err) {
1858 pr_err("mmc_erase: group start error %d, "
1859 "status %#x\n", err, cmd.resp[0]);
1860 err = -EIO;
1861 goto out;
1862 }
1863
1864 memset(&cmd, 0, sizeof(struct mmc_command));
1865 if (mmc_card_sd(card))
1866 cmd.opcode = SD_ERASE_WR_BLK_END;
1867 else
1868 cmd.opcode = MMC_ERASE_GROUP_END;
1869 cmd.arg = to;
1870 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
1871 err = mmc_wait_for_cmd(card->host, &cmd, 0);
1872 if (err) {
1873 pr_err("mmc_erase: group end error %d, status %#x\n",
1874 err, cmd.resp[0]);
1875 err = -EIO;
1876 goto out;
1877 }
1878
1879 memset(&cmd, 0, sizeof(struct mmc_command));
1880 cmd.opcode = MMC_ERASE;
1881 cmd.arg = arg;
1882 cmd.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC;
1883 cmd.cmd_timeout_ms = mmc_erase_timeout(card, arg, qty);
1884 err = mmc_wait_for_cmd(card->host, &cmd, 0);
1885 if (err) {
1886 pr_err("mmc_erase: erase error %d, status %#x\n",
1887 err, cmd.resp[0]);
1888 err = -EIO;
1889 goto out;
1890 }
1891
1892 if (mmc_host_is_spi(card->host))
1893 goto out;
1894
1895 timeout = jiffies + msecs_to_jiffies(MMC_CORE_TIMEOUT_MS);
1896 do {
1897 memset(&cmd, 0, sizeof(struct mmc_command));
1898 cmd.opcode = MMC_SEND_STATUS;
1899 cmd.arg = card->rca << 16;
1900 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
1901
1902 err = mmc_wait_for_cmd(card->host, &cmd, 0);
1903 if (err || (cmd.resp[0] & 0xFDF92000)) {
1904 pr_err("error %d requesting status %#x\n",
1905 err, cmd.resp[0]);
1906 err = -EIO;
1907 goto out;
1908 }
1909
1910
1911
1912
1913 if (time_after(jiffies, timeout)) {
1914 pr_err("%s: Card stuck in programming state! %s\n",
1915 mmc_hostname(card->host), __func__);
1916 err = -EIO;
1917 goto out;
1918 }
1919
1920 } while (!(cmd.resp[0] & R1_READY_FOR_DATA) ||
1921 (R1_CURRENT_STATE(cmd.resp[0]) == R1_STATE_PRG));
1922out:
1923 return err;
1924}
1925
1926
1927
1928
1929
1930
1931
1932
1933
1934
1935int mmc_erase(struct mmc_card *card, unsigned int from, unsigned int nr,
1936 unsigned int arg)
1937{
1938 unsigned int rem, to = from + nr;
1939
1940 if (!(card->host->caps & MMC_CAP_ERASE) ||
1941 !(card->csd.cmdclass & CCC_ERASE))
1942 return -EOPNOTSUPP;
1943
1944 if (!card->erase_size)
1945 return -EOPNOTSUPP;
1946
1947 if (mmc_card_sd(card) && arg != MMC_ERASE_ARG)
1948 return -EOPNOTSUPP;
1949
1950 if ((arg & MMC_SECURE_ARGS) &&
1951 !(card->ext_csd.sec_feature_support & EXT_CSD_SEC_ER_EN))
1952 return -EOPNOTSUPP;
1953
1954 if ((arg & MMC_TRIM_ARGS) &&
1955 !(card->ext_csd.sec_feature_support & EXT_CSD_SEC_GB_CL_EN))
1956 return -EOPNOTSUPP;
1957
1958 if (arg == MMC_SECURE_ERASE_ARG) {
1959 if (from % card->erase_size || nr % card->erase_size)
1960 return -EINVAL;
1961 }
1962
1963 if (arg == MMC_ERASE_ARG) {
1964 rem = from % card->erase_size;
1965 if (rem) {
1966 rem = card->erase_size - rem;
1967 from += rem;
1968 if (nr > rem)
1969 nr -= rem;
1970 else
1971 return 0;
1972 }
1973 rem = nr % card->erase_size;
1974 if (rem)
1975 nr -= rem;
1976 }
1977
1978 if (nr == 0)
1979 return 0;
1980
1981 to = from + nr;
1982
1983 if (to <= from)
1984 return -EINVAL;
1985
1986
1987 to -= 1;
1988
1989 return mmc_do_erase(card, from, to, arg);
1990}
1991EXPORT_SYMBOL(mmc_erase);
1992
1993int mmc_can_erase(struct mmc_card *card)
1994{
1995 if ((card->host->caps & MMC_CAP_ERASE) &&
1996 (card->csd.cmdclass & CCC_ERASE) && card->erase_size)
1997 return 1;
1998 return 0;
1999}
2000EXPORT_SYMBOL(mmc_can_erase);
2001
2002int mmc_can_trim(struct mmc_card *card)
2003{
2004 if (card->ext_csd.sec_feature_support & EXT_CSD_SEC_GB_CL_EN)
2005 return 1;
2006 return 0;
2007}
2008EXPORT_SYMBOL(mmc_can_trim);
2009
2010int mmc_can_discard(struct mmc_card *card)
2011{
2012
2013
2014
2015
2016 if (card->ext_csd.feature_support & MMC_DISCARD_FEATURE)
2017 return 1;
2018 return 0;
2019}
2020EXPORT_SYMBOL(mmc_can_discard);
2021
2022int mmc_can_sanitize(struct mmc_card *card)
2023{
2024 if (!mmc_can_trim(card) && !mmc_can_erase(card))
2025 return 0;
2026 if (card->ext_csd.sec_feature_support & EXT_CSD_SEC_SANITIZE)
2027 return 1;
2028 return 0;
2029}
2030EXPORT_SYMBOL(mmc_can_sanitize);
2031
2032int mmc_can_secure_erase_trim(struct mmc_card *card)
2033{
2034 if (card->ext_csd.sec_feature_support & EXT_CSD_SEC_ER_EN)
2035 return 1;
2036 return 0;
2037}
2038EXPORT_SYMBOL(mmc_can_secure_erase_trim);
2039
2040int mmc_erase_group_aligned(struct mmc_card *card, unsigned int from,
2041 unsigned int nr)
2042{
2043 if (!card->erase_size)
2044 return 0;
2045 if (from % card->erase_size || nr % card->erase_size)
2046 return 0;
2047 return 1;
2048}
2049EXPORT_SYMBOL(mmc_erase_group_aligned);
2050
2051static unsigned int mmc_do_calc_max_discard(struct mmc_card *card,
2052 unsigned int arg)
2053{
2054 struct mmc_host *host = card->host;
2055 unsigned int max_discard, x, y, qty = 0, max_qty, timeout;
2056 unsigned int last_timeout = 0;
2057
2058 if (card->erase_shift)
2059 max_qty = UINT_MAX >> card->erase_shift;
2060 else if (mmc_card_sd(card))
2061 max_qty = UINT_MAX;
2062 else
2063 max_qty = UINT_MAX / card->erase_size;
2064
2065
2066 do {
2067 y = 0;
2068 for (x = 1; x && x <= max_qty && max_qty - x >= qty; x <<= 1) {
2069 timeout = mmc_erase_timeout(card, arg, qty + x);
2070 if (timeout > host->max_discard_to)
2071 break;
2072 if (timeout < last_timeout)
2073 break;
2074 last_timeout = timeout;
2075 y = x;
2076 }
2077 qty += y;
2078 } while (y);
2079
2080 if (!qty)
2081 return 0;
2082
2083 if (qty == 1)
2084 return 1;
2085
2086
2087 if (card->erase_shift)
2088 max_discard = --qty << card->erase_shift;
2089 else if (mmc_card_sd(card))
2090 max_discard = qty;
2091 else
2092 max_discard = --qty * card->erase_size;
2093
2094 return max_discard;
2095}
2096
2097unsigned int mmc_calc_max_discard(struct mmc_card *card)
2098{
2099 struct mmc_host *host = card->host;
2100 unsigned int max_discard, max_trim;
2101
2102 if (!host->max_discard_to)
2103 return UINT_MAX;
2104
2105
2106
2107
2108
2109
2110 if (mmc_card_mmc(card) && !(card->ext_csd.erase_group_def & 1))
2111 return card->pref_erase;
2112
2113 max_discard = mmc_do_calc_max_discard(card, MMC_ERASE_ARG);
2114 if (mmc_can_trim(card)) {
2115 max_trim = mmc_do_calc_max_discard(card, MMC_TRIM_ARG);
2116 if (max_trim < max_discard)
2117 max_discard = max_trim;
2118 } else if (max_discard < card->erase_size) {
2119 max_discard = 0;
2120 }
2121 pr_debug("%s: calculated max. discard sectors %u for timeout %u ms\n",
2122 mmc_hostname(host), max_discard, host->max_discard_to);
2123 return max_discard;
2124}
2125EXPORT_SYMBOL(mmc_calc_max_discard);
2126
2127int mmc_set_blocklen(struct mmc_card *card, unsigned int blocklen)
2128{
2129 struct mmc_command cmd = {0};
2130
2131 if (mmc_card_blockaddr(card) || mmc_card_ddr_mode(card))
2132 return 0;
2133
2134 cmd.opcode = MMC_SET_BLOCKLEN;
2135 cmd.arg = blocklen;
2136 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
2137 return mmc_wait_for_cmd(card->host, &cmd, 5);
2138}
2139EXPORT_SYMBOL(mmc_set_blocklen);
2140
2141int mmc_set_blockcount(struct mmc_card *card, unsigned int blockcount,
2142 bool is_rel_write)
2143{
2144 struct mmc_command cmd = {0};
2145
2146 cmd.opcode = MMC_SET_BLOCK_COUNT;
2147 cmd.arg = blockcount & 0x0000FFFF;
2148 if (is_rel_write)
2149 cmd.arg |= 1 << 31;
2150 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
2151 return mmc_wait_for_cmd(card->host, &cmd, 5);
2152}
2153EXPORT_SYMBOL(mmc_set_blockcount);
2154
2155static void mmc_hw_reset_for_init(struct mmc_host *host)
2156{
2157 if (!(host->caps & MMC_CAP_HW_RESET) || !host->ops->hw_reset)
2158 return;
2159 mmc_host_clk_hold(host);
2160 host->ops->hw_reset(host);
2161 mmc_host_clk_release(host);
2162}
2163
2164int mmc_can_reset(struct mmc_card *card)
2165{
2166 u8 rst_n_function;
2167
2168 if (!mmc_card_mmc(card))
2169 return 0;
2170 rst_n_function = card->ext_csd.rst_n_function;
2171 if ((rst_n_function & EXT_CSD_RST_N_EN_MASK) != EXT_CSD_RST_N_ENABLED)
2172 return 0;
2173 return 1;
2174}
2175EXPORT_SYMBOL(mmc_can_reset);
2176
2177static int mmc_do_hw_reset(struct mmc_host *host, int check)
2178{
2179 struct mmc_card *card = host->card;
2180
2181 if (!host->bus_ops->power_restore)
2182 return -EOPNOTSUPP;
2183
2184 if (!(host->caps & MMC_CAP_HW_RESET) || !host->ops->hw_reset)
2185 return -EOPNOTSUPP;
2186
2187 if (!card)
2188 return -EINVAL;
2189
2190 if (!mmc_can_reset(card))
2191 return -EOPNOTSUPP;
2192
2193 mmc_host_clk_hold(host);
2194 mmc_set_clock(host, host->f_init);
2195
2196 host->ops->hw_reset(host);
2197
2198
2199 if (check) {
2200 struct mmc_command cmd = {0};
2201 int err;
2202
2203 cmd.opcode = MMC_SEND_STATUS;
2204 if (!mmc_host_is_spi(card->host))
2205 cmd.arg = card->rca << 16;
2206 cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_AC;
2207 err = mmc_wait_for_cmd(card->host, &cmd, 0);
2208 if (!err) {
2209 mmc_host_clk_release(host);
2210 return -ENOSYS;
2211 }
2212 }
2213
2214 host->card->state &= ~(MMC_STATE_HIGHSPEED | MMC_STATE_HIGHSPEED_DDR);
2215 if (mmc_host_is_spi(host)) {
2216 host->ios.chip_select = MMC_CS_HIGH;
2217 host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
2218 } else {
2219 host->ios.chip_select = MMC_CS_DONTCARE;
2220 host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
2221 }
2222 host->ios.bus_width = MMC_BUS_WIDTH_1;
2223 host->ios.timing = MMC_TIMING_LEGACY;
2224 mmc_set_ios(host);
2225
2226 mmc_host_clk_release(host);
2227
2228 return host->bus_ops->power_restore(host);
2229}
2230
2231int mmc_hw_reset(struct mmc_host *host)
2232{
2233 return mmc_do_hw_reset(host, 0);
2234}
2235EXPORT_SYMBOL(mmc_hw_reset);
2236
2237int mmc_hw_reset_check(struct mmc_host *host)
2238{
2239 return mmc_do_hw_reset(host, 1);
2240}
2241EXPORT_SYMBOL(mmc_hw_reset_check);
2242
2243static int mmc_rescan_try_freq(struct mmc_host *host, unsigned freq)
2244{
2245 host->f_init = freq;
2246
2247#ifdef CONFIG_MMC_DEBUG
2248 pr_info("%s: %s: trying to init card at %u Hz\n",
2249 mmc_hostname(host), __func__, host->f_init);
2250#endif
2251 mmc_power_up(host);
2252
2253
2254
2255
2256
2257 mmc_hw_reset_for_init(host);
2258
2259
2260
2261
2262
2263
2264 sdio_reset(host);
2265 mmc_go_idle(host);
2266
2267 mmc_send_if_cond(host, host->ocr_avail);
2268
2269
2270 if (!mmc_attach_sdio(host))
2271 return 0;
2272 if (!mmc_attach_sd(host))
2273 return 0;
2274 if (!mmc_attach_mmc(host))
2275 return 0;
2276
2277 mmc_power_off(host);
2278 return -EIO;
2279}
2280
2281int _mmc_detect_card_removed(struct mmc_host *host)
2282{
2283 int ret;
2284
2285 if ((host->caps & MMC_CAP_NONREMOVABLE) || !host->bus_ops->alive)
2286 return 0;
2287
2288 if (!host->card || mmc_card_removed(host->card))
2289 return 1;
2290
2291 ret = host->bus_ops->alive(host);
2292 if (ret) {
2293 mmc_card_set_removed(host->card);
2294 pr_debug("%s: card remove detected\n", mmc_hostname(host));
2295 }
2296
2297 return ret;
2298}
2299
2300int mmc_detect_card_removed(struct mmc_host *host)
2301{
2302 struct mmc_card *card = host->card;
2303 int ret;
2304
2305 WARN_ON(!host->claimed);
2306
2307 if (!card)
2308 return 1;
2309
2310 ret = mmc_card_removed(card);
2311
2312
2313
2314
2315 if (!host->detect_change && !(host->caps & MMC_CAP_NEEDS_POLL) &&
2316 !(host->caps2 & MMC_CAP2_DETECT_ON_ERR))
2317 return ret;
2318
2319 host->detect_change = 0;
2320 if (!ret) {
2321 ret = _mmc_detect_card_removed(host);
2322 if (ret && (host->caps2 & MMC_CAP2_DETECT_ON_ERR)) {
2323
2324
2325
2326
2327 cancel_delayed_work(&host->detect);
2328 mmc_detect_change(host, 0);
2329 }
2330 }
2331
2332 return ret;
2333}
2334EXPORT_SYMBOL(mmc_detect_card_removed);
2335
2336void mmc_rescan(struct work_struct *work)
2337{
2338 struct mmc_host *host =
2339 container_of(work, struct mmc_host, detect.work);
2340 int i;
2341
2342 if (host->rescan_disable)
2343 return;
2344
2345
2346 if ((host->caps & MMC_CAP_NONREMOVABLE) && host->rescan_entered)
2347 return;
2348 host->rescan_entered = 1;
2349
2350 mmc_bus_get(host);
2351
2352
2353
2354
2355
2356 if (host->bus_ops && host->bus_ops->detect && !host->bus_dead
2357 && !(host->caps & MMC_CAP_NONREMOVABLE))
2358 host->bus_ops->detect(host);
2359
2360 host->detect_change = 0;
2361
2362
2363
2364
2365
2366 mmc_bus_put(host);
2367 mmc_bus_get(host);
2368
2369
2370 if (host->bus_ops != NULL) {
2371 mmc_bus_put(host);
2372 goto out;
2373 }
2374
2375
2376
2377
2378
2379 mmc_bus_put(host);
2380
2381 if (host->ops->get_cd && host->ops->get_cd(host) == 0) {
2382 mmc_claim_host(host);
2383 mmc_power_off(host);
2384 mmc_release_host(host);
2385 goto out;
2386 }
2387
2388 mmc_claim_host(host);
2389 for (i = 0; i < ARRAY_SIZE(freqs); i++) {
2390 if (!mmc_rescan_try_freq(host, max(freqs[i], host->f_min)))
2391 break;
2392 if (freqs[i] <= host->f_min)
2393 break;
2394 }
2395 mmc_release_host(host);
2396
2397 out:
2398 if (host->caps & MMC_CAP_NEEDS_POLL)
2399 mmc_schedule_delayed_work(&host->detect, HZ);
2400}
2401
2402void mmc_start_host(struct mmc_host *host)
2403{
2404 host->f_init = max(freqs[0], host->f_min);
2405 host->rescan_disable = 0;
2406 mmc_power_up(host);
2407 mmc_detect_change(host, 0);
2408}
2409
2410void mmc_stop_host(struct mmc_host *host)
2411{
2412#ifdef CONFIG_MMC_DEBUG
2413 unsigned long flags;
2414 spin_lock_irqsave(&host->lock, flags);
2415 host->removed = 1;
2416 spin_unlock_irqrestore(&host->lock, flags);
2417#endif
2418
2419 host->rescan_disable = 1;
2420 cancel_delayed_work_sync(&host->detect);
2421 mmc_flush_scheduled_work();
2422
2423
2424 host->pm_flags = 0;
2425
2426 mmc_bus_get(host);
2427 if (host->bus_ops && !host->bus_dead) {
2428
2429 if (host->bus_ops->remove)
2430 host->bus_ops->remove(host);
2431
2432 mmc_claim_host(host);
2433 mmc_detach_bus(host);
2434 mmc_power_off(host);
2435 mmc_release_host(host);
2436 mmc_bus_put(host);
2437 return;
2438 }
2439 mmc_bus_put(host);
2440
2441 BUG_ON(host->card);
2442
2443 mmc_power_off(host);
2444}
2445
2446int mmc_power_save_host(struct mmc_host *host)
2447{
2448 int ret = 0;
2449
2450#ifdef CONFIG_MMC_DEBUG
2451 pr_info("%s: %s: powering down\n", mmc_hostname(host), __func__);
2452#endif
2453
2454 mmc_bus_get(host);
2455
2456 if (!host->bus_ops || host->bus_dead || !host->bus_ops->power_restore) {
2457 mmc_bus_put(host);
2458 return -EINVAL;
2459 }
2460
2461 if (host->bus_ops->power_save)
2462 ret = host->bus_ops->power_save(host);
2463
2464 mmc_bus_put(host);
2465
2466 mmc_power_off(host);
2467
2468 return ret;
2469}
2470EXPORT_SYMBOL(mmc_power_save_host);
2471
2472int mmc_power_restore_host(struct mmc_host *host)
2473{
2474 int ret;
2475
2476#ifdef CONFIG_MMC_DEBUG
2477 pr_info("%s: %s: powering up\n", mmc_hostname(host), __func__);
2478#endif
2479
2480 mmc_bus_get(host);
2481
2482 if (!host->bus_ops || host->bus_dead || !host->bus_ops->power_restore) {
2483 mmc_bus_put(host);
2484 return -EINVAL;
2485 }
2486
2487 mmc_power_up(host);
2488 ret = host->bus_ops->power_restore(host);
2489
2490 mmc_bus_put(host);
2491
2492 return ret;
2493}
2494EXPORT_SYMBOL(mmc_power_restore_host);
2495
2496int mmc_card_awake(struct mmc_host *host)
2497{
2498 int err = -ENOSYS;
2499
2500 if (host->caps2 & MMC_CAP2_NO_SLEEP_CMD)
2501 return 0;
2502
2503 mmc_bus_get(host);
2504
2505 if (host->bus_ops && !host->bus_dead && host->bus_ops->awake)
2506 err = host->bus_ops->awake(host);
2507
2508 mmc_bus_put(host);
2509
2510 return err;
2511}
2512EXPORT_SYMBOL(mmc_card_awake);
2513
2514int mmc_card_sleep(struct mmc_host *host)
2515{
2516 int err = -ENOSYS;
2517
2518 if (host->caps2 & MMC_CAP2_NO_SLEEP_CMD)
2519 return 0;
2520
2521 mmc_bus_get(host);
2522
2523 if (host->bus_ops && !host->bus_dead && host->bus_ops->sleep)
2524 err = host->bus_ops->sleep(host);
2525
2526 mmc_bus_put(host);
2527
2528 return err;
2529}
2530EXPORT_SYMBOL(mmc_card_sleep);
2531
2532int mmc_card_can_sleep(struct mmc_host *host)
2533{
2534 struct mmc_card *card = host->card;
2535
2536 if (card && mmc_card_mmc(card) && card->ext_csd.rev >= 3)
2537 return 1;
2538 return 0;
2539}
2540EXPORT_SYMBOL(mmc_card_can_sleep);
2541
2542
2543
2544
2545int mmc_flush_cache(struct mmc_card *card)
2546{
2547 struct mmc_host *host = card->host;
2548 int err = 0;
2549
2550 if (!(host->caps2 & MMC_CAP2_CACHE_CTRL))
2551 return err;
2552
2553 if (mmc_card_mmc(card) &&
2554 (card->ext_csd.cache_size > 0) &&
2555 (card->ext_csd.cache_ctrl & 1)) {
2556 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
2557 EXT_CSD_FLUSH_CACHE, 1, 0);
2558 if (err)
2559 pr_err("%s: cache flush error %d\n",
2560 mmc_hostname(card->host), err);
2561 }
2562
2563 return err;
2564}
2565EXPORT_SYMBOL(mmc_flush_cache);
2566
2567
2568
2569
2570
2571
2572
2573int mmc_cache_ctrl(struct mmc_host *host, u8 enable)
2574{
2575 struct mmc_card *card = host->card;
2576 unsigned int timeout;
2577 int err = 0;
2578
2579 if (!(host->caps2 & MMC_CAP2_CACHE_CTRL) ||
2580 mmc_card_is_removable(host))
2581 return err;
2582
2583 if (card && mmc_card_mmc(card) &&
2584 (card->ext_csd.cache_size > 0)) {
2585 enable = !!enable;
2586
2587 if (card->ext_csd.cache_ctrl ^ enable) {
2588 timeout = enable ? card->ext_csd.generic_cmd6_time : 0;
2589 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
2590 EXT_CSD_CACHE_CTRL, enable, timeout);
2591 if (err)
2592 pr_err("%s: cache %s error %d\n",
2593 mmc_hostname(card->host),
2594 enable ? "on" : "off",
2595 err);
2596 else
2597 card->ext_csd.cache_ctrl = enable;
2598 }
2599 }
2600
2601 return err;
2602}
2603EXPORT_SYMBOL(mmc_cache_ctrl);
2604
2605#ifdef CONFIG_PM
2606
2607
2608
2609
2610
2611int mmc_suspend_host(struct mmc_host *host)
2612{
2613 int err = 0;
2614
2615 cancel_delayed_work(&host->detect);
2616 mmc_flush_scheduled_work();
2617
2618 mmc_bus_get(host);
2619 if (host->bus_ops && !host->bus_dead) {
2620 if (host->bus_ops->suspend) {
2621 if (mmc_card_doing_bkops(host->card)) {
2622 err = mmc_stop_bkops(host->card);
2623 if (err)
2624 goto out;
2625 }
2626 err = host->bus_ops->suspend(host);
2627 }
2628
2629 if (err == -ENOSYS || !host->bus_ops->resume) {
2630
2631
2632
2633
2634
2635
2636 if (host->bus_ops->remove)
2637 host->bus_ops->remove(host);
2638 mmc_claim_host(host);
2639 mmc_detach_bus(host);
2640 mmc_power_off(host);
2641 mmc_release_host(host);
2642 host->pm_flags = 0;
2643 err = 0;
2644 }
2645 }
2646 mmc_bus_put(host);
2647
2648 if (!err && !mmc_card_keep_power(host))
2649 mmc_power_off(host);
2650
2651out:
2652 return err;
2653}
2654
2655EXPORT_SYMBOL(mmc_suspend_host);
2656
2657
2658
2659
2660
2661int mmc_resume_host(struct mmc_host *host)
2662{
2663 int err = 0;
2664
2665 mmc_bus_get(host);
2666 if (host->bus_ops && !host->bus_dead) {
2667 if (!mmc_card_keep_power(host)) {
2668 mmc_power_up(host);
2669 mmc_select_voltage(host, host->ocr);
2670
2671
2672
2673
2674
2675
2676 if (mmc_card_sdio(host->card) &&
2677 (host->caps & MMC_CAP_POWER_OFF_CARD)) {
2678 pm_runtime_disable(&host->card->dev);
2679 pm_runtime_set_active(&host->card->dev);
2680 pm_runtime_enable(&host->card->dev);
2681 }
2682 }
2683 BUG_ON(!host->bus_ops->resume);
2684 err = host->bus_ops->resume(host);
2685 if (err) {
2686 pr_warning("%s: error %d during resume "
2687 "(card was removed?)\n",
2688 mmc_hostname(host), err);
2689 err = 0;
2690 }
2691 }
2692 host->pm_flags &= ~MMC_PM_KEEP_POWER;
2693 mmc_bus_put(host);
2694
2695 return err;
2696}
2697EXPORT_SYMBOL(mmc_resume_host);
2698
2699
2700
2701
2702
2703int mmc_pm_notify(struct notifier_block *notify_block,
2704 unsigned long mode, void *unused)
2705{
2706 struct mmc_host *host = container_of(
2707 notify_block, struct mmc_host, pm_notify);
2708 unsigned long flags;
2709 int err = 0;
2710
2711 switch (mode) {
2712 case PM_HIBERNATION_PREPARE:
2713 case PM_SUSPEND_PREPARE:
2714 if (host->card && mmc_card_mmc(host->card) &&
2715 mmc_card_doing_bkops(host->card)) {
2716 err = mmc_stop_bkops(host->card);
2717 if (err) {
2718 pr_err("%s: didn't stop bkops\n",
2719 mmc_hostname(host));
2720 return err;
2721 }
2722 mmc_card_clr_doing_bkops(host->card);
2723 }
2724
2725 spin_lock_irqsave(&host->lock, flags);
2726 host->rescan_disable = 1;
2727 spin_unlock_irqrestore(&host->lock, flags);
2728 cancel_delayed_work_sync(&host->detect);
2729
2730 if (!host->bus_ops || host->bus_ops->suspend)
2731 break;
2732
2733
2734 if (host->bus_ops->remove)
2735 host->bus_ops->remove(host);
2736
2737 mmc_claim_host(host);
2738 mmc_detach_bus(host);
2739 mmc_power_off(host);
2740 mmc_release_host(host);
2741 host->pm_flags = 0;
2742 break;
2743
2744 case PM_POST_SUSPEND:
2745 case PM_POST_HIBERNATION:
2746 case PM_POST_RESTORE:
2747
2748 spin_lock_irqsave(&host->lock, flags);
2749 host->rescan_disable = 0;
2750 spin_unlock_irqrestore(&host->lock, flags);
2751 mmc_detect_change(host, 0);
2752
2753 }
2754
2755 return 0;
2756}
2757#endif
2758
2759
2760
2761
2762
2763
2764
2765
2766
2767void mmc_init_context_info(struct mmc_host *host)
2768{
2769 spin_lock_init(&host->context_info.lock);
2770 host->context_info.is_new_req = false;
2771 host->context_info.is_done_rcv = false;
2772 host->context_info.is_waiting_last_req = false;
2773 init_waitqueue_head(&host->context_info.wait);
2774}
2775
2776static int __init mmc_init(void)
2777{
2778 int ret;
2779
2780 workqueue = alloc_ordered_workqueue("kmmcd", 0);
2781 if (!workqueue)
2782 return -ENOMEM;
2783
2784 ret = mmc_register_bus();
2785 if (ret)
2786 goto destroy_workqueue;
2787
2788 ret = mmc_register_host_class();
2789 if (ret)
2790 goto unregister_bus;
2791
2792 ret = sdio_register_bus();
2793 if (ret)
2794 goto unregister_host_class;
2795
2796 return 0;
2797
2798unregister_host_class:
2799 mmc_unregister_host_class();
2800unregister_bus:
2801 mmc_unregister_bus();
2802destroy_workqueue:
2803 destroy_workqueue(workqueue);
2804
2805 return ret;
2806}
2807
2808static void __exit mmc_exit(void)
2809{
2810 sdio_unregister_bus();
2811 mmc_unregister_host_class();
2812 mmc_unregister_bus();
2813 destroy_workqueue(workqueue);
2814}
2815
2816subsys_initcall(mmc_init);
2817module_exit(mmc_exit);
2818
2819MODULE_LICENSE("GPL");
2820