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 "mmc_ops.h"
23
24#define MMC_OPS_TIMEOUT_MS (10 * 60 * 1000)
25
26static inline int __mmc_send_status(struct mmc_card *card, u32 *status,
27 bool ignore_crc)
28{
29 int err;
30 struct mmc_command cmd = {0};
31
32 BUG_ON(!card);
33 BUG_ON(!card->host);
34
35 cmd.opcode = MMC_SEND_STATUS;
36 if (!mmc_host_is_spi(card->host))
37 cmd.arg = card->rca << 16;
38 cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_AC;
39 if (ignore_crc)
40 cmd.flags &= ~MMC_RSP_CRC;
41
42 err = mmc_wait_for_cmd(card->host, &cmd, MMC_CMD_RETRIES);
43 if (err)
44 return err;
45
46
47
48
49 if (status)
50 *status = cmd.resp[0];
51
52 return 0;
53}
54
55int mmc_send_status(struct mmc_card *card, u32 *status)
56{
57 return __mmc_send_status(card, status, false);
58}
59
60static int _mmc_select_card(struct mmc_host *host, struct mmc_card *card)
61{
62 int err;
63 struct mmc_command cmd = {0};
64
65 BUG_ON(!host);
66
67 cmd.opcode = MMC_SELECT_CARD;
68
69 if (card) {
70 cmd.arg = card->rca << 16;
71 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
72 } else {
73 cmd.arg = 0;
74 cmd.flags = MMC_RSP_NONE | MMC_CMD_AC;
75 }
76
77 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
78 if (err)
79 return err;
80
81 return 0;
82}
83
84int mmc_select_card(struct mmc_card *card)
85{
86 BUG_ON(!card);
87
88 return _mmc_select_card(card->host, card);
89}
90
91int mmc_deselect_cards(struct mmc_host *host)
92{
93 return _mmc_select_card(host, NULL);
94}
95
96int mmc_go_idle(struct mmc_host *host)
97{
98 int err;
99 struct mmc_command cmd = {0};
100
101
102
103
104
105
106
107
108
109
110 if (!mmc_host_is_spi(host)) {
111 mmc_set_chip_select(host, MMC_CS_HIGH);
112 mmc_delay(1);
113 }
114
115 cmd.opcode = MMC_GO_IDLE_STATE;
116 cmd.arg = 0;
117 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_NONE | MMC_CMD_BC;
118
119 err = mmc_wait_for_cmd(host, &cmd, 0);
120
121 mmc_delay(1);
122
123 if (!mmc_host_is_spi(host)) {
124 mmc_set_chip_select(host, MMC_CS_DONTCARE);
125 mmc_delay(1);
126 }
127
128 host->use_spi_crc = 0;
129
130 return err;
131}
132
133int mmc_send_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr)
134{
135 struct mmc_command cmd = {0};
136 int i, err = 0;
137
138 BUG_ON(!host);
139
140 cmd.opcode = MMC_SEND_OP_COND;
141 cmd.arg = mmc_host_is_spi(host) ? 0 : ocr;
142 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R3 | MMC_CMD_BCR;
143
144 for (i = 100; i; i--) {
145 err = mmc_wait_for_cmd(host, &cmd, 0);
146 if (err)
147 break;
148
149
150 if (ocr == 0)
151 break;
152
153
154 if (mmc_host_is_spi(host)) {
155 if (!(cmd.resp[0] & R1_SPI_IDLE))
156 break;
157 } else {
158 if (cmd.resp[0] & MMC_CARD_BUSY)
159 break;
160 }
161
162 err = -ETIMEDOUT;
163
164 mmc_delay(10);
165 }
166
167 if (rocr && !mmc_host_is_spi(host))
168 *rocr = cmd.resp[0];
169
170 return err;
171}
172
173int mmc_all_send_cid(struct mmc_host *host, u32 *cid)
174{
175 int err;
176 struct mmc_command cmd = {0};
177
178 BUG_ON(!host);
179 BUG_ON(!cid);
180
181 cmd.opcode = MMC_ALL_SEND_CID;
182 cmd.arg = 0;
183 cmd.flags = MMC_RSP_R2 | MMC_CMD_BCR;
184
185 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
186 if (err)
187 return err;
188
189 memcpy(cid, cmd.resp, sizeof(u32) * 4);
190
191 return 0;
192}
193
194int mmc_set_relative_addr(struct mmc_card *card)
195{
196 int err;
197 struct mmc_command cmd = {0};
198
199 BUG_ON(!card);
200 BUG_ON(!card->host);
201
202 cmd.opcode = MMC_SET_RELATIVE_ADDR;
203 cmd.arg = card->rca << 16;
204 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
205
206 err = mmc_wait_for_cmd(card->host, &cmd, MMC_CMD_RETRIES);
207 if (err)
208 return err;
209
210 return 0;
211}
212
213static int
214mmc_send_cxd_native(struct mmc_host *host, u32 arg, u32 *cxd, int opcode)
215{
216 int err;
217 struct mmc_command cmd = {0};
218
219 BUG_ON(!host);
220 BUG_ON(!cxd);
221
222 cmd.opcode = opcode;
223 cmd.arg = arg;
224 cmd.flags = MMC_RSP_R2 | MMC_CMD_AC;
225
226 err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES);
227 if (err)
228 return err;
229
230 memcpy(cxd, cmd.resp, sizeof(u32) * 4);
231
232 return 0;
233}
234
235
236
237
238
239static int
240mmc_send_cxd_data(struct mmc_card *card, struct mmc_host *host,
241 u32 opcode, void *buf, unsigned len)
242{
243 struct mmc_request mrq = {NULL};
244 struct mmc_command cmd = {0};
245 struct mmc_data data = {0};
246 struct scatterlist sg;
247 void *data_buf;
248 int is_on_stack;
249
250 is_on_stack = object_is_on_stack(buf);
251 if (is_on_stack) {
252
253
254
255
256 data_buf = kmalloc(len, GFP_KERNEL);
257 if (!data_buf)
258 return -ENOMEM;
259 } else
260 data_buf = buf;
261
262 mrq.cmd = &cmd;
263 mrq.data = &data;
264
265 cmd.opcode = opcode;
266 cmd.arg = 0;
267
268
269
270
271
272
273 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
274
275 data.blksz = len;
276 data.blocks = 1;
277 data.flags = MMC_DATA_READ;
278 data.sg = &sg;
279 data.sg_len = 1;
280
281 sg_init_one(&sg, data_buf, len);
282
283 if (opcode == MMC_SEND_CSD || opcode == MMC_SEND_CID) {
284
285
286
287
288 data.timeout_ns = 0;
289 data.timeout_clks = 64;
290 } else
291 mmc_set_data_timeout(&data, card);
292
293 mmc_wait_for_req(host, &mrq);
294
295 if (is_on_stack) {
296 memcpy(buf, data_buf, len);
297 kfree(data_buf);
298 }
299
300 if (cmd.error)
301 return cmd.error;
302 if (data.error)
303 return data.error;
304
305 return 0;
306}
307
308int mmc_send_csd(struct mmc_card *card, u32 *csd)
309{
310 int ret, i;
311 u32 *csd_tmp;
312
313 if (!mmc_host_is_spi(card->host))
314 return mmc_send_cxd_native(card->host, card->rca << 16,
315 csd, MMC_SEND_CSD);
316
317 csd_tmp = kmalloc(16, GFP_KERNEL);
318 if (!csd_tmp)
319 return -ENOMEM;
320
321 ret = mmc_send_cxd_data(card, card->host, MMC_SEND_CSD, csd_tmp, 16);
322 if (ret)
323 goto err;
324
325 for (i = 0;i < 4;i++)
326 csd[i] = be32_to_cpu(csd_tmp[i]);
327
328err:
329 kfree(csd_tmp);
330 return ret;
331}
332
333int mmc_send_cid(struct mmc_host *host, u32 *cid)
334{
335 int ret, i;
336 u32 *cid_tmp;
337
338 if (!mmc_host_is_spi(host)) {
339 if (!host->card)
340 return -EINVAL;
341 return mmc_send_cxd_native(host, host->card->rca << 16,
342 cid, MMC_SEND_CID);
343 }
344
345 cid_tmp = kmalloc(16, GFP_KERNEL);
346 if (!cid_tmp)
347 return -ENOMEM;
348
349 ret = mmc_send_cxd_data(NULL, host, MMC_SEND_CID, cid_tmp, 16);
350 if (ret)
351 goto err;
352
353 for (i = 0;i < 4;i++)
354 cid[i] = be32_to_cpu(cid_tmp[i]);
355
356err:
357 kfree(cid_tmp);
358 return ret;
359}
360
361int mmc_send_ext_csd(struct mmc_card *card, u8 *ext_csd)
362{
363 return mmc_send_cxd_data(card, card->host, MMC_SEND_EXT_CSD,
364 ext_csd, 512);
365}
366EXPORT_SYMBOL_GPL(mmc_send_ext_csd);
367
368int mmc_spi_read_ocr(struct mmc_host *host, int highcap, u32 *ocrp)
369{
370 struct mmc_command cmd = {0};
371 int err;
372
373 cmd.opcode = MMC_SPI_READ_OCR;
374 cmd.arg = highcap ? (1 << 30) : 0;
375 cmd.flags = MMC_RSP_SPI_R3;
376
377 err = mmc_wait_for_cmd(host, &cmd, 0);
378
379 *ocrp = cmd.resp[1];
380 return err;
381}
382
383int mmc_spi_set_crc(struct mmc_host *host, int use_crc)
384{
385 struct mmc_command cmd = {0};
386 int err;
387
388 cmd.opcode = MMC_SPI_CRC_ON_OFF;
389 cmd.flags = MMC_RSP_SPI_R1;
390 cmd.arg = use_crc;
391
392 err = mmc_wait_for_cmd(host, &cmd, 0);
393 if (!err)
394 host->use_spi_crc = use_crc;
395 return err;
396}
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411int __mmc_switch(struct mmc_card *card, u8 set, u8 index, u8 value,
412 unsigned int timeout_ms, bool use_busy_signal, bool send_status)
413{
414 int err;
415 struct mmc_command cmd = {0};
416 unsigned long timeout;
417 u32 status = 0;
418 bool ignore_crc = false;
419
420 BUG_ON(!card);
421 BUG_ON(!card->host);
422
423 cmd.opcode = MMC_SWITCH;
424 cmd.arg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
425 (index << 16) |
426 (value << 8) |
427 set;
428 cmd.flags = MMC_CMD_AC;
429 if (use_busy_signal)
430 cmd.flags |= MMC_RSP_SPI_R1B | MMC_RSP_R1B;
431 else
432 cmd.flags |= MMC_RSP_SPI_R1 | MMC_RSP_R1;
433
434
435 cmd.cmd_timeout_ms = timeout_ms;
436 if (index == EXT_CSD_SANITIZE_START)
437 cmd.sanitize_busy = true;
438
439 err = mmc_wait_for_cmd(card->host, &cmd, MMC_CMD_RETRIES);
440 if (err)
441 return err;
442
443
444 if (!use_busy_signal)
445 return 0;
446
447
448
449
450
451
452 if (index == EXT_CSD_HS_TIMING &&
453 !(card->host->caps & MMC_CAP_WAIT_WHILE_BUSY))
454 ignore_crc = true;
455
456 timeout = jiffies + msecs_to_jiffies(MMC_OPS_TIMEOUT_MS);
457 do {
458 if (send_status) {
459 err = __mmc_send_status(card, &status, ignore_crc);
460 if (err)
461 return err;
462 }
463 if (card->host->caps & MMC_CAP_WAIT_WHILE_BUSY)
464 break;
465 if (mmc_host_is_spi(card->host))
466 break;
467
468
469
470
471
472
473 if (!send_status) {
474 mmc_delay(timeout_ms);
475 return 0;
476 }
477
478
479 if (time_after(jiffies, timeout)) {
480 pr_err("%s: Card stuck in programming state! %s\n",
481 mmc_hostname(card->host), __func__);
482 return -ETIMEDOUT;
483 }
484 } while (R1_CURRENT_STATE(status) == R1_STATE_PRG);
485
486 if (mmc_host_is_spi(card->host)) {
487 if (status & R1_SPI_ILLEGAL_COMMAND)
488 return -EBADMSG;
489 } else {
490 if (status & 0xFDFFA000)
491 pr_warning("%s: unexpected status %#x after "
492 "switch", mmc_hostname(card->host), status);
493 if (status & R1_SWITCH_ERROR)
494 return -EBADMSG;
495 }
496
497 return 0;
498}
499EXPORT_SYMBOL_GPL(__mmc_switch);
500
501int mmc_switch(struct mmc_card *card, u8 set, u8 index, u8 value,
502 unsigned int timeout_ms)
503{
504 return __mmc_switch(card, set, index, value, timeout_ms, true, true);
505}
506EXPORT_SYMBOL_GPL(mmc_switch);
507
508static int
509mmc_send_bus_test(struct mmc_card *card, struct mmc_host *host, u8 opcode,
510 u8 len)
511{
512 struct mmc_request mrq = {NULL};
513 struct mmc_command cmd = {0};
514 struct mmc_data data = {0};
515 struct scatterlist sg;
516 u8 *data_buf;
517 u8 *test_buf;
518 int i, err;
519 static u8 testdata_8bit[8] = { 0x55, 0xaa, 0, 0, 0, 0, 0, 0 };
520 static u8 testdata_4bit[4] = { 0x5a, 0, 0, 0 };
521
522
523
524
525 data_buf = kmalloc(len, GFP_KERNEL);
526 if (!data_buf)
527 return -ENOMEM;
528
529 if (len == 8)
530 test_buf = testdata_8bit;
531 else if (len == 4)
532 test_buf = testdata_4bit;
533 else {
534 pr_err("%s: Invalid bus_width %d\n",
535 mmc_hostname(host), len);
536 kfree(data_buf);
537 return -EINVAL;
538 }
539
540 if (opcode == MMC_BUS_TEST_W)
541 memcpy(data_buf, test_buf, len);
542
543 mrq.cmd = &cmd;
544 mrq.data = &data;
545 cmd.opcode = opcode;
546 cmd.arg = 0;
547
548
549
550
551
552
553 cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
554
555 data.blksz = len;
556 data.blocks = 1;
557 if (opcode == MMC_BUS_TEST_R)
558 data.flags = MMC_DATA_READ;
559 else
560 data.flags = MMC_DATA_WRITE;
561
562 data.sg = &sg;
563 data.sg_len = 1;
564 mmc_set_data_timeout(&data, card);
565 sg_init_one(&sg, data_buf, len);
566 mmc_wait_for_req(host, &mrq);
567 err = 0;
568 if (opcode == MMC_BUS_TEST_R) {
569 for (i = 0; i < len / 4; i++)
570 if ((test_buf[i] ^ data_buf[i]) != 0xff) {
571 err = -EIO;
572 break;
573 }
574 }
575 kfree(data_buf);
576
577 if (cmd.error)
578 return cmd.error;
579 if (data.error)
580 return data.error;
581
582 return err;
583}
584
585int mmc_bus_test(struct mmc_card *card, u8 bus_width)
586{
587 int err, width;
588
589 if (bus_width == MMC_BUS_WIDTH_8)
590 width = 8;
591 else if (bus_width == MMC_BUS_WIDTH_4)
592 width = 4;
593 else if (bus_width == MMC_BUS_WIDTH_1)
594 return 0;
595 else
596 return -EINVAL;
597
598
599
600
601
602 mmc_send_bus_test(card, card->host, MMC_BUS_TEST_W, width);
603 err = mmc_send_bus_test(card, card->host, MMC_BUS_TEST_R, width);
604 return err;
605}
606
607int mmc_send_hpi_cmd(struct mmc_card *card, u32 *status)
608{
609 struct mmc_command cmd = {0};
610 unsigned int opcode;
611 int err;
612
613 if (!card->ext_csd.hpi) {
614 pr_warning("%s: Card didn't support HPI command\n",
615 mmc_hostname(card->host));
616 return -EINVAL;
617 }
618
619 opcode = card->ext_csd.hpi_cmd;
620 if (opcode == MMC_STOP_TRANSMISSION)
621 cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
622 else if (opcode == MMC_SEND_STATUS)
623 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
624
625 cmd.opcode = opcode;
626 cmd.arg = card->rca << 16 | 1;
627
628 err = mmc_wait_for_cmd(card->host, &cmd, 0);
629 if (err) {
630 pr_warn("%s: error %d interrupting operation. "
631 "HPI command response %#x\n", mmc_hostname(card->host),
632 err, cmd.resp[0]);
633 return err;
634 }
635 if (status)
636 *status = cmd.resp[0];
637
638 return 0;
639}
640