1
2
3
4
5
6
7
8
9
10
11
12#include <linux/slab.h>
13#include <linux/export.h>
14#include <linux/types.h>
15#include <linux/scatterlist.h>
16
17#include <linux/mmc/host.h>
18#include <linux/mmc/card.h>
19#include <linux/mmc/mmc.h>
20
21#include "core.h"
22#include "host.h"
23#include "mmc_ops.h"
24
25#define MMC_OPS_TIMEOUT_MS (10 * 60 * 1000)
26
27static const u8 tuning_blk_pattern_4bit[] = {
28 0xff, 0x0f, 0xff, 0x00, 0xff, 0xcc, 0xc3, 0xcc,
29 0xc3, 0x3c, 0xcc, 0xff, 0xfe, 0xff, 0xfe, 0xef,
30 0xff, 0xdf, 0xff, 0xdd, 0xff, 0xfb, 0xff, 0xfb,
31 0xbf, 0xff, 0x7f, 0xff, 0x77, 0xf7, 0xbd, 0xef,
32 0xff, 0xf0, 0xff, 0xf0, 0x0f, 0xfc, 0xcc, 0x3c,
33 0xcc, 0x33, 0xcc, 0xcf, 0xff, 0xef, 0xff, 0xee,
34 0xff, 0xfd, 0xff, 0xfd, 0xdf, 0xff, 0xbf, 0xff,
35 0xbb, 0xff, 0xf7, 0xff, 0xf7, 0x7f, 0x7b, 0xde,
36};
37
38static const u8 tuning_blk_pattern_8bit[] = {
39 0xff, 0xff, 0x00, 0xff, 0xff, 0xff, 0x00, 0x00,
40 0xff, 0xff, 0xcc, 0xcc, 0xcc, 0x33, 0xcc, 0xcc,
41 0xcc, 0x33, 0x33, 0xcc, 0xcc, 0xcc, 0xff, 0xff,
42 0xff, 0xee, 0xff, 0xff, 0xff, 0xee, 0xee, 0xff,
43 0xff, 0xff, 0xdd, 0xff, 0xff, 0xff, 0xdd, 0xdd,
44 0xff, 0xff, 0xff, 0xbb, 0xff, 0xff, 0xff, 0xbb,
45 0xbb, 0xff, 0xff, 0xff, 0x77, 0xff, 0xff, 0xff,
46 0x77, 0x77, 0xff, 0x77, 0xbb, 0xdd, 0xee, 0xff,
47 0xff, 0xff, 0xff, 0x00, 0xff, 0xff, 0xff, 0x00,
48 0x00, 0xff, 0xff, 0xcc, 0xcc, 0xcc, 0x33, 0xcc,
49 0xcc, 0xcc, 0x33, 0x33, 0xcc, 0xcc, 0xcc, 0xff,
50 0xff, 0xff, 0xee, 0xff, 0xff, 0xff, 0xee, 0xee,
51 0xff, 0xff, 0xff, 0xdd, 0xff, 0xff, 0xff, 0xdd,
52 0xdd, 0xff, 0xff, 0xff, 0xbb, 0xff, 0xff, 0xff,
53 0xbb, 0xbb, 0xff, 0xff, 0xff, 0x77, 0xff, 0xff,
54 0xff, 0x77, 0x77, 0xff, 0x77, 0xbb, 0xdd, 0xee,
55};
56
57static inline int __mmc_send_status(struct mmc_card *card, u32 *status,
58 bool ignore_crc)
59{
60 int err;
61 struct mmc_command cmd = {0};
62
63 BUG_ON(!card);
64 BUG_ON(!card->host);
65
66 cmd.opcode = MMC_SEND_STATUS;
67 if (!mmc_host_is_spi(card->host))
68 cmd.arg = card->rca << 16;
69 cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_AC;
70 if (ignore_crc)
71 cmd.flags &= ~MMC_RSP_CRC;
72
73 err = mmc_wait_for_cmd(card->host, &cmd, MMC_CMD_RETRIES);
74 if (err)
75 return err;
76
77
78
79
80 if (status)
81 *status = cmd.resp[0];
82
83 return 0;
84}
85
86int mmc_send_status(struct mmc_card *card, u32 *status)
87{
88 return __mmc_send_status(card, status, false);
89}
90
91static int _mmc_select_card(struct mmc_host *host, struct mmc_card *card)
92{
93 int err;
94 struct mmc_command cmd = {0};
95
96 BUG_ON(!host);
97
98 cmd.opcode = MMC_SELECT_CARD;
99
100 if (card) {
101 cmd.arg = card->rca << 16;
102 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
103 } else {
104 cmd.arg = 0;
105 cmd.flags = MMC_RSP_NONE | MMC_CMD_AC;
106 }
107
108 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
109 if (err)
110 return err;
111
112 return 0;
113}
114
115int mmc_select_card(struct mmc_card *card)
116{
117 BUG_ON(!card);
118
119 return _mmc_select_card(card->host, card);
120}
121
122int mmc_deselect_cards(struct mmc_host *host)
123{
124 return _mmc_select_card(host, NULL);
125}
126
127
128
129
130
131
132
133
134
135int mmc_set_dsr(struct mmc_host *host)
136{
137 struct mmc_command cmd = {0};
138
139 cmd.opcode = MMC_SET_DSR;
140
141 cmd.arg = (host->dsr << 16) | 0xffff;
142 cmd.flags = MMC_RSP_NONE | MMC_CMD_AC;
143
144 return mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
145}
146
147int mmc_go_idle(struct mmc_host *host)
148{
149 int err;
150 struct mmc_command cmd = {0};
151
152
153
154
155
156
157
158
159
160
161 if (!mmc_host_is_spi(host)) {
162 mmc_set_chip_select(host, MMC_CS_HIGH);
163 mmc_delay(1);
164 }
165
166 cmd.opcode = MMC_GO_IDLE_STATE;
167 cmd.arg = 0;
168 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_NONE | MMC_CMD_BC;
169
170 err = mmc_wait_for_cmd(host, &cmd, 0);
171
172 mmc_delay(1);
173
174 if (!mmc_host_is_spi(host)) {
175 mmc_set_chip_select(host, MMC_CS_DONTCARE);
176 mmc_delay(1);
177 }
178
179 host->use_spi_crc = 0;
180
181 return err;
182}
183
184int mmc_send_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
185{
186 struct mmc_command cmd = {0};
187 int i, err = 0;
188
189 BUG_ON(!host);
190
191 cmd.opcode = MMC_SEND_OP_COND;
192 cmd.arg = mmc_host_is_spi(host) ? 0 : ocr;
193 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R3 | MMC_CMD_BCR;
194
195 for (i = 100; i; i--) {
196 err = mmc_wait_for_cmd(host, &cmd, 0);
197 if (err)
198 break;
199
200
201 if (ocr == 0)
202 break;
203
204
205 if (mmc_host_is_spi(host)) {
206 if (!(cmd.resp[0] & R1_SPI_IDLE))
207 break;
208 } else {
209 if (cmd.resp[0] & MMC_CARD_BUSY)
210 break;
211 }
212
213 err = -ETIMEDOUT;
214
215 mmc_delay(10);
216 }
217
218 if (rocr && !mmc_host_is_spi(host))
219 *rocr = cmd.resp[0];
220
221 return err;
222}
223
224int mmc_all_send_cid(struct mmc_host *host, u32 *cid)
225{
226 int err;
227 struct mmc_command cmd = {0};
228
229 BUG_ON(!host);
230 BUG_ON(!cid);
231
232 cmd.opcode = MMC_ALL_SEND_CID;
233 cmd.arg = 0;
234 cmd.flags = MMC_RSP_R2 | MMC_CMD_BCR;
235
236 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
237 if (err)
238 return err;
239
240 memcpy(cid, cmd.resp, sizeof(u32) * 4);
241
242 return 0;
243}
244
245int mmc_set_relative_addr(struct mmc_card *card)
246{
247 int err;
248 struct mmc_command cmd = {0};
249
250 BUG_ON(!card);
251 BUG_ON(!card->host);
252
253 cmd.opcode = MMC_SET_RELATIVE_ADDR;
254 cmd.arg = card->rca << 16;
255 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
256
257 err = mmc_wait_for_cmd(card->host, &cmd, MMC_CMD_RETRIES);
258 if (err)
259 return err;
260
261 return 0;
262}
263
264static int
265mmc_send_cxd_native(struct mmc_host *host, u32 arg, u32 *cxd, int opcode)
266{
267 int err;
268 struct mmc_command cmd = {0};
269
270 BUG_ON(!host);
271 BUG_ON(!cxd);
272
273 cmd.opcode = opcode;
274 cmd.arg = arg;
275 cmd.flags = MMC_RSP_R2 | MMC_CMD_AC;
276
277 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
278 if (err)
279 return err;
280
281 memcpy(cxd, cmd.resp, sizeof(u32) * 4);
282
283 return 0;
284}
285
286
287
288
289
290static int
291mmc_send_cxd_data(struct mmc_card *card, struct mmc_host *host,
292 u32 opcode, void *buf, unsigned len)
293{
294 struct mmc_request mrq = {NULL};
295 struct mmc_command cmd = {0};
296 struct mmc_data data = {0};
297 struct scatterlist sg;
298
299 mrq.cmd = &cmd;
300 mrq.data = &data;
301
302 cmd.opcode = opcode;
303 cmd.arg = 0;
304
305
306
307
308
309
310 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
311
312 data.blksz = len;
313 data.blocks = 1;
314 data.flags = MMC_DATA_READ;
315 data.sg = &sg;
316 data.sg_len = 1;
317
318 sg_init_one(&sg, buf, len);
319
320 if (opcode == MMC_SEND_CSD || opcode == MMC_SEND_CID) {
321
322
323
324
325 data.timeout_ns = 0;
326 data.timeout_clks = 64;
327 } else
328 mmc_set_data_timeout(&data, card);
329
330 mmc_wait_for_req(host, &mrq);
331
332 if (cmd.error)
333 return cmd.error;
334 if (data.error)
335 return data.error;
336
337 return 0;
338}
339
340int mmc_send_csd(struct mmc_card *card, u32 *csd)
341{
342 int ret, i;
343 u32 *csd_tmp;
344
345 if (!mmc_host_is_spi(card->host))
346 return mmc_send_cxd_native(card->host, card->rca << 16,
347 csd, MMC_SEND_CSD);
348
349 csd_tmp = kzalloc(16, GFP_KERNEL);
350 if (!csd_tmp)
351 return -ENOMEM;
352
353 ret = mmc_send_cxd_data(card, card->host, MMC_SEND_CSD, csd_tmp, 16);
354 if (ret)
355 goto err;
356
357 for (i = 0;i < 4;i++)
358 csd[i] = be32_to_cpu(csd_tmp[i]);
359
360err:
361 kfree(csd_tmp);
362 return ret;
363}
364
365int mmc_send_cid(struct mmc_host *host, u32 *cid)
366{
367 int ret, i;
368 u32 *cid_tmp;
369
370 if (!mmc_host_is_spi(host)) {
371 if (!host->card)
372 return -EINVAL;
373 return mmc_send_cxd_native(host, host->card->rca << 16,
374 cid, MMC_SEND_CID);
375 }
376
377 cid_tmp = kzalloc(16, GFP_KERNEL);
378 if (!cid_tmp)
379 return -ENOMEM;
380
381 ret = mmc_send_cxd_data(NULL, host, MMC_SEND_CID, cid_tmp, 16);
382 if (ret)
383 goto err;
384
385 for (i = 0;i < 4;i++)
386 cid[i] = be32_to_cpu(cid_tmp[i]);
387
388err:
389 kfree(cid_tmp);
390 return ret;
391}
392
393int mmc_get_ext_csd(struct mmc_card *card, u8 **new_ext_csd)
394{
395 int err;
396 u8 *ext_csd;
397
398 if (!card || !new_ext_csd)
399 return -EINVAL;
400
401 if (!mmc_can_ext_csd(card))
402 return -EOPNOTSUPP;
403
404
405
406
407
408 ext_csd = kzalloc(512, GFP_KERNEL);
409 if (!ext_csd)
410 return -ENOMEM;
411
412 err = mmc_send_cxd_data(card, card->host, MMC_SEND_EXT_CSD, ext_csd,
413 512);
414 if (err)
415 kfree(ext_csd);
416 else
417 *new_ext_csd = ext_csd;
418
419 return err;
420}
421EXPORT_SYMBOL_GPL(mmc_get_ext_csd);
422
423int mmc_spi_read_ocr(struct mmc_host *host, int highcap, u32 *ocrp)
424{
425 struct mmc_command cmd = {0};
426 int err;
427
428 cmd.opcode = MMC_SPI_READ_OCR;
429 cmd.arg = highcap ? (1 << 30) : 0;
430 cmd.flags = MMC_RSP_SPI_R3;
431
432 err = mmc_wait_for_cmd(host, &cmd, 0);
433
434 *ocrp = cmd.resp[1];
435 return err;
436}
437
438int mmc_spi_set_crc(struct mmc_host *host, int use_crc)
439{
440 struct mmc_command cmd = {0};
441 int err;
442
443 cmd.opcode = MMC_SPI_CRC_ON_OFF;
444 cmd.flags = MMC_RSP_SPI_R1;
445 cmd.arg = use_crc;
446
447 err = mmc_wait_for_cmd(host, &cmd, 0);
448 if (!err)
449 host->use_spi_crc = use_crc;
450 return err;
451}
452
453int mmc_switch_status_error(struct mmc_host *host, u32 status)
454{
455 if (mmc_host_is_spi(host)) {
456 if (status & R1_SPI_ILLEGAL_COMMAND)
457 return -EBADMSG;
458 } else {
459 if (status & 0xFDFFA000)
460 pr_warn("%s: unexpected status %#x after switch\n",
461 mmc_hostname(host), status);
462 if (status & R1_SWITCH_ERROR)
463 return -EBADMSG;
464 }
465 return 0;
466}
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482int __mmc_switch(struct mmc_card *card, u8 set, u8 index, u8 value,
483 unsigned int timeout_ms, bool use_busy_signal, bool send_status,
484 bool ignore_crc)
485{
486 struct mmc_host *host = card->host;
487 int err;
488 struct mmc_command cmd = {0};
489 unsigned long timeout;
490 u32 status = 0;
491 bool use_r1b_resp = use_busy_signal;
492 bool expired = false;
493
494 mmc_retune_hold(host);
495
496
497
498
499
500
501
502 if (timeout_ms && host->max_busy_timeout &&
503 (timeout_ms > host->max_busy_timeout))
504 use_r1b_resp = false;
505
506 cmd.opcode = MMC_SWITCH;
507 cmd.arg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
508 (index << 16) |
509 (value << 8) |
510 set;
511 cmd.flags = MMC_CMD_AC;
512 if (use_r1b_resp) {
513 cmd.flags |= MMC_RSP_SPI_R1B | MMC_RSP_R1B;
514
515
516
517
518 cmd.busy_timeout = timeout_ms;
519 } else {
520 cmd.flags |= MMC_RSP_SPI_R1 | MMC_RSP_R1;
521 }
522
523 if (index == EXT_CSD_SANITIZE_START)
524 cmd.sanitize_busy = true;
525
526 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
527 if (err)
528 goto out;
529
530
531 if (!use_busy_signal)
532 goto out;
533
534
535
536
537
538 if ((host->caps & MMC_CAP_WAIT_WHILE_BUSY) && use_r1b_resp)
539 ignore_crc = false;
540
541
542 if (!timeout_ms)
543 timeout_ms = MMC_OPS_TIMEOUT_MS;
544
545
546 timeout = jiffies + msecs_to_jiffies(timeout_ms);
547 do {
548 if (send_status) {
549
550
551
552
553
554 expired = time_after(jiffies, timeout);
555 err = __mmc_send_status(card, &status, ignore_crc);
556 if (err)
557 goto out;
558 }
559 if ((host->caps & MMC_CAP_WAIT_WHILE_BUSY) && use_r1b_resp)
560 break;
561 if (mmc_host_is_spi(host))
562 break;
563
564
565
566
567
568
569 if (!send_status) {
570 mmc_delay(timeout_ms);
571 goto out;
572 }
573
574
575 if (expired && R1_CURRENT_STATE(status) == R1_STATE_PRG) {
576 pr_err("%s: Card stuck in programming state! %s\n",
577 mmc_hostname(host), __func__);
578 err = -ETIMEDOUT;
579 goto out;
580 }
581 } while (R1_CURRENT_STATE(status) == R1_STATE_PRG);
582
583 err = mmc_switch_status_error(host, status);
584out:
585 mmc_retune_release(host);
586
587 return err;
588}
589
590int mmc_switch(struct mmc_card *card, u8 set, u8 index, u8 value,
591 unsigned int timeout_ms)
592{
593 return __mmc_switch(card, set, index, value, timeout_ms, true, true,
594 false);
595}
596EXPORT_SYMBOL_GPL(mmc_switch);
597
598int mmc_send_tuning(struct mmc_host *host, u32 opcode, int *cmd_error)
599{
600 struct mmc_request mrq = {NULL};
601 struct mmc_command cmd = {0};
602 struct mmc_data data = {0};
603 struct scatterlist sg;
604 struct mmc_ios *ios = &host->ios;
605 const u8 *tuning_block_pattern;
606 int size, err = 0;
607 u8 *data_buf;
608
609 if (ios->bus_width == MMC_BUS_WIDTH_8) {
610 tuning_block_pattern = tuning_blk_pattern_8bit;
611 size = sizeof(tuning_blk_pattern_8bit);
612 } else if (ios->bus_width == MMC_BUS_WIDTH_4) {
613 tuning_block_pattern = tuning_blk_pattern_4bit;
614 size = sizeof(tuning_blk_pattern_4bit);
615 } else
616 return -EINVAL;
617
618 data_buf = kzalloc(size, GFP_KERNEL);
619 if (!data_buf)
620 return -ENOMEM;
621
622 mrq.cmd = &cmd;
623 mrq.data = &data;
624
625 cmd.opcode = opcode;
626 cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC;
627
628 data.blksz = size;
629 data.blocks = 1;
630 data.flags = MMC_DATA_READ;
631
632
633
634
635
636
637 data.timeout_ns = 150 * NSEC_PER_MSEC;
638
639 data.sg = &sg;
640 data.sg_len = 1;
641 sg_init_one(&sg, data_buf, size);
642
643 mmc_wait_for_req(host, &mrq);
644
645 if (cmd_error)
646 *cmd_error = cmd.error;
647
648 if (cmd.error) {
649 err = cmd.error;
650 goto out;
651 }
652
653 if (data.error) {
654 err = data.error;
655 goto out;
656 }
657
658 if (memcmp(data_buf, tuning_block_pattern, size))
659 err = -EIO;
660
661out:
662 kfree(data_buf);
663 return err;
664}
665EXPORT_SYMBOL_GPL(mmc_send_tuning);
666
667static int
668mmc_send_bus_test(struct mmc_card *card, struct mmc_host *host, u8 opcode,
669 u8 len)
670{
671 struct mmc_request mrq = {NULL};
672 struct mmc_command cmd = {0};
673 struct mmc_data data = {0};
674 struct scatterlist sg;
675 u8 *data_buf;
676 u8 *test_buf;
677 int i, err;
678 static u8 testdata_8bit[8] = { 0x55, 0xaa, 0, 0, 0, 0, 0, 0 };
679 static u8 testdata_4bit[4] = { 0x5a, 0, 0, 0 };
680
681
682
683
684 data_buf = kmalloc(len, GFP_KERNEL);
685 if (!data_buf)
686 return -ENOMEM;
687
688 if (len == 8)
689 test_buf = testdata_8bit;
690 else if (len == 4)
691 test_buf = testdata_4bit;
692 else {
693 pr_err("%s: Invalid bus_width %d\n",
694 mmc_hostname(host), len);
695 kfree(data_buf);
696 return -EINVAL;
697 }
698
699 if (opcode == MMC_BUS_TEST_W)
700 memcpy(data_buf, test_buf, len);
701
702 mrq.cmd = &cmd;
703 mrq.data = &data;
704 cmd.opcode = opcode;
705 cmd.arg = 0;
706
707
708
709
710
711
712 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
713
714 data.blksz = len;
715 data.blocks = 1;
716 if (opcode == MMC_BUS_TEST_R)
717 data.flags = MMC_DATA_READ;
718 else
719 data.flags = MMC_DATA_WRITE;
720
721 data.sg = &sg;
722 data.sg_len = 1;
723 mmc_set_data_timeout(&data, card);
724 sg_init_one(&sg, data_buf, len);
725 mmc_wait_for_req(host, &mrq);
726 err = 0;
727 if (opcode == MMC_BUS_TEST_R) {
728 for (i = 0; i < len / 4; i++)
729 if ((test_buf[i] ^ data_buf[i]) != 0xff) {
730 err = -EIO;
731 break;
732 }
733 }
734 kfree(data_buf);
735
736 if (cmd.error)
737 return cmd.error;
738 if (data.error)
739 return data.error;
740
741 return err;
742}
743
744int mmc_bus_test(struct mmc_card *card, u8 bus_width)
745{
746 int err, width;
747
748 if (bus_width == MMC_BUS_WIDTH_8)
749 width = 8;
750 else if (bus_width == MMC_BUS_WIDTH_4)
751 width = 4;
752 else if (bus_width == MMC_BUS_WIDTH_1)
753 return 0;
754 else
755 return -EINVAL;
756
757
758
759
760
761 mmc_send_bus_test(card, card->host, MMC_BUS_TEST_W, width);
762 err = mmc_send_bus_test(card, card->host, MMC_BUS_TEST_R, width);
763 return err;
764}
765
766int mmc_send_hpi_cmd(struct mmc_card *card, u32 *status)
767{
768 struct mmc_command cmd = {0};
769 unsigned int opcode;
770 int err;
771
772 if (!card->ext_csd.hpi) {
773 pr_warn("%s: Card didn't support HPI command\n",
774 mmc_hostname(card->host));
775 return -EINVAL;
776 }
777
778 opcode = card->ext_csd.hpi_cmd;
779 if (opcode == MMC_STOP_TRANSMISSION)
780 cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
781 else if (opcode == MMC_SEND_STATUS)
782 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
783
784 cmd.opcode = opcode;
785 cmd.arg = card->rca << 16 | 1;
786
787 err = mmc_wait_for_cmd(card->host, &cmd, 0);
788 if (err) {
789 pr_warn("%s: error %d interrupting operation. "
790 "HPI command response %#x\n", mmc_hostname(card->host),
791 err, cmd.resp[0]);
792 return err;
793 }
794 if (status)
795 *status = cmd.resp[0];
796
797 return 0;
798}
799
800int mmc_can_ext_csd(struct mmc_card *card)
801{
802 return (card && card->csd.mmca_vsn > CSD_SPEC_VER_3);
803}
804