?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[ARM] pxa: Gumstix Verdex PCMCIA support
[linux-2.6/verdex.git] / drivers / mmc / card / mmc_test.c
blobb9f1e84897cc14fc2cbfa1e12adff95b4b93bb2e
1 /*
2 * linux/drivers/mmc/card/mmc_test.c
3 *
4 * Copyright 2007-2008 Pierre Ossman
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or (at
9 * your option) any later version.
10 */
11
12 #include <linux/mmc/core.h>
13 #include <linux/mmc/card.h>
14 #include <linux/mmc/host.h>
15 #include <linux/mmc/mmc.h>
16
17 #include <linux/scatterlist.h>
18
19 #define RESULT_OK 0
20 #define RESULT_FAIL 1
21 #define RESULT_UNSUP_HOST 2
22 #define RESULT_UNSUP_CARD 3
23
24 #define BUFFER_ORDER 2
25 #define BUFFER_SIZE (PAGE_SIZE << BUFFER_ORDER)
26
27 struct mmc_test_card {
28 struct mmc_card *card;
29
30 u8 scratch[BUFFER_SIZE];
31 u8 *buffer;
32 #ifdef CONFIG_HIGHMEM
33 struct page *highmem;
34 #endif
35 };
36
37 /*******************************************************************/
38 /* General helper functions */
39 /*******************************************************************/
40
41 /*
42 * Configure correct block size in card
43 */
44 static int mmc_test_set_blksize(struct mmc_test_card *test, unsigned size)
45 {
46 struct mmc_command cmd;
47 int ret;
48
49 cmd.opcode = MMC_SET_BLOCKLEN;
50 cmd.arg = size;
51 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
52 ret = mmc_wait_for_cmd(test->card->host, &cmd, 0);
53 if (ret)
54 return ret;
55
56 return 0;
57 }
58
59 /*
60 * Fill in the mmc_request structure given a set of transfer parameters.
61 */
62 static void mmc_test_prepare_mrq(struct mmc_test_card *test,
63 struct mmc_request *mrq, struct scatterlist *sg, unsigned sg_len,
64 unsigned dev_addr, unsigned blocks, unsigned blksz, int write)
65 {
66 BUG_ON(!mrq || !mrq->cmd || !mrq->data || !mrq->stop);
67
68 if (blocks > 1) {
69 mrq->cmd->opcode = write ?
70 MMC_WRITE_MULTIPLE_BLOCK : MMC_READ_MULTIPLE_BLOCK;
71 } else {
72 mrq->cmd->opcode = write ?
73 MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
74 }
75
76 mrq->cmd->arg = dev_addr;
77 mrq->cmd->flags = MMC_RSP_R1 | MMC_CMD_ADTC;
78
79 if (blocks == 1)
80 mrq->stop = NULL;
81 else {
82 mrq->stop->opcode = MMC_STOP_TRANSMISSION;
83 mrq->stop->arg = 0;
84 mrq->stop->flags = MMC_RSP_R1B | MMC_CMD_AC;
85 }
86
87 mrq->data->blksz = blksz;
88 mrq->data->blocks = blocks;
89 mrq->data->flags = write ? MMC_DATA_WRITE : MMC_DATA_READ;
90 mrq->data->sg = sg;
91 mrq->data->sg_len = sg_len;
92
93 mmc_set_data_timeout(mrq->data, test->card);
94 }
95
96 /*
97 * Wait for the card to finish the busy state
98 */
99 static int mmc_test_wait_busy(struct mmc_test_card *test)
100 {
101 int ret, busy;
102 struct mmc_command cmd;
103
104 busy = 0;
105 do {
106 memset(&cmd, 0, sizeof(struct mmc_command));
107
108 cmd.opcode = MMC_SEND_STATUS;
109 cmd.arg = test->card->rca << 16;
110 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
111
112 ret = mmc_wait_for_cmd(test->card->host, &cmd, 0);
113 if (ret)
114 break;
115
116 if (!busy && !(cmd.resp[0] & R1_READY_FOR_DATA)) {
117 busy = 1;
118 printk(KERN_INFO "%s: Warning: Host did not "
119 "wait for busy state to end.\n",
120 mmc_hostname(test->card->host));
121 }
122 } while (!(cmd.resp[0] & R1_READY_FOR_DATA));
123
124 return ret;
125 }
126
127 /*
128 * Transfer a single sector of kernel addressable data
129 */
130 static int mmc_test_buffer_transfer(struct mmc_test_card *test,
131 u8 *buffer, unsigned addr, unsigned blksz, int write)
132 {
133 int ret;
134
135 struct mmc_request mrq;
136 struct mmc_command cmd;
137 struct mmc_command stop;
138 struct mmc_data data;
139
140 struct scatterlist sg;
141
142 memset(&mrq, 0, sizeof(struct mmc_request));
143 memset(&cmd, 0, sizeof(struct mmc_command));
144 memset(&data, 0, sizeof(struct mmc_data));
145 memset(&stop, 0, sizeof(struct mmc_command));
146
147 mrq.cmd = &cmd;
148 mrq.data = &data;
149 mrq.stop = &stop;
150
151 sg_init_one(&sg, buffer, blksz);
152
153 mmc_test_prepare_mrq(test, &mrq, &sg, 1, addr, 1, blksz, write);
154
155 mmc_wait_for_req(test->card->host, &mrq);
156
157 if (cmd.error)
158 return cmd.error;
159 if (data.error)
160 return data.error;
161
162 ret = mmc_test_wait_busy(test);
163 if (ret)
164 return ret;
165
166 return 0;
167 }
168
169 /*******************************************************************/
170 /* Test preparation and cleanup */
171 /*******************************************************************/
172
173 /*
174 * Fill the first couple of sectors of the card with known data
175 * so that bad reads/writes can be detected
176 */
177 static int __mmc_test_prepare(struct mmc_test_card *test, int write)
178 {
179 int ret, i;
180
181 ret = mmc_test_set_blksize(test, 512);
182 if (ret)
183 return ret;
184
185 if (write)
186 memset(test->buffer, 0xDF, 512);
187 else {
188 for (i = 0;i < 512;i++)
189 test->buffer[i] = i;
190 }
191
192 for (i = 0;i < BUFFER_SIZE / 512;i++) {
193 ret = mmc_test_buffer_transfer(test, test->buffer, i * 512, 512, 1);
194 if (ret)
195 return ret;
196 }
197
198 return 0;
199 }
200
201 static int mmc_test_prepare_write(struct mmc_test_card *test)
202 {
203 return __mmc_test_prepare(test, 1);
204 }
205
206 static int mmc_test_prepare_read(struct mmc_test_card *test)
207 {
208 return __mmc_test_prepare(test, 0);
209 }
210
211 static int mmc_test_cleanup(struct mmc_test_card *test)
212 {
213 int ret, i;
214
215 ret = mmc_test_set_blksize(test, 512);
216 if (ret)
217 return ret;
218
219 memset(test->buffer, 0, 512);
220
221 for (i = 0;i < BUFFER_SIZE / 512;i++) {
222 ret = mmc_test_buffer_transfer(test, test->buffer, i * 512, 512, 1);
223 if (ret)
224 return ret;
225 }
226
227 return 0;
228 }
229
230 /*******************************************************************/
231 /* Test execution helpers */
232 /*******************************************************************/
233
234 /*
235 * Modifies the mmc_request to perform the "short transfer" tests
236 */
237 static void mmc_test_prepare_broken_mrq(struct mmc_test_card *test,
238 struct mmc_request *mrq, int write)
239 {
240 BUG_ON(!mrq || !mrq->cmd || !mrq->data);
241
242 if (mrq->data->blocks > 1) {
243 mrq->cmd->opcode = write ?
244 MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
245 mrq->stop = NULL;
246 } else {
247 mrq->cmd->opcode = MMC_SEND_STATUS;
248 mrq->cmd->arg = test->card->rca << 16;
249 }
250 }
251
252 /*
253 * Checks that a normal transfer didn't have any errors
254 */
255 static int mmc_test_check_result(struct mmc_test_card *test,
256 struct mmc_request *mrq)
257 {
258 int ret;
259
260 BUG_ON(!mrq || !mrq->cmd || !mrq->data);
261
262 ret = 0;
263
264 if (!ret && mrq->cmd->error)
265 ret = mrq->cmd->error;
266 if (!ret && mrq->data->error)
267 ret = mrq->data->error;
268 if (!ret && mrq->stop && mrq->stop->error)
269 ret = mrq->stop->error;
270 if (!ret && mrq->data->bytes_xfered !=
271 mrq->data->blocks * mrq->data->blksz)
272 ret = RESULT_FAIL;
273
274 if (ret == -EINVAL)
275 ret = RESULT_UNSUP_HOST;
276
277 return ret;
278 }
279
280 /*
281 * Checks that a "short transfer" behaved as expected
282 */
283 static int mmc_test_check_broken_result(struct mmc_test_card *test,
284 struct mmc_request *mrq)
285 {
286 int ret;
287
288 BUG_ON(!mrq || !mrq->cmd || !mrq->data);
289
290 ret = 0;
291
292 if (!ret && mrq->cmd->error)
293 ret = mrq->cmd->error;
294 if (!ret && mrq->data->error == 0)
295 ret = RESULT_FAIL;
296 if (!ret && mrq->data->error != -ETIMEDOUT)
297 ret = mrq->data->error;
298 if (!ret && mrq->stop && mrq->stop->error)
299 ret = mrq->stop->error;
300 if (mrq->data->blocks > 1) {
301 if (!ret && mrq->data->bytes_xfered > mrq->data->blksz)
302 ret = RESULT_FAIL;
303 } else {
304 if (!ret && mrq->data->bytes_xfered > 0)
305 ret = RESULT_FAIL;
306 }
307
308 if (ret == -EINVAL)
309 ret = RESULT_UNSUP_HOST;
310
311 return ret;
312 }
313
314 /*
315 * Tests a basic transfer with certain parameters
316 */
317 static int mmc_test_simple_transfer(struct mmc_test_card *test,
318 struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
319 unsigned blocks, unsigned blksz, int write)
320 {
321 struct mmc_request mrq;
322 struct mmc_command cmd;
323 struct mmc_command stop;
324 struct mmc_data data;
325
326 memset(&mrq, 0, sizeof(struct mmc_request));
327 memset(&cmd, 0, sizeof(struct mmc_command));
328 memset(&data, 0, sizeof(struct mmc_data));
329 memset(&stop, 0, sizeof(struct mmc_command));
330
331 mrq.cmd = &cmd;
332 mrq.data = &data;
333 mrq.stop = &stop;
334
335 mmc_test_prepare_mrq(test, &mrq, sg, sg_len, dev_addr,
336 blocks, blksz, write);
337
338 mmc_wait_for_req(test->card->host, &mrq);
339
340 mmc_test_wait_busy(test);
341
342 return mmc_test_check_result(test, &mrq);
343 }
344
345 /*
346 * Tests a transfer where the card will fail completely or partly
347 */
348 static int mmc_test_broken_transfer(struct mmc_test_card *test,
349 unsigned blocks, unsigned blksz, int write)
350 {
351 struct mmc_request mrq;
352 struct mmc_command cmd;
353 struct mmc_command stop;
354 struct mmc_data data;
355
356 struct scatterlist sg;
357
358 memset(&mrq, 0, sizeof(struct mmc_request));
359 memset(&cmd, 0, sizeof(struct mmc_command));
360 memset(&data, 0, sizeof(struct mmc_data));
361 memset(&stop, 0, sizeof(struct mmc_command));
362
363 mrq.cmd = &cmd;
364 mrq.data = &data;
365 mrq.stop = &stop;
366
367 sg_init_one(&sg, test->buffer, blocks * blksz);
368
369 mmc_test_prepare_mrq(test, &mrq, &sg, 1, 0, blocks, blksz, write);
370 mmc_test_prepare_broken_mrq(test, &mrq, write);
371
372 mmc_wait_for_req(test->card->host, &mrq);
373
374 mmc_test_wait_busy(test);
375
376 return mmc_test_check_broken_result(test, &mrq);
377 }
378
379 /*
380 * Does a complete transfer test where data is also validated
381 *
382 * Note: mmc_test_prepare() must have been done before this call
383 */
384 static int mmc_test_transfer(struct mmc_test_card *test,
385 struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
386 unsigned blocks, unsigned blksz, int write)
387 {
388 int ret, i;
389 unsigned long flags;
390
391 if (write) {
392 for (i = 0;i < blocks * blksz;i++)
393 test->scratch[i] = i;
394 } else {
395 memset(test->scratch, 0, BUFFER_SIZE);
396 }
397 local_irq_save(flags);
398 sg_copy_from_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
399 local_irq_restore(flags);
400
401 ret = mmc_test_set_blksize(test, blksz);
402 if (ret)
403 return ret;
404
405 ret = mmc_test_simple_transfer(test, sg, sg_len, dev_addr,
406 blocks, blksz, write);
407 if (ret)
408 return ret;
409
410 if (write) {
411 int sectors;
412
413 ret = mmc_test_set_blksize(test, 512);
414 if (ret)
415 return ret;
416
417 sectors = (blocks * blksz + 511) / 512;
418 if ((sectors * 512) == (blocks * blksz))
419 sectors++;
420
421 if ((sectors * 512) > BUFFER_SIZE)
422 return -EINVAL;
423
424 memset(test->buffer, 0, sectors * 512);
425
426 for (i = 0;i < sectors;i++) {
427 ret = mmc_test_buffer_transfer(test,
428 test->buffer + i * 512,
429 dev_addr + i * 512, 512, 0);
430 if (ret)
431 return ret;
432 }
433
434 for (i = 0;i < blocks * blksz;i++) {
435 if (test->buffer[i] != (u8)i)
436 return RESULT_FAIL;
437 }
438
439 for (;i < sectors * 512;i++) {
440 if (test->buffer[i] != 0xDF)
441 return RESULT_FAIL;
442 }
443 } else {
444 local_irq_save(flags);
445 sg_copy_to_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
446 local_irq_restore(flags);
447 for (i = 0;i < blocks * blksz;i++) {
448 if (test->scratch[i] != (u8)i)
449 return RESULT_FAIL;
450 }
451 }
452
453 return 0;
454 }
455
456 /*******************************************************************/
457 /* Tests */
458 /*******************************************************************/
459
460 struct mmc_test_case {
461 const char *name;
462
463 int (*prepare)(struct mmc_test_card *);
464 int (*run)(struct mmc_test_card *);
465 int (*cleanup)(struct mmc_test_card *);
466 };
467
468 static int mmc_test_basic_write(struct mmc_test_card *test)
469 {
470 int ret;
471 struct scatterlist sg;
472
473 ret = mmc_test_set_blksize(test, 512);
474 if (ret)
475 return ret;
476
477 sg_init_one(&sg, test->buffer, 512);
478
479 ret = mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 1);
480 if (ret)
481 return ret;
482
483 return 0;
484 }
485
486 static int mmc_test_basic_read(struct mmc_test_card *test)
487 {
488 int ret;
489 struct scatterlist sg;
490
491 ret = mmc_test_set_blksize(test, 512);
492 if (ret)
493 return ret;
494
495 sg_init_one(&sg, test->buffer, 512);
496
497 ret = mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 0);
498 if (ret)
499 return ret;
500
501 return 0;
502 }
503
504 static int mmc_test_verify_write(struct mmc_test_card *test)
505 {
506 int ret;
507 struct scatterlist sg;
508
509 sg_init_one(&sg, test->buffer, 512);
510
511 ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
512 if (ret)
513 return ret;
514
515 return 0;
516 }
517
518 static int mmc_test_verify_read(struct mmc_test_card *test)
519 {
520 int ret;
521 struct scatterlist sg;
522
523 sg_init_one(&sg, test->buffer, 512);
524
525 ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
526 if (ret)
527 return ret;
528
529 return 0;
530 }
531
532 static int mmc_test_multi_write(struct mmc_test_card *test)
533 {
534 int ret;
535 unsigned int size;
536 struct scatterlist sg;
537
538 if (test->card->host->max_blk_count == 1)
539 return RESULT_UNSUP_HOST;
540
541 size = PAGE_SIZE * 2;
542 size = min(size, test->card->host->max_req_size);
543 size = min(size, test->card->host->max_seg_size);
544 size = min(size, test->card->host->max_blk_count * 512);
545
546 if (size < 1024)
547 return RESULT_UNSUP_HOST;
548
549 sg_init_one(&sg, test->buffer, size);
550
551 ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
552 if (ret)
553 return ret;
554
555 return 0;
556 }
557
558 static int mmc_test_multi_read(struct mmc_test_card *test)
559 {
560 int ret;
561 unsigned int size;
562 struct scatterlist sg;
563
564 if (test->card->host->max_blk_count == 1)
565 return RESULT_UNSUP_HOST;
566
567 size = PAGE_SIZE * 2;
568 size = min(size, test->card->host->max_req_size);
569 size = min(size, test->card->host->max_seg_size);
570 size = min(size, test->card->host->max_blk_count * 512);
571
572 if (size < 1024)
573 return RESULT_UNSUP_HOST;
574
575 sg_init_one(&sg, test->buffer, size);
576
577 ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
578 if (ret)
579 return ret;
580
581 return 0;
582 }
583
584 static int mmc_test_pow2_write(struct mmc_test_card *test)
585 {
586 int ret, i;
587 struct scatterlist sg;
588
589 if (!test->card->csd.write_partial)
590 return RESULT_UNSUP_CARD;
591
592 for (i = 1; i < 512;i <<= 1) {
593 sg_init_one(&sg, test->buffer, i);
594 ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
595 if (ret)
596 return ret;
597 }
598
599 return 0;
600 }
601
602 static int mmc_test_pow2_read(struct mmc_test_card *test)
603 {
604 int ret, i;
605 struct scatterlist sg;
606
607 if (!test->card->csd.read_partial)
608 return RESULT_UNSUP_CARD;
609
610 for (i = 1; i < 512;i <<= 1) {
611 sg_init_one(&sg, test->buffer, i);
612 ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
613 if (ret)
614 return ret;
615 }
616
617 return 0;
618 }
619
620 static int mmc_test_weird_write(struct mmc_test_card *test)
621 {
622 int ret, i;
623 struct scatterlist sg;
624
625 if (!test->card->csd.write_partial)
626 return RESULT_UNSUP_CARD;
627
628 for (i = 3; i < 512;i += 7) {
629 sg_init_one(&sg, test->buffer, i);
630 ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
631 if (ret)
632 return ret;
633 }
634
635 return 0;
636 }
637
638 static int mmc_test_weird_read(struct mmc_test_card *test)
639 {
640 int ret, i;
641 struct scatterlist sg;
642
643 if (!test->card->csd.read_partial)
644 return RESULT_UNSUP_CARD;
645
646 for (i = 3; i < 512;i += 7) {
647 sg_init_one(&sg, test->buffer, i);
648 ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
649 if (ret)
650 return ret;
651 }
652
653 return 0;
654 }
655
656 static int mmc_test_align_write(struct mmc_test_card *test)
657 {
658 int ret, i;
659 struct scatterlist sg;
660
661 for (i = 1;i < 4;i++) {
662 sg_init_one(&sg, test->buffer + i, 512);
663 ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
664 if (ret)
665 return ret;
666 }
667
668 return 0;
669 }
670
671 static int mmc_test_align_read(struct mmc_test_card *test)
672 {
673 int ret, i;
674 struct scatterlist sg;
675
676 for (i = 1;i < 4;i++) {
677 sg_init_one(&sg, test->buffer + i, 512);
678 ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
679 if (ret)
680 return ret;
681 }
682
683 return 0;
684 }
685
686 static int mmc_test_align_multi_write(struct mmc_test_card *test)
687 {
688 int ret, i;
689 unsigned int size;
690 struct scatterlist sg;
691
692 if (test->card->host->max_blk_count == 1)
693 return RESULT_UNSUP_HOST;
694
695 size = PAGE_SIZE * 2;
696 size = min(size, test->card->host->max_req_size);
697 size = min(size, test->card->host->max_seg_size);
698 size = min(size, test->card->host->max_blk_count * 512);
699
700 if (size < 1024)
701 return RESULT_UNSUP_HOST;
702
703 for (i = 1;i < 4;i++) {
704 sg_init_one(&sg, test->buffer + i, size);
705 ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
706 if (ret)
707 return ret;
708 }
709
710 return 0;
711 }
712
713 static int mmc_test_align_multi_read(struct mmc_test_card *test)
714 {
715 int ret, i;
716 unsigned int size;
717 struct scatterlist sg;
718
719 if (test->card->host->max_blk_count == 1)
720 return RESULT_UNSUP_HOST;
721
722 size = PAGE_SIZE * 2;
723 size = min(size, test->card->host->max_req_size);
724 size = min(size, test->card->host->max_seg_size);
725 size = min(size, test->card->host->max_blk_count * 512);
726
727 if (size < 1024)
728 return RESULT_UNSUP_HOST;
729
730 for (i = 1;i < 4;i++) {
731 sg_init_one(&sg, test->buffer + i, size);
732 ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
733 if (ret)
734 return ret;
735 }
736
737 return 0;
738 }
739
740 static int mmc_test_xfersize_write(struct mmc_test_card *test)
741 {
742 int ret;
743
744 ret = mmc_test_set_blksize(test, 512);
745 if (ret)
746 return ret;
747
748 ret = mmc_test_broken_transfer(test, 1, 512, 1);
749 if (ret)
750 return ret;
751
752 return 0;
753 }
754
755 static int mmc_test_xfersize_read(struct mmc_test_card *test)
756 {
757 int ret;
758
759 ret = mmc_test_set_blksize(test, 512);
760 if (ret)
761 return ret;
762
763 ret = mmc_test_broken_transfer(test, 1, 512, 0);
764 if (ret)
765 return ret;
766
767 return 0;
768 }
769
770 static int mmc_test_multi_xfersize_write(struct mmc_test_card *test)
771 {
772 int ret;
773
774 if (test->card->host->max_blk_count == 1)
775 return RESULT_UNSUP_HOST;
776
777 ret = mmc_test_set_blksize(test, 512);
778 if (ret)
779 return ret;
780
781 ret = mmc_test_broken_transfer(test, 2, 512, 1);
782 if (ret)
783 return ret;
784
785 return 0;
786 }
787
788 static int mmc_test_multi_xfersize_read(struct mmc_test_card *test)
789 {
790 int ret;
791
792 if (test->card->host->max_blk_count == 1)
793 return RESULT_UNSUP_HOST;
794
795 ret = mmc_test_set_blksize(test, 512);
796 if (ret)
797 return ret;
798
799 ret = mmc_test_broken_transfer(test, 2, 512, 0);
800 if (ret)
801 return ret;
802
803 return 0;
804 }
805
806 #ifdef CONFIG_HIGHMEM
807
808 static int mmc_test_write_high(struct mmc_test_card *test)
809 {
810 int ret;
811 struct scatterlist sg;
812
813 sg_init_table(&sg, 1);
814 sg_set_page(&sg, test->highmem, 512, 0);
815
816 ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
817 if (ret)
818 return ret;
819
820 return 0;
821 }
822
823 static int mmc_test_read_high(struct mmc_test_card *test)
824 {
825 int ret;
826 struct scatterlist sg;
827
828 sg_init_table(&sg, 1);
829 sg_set_page(&sg, test->highmem, 512, 0);
830
831 ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
832 if (ret)
833 return ret;
834
835 return 0;
836 }
837
838 static int mmc_test_multi_write_high(struct mmc_test_card *test)
839 {
840 int ret;
841 unsigned int size;
842 struct scatterlist sg;
843
844 if (test->card->host->max_blk_count == 1)
845 return RESULT_UNSUP_HOST;
846
847 size = PAGE_SIZE * 2;
848 size = min(size, test->card->host->max_req_size);
849 size = min(size, test->card->host->max_seg_size);
850 size = min(size, test->card->host->max_blk_count * 512);
851
852 if (size < 1024)
853 return RESULT_UNSUP_HOST;
854
855 sg_init_table(&sg, 1);
856 sg_set_page(&sg, test->highmem, size, 0);
857
858 ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
859 if (ret)
860 return ret;
861
862 return 0;
863 }
864
865 static int mmc_test_multi_read_high(struct mmc_test_card *test)
866 {
867 int ret;
868 unsigned int size;
869 struct scatterlist sg;
870
871 if (test->card->host->max_blk_count == 1)
872 return RESULT_UNSUP_HOST;
873
874 size = PAGE_SIZE * 2;
875 size = min(size, test->card->host->max_req_size);
876 size = min(size, test->card->host->max_seg_size);
877 size = min(size, test->card->host->max_blk_count * 512);
878
879 if (size < 1024)
880 return RESULT_UNSUP_HOST;
881
882 sg_init_table(&sg, 1);
883 sg_set_page(&sg, test->highmem, size, 0);
884
885 ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
886 if (ret)
887 return ret;
888
889 return 0;
890 }
891
892 #endif /* CONFIG_HIGHMEM */
893
894 static const struct mmc_test_case mmc_test_cases[] = {
895 {
896 .name = "Basic write (no data verification)",
897 .run = mmc_test_basic_write,
898 },
899
900 {
901 .name = "Basic read (no data verification)",
902 .run = mmc_test_basic_read,
903 },
904
905 {
906 .name = "Basic write (with data verification)",
907 .prepare = mmc_test_prepare_write,
908 .run = mmc_test_verify_write,
909 .cleanup = mmc_test_cleanup,
910 },
911
912 {
913 .name = "Basic read (with data verification)",
914 .prepare = mmc_test_prepare_read,
915 .run = mmc_test_verify_read,
916 .cleanup = mmc_test_cleanup,
917 },
918
919 {
920 .name = "Multi-block write",
921 .prepare = mmc_test_prepare_write,
922 .run = mmc_test_multi_write,
923 .cleanup = mmc_test_cleanup,
924 },
925
926 {
927 .name = "Multi-block read",
928 .prepare = mmc_test_prepare_read,
929 .run = mmc_test_multi_read,
930 .cleanup = mmc_test_cleanup,
931 },
932
933 {
934 .name = "Power of two block writes",
935 .prepare = mmc_test_prepare_write,
936 .run = mmc_test_pow2_write,
937 .cleanup = mmc_test_cleanup,
938 },
939
940 {
941 .name = "Power of two block reads",
942 .prepare = mmc_test_prepare_read,
943 .run = mmc_test_pow2_read,
944 .cleanup = mmc_test_cleanup,
945 },
946
947 {
948 .name = "Weird sized block writes",
949 .prepare = mmc_test_prepare_write,
950 .run = mmc_test_weird_write,
951 .cleanup = mmc_test_cleanup,
952 },
953
954 {
955 .name = "Weird sized block reads",
956 .prepare = mmc_test_prepare_read,
957 .run = mmc_test_weird_read,
958 .cleanup = mmc_test_cleanup,
959 },
960
961 {
962 .name = "Badly aligned write",
963 .prepare = mmc_test_prepare_write,
964 .run = mmc_test_align_write,
965 .cleanup = mmc_test_cleanup,
966 },
967
968 {
969 .name = "Badly aligned read",
970 .prepare = mmc_test_prepare_read,
971 .run = mmc_test_align_read,
972 .cleanup = mmc_test_cleanup,
973 },
974
975 {
976 .name = "Badly aligned multi-block write",
977 .prepare = mmc_test_prepare_write,
978 .run = mmc_test_align_multi_write,
979 .cleanup = mmc_test_cleanup,
980 },
981
982 {
983 .name = "Badly aligned multi-block read",
984 .prepare = mmc_test_prepare_read,
985 .run = mmc_test_align_multi_read,
986 .cleanup = mmc_test_cleanup,
987 },
988
989 {
990 .name = "Correct xfer_size at write (start failure)",
991 .run = mmc_test_xfersize_write,
992 },
993
994 {
995 .name = "Correct xfer_size at read (start failure)",
996 .run = mmc_test_xfersize_read,
997 },
998
999 {
1000 .name = "Correct xfer_size at write (midway failure)",
1001 .run = mmc_test_multi_xfersize_write,
1002 },
1003
1004 {
1005 .name = "Correct xfer_size at read (midway failure)",
1006 .run = mmc_test_multi_xfersize_read,
1007 },
1008
1009 #ifdef CONFIG_HIGHMEM
1010
1011 {
1012 .name = "Highmem write",
1013 .prepare = mmc_test_prepare_write,
1014 .run = mmc_test_write_high,
1015 .cleanup = mmc_test_cleanup,
1016 },
1017
1018 {
1019 .name = "Highmem read",
1020 .prepare = mmc_test_prepare_read,
1021 .run = mmc_test_read_high,
1022 .cleanup = mmc_test_cleanup,
1023 },
1024
1025 {
1026 .name = "Multi-block highmem write",
1027 .prepare = mmc_test_prepare_write,
1028 .run = mmc_test_multi_write_high,
1029 .cleanup = mmc_test_cleanup,
1030 },
1031
1032 {
1033 .name = "Multi-block highmem read",
1034 .prepare = mmc_test_prepare_read,
1035 .run = mmc_test_multi_read_high,
1036 .cleanup = mmc_test_cleanup,
1037 },
1038
1039 #endif /* CONFIG_HIGHMEM */
1040
1041 };
1042
1043 static DEFINE_MUTEX(mmc_test_lock);
1044
1045 static void mmc_test_run(struct mmc_test_card *test, int testcase)
1046 {
1047 int i, ret;
1048
1049 printk(KERN_INFO "%s: Starting tests of card %s...\n",
1050 mmc_hostname(test->card->host), mmc_card_id(test->card));
1051
1052 mmc_claim_host(test->card->host);
1053
1054 for (i = 0;i < ARRAY_SIZE(mmc_test_cases);i++) {
1055 if (testcase && ((i + 1) != testcase))
1056 continue;
1057
1058 printk(KERN_INFO "%s: Test case %d. %s...\n",
1059 mmc_hostname(test->card->host), i + 1,
1060 mmc_test_cases[i].name);
1061
1062 if (mmc_test_cases[i].prepare) {
1063 ret = mmc_test_cases[i].prepare(test);
1064 if (ret) {
1065 printk(KERN_INFO "%s: Result: Prepare "
1066 "stage failed! (%d)\n",
1067 mmc_hostname(test->card->host),
1068 ret);
1069 continue;
1070 }
1071 }
1072
1073 ret = mmc_test_cases[i].run(test);
1074 switch (ret) {
1075 case RESULT_OK:
1076 printk(KERN_INFO "%s: Result: OK\n",
1077 mmc_hostname(test->card->host));
1078 break;
1079 case RESULT_FAIL:
1080 printk(KERN_INFO "%s: Result: FAILED\n",
1081 mmc_hostname(test->card->host));
1082 break;
1083 case RESULT_UNSUP_HOST:
1084 printk(KERN_INFO "%s: Result: UNSUPPORTED "
1085 "(by host)\n",
1086 mmc_hostname(test->card->host));
1087 break;
1088 case RESULT_UNSUP_CARD:
1089 printk(KERN_INFO "%s: Result: UNSUPPORTED "
1090 "(by card)\n",
1091 mmc_hostname(test->card->host));
1092 break;
1093 default:
1094 printk(KERN_INFO "%s: Result: ERROR (%d)\n",
1095 mmc_hostname(test->card->host), ret);
1096 }
1097
1098 if (mmc_test_cases[i].cleanup) {
1099 ret = mmc_test_cases[i].cleanup(test);
1100 if (ret) {
1101 printk(KERN_INFO "%s: Warning: Cleanup "
1102 "stage failed! (%d)\n",
1103 mmc_hostname(test->card->host),
1104 ret);
1105 }
1106 }
1107 }
1108
1109 mmc_release_host(test->card->host);
1110
1111 printk(KERN_INFO "%s: Tests completed.\n",
1112 mmc_hostname(test->card->host));
1113 }
1114
1115 static ssize_t mmc_test_show(struct device *dev,
1116 struct device_attribute *attr, char *buf)
1117 {
1118 mutex_lock(&mmc_test_lock);
1119 mutex_unlock(&mmc_test_lock);
1120
1121 return 0;
1122 }
1123
1124 static ssize_t mmc_test_store(struct device *dev,
1125 struct device_attribute *attr, const char *buf, size_t count)
1126 {
1127 struct mmc_card *card;
1128 struct mmc_test_card *test;
1129 int testcase;
1130
1131 card = container_of(dev, struct mmc_card, dev);
1132
1133 testcase = simple_strtol(buf, NULL, 10);
1134
1135 test = kzalloc(sizeof(struct mmc_test_card), GFP_KERNEL);
1136 if (!test)
1137 return -ENOMEM;
1138
1139 test->card = card;
1140
1141 test->buffer = kzalloc(BUFFER_SIZE, GFP_KERNEL);
1142 #ifdef CONFIG_HIGHMEM
1143 test->highmem = alloc_pages(GFP_KERNEL | __GFP_HIGHMEM, BUFFER_ORDER);
1144 #endif
1145
1146 #ifdef CONFIG_HIGHMEM
1147 if (test->buffer && test->highmem) {
1148 #else
1149 if (test->buffer) {
1150 #endif
1151 mutex_lock(&mmc_test_lock);
1152 mmc_test_run(test, testcase);
1153 mutex_unlock(&mmc_test_lock);
1154 }
1155
1156 #ifdef CONFIG_HIGHMEM
1157 __free_pages(test->highmem, BUFFER_ORDER);
1158 #endif
1159 kfree(test->buffer);
1160 kfree(test);
1161
1162 return count;
1163 }
1164
1165 static DEVICE_ATTR(test, S_IWUSR | S_IRUGO, mmc_test_show, mmc_test_store);
1166
1167 static int mmc_test_probe(struct mmc_card *card)
1168 {
1169 int ret;
1170
1171 if ((card->type != MMC_TYPE_MMC) && (card->type != MMC_TYPE_SD))
1172 return -ENODEV;
1173
1174 ret = device_create_file(&card->dev, &dev_attr_test);
1175 if (ret)
1176 return ret;
1177
1178 dev_info(&card->dev, "Card claimed for testing.\n");
1179
1180 return 0;
1181 }
1182
1183 static void mmc_test_remove(struct mmc_card *card)
1184 {
1185 device_remove_file(&card->dev, &dev_attr_test);
1186 }
1187
1188 static struct mmc_driver mmc_driver = {
1189 .drv = {
1190 .name = "mmc_test",
1191 },
1192 .probe = mmc_test_probe,
1193 .remove = mmc_test_remove,
1194 };
1195
1196 static int __init mmc_test_init(void)
1197 {
1198 return mmc_register_driver(&mmc_driver);
1199 }
1200
1201 static void __exit mmc_test_exit(void)
1202 {
1203 mmc_unregister_driver(&mmc_driver);
1204 }
1205
1206 module_init(mmc_test_init);
1207 module_exit(mmc_test_exit);
1208
1209 MODULE_LICENSE("GPL");
1210 MODULE_DESCRIPTION("Multimedia Card (MMC) host test driver");
1211 MODULE_AUTHOR("Pierre Ossman");
Verdex Pro support