git.oblomov.eu Git - linux-2.6/blob - drivers/mmc/card/mmc_test.c

   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, 1);
 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 struct 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         mutex_init(&mmc_test_lock);
1175
1176         ret = device_create_file(&card->dev, &dev_attr_test);
1177         if (ret)
1178                 return ret;
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");