mmc_test.c 49 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275
  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/slab.h>
  16. #include <linux/scatterlist.h>
  17. #include <linux/swap.h> /* For nr_free_buffer_pages() */
  18. #include <linux/list.h>
  19. #define RESULT_OK 0
  20. #define RESULT_FAIL 1
  21. #define RESULT_UNSUP_HOST 2
  22. #define RESULT_UNSUP_CARD 3
  23. #define BUFFER_ORDER 2
  24. #define BUFFER_SIZE (PAGE_SIZE << BUFFER_ORDER)
  25. /*
  26. * Limit the test area size to the maximum MMC HC erase group size. Note that
  27. * the maximum SD allocation unit size is just 4MiB.
  28. */
  29. #define TEST_AREA_MAX_SIZE (128 * 1024 * 1024)
  30. /**
  31. * struct mmc_test_pages - pages allocated by 'alloc_pages()'.
  32. * @page: first page in the allocation
  33. * @order: order of the number of pages allocated
  34. */
  35. struct mmc_test_pages {
  36. struct page *page;
  37. unsigned int order;
  38. };
  39. /**
  40. * struct mmc_test_mem - allocated memory.
  41. * @arr: array of allocations
  42. * @cnt: number of allocations
  43. */
  44. struct mmc_test_mem {
  45. struct mmc_test_pages *arr;
  46. unsigned int cnt;
  47. };
  48. /**
  49. * struct mmc_test_area - information for performance tests.
  50. * @max_sz: test area size (in bytes)
  51. * @dev_addr: address on card at which to do performance tests
  52. * @max_tfr: maximum transfer size allowed by driver (in bytes)
  53. * @max_segs: maximum segments allowed by driver in scatterlist @sg
  54. * @max_seg_sz: maximum segment size allowed by driver
  55. * @blocks: number of (512 byte) blocks currently mapped by @sg
  56. * @sg_len: length of currently mapped scatterlist @sg
  57. * @mem: allocated memory
  58. * @sg: scatterlist
  59. */
  60. struct mmc_test_area {
  61. unsigned long max_sz;
  62. unsigned int dev_addr;
  63. unsigned int max_tfr;
  64. unsigned int max_segs;
  65. unsigned int max_seg_sz;
  66. unsigned int blocks;
  67. unsigned int sg_len;
  68. struct mmc_test_mem *mem;
  69. struct scatterlist *sg;
  70. };
  71. /**
  72. * struct mmc_test_transfer_result - transfer results for performance tests.
  73. * @link: double-linked list
  74. * @count: amount of group of sectors to check
  75. * @sectors: amount of sectors to check in one group
  76. * @ts: time values of transfer
  77. * @rate: calculated transfer rate
  78. */
  79. struct mmc_test_transfer_result {
  80. struct list_head link;
  81. unsigned int count;
  82. unsigned int sectors;
  83. struct timespec ts;
  84. unsigned int rate;
  85. };
  86. /**
  87. * struct mmc_test_general_result - results for tests.
  88. * @link: double-linked list
  89. * @card: card under test
  90. * @testcase: number of test case
  91. * @result: result of test run
  92. * @tr_lst: transfer measurements if any as mmc_test_transfer_result
  93. */
  94. struct mmc_test_general_result {
  95. struct list_head link;
  96. struct mmc_card *card;
  97. int testcase;
  98. int result;
  99. struct list_head tr_lst;
  100. };
  101. /**
  102. * struct mmc_test_card - test information.
  103. * @card: card under test
  104. * @scratch: transfer buffer
  105. * @buffer: transfer buffer
  106. * @highmem: buffer for highmem tests
  107. * @area: information for performance tests
  108. * @gr: pointer to results of current testcase
  109. */
  110. struct mmc_test_card {
  111. struct mmc_card *card;
  112. u8 scratch[BUFFER_SIZE];
  113. u8 *buffer;
  114. #ifdef CONFIG_HIGHMEM
  115. struct page *highmem;
  116. #endif
  117. struct mmc_test_area area;
  118. struct mmc_test_general_result *gr;
  119. };
  120. /*******************************************************************/
  121. /* General helper functions */
  122. /*******************************************************************/
  123. /*
  124. * Configure correct block size in card
  125. */
  126. static int mmc_test_set_blksize(struct mmc_test_card *test, unsigned size)
  127. {
  128. struct mmc_command cmd;
  129. int ret;
  130. cmd.opcode = MMC_SET_BLOCKLEN;
  131. cmd.arg = size;
  132. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  133. ret = mmc_wait_for_cmd(test->card->host, &cmd, 0);
  134. if (ret)
  135. return ret;
  136. return 0;
  137. }
  138. /*
  139. * Fill in the mmc_request structure given a set of transfer parameters.
  140. */
  141. static void mmc_test_prepare_mrq(struct mmc_test_card *test,
  142. struct mmc_request *mrq, struct scatterlist *sg, unsigned sg_len,
  143. unsigned dev_addr, unsigned blocks, unsigned blksz, int write)
  144. {
  145. BUG_ON(!mrq || !mrq->cmd || !mrq->data || !mrq->stop);
  146. if (blocks > 1) {
  147. mrq->cmd->opcode = write ?
  148. MMC_WRITE_MULTIPLE_BLOCK : MMC_READ_MULTIPLE_BLOCK;
  149. } else {
  150. mrq->cmd->opcode = write ?
  151. MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
  152. }
  153. mrq->cmd->arg = dev_addr;
  154. if (!mmc_card_blockaddr(test->card))
  155. mrq->cmd->arg <<= 9;
  156. mrq->cmd->flags = MMC_RSP_R1 | MMC_CMD_ADTC;
  157. if (blocks == 1)
  158. mrq->stop = NULL;
  159. else {
  160. mrq->stop->opcode = MMC_STOP_TRANSMISSION;
  161. mrq->stop->arg = 0;
  162. mrq->stop->flags = MMC_RSP_R1B | MMC_CMD_AC;
  163. }
  164. mrq->data->blksz = blksz;
  165. mrq->data->blocks = blocks;
  166. mrq->data->flags = write ? MMC_DATA_WRITE : MMC_DATA_READ;
  167. mrq->data->sg = sg;
  168. mrq->data->sg_len = sg_len;
  169. mmc_set_data_timeout(mrq->data, test->card);
  170. }
  171. static int mmc_test_busy(struct mmc_command *cmd)
  172. {
  173. return !(cmd->resp[0] & R1_READY_FOR_DATA) ||
  174. (R1_CURRENT_STATE(cmd->resp[0]) == 7);
  175. }
  176. /*
  177. * Wait for the card to finish the busy state
  178. */
  179. static int mmc_test_wait_busy(struct mmc_test_card *test)
  180. {
  181. int ret, busy;
  182. struct mmc_command cmd;
  183. busy = 0;
  184. do {
  185. memset(&cmd, 0, sizeof(struct mmc_command));
  186. cmd.opcode = MMC_SEND_STATUS;
  187. cmd.arg = test->card->rca << 16;
  188. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  189. ret = mmc_wait_for_cmd(test->card->host, &cmd, 0);
  190. if (ret)
  191. break;
  192. if (!busy && mmc_test_busy(&cmd)) {
  193. busy = 1;
  194. printk(KERN_INFO "%s: Warning: Host did not "
  195. "wait for busy state to end.\n",
  196. mmc_hostname(test->card->host));
  197. }
  198. } while (mmc_test_busy(&cmd));
  199. return ret;
  200. }
  201. /*
  202. * Transfer a single sector of kernel addressable data
  203. */
  204. static int mmc_test_buffer_transfer(struct mmc_test_card *test,
  205. u8 *buffer, unsigned addr, unsigned blksz, int write)
  206. {
  207. int ret;
  208. struct mmc_request mrq;
  209. struct mmc_command cmd;
  210. struct mmc_command stop;
  211. struct mmc_data data;
  212. struct scatterlist sg;
  213. memset(&mrq, 0, sizeof(struct mmc_request));
  214. memset(&cmd, 0, sizeof(struct mmc_command));
  215. memset(&data, 0, sizeof(struct mmc_data));
  216. memset(&stop, 0, sizeof(struct mmc_command));
  217. mrq.cmd = &cmd;
  218. mrq.data = &data;
  219. mrq.stop = &stop;
  220. sg_init_one(&sg, buffer, blksz);
  221. mmc_test_prepare_mrq(test, &mrq, &sg, 1, addr, 1, blksz, write);
  222. mmc_wait_for_req(test->card->host, &mrq);
  223. if (cmd.error)
  224. return cmd.error;
  225. if (data.error)
  226. return data.error;
  227. ret = mmc_test_wait_busy(test);
  228. if (ret)
  229. return ret;
  230. return 0;
  231. }
  232. static void mmc_test_free_mem(struct mmc_test_mem *mem)
  233. {
  234. if (!mem)
  235. return;
  236. while (mem->cnt--)
  237. __free_pages(mem->arr[mem->cnt].page,
  238. mem->arr[mem->cnt].order);
  239. kfree(mem->arr);
  240. kfree(mem);
  241. }
  242. /*
  243. * Allocate a lot of memory, preferrably max_sz but at least min_sz. In case
  244. * there isn't much memory do not exceed 1/16th total lowmem pages. Also do
  245. * not exceed a maximum number of segments and try not to make segments much
  246. * bigger than maximum segment size.
  247. */
  248. static struct mmc_test_mem *mmc_test_alloc_mem(unsigned long min_sz,
  249. unsigned long max_sz,
  250. unsigned int max_segs,
  251. unsigned int max_seg_sz)
  252. {
  253. unsigned long max_page_cnt = DIV_ROUND_UP(max_sz, PAGE_SIZE);
  254. unsigned long min_page_cnt = DIV_ROUND_UP(min_sz, PAGE_SIZE);
  255. unsigned long max_seg_page_cnt = DIV_ROUND_UP(max_seg_sz, PAGE_SIZE);
  256. unsigned long page_cnt = 0;
  257. unsigned long limit = nr_free_buffer_pages() >> 4;
  258. struct mmc_test_mem *mem;
  259. if (max_page_cnt > limit)
  260. max_page_cnt = limit;
  261. if (max_page_cnt < min_page_cnt)
  262. max_page_cnt = min_page_cnt;
  263. if (max_seg_page_cnt > max_page_cnt)
  264. max_seg_page_cnt = max_page_cnt;
  265. if (max_segs > max_page_cnt)
  266. max_segs = max_page_cnt;
  267. mem = kzalloc(sizeof(struct mmc_test_mem), GFP_KERNEL);
  268. if (!mem)
  269. return NULL;
  270. mem->arr = kzalloc(sizeof(struct mmc_test_pages) * max_segs,
  271. GFP_KERNEL);
  272. if (!mem->arr)
  273. goto out_free;
  274. while (max_page_cnt) {
  275. struct page *page;
  276. unsigned int order;
  277. gfp_t flags = GFP_KERNEL | GFP_DMA | __GFP_NOWARN |
  278. __GFP_NORETRY;
  279. order = get_order(max_seg_page_cnt << PAGE_SHIFT);
  280. while (1) {
  281. page = alloc_pages(flags, order);
  282. if (page || !order)
  283. break;
  284. order -= 1;
  285. }
  286. if (!page) {
  287. if (page_cnt < min_page_cnt)
  288. goto out_free;
  289. break;
  290. }
  291. mem->arr[mem->cnt].page = page;
  292. mem->arr[mem->cnt].order = order;
  293. mem->cnt += 1;
  294. if (max_page_cnt <= (1UL << order))
  295. break;
  296. if (mem->cnt >= max_segs) {
  297. if (page_cnt < min_page_cnt)
  298. goto out_free;
  299. break;
  300. }
  301. max_page_cnt -= 1UL << order;
  302. page_cnt += 1UL << order;
  303. }
  304. return mem;
  305. out_free:
  306. mmc_test_free_mem(mem);
  307. return NULL;
  308. }
  309. /*
  310. * Map memory into a scatterlist. Optionally allow the same memory to be
  311. * mapped more than once.
  312. */
  313. static int mmc_test_map_sg(struct mmc_test_mem *mem, unsigned long sz,
  314. struct scatterlist *sglist, int repeat,
  315. unsigned int max_segs, unsigned int max_seg_sz,
  316. unsigned int *sg_len)
  317. {
  318. struct scatterlist *sg = NULL;
  319. unsigned int i;
  320. sg_init_table(sglist, max_segs);
  321. *sg_len = 0;
  322. do {
  323. for (i = 0; i < mem->cnt; i++) {
  324. unsigned long len = PAGE_SIZE << mem->arr[i].order;
  325. if (len > sz)
  326. len = sz;
  327. if (len > max_seg_sz)
  328. len = max_seg_sz;
  329. if (sg)
  330. sg = sg_next(sg);
  331. else
  332. sg = sglist;
  333. if (!sg)
  334. return -EINVAL;
  335. sg_set_page(sg, mem->arr[i].page, len, 0);
  336. sz -= len;
  337. *sg_len += 1;
  338. if (!sz)
  339. break;
  340. }
  341. } while (sz && repeat);
  342. if (sz)
  343. return -EINVAL;
  344. if (sg)
  345. sg_mark_end(sg);
  346. return 0;
  347. }
  348. /*
  349. * Map memory into a scatterlist so that no pages are contiguous. Allow the
  350. * same memory to be mapped more than once.
  351. */
  352. static int mmc_test_map_sg_max_scatter(struct mmc_test_mem *mem,
  353. unsigned long sz,
  354. struct scatterlist *sglist,
  355. unsigned int max_segs,
  356. unsigned int max_seg_sz,
  357. unsigned int *sg_len)
  358. {
  359. struct scatterlist *sg = NULL;
  360. unsigned int i = mem->cnt, cnt;
  361. unsigned long len;
  362. void *base, *addr, *last_addr = NULL;
  363. sg_init_table(sglist, max_segs);
  364. *sg_len = 0;
  365. while (sz) {
  366. base = page_address(mem->arr[--i].page);
  367. cnt = 1 << mem->arr[i].order;
  368. while (sz && cnt) {
  369. addr = base + PAGE_SIZE * --cnt;
  370. if (last_addr && last_addr + PAGE_SIZE == addr)
  371. continue;
  372. last_addr = addr;
  373. len = PAGE_SIZE;
  374. if (len > max_seg_sz)
  375. len = max_seg_sz;
  376. if (len > sz)
  377. len = sz;
  378. if (sg)
  379. sg = sg_next(sg);
  380. else
  381. sg = sglist;
  382. if (!sg)
  383. return -EINVAL;
  384. sg_set_page(sg, virt_to_page(addr), len, 0);
  385. sz -= len;
  386. *sg_len += 1;
  387. }
  388. if (i == 0)
  389. i = mem->cnt;
  390. }
  391. if (sg)
  392. sg_mark_end(sg);
  393. return 0;
  394. }
  395. /*
  396. * Calculate transfer rate in bytes per second.
  397. */
  398. static unsigned int mmc_test_rate(uint64_t bytes, struct timespec *ts)
  399. {
  400. uint64_t ns;
  401. ns = ts->tv_sec;
  402. ns *= 1000000000;
  403. ns += ts->tv_nsec;
  404. bytes *= 1000000000;
  405. while (ns > UINT_MAX) {
  406. bytes >>= 1;
  407. ns >>= 1;
  408. }
  409. if (!ns)
  410. return 0;
  411. do_div(bytes, (uint32_t)ns);
  412. return bytes;
  413. }
  414. /*
  415. * Save transfer results for future usage
  416. */
  417. static void mmc_test_save_transfer_result(struct mmc_test_card *test,
  418. unsigned int count, unsigned int sectors, struct timespec ts,
  419. unsigned int rate)
  420. {
  421. struct mmc_test_transfer_result *tr;
  422. if (!test->gr)
  423. return;
  424. tr = kmalloc(sizeof(struct mmc_test_transfer_result), GFP_KERNEL);
  425. if (!tr)
  426. return;
  427. tr->count = count;
  428. tr->sectors = sectors;
  429. tr->ts = ts;
  430. tr->rate = rate;
  431. list_add_tail(&tr->link, &test->gr->tr_lst);
  432. }
  433. /*
  434. * Print the transfer rate.
  435. */
  436. static void mmc_test_print_rate(struct mmc_test_card *test, uint64_t bytes,
  437. struct timespec *ts1, struct timespec *ts2)
  438. {
  439. unsigned int rate, sectors = bytes >> 9;
  440. struct timespec ts;
  441. ts = timespec_sub(*ts2, *ts1);
  442. rate = mmc_test_rate(bytes, &ts);
  443. printk(KERN_INFO "%s: Transfer of %u sectors (%u%s KiB) took %lu.%09lu "
  444. "seconds (%u kB/s, %u KiB/s)\n",
  445. mmc_hostname(test->card->host), sectors, sectors >> 1,
  446. (sectors == 1 ? ".5" : ""), (unsigned long)ts.tv_sec,
  447. (unsigned long)ts.tv_nsec, rate / 1000, rate / 1024);
  448. mmc_test_save_transfer_result(test, 1, sectors, ts, rate);
  449. }
  450. /*
  451. * Print the average transfer rate.
  452. */
  453. static void mmc_test_print_avg_rate(struct mmc_test_card *test, uint64_t bytes,
  454. unsigned int count, struct timespec *ts1,
  455. struct timespec *ts2)
  456. {
  457. unsigned int rate, sectors = bytes >> 9;
  458. uint64_t tot = bytes * count;
  459. struct timespec ts;
  460. ts = timespec_sub(*ts2, *ts1);
  461. rate = mmc_test_rate(tot, &ts);
  462. printk(KERN_INFO "%s: Transfer of %u x %u sectors (%u x %u%s KiB) took "
  463. "%lu.%09lu seconds (%u kB/s, %u KiB/s)\n",
  464. mmc_hostname(test->card->host), count, sectors, count,
  465. sectors >> 1, (sectors == 1 ? ".5" : ""),
  466. (unsigned long)ts.tv_sec, (unsigned long)ts.tv_nsec,
  467. rate / 1000, rate / 1024);
  468. mmc_test_save_transfer_result(test, count, sectors, ts, rate);
  469. }
  470. /*
  471. * Return the card size in sectors.
  472. */
  473. static unsigned int mmc_test_capacity(struct mmc_card *card)
  474. {
  475. if (!mmc_card_sd(card) && mmc_card_blockaddr(card))
  476. return card->ext_csd.sectors;
  477. else
  478. return card->csd.capacity << (card->csd.read_blkbits - 9);
  479. }
  480. /*******************************************************************/
  481. /* Test preparation and cleanup */
  482. /*******************************************************************/
  483. /*
  484. * Fill the first couple of sectors of the card with known data
  485. * so that bad reads/writes can be detected
  486. */
  487. static int __mmc_test_prepare(struct mmc_test_card *test, int write)
  488. {
  489. int ret, i;
  490. ret = mmc_test_set_blksize(test, 512);
  491. if (ret)
  492. return ret;
  493. if (write)
  494. memset(test->buffer, 0xDF, 512);
  495. else {
  496. for (i = 0;i < 512;i++)
  497. test->buffer[i] = i;
  498. }
  499. for (i = 0;i < BUFFER_SIZE / 512;i++) {
  500. ret = mmc_test_buffer_transfer(test, test->buffer, i, 512, 1);
  501. if (ret)
  502. return ret;
  503. }
  504. return 0;
  505. }
  506. static int mmc_test_prepare_write(struct mmc_test_card *test)
  507. {
  508. return __mmc_test_prepare(test, 1);
  509. }
  510. static int mmc_test_prepare_read(struct mmc_test_card *test)
  511. {
  512. return __mmc_test_prepare(test, 0);
  513. }
  514. static int mmc_test_cleanup(struct mmc_test_card *test)
  515. {
  516. int ret, i;
  517. ret = mmc_test_set_blksize(test, 512);
  518. if (ret)
  519. return ret;
  520. memset(test->buffer, 0, 512);
  521. for (i = 0;i < BUFFER_SIZE / 512;i++) {
  522. ret = mmc_test_buffer_transfer(test, test->buffer, i, 512, 1);
  523. if (ret)
  524. return ret;
  525. }
  526. return 0;
  527. }
  528. /*******************************************************************/
  529. /* Test execution helpers */
  530. /*******************************************************************/
  531. /*
  532. * Modifies the mmc_request to perform the "short transfer" tests
  533. */
  534. static void mmc_test_prepare_broken_mrq(struct mmc_test_card *test,
  535. struct mmc_request *mrq, int write)
  536. {
  537. BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  538. if (mrq->data->blocks > 1) {
  539. mrq->cmd->opcode = write ?
  540. MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
  541. mrq->stop = NULL;
  542. } else {
  543. mrq->cmd->opcode = MMC_SEND_STATUS;
  544. mrq->cmd->arg = test->card->rca << 16;
  545. }
  546. }
  547. /*
  548. * Checks that a normal transfer didn't have any errors
  549. */
  550. static int mmc_test_check_result(struct mmc_test_card *test,
  551. struct mmc_request *mrq)
  552. {
  553. int ret;
  554. BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  555. ret = 0;
  556. if (!ret && mrq->cmd->error)
  557. ret = mrq->cmd->error;
  558. if (!ret && mrq->data->error)
  559. ret = mrq->data->error;
  560. if (!ret && mrq->stop && mrq->stop->error)
  561. ret = mrq->stop->error;
  562. if (!ret && mrq->data->bytes_xfered !=
  563. mrq->data->blocks * mrq->data->blksz)
  564. ret = RESULT_FAIL;
  565. if (ret == -EINVAL)
  566. ret = RESULT_UNSUP_HOST;
  567. return ret;
  568. }
  569. /*
  570. * Checks that a "short transfer" behaved as expected
  571. */
  572. static int mmc_test_check_broken_result(struct mmc_test_card *test,
  573. struct mmc_request *mrq)
  574. {
  575. int ret;
  576. BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  577. ret = 0;
  578. if (!ret && mrq->cmd->error)
  579. ret = mrq->cmd->error;
  580. if (!ret && mrq->data->error == 0)
  581. ret = RESULT_FAIL;
  582. if (!ret && mrq->data->error != -ETIMEDOUT)
  583. ret = mrq->data->error;
  584. if (!ret && mrq->stop && mrq->stop->error)
  585. ret = mrq->stop->error;
  586. if (mrq->data->blocks > 1) {
  587. if (!ret && mrq->data->bytes_xfered > mrq->data->blksz)
  588. ret = RESULT_FAIL;
  589. } else {
  590. if (!ret && mrq->data->bytes_xfered > 0)
  591. ret = RESULT_FAIL;
  592. }
  593. if (ret == -EINVAL)
  594. ret = RESULT_UNSUP_HOST;
  595. return ret;
  596. }
  597. /*
  598. * Tests a basic transfer with certain parameters
  599. */
  600. static int mmc_test_simple_transfer(struct mmc_test_card *test,
  601. struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
  602. unsigned blocks, unsigned blksz, int write)
  603. {
  604. struct mmc_request mrq;
  605. struct mmc_command cmd;
  606. struct mmc_command stop;
  607. struct mmc_data data;
  608. memset(&mrq, 0, sizeof(struct mmc_request));
  609. memset(&cmd, 0, sizeof(struct mmc_command));
  610. memset(&data, 0, sizeof(struct mmc_data));
  611. memset(&stop, 0, sizeof(struct mmc_command));
  612. mrq.cmd = &cmd;
  613. mrq.data = &data;
  614. mrq.stop = &stop;
  615. mmc_test_prepare_mrq(test, &mrq, sg, sg_len, dev_addr,
  616. blocks, blksz, write);
  617. mmc_wait_for_req(test->card->host, &mrq);
  618. mmc_test_wait_busy(test);
  619. return mmc_test_check_result(test, &mrq);
  620. }
  621. /*
  622. * Tests a transfer where the card will fail completely or partly
  623. */
  624. static int mmc_test_broken_transfer(struct mmc_test_card *test,
  625. unsigned blocks, unsigned blksz, int write)
  626. {
  627. struct mmc_request mrq;
  628. struct mmc_command cmd;
  629. struct mmc_command stop;
  630. struct mmc_data data;
  631. struct scatterlist sg;
  632. memset(&mrq, 0, sizeof(struct mmc_request));
  633. memset(&cmd, 0, sizeof(struct mmc_command));
  634. memset(&data, 0, sizeof(struct mmc_data));
  635. memset(&stop, 0, sizeof(struct mmc_command));
  636. mrq.cmd = &cmd;
  637. mrq.data = &data;
  638. mrq.stop = &stop;
  639. sg_init_one(&sg, test->buffer, blocks * blksz);
  640. mmc_test_prepare_mrq(test, &mrq, &sg, 1, 0, blocks, blksz, write);
  641. mmc_test_prepare_broken_mrq(test, &mrq, write);
  642. mmc_wait_for_req(test->card->host, &mrq);
  643. mmc_test_wait_busy(test);
  644. return mmc_test_check_broken_result(test, &mrq);
  645. }
  646. /*
  647. * Does a complete transfer test where data is also validated
  648. *
  649. * Note: mmc_test_prepare() must have been done before this call
  650. */
  651. static int mmc_test_transfer(struct mmc_test_card *test,
  652. struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
  653. unsigned blocks, unsigned blksz, int write)
  654. {
  655. int ret, i;
  656. unsigned long flags;
  657. if (write) {
  658. for (i = 0;i < blocks * blksz;i++)
  659. test->scratch[i] = i;
  660. } else {
  661. memset(test->scratch, 0, BUFFER_SIZE);
  662. }
  663. local_irq_save(flags);
  664. sg_copy_from_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
  665. local_irq_restore(flags);
  666. ret = mmc_test_set_blksize(test, blksz);
  667. if (ret)
  668. return ret;
  669. ret = mmc_test_simple_transfer(test, sg, sg_len, dev_addr,
  670. blocks, blksz, write);
  671. if (ret)
  672. return ret;
  673. if (write) {
  674. int sectors;
  675. ret = mmc_test_set_blksize(test, 512);
  676. if (ret)
  677. return ret;
  678. sectors = (blocks * blksz + 511) / 512;
  679. if ((sectors * 512) == (blocks * blksz))
  680. sectors++;
  681. if ((sectors * 512) > BUFFER_SIZE)
  682. return -EINVAL;
  683. memset(test->buffer, 0, sectors * 512);
  684. for (i = 0;i < sectors;i++) {
  685. ret = mmc_test_buffer_transfer(test,
  686. test->buffer + i * 512,
  687. dev_addr + i, 512, 0);
  688. if (ret)
  689. return ret;
  690. }
  691. for (i = 0;i < blocks * blksz;i++) {
  692. if (test->buffer[i] != (u8)i)
  693. return RESULT_FAIL;
  694. }
  695. for (;i < sectors * 512;i++) {
  696. if (test->buffer[i] != 0xDF)
  697. return RESULT_FAIL;
  698. }
  699. } else {
  700. local_irq_save(flags);
  701. sg_copy_to_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
  702. local_irq_restore(flags);
  703. for (i = 0;i < blocks * blksz;i++) {
  704. if (test->scratch[i] != (u8)i)
  705. return RESULT_FAIL;
  706. }
  707. }
  708. return 0;
  709. }
  710. /*******************************************************************/
  711. /* Tests */
  712. /*******************************************************************/
  713. struct mmc_test_case {
  714. const char *name;
  715. int (*prepare)(struct mmc_test_card *);
  716. int (*run)(struct mmc_test_card *);
  717. int (*cleanup)(struct mmc_test_card *);
  718. };
  719. static int mmc_test_basic_write(struct mmc_test_card *test)
  720. {
  721. int ret;
  722. struct scatterlist sg;
  723. ret = mmc_test_set_blksize(test, 512);
  724. if (ret)
  725. return ret;
  726. sg_init_one(&sg, test->buffer, 512);
  727. ret = mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 1);
  728. if (ret)
  729. return ret;
  730. return 0;
  731. }
  732. static int mmc_test_basic_read(struct mmc_test_card *test)
  733. {
  734. int ret;
  735. struct scatterlist sg;
  736. ret = mmc_test_set_blksize(test, 512);
  737. if (ret)
  738. return ret;
  739. sg_init_one(&sg, test->buffer, 512);
  740. ret = mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 0);
  741. if (ret)
  742. return ret;
  743. return 0;
  744. }
  745. static int mmc_test_verify_write(struct mmc_test_card *test)
  746. {
  747. int ret;
  748. struct scatterlist sg;
  749. sg_init_one(&sg, test->buffer, 512);
  750. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
  751. if (ret)
  752. return ret;
  753. return 0;
  754. }
  755. static int mmc_test_verify_read(struct mmc_test_card *test)
  756. {
  757. int ret;
  758. struct scatterlist sg;
  759. sg_init_one(&sg, test->buffer, 512);
  760. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
  761. if (ret)
  762. return ret;
  763. return 0;
  764. }
  765. static int mmc_test_multi_write(struct mmc_test_card *test)
  766. {
  767. int ret;
  768. unsigned int size;
  769. struct scatterlist sg;
  770. if (test->card->host->max_blk_count == 1)
  771. return RESULT_UNSUP_HOST;
  772. size = PAGE_SIZE * 2;
  773. size = min(size, test->card->host->max_req_size);
  774. size = min(size, test->card->host->max_seg_size);
  775. size = min(size, test->card->host->max_blk_count * 512);
  776. if (size < 1024)
  777. return RESULT_UNSUP_HOST;
  778. sg_init_one(&sg, test->buffer, size);
  779. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
  780. if (ret)
  781. return ret;
  782. return 0;
  783. }
  784. static int mmc_test_multi_read(struct mmc_test_card *test)
  785. {
  786. int ret;
  787. unsigned int size;
  788. struct scatterlist sg;
  789. if (test->card->host->max_blk_count == 1)
  790. return RESULT_UNSUP_HOST;
  791. size = PAGE_SIZE * 2;
  792. size = min(size, test->card->host->max_req_size);
  793. size = min(size, test->card->host->max_seg_size);
  794. size = min(size, test->card->host->max_blk_count * 512);
  795. if (size < 1024)
  796. return RESULT_UNSUP_HOST;
  797. sg_init_one(&sg, test->buffer, size);
  798. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
  799. if (ret)
  800. return ret;
  801. return 0;
  802. }
  803. static int mmc_test_pow2_write(struct mmc_test_card *test)
  804. {
  805. int ret, i;
  806. struct scatterlist sg;
  807. if (!test->card->csd.write_partial)
  808. return RESULT_UNSUP_CARD;
  809. for (i = 1; i < 512;i <<= 1) {
  810. sg_init_one(&sg, test->buffer, i);
  811. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
  812. if (ret)
  813. return ret;
  814. }
  815. return 0;
  816. }
  817. static int mmc_test_pow2_read(struct mmc_test_card *test)
  818. {
  819. int ret, i;
  820. struct scatterlist sg;
  821. if (!test->card->csd.read_partial)
  822. return RESULT_UNSUP_CARD;
  823. for (i = 1; i < 512;i <<= 1) {
  824. sg_init_one(&sg, test->buffer, i);
  825. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
  826. if (ret)
  827. return ret;
  828. }
  829. return 0;
  830. }
  831. static int mmc_test_weird_write(struct mmc_test_card *test)
  832. {
  833. int ret, i;
  834. struct scatterlist sg;
  835. if (!test->card->csd.write_partial)
  836. return RESULT_UNSUP_CARD;
  837. for (i = 3; i < 512;i += 7) {
  838. sg_init_one(&sg, test->buffer, i);
  839. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
  840. if (ret)
  841. return ret;
  842. }
  843. return 0;
  844. }
  845. static int mmc_test_weird_read(struct mmc_test_card *test)
  846. {
  847. int ret, i;
  848. struct scatterlist sg;
  849. if (!test->card->csd.read_partial)
  850. return RESULT_UNSUP_CARD;
  851. for (i = 3; i < 512;i += 7) {
  852. sg_init_one(&sg, test->buffer, i);
  853. ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
  854. if (ret)
  855. return ret;
  856. }
  857. return 0;
  858. }
  859. static int mmc_test_align_write(struct mmc_test_card *test)
  860. {
  861. int ret, i;
  862. struct scatterlist sg;
  863. for (i = 1;i < 4;i++) {
  864. sg_init_one(&sg, test->buffer + i, 512);
  865. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
  866. if (ret)
  867. return ret;
  868. }
  869. return 0;
  870. }
  871. static int mmc_test_align_read(struct mmc_test_card *test)
  872. {
  873. int ret, i;
  874. struct scatterlist sg;
  875. for (i = 1;i < 4;i++) {
  876. sg_init_one(&sg, test->buffer + i, 512);
  877. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
  878. if (ret)
  879. return ret;
  880. }
  881. return 0;
  882. }
  883. static int mmc_test_align_multi_write(struct mmc_test_card *test)
  884. {
  885. int ret, i;
  886. unsigned int size;
  887. struct scatterlist sg;
  888. if (test->card->host->max_blk_count == 1)
  889. return RESULT_UNSUP_HOST;
  890. size = PAGE_SIZE * 2;
  891. size = min(size, test->card->host->max_req_size);
  892. size = min(size, test->card->host->max_seg_size);
  893. size = min(size, test->card->host->max_blk_count * 512);
  894. if (size < 1024)
  895. return RESULT_UNSUP_HOST;
  896. for (i = 1;i < 4;i++) {
  897. sg_init_one(&sg, test->buffer + i, size);
  898. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
  899. if (ret)
  900. return ret;
  901. }
  902. return 0;
  903. }
  904. static int mmc_test_align_multi_read(struct mmc_test_card *test)
  905. {
  906. int ret, i;
  907. unsigned int size;
  908. struct scatterlist sg;
  909. if (test->card->host->max_blk_count == 1)
  910. return RESULT_UNSUP_HOST;
  911. size = PAGE_SIZE * 2;
  912. size = min(size, test->card->host->max_req_size);
  913. size = min(size, test->card->host->max_seg_size);
  914. size = min(size, test->card->host->max_blk_count * 512);
  915. if (size < 1024)
  916. return RESULT_UNSUP_HOST;
  917. for (i = 1;i < 4;i++) {
  918. sg_init_one(&sg, test->buffer + i, size);
  919. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
  920. if (ret)
  921. return ret;
  922. }
  923. return 0;
  924. }
  925. static int mmc_test_xfersize_write(struct mmc_test_card *test)
  926. {
  927. int ret;
  928. ret = mmc_test_set_blksize(test, 512);
  929. if (ret)
  930. return ret;
  931. ret = mmc_test_broken_transfer(test, 1, 512, 1);
  932. if (ret)
  933. return ret;
  934. return 0;
  935. }
  936. static int mmc_test_xfersize_read(struct mmc_test_card *test)
  937. {
  938. int ret;
  939. ret = mmc_test_set_blksize(test, 512);
  940. if (ret)
  941. return ret;
  942. ret = mmc_test_broken_transfer(test, 1, 512, 0);
  943. if (ret)
  944. return ret;
  945. return 0;
  946. }
  947. static int mmc_test_multi_xfersize_write(struct mmc_test_card *test)
  948. {
  949. int ret;
  950. if (test->card->host->max_blk_count == 1)
  951. return RESULT_UNSUP_HOST;
  952. ret = mmc_test_set_blksize(test, 512);
  953. if (ret)
  954. return ret;
  955. ret = mmc_test_broken_transfer(test, 2, 512, 1);
  956. if (ret)
  957. return ret;
  958. return 0;
  959. }
  960. static int mmc_test_multi_xfersize_read(struct mmc_test_card *test)
  961. {
  962. int ret;
  963. if (test->card->host->max_blk_count == 1)
  964. return RESULT_UNSUP_HOST;
  965. ret = mmc_test_set_blksize(test, 512);
  966. if (ret)
  967. return ret;
  968. ret = mmc_test_broken_transfer(test, 2, 512, 0);
  969. if (ret)
  970. return ret;
  971. return 0;
  972. }
  973. #ifdef CONFIG_HIGHMEM
  974. static int mmc_test_write_high(struct mmc_test_card *test)
  975. {
  976. int ret;
  977. struct scatterlist sg;
  978. sg_init_table(&sg, 1);
  979. sg_set_page(&sg, test->highmem, 512, 0);
  980. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
  981. if (ret)
  982. return ret;
  983. return 0;
  984. }
  985. static int mmc_test_read_high(struct mmc_test_card *test)
  986. {
  987. int ret;
  988. struct scatterlist sg;
  989. sg_init_table(&sg, 1);
  990. sg_set_page(&sg, test->highmem, 512, 0);
  991. ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
  992. if (ret)
  993. return ret;
  994. return 0;
  995. }
  996. static int mmc_test_multi_write_high(struct mmc_test_card *test)
  997. {
  998. int ret;
  999. unsigned int size;
  1000. struct scatterlist sg;
  1001. if (test->card->host->max_blk_count == 1)
  1002. return RESULT_UNSUP_HOST;
  1003. size = PAGE_SIZE * 2;
  1004. size = min(size, test->card->host->max_req_size);
  1005. size = min(size, test->card->host->max_seg_size);
  1006. size = min(size, test->card->host->max_blk_count * 512);
  1007. if (size < 1024)
  1008. return RESULT_UNSUP_HOST;
  1009. sg_init_table(&sg, 1);
  1010. sg_set_page(&sg, test->highmem, size, 0);
  1011. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
  1012. if (ret)
  1013. return ret;
  1014. return 0;
  1015. }
  1016. static int mmc_test_multi_read_high(struct mmc_test_card *test)
  1017. {
  1018. int ret;
  1019. unsigned int size;
  1020. struct scatterlist sg;
  1021. if (test->card->host->max_blk_count == 1)
  1022. return RESULT_UNSUP_HOST;
  1023. size = PAGE_SIZE * 2;
  1024. size = min(size, test->card->host->max_req_size);
  1025. size = min(size, test->card->host->max_seg_size);
  1026. size = min(size, test->card->host->max_blk_count * 512);
  1027. if (size < 1024)
  1028. return RESULT_UNSUP_HOST;
  1029. sg_init_table(&sg, 1);
  1030. sg_set_page(&sg, test->highmem, size, 0);
  1031. ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
  1032. if (ret)
  1033. return ret;
  1034. return 0;
  1035. }
  1036. #else
  1037. static int mmc_test_no_highmem(struct mmc_test_card *test)
  1038. {
  1039. printk(KERN_INFO "%s: Highmem not configured - test skipped\n",
  1040. mmc_hostname(test->card->host));
  1041. return 0;
  1042. }
  1043. #endif /* CONFIG_HIGHMEM */
  1044. /*
  1045. * Map sz bytes so that it can be transferred.
  1046. */
  1047. static int mmc_test_area_map(struct mmc_test_card *test, unsigned long sz,
  1048. int max_scatter)
  1049. {
  1050. struct mmc_test_area *t = &test->area;
  1051. int err;
  1052. t->blocks = sz >> 9;
  1053. if (max_scatter) {
  1054. err = mmc_test_map_sg_max_scatter(t->mem, sz, t->sg,
  1055. t->max_segs, t->max_seg_sz,
  1056. &t->sg_len);
  1057. } else {
  1058. err = mmc_test_map_sg(t->mem, sz, t->sg, 1, t->max_segs,
  1059. t->max_seg_sz, &t->sg_len);
  1060. }
  1061. if (err)
  1062. printk(KERN_INFO "%s: Failed to map sg list\n",
  1063. mmc_hostname(test->card->host));
  1064. return err;
  1065. }
  1066. /*
  1067. * Transfer bytes mapped by mmc_test_area_map().
  1068. */
  1069. static int mmc_test_area_transfer(struct mmc_test_card *test,
  1070. unsigned int dev_addr, int write)
  1071. {
  1072. struct mmc_test_area *t = &test->area;
  1073. return mmc_test_simple_transfer(test, t->sg, t->sg_len, dev_addr,
  1074. t->blocks, 512, write);
  1075. }
  1076. /*
  1077. * Map and transfer bytes.
  1078. */
  1079. static int mmc_test_area_io(struct mmc_test_card *test, unsigned long sz,
  1080. unsigned int dev_addr, int write, int max_scatter,
  1081. int timed)
  1082. {
  1083. struct timespec ts1, ts2;
  1084. int ret;
  1085. /*
  1086. * In the case of a maximally scattered transfer, the maximum transfer
  1087. * size is further limited by using PAGE_SIZE segments.
  1088. */
  1089. if (max_scatter) {
  1090. struct mmc_test_area *t = &test->area;
  1091. unsigned long max_tfr;
  1092. if (t->max_seg_sz >= PAGE_SIZE)
  1093. max_tfr = t->max_segs * PAGE_SIZE;
  1094. else
  1095. max_tfr = t->max_segs * t->max_seg_sz;
  1096. if (sz > max_tfr)
  1097. sz = max_tfr;
  1098. }
  1099. ret = mmc_test_area_map(test, sz, max_scatter);
  1100. if (ret)
  1101. return ret;
  1102. if (timed)
  1103. getnstimeofday(&ts1);
  1104. ret = mmc_test_area_transfer(test, dev_addr, write);
  1105. if (ret)
  1106. return ret;
  1107. if (timed)
  1108. getnstimeofday(&ts2);
  1109. if (timed)
  1110. mmc_test_print_rate(test, sz, &ts1, &ts2);
  1111. return 0;
  1112. }
  1113. /*
  1114. * Write the test area entirely.
  1115. */
  1116. static int mmc_test_area_fill(struct mmc_test_card *test)
  1117. {
  1118. return mmc_test_area_io(test, test->area.max_tfr, test->area.dev_addr,
  1119. 1, 0, 0);
  1120. }
  1121. /*
  1122. * Erase the test area entirely.
  1123. */
  1124. static int mmc_test_area_erase(struct mmc_test_card *test)
  1125. {
  1126. struct mmc_test_area *t = &test->area;
  1127. if (!mmc_can_erase(test->card))
  1128. return 0;
  1129. return mmc_erase(test->card, t->dev_addr, test->area.max_sz >> 9,
  1130. MMC_ERASE_ARG);
  1131. }
  1132. /*
  1133. * Cleanup struct mmc_test_area.
  1134. */
  1135. static int mmc_test_area_cleanup(struct mmc_test_card *test)
  1136. {
  1137. struct mmc_test_area *t = &test->area;
  1138. kfree(t->sg);
  1139. mmc_test_free_mem(t->mem);
  1140. return 0;
  1141. }
  1142. /*
  1143. * Initialize an area for testing large transfers. The size of the area is the
  1144. * preferred erase size which is a good size for optimal transfer speed. Note
  1145. * that is typically 4MiB for modern cards. The test area is set to the middle
  1146. * of the card because cards may have different charateristics at the front
  1147. * (for FAT file system optimization). Optionally, the area is erased (if the
  1148. * card supports it) which may improve write performance. Optionally, the area
  1149. * is filled with data for subsequent read tests.
  1150. */
  1151. static int mmc_test_area_init(struct mmc_test_card *test, int erase, int fill)
  1152. {
  1153. struct mmc_test_area *t = &test->area;
  1154. unsigned long min_sz = 64 * 1024;
  1155. int ret;
  1156. ret = mmc_test_set_blksize(test, 512);
  1157. if (ret)
  1158. return ret;
  1159. if (test->card->pref_erase > TEST_AREA_MAX_SIZE >> 9)
  1160. t->max_sz = TEST_AREA_MAX_SIZE;
  1161. else
  1162. t->max_sz = (unsigned long)test->card->pref_erase << 9;
  1163. t->max_segs = test->card->host->max_segs;
  1164. t->max_seg_sz = test->card->host->max_seg_size;
  1165. t->max_tfr = t->max_sz;
  1166. if (t->max_tfr >> 9 > test->card->host->max_blk_count)
  1167. t->max_tfr = test->card->host->max_blk_count << 9;
  1168. if (t->max_tfr > test->card->host->max_req_size)
  1169. t->max_tfr = test->card->host->max_req_size;
  1170. if (t->max_tfr / t->max_seg_sz > t->max_segs)
  1171. t->max_tfr = t->max_segs * t->max_seg_sz;
  1172. /*
  1173. * Try to allocate enough memory for the whole area. Less is OK
  1174. * because the same memory can be mapped into the scatterlist more than
  1175. * once. Also, take into account the limits imposed on scatterlist
  1176. * segments by the host driver.
  1177. */
  1178. t->mem = mmc_test_alloc_mem(min_sz, t->max_sz, t->max_segs,
  1179. t->max_seg_sz);
  1180. if (!t->mem)
  1181. return -ENOMEM;
  1182. t->sg = kmalloc(sizeof(struct scatterlist) * t->max_segs, GFP_KERNEL);
  1183. if (!t->sg) {
  1184. ret = -ENOMEM;
  1185. goto out_free;
  1186. }
  1187. t->dev_addr = mmc_test_capacity(test->card) / 2;
  1188. t->dev_addr -= t->dev_addr % (t->max_sz >> 9);
  1189. if (erase) {
  1190. ret = mmc_test_area_erase(test);
  1191. if (ret)
  1192. goto out_free;
  1193. }
  1194. if (fill) {
  1195. ret = mmc_test_area_fill(test);
  1196. if (ret)
  1197. goto out_free;
  1198. }
  1199. return 0;
  1200. out_free:
  1201. mmc_test_area_cleanup(test);
  1202. return ret;
  1203. }
  1204. /*
  1205. * Prepare for large transfers. Do not erase the test area.
  1206. */
  1207. static int mmc_test_area_prepare(struct mmc_test_card *test)
  1208. {
  1209. return mmc_test_area_init(test, 0, 0);
  1210. }
  1211. /*
  1212. * Prepare for large transfers. Do erase the test area.
  1213. */
  1214. static int mmc_test_area_prepare_erase(struct mmc_test_card *test)
  1215. {
  1216. return mmc_test_area_init(test, 1, 0);
  1217. }
  1218. /*
  1219. * Prepare for large transfers. Erase and fill the test area.
  1220. */
  1221. static int mmc_test_area_prepare_fill(struct mmc_test_card *test)
  1222. {
  1223. return mmc_test_area_init(test, 1, 1);
  1224. }
  1225. /*
  1226. * Test best-case performance. Best-case performance is expected from
  1227. * a single large transfer.
  1228. *
  1229. * An additional option (max_scatter) allows the measurement of the same
  1230. * transfer but with no contiguous pages in the scatter list. This tests
  1231. * the efficiency of DMA to handle scattered pages.
  1232. */
  1233. static int mmc_test_best_performance(struct mmc_test_card *test, int write,
  1234. int max_scatter)
  1235. {
  1236. return mmc_test_area_io(test, test->area.max_tfr, test->area.dev_addr,
  1237. write, max_scatter, 1);
  1238. }
  1239. /*
  1240. * Best-case read performance.
  1241. */
  1242. static int mmc_test_best_read_performance(struct mmc_test_card *test)
  1243. {
  1244. return mmc_test_best_performance(test, 0, 0);
  1245. }
  1246. /*
  1247. * Best-case write performance.
  1248. */
  1249. static int mmc_test_best_write_performance(struct mmc_test_card *test)
  1250. {
  1251. return mmc_test_best_performance(test, 1, 0);
  1252. }
  1253. /*
  1254. * Best-case read performance into scattered pages.
  1255. */
  1256. static int mmc_test_best_read_perf_max_scatter(struct mmc_test_card *test)
  1257. {
  1258. return mmc_test_best_performance(test, 0, 1);
  1259. }
  1260. /*
  1261. * Best-case write performance from scattered pages.
  1262. */
  1263. static int mmc_test_best_write_perf_max_scatter(struct mmc_test_card *test)
  1264. {
  1265. return mmc_test_best_performance(test, 1, 1);
  1266. }
  1267. /*
  1268. * Single read performance by transfer size.
  1269. */
  1270. static int mmc_test_profile_read_perf(struct mmc_test_card *test)
  1271. {
  1272. unsigned long sz;
  1273. unsigned int dev_addr;
  1274. int ret;
  1275. for (sz = 512; sz < test->area.max_tfr; sz <<= 1) {
  1276. dev_addr = test->area.dev_addr + (sz >> 9);
  1277. ret = mmc_test_area_io(test, sz, dev_addr, 0, 0, 1);
  1278. if (ret)
  1279. return ret;
  1280. }
  1281. sz = test->area.max_tfr;
  1282. dev_addr = test->area.dev_addr;
  1283. return mmc_test_area_io(test, sz, dev_addr, 0, 0, 1);
  1284. }
  1285. /*
  1286. * Single write performance by transfer size.
  1287. */
  1288. static int mmc_test_profile_write_perf(struct mmc_test_card *test)
  1289. {
  1290. unsigned long sz;
  1291. unsigned int dev_addr;
  1292. int ret;
  1293. ret = mmc_test_area_erase(test);
  1294. if (ret)
  1295. return ret;
  1296. for (sz = 512; sz < test->area.max_tfr; sz <<= 1) {
  1297. dev_addr = test->area.dev_addr + (sz >> 9);
  1298. ret = mmc_test_area_io(test, sz, dev_addr, 1, 0, 1);
  1299. if (ret)
  1300. return ret;
  1301. }
  1302. ret = mmc_test_area_erase(test);
  1303. if (ret)
  1304. return ret;
  1305. sz = test->area.max_tfr;
  1306. dev_addr = test->area.dev_addr;
  1307. return mmc_test_area_io(test, sz, dev_addr, 1, 0, 1);
  1308. }
  1309. /*
  1310. * Single trim performance by transfer size.
  1311. */
  1312. static int mmc_test_profile_trim_perf(struct mmc_test_card *test)
  1313. {
  1314. unsigned long sz;
  1315. unsigned int dev_addr;
  1316. struct timespec ts1, ts2;
  1317. int ret;
  1318. if (!mmc_can_trim(test->card))
  1319. return RESULT_UNSUP_CARD;
  1320. if (!mmc_can_erase(test->card))
  1321. return RESULT_UNSUP_HOST;
  1322. for (sz = 512; sz < test->area.max_sz; sz <<= 1) {
  1323. dev_addr = test->area.dev_addr + (sz >> 9);
  1324. getnstimeofday(&ts1);
  1325. ret = mmc_erase(test->card, dev_addr, sz >> 9, MMC_TRIM_ARG);
  1326. if (ret)
  1327. return ret;
  1328. getnstimeofday(&ts2);
  1329. mmc_test_print_rate(test, sz, &ts1, &ts2);
  1330. }
  1331. dev_addr = test->area.dev_addr;
  1332. getnstimeofday(&ts1);
  1333. ret = mmc_erase(test->card, dev_addr, sz >> 9, MMC_TRIM_ARG);
  1334. if (ret)
  1335. return ret;
  1336. getnstimeofday(&ts2);
  1337. mmc_test_print_rate(test, sz, &ts1, &ts2);
  1338. return 0;
  1339. }
  1340. static int mmc_test_seq_read_perf(struct mmc_test_card *test, unsigned long sz)
  1341. {
  1342. unsigned int dev_addr, i, cnt;
  1343. struct timespec ts1, ts2;
  1344. int ret;
  1345. cnt = test->area.max_sz / sz;
  1346. dev_addr = test->area.dev_addr;
  1347. getnstimeofday(&ts1);
  1348. for (i = 0; i < cnt; i++) {
  1349. ret = mmc_test_area_io(test, sz, dev_addr, 0, 0, 0);
  1350. if (ret)
  1351. return ret;
  1352. dev_addr += (sz >> 9);
  1353. }
  1354. getnstimeofday(&ts2);
  1355. mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
  1356. return 0;
  1357. }
  1358. /*
  1359. * Consecutive read performance by transfer size.
  1360. */
  1361. static int mmc_test_profile_seq_read_perf(struct mmc_test_card *test)
  1362. {
  1363. unsigned long sz;
  1364. int ret;
  1365. for (sz = 512; sz < test->area.max_tfr; sz <<= 1) {
  1366. ret = mmc_test_seq_read_perf(test, sz);
  1367. if (ret)
  1368. return ret;
  1369. }
  1370. sz = test->area.max_tfr;
  1371. return mmc_test_seq_read_perf(test, sz);
  1372. }
  1373. static int mmc_test_seq_write_perf(struct mmc_test_card *test, unsigned long sz)
  1374. {
  1375. unsigned int dev_addr, i, cnt;
  1376. struct timespec ts1, ts2;
  1377. int ret;
  1378. ret = mmc_test_area_erase(test);
  1379. if (ret)
  1380. return ret;
  1381. cnt = test->area.max_sz / sz;
  1382. dev_addr = test->area.dev_addr;
  1383. getnstimeofday(&ts1);
  1384. for (i = 0; i < cnt; i++) {
  1385. ret = mmc_test_area_io(test, sz, dev_addr, 1, 0, 0);
  1386. if (ret)
  1387. return ret;
  1388. dev_addr += (sz >> 9);
  1389. }
  1390. getnstimeofday(&ts2);
  1391. mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
  1392. return 0;
  1393. }
  1394. /*
  1395. * Consecutive write performance by transfer size.
  1396. */
  1397. static int mmc_test_profile_seq_write_perf(struct mmc_test_card *test)
  1398. {
  1399. unsigned long sz;
  1400. int ret;
  1401. for (sz = 512; sz < test->area.max_tfr; sz <<= 1) {
  1402. ret = mmc_test_seq_write_perf(test, sz);
  1403. if (ret)
  1404. return ret;
  1405. }
  1406. sz = test->area.max_tfr;
  1407. return mmc_test_seq_write_perf(test, sz);
  1408. }
  1409. /*
  1410. * Consecutive trim performance by transfer size.
  1411. */
  1412. static int mmc_test_profile_seq_trim_perf(struct mmc_test_card *test)
  1413. {
  1414. unsigned long sz;
  1415. unsigned int dev_addr, i, cnt;
  1416. struct timespec ts1, ts2;
  1417. int ret;
  1418. if (!mmc_can_trim(test->card))
  1419. return RESULT_UNSUP_CARD;
  1420. if (!mmc_can_erase(test->card))
  1421. return RESULT_UNSUP_HOST;
  1422. for (sz = 512; sz <= test->area.max_sz; sz <<= 1) {
  1423. ret = mmc_test_area_erase(test);
  1424. if (ret)
  1425. return ret;
  1426. ret = mmc_test_area_fill(test);
  1427. if (ret)
  1428. return ret;
  1429. cnt = test->area.max_sz / sz;
  1430. dev_addr = test->area.dev_addr;
  1431. getnstimeofday(&ts1);
  1432. for (i = 0; i < cnt; i++) {
  1433. ret = mmc_erase(test->card, dev_addr, sz >> 9,
  1434. MMC_TRIM_ARG);
  1435. if (ret)
  1436. return ret;
  1437. dev_addr += (sz >> 9);
  1438. }
  1439. getnstimeofday(&ts2);
  1440. mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
  1441. }
  1442. return 0;
  1443. }
  1444. static const struct mmc_test_case mmc_test_cases[] = {
  1445. {
  1446. .name = "Basic write (no data verification)",
  1447. .run = mmc_test_basic_write,
  1448. },
  1449. {
  1450. .name = "Basic read (no data verification)",
  1451. .run = mmc_test_basic_read,
  1452. },
  1453. {
  1454. .name = "Basic write (with data verification)",
  1455. .prepare = mmc_test_prepare_write,
  1456. .run = mmc_test_verify_write,
  1457. .cleanup = mmc_test_cleanup,
  1458. },
  1459. {
  1460. .name = "Basic read (with data verification)",
  1461. .prepare = mmc_test_prepare_read,
  1462. .run = mmc_test_verify_read,
  1463. .cleanup = mmc_test_cleanup,
  1464. },
  1465. {
  1466. .name = "Multi-block write",
  1467. .prepare = mmc_test_prepare_write,
  1468. .run = mmc_test_multi_write,
  1469. .cleanup = mmc_test_cleanup,
  1470. },
  1471. {
  1472. .name = "Multi-block read",
  1473. .prepare = mmc_test_prepare_read,
  1474. .run = mmc_test_multi_read,
  1475. .cleanup = mmc_test_cleanup,
  1476. },
  1477. {
  1478. .name = "Power of two block writes",
  1479. .prepare = mmc_test_prepare_write,
  1480. .run = mmc_test_pow2_write,
  1481. .cleanup = mmc_test_cleanup,
  1482. },
  1483. {
  1484. .name = "Power of two block reads",
  1485. .prepare = mmc_test_prepare_read,
  1486. .run = mmc_test_pow2_read,
  1487. .cleanup = mmc_test_cleanup,
  1488. },
  1489. {
  1490. .name = "Weird sized block writes",
  1491. .prepare = mmc_test_prepare_write,
  1492. .run = mmc_test_weird_write,
  1493. .cleanup = mmc_test_cleanup,
  1494. },
  1495. {
  1496. .name = "Weird sized block reads",
  1497. .prepare = mmc_test_prepare_read,
  1498. .run = mmc_test_weird_read,
  1499. .cleanup = mmc_test_cleanup,
  1500. },
  1501. {
  1502. .name = "Badly aligned write",
  1503. .prepare = mmc_test_prepare_write,
  1504. .run = mmc_test_align_write,
  1505. .cleanup = mmc_test_cleanup,
  1506. },
  1507. {
  1508. .name = "Badly aligned read",
  1509. .prepare = mmc_test_prepare_read,
  1510. .run = mmc_test_align_read,
  1511. .cleanup = mmc_test_cleanup,
  1512. },
  1513. {
  1514. .name = "Badly aligned multi-block write",
  1515. .prepare = mmc_test_prepare_write,
  1516. .run = mmc_test_align_multi_write,
  1517. .cleanup = mmc_test_cleanup,
  1518. },
  1519. {
  1520. .name = "Badly aligned multi-block read",
  1521. .prepare = mmc_test_prepare_read,
  1522. .run = mmc_test_align_multi_read,
  1523. .cleanup = mmc_test_cleanup,
  1524. },
  1525. {
  1526. .name = "Correct xfer_size at write (start failure)",
  1527. .run = mmc_test_xfersize_write,
  1528. },
  1529. {
  1530. .name = "Correct xfer_size at read (start failure)",
  1531. .run = mmc_test_xfersize_read,
  1532. },
  1533. {
  1534. .name = "Correct xfer_size at write (midway failure)",
  1535. .run = mmc_test_multi_xfersize_write,
  1536. },
  1537. {
  1538. .name = "Correct xfer_size at read (midway failure)",
  1539. .run = mmc_test_multi_xfersize_read,
  1540. },
  1541. #ifdef CONFIG_HIGHMEM
  1542. {
  1543. .name = "Highmem write",
  1544. .prepare = mmc_test_prepare_write,
  1545. .run = mmc_test_write_high,
  1546. .cleanup = mmc_test_cleanup,
  1547. },
  1548. {
  1549. .name = "Highmem read",
  1550. .prepare = mmc_test_prepare_read,
  1551. .run = mmc_test_read_high,
  1552. .cleanup = mmc_test_cleanup,
  1553. },
  1554. {
  1555. .name = "Multi-block highmem write",
  1556. .prepare = mmc_test_prepare_write,
  1557. .run = mmc_test_multi_write_high,
  1558. .cleanup = mmc_test_cleanup,
  1559. },
  1560. {
  1561. .name = "Multi-block highmem read",
  1562. .prepare = mmc_test_prepare_read,
  1563. .run = mmc_test_multi_read_high,
  1564. .cleanup = mmc_test_cleanup,
  1565. },
  1566. #else
  1567. {
  1568. .name = "Highmem write",
  1569. .run = mmc_test_no_highmem,
  1570. },
  1571. {
  1572. .name = "Highmem read",
  1573. .run = mmc_test_no_highmem,
  1574. },
  1575. {
  1576. .name = "Multi-block highmem write",
  1577. .run = mmc_test_no_highmem,
  1578. },
  1579. {
  1580. .name = "Multi-block highmem read",
  1581. .run = mmc_test_no_highmem,
  1582. },
  1583. #endif /* CONFIG_HIGHMEM */
  1584. {
  1585. .name = "Best-case read performance",
  1586. .prepare = mmc_test_area_prepare_fill,
  1587. .run = mmc_test_best_read_performance,
  1588. .cleanup = mmc_test_area_cleanup,
  1589. },
  1590. {
  1591. .name = "Best-case write performance",
  1592. .prepare = mmc_test_area_prepare_erase,
  1593. .run = mmc_test_best_write_performance,
  1594. .cleanup = mmc_test_area_cleanup,
  1595. },
  1596. {
  1597. .name = "Best-case read performance into scattered pages",
  1598. .prepare = mmc_test_area_prepare_fill,
  1599. .run = mmc_test_best_read_perf_max_scatter,
  1600. .cleanup = mmc_test_area_cleanup,
  1601. },
  1602. {
  1603. .name = "Best-case write performance from scattered pages",
  1604. .prepare = mmc_test_area_prepare_erase,
  1605. .run = mmc_test_best_write_perf_max_scatter,
  1606. .cleanup = mmc_test_area_cleanup,
  1607. },
  1608. {
  1609. .name = "Single read performance by transfer size",
  1610. .prepare = mmc_test_area_prepare_fill,
  1611. .run = mmc_test_profile_read_perf,
  1612. .cleanup = mmc_test_area_cleanup,
  1613. },
  1614. {
  1615. .name = "Single write performance by transfer size",
  1616. .prepare = mmc_test_area_prepare,
  1617. .run = mmc_test_profile_write_perf,
  1618. .cleanup = mmc_test_area_cleanup,
  1619. },
  1620. {
  1621. .name = "Single trim performance by transfer size",
  1622. .prepare = mmc_test_area_prepare_fill,
  1623. .run = mmc_test_profile_trim_perf,
  1624. .cleanup = mmc_test_area_cleanup,
  1625. },
  1626. {
  1627. .name = "Consecutive read performance by transfer size",
  1628. .prepare = mmc_test_area_prepare_fill,
  1629. .run = mmc_test_profile_seq_read_perf,
  1630. .cleanup = mmc_test_area_cleanup,
  1631. },
  1632. {
  1633. .name = "Consecutive write performance by transfer size",
  1634. .prepare = mmc_test_area_prepare,
  1635. .run = mmc_test_profile_seq_write_perf,
  1636. .cleanup = mmc_test_area_cleanup,
  1637. },
  1638. {
  1639. .name = "Consecutive trim performance by transfer size",
  1640. .prepare = mmc_test_area_prepare,
  1641. .run = mmc_test_profile_seq_trim_perf,
  1642. .cleanup = mmc_test_area_cleanup,
  1643. },
  1644. };
  1645. static DEFINE_MUTEX(mmc_test_lock);
  1646. static LIST_HEAD(mmc_test_result);
  1647. static void mmc_test_run(struct mmc_test_card *test, int testcase)
  1648. {
  1649. int i, ret;
  1650. printk(KERN_INFO "%s: Starting tests of card %s...\n",
  1651. mmc_hostname(test->card->host), mmc_card_id(test->card));
  1652. mmc_claim_host(test->card->host);
  1653. for (i = 0;i < ARRAY_SIZE(mmc_test_cases);i++) {
  1654. struct mmc_test_general_result *gr;
  1655. if (testcase && ((i + 1) != testcase))
  1656. continue;
  1657. printk(KERN_INFO "%s: Test case %d. %s...\n",
  1658. mmc_hostname(test->card->host), i + 1,
  1659. mmc_test_cases[i].name);
  1660. if (mmc_test_cases[i].prepare) {
  1661. ret = mmc_test_cases[i].prepare(test);
  1662. if (ret) {
  1663. printk(KERN_INFO "%s: Result: Prepare "
  1664. "stage failed! (%d)\n",
  1665. mmc_hostname(test->card->host),
  1666. ret);
  1667. continue;
  1668. }
  1669. }
  1670. gr = kzalloc(sizeof(struct mmc_test_general_result),
  1671. GFP_KERNEL);
  1672. if (gr) {
  1673. INIT_LIST_HEAD(&gr->tr_lst);
  1674. /* Assign data what we know already */
  1675. gr->card = test->card;
  1676. gr->testcase = i;
  1677. /* Append container to global one */
  1678. list_add_tail(&gr->link, &mmc_test_result);
  1679. /*
  1680. * Save the pointer to created container in our private
  1681. * structure.
  1682. */
  1683. test->gr = gr;
  1684. }
  1685. ret = mmc_test_cases[i].run(test);
  1686. switch (ret) {
  1687. case RESULT_OK:
  1688. printk(KERN_INFO "%s: Result: OK\n",
  1689. mmc_hostname(test->card->host));
  1690. break;
  1691. case RESULT_FAIL:
  1692. printk(KERN_INFO "%s: Result: FAILED\n",
  1693. mmc_hostname(test->card->host));
  1694. break;
  1695. case RESULT_UNSUP_HOST:
  1696. printk(KERN_INFO "%s: Result: UNSUPPORTED "
  1697. "(by host)\n",
  1698. mmc_hostname(test->card->host));
  1699. break;
  1700. case RESULT_UNSUP_CARD:
  1701. printk(KERN_INFO "%s: Result: UNSUPPORTED "
  1702. "(by card)\n",
  1703. mmc_hostname(test->card->host));
  1704. break;
  1705. default:
  1706. printk(KERN_INFO "%s: Result: ERROR (%d)\n",
  1707. mmc_hostname(test->card->host), ret);
  1708. }
  1709. /* Save the result */
  1710. if (gr)
  1711. gr->result = ret;
  1712. if (mmc_test_cases[i].cleanup) {
  1713. ret = mmc_test_cases[i].cleanup(test);
  1714. if (ret) {
  1715. printk(KERN_INFO "%s: Warning: Cleanup "
  1716. "stage failed! (%d)\n",
  1717. mmc_hostname(test->card->host),
  1718. ret);
  1719. }
  1720. }
  1721. }
  1722. mmc_release_host(test->card->host);
  1723. printk(KERN_INFO "%s: Tests completed.\n",
  1724. mmc_hostname(test->card->host));
  1725. }
  1726. static void mmc_test_free_result(struct mmc_card *card)
  1727. {
  1728. struct mmc_test_general_result *gr, *grs;
  1729. mutex_lock(&mmc_test_lock);
  1730. list_for_each_entry_safe(gr, grs, &mmc_test_result, link) {
  1731. struct mmc_test_transfer_result *tr, *trs;
  1732. if (card && gr->card != card)
  1733. continue;
  1734. list_for_each_entry_safe(tr, trs, &gr->tr_lst, link) {
  1735. list_del(&tr->link);
  1736. kfree(tr);
  1737. }
  1738. list_del(&gr->link);
  1739. kfree(gr);
  1740. }
  1741. mutex_unlock(&mmc_test_lock);
  1742. }
  1743. static ssize_t mmc_test_show(struct device *dev,
  1744. struct device_attribute *attr, char *buf)
  1745. {
  1746. struct mmc_card *card = mmc_dev_to_card(dev);
  1747. struct mmc_test_general_result *gr;
  1748. char *p = buf;
  1749. size_t len = PAGE_SIZE;
  1750. int ret;
  1751. mutex_lock(&mmc_test_lock);
  1752. list_for_each_entry(gr, &mmc_test_result, link) {
  1753. struct mmc_test_transfer_result *tr;
  1754. if (gr->card != card)
  1755. continue;
  1756. ret = snprintf(p, len, "Test %d: %d\n", gr->testcase + 1,
  1757. gr->result);
  1758. if (ret < 0)
  1759. goto err;
  1760. if (ret >= len) {
  1761. ret = -ENOBUFS;
  1762. goto err;
  1763. }
  1764. p += ret;
  1765. len -= ret;
  1766. list_for_each_entry(tr, &gr->tr_lst, link) {
  1767. ret = snprintf(p, len, "%u %d %lu.%09lu %u\n",
  1768. tr->count, tr->sectors,
  1769. (unsigned long)tr->ts.tv_sec,
  1770. (unsigned long)tr->ts.tv_nsec,
  1771. tr->rate);
  1772. if (ret < 0)
  1773. goto err;
  1774. if (ret >= len) {
  1775. ret = -ENOBUFS;
  1776. goto err;
  1777. }
  1778. p += ret;
  1779. len -= ret;
  1780. }
  1781. }
  1782. ret = PAGE_SIZE - len;
  1783. err:
  1784. mutex_unlock(&mmc_test_lock);
  1785. return ret;
  1786. }
  1787. static ssize_t mmc_test_store(struct device *dev,
  1788. struct device_attribute *attr, const char *buf, size_t count)
  1789. {
  1790. struct mmc_card *card = mmc_dev_to_card(dev);
  1791. struct mmc_test_card *test;
  1792. long testcase;
  1793. if (strict_strtol(buf, 10, &testcase))
  1794. return -EINVAL;
  1795. test = kzalloc(sizeof(struct mmc_test_card), GFP_KERNEL);
  1796. if (!test)
  1797. return -ENOMEM;
  1798. /*
  1799. * Remove all test cases associated with given card. Thus we have only
  1800. * actual data of the last run.
  1801. */
  1802. mmc_test_free_result(card);
  1803. test->card = card;
  1804. test->buffer = kzalloc(BUFFER_SIZE, GFP_KERNEL);
  1805. #ifdef CONFIG_HIGHMEM
  1806. test->highmem = alloc_pages(GFP_KERNEL | __GFP_HIGHMEM, BUFFER_ORDER);
  1807. #endif
  1808. #ifdef CONFIG_HIGHMEM
  1809. if (test->buffer && test->highmem) {
  1810. #else
  1811. if (test->buffer) {
  1812. #endif
  1813. mutex_lock(&mmc_test_lock);
  1814. mmc_test_run(test, testcase);
  1815. mutex_unlock(&mmc_test_lock);
  1816. }
  1817. #ifdef CONFIG_HIGHMEM
  1818. __free_pages(test->highmem, BUFFER_ORDER);
  1819. #endif
  1820. kfree(test->buffer);
  1821. kfree(test);
  1822. return count;
  1823. }
  1824. static DEVICE_ATTR(test, S_IWUSR | S_IRUGO, mmc_test_show, mmc_test_store);
  1825. static int mmc_test_probe(struct mmc_card *card)
  1826. {
  1827. int ret;
  1828. if (!mmc_card_mmc(card) && !mmc_card_sd(card))
  1829. return -ENODEV;
  1830. ret = device_create_file(&card->dev, &dev_attr_test);
  1831. if (ret)
  1832. return ret;
  1833. dev_info(&card->dev, "Card claimed for testing.\n");
  1834. return 0;
  1835. }
  1836. static void mmc_test_remove(struct mmc_card *card)
  1837. {
  1838. mmc_test_free_result(card);
  1839. device_remove_file(&card->dev, &dev_attr_test);
  1840. }
  1841. static struct mmc_driver mmc_driver = {
  1842. .drv = {
  1843. .name = "mmc_test",
  1844. },
  1845. .probe = mmc_test_probe,
  1846. .remove = mmc_test_remove,
  1847. };
  1848. static int __init mmc_test_init(void)
  1849. {
  1850. return mmc_register_driver(&mmc_driver);
  1851. }
  1852. static void __exit mmc_test_exit(void)
  1853. {
  1854. /* Clear stalled data if card is still plugged */
  1855. mmc_test_free_result(NULL);
  1856. mmc_unregister_driver(&mmc_driver);
  1857. }
  1858. module_init(mmc_test_init);
  1859. module_exit(mmc_test_exit);
  1860. MODULE_LICENSE("GPL");
  1861. MODULE_DESCRIPTION("Multimedia Card (MMC) host test driver");
  1862. MODULE_AUTHOR("Pierre Ossman");