mmc_test.c 22 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075
  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. #include <linux/mmc/core.h>
  12. #include <linux/mmc/card.h>
  13. #include <linux/mmc/host.h>
  14. #include <linux/mmc/mmc.h>
  15. #include <linux/scatterlist.h>
  16. #define RESULT_OK 0
  17. #define RESULT_FAIL 1
  18. #define RESULT_UNSUP_HOST 2
  19. #define RESULT_UNSUP_CARD 3
  20. #define BUFFER_SIZE (PAGE_SIZE * 4)
  21. struct mmc_test_card {
  22. struct mmc_card *card;
  23. u8 scratch[BUFFER_SIZE];
  24. u8 *buffer;
  25. };
  26. /*******************************************************************/
  27. /* General helper functions */
  28. /*******************************************************************/
  29. /*
  30. * Configure correct block size in card
  31. */
  32. static int mmc_test_set_blksize(struct mmc_test_card *test, unsigned size)
  33. {
  34. struct mmc_command cmd;
  35. int ret;
  36. cmd.opcode = MMC_SET_BLOCKLEN;
  37. cmd.arg = size;
  38. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  39. ret = mmc_wait_for_cmd(test->card->host, &cmd, 0);
  40. if (ret)
  41. return ret;
  42. return 0;
  43. }
  44. /*
  45. * Fill in the mmc_request structure given a set of transfer parameters.
  46. */
  47. static void mmc_test_prepare_mrq(struct mmc_test_card *test,
  48. struct mmc_request *mrq, struct scatterlist *sg, unsigned sg_len,
  49. unsigned dev_addr, unsigned blocks, unsigned blksz, int write)
  50. {
  51. BUG_ON(!mrq || !mrq->cmd || !mrq->data || !mrq->stop);
  52. if (blocks > 1) {
  53. mrq->cmd->opcode = write ?
  54. MMC_WRITE_MULTIPLE_BLOCK : MMC_READ_MULTIPLE_BLOCK;
  55. } else {
  56. mrq->cmd->opcode = write ?
  57. MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
  58. }
  59. mrq->cmd->arg = dev_addr;
  60. mrq->cmd->flags = MMC_RSP_R1 | MMC_CMD_ADTC;
  61. if (blocks == 1)
  62. mrq->stop = NULL;
  63. else {
  64. mrq->stop->opcode = MMC_STOP_TRANSMISSION;
  65. mrq->stop->arg = 0;
  66. mrq->stop->flags = MMC_RSP_R1B | MMC_CMD_AC;
  67. }
  68. mrq->data->blksz = blksz;
  69. mrq->data->blocks = blocks;
  70. mrq->data->flags = write ? MMC_DATA_WRITE : MMC_DATA_READ;
  71. mrq->data->sg = sg;
  72. mrq->data->sg_len = sg_len;
  73. mmc_set_data_timeout(mrq->data, test->card);
  74. }
  75. /*
  76. * Wait for the card to finish the busy state
  77. */
  78. static int mmc_test_wait_busy(struct mmc_test_card *test)
  79. {
  80. int ret, busy;
  81. struct mmc_command cmd;
  82. busy = 0;
  83. do {
  84. memset(&cmd, 0, sizeof(struct mmc_command));
  85. cmd.opcode = MMC_SEND_STATUS;
  86. cmd.arg = test->card->rca << 16;
  87. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  88. ret = mmc_wait_for_cmd(test->card->host, &cmd, 0);
  89. if (ret)
  90. break;
  91. if (!busy && !(cmd.resp[0] & R1_READY_FOR_DATA)) {
  92. busy = 1;
  93. printk(KERN_INFO "%s: Warning: Host did not "
  94. "wait for busy state to end.\n",
  95. mmc_hostname(test->card->host));
  96. }
  97. } while (!(cmd.resp[0] & R1_READY_FOR_DATA));
  98. return ret;
  99. }
  100. /*
  101. * Transfer a single sector of kernel addressable data
  102. */
  103. static int mmc_test_buffer_transfer(struct mmc_test_card *test,
  104. u8 *buffer, unsigned addr, unsigned blksz, int write)
  105. {
  106. int ret;
  107. struct mmc_request mrq;
  108. struct mmc_command cmd;
  109. struct mmc_command stop;
  110. struct mmc_data data;
  111. struct scatterlist sg;
  112. memset(&mrq, 0, sizeof(struct mmc_request));
  113. memset(&cmd, 0, sizeof(struct mmc_command));
  114. memset(&data, 0, sizeof(struct mmc_data));
  115. memset(&stop, 0, sizeof(struct mmc_command));
  116. mrq.cmd = &cmd;
  117. mrq.data = &data;
  118. mrq.stop = &stop;
  119. sg_init_one(&sg, buffer, blksz);
  120. mmc_test_prepare_mrq(test, &mrq, &sg, 1, addr, 1, blksz, write);
  121. mmc_wait_for_req(test->card->host, &mrq);
  122. if (cmd.error)
  123. return cmd.error;
  124. if (data.error)
  125. return data.error;
  126. ret = mmc_test_wait_busy(test);
  127. if (ret)
  128. return ret;
  129. return 0;
  130. }
  131. /*******************************************************************/
  132. /* Test preparation and cleanup */
  133. /*******************************************************************/
  134. /*
  135. * Fill the first couple of sectors of the card with known data
  136. * so that bad reads/writes can be detected
  137. */
  138. static int __mmc_test_prepare(struct mmc_test_card *test, int write)
  139. {
  140. int ret, i;
  141. ret = mmc_test_set_blksize(test, 512);
  142. if (ret)
  143. return ret;
  144. if (write)
  145. memset(test->buffer, 0xDF, 512);
  146. else {
  147. for (i = 0;i < 512;i++)
  148. test->buffer[i] = i;
  149. }
  150. for (i = 0;i < BUFFER_SIZE / 512;i++) {
  151. ret = mmc_test_buffer_transfer(test, test->buffer, i * 512, 512, 1);
  152. if (ret)
  153. return ret;
  154. }
  155. return 0;
  156. }
  157. static int mmc_test_prepare_write(struct mmc_test_card *test)
  158. {
  159. return __mmc_test_prepare(test, 1);
  160. }
  161. static int mmc_test_prepare_read(struct mmc_test_card *test)
  162. {
  163. return __mmc_test_prepare(test, 0);
  164. }
  165. static int mmc_test_cleanup(struct mmc_test_card *test)
  166. {
  167. int ret, i;
  168. ret = mmc_test_set_blksize(test, 512);
  169. if (ret)
  170. return ret;
  171. memset(test->buffer, 0, 512);
  172. for (i = 0;i < BUFFER_SIZE / 512;i++) {
  173. ret = mmc_test_buffer_transfer(test, test->buffer, i * 512, 512, 1);
  174. if (ret)
  175. return ret;
  176. }
  177. return 0;
  178. }
  179. /*******************************************************************/
  180. /* Test execution helpers */
  181. /*******************************************************************/
  182. /*
  183. * Modifies the mmc_request to perform the "short transfer" tests
  184. */
  185. static void mmc_test_prepare_broken_mrq(struct mmc_test_card *test,
  186. struct mmc_request *mrq, int write)
  187. {
  188. BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  189. if (mrq->data->blocks > 1) {
  190. mrq->cmd->opcode = write ?
  191. MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
  192. mrq->stop = NULL;
  193. } else {
  194. mrq->cmd->opcode = MMC_SEND_STATUS;
  195. mrq->cmd->arg = test->card->rca << 16;
  196. }
  197. }
  198. /*
  199. * Checks that a normal transfer didn't have any errors
  200. */
  201. static int mmc_test_check_result(struct mmc_test_card *test,
  202. struct mmc_request *mrq)
  203. {
  204. int ret;
  205. BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  206. ret = 0;
  207. if (!ret && mrq->cmd->error)
  208. ret = mrq->cmd->error;
  209. if (!ret && mrq->data->error)
  210. ret = mrq->data->error;
  211. if (!ret && mrq->stop && mrq->stop->error)
  212. ret = mrq->stop->error;
  213. if (!ret && mrq->data->bytes_xfered !=
  214. mrq->data->blocks * mrq->data->blksz)
  215. ret = RESULT_FAIL;
  216. if (ret == -EINVAL)
  217. ret = RESULT_UNSUP_HOST;
  218. return ret;
  219. }
  220. /*
  221. * Checks that a "short transfer" behaved as expected
  222. */
  223. static int mmc_test_check_broken_result(struct mmc_test_card *test,
  224. struct mmc_request *mrq)
  225. {
  226. int ret;
  227. BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  228. ret = 0;
  229. if (!ret && mrq->cmd->error)
  230. ret = mrq->cmd->error;
  231. if (!ret && mrq->data->error == 0)
  232. ret = RESULT_FAIL;
  233. if (!ret && mrq->data->error != -ETIMEDOUT)
  234. ret = mrq->data->error;
  235. if (!ret && mrq->stop && mrq->stop->error)
  236. ret = mrq->stop->error;
  237. if (mrq->data->blocks > 1) {
  238. if (!ret && mrq->data->bytes_xfered > mrq->data->blksz)
  239. ret = RESULT_FAIL;
  240. } else {
  241. if (!ret && mrq->data->bytes_xfered > 0)
  242. ret = RESULT_FAIL;
  243. }
  244. if (ret == -EINVAL)
  245. ret = RESULT_UNSUP_HOST;
  246. return ret;
  247. }
  248. /*
  249. * Tests a basic transfer with certain parameters
  250. */
  251. static int mmc_test_simple_transfer(struct mmc_test_card *test,
  252. struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
  253. unsigned blocks, unsigned blksz, int write)
  254. {
  255. struct mmc_request mrq;
  256. struct mmc_command cmd;
  257. struct mmc_command stop;
  258. struct mmc_data data;
  259. memset(&mrq, 0, sizeof(struct mmc_request));
  260. memset(&cmd, 0, sizeof(struct mmc_command));
  261. memset(&data, 0, sizeof(struct mmc_data));
  262. memset(&stop, 0, sizeof(struct mmc_command));
  263. mrq.cmd = &cmd;
  264. mrq.data = &data;
  265. mrq.stop = &stop;
  266. mmc_test_prepare_mrq(test, &mrq, sg, sg_len, dev_addr,
  267. blocks, blksz, write);
  268. mmc_wait_for_req(test->card->host, &mrq);
  269. mmc_test_wait_busy(test);
  270. return mmc_test_check_result(test, &mrq);
  271. }
  272. /*
  273. * Tests a transfer where the card will fail completely or partly
  274. */
  275. static int mmc_test_broken_transfer(struct mmc_test_card *test,
  276. unsigned blocks, unsigned blksz, int write)
  277. {
  278. struct mmc_request mrq;
  279. struct mmc_command cmd;
  280. struct mmc_command stop;
  281. struct mmc_data data;
  282. struct scatterlist sg;
  283. memset(&mrq, 0, sizeof(struct mmc_request));
  284. memset(&cmd, 0, sizeof(struct mmc_command));
  285. memset(&data, 0, sizeof(struct mmc_data));
  286. memset(&stop, 0, sizeof(struct mmc_command));
  287. mrq.cmd = &cmd;
  288. mrq.data = &data;
  289. mrq.stop = &stop;
  290. sg_init_one(&sg, test->buffer, blocks * blksz);
  291. mmc_test_prepare_mrq(test, &mrq, &sg, 1, 0, blocks, blksz, write);
  292. mmc_test_prepare_broken_mrq(test, &mrq, write);
  293. mmc_wait_for_req(test->card->host, &mrq);
  294. mmc_test_wait_busy(test);
  295. return mmc_test_check_broken_result(test, &mrq);
  296. }
  297. /*
  298. * Does a complete transfer test where data is also validated
  299. *
  300. * Note: mmc_test_prepare() must have been done before this call
  301. */
  302. static int mmc_test_transfer(struct mmc_test_card *test,
  303. struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
  304. unsigned blocks, unsigned blksz, int write)
  305. {
  306. int ret, i;
  307. unsigned long flags;
  308. if (write) {
  309. for (i = 0;i < blocks * blksz;i++)
  310. test->scratch[i] = i;
  311. } else {
  312. memset(test->scratch, 0, BUFFER_SIZE);
  313. }
  314. local_irq_save(flags);
  315. sg_copy_from_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
  316. local_irq_restore(flags);
  317. ret = mmc_test_set_blksize(test, blksz);
  318. if (ret)
  319. return ret;
  320. ret = mmc_test_simple_transfer(test, sg, sg_len, dev_addr,
  321. blocks, blksz, write);
  322. if (ret)
  323. return ret;
  324. if (write) {
  325. int sectors;
  326. ret = mmc_test_set_blksize(test, 512);
  327. if (ret)
  328. return ret;
  329. sectors = (blocks * blksz + 511) / 512;
  330. if ((sectors * 512) == (blocks * blksz))
  331. sectors++;
  332. if ((sectors * 512) > BUFFER_SIZE)
  333. return -EINVAL;
  334. memset(test->buffer, 0, sectors * 512);
  335. for (i = 0;i < sectors;i++) {
  336. ret = mmc_test_buffer_transfer(test,
  337. test->buffer + i * 512,
  338. dev_addr + i * 512, 512, 0);
  339. if (ret)
  340. return ret;
  341. }
  342. for (i = 0;i < blocks * blksz;i++) {
  343. if (test->buffer[i] != (u8)i)
  344. return RESULT_FAIL;
  345. }
  346. for (;i < sectors * 512;i++) {
  347. if (test->buffer[i] != 0xDF)
  348. return RESULT_FAIL;
  349. }
  350. } else {
  351. local_irq_save(flags);
  352. sg_copy_to_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
  353. local_irq_restore(flags);
  354. for (i = 0;i < blocks * blksz;i++) {
  355. if (test->scratch[i] != (u8)i)
  356. return RESULT_FAIL;
  357. }
  358. }
  359. return 0;
  360. }
  361. /*******************************************************************/
  362. /* Tests */
  363. /*******************************************************************/
  364. struct mmc_test_case {
  365. const char *name;
  366. int (*prepare)(struct mmc_test_card *);
  367. int (*run)(struct mmc_test_card *);
  368. int (*cleanup)(struct mmc_test_card *);
  369. };
  370. static int mmc_test_basic_write(struct mmc_test_card *test)
  371. {
  372. int ret;
  373. struct scatterlist sg;
  374. ret = mmc_test_set_blksize(test, 512);
  375. if (ret)
  376. return ret;
  377. sg_init_one(&sg, test->buffer, 512);
  378. ret = mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 1);
  379. if (ret)
  380. return ret;
  381. return 0;
  382. }
  383. static int mmc_test_basic_read(struct mmc_test_card *test)
  384. {
  385. int ret;
  386. struct scatterlist sg;
  387. ret = mmc_test_set_blksize(test, 512);
  388. if (ret)
  389. return ret;
  390. sg_init_one(&sg, test->buffer, 512);
  391. ret = mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 1);
  392. if (ret)
  393. return ret;
  394. return 0;
  395. }
  396. static int mmc_test_verify_write(struct mmc_test_card *test)
  397. {
  398. int ret;
  399. struct scatterlist sg;
  400. sg_init_one(&sg, test->buffer, 512);
  401. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
  402. if (ret)
  403. return ret;
  404. return 0;
  405. }
  406. static int mmc_test_verify_read(struct mmc_test_card *test)
  407. {
  408. int ret;
  409. struct scatterlist sg;
  410. sg_init_one(&sg, test->buffer, 512);
  411. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
  412. if (ret)
  413. return ret;
  414. return 0;
  415. }
  416. static int mmc_test_multi_write(struct mmc_test_card *test)
  417. {
  418. int ret;
  419. unsigned int size;
  420. struct scatterlist sg;
  421. if (test->card->host->max_blk_count == 1)
  422. return RESULT_UNSUP_HOST;
  423. size = PAGE_SIZE * 2;
  424. size = min(size, test->card->host->max_req_size);
  425. size = min(size, test->card->host->max_seg_size);
  426. size = min(size, test->card->host->max_blk_count * 512);
  427. if (size < 1024)
  428. return RESULT_UNSUP_HOST;
  429. sg_init_one(&sg, test->buffer, size);
  430. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
  431. if (ret)
  432. return ret;
  433. return 0;
  434. }
  435. static int mmc_test_multi_read(struct mmc_test_card *test)
  436. {
  437. int ret;
  438. unsigned int size;
  439. struct scatterlist sg;
  440. if (test->card->host->max_blk_count == 1)
  441. return RESULT_UNSUP_HOST;
  442. size = PAGE_SIZE * 2;
  443. size = min(size, test->card->host->max_req_size);
  444. size = min(size, test->card->host->max_seg_size);
  445. size = min(size, test->card->host->max_blk_count * 512);
  446. if (size < 1024)
  447. return RESULT_UNSUP_HOST;
  448. sg_init_one(&sg, test->buffer, size);
  449. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
  450. if (ret)
  451. return ret;
  452. return 0;
  453. }
  454. static int mmc_test_pow2_write(struct mmc_test_card *test)
  455. {
  456. int ret, i;
  457. struct scatterlist sg;
  458. if (!test->card->csd.write_partial)
  459. return RESULT_UNSUP_CARD;
  460. for (i = 1; i < 512;i <<= 1) {
  461. sg_init_one(&sg, test->buffer, i);
  462. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
  463. if (ret)
  464. return ret;
  465. }
  466. return 0;
  467. }
  468. static int mmc_test_pow2_read(struct mmc_test_card *test)
  469. {
  470. int ret, i;
  471. struct scatterlist sg;
  472. if (!test->card->csd.read_partial)
  473. return RESULT_UNSUP_CARD;
  474. for (i = 1; i < 512;i <<= 1) {
  475. sg_init_one(&sg, test->buffer, i);
  476. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
  477. if (ret)
  478. return ret;
  479. }
  480. return 0;
  481. }
  482. static int mmc_test_weird_write(struct mmc_test_card *test)
  483. {
  484. int ret, i;
  485. struct scatterlist sg;
  486. if (!test->card->csd.write_partial)
  487. return RESULT_UNSUP_CARD;
  488. for (i = 3; i < 512;i += 7) {
  489. sg_init_one(&sg, test->buffer, i);
  490. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
  491. if (ret)
  492. return ret;
  493. }
  494. return 0;
  495. }
  496. static int mmc_test_weird_read(struct mmc_test_card *test)
  497. {
  498. int ret, i;
  499. struct scatterlist sg;
  500. if (!test->card->csd.read_partial)
  501. return RESULT_UNSUP_CARD;
  502. for (i = 3; i < 512;i += 7) {
  503. sg_init_one(&sg, test->buffer, i);
  504. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
  505. if (ret)
  506. return ret;
  507. }
  508. return 0;
  509. }
  510. static int mmc_test_align_write(struct mmc_test_card *test)
  511. {
  512. int ret, i;
  513. struct scatterlist sg;
  514. for (i = 1;i < 4;i++) {
  515. sg_init_one(&sg, test->buffer + i, 512);
  516. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
  517. if (ret)
  518. return ret;
  519. }
  520. return 0;
  521. }
  522. static int mmc_test_align_read(struct mmc_test_card *test)
  523. {
  524. int ret, i;
  525. struct scatterlist sg;
  526. for (i = 1;i < 4;i++) {
  527. sg_init_one(&sg, test->buffer + i, 512);
  528. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
  529. if (ret)
  530. return ret;
  531. }
  532. return 0;
  533. }
  534. static int mmc_test_align_multi_write(struct mmc_test_card *test)
  535. {
  536. int ret, i;
  537. unsigned int size;
  538. struct scatterlist sg;
  539. if (test->card->host->max_blk_count == 1)
  540. return RESULT_UNSUP_HOST;
  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. if (size < 1024)
  546. return RESULT_UNSUP_HOST;
  547. for (i = 1;i < 4;i++) {
  548. sg_init_one(&sg, test->buffer + i, size);
  549. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
  550. if (ret)
  551. return ret;
  552. }
  553. return 0;
  554. }
  555. static int mmc_test_align_multi_read(struct mmc_test_card *test)
  556. {
  557. int ret, i;
  558. unsigned int size;
  559. struct scatterlist sg;
  560. if (test->card->host->max_blk_count == 1)
  561. return RESULT_UNSUP_HOST;
  562. size = PAGE_SIZE * 2;
  563. size = min(size, test->card->host->max_req_size);
  564. size = min(size, test->card->host->max_seg_size);
  565. size = min(size, test->card->host->max_blk_count * 512);
  566. if (size < 1024)
  567. return RESULT_UNSUP_HOST;
  568. for (i = 1;i < 4;i++) {
  569. sg_init_one(&sg, test->buffer + i, size);
  570. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
  571. if (ret)
  572. return ret;
  573. }
  574. return 0;
  575. }
  576. static int mmc_test_xfersize_write(struct mmc_test_card *test)
  577. {
  578. int ret;
  579. ret = mmc_test_set_blksize(test, 512);
  580. if (ret)
  581. return ret;
  582. ret = mmc_test_broken_transfer(test, 1, 512, 1);
  583. if (ret)
  584. return ret;
  585. return 0;
  586. }
  587. static int mmc_test_xfersize_read(struct mmc_test_card *test)
  588. {
  589. int ret;
  590. ret = mmc_test_set_blksize(test, 512);
  591. if (ret)
  592. return ret;
  593. ret = mmc_test_broken_transfer(test, 1, 512, 0);
  594. if (ret)
  595. return ret;
  596. return 0;
  597. }
  598. static int mmc_test_multi_xfersize_write(struct mmc_test_card *test)
  599. {
  600. int ret;
  601. if (test->card->host->max_blk_count == 1)
  602. return RESULT_UNSUP_HOST;
  603. ret = mmc_test_set_blksize(test, 512);
  604. if (ret)
  605. return ret;
  606. ret = mmc_test_broken_transfer(test, 2, 512, 1);
  607. if (ret)
  608. return ret;
  609. return 0;
  610. }
  611. static int mmc_test_multi_xfersize_read(struct mmc_test_card *test)
  612. {
  613. int ret;
  614. if (test->card->host->max_blk_count == 1)
  615. return RESULT_UNSUP_HOST;
  616. ret = mmc_test_set_blksize(test, 512);
  617. if (ret)
  618. return ret;
  619. ret = mmc_test_broken_transfer(test, 2, 512, 0);
  620. if (ret)
  621. return ret;
  622. return 0;
  623. }
  624. static const struct mmc_test_case mmc_test_cases[] = {
  625. {
  626. .name = "Basic write (no data verification)",
  627. .run = mmc_test_basic_write,
  628. },
  629. {
  630. .name = "Basic read (no data verification)",
  631. .run = mmc_test_basic_read,
  632. },
  633. {
  634. .name = "Basic write (with data verification)",
  635. .prepare = mmc_test_prepare_write,
  636. .run = mmc_test_verify_write,
  637. .cleanup = mmc_test_cleanup,
  638. },
  639. {
  640. .name = "Basic read (with data verification)",
  641. .prepare = mmc_test_prepare_read,
  642. .run = mmc_test_verify_read,
  643. .cleanup = mmc_test_cleanup,
  644. },
  645. {
  646. .name = "Multi-block write",
  647. .prepare = mmc_test_prepare_write,
  648. .run = mmc_test_multi_write,
  649. .cleanup = mmc_test_cleanup,
  650. },
  651. {
  652. .name = "Multi-block read",
  653. .prepare = mmc_test_prepare_read,
  654. .run = mmc_test_multi_read,
  655. .cleanup = mmc_test_cleanup,
  656. },
  657. {
  658. .name = "Power of two block writes",
  659. .prepare = mmc_test_prepare_write,
  660. .run = mmc_test_pow2_write,
  661. .cleanup = mmc_test_cleanup,
  662. },
  663. {
  664. .name = "Power of two block reads",
  665. .prepare = mmc_test_prepare_read,
  666. .run = mmc_test_pow2_read,
  667. .cleanup = mmc_test_cleanup,
  668. },
  669. {
  670. .name = "Weird sized block writes",
  671. .prepare = mmc_test_prepare_write,
  672. .run = mmc_test_weird_write,
  673. .cleanup = mmc_test_cleanup,
  674. },
  675. {
  676. .name = "Weird sized block reads",
  677. .prepare = mmc_test_prepare_read,
  678. .run = mmc_test_weird_read,
  679. .cleanup = mmc_test_cleanup,
  680. },
  681. {
  682. .name = "Badly aligned write",
  683. .prepare = mmc_test_prepare_write,
  684. .run = mmc_test_align_write,
  685. .cleanup = mmc_test_cleanup,
  686. },
  687. {
  688. .name = "Badly aligned read",
  689. .prepare = mmc_test_prepare_read,
  690. .run = mmc_test_align_read,
  691. .cleanup = mmc_test_cleanup,
  692. },
  693. {
  694. .name = "Badly aligned multi-block write",
  695. .prepare = mmc_test_prepare_write,
  696. .run = mmc_test_align_multi_write,
  697. .cleanup = mmc_test_cleanup,
  698. },
  699. {
  700. .name = "Badly aligned multi-block read",
  701. .prepare = mmc_test_prepare_read,
  702. .run = mmc_test_align_multi_read,
  703. .cleanup = mmc_test_cleanup,
  704. },
  705. {
  706. .name = "Correct xfer_size at write (start failure)",
  707. .run = mmc_test_xfersize_write,
  708. },
  709. {
  710. .name = "Correct xfer_size at read (start failure)",
  711. .run = mmc_test_xfersize_read,
  712. },
  713. {
  714. .name = "Correct xfer_size at write (midway failure)",
  715. .run = mmc_test_multi_xfersize_write,
  716. },
  717. {
  718. .name = "Correct xfer_size at read (midway failure)",
  719. .run = mmc_test_multi_xfersize_read,
  720. },
  721. };
  722. static struct mutex mmc_test_lock;
  723. static void mmc_test_run(struct mmc_test_card *test, int testcase)
  724. {
  725. int i, ret;
  726. printk(KERN_INFO "%s: Starting tests of card %s...\n",
  727. mmc_hostname(test->card->host), mmc_card_id(test->card));
  728. mmc_claim_host(test->card->host);
  729. for (i = 0;i < ARRAY_SIZE(mmc_test_cases);i++) {
  730. if (testcase && ((i + 1) != testcase))
  731. continue;
  732. printk(KERN_INFO "%s: Test case %d. %s...\n",
  733. mmc_hostname(test->card->host), i + 1,
  734. mmc_test_cases[i].name);
  735. if (mmc_test_cases[i].prepare) {
  736. ret = mmc_test_cases[i].prepare(test);
  737. if (ret) {
  738. printk(KERN_INFO "%s: Result: Prepare "
  739. "stage failed! (%d)\n",
  740. mmc_hostname(test->card->host),
  741. ret);
  742. continue;
  743. }
  744. }
  745. ret = mmc_test_cases[i].run(test);
  746. switch (ret) {
  747. case RESULT_OK:
  748. printk(KERN_INFO "%s: Result: OK\n",
  749. mmc_hostname(test->card->host));
  750. break;
  751. case RESULT_FAIL:
  752. printk(KERN_INFO "%s: Result: FAILED\n",
  753. mmc_hostname(test->card->host));
  754. break;
  755. case RESULT_UNSUP_HOST:
  756. printk(KERN_INFO "%s: Result: UNSUPPORTED "
  757. "(by host)\n",
  758. mmc_hostname(test->card->host));
  759. break;
  760. case RESULT_UNSUP_CARD:
  761. printk(KERN_INFO "%s: Result: UNSUPPORTED "
  762. "(by card)\n",
  763. mmc_hostname(test->card->host));
  764. break;
  765. default:
  766. printk(KERN_INFO "%s: Result: ERROR (%d)\n",
  767. mmc_hostname(test->card->host), ret);
  768. }
  769. if (mmc_test_cases[i].cleanup) {
  770. ret = mmc_test_cases[i].cleanup(test);
  771. if (ret) {
  772. printk(KERN_INFO "%s: Warning: Cleanup "
  773. "stage failed! (%d)\n",
  774. mmc_hostname(test->card->host),
  775. ret);
  776. }
  777. }
  778. }
  779. mmc_release_host(test->card->host);
  780. printk(KERN_INFO "%s: Tests completed.\n",
  781. mmc_hostname(test->card->host));
  782. }
  783. static ssize_t mmc_test_show(struct device *dev,
  784. struct device_attribute *attr, char *buf)
  785. {
  786. mutex_lock(&mmc_test_lock);
  787. mutex_unlock(&mmc_test_lock);
  788. return 0;
  789. }
  790. static ssize_t mmc_test_store(struct device *dev,
  791. struct device_attribute *attr, const char *buf, size_t count)
  792. {
  793. struct mmc_card *card;
  794. struct mmc_test_card *test;
  795. int testcase;
  796. card = container_of(dev, struct mmc_card, dev);
  797. testcase = simple_strtol(buf, NULL, 10);
  798. test = kzalloc(sizeof(struct mmc_test_card), GFP_KERNEL);
  799. if (!test)
  800. return -ENOMEM;
  801. test->card = card;
  802. test->buffer = kzalloc(BUFFER_SIZE, GFP_KERNEL);
  803. if (test->buffer) {
  804. mutex_lock(&mmc_test_lock);
  805. mmc_test_run(test, testcase);
  806. mutex_unlock(&mmc_test_lock);
  807. }
  808. kfree(test->buffer);
  809. kfree(test);
  810. return count;
  811. }
  812. static DEVICE_ATTR(test, S_IWUSR | S_IRUGO, mmc_test_show, mmc_test_store);
  813. static int mmc_test_probe(struct mmc_card *card)
  814. {
  815. int ret;
  816. if ((card->type != MMC_TYPE_MMC) && (card->type != MMC_TYPE_SD))
  817. return -ENODEV;
  818. mutex_init(&mmc_test_lock);
  819. ret = device_create_file(&card->dev, &dev_attr_test);
  820. if (ret)
  821. return ret;
  822. return 0;
  823. }
  824. static void mmc_test_remove(struct mmc_card *card)
  825. {
  826. device_remove_file(&card->dev, &dev_attr_test);
  827. }
  828. static struct mmc_driver mmc_driver = {
  829. .drv = {
  830. .name = "mmc_test",
  831. },
  832. .probe = mmc_test_probe,
  833. .remove = mmc_test_remove,
  834. };
  835. static int __init mmc_test_init(void)
  836. {
  837. return mmc_register_driver(&mmc_driver);
  838. }
  839. static void __exit mmc_test_exit(void)
  840. {
  841. mmc_unregister_driver(&mmc_driver);
  842. }
  843. module_init(mmc_test_init);
  844. module_exit(mmc_test_exit);
  845. MODULE_LICENSE("GPL");
  846. MODULE_DESCRIPTION("Multimedia Card (MMC) host test driver");
  847. MODULE_AUTHOR("Pierre Ossman");