Blame view

drivers/mmc/card/mmc_test.c 73.8 KB
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1
2
3
  /*
   *  linux/drivers/mmc/card/mmc_test.c
   *
0121a9829   Pierre Ossman   mmc_test: only bi...
4
   *  Copyright 2007-2008 Pierre Ossman
88ae600d5   Pierre Ossman   mmc: mmc host tes...
5
6
7
8
9
10
11
12
13
14
15
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License, or (at
   * your option) any later version.
   */
  
  #include <linux/mmc/core.h>
  #include <linux/mmc/card.h>
  #include <linux/mmc/host.h>
  #include <linux/mmc/mmc.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
16
  #include <linux/slab.h>
88ae600d5   Pierre Ossman   mmc: mmc host tes...
17
18
  
  #include <linux/scatterlist.h>
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
19
  #include <linux/swap.h>		/* For nr_free_buffer_pages() */
3183aa153   Andy Shevchenko   mmc_test: collect...
20
  #include <linux/list.h>
88ae600d5   Pierre Ossman   mmc: mmc host tes...
21

130067ed1   Andy Shevchenko   mmc_test: move fi...
22
23
24
  #include <linux/debugfs.h>
  #include <linux/uaccess.h>
  #include <linux/seq_file.h>
88b476797   Paul Gortmaker   mmc: Add module.h...
25
  #include <linux/module.h>
130067ed1   Andy Shevchenko   mmc_test: move fi...
26

88ae600d5   Pierre Ossman   mmc: mmc host tes...
27
28
29
30
  #define RESULT_OK		0
  #define RESULT_FAIL		1
  #define RESULT_UNSUP_HOST	2
  #define RESULT_UNSUP_CARD	3
2661081f5   Pierre Ossman   mmc_test: highmem...
31
32
  #define BUFFER_ORDER		2
  #define BUFFER_SIZE		(PAGE_SIZE << BUFFER_ORDER)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
33

3ee14bf79   Adrian Hunter   mmc: mmc_test: Ex...
34
  #define TEST_ALIGN_END		8
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
35
36
37
38
39
  /*
   * Limit the test area size to the maximum MMC HC erase group size.  Note that
   * the maximum SD allocation unit size is just 4MiB.
   */
  #define TEST_AREA_MAX_SIZE (128 * 1024 * 1024)
64f7120d8   Adrian Hunter   mmc_test: add per...
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
  /**
   * struct mmc_test_pages - pages allocated by 'alloc_pages()'.
   * @page: first page in the allocation
   * @order: order of the number of pages allocated
   */
  struct mmc_test_pages {
  	struct page *page;
  	unsigned int order;
  };
  
  /**
   * struct mmc_test_mem - allocated memory.
   * @arr: array of allocations
   * @cnt: number of allocations
   */
  struct mmc_test_mem {
  	struct mmc_test_pages *arr;
  	unsigned int cnt;
  };
  
  /**
   * struct mmc_test_area - information for performance tests.
64f7120d8   Adrian Hunter   mmc_test: add per...
62
   * @max_sz: test area size (in bytes)
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
63
   * @dev_addr: address on card at which to do performance tests
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
64
65
66
   * @max_tfr: maximum transfer size allowed by driver (in bytes)
   * @max_segs: maximum segments allowed by driver in scatterlist @sg
   * @max_seg_sz: maximum segment size allowed by driver
64f7120d8   Adrian Hunter   mmc_test: add per...
67
68
69
70
71
72
   * @blocks: number of (512 byte) blocks currently mapped by @sg
   * @sg_len: length of currently mapped scatterlist @sg
   * @mem: allocated memory
   * @sg: scatterlist
   */
  struct mmc_test_area {
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
73
  	unsigned long max_sz;
64f7120d8   Adrian Hunter   mmc_test: add per...
74
  	unsigned int dev_addr;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
75
  	unsigned int max_tfr;
64f7120d8   Adrian Hunter   mmc_test: add per...
76
  	unsigned int max_segs;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
77
  	unsigned int max_seg_sz;
64f7120d8   Adrian Hunter   mmc_test: add per...
78
79
80
81
82
83
84
  	unsigned int blocks;
  	unsigned int sg_len;
  	struct mmc_test_mem *mem;
  	struct scatterlist *sg;
  };
  
  /**
3183aa153   Andy Shevchenko   mmc_test: collect...
85
86
87
88
89
90
   * struct mmc_test_transfer_result - transfer results for performance tests.
   * @link: double-linked list
   * @count: amount of group of sectors to check
   * @sectors: amount of sectors to check in one group
   * @ts: time values of transfer
   * @rate: calculated transfer rate
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
91
   * @iops: I/O operations per second (times 100)
3183aa153   Andy Shevchenko   mmc_test: collect...
92
93
94
95
96
97
98
   */
  struct mmc_test_transfer_result {
  	struct list_head link;
  	unsigned int count;
  	unsigned int sectors;
  	struct timespec ts;
  	unsigned int rate;
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
99
  	unsigned int iops;
3183aa153   Andy Shevchenko   mmc_test: collect...
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
  };
  
  /**
   * struct mmc_test_general_result - results for tests.
   * @link: double-linked list
   * @card: card under test
   * @testcase: number of test case
   * @result: result of test run
   * @tr_lst: transfer measurements if any as mmc_test_transfer_result
   */
  struct mmc_test_general_result {
  	struct list_head link;
  	struct mmc_card *card;
  	int testcase;
  	int result;
  	struct list_head tr_lst;
  };
  
  /**
130067ed1   Andy Shevchenko   mmc_test: move fi...
119
120
121
122
123
124
125
126
127
128
129
130
   * struct mmc_test_dbgfs_file - debugfs related file.
   * @link: double-linked list
   * @card: card under test
   * @file: file created under debugfs
   */
  struct mmc_test_dbgfs_file {
  	struct list_head link;
  	struct mmc_card *card;
  	struct dentry *file;
  };
  
  /**
64f7120d8   Adrian Hunter   mmc_test: add per...
131
132
133
134
135
136
   * struct mmc_test_card - test information.
   * @card: card under test
   * @scratch: transfer buffer
   * @buffer: transfer buffer
   * @highmem: buffer for highmem tests
   * @area: information for performance tests
3183aa153   Andy Shevchenko   mmc_test: collect...
137
   * @gr: pointer to results of current testcase
64f7120d8   Adrian Hunter   mmc_test: add per...
138
   */
88ae600d5   Pierre Ossman   mmc: mmc host tes...
139
140
  struct mmc_test_card {
  	struct mmc_card	*card;
6b174931a   Pierre Ossman   mmc_test: cleanup
141
  	u8		scratch[BUFFER_SIZE];
88ae600d5   Pierre Ossman   mmc: mmc host tes...
142
  	u8		*buffer;
2661081f5   Pierre Ossman   mmc_test: highmem...
143
144
145
  #ifdef CONFIG_HIGHMEM
  	struct page	*highmem;
  #endif
3183aa153   Andy Shevchenko   mmc_test: collect...
146
147
  	struct mmc_test_area		area;
  	struct mmc_test_general_result	*gr;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
148
  };
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
149
150
151
152
153
154
155
  enum mmc_test_prep_media {
  	MMC_TEST_PREP_NONE = 0,
  	MMC_TEST_PREP_WRITE_FULL = 1 << 0,
  	MMC_TEST_PREP_ERASE = 1 << 1,
  };
  
  struct mmc_test_multiple_rw {
bf0433303   Per Forlin   mmc: mmc_test: te...
156
  	unsigned int *sg_len;
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
157
158
159
160
161
162
163
164
165
166
167
168
  	unsigned int *bs;
  	unsigned int len;
  	unsigned int size;
  	bool do_write;
  	bool do_nonblock_req;
  	enum mmc_test_prep_media prepare;
  };
  
  struct mmc_test_async_req {
  	struct mmc_async_req areq;
  	struct mmc_test_card *test;
  };
88ae600d5   Pierre Ossman   mmc: mmc host tes...
169
  /*******************************************************************/
6b174931a   Pierre Ossman   mmc_test: cleanup
170
  /*  General helper functions                                       */
88ae600d5   Pierre Ossman   mmc: mmc host tes...
171
  /*******************************************************************/
6b174931a   Pierre Ossman   mmc_test: cleanup
172
173
174
  /*
   * Configure correct block size in card
   */
88ae600d5   Pierre Ossman   mmc: mmc host tes...
175
176
  static int mmc_test_set_blksize(struct mmc_test_card *test, unsigned size)
  {
0f8d8ea64   Adrian Hunter   mmc: Fixes for Du...
177
  	return mmc_set_blocklen(test->card, size);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
178
  }
4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
  static bool mmc_test_card_cmd23(struct mmc_card *card)
  {
  	return mmc_card_mmc(card) ||
  	       (mmc_card_sd(card) && card->scr.cmds & SD_SCR_CMD23_SUPPORT);
  }
  
  static void mmc_test_prepare_sbc(struct mmc_test_card *test,
  				 struct mmc_request *mrq, unsigned int blocks)
  {
  	struct mmc_card *card = test->card;
  
  	if (!mrq->sbc || !mmc_host_cmd23(card->host) ||
  	    !mmc_test_card_cmd23(card) || !mmc_op_multi(mrq->cmd->opcode) ||
  	    (card->quirks & MMC_QUIRK_BLK_NO_CMD23)) {
  		mrq->sbc = NULL;
  		return;
  	}
  
  	mrq->sbc->opcode = MMC_SET_BLOCK_COUNT;
  	mrq->sbc->arg = blocks;
  	mrq->sbc->flags = MMC_RSP_R1 | MMC_CMD_AC;
  }
6b174931a   Pierre Ossman   mmc_test: cleanup
201
202
203
204
205
206
  /*
   * Fill in the mmc_request structure given a set of transfer parameters.
   */
  static void mmc_test_prepare_mrq(struct mmc_test_card *test,
  	struct mmc_request *mrq, struct scatterlist *sg, unsigned sg_len,
  	unsigned dev_addr, unsigned blocks, unsigned blksz, int write)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
207
  {
6b174931a   Pierre Ossman   mmc_test: cleanup
208
  	BUG_ON(!mrq || !mrq->cmd || !mrq->data || !mrq->stop);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
209

6b174931a   Pierre Ossman   mmc_test: cleanup
210
211
212
  	if (blocks > 1) {
  		mrq->cmd->opcode = write ?
  			MMC_WRITE_MULTIPLE_BLOCK : MMC_READ_MULTIPLE_BLOCK;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
213
  	} else {
6b174931a   Pierre Ossman   mmc_test: cleanup
214
215
  		mrq->cmd->opcode = write ?
  			MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
216
  	}
6b174931a   Pierre Ossman   mmc_test: cleanup
217
  	mrq->cmd->arg = dev_addr;
c286d03cc   Johan Kristell   mmc_test: block a...
218
219
  	if (!mmc_card_blockaddr(test->card))
  		mrq->cmd->arg <<= 9;
6b174931a   Pierre Ossman   mmc_test: cleanup
220
  	mrq->cmd->flags = MMC_RSP_R1 | MMC_CMD_ADTC;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
221

6b174931a   Pierre Ossman   mmc_test: cleanup
222
223
224
225
226
227
  	if (blocks == 1)
  		mrq->stop = NULL;
  	else {
  		mrq->stop->opcode = MMC_STOP_TRANSMISSION;
  		mrq->stop->arg = 0;
  		mrq->stop->flags = MMC_RSP_R1B | MMC_CMD_AC;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
228
  	}
6b174931a   Pierre Ossman   mmc_test: cleanup
229
230
231
232
233
  	mrq->data->blksz = blksz;
  	mrq->data->blocks = blocks;
  	mrq->data->flags = write ? MMC_DATA_WRITE : MMC_DATA_READ;
  	mrq->data->sg = sg;
  	mrq->data->sg_len = sg_len;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
234

4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
235
  	mmc_test_prepare_sbc(test, mrq, blocks);
6b174931a   Pierre Ossman   mmc_test: cleanup
236
237
  	mmc_set_data_timeout(mrq->data, test->card);
  }
88ae600d5   Pierre Ossman   mmc: mmc host tes...
238

64f7120d8   Adrian Hunter   mmc_test: add per...
239
240
241
  static int mmc_test_busy(struct mmc_command *cmd)
  {
  	return !(cmd->resp[0] & R1_READY_FOR_DATA) ||
7435bb795   Jaehoon Chung   mmc: core: use de...
242
  		(R1_CURRENT_STATE(cmd->resp[0]) == R1_STATE_PRG);
64f7120d8   Adrian Hunter   mmc_test: add per...
243
  }
6b174931a   Pierre Ossman   mmc_test: cleanup
244
245
246
247
248
249
  /*
   * Wait for the card to finish the busy state
   */
  static int mmc_test_wait_busy(struct mmc_test_card *test)
  {
  	int ret, busy;
1278dba16   Chris Ball   mmc: initialize s...
250
  	struct mmc_command cmd = {0};
88ae600d5   Pierre Ossman   mmc: mmc host tes...
251
252
253
  
  	busy = 0;
  	do {
88ae600d5   Pierre Ossman   mmc: mmc host tes...
254
255
256
257
258
  		memset(&cmd, 0, sizeof(struct mmc_command));
  
  		cmd.opcode = MMC_SEND_STATUS;
  		cmd.arg = test->card->rca << 16;
  		cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
6b174931a   Pierre Ossman   mmc_test: cleanup
259
260
  		ret = mmc_wait_for_cmd(test->card->host, &cmd, 0);
  		if (ret)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
261
  			break;
64f7120d8   Adrian Hunter   mmc_test: add per...
262
  		if (!busy && mmc_test_busy(&cmd)) {
88ae600d5   Pierre Ossman   mmc: mmc host tes...
263
  			busy = 1;
54d6b44a5   Pawel Moll   mmc: mmc_test: On...
264
  			if (test->card->host->caps & MMC_CAP_WAIT_WHILE_BUSY)
a3c76eb9d   Girish K S   mmc: replace prin...
265
  				pr_info("%s: Warning: Host did not "
54d6b44a5   Pawel Moll   mmc: mmc_test: On...
266
267
268
  					"wait for busy state to end.
  ",
  					mmc_hostname(test->card->host));
88ae600d5   Pierre Ossman   mmc: mmc host tes...
269
  		}
64f7120d8   Adrian Hunter   mmc_test: add per...
270
  	} while (mmc_test_busy(&cmd));
88ae600d5   Pierre Ossman   mmc: mmc host tes...
271
272
273
  
  	return ret;
  }
6b174931a   Pierre Ossman   mmc_test: cleanup
274
275
276
277
278
  /*
   * Transfer a single sector of kernel addressable data
   */
  static int mmc_test_buffer_transfer(struct mmc_test_card *test,
  	u8 *buffer, unsigned addr, unsigned blksz, int write)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
279
  {
24f5b53ba   Chris Ball   mmc: initialize s...
280
  	struct mmc_request mrq = {0};
1278dba16   Chris Ball   mmc: initialize s...
281
282
  	struct mmc_command cmd = {0};
  	struct mmc_command stop = {0};
a61ad2b49   Chris Ball   mmc: initialize s...
283
  	struct mmc_data data = {0};
6b174931a   Pierre Ossman   mmc_test: cleanup
284
285
  
  	struct scatterlist sg;
6b174931a   Pierre Ossman   mmc_test: cleanup
286
287
288
289
290
291
292
293
294
295
296
297
298
299
  	mrq.cmd = &cmd;
  	mrq.data = &data;
  	mrq.stop = &stop;
  
  	sg_init_one(&sg, buffer, blksz);
  
  	mmc_test_prepare_mrq(test, &mrq, &sg, 1, addr, 1, blksz, write);
  
  	mmc_wait_for_req(test->card->host, &mrq);
  
  	if (cmd.error)
  		return cmd.error;
  	if (data.error)
  		return data.error;
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
300
  	return mmc_test_wait_busy(test);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
301
  }
64f7120d8   Adrian Hunter   mmc_test: add per...
302
303
304
305
306
307
308
309
310
311
312
313
  static void mmc_test_free_mem(struct mmc_test_mem *mem)
  {
  	if (!mem)
  		return;
  	while (mem->cnt--)
  		__free_pages(mem->arr[mem->cnt].page,
  			     mem->arr[mem->cnt].order);
  	kfree(mem->arr);
  	kfree(mem);
  }
  
  /*
25985edce   Lucas De Marchi   Fix common misspe...
314
   * Allocate a lot of memory, preferably max_sz but at least min_sz.  In case
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
315
316
317
   * there isn't much memory do not exceed 1/16th total lowmem pages.  Also do
   * not exceed a maximum number of segments and try not to make segments much
   * bigger than maximum segment size.
64f7120d8   Adrian Hunter   mmc_test: add per...
318
   */
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
319
  static struct mmc_test_mem *mmc_test_alloc_mem(unsigned long min_sz,
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
320
321
322
  					       unsigned long max_sz,
  					       unsigned int max_segs,
  					       unsigned int max_seg_sz)
64f7120d8   Adrian Hunter   mmc_test: add per...
323
  {
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
324
325
  	unsigned long max_page_cnt = DIV_ROUND_UP(max_sz, PAGE_SIZE);
  	unsigned long min_page_cnt = DIV_ROUND_UP(min_sz, PAGE_SIZE);
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
326
  	unsigned long max_seg_page_cnt = DIV_ROUND_UP(max_seg_sz, PAGE_SIZE);
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
327
328
  	unsigned long page_cnt = 0;
  	unsigned long limit = nr_free_buffer_pages() >> 4;
64f7120d8   Adrian Hunter   mmc_test: add per...
329
  	struct mmc_test_mem *mem;
64f7120d8   Adrian Hunter   mmc_test: add per...
330

fec4dcce2   Adrian Hunter   mmc_test: fix lar...
331
332
  	if (max_page_cnt > limit)
  		max_page_cnt = limit;
3d203be83   Adrian Hunter   mmc_test: fix mem...
333
334
  	if (min_page_cnt > max_page_cnt)
  		min_page_cnt = max_page_cnt;
64f7120d8   Adrian Hunter   mmc_test: add per...
335

c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
336
337
338
339
340
  	if (max_seg_page_cnt > max_page_cnt)
  		max_seg_page_cnt = max_page_cnt;
  
  	if (max_segs > max_page_cnt)
  		max_segs = max_page_cnt;
64f7120d8   Adrian Hunter   mmc_test: add per...
341
342
343
  	mem = kzalloc(sizeof(struct mmc_test_mem), GFP_KERNEL);
  	if (!mem)
  		return NULL;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
344
  	mem->arr = kzalloc(sizeof(struct mmc_test_pages) * max_segs,
64f7120d8   Adrian Hunter   mmc_test: add per...
345
346
347
348
349
350
351
352
353
  			   GFP_KERNEL);
  	if (!mem->arr)
  		goto out_free;
  
  	while (max_page_cnt) {
  		struct page *page;
  		unsigned int order;
  		gfp_t flags = GFP_KERNEL | GFP_DMA | __GFP_NOWARN |
  				__GFP_NORETRY;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
354
  		order = get_order(max_seg_page_cnt << PAGE_SHIFT);
64f7120d8   Adrian Hunter   mmc_test: add per...
355
356
357
358
359
360
361
362
363
364
365
366
367
368
  		while (1) {
  			page = alloc_pages(flags, order);
  			if (page || !order)
  				break;
  			order -= 1;
  		}
  		if (!page) {
  			if (page_cnt < min_page_cnt)
  				goto out_free;
  			break;
  		}
  		mem->arr[mem->cnt].page = page;
  		mem->arr[mem->cnt].order = order;
  		mem->cnt += 1;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
369
370
  		if (max_page_cnt <= (1UL << order))
  			break;
3d203be83   Adrian Hunter   mmc_test: fix mem...
371
372
  		max_page_cnt -= 1UL << order;
  		page_cnt += 1UL << order;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
373
374
375
376
377
  		if (mem->cnt >= max_segs) {
  			if (page_cnt < min_page_cnt)
  				goto out_free;
  			break;
  		}
64f7120d8   Adrian Hunter   mmc_test: add per...
378
379
380
381
382
383
384
385
386
387
388
389
390
  	}
  
  	return mem;
  
  out_free:
  	mmc_test_free_mem(mem);
  	return NULL;
  }
  
  /*
   * Map memory into a scatterlist.  Optionally allow the same memory to be
   * mapped more than once.
   */
bf0433303   Per Forlin   mmc: mmc_test: te...
391
  static int mmc_test_map_sg(struct mmc_test_mem *mem, unsigned long size,
64f7120d8   Adrian Hunter   mmc_test: add per...
392
  			   struct scatterlist *sglist, int repeat,
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
393
  			   unsigned int max_segs, unsigned int max_seg_sz,
bf0433303   Per Forlin   mmc: mmc_test: te...
394
  			   unsigned int *sg_len, int min_sg_len)
64f7120d8   Adrian Hunter   mmc_test: add per...
395
396
397
  {
  	struct scatterlist *sg = NULL;
  	unsigned int i;
bf0433303   Per Forlin   mmc: mmc_test: te...
398
  	unsigned long sz = size;
64f7120d8   Adrian Hunter   mmc_test: add per...
399
400
  
  	sg_init_table(sglist, max_segs);
bf0433303   Per Forlin   mmc: mmc_test: te...
401
402
  	if (min_sg_len > max_segs)
  		min_sg_len = max_segs;
64f7120d8   Adrian Hunter   mmc_test: add per...
403
404
405
406
  
  	*sg_len = 0;
  	do {
  		for (i = 0; i < mem->cnt; i++) {
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
407
  			unsigned long len = PAGE_SIZE << mem->arr[i].order;
64f7120d8   Adrian Hunter   mmc_test: add per...
408

bf0433303   Per Forlin   mmc: mmc_test: te...
409
410
  			if (min_sg_len && (size / min_sg_len < len))
  				len = ALIGN(size / min_sg_len, 512);
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
411
  			if (len > sz)
64f7120d8   Adrian Hunter   mmc_test: add per...
412
  				len = sz;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
413
414
  			if (len > max_seg_sz)
  				len = max_seg_sz;
64f7120d8   Adrian Hunter   mmc_test: add per...
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
  			if (sg)
  				sg = sg_next(sg);
  			else
  				sg = sglist;
  			if (!sg)
  				return -EINVAL;
  			sg_set_page(sg, mem->arr[i].page, len, 0);
  			sz -= len;
  			*sg_len += 1;
  			if (!sz)
  				break;
  		}
  	} while (sz && repeat);
  
  	if (sz)
  		return -EINVAL;
  
  	if (sg)
  		sg_mark_end(sg);
  
  	return 0;
  }
  
  /*
   * Map memory into a scatterlist so that no pages are contiguous.  Allow the
   * same memory to be mapped more than once.
   */
  static int mmc_test_map_sg_max_scatter(struct mmc_test_mem *mem,
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
443
  				       unsigned long sz,
64f7120d8   Adrian Hunter   mmc_test: add per...
444
445
  				       struct scatterlist *sglist,
  				       unsigned int max_segs,
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
446
  				       unsigned int max_seg_sz,
64f7120d8   Adrian Hunter   mmc_test: add per...
447
448
449
  				       unsigned int *sg_len)
  {
  	struct scatterlist *sg = NULL;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
450
451
  	unsigned int i = mem->cnt, cnt;
  	unsigned long len;
64f7120d8   Adrian Hunter   mmc_test: add per...
452
453
454
455
456
  	void *base, *addr, *last_addr = NULL;
  
  	sg_init_table(sglist, max_segs);
  
  	*sg_len = 0;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
457
  	while (sz) {
64f7120d8   Adrian Hunter   mmc_test: add per...
458
459
460
461
462
463
464
465
  		base = page_address(mem->arr[--i].page);
  		cnt = 1 << mem->arr[i].order;
  		while (sz && cnt) {
  			addr = base + PAGE_SIZE * --cnt;
  			if (last_addr && last_addr + PAGE_SIZE == addr)
  				continue;
  			last_addr = addr;
  			len = PAGE_SIZE;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
466
467
468
  			if (len > max_seg_sz)
  				len = max_seg_sz;
  			if (len > sz)
64f7120d8   Adrian Hunter   mmc_test: add per...
469
470
471
472
473
474
475
476
477
478
479
  				len = sz;
  			if (sg)
  				sg = sg_next(sg);
  			else
  				sg = sglist;
  			if (!sg)
  				return -EINVAL;
  			sg_set_page(sg, virt_to_page(addr), len, 0);
  			sz -= len;
  			*sg_len += 1;
  		}
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
480
481
  		if (i == 0)
  			i = mem->cnt;
64f7120d8   Adrian Hunter   mmc_test: add per...
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
  	}
  
  	if (sg)
  		sg_mark_end(sg);
  
  	return 0;
  }
  
  /*
   * Calculate transfer rate in bytes per second.
   */
  static unsigned int mmc_test_rate(uint64_t bytes, struct timespec *ts)
  {
  	uint64_t ns;
  
  	ns = ts->tv_sec;
  	ns *= 1000000000;
  	ns += ts->tv_nsec;
  
  	bytes *= 1000000000;
  
  	while (ns > UINT_MAX) {
  		bytes >>= 1;
  		ns >>= 1;
  	}
  
  	if (!ns)
  		return 0;
  
  	do_div(bytes, (uint32_t)ns);
  
  	return bytes;
  }
  
  /*
3183aa153   Andy Shevchenko   mmc_test: collect...
517
518
519
520
   * Save transfer results for future usage
   */
  static void mmc_test_save_transfer_result(struct mmc_test_card *test,
  	unsigned int count, unsigned int sectors, struct timespec ts,
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
521
  	unsigned int rate, unsigned int iops)
3183aa153   Andy Shevchenko   mmc_test: collect...
522
523
524
525
526
527
528
529
530
531
532
533
534
535
  {
  	struct mmc_test_transfer_result *tr;
  
  	if (!test->gr)
  		return;
  
  	tr = kmalloc(sizeof(struct mmc_test_transfer_result), GFP_KERNEL);
  	if (!tr)
  		return;
  
  	tr->count = count;
  	tr->sectors = sectors;
  	tr->ts = ts;
  	tr->rate = rate;
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
536
  	tr->iops = iops;
3183aa153   Andy Shevchenko   mmc_test: collect...
537
538
539
540
541
  
  	list_add_tail(&tr->link, &test->gr->tr_lst);
  }
  
  /*
64f7120d8   Adrian Hunter   mmc_test: add per...
542
543
544
545
546
   * Print the transfer rate.
   */
  static void mmc_test_print_rate(struct mmc_test_card *test, uint64_t bytes,
  				struct timespec *ts1, struct timespec *ts2)
  {
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
547
  	unsigned int rate, iops, sectors = bytes >> 9;
64f7120d8   Adrian Hunter   mmc_test: add per...
548
549
550
551
552
  	struct timespec ts;
  
  	ts = timespec_sub(*ts2, *ts1);
  
  	rate = mmc_test_rate(bytes, &ts);
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
553
  	iops = mmc_test_rate(100, &ts); /* I/O ops per sec x 100 */
64f7120d8   Adrian Hunter   mmc_test: add per...
554

a3c76eb9d   Girish K S   mmc: replace prin...
555
  	pr_info("%s: Transfer of %u sectors (%u%s KiB) took %lu.%09lu "
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
556
557
  			 "seconds (%u kB/s, %u KiB/s, %u.%02u IOPS)
  ",
64f7120d8   Adrian Hunter   mmc_test: add per...
558
  			 mmc_hostname(test->card->host), sectors, sectors >> 1,
c27d37aed   Adrian Hunter   mmc_test: fix dis...
559
  			 (sectors & 1 ? ".5" : ""), (unsigned long)ts.tv_sec,
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
560
561
  			 (unsigned long)ts.tv_nsec, rate / 1000, rate / 1024,
  			 iops / 100, iops % 100);
3183aa153   Andy Shevchenko   mmc_test: collect...
562

b6056d123   Adrian Hunter   mmc: mmc_test: ad...
563
  	mmc_test_save_transfer_result(test, 1, sectors, ts, rate, iops);
64f7120d8   Adrian Hunter   mmc_test: add per...
564
565
566
567
568
569
570
571
572
  }
  
  /*
   * Print the average transfer rate.
   */
  static void mmc_test_print_avg_rate(struct mmc_test_card *test, uint64_t bytes,
  				    unsigned int count, struct timespec *ts1,
  				    struct timespec *ts2)
  {
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
573
  	unsigned int rate, iops, sectors = bytes >> 9;
64f7120d8   Adrian Hunter   mmc_test: add per...
574
575
576
577
578
579
  	uint64_t tot = bytes * count;
  	struct timespec ts;
  
  	ts = timespec_sub(*ts2, *ts1);
  
  	rate = mmc_test_rate(tot, &ts);
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
580
  	iops = mmc_test_rate(count * 100, &ts); /* I/O ops per sec x 100 */
64f7120d8   Adrian Hunter   mmc_test: add per...
581

a3c76eb9d   Girish K S   mmc: replace prin...
582
  	pr_info("%s: Transfer of %u x %u sectors (%u x %u%s KiB) took "
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
583
  			 "%lu.%09lu seconds (%u kB/s, %u KiB/s, "
bf0433303   Per Forlin   mmc: mmc_test: te...
584
585
  			 "%u.%02u IOPS, sg_len %d)
  ",
64f7120d8   Adrian Hunter   mmc_test: add per...
586
  			 mmc_hostname(test->card->host), count, sectors, count,
c27d37aed   Adrian Hunter   mmc_test: fix dis...
587
  			 sectors >> 1, (sectors & 1 ? ".5" : ""),
64f7120d8   Adrian Hunter   mmc_test: add per...
588
  			 (unsigned long)ts.tv_sec, (unsigned long)ts.tv_nsec,
bf0433303   Per Forlin   mmc: mmc_test: te...
589
590
  			 rate / 1000, rate / 1024, iops / 100, iops % 100,
  			 test->area.sg_len);
3183aa153   Andy Shevchenko   mmc_test: collect...
591

b6056d123   Adrian Hunter   mmc: mmc_test: ad...
592
  	mmc_test_save_transfer_result(test, count, sectors, ts, rate, iops);
64f7120d8   Adrian Hunter   mmc_test: add per...
593
594
595
596
597
598
599
600
601
602
603
604
  }
  
  /*
   * Return the card size in sectors.
   */
  static unsigned int mmc_test_capacity(struct mmc_card *card)
  {
  	if (!mmc_card_sd(card) && mmc_card_blockaddr(card))
  		return card->ext_csd.sectors;
  	else
  		return card->csd.capacity << (card->csd.read_blkbits - 9);
  }
6b174931a   Pierre Ossman   mmc_test: cleanup
605
606
607
608
609
610
611
612
613
  /*******************************************************************/
  /*  Test preparation and cleanup                                   */
  /*******************************************************************/
  
  /*
   * Fill the first couple of sectors of the card with known data
   * so that bad reads/writes can be detected
   */
  static int __mmc_test_prepare(struct mmc_test_card *test, int write)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
614
615
616
617
618
619
620
621
  {
  	int ret, i;
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
  
  	if (write)
6b174931a   Pierre Ossman   mmc_test: cleanup
622
  		memset(test->buffer, 0xDF, 512);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
623
  	else {
6b174931a   Pierre Ossman   mmc_test: cleanup
624
  		for (i = 0;i < 512;i++)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
625
626
627
628
  			test->buffer[i] = i;
  	}
  
  	for (i = 0;i < BUFFER_SIZE / 512;i++) {
c286d03cc   Johan Kristell   mmc_test: block a...
629
  		ret = mmc_test_buffer_transfer(test, test->buffer, i, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
630
631
632
633
634
635
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
6b174931a   Pierre Ossman   mmc_test: cleanup
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
  static int mmc_test_prepare_write(struct mmc_test_card *test)
  {
  	return __mmc_test_prepare(test, 1);
  }
  
  static int mmc_test_prepare_read(struct mmc_test_card *test)
  {
  	return __mmc_test_prepare(test, 0);
  }
  
  static int mmc_test_cleanup(struct mmc_test_card *test)
  {
  	int ret, i;
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
  
  	memset(test->buffer, 0, 512);
  
  	for (i = 0;i < BUFFER_SIZE / 512;i++) {
c286d03cc   Johan Kristell   mmc_test: block a...
657
  		ret = mmc_test_buffer_transfer(test, test->buffer, i, 512, 1);
6b174931a   Pierre Ossman   mmc_test: cleanup
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  /*******************************************************************/
  /*  Test execution helpers                                         */
  /*******************************************************************/
  
  /*
   * Modifies the mmc_request to perform the "short transfer" tests
   */
  static void mmc_test_prepare_broken_mrq(struct mmc_test_card *test,
  	struct mmc_request *mrq, int write)
  {
  	BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  
  	if (mrq->data->blocks > 1) {
  		mrq->cmd->opcode = write ?
  			MMC_WRITE_BLOCK : MMC_READ_SINGLE_BLOCK;
  		mrq->stop = NULL;
  	} else {
  		mrq->cmd->opcode = MMC_SEND_STATUS;
  		mrq->cmd->arg = test->card->rca << 16;
  	}
  }
  
  /*
   * Checks that a normal transfer didn't have any errors
   */
  static int mmc_test_check_result(struct mmc_test_card *test,
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
691
  				 struct mmc_request *mrq)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
692
  {
6b174931a   Pierre Ossman   mmc_test: cleanup
693
694
695
696
697
  	int ret;
  
  	BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  
  	ret = 0;
4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
698
699
  	if (mrq->sbc && mrq->sbc->error)
  		ret = mrq->sbc->error;
6b174931a   Pierre Ossman   mmc_test: cleanup
700
701
702
703
704
705
706
707
708
709
710
711
712
713
  	if (!ret && mrq->cmd->error)
  		ret = mrq->cmd->error;
  	if (!ret && mrq->data->error)
  		ret = mrq->data->error;
  	if (!ret && mrq->stop && mrq->stop->error)
  		ret = mrq->stop->error;
  	if (!ret && mrq->data->bytes_xfered !=
  		mrq->data->blocks * mrq->data->blksz)
  		ret = RESULT_FAIL;
  
  	if (ret == -EINVAL)
  		ret = RESULT_UNSUP_HOST;
  
  	return ret;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
714
  }
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
715
716
717
718
719
720
721
722
723
724
  static int mmc_test_check_result_async(struct mmc_card *card,
  				       struct mmc_async_req *areq)
  {
  	struct mmc_test_async_req *test_async =
  		container_of(areq, struct mmc_test_async_req, areq);
  
  	mmc_test_wait_busy(test_async->test);
  
  	return mmc_test_check_result(test_async->test, areq->mrq);
  }
6b174931a   Pierre Ossman   mmc_test: cleanup
725
726
727
728
729
  /*
   * Checks that a "short transfer" behaved as expected
   */
  static int mmc_test_check_broken_result(struct mmc_test_card *test,
  	struct mmc_request *mrq)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
730
  {
6b174931a   Pierre Ossman   mmc_test: cleanup
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
  	int ret;
  
  	BUG_ON(!mrq || !mrq->cmd || !mrq->data);
  
  	ret = 0;
  
  	if (!ret && mrq->cmd->error)
  		ret = mrq->cmd->error;
  	if (!ret && mrq->data->error == 0)
  		ret = RESULT_FAIL;
  	if (!ret && mrq->data->error != -ETIMEDOUT)
  		ret = mrq->data->error;
  	if (!ret && mrq->stop && mrq->stop->error)
  		ret = mrq->stop->error;
  	if (mrq->data->blocks > 1) {
  		if (!ret && mrq->data->bytes_xfered > mrq->data->blksz)
  			ret = RESULT_FAIL;
  	} else {
  		if (!ret && mrq->data->bytes_xfered > 0)
  			ret = RESULT_FAIL;
  	}
  
  	if (ret == -EINVAL)
  		ret = RESULT_UNSUP_HOST;
  
  	return ret;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
757
  }
6b174931a   Pierre Ossman   mmc_test: cleanup
758
  /*
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
   * Tests nonblock transfer with certain parameters
   */
  static void mmc_test_nonblock_reset(struct mmc_request *mrq,
  				    struct mmc_command *cmd,
  				    struct mmc_command *stop,
  				    struct mmc_data *data)
  {
  	memset(mrq, 0, sizeof(struct mmc_request));
  	memset(cmd, 0, sizeof(struct mmc_command));
  	memset(data, 0, sizeof(struct mmc_data));
  	memset(stop, 0, sizeof(struct mmc_command));
  
  	mrq->cmd = cmd;
  	mrq->data = data;
  	mrq->stop = stop;
  }
  static int mmc_test_nonblock_transfer(struct mmc_test_card *test,
  				      struct scatterlist *sg, unsigned sg_len,
  				      unsigned dev_addr, unsigned blocks,
  				      unsigned blksz, int write, int count)
  {
  	struct mmc_request mrq1;
  	struct mmc_command cmd1;
  	struct mmc_command stop1;
  	struct mmc_data data1;
  
  	struct mmc_request mrq2;
  	struct mmc_command cmd2;
  	struct mmc_command stop2;
  	struct mmc_data data2;
  
  	struct mmc_test_async_req test_areq[2];
  	struct mmc_async_req *done_areq;
  	struct mmc_async_req *cur_areq = &test_areq[0].areq;
  	struct mmc_async_req *other_areq = &test_areq[1].areq;
  	int i;
1d8286ccb   Dan Carpenter   mmc: mmc_test: Un...
795
  	int ret = RESULT_OK;
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
  
  	test_areq[0].test = test;
  	test_areq[1].test = test;
  
  	mmc_test_nonblock_reset(&mrq1, &cmd1, &stop1, &data1);
  	mmc_test_nonblock_reset(&mrq2, &cmd2, &stop2, &data2);
  
  	cur_areq->mrq = &mrq1;
  	cur_areq->err_check = mmc_test_check_result_async;
  	other_areq->mrq = &mrq2;
  	other_areq->err_check = mmc_test_check_result_async;
  
  	for (i = 0; i < count; i++) {
  		mmc_test_prepare_mrq(test, cur_areq->mrq, sg, sg_len, dev_addr,
  				     blocks, blksz, write);
  		done_areq = mmc_start_req(test->card->host, cur_areq, &ret);
  
  		if (ret || (!done_areq && i > 0))
  			goto err;
  
  		if (done_areq) {
  			if (done_areq->mrq == &mrq2)
  				mmc_test_nonblock_reset(&mrq2, &cmd2,
  							&stop2, &data2);
  			else
  				mmc_test_nonblock_reset(&mrq1, &cmd1,
  							&stop1, &data1);
  		}
75fda77b2   Fabian Frederick   mmc: mmc-test: us...
824
  		swap(cur_areq, other_areq);
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
825
826
827
828
829
830
831
832
833
834
835
  		dev_addr += blocks;
  	}
  
  	done_areq = mmc_start_req(test->card->host, NULL, &ret);
  
  	return ret;
  err:
  	return ret;
  }
  
  /*
6b174931a   Pierre Ossman   mmc_test: cleanup
836
837
838
839
840
   * Tests a basic transfer with certain parameters
   */
  static int mmc_test_simple_transfer(struct mmc_test_card *test,
  	struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
  	unsigned blocks, unsigned blksz, int write)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
841
  {
24f5b53ba   Chris Ball   mmc: initialize s...
842
  	struct mmc_request mrq = {0};
1278dba16   Chris Ball   mmc: initialize s...
843
844
  	struct mmc_command cmd = {0};
  	struct mmc_command stop = {0};
a61ad2b49   Chris Ball   mmc: initialize s...
845
  	struct mmc_data data = {0};
88ae600d5   Pierre Ossman   mmc: mmc host tes...
846

6b174931a   Pierre Ossman   mmc_test: cleanup
847
848
849
850
851
852
853
854
  	mrq.cmd = &cmd;
  	mrq.data = &data;
  	mrq.stop = &stop;
  
  	mmc_test_prepare_mrq(test, &mrq, sg, sg_len, dev_addr,
  		blocks, blksz, write);
  
  	mmc_wait_for_req(test->card->host, &mrq);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
855

6b174931a   Pierre Ossman   mmc_test: cleanup
856
857
858
859
860
861
862
863
864
865
866
  	mmc_test_wait_busy(test);
  
  	return mmc_test_check_result(test, &mrq);
  }
  
  /*
   * Tests a transfer where the card will fail completely or partly
   */
  static int mmc_test_broken_transfer(struct mmc_test_card *test,
  	unsigned blocks, unsigned blksz, int write)
  {
24f5b53ba   Chris Ball   mmc: initialize s...
867
  	struct mmc_request mrq = {0};
1278dba16   Chris Ball   mmc: initialize s...
868
869
  	struct mmc_command cmd = {0};
  	struct mmc_command stop = {0};
a61ad2b49   Chris Ball   mmc: initialize s...
870
  	struct mmc_data data = {0};
6b174931a   Pierre Ossman   mmc_test: cleanup
871
872
  
  	struct scatterlist sg;
6b174931a   Pierre Ossman   mmc_test: cleanup
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
  	mrq.cmd = &cmd;
  	mrq.data = &data;
  	mrq.stop = &stop;
  
  	sg_init_one(&sg, test->buffer, blocks * blksz);
  
  	mmc_test_prepare_mrq(test, &mrq, &sg, 1, 0, blocks, blksz, write);
  	mmc_test_prepare_broken_mrq(test, &mrq, write);
  
  	mmc_wait_for_req(test->card->host, &mrq);
  
  	mmc_test_wait_busy(test);
  
  	return mmc_test_check_broken_result(test, &mrq);
  }
  
  /*
   * Does a complete transfer test where data is also validated
   *
   * Note: mmc_test_prepare() must have been done before this call
   */
  static int mmc_test_transfer(struct mmc_test_card *test,
  	struct scatterlist *sg, unsigned sg_len, unsigned dev_addr,
  	unsigned blocks, unsigned blksz, int write)
  {
  	int ret, i;
  	unsigned long flags;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
900
901
902
  
  	if (write) {
  		for (i = 0;i < blocks * blksz;i++)
6b174931a   Pierre Ossman   mmc_test: cleanup
903
904
  			test->scratch[i] = i;
  	} else {
b7ac2cf1c   Pierre Ossman   mmc_test: Revert ...
905
  		memset(test->scratch, 0, BUFFER_SIZE);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
906
  	}
6b174931a   Pierre Ossman   mmc_test: cleanup
907
  	local_irq_save(flags);
b7ac2cf1c   Pierre Ossman   mmc_test: Revert ...
908
  	sg_copy_from_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
6b174931a   Pierre Ossman   mmc_test: cleanup
909
  	local_irq_restore(flags);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
910
911
912
913
  
  	ret = mmc_test_set_blksize(test, blksz);
  	if (ret)
  		return ret;
6b174931a   Pierre Ossman   mmc_test: cleanup
914
915
  	ret = mmc_test_simple_transfer(test, sg, sg_len, dev_addr,
  		blocks, blksz, write);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
916
917
918
919
  	if (ret)
  		return ret;
  
  	if (write) {
6b174931a   Pierre Ossman   mmc_test: cleanup
920
  		int sectors;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
921
922
923
924
925
926
927
928
929
930
931
932
933
934
  		ret = mmc_test_set_blksize(test, 512);
  		if (ret)
  			return ret;
  
  		sectors = (blocks * blksz + 511) / 512;
  		if ((sectors * 512) == (blocks * blksz))
  			sectors++;
  
  		if ((sectors * 512) > BUFFER_SIZE)
  			return -EINVAL;
  
  		memset(test->buffer, 0, sectors * 512);
  
  		for (i = 0;i < sectors;i++) {
6b174931a   Pierre Ossman   mmc_test: cleanup
935
  			ret = mmc_test_buffer_transfer(test,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
936
  				test->buffer + i * 512,
c286d03cc   Johan Kristell   mmc_test: block a...
937
  				dev_addr + i, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
938
939
940
941
942
943
944
945
946
947
948
949
950
951
  			if (ret)
  				return ret;
  		}
  
  		for (i = 0;i < blocks * blksz;i++) {
  			if (test->buffer[i] != (u8)i)
  				return RESULT_FAIL;
  		}
  
  		for (;i < sectors * 512;i++) {
  			if (test->buffer[i] != 0xDF)
  				return RESULT_FAIL;
  		}
  	} else {
6b174931a   Pierre Ossman   mmc_test: cleanup
952
  		local_irq_save(flags);
b7ac2cf1c   Pierre Ossman   mmc_test: Revert ...
953
  		sg_copy_to_buffer(sg, sg_len, test->scratch, BUFFER_SIZE);
6b174931a   Pierre Ossman   mmc_test: cleanup
954
  		local_irq_restore(flags);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
955
  		for (i = 0;i < blocks * blksz;i++) {
6b174931a   Pierre Ossman   mmc_test: cleanup
956
  			if (test->scratch[i] != (u8)i)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
957
958
959
960
961
962
  				return RESULT_FAIL;
  		}
  	}
  
  	return 0;
  }
88ae600d5   Pierre Ossman   mmc: mmc host tes...
963
964
965
966
967
968
969
970
971
972
973
974
975
976
977
  /*******************************************************************/
  /*  Tests                                                          */
  /*******************************************************************/
  
  struct mmc_test_case {
  	const char *name;
  
  	int (*prepare)(struct mmc_test_card *);
  	int (*run)(struct mmc_test_card *);
  	int (*cleanup)(struct mmc_test_card *);
  };
  
  static int mmc_test_basic_write(struct mmc_test_card *test)
  {
  	int ret;
6b174931a   Pierre Ossman   mmc_test: cleanup
978
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
979
980
981
982
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
6b174931a   Pierre Ossman   mmc_test: cleanup
983
  	sg_init_one(&sg, test->buffer, 512);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
984
  	return mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
985
986
987
988
989
  }
  
  static int mmc_test_basic_read(struct mmc_test_card *test)
  {
  	int ret;
6b174931a   Pierre Ossman   mmc_test: cleanup
990
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
991
992
993
994
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
6b174931a   Pierre Ossman   mmc_test: cleanup
995
  	sg_init_one(&sg, test->buffer, 512);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
996
  	return mmc_test_simple_transfer(test, &sg, 1, 0, 1, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
997
998
999
1000
  }
  
  static int mmc_test_verify_write(struct mmc_test_card *test)
  {
6b174931a   Pierre Ossman   mmc_test: cleanup
1001
1002
1003
  	struct scatterlist sg;
  
  	sg_init_one(&sg, test->buffer, 512);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1004

30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1005
  	return mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1006
1007
1008
1009
  }
  
  static int mmc_test_verify_read(struct mmc_test_card *test)
  {
6b174931a   Pierre Ossman   mmc_test: cleanup
1010
1011
1012
  	struct scatterlist sg;
  
  	sg_init_one(&sg, test->buffer, 512);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1013

30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1014
  	return mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1015
1016
1017
1018
  }
  
  static int mmc_test_multi_write(struct mmc_test_card *test)
  {
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1019
  	unsigned int size;
6b174931a   Pierre Ossman   mmc_test: cleanup
1020
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	size = PAGE_SIZE * 2;
  	size = min(size, test->card->host->max_req_size);
  	size = min(size, test->card->host->max_seg_size);
  	size = min(size, test->card->host->max_blk_count * 512);
  
  	if (size < 1024)
  		return RESULT_UNSUP_HOST;
6b174931a   Pierre Ossman   mmc_test: cleanup
1032
  	sg_init_one(&sg, test->buffer, size);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1033
  	return mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1034
1035
1036
1037
  }
  
  static int mmc_test_multi_read(struct mmc_test_card *test)
  {
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1038
  	unsigned int size;
6b174931a   Pierre Ossman   mmc_test: cleanup
1039
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	size = PAGE_SIZE * 2;
  	size = min(size, test->card->host->max_req_size);
  	size = min(size, test->card->host->max_seg_size);
  	size = min(size, test->card->host->max_blk_count * 512);
  
  	if (size < 1024)
  		return RESULT_UNSUP_HOST;
6b174931a   Pierre Ossman   mmc_test: cleanup
1051
  	sg_init_one(&sg, test->buffer, size);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1052
  	return mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1053
1054
1055
1056
1057
  }
  
  static int mmc_test_pow2_write(struct mmc_test_card *test)
  {
  	int ret, i;
6b174931a   Pierre Ossman   mmc_test: cleanup
1058
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1059
1060
1061
1062
1063
  
  	if (!test->card->csd.write_partial)
  		return RESULT_UNSUP_CARD;
  
  	for (i = 1; i < 512;i <<= 1) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1064
1065
  		sg_init_one(&sg, test->buffer, i);
  		ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_pow2_read(struct mmc_test_card *test)
  {
  	int ret, i;
6b174931a   Pierre Ossman   mmc_test: cleanup
1076
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1077
1078
1079
1080
1081
  
  	if (!test->card->csd.read_partial)
  		return RESULT_UNSUP_CARD;
  
  	for (i = 1; i < 512;i <<= 1) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1082
1083
  		sg_init_one(&sg, test->buffer, i);
  		ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_weird_write(struct mmc_test_card *test)
  {
  	int ret, i;
6b174931a   Pierre Ossman   mmc_test: cleanup
1094
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1095
1096
1097
1098
1099
  
  	if (!test->card->csd.write_partial)
  		return RESULT_UNSUP_CARD;
  
  	for (i = 3; i < 512;i += 7) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1100
1101
  		sg_init_one(&sg, test->buffer, i);
  		ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_weird_read(struct mmc_test_card *test)
  {
  	int ret, i;
6b174931a   Pierre Ossman   mmc_test: cleanup
1112
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1113
1114
1115
1116
1117
  
  	if (!test->card->csd.read_partial)
  		return RESULT_UNSUP_CARD;
  
  	for (i = 3; i < 512;i += 7) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1118
1119
  		sg_init_one(&sg, test->buffer, i);
  		ret = mmc_test_transfer(test, &sg, 1, 0, 1, i, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_align_write(struct mmc_test_card *test)
  {
  	int ret, i;
6b174931a   Pierre Ossman   mmc_test: cleanup
1130
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1131

3ee14bf79   Adrian Hunter   mmc: mmc_test: Ex...
1132
  	for (i = 1; i < TEST_ALIGN_END; i++) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1133
1134
  		sg_init_one(&sg, test->buffer + i, 512);
  		ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_align_read(struct mmc_test_card *test)
  {
  	int ret, i;
6b174931a   Pierre Ossman   mmc_test: cleanup
1145
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1146

3ee14bf79   Adrian Hunter   mmc: mmc_test: Ex...
1147
  	for (i = 1; i < TEST_ALIGN_END; i++) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1148
1149
  		sg_init_one(&sg, test->buffer + i, 512);
  		ret = mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_align_multi_write(struct mmc_test_card *test)
  {
  	int ret, i;
  	unsigned int size;
6b174931a   Pierre Ossman   mmc_test: cleanup
1161
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	size = PAGE_SIZE * 2;
  	size = min(size, test->card->host->max_req_size);
  	size = min(size, test->card->host->max_seg_size);
  	size = min(size, test->card->host->max_blk_count * 512);
  
  	if (size < 1024)
  		return RESULT_UNSUP_HOST;
3ee14bf79   Adrian Hunter   mmc: mmc_test: Ex...
1173
  	for (i = 1; i < TEST_ALIGN_END; i++) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1174
1175
  		sg_init_one(&sg, test->buffer + i, size);
  		ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_align_multi_read(struct mmc_test_card *test)
  {
  	int ret, i;
  	unsigned int size;
6b174931a   Pierre Ossman   mmc_test: cleanup
1187
  	struct scatterlist sg;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	size = PAGE_SIZE * 2;
  	size = min(size, test->card->host->max_req_size);
  	size = min(size, test->card->host->max_seg_size);
  	size = min(size, test->card->host->max_blk_count * 512);
  
  	if (size < 1024)
  		return RESULT_UNSUP_HOST;
3ee14bf79   Adrian Hunter   mmc: mmc_test: Ex...
1199
  	for (i = 1; i < TEST_ALIGN_END; i++) {
6b174931a   Pierre Ossman   mmc_test: cleanup
1200
1201
  		sg_init_one(&sg, test->buffer + i, size);
  		ret = mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1202
1203
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
  		if (ret)
  			return ret;
  	}
  
  	return 0;
  }
  
  static int mmc_test_xfersize_write(struct mmc_test_card *test)
  {
  	int ret;
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1216
  	return mmc_test_broken_transfer(test, 1, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1217
1218
1219
1220
1221
1222
1223
1224
1225
  }
  
  static int mmc_test_xfersize_read(struct mmc_test_card *test)
  {
  	int ret;
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1226
  	return mmc_test_broken_transfer(test, 1, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
  }
  
  static int mmc_test_multi_xfersize_write(struct mmc_test_card *test)
  {
  	int ret;
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1239
  	return mmc_test_broken_transfer(test, 2, 512, 1);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1240
1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
  }
  
  static int mmc_test_multi_xfersize_read(struct mmc_test_card *test)
  {
  	int ret;
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1252
  	return mmc_test_broken_transfer(test, 2, 512, 0);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
1253
  }
2661081f5   Pierre Ossman   mmc_test: highmem...
1254
1255
1256
1257
  #ifdef CONFIG_HIGHMEM
  
  static int mmc_test_write_high(struct mmc_test_card *test)
  {
2661081f5   Pierre Ossman   mmc_test: highmem...
1258
1259
1260
1261
  	struct scatterlist sg;
  
  	sg_init_table(&sg, 1);
  	sg_set_page(&sg, test->highmem, 512, 0);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1262
  	return mmc_test_transfer(test, &sg, 1, 0, 1, 512, 1);
2661081f5   Pierre Ossman   mmc_test: highmem...
1263
1264
1265
1266
  }
  
  static int mmc_test_read_high(struct mmc_test_card *test)
  {
2661081f5   Pierre Ossman   mmc_test: highmem...
1267
1268
1269
1270
  	struct scatterlist sg;
  
  	sg_init_table(&sg, 1);
  	sg_set_page(&sg, test->highmem, 512, 0);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1271
  	return mmc_test_transfer(test, &sg, 1, 0, 1, 512, 0);
2661081f5   Pierre Ossman   mmc_test: highmem...
1272
1273
1274
1275
  }
  
  static int mmc_test_multi_write_high(struct mmc_test_card *test)
  {
2661081f5   Pierre Ossman   mmc_test: highmem...
1276
1277
1278
1279
1280
1281
1282
1283
1284
1285
1286
1287
1288
1289
1290
1291
  	unsigned int size;
  	struct scatterlist sg;
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	size = PAGE_SIZE * 2;
  	size = min(size, test->card->host->max_req_size);
  	size = min(size, test->card->host->max_seg_size);
  	size = min(size, test->card->host->max_blk_count * 512);
  
  	if (size < 1024)
  		return RESULT_UNSUP_HOST;
  
  	sg_init_table(&sg, 1);
  	sg_set_page(&sg, test->highmem, size, 0);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1292
  	return mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 1);
2661081f5   Pierre Ossman   mmc_test: highmem...
1293
1294
1295
1296
  }
  
  static int mmc_test_multi_read_high(struct mmc_test_card *test)
  {
2661081f5   Pierre Ossman   mmc_test: highmem...
1297
1298
1299
1300
1301
1302
1303
1304
1305
1306
1307
1308
1309
1310
1311
1312
  	unsigned int size;
  	struct scatterlist sg;
  
  	if (test->card->host->max_blk_count == 1)
  		return RESULT_UNSUP_HOST;
  
  	size = PAGE_SIZE * 2;
  	size = min(size, test->card->host->max_req_size);
  	size = min(size, test->card->host->max_seg_size);
  	size = min(size, test->card->host->max_blk_count * 512);
  
  	if (size < 1024)
  		return RESULT_UNSUP_HOST;
  
  	sg_init_table(&sg, 1);
  	sg_set_page(&sg, test->highmem, size, 0);
30a9b9e1e   Fabio Estevam   mmc: card: mmc_te...
1313
  	return mmc_test_transfer(test, &sg, 1, 0, size/512, 512, 0);
2661081f5   Pierre Ossman   mmc_test: highmem...
1314
  }
64f7120d8   Adrian Hunter   mmc_test: add per...
1315
1316
1317
1318
  #else
  
  static int mmc_test_no_highmem(struct mmc_test_card *test)
  {
a3c76eb9d   Girish K S   mmc: replace prin...
1319
1320
  	pr_info("%s: Highmem not configured - test skipped
  ",
64f7120d8   Adrian Hunter   mmc_test: add per...
1321
1322
1323
  	       mmc_hostname(test->card->host));
  	return 0;
  }
2661081f5   Pierre Ossman   mmc_test: highmem...
1324
  #endif /* CONFIG_HIGHMEM */
64f7120d8   Adrian Hunter   mmc_test: add per...
1325
1326
1327
  /*
   * Map sz bytes so that it can be transferred.
   */
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1328
  static int mmc_test_area_map(struct mmc_test_card *test, unsigned long sz,
bf0433303   Per Forlin   mmc: mmc_test: te...
1329
  			     int max_scatter, int min_sg_len)
64f7120d8   Adrian Hunter   mmc_test: add per...
1330
1331
  {
  	struct mmc_test_area *t = &test->area;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1332
  	int err;
64f7120d8   Adrian Hunter   mmc_test: add per...
1333
1334
1335
1336
  
  	t->blocks = sz >> 9;
  
  	if (max_scatter) {
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1337
1338
  		err = mmc_test_map_sg_max_scatter(t->mem, sz, t->sg,
  						  t->max_segs, t->max_seg_sz,
64f7120d8   Adrian Hunter   mmc_test: add per...
1339
  				       &t->sg_len);
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1340
1341
  	} else {
  		err = mmc_test_map_sg(t->mem, sz, t->sg, 1, t->max_segs,
bf0433303   Per Forlin   mmc: mmc_test: te...
1342
  				      t->max_seg_sz, &t->sg_len, min_sg_len);
64f7120d8   Adrian Hunter   mmc_test: add per...
1343
  	}
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1344
  	if (err)
a3c76eb9d   Girish K S   mmc: replace prin...
1345
1346
  		pr_info("%s: Failed to map sg list
  ",
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1347
1348
  		       mmc_hostname(test->card->host));
  	return err;
64f7120d8   Adrian Hunter   mmc_test: add per...
1349
1350
1351
1352
1353
1354
1355
1356
1357
1358
1359
1360
1361
1362
1363
  }
  
  /*
   * Transfer bytes mapped by mmc_test_area_map().
   */
  static int mmc_test_area_transfer(struct mmc_test_card *test,
  				  unsigned int dev_addr, int write)
  {
  	struct mmc_test_area *t = &test->area;
  
  	return mmc_test_simple_transfer(test, t->sg, t->sg_len, dev_addr,
  					t->blocks, 512, write);
  }
  
  /*
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1364
   * Map and transfer bytes for multiple transfers.
64f7120d8   Adrian Hunter   mmc_test: add per...
1365
   */
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1366
1367
1368
  static int mmc_test_area_io_seq(struct mmc_test_card *test, unsigned long sz,
  				unsigned int dev_addr, int write,
  				int max_scatter, int timed, int count,
bf0433303   Per Forlin   mmc: mmc_test: te...
1369
  				bool nonblock, int min_sg_len)
64f7120d8   Adrian Hunter   mmc_test: add per...
1370
1371
  {
  	struct timespec ts1, ts2;
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1372
1373
1374
  	int ret = 0;
  	int i;
  	struct mmc_test_area *t = &test->area;
64f7120d8   Adrian Hunter   mmc_test: add per...
1375

c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1376
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
  	/*
  	 * In the case of a maximally scattered transfer, the maximum transfer
  	 * size is further limited by using PAGE_SIZE segments.
  	 */
  	if (max_scatter) {
  		struct mmc_test_area *t = &test->area;
  		unsigned long max_tfr;
  
  		if (t->max_seg_sz >= PAGE_SIZE)
  			max_tfr = t->max_segs * PAGE_SIZE;
  		else
  			max_tfr = t->max_segs * t->max_seg_sz;
  		if (sz > max_tfr)
  			sz = max_tfr;
  	}
bf0433303   Per Forlin   mmc: mmc_test: te...
1391
  	ret = mmc_test_area_map(test, sz, max_scatter, min_sg_len);
64f7120d8   Adrian Hunter   mmc_test: add per...
1392
1393
1394
1395
1396
  	if (ret)
  		return ret;
  
  	if (timed)
  		getnstimeofday(&ts1);
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1397
1398
1399
1400
1401
1402
1403
1404
  	if (nonblock)
  		ret = mmc_test_nonblock_transfer(test, t->sg, t->sg_len,
  				 dev_addr, t->blocks, 512, write, count);
  	else
  		for (i = 0; i < count && ret == 0; i++) {
  			ret = mmc_test_area_transfer(test, dev_addr, write);
  			dev_addr += sz >> 9;
  		}
64f7120d8   Adrian Hunter   mmc_test: add per...
1405

64f7120d8   Adrian Hunter   mmc_test: add per...
1406
1407
1408
1409
1410
1411
1412
  	if (ret)
  		return ret;
  
  	if (timed)
  		getnstimeofday(&ts2);
  
  	if (timed)
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1413
  		mmc_test_print_avg_rate(test, sz, count, &ts1, &ts2);
64f7120d8   Adrian Hunter   mmc_test: add per...
1414
1415
1416
  
  	return 0;
  }
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1417
1418
1419
1420
1421
  static int mmc_test_area_io(struct mmc_test_card *test, unsigned long sz,
  			    unsigned int dev_addr, int write, int max_scatter,
  			    int timed)
  {
  	return mmc_test_area_io_seq(test, sz, dev_addr, write, max_scatter,
bf0433303   Per Forlin   mmc: mmc_test: te...
1422
  				    timed, 1, false, 0);
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1423
  }
64f7120d8   Adrian Hunter   mmc_test: add per...
1424
1425
1426
1427
1428
  /*
   * Write the test area entirely.
   */
  static int mmc_test_area_fill(struct mmc_test_card *test)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1429
1430
1431
  	struct mmc_test_area *t = &test->area;
  
  	return mmc_test_area_io(test, t->max_tfr, t->dev_addr, 1, 0, 0);
64f7120d8   Adrian Hunter   mmc_test: add per...
1432
1433
1434
1435
1436
1437
1438
1439
1440
1441
1442
  }
  
  /*
   * Erase the test area entirely.
   */
  static int mmc_test_area_erase(struct mmc_test_card *test)
  {
  	struct mmc_test_area *t = &test->area;
  
  	if (!mmc_can_erase(test->card))
  		return 0;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1443
  	return mmc_erase(test->card, t->dev_addr, t->max_sz >> 9,
64f7120d8   Adrian Hunter   mmc_test: add per...
1444
1445
1446
1447
1448
1449
1450
1451
1452
1453
1454
1455
1456
1457
1458
1459
1460
  			 MMC_ERASE_ARG);
  }
  
  /*
   * Cleanup struct mmc_test_area.
   */
  static int mmc_test_area_cleanup(struct mmc_test_card *test)
  {
  	struct mmc_test_area *t = &test->area;
  
  	kfree(t->sg);
  	mmc_test_free_mem(t->mem);
  
  	return 0;
  }
  
  /*
0532ff635   Adrian Hunter   mmc: mmc_test: ma...
1461
1462
1463
1464
1465
   * Initialize an area for testing large transfers.  The test area is set to the
   * middle of the card because cards may have different charateristics at the
   * front (for FAT file system optimization).  Optionally, the area is erased
   * (if the card supports it) which may improve write performance.  Optionally,
   * the area is filled with data for subsequent read tests.
64f7120d8   Adrian Hunter   mmc_test: add per...
1466
1467
1468
1469
   */
  static int mmc_test_area_init(struct mmc_test_card *test, int erase, int fill)
  {
  	struct mmc_test_area *t = &test->area;
0532ff635   Adrian Hunter   mmc: mmc_test: ma...
1470
  	unsigned long min_sz = 64 * 1024, sz;
64f7120d8   Adrian Hunter   mmc_test: add per...
1471
1472
1473
1474
1475
  	int ret;
  
  	ret = mmc_test_set_blksize(test, 512);
  	if (ret)
  		return ret;
0532ff635   Adrian Hunter   mmc: mmc_test: ma...
1476
1477
1478
1479
1480
1481
1482
  	/* Make the test area size about 4MiB */
  	sz = (unsigned long)test->card->pref_erase << 9;
  	t->max_sz = sz;
  	while (t->max_sz < 4 * 1024 * 1024)
  		t->max_sz += sz;
  	while (t->max_sz > TEST_AREA_MAX_SIZE && t->max_sz > sz)
  		t->max_sz -= sz;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1483
1484
1485
  
  	t->max_segs = test->card->host->max_segs;
  	t->max_seg_sz = test->card->host->max_seg_size;
739c69c96   Per Forlin   mmc: mmc_test: al...
1486
  	t->max_seg_sz -= t->max_seg_sz % 512;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1487
1488
1489
1490
1491
1492
1493
1494
  
  	t->max_tfr = t->max_sz;
  	if (t->max_tfr >> 9 > test->card->host->max_blk_count)
  		t->max_tfr = test->card->host->max_blk_count << 9;
  	if (t->max_tfr > test->card->host->max_req_size)
  		t->max_tfr = test->card->host->max_req_size;
  	if (t->max_tfr / t->max_seg_sz > t->max_segs)
  		t->max_tfr = t->max_segs * t->max_seg_sz;
64f7120d8   Adrian Hunter   mmc_test: add per...
1495
  	/*
3d203be83   Adrian Hunter   mmc_test: fix mem...
1496
  	 * Try to allocate enough memory for a max. sized transfer.  Less is OK
64f7120d8   Adrian Hunter   mmc_test: add per...
1497
  	 * because the same memory can be mapped into the scatterlist more than
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1498
1499
  	 * once.  Also, take into account the limits imposed on scatterlist
  	 * segments by the host driver.
64f7120d8   Adrian Hunter   mmc_test: add per...
1500
  	 */
3d203be83   Adrian Hunter   mmc_test: fix mem...
1501
  	t->mem = mmc_test_alloc_mem(min_sz, t->max_tfr, t->max_segs,
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1502
  				    t->max_seg_sz);
64f7120d8   Adrian Hunter   mmc_test: add per...
1503
1504
  	if (!t->mem)
  		return -ENOMEM;
64f7120d8   Adrian Hunter   mmc_test: add per...
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522
1523
1524
1525
1526
1527
1528
1529
1530
1531
1532
1533
1534
1535
1536
1537
1538
1539
1540
1541
1542
1543
1544
1545
1546
1547
1548
1549
1550
1551
1552
1553
1554
1555
1556
1557
1558
1559
1560
1561
1562
1563
1564
1565
1566
1567
  	t->sg = kmalloc(sizeof(struct scatterlist) * t->max_segs, GFP_KERNEL);
  	if (!t->sg) {
  		ret = -ENOMEM;
  		goto out_free;
  	}
  
  	t->dev_addr = mmc_test_capacity(test->card) / 2;
  	t->dev_addr -= t->dev_addr % (t->max_sz >> 9);
  
  	if (erase) {
  		ret = mmc_test_area_erase(test);
  		if (ret)
  			goto out_free;
  	}
  
  	if (fill) {
  		ret = mmc_test_area_fill(test);
  		if (ret)
  			goto out_free;
  	}
  
  	return 0;
  
  out_free:
  	mmc_test_area_cleanup(test);
  	return ret;
  }
  
  /*
   * Prepare for large transfers.  Do not erase the test area.
   */
  static int mmc_test_area_prepare(struct mmc_test_card *test)
  {
  	return mmc_test_area_init(test, 0, 0);
  }
  
  /*
   * Prepare for large transfers.  Do erase the test area.
   */
  static int mmc_test_area_prepare_erase(struct mmc_test_card *test)
  {
  	return mmc_test_area_init(test, 1, 0);
  }
  
  /*
   * Prepare for large transfers.  Erase and fill the test area.
   */
  static int mmc_test_area_prepare_fill(struct mmc_test_card *test)
  {
  	return mmc_test_area_init(test, 1, 1);
  }
  
  /*
   * Test best-case performance.  Best-case performance is expected from
   * a single large transfer.
   *
   * An additional option (max_scatter) allows the measurement of the same
   * transfer but with no contiguous pages in the scatter list.  This tests
   * the efficiency of DMA to handle scattered pages.
   */
  static int mmc_test_best_performance(struct mmc_test_card *test, int write,
  				     int max_scatter)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1568
1569
1570
1571
  	struct mmc_test_area *t = &test->area;
  
  	return mmc_test_area_io(test, t->max_tfr, t->dev_addr, write,
  				max_scatter, 1);
64f7120d8   Adrian Hunter   mmc_test: add per...
1572
1573
1574
1575
1576
1577
1578
1579
1580
1581
1582
1583
1584
1585
1586
1587
1588
1589
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599
1600
1601
1602
1603
1604
1605
1606
1607
1608
1609
1610
  }
  
  /*
   * Best-case read performance.
   */
  static int mmc_test_best_read_performance(struct mmc_test_card *test)
  {
  	return mmc_test_best_performance(test, 0, 0);
  }
  
  /*
   * Best-case write performance.
   */
  static int mmc_test_best_write_performance(struct mmc_test_card *test)
  {
  	return mmc_test_best_performance(test, 1, 0);
  }
  
  /*
   * Best-case read performance into scattered pages.
   */
  static int mmc_test_best_read_perf_max_scatter(struct mmc_test_card *test)
  {
  	return mmc_test_best_performance(test, 0, 1);
  }
  
  /*
   * Best-case write performance from scattered pages.
   */
  static int mmc_test_best_write_perf_max_scatter(struct mmc_test_card *test)
  {
  	return mmc_test_best_performance(test, 1, 1);
  }
  
  /*
   * Single read performance by transfer size.
   */
  static int mmc_test_profile_read_perf(struct mmc_test_card *test)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1611
  	struct mmc_test_area *t = &test->area;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1612
1613
  	unsigned long sz;
  	unsigned int dev_addr;
64f7120d8   Adrian Hunter   mmc_test: add per...
1614
  	int ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1615
1616
  	for (sz = 512; sz < t->max_tfr; sz <<= 1) {
  		dev_addr = t->dev_addr + (sz >> 9);
64f7120d8   Adrian Hunter   mmc_test: add per...
1617
1618
1619
1620
  		ret = mmc_test_area_io(test, sz, dev_addr, 0, 0, 1);
  		if (ret)
  			return ret;
  	}
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1621
1622
  	sz = t->max_tfr;
  	dev_addr = t->dev_addr;
64f7120d8   Adrian Hunter   mmc_test: add per...
1623
1624
1625
1626
1627
1628
1629
1630
  	return mmc_test_area_io(test, sz, dev_addr, 0, 0, 1);
  }
  
  /*
   * Single write performance by transfer size.
   */
  static int mmc_test_profile_write_perf(struct mmc_test_card *test)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1631
  	struct mmc_test_area *t = &test->area;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1632
1633
  	unsigned long sz;
  	unsigned int dev_addr;
64f7120d8   Adrian Hunter   mmc_test: add per...
1634
1635
1636
1637
1638
  	int ret;
  
  	ret = mmc_test_area_erase(test);
  	if (ret)
  		return ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1639
1640
  	for (sz = 512; sz < t->max_tfr; sz <<= 1) {
  		dev_addr = t->dev_addr + (sz >> 9);
64f7120d8   Adrian Hunter   mmc_test: add per...
1641
1642
1643
1644
1645
1646
1647
  		ret = mmc_test_area_io(test, sz, dev_addr, 1, 0, 1);
  		if (ret)
  			return ret;
  	}
  	ret = mmc_test_area_erase(test);
  	if (ret)
  		return ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1648
1649
  	sz = t->max_tfr;
  	dev_addr = t->dev_addr;
64f7120d8   Adrian Hunter   mmc_test: add per...
1650
1651
1652
1653
1654
1655
1656
1657
  	return mmc_test_area_io(test, sz, dev_addr, 1, 0, 1);
  }
  
  /*
   * Single trim performance by transfer size.
   */
  static int mmc_test_profile_trim_perf(struct mmc_test_card *test)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1658
  	struct mmc_test_area *t = &test->area;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1659
1660
  	unsigned long sz;
  	unsigned int dev_addr;
64f7120d8   Adrian Hunter   mmc_test: add per...
1661
1662
1663
1664
1665
1666
1667
1668
  	struct timespec ts1, ts2;
  	int ret;
  
  	if (!mmc_can_trim(test->card))
  		return RESULT_UNSUP_CARD;
  
  	if (!mmc_can_erase(test->card))
  		return RESULT_UNSUP_HOST;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1669
1670
  	for (sz = 512; sz < t->max_sz; sz <<= 1) {
  		dev_addr = t->dev_addr + (sz >> 9);
64f7120d8   Adrian Hunter   mmc_test: add per...
1671
1672
1673
1674
1675
1676
1677
  		getnstimeofday(&ts1);
  		ret = mmc_erase(test->card, dev_addr, sz >> 9, MMC_TRIM_ARG);
  		if (ret)
  			return ret;
  		getnstimeofday(&ts2);
  		mmc_test_print_rate(test, sz, &ts1, &ts2);
  	}
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1678
  	dev_addr = t->dev_addr;
64f7120d8   Adrian Hunter   mmc_test: add per...
1679
1680
1681
1682
1683
1684
1685
1686
  	getnstimeofday(&ts1);
  	ret = mmc_erase(test->card, dev_addr, sz >> 9, MMC_TRIM_ARG);
  	if (ret)
  		return ret;
  	getnstimeofday(&ts2);
  	mmc_test_print_rate(test, sz, &ts1, &ts2);
  	return 0;
  }
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1687
1688
  static int mmc_test_seq_read_perf(struct mmc_test_card *test, unsigned long sz)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1689
  	struct mmc_test_area *t = &test->area;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1690
1691
1692
  	unsigned int dev_addr, i, cnt;
  	struct timespec ts1, ts2;
  	int ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1693
1694
  	cnt = t->max_sz / sz;
  	dev_addr = t->dev_addr;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1695
1696
1697
1698
1699
1700
1701
1702
1703
1704
1705
  	getnstimeofday(&ts1);
  	for (i = 0; i < cnt; i++) {
  		ret = mmc_test_area_io(test, sz, dev_addr, 0, 0, 0);
  		if (ret)
  			return ret;
  		dev_addr += (sz >> 9);
  	}
  	getnstimeofday(&ts2);
  	mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
  	return 0;
  }
64f7120d8   Adrian Hunter   mmc_test: add per...
1706
1707
1708
1709
1710
  /*
   * Consecutive read performance by transfer size.
   */
  static int mmc_test_profile_seq_read_perf(struct mmc_test_card *test)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1711
  	struct mmc_test_area *t = &test->area;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1712
  	unsigned long sz;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1713
  	int ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1714
  	for (sz = 512; sz < t->max_tfr; sz <<= 1) {
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1715
1716
1717
1718
  		ret = mmc_test_seq_read_perf(test, sz);
  		if (ret)
  			return ret;
  	}
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1719
  	sz = t->max_tfr;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1720
1721
1722
1723
1724
  	return mmc_test_seq_read_perf(test, sz);
  }
  
  static int mmc_test_seq_write_perf(struct mmc_test_card *test, unsigned long sz)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1725
  	struct mmc_test_area *t = &test->area;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1726
  	unsigned int dev_addr, i, cnt;
64f7120d8   Adrian Hunter   mmc_test: add per...
1727
1728
  	struct timespec ts1, ts2;
  	int ret;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1729
1730
1731
  	ret = mmc_test_area_erase(test);
  	if (ret)
  		return ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1732
1733
  	cnt = t->max_sz / sz;
  	dev_addr = t->dev_addr;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1734
1735
1736
1737
1738
1739
  	getnstimeofday(&ts1);
  	for (i = 0; i < cnt; i++) {
  		ret = mmc_test_area_io(test, sz, dev_addr, 1, 0, 0);
  		if (ret)
  			return ret;
  		dev_addr += (sz >> 9);
64f7120d8   Adrian Hunter   mmc_test: add per...
1740
  	}
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1741
1742
  	getnstimeofday(&ts2);
  	mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
64f7120d8   Adrian Hunter   mmc_test: add per...
1743
1744
1745
1746
1747
1748
1749
1750
  	return 0;
  }
  
  /*
   * Consecutive write performance by transfer size.
   */
  static int mmc_test_profile_seq_write_perf(struct mmc_test_card *test)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1751
  	struct mmc_test_area *t = &test->area;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1752
  	unsigned long sz;
64f7120d8   Adrian Hunter   mmc_test: add per...
1753
  	int ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1754
  	for (sz = 512; sz < t->max_tfr; sz <<= 1) {
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1755
  		ret = mmc_test_seq_write_perf(test, sz);
64f7120d8   Adrian Hunter   mmc_test: add per...
1756
1757
  		if (ret)
  			return ret;
64f7120d8   Adrian Hunter   mmc_test: add per...
1758
  	}
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1759
  	sz = t->max_tfr;
c8c8c1bdb   Adrian Hunter   mmc_test: fix per...
1760
  	return mmc_test_seq_write_perf(test, sz);
64f7120d8   Adrian Hunter   mmc_test: add per...
1761
1762
1763
1764
1765
1766
1767
  }
  
  /*
   * Consecutive trim performance by transfer size.
   */
  static int mmc_test_profile_seq_trim_perf(struct mmc_test_card *test)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1768
  	struct mmc_test_area *t = &test->area;
fec4dcce2   Adrian Hunter   mmc_test: fix lar...
1769
1770
  	unsigned long sz;
  	unsigned int dev_addr, i, cnt;
64f7120d8   Adrian Hunter   mmc_test: add per...
1771
1772
1773
1774
1775
1776
1777
1778
  	struct timespec ts1, ts2;
  	int ret;
  
  	if (!mmc_can_trim(test->card))
  		return RESULT_UNSUP_CARD;
  
  	if (!mmc_can_erase(test->card))
  		return RESULT_UNSUP_HOST;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1779
  	for (sz = 512; sz <= t->max_sz; sz <<= 1) {
64f7120d8   Adrian Hunter   mmc_test: add per...
1780
1781
1782
1783
1784
1785
  		ret = mmc_test_area_erase(test);
  		if (ret)
  			return ret;
  		ret = mmc_test_area_fill(test);
  		if (ret)
  			return ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1786
1787
  		cnt = t->max_sz / sz;
  		dev_addr = t->dev_addr;
64f7120d8   Adrian Hunter   mmc_test: add per...
1788
1789
1790
1791
1792
1793
1794
1795
1796
1797
1798
1799
1800
  		getnstimeofday(&ts1);
  		for (i = 0; i < cnt; i++) {
  			ret = mmc_erase(test->card, dev_addr, sz >> 9,
  					MMC_TRIM_ARG);
  			if (ret)
  				return ret;
  			dev_addr += (sz >> 9);
  		}
  		getnstimeofday(&ts2);
  		mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
  	}
  	return 0;
  }
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
1801
1802
1803
1804
1805
1806
1807
1808
1809
1810
1811
1812
1813
1814
1815
1816
1817
1818
1819
1820
1821
1822
1823
1824
1825
1826
1827
1828
1829
1830
1831
1832
1833
1834
1835
1836
1837
1838
1839
1840
1841
1842
1843
1844
1845
1846
1847
1848
  static unsigned int rnd_next = 1;
  
  static unsigned int mmc_test_rnd_num(unsigned int rnd_cnt)
  {
  	uint64_t r;
  
  	rnd_next = rnd_next * 1103515245 + 12345;
  	r = (rnd_next >> 16) & 0x7fff;
  	return (r * rnd_cnt) >> 15;
  }
  
  static int mmc_test_rnd_perf(struct mmc_test_card *test, int write, int print,
  			     unsigned long sz)
  {
  	unsigned int dev_addr, cnt, rnd_addr, range1, range2, last_ea = 0, ea;
  	unsigned int ssz;
  	struct timespec ts1, ts2, ts;
  	int ret;
  
  	ssz = sz >> 9;
  
  	rnd_addr = mmc_test_capacity(test->card) / 4;
  	range1 = rnd_addr / test->card->pref_erase;
  	range2 = range1 / ssz;
  
  	getnstimeofday(&ts1);
  	for (cnt = 0; cnt < UINT_MAX; cnt++) {
  		getnstimeofday(&ts2);
  		ts = timespec_sub(ts2, ts1);
  		if (ts.tv_sec >= 10)
  			break;
  		ea = mmc_test_rnd_num(range1);
  		if (ea == last_ea)
  			ea -= 1;
  		last_ea = ea;
  		dev_addr = rnd_addr + test->card->pref_erase * ea +
  			   ssz * mmc_test_rnd_num(range2);
  		ret = mmc_test_area_io(test, sz, dev_addr, write, 0, 0);
  		if (ret)
  			return ret;
  	}
  	if (print)
  		mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
  	return 0;
  }
  
  static int mmc_test_random_perf(struct mmc_test_card *test, int write)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1849
  	struct mmc_test_area *t = &test->area;
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
1850
1851
1852
  	unsigned int next;
  	unsigned long sz;
  	int ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1853
  	for (sz = 512; sz < t->max_tfr; sz <<= 1) {
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
1854
1855
1856
1857
1858
1859
1860
1861
1862
1863
1864
1865
1866
1867
1868
1869
  		/*
  		 * When writing, try to get more consistent results by running
  		 * the test twice with exactly the same I/O but outputting the
  		 * results only for the 2nd run.
  		 */
  		if (write) {
  			next = rnd_next;
  			ret = mmc_test_rnd_perf(test, write, 0, sz);
  			if (ret)
  				return ret;
  			rnd_next = next;
  		}
  		ret = mmc_test_rnd_perf(test, write, 1, sz);
  		if (ret)
  			return ret;
  	}
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1870
  	sz = t->max_tfr;
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
1871
1872
1873
1874
1875
1876
1877
1878
1879
1880
1881
1882
1883
1884
1885
1886
1887
1888
1889
1890
1891
1892
1893
1894
1895
  	if (write) {
  		next = rnd_next;
  		ret = mmc_test_rnd_perf(test, write, 0, sz);
  		if (ret)
  			return ret;
  		rnd_next = next;
  	}
  	return mmc_test_rnd_perf(test, write, 1, sz);
  }
  
  /*
   * Random read performance by transfer size.
   */
  static int mmc_test_random_read_perf(struct mmc_test_card *test)
  {
  	return mmc_test_random_perf(test, 0);
  }
  
  /*
   * Random write performance by transfer size.
   */
  static int mmc_test_random_write_perf(struct mmc_test_card *test)
  {
  	return mmc_test_random_perf(test, 1);
  }
a803d551d   Adrian Hunter   mmc: mmc_test: ad...
1896
1897
1898
  static int mmc_test_seq_perf(struct mmc_test_card *test, int write,
  			     unsigned int tot_sz, int max_scatter)
  {
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1899
  	struct mmc_test_area *t = &test->area;
a803d551d   Adrian Hunter   mmc: mmc_test: ad...
1900
  	unsigned int dev_addr, i, cnt, sz, ssz;
5a8fba524   Chris Ball   mmc: mmc_test: Re...
1901
  	struct timespec ts1, ts2;
a803d551d   Adrian Hunter   mmc: mmc_test: ad...
1902
  	int ret;
253d6a280   Andy Shevchenko   mmc: mmc_test: mi...
1903
  	sz = t->max_tfr;
a803d551d   Adrian Hunter   mmc: mmc_test: ad...
1904
1905
1906
1907
1908
  	/*
  	 * In the case of a maximally scattered transfer, the maximum transfer
  	 * size is further limited by using PAGE_SIZE segments.
  	 */
  	if (max_scatter) {
a803d551d   Adrian Hunter   mmc: mmc_test: ad...
1909
1910
1911
1912
1913
1914
1915
1916
1917
1918
1919
1920
1921
1922
1923
1924
1925
1926
1927
1928
1929
1930
1931
1932
1933
1934
  		unsigned long max_tfr;
  
  		if (t->max_seg_sz >= PAGE_SIZE)
  			max_tfr = t->max_segs * PAGE_SIZE;
  		else
  			max_tfr = t->max_segs * t->max_seg_sz;
  		if (sz > max_tfr)
  			sz = max_tfr;
  	}
  
  	ssz = sz >> 9;
  	dev_addr = mmc_test_capacity(test->card) / 4;
  	if (tot_sz > dev_addr << 9)
  		tot_sz = dev_addr << 9;
  	cnt = tot_sz / sz;
  	dev_addr &= 0xffff0000; /* Round to 64MiB boundary */
  
  	getnstimeofday(&ts1);
  	for (i = 0; i < cnt; i++) {
  		ret = mmc_test_area_io(test, sz, dev_addr, write,
  				       max_scatter, 0);
  		if (ret)
  			return ret;
  		dev_addr += ssz;
  	}
  	getnstimeofday(&ts2);
a803d551d   Adrian Hunter   mmc: mmc_test: ad...
1935
1936
1937
1938
1939
1940
1941
1942
1943
1944
1945
1946
1947
1948
1949
1950
1951
1952
1953
1954
1955
1956
1957
1958
1959
1960
1961
1962
1963
1964
1965
1966
1967
1968
1969
1970
1971
1972
1973
1974
1975
1976
1977
  	mmc_test_print_avg_rate(test, sz, cnt, &ts1, &ts2);
  
  	return 0;
  }
  
  static int mmc_test_large_seq_perf(struct mmc_test_card *test, int write)
  {
  	int ret, i;
  
  	for (i = 0; i < 10; i++) {
  		ret = mmc_test_seq_perf(test, write, 10 * 1024 * 1024, 1);
  		if (ret)
  			return ret;
  	}
  	for (i = 0; i < 5; i++) {
  		ret = mmc_test_seq_perf(test, write, 100 * 1024 * 1024, 1);
  		if (ret)
  			return ret;
  	}
  	for (i = 0; i < 3; i++) {
  		ret = mmc_test_seq_perf(test, write, 1000 * 1024 * 1024, 1);
  		if (ret)
  			return ret;
  	}
  
  	return ret;
  }
  
  /*
   * Large sequential read performance.
   */
  static int mmc_test_large_seq_read_perf(struct mmc_test_card *test)
  {
  	return mmc_test_large_seq_perf(test, 0);
  }
  
  /*
   * Large sequential write performance.
   */
  static int mmc_test_large_seq_write_perf(struct mmc_test_card *test)
  {
  	return mmc_test_large_seq_perf(test, 1);
  }
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1978
1979
  static int mmc_test_rw_multiple(struct mmc_test_card *test,
  				struct mmc_test_multiple_rw *tdata,
bf0433303   Per Forlin   mmc: mmc_test: te...
1980
1981
  				unsigned int reqsize, unsigned int size,
  				int min_sg_len)
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
1982
1983
1984
1985
1986
1987
1988
1989
1990
1991
1992
1993
1994
1995
1996
1997
1998
1999
2000
2001
2002
2003
2004
2005
2006
2007
2008
2009
2010
2011
2012
2013
2014
2015
2016
2017
  {
  	unsigned int dev_addr;
  	struct mmc_test_area *t = &test->area;
  	int ret = 0;
  
  	/* Set up test area */
  	if (size > mmc_test_capacity(test->card) / 2 * 512)
  		size = mmc_test_capacity(test->card) / 2 * 512;
  	if (reqsize > t->max_tfr)
  		reqsize = t->max_tfr;
  	dev_addr = mmc_test_capacity(test->card) / 4;
  	if ((dev_addr & 0xffff0000))
  		dev_addr &= 0xffff0000; /* Round to 64MiB boundary */
  	else
  		dev_addr &= 0xfffff800; /* Round to 1MiB boundary */
  	if (!dev_addr)
  		goto err;
  
  	if (reqsize > size)
  		return 0;
  
  	/* prepare test area */
  	if (mmc_can_erase(test->card) &&
  	    tdata->prepare & MMC_TEST_PREP_ERASE) {
  		ret = mmc_erase(test->card, dev_addr,
  				size / 512, MMC_SECURE_ERASE_ARG);
  		if (ret)
  			ret = mmc_erase(test->card, dev_addr,
  					size / 512, MMC_ERASE_ARG);
  		if (ret)
  			goto err;
  	}
  
  	/* Run test */
  	ret = mmc_test_area_io_seq(test, reqsize, dev_addr,
  				   tdata->do_write, 0, 1, size / reqsize,
bf0433303   Per Forlin   mmc: mmc_test: te...
2018
  				   tdata->do_nonblock_req, min_sg_len);
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
2019
2020
2021
2022
2023
  	if (ret)
  		goto err;
  
  	return ret;
   err:
a3c76eb9d   Girish K S   mmc: replace prin...
2024
2025
  	pr_info("[%s] error
  ", __func__);
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
2026
2027
2028
2029
2030
2031
2032
2033
2034
2035
2036
2037
2038
  	return ret;
  }
  
  static int mmc_test_rw_multiple_size(struct mmc_test_card *test,
  				     struct mmc_test_multiple_rw *rw)
  {
  	int ret = 0;
  	int i;
  	void *pre_req = test->card->host->ops->pre_req;
  	void *post_req = test->card->host->ops->post_req;
  
  	if (rw->do_nonblock_req &&
  	    ((!pre_req && post_req) || (pre_req && !post_req))) {
a3c76eb9d   Girish K S   mmc: replace prin...
2039
2040
  		pr_info("error: only one of pre/post is defined
  ");
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
2041
2042
2043
2044
  		return -EINVAL;
  	}
  
  	for (i = 0 ; i < rw->len && ret == 0; i++) {
bf0433303   Per Forlin   mmc: mmc_test: te...
2045
2046
2047
2048
2049
2050
2051
2052
2053
2054
2055
2056
2057
2058
2059
2060
  		ret = mmc_test_rw_multiple(test, rw, rw->bs[i], rw->size, 0);
  		if (ret)
  			break;
  	}
  	return ret;
  }
  
  static int mmc_test_rw_multiple_sg_len(struct mmc_test_card *test,
  				       struct mmc_test_multiple_rw *rw)
  {
  	int ret = 0;
  	int i;
  
  	for (i = 0 ; i < rw->len && ret == 0; i++) {
  		ret = mmc_test_rw_multiple(test, rw, 512*1024, rw->size,
  					   rw->sg_len[i]);
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
2061
2062
2063
2064
2065
2066
2067
2068
2069
2070
2071
2072
2073
2074
2075
2076
2077
2078
2079
2080
2081
2082
2083
2084
2085
2086
2087
2088
2089
2090
2091
2092
2093
2094
2095
2096
2097
2098
2099
2100
2101
2102
2103
2104
2105
2106
2107
2108
2109
2110
2111
2112
2113
2114
2115
2116
2117
2118
2119
2120
2121
2122
2123
2124
2125
2126
2127
2128
2129
2130
2131
2132
2133
2134
2135
2136
2137
2138
2139
2140
2141
  		if (ret)
  			break;
  	}
  	return ret;
  }
  
  /*
   * Multiple blocking write 4k to 4 MB chunks
   */
  static int mmc_test_profile_mult_write_blocking_perf(struct mmc_test_card *test)
  {
  	unsigned int bs[] = {1 << 12, 1 << 13, 1 << 14, 1 << 15, 1 << 16,
  			     1 << 17, 1 << 18, 1 << 19, 1 << 20, 1 << 22};
  	struct mmc_test_multiple_rw test_data = {
  		.bs = bs,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(bs),
  		.do_write = true,
  		.do_nonblock_req = false,
  		.prepare = MMC_TEST_PREP_ERASE,
  	};
  
  	return mmc_test_rw_multiple_size(test, &test_data);
  };
  
  /*
   * Multiple non-blocking write 4k to 4 MB chunks
   */
  static int mmc_test_profile_mult_write_nonblock_perf(struct mmc_test_card *test)
  {
  	unsigned int bs[] = {1 << 12, 1 << 13, 1 << 14, 1 << 15, 1 << 16,
  			     1 << 17, 1 << 18, 1 << 19, 1 << 20, 1 << 22};
  	struct mmc_test_multiple_rw test_data = {
  		.bs = bs,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(bs),
  		.do_write = true,
  		.do_nonblock_req = true,
  		.prepare = MMC_TEST_PREP_ERASE,
  	};
  
  	return mmc_test_rw_multiple_size(test, &test_data);
  }
  
  /*
   * Multiple blocking read 4k to 4 MB chunks
   */
  static int mmc_test_profile_mult_read_blocking_perf(struct mmc_test_card *test)
  {
  	unsigned int bs[] = {1 << 12, 1 << 13, 1 << 14, 1 << 15, 1 << 16,
  			     1 << 17, 1 << 18, 1 << 19, 1 << 20, 1 << 22};
  	struct mmc_test_multiple_rw test_data = {
  		.bs = bs,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(bs),
  		.do_write = false,
  		.do_nonblock_req = false,
  		.prepare = MMC_TEST_PREP_NONE,
  	};
  
  	return mmc_test_rw_multiple_size(test, &test_data);
  }
  
  /*
   * Multiple non-blocking read 4k to 4 MB chunks
   */
  static int mmc_test_profile_mult_read_nonblock_perf(struct mmc_test_card *test)
  {
  	unsigned int bs[] = {1 << 12, 1 << 13, 1 << 14, 1 << 15, 1 << 16,
  			     1 << 17, 1 << 18, 1 << 19, 1 << 20, 1 << 22};
  	struct mmc_test_multiple_rw test_data = {
  		.bs = bs,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(bs),
  		.do_write = false,
  		.do_nonblock_req = true,
  		.prepare = MMC_TEST_PREP_NONE,
  	};
  
  	return mmc_test_rw_multiple_size(test, &test_data);
  }
bf0433303   Per Forlin   mmc: mmc_test: te...
2142
2143
2144
2145
2146
2147
2148
2149
2150
2151
2152
2153
2154
2155
2156
2157
2158
2159
2160
2161
2162
2163
2164
2165
2166
2167
2168
2169
2170
2171
2172
2173
2174
2175
2176
2177
2178
2179
2180
2181
2182
2183
2184
2185
2186
2187
2188
2189
2190
2191
2192
2193
2194
2195
2196
2197
2198
2199
2200
2201
2202
2203
2204
2205
2206
2207
2208
2209
2210
2211
2212
2213
2214
2215
2216
  /*
   * Multiple blocking write 1 to 512 sg elements
   */
  static int mmc_test_profile_sglen_wr_blocking_perf(struct mmc_test_card *test)
  {
  	unsigned int sg_len[] = {1, 1 << 3, 1 << 4, 1 << 5, 1 << 6,
  				 1 << 7, 1 << 8, 1 << 9};
  	struct mmc_test_multiple_rw test_data = {
  		.sg_len = sg_len,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(sg_len),
  		.do_write = true,
  		.do_nonblock_req = false,
  		.prepare = MMC_TEST_PREP_ERASE,
  	};
  
  	return mmc_test_rw_multiple_sg_len(test, &test_data);
  };
  
  /*
   * Multiple non-blocking write 1 to 512 sg elements
   */
  static int mmc_test_profile_sglen_wr_nonblock_perf(struct mmc_test_card *test)
  {
  	unsigned int sg_len[] = {1, 1 << 3, 1 << 4, 1 << 5, 1 << 6,
  				 1 << 7, 1 << 8, 1 << 9};
  	struct mmc_test_multiple_rw test_data = {
  		.sg_len = sg_len,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(sg_len),
  		.do_write = true,
  		.do_nonblock_req = true,
  		.prepare = MMC_TEST_PREP_ERASE,
  	};
  
  	return mmc_test_rw_multiple_sg_len(test, &test_data);
  }
  
  /*
   * Multiple blocking read 1 to 512 sg elements
   */
  static int mmc_test_profile_sglen_r_blocking_perf(struct mmc_test_card *test)
  {
  	unsigned int sg_len[] = {1, 1 << 3, 1 << 4, 1 << 5, 1 << 6,
  				 1 << 7, 1 << 8, 1 << 9};
  	struct mmc_test_multiple_rw test_data = {
  		.sg_len = sg_len,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(sg_len),
  		.do_write = false,
  		.do_nonblock_req = false,
  		.prepare = MMC_TEST_PREP_NONE,
  	};
  
  	return mmc_test_rw_multiple_sg_len(test, &test_data);
  }
  
  /*
   * Multiple non-blocking read 1 to 512 sg elements
   */
  static int mmc_test_profile_sglen_r_nonblock_perf(struct mmc_test_card *test)
  {
  	unsigned int sg_len[] = {1, 1 << 3, 1 << 4, 1 << 5, 1 << 6,
  				 1 << 7, 1 << 8, 1 << 9};
  	struct mmc_test_multiple_rw test_data = {
  		.sg_len = sg_len,
  		.size = TEST_AREA_MAX_SIZE,
  		.len = ARRAY_SIZE(sg_len),
  		.do_write = false,
  		.do_nonblock_req = true,
  		.prepare = MMC_TEST_PREP_NONE,
  	};
  
  	return mmc_test_rw_multiple_sg_len(test, &test_data);
  }
2311344c3   Adrian Hunter   mmc: mmc-test: ad...
2217
2218
2219
  /*
   * eMMC hardware reset.
   */
08b137d90   Chaotian Jing   mmc: core: Fix in...
2220
  static int mmc_test_reset(struct mmc_test_card *test)
2311344c3   Adrian Hunter   mmc: mmc-test: ad...
2221
2222
2223
2224
  {
  	struct mmc_card *card = test->card;
  	struct mmc_host *host = card->host;
  	int err;
83533ab28   Johan Rudholm   mmc: core: always...
2225
  	err = mmc_hw_reset(host);
2311344c3   Adrian Hunter   mmc: mmc-test: ad...
2226
2227
  	if (!err)
  		return RESULT_OK;
83533ab28   Johan Rudholm   mmc: core: always...
2228
2229
  	else if (err == -EOPNOTSUPP)
  		return RESULT_UNSUP_HOST;
2311344c3   Adrian Hunter   mmc: mmc-test: ad...
2230

83533ab28   Johan Rudholm   mmc: core: always...
2231
  	return RESULT_FAIL;
2311344c3   Adrian Hunter   mmc: mmc-test: ad...
2232
  }
4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
2233
2234
2235
2236
2237
2238
2239
2240
2241
2242
2243
2244
2245
2246
2247
2248
2249
2250
2251
2252
2253
2254
2255
2256
2257
2258
2259
2260
2261
2262
2263
2264
2265
2266
2267
2268
2269
2270
2271
2272
2273
2274
  struct mmc_test_req {
  	struct mmc_request mrq;
  	struct mmc_command sbc;
  	struct mmc_command cmd;
  	struct mmc_command stop;
  	struct mmc_command status;
  	struct mmc_data data;
  };
  
  static struct mmc_test_req *mmc_test_req_alloc(void)
  {
  	struct mmc_test_req *rq = kzalloc(sizeof(*rq), GFP_KERNEL);
  
  	if (rq) {
  		rq->mrq.cmd = &rq->cmd;
  		rq->mrq.data = &rq->data;
  		rq->mrq.stop = &rq->stop;
  	}
  
  	return rq;
  }
  
  static int mmc_test_send_status(struct mmc_test_card *test,
  				struct mmc_command *cmd)
  {
  	memset(cmd, 0, sizeof(*cmd));
  
  	cmd->opcode = MMC_SEND_STATUS;
  	if (!mmc_host_is_spi(test->card->host))
  		cmd->arg = test->card->rca << 16;
  	cmd->flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_AC;
  
  	return mmc_wait_for_cmd(test->card->host, cmd, 0);
  }
  
  static int mmc_test_ongoing_transfer(struct mmc_test_card *test,
  				     unsigned int dev_addr, int use_sbc,
  				     int repeat_cmd, int write, int use_areq)
  {
  	struct mmc_test_req *rq = mmc_test_req_alloc();
  	struct mmc_host *host = test->card->host;
  	struct mmc_test_area *t = &test->area;
be55f7bee   Adrian Hunter   mmc: mmc_test: Fi...
2275
  	struct mmc_test_async_req test_areq = { .test = test };
4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
2276
2277
2278
2279
2280
2281
2282
2283
2284
2285
2286
2287
2288
2289
  	struct mmc_request *mrq;
  	unsigned long timeout;
  	bool expired = false;
  	int ret = 0, cmd_ret;
  	u32 status = 0;
  	int count = 0;
  
  	if (!rq)
  		return -ENOMEM;
  
  	mrq = &rq->mrq;
  	if (use_sbc)
  		mrq->sbc = &rq->sbc;
  	mrq->cap_cmd_during_tfr = true;
be55f7bee   Adrian Hunter   mmc: mmc_test: Fi...
2290
2291
  	test_areq.areq.mrq = mrq;
  	test_areq.areq.err_check = mmc_test_check_result_async;
4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
2292
2293
2294
2295
2296
2297
2298
2299
2300
2301
2302
2303
2304
  
  	mmc_test_prepare_mrq(test, mrq, t->sg, t->sg_len, dev_addr, t->blocks,
  			     512, write);
  
  	if (use_sbc && t->blocks > 1 && !mrq->sbc) {
  		ret =  mmc_host_cmd23(host) ?
  		       RESULT_UNSUP_CARD :
  		       RESULT_UNSUP_HOST;
  		goto out_free;
  	}
  
  	/* Start ongoing data request */
  	if (use_areq) {
be55f7bee   Adrian Hunter   mmc: mmc_test: Fi...
2305
  		mmc_start_req(host, &test_areq.areq, &ret);
4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
2306
2307
2308
2309
2310
2311
2312
2313
2314
2315
2316
2317
2318
2319
2320
2321
2322
2323
2324
2325
2326
2327
2328
2329
2330
2331
2332
2333
2334
2335
2336
2337
2338
2339
2340
2341
2342
2343
2344
2345
2346
2347
2348
2349
2350
2351
2352
2353
2354
2355
2356
2357
2358
2359
2360
2361
2362
2363
2364
2365
2366
2367
2368
2369
2370
2371
2372
2373
2374
2375
2376
2377
2378
2379
2380
2381
2382
2383
2384
2385
2386
2387
2388
2389
2390
2391
2392
2393
2394
2395
2396
2397
2398
2399
2400
2401
2402
2403
2404
2405
2406
2407
2408
2409
2410
2411
2412
2413
2414
2415
2416
2417
2418
2419
2420
2421
2422
2423
2424
2425
2426
2427
2428
2429
2430
2431
2432
2433
2434
2435
2436
2437
2438
2439
2440
2441
2442
2443
2444
2445
2446
2447
2448
2449
2450
2451
2452
2453
2454
2455
2456
2457
2458
2459
2460
2461
2462
2463
2464
2465
2466
2467
2468
2469
2470
2471
2472
  		if (ret)
  			goto out_free;
  	} else {
  		mmc_wait_for_req(host, mrq);
  	}
  
  	timeout = jiffies + msecs_to_jiffies(3000);
  	do {
  		count += 1;
  
  		/* Send status command while data transfer in progress */
  		cmd_ret = mmc_test_send_status(test, &rq->status);
  		if (cmd_ret)
  			break;
  
  		status = rq->status.resp[0];
  		if (status & R1_ERROR) {
  			cmd_ret = -EIO;
  			break;
  		}
  
  		if (mmc_is_req_done(host, mrq))
  			break;
  
  		expired = time_after(jiffies, timeout);
  		if (expired) {
  			pr_info("%s: timeout waiting for Tran state status %#x
  ",
  				mmc_hostname(host), status);
  			cmd_ret = -ETIMEDOUT;
  			break;
  		}
  	} while (repeat_cmd && R1_CURRENT_STATE(status) != R1_STATE_TRAN);
  
  	/* Wait for data request to complete */
  	if (use_areq)
  		mmc_start_req(host, NULL, &ret);
  	else
  		mmc_wait_for_req_done(test->card->host, mrq);
  
  	/*
  	 * For cap_cmd_during_tfr request, upper layer must send stop if
  	 * required.
  	 */
  	if (mrq->data->stop && (mrq->data->error || !mrq->sbc)) {
  		if (ret)
  			mmc_wait_for_cmd(host, mrq->data->stop, 0);
  		else
  			ret = mmc_wait_for_cmd(host, mrq->data->stop, 0);
  	}
  
  	if (ret)
  		goto out_free;
  
  	if (cmd_ret) {
  		pr_info("%s: Send Status failed: status %#x, error %d
  ",
  			mmc_hostname(test->card->host), status, cmd_ret);
  	}
  
  	ret = mmc_test_check_result(test, mrq);
  	if (ret)
  		goto out_free;
  
  	ret = mmc_test_wait_busy(test);
  	if (ret)
  		goto out_free;
  
  	if (repeat_cmd && (t->blocks + 1) << 9 > t->max_tfr)
  		pr_info("%s: %d commands completed during transfer of %u blocks
  ",
  			mmc_hostname(test->card->host), count, t->blocks);
  
  	if (cmd_ret)
  		ret = cmd_ret;
  out_free:
  	kfree(rq);
  
  	return ret;
  }
  
  static int __mmc_test_cmds_during_tfr(struct mmc_test_card *test,
  				      unsigned long sz, int use_sbc, int write,
  				      int use_areq)
  {
  	struct mmc_test_area *t = &test->area;
  	int ret;
  
  	if (!(test->card->host->caps & MMC_CAP_CMD_DURING_TFR))
  		return RESULT_UNSUP_HOST;
  
  	ret = mmc_test_area_map(test, sz, 0, 0);
  	if (ret)
  		return ret;
  
  	ret = mmc_test_ongoing_transfer(test, t->dev_addr, use_sbc, 0, write,
  					use_areq);
  	if (ret)
  		return ret;
  
  	return mmc_test_ongoing_transfer(test, t->dev_addr, use_sbc, 1, write,
  					 use_areq);
  }
  
  static int mmc_test_cmds_during_tfr(struct mmc_test_card *test, int use_sbc,
  				    int write, int use_areq)
  {
  	struct mmc_test_area *t = &test->area;
  	unsigned long sz;
  	int ret;
  
  	for (sz = 512; sz <= t->max_tfr; sz += 512) {
  		ret = __mmc_test_cmds_during_tfr(test, sz, use_sbc, write,
  						 use_areq);
  		if (ret)
  			return ret;
  	}
  	return 0;
  }
  
  /*
   * Commands during read - no Set Block Count (CMD23).
   */
  static int mmc_test_cmds_during_read(struct mmc_test_card *test)
  {
  	return mmc_test_cmds_during_tfr(test, 0, 0, 0);
  }
  
  /*
   * Commands during write - no Set Block Count (CMD23).
   */
  static int mmc_test_cmds_during_write(struct mmc_test_card *test)
  {
  	return mmc_test_cmds_during_tfr(test, 0, 1, 0);
  }
  
  /*
   * Commands during read - use Set Block Count (CMD23).
   */
  static int mmc_test_cmds_during_read_cmd23(struct mmc_test_card *test)
  {
  	return mmc_test_cmds_during_tfr(test, 1, 0, 0);
  }
  
  /*
   * Commands during write - use Set Block Count (CMD23).
   */
  static int mmc_test_cmds_during_write_cmd23(struct mmc_test_card *test)
  {
  	return mmc_test_cmds_during_tfr(test, 1, 1, 0);
  }
  
  /*
   * Commands during non-blocking read - use Set Block Count (CMD23).
   */
  static int mmc_test_cmds_during_read_cmd23_nonblock(struct mmc_test_card *test)
  {
  	return mmc_test_cmds_during_tfr(test, 1, 0, 1);
  }
  
  /*
   * Commands during non-blocking write - use Set Block Count (CMD23).
   */
  static int mmc_test_cmds_during_write_cmd23_nonblock(struct mmc_test_card *test)
  {
  	return mmc_test_cmds_during_tfr(test, 1, 1, 1);
  }
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2473
2474
2475
2476
2477
2478
2479
2480
2481
2482
2483
2484
2485
  static const struct mmc_test_case mmc_test_cases[] = {
  	{
  		.name = "Basic write (no data verification)",
  		.run = mmc_test_basic_write,
  	},
  
  	{
  		.name = "Basic read (no data verification)",
  		.run = mmc_test_basic_read,
  	},
  
  	{
  		.name = "Basic write (with data verification)",
6b174931a   Pierre Ossman   mmc_test: cleanup
2486
  		.prepare = mmc_test_prepare_write,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2487
  		.run = mmc_test_verify_write,
6b174931a   Pierre Ossman   mmc_test: cleanup
2488
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2489
2490
2491
2492
  	},
  
  	{
  		.name = "Basic read (with data verification)",
6b174931a   Pierre Ossman   mmc_test: cleanup
2493
  		.prepare = mmc_test_prepare_read,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2494
  		.run = mmc_test_verify_read,
6b174931a   Pierre Ossman   mmc_test: cleanup
2495
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2496
2497
2498
2499
  	},
  
  	{
  		.name = "Multi-block write",
6b174931a   Pierre Ossman   mmc_test: cleanup
2500
  		.prepare = mmc_test_prepare_write,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2501
  		.run = mmc_test_multi_write,
6b174931a   Pierre Ossman   mmc_test: cleanup
2502
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2503
2504
2505
2506
  	},
  
  	{
  		.name = "Multi-block read",
6b174931a   Pierre Ossman   mmc_test: cleanup
2507
  		.prepare = mmc_test_prepare_read,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2508
  		.run = mmc_test_multi_read,
6b174931a   Pierre Ossman   mmc_test: cleanup
2509
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2510
2511
2512
2513
  	},
  
  	{
  		.name = "Power of two block writes",
6b174931a   Pierre Ossman   mmc_test: cleanup
2514
  		.prepare = mmc_test_prepare_write,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2515
  		.run = mmc_test_pow2_write,
6b174931a   Pierre Ossman   mmc_test: cleanup
2516
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2517
2518
2519
2520
  	},
  
  	{
  		.name = "Power of two block reads",
6b174931a   Pierre Ossman   mmc_test: cleanup
2521
  		.prepare = mmc_test_prepare_read,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2522
  		.run = mmc_test_pow2_read,
6b174931a   Pierre Ossman   mmc_test: cleanup
2523
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2524
2525
2526
2527
  	},
  
  	{
  		.name = "Weird sized block writes",
6b174931a   Pierre Ossman   mmc_test: cleanup
2528
  		.prepare = mmc_test_prepare_write,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2529
  		.run = mmc_test_weird_write,
6b174931a   Pierre Ossman   mmc_test: cleanup
2530
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2531
2532
2533
2534
  	},
  
  	{
  		.name = "Weird sized block reads",
6b174931a   Pierre Ossman   mmc_test: cleanup
2535
  		.prepare = mmc_test_prepare_read,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2536
  		.run = mmc_test_weird_read,
6b174931a   Pierre Ossman   mmc_test: cleanup
2537
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2538
2539
2540
2541
  	},
  
  	{
  		.name = "Badly aligned write",
6b174931a   Pierre Ossman   mmc_test: cleanup
2542
  		.prepare = mmc_test_prepare_write,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2543
  		.run = mmc_test_align_write,
6b174931a   Pierre Ossman   mmc_test: cleanup
2544
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2545
2546
2547
2548
  	},
  
  	{
  		.name = "Badly aligned read",
6b174931a   Pierre Ossman   mmc_test: cleanup
2549
  		.prepare = mmc_test_prepare_read,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2550
  		.run = mmc_test_align_read,
6b174931a   Pierre Ossman   mmc_test: cleanup
2551
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2552
2553
2554
2555
  	},
  
  	{
  		.name = "Badly aligned multi-block write",
6b174931a   Pierre Ossman   mmc_test: cleanup
2556
  		.prepare = mmc_test_prepare_write,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2557
  		.run = mmc_test_align_multi_write,
6b174931a   Pierre Ossman   mmc_test: cleanup
2558
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2559
2560
2561
2562
  	},
  
  	{
  		.name = "Badly aligned multi-block read",
6b174931a   Pierre Ossman   mmc_test: cleanup
2563
  		.prepare = mmc_test_prepare_read,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2564
  		.run = mmc_test_align_multi_read,
6b174931a   Pierre Ossman   mmc_test: cleanup
2565
  		.cleanup = mmc_test_cleanup,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2566
2567
2568
2569
2570
2571
2572
2573
2574
2575
2576
2577
2578
2579
2580
2581
2582
2583
2584
2585
2586
  	},
  
  	{
  		.name = "Correct xfer_size at write (start failure)",
  		.run = mmc_test_xfersize_write,
  	},
  
  	{
  		.name = "Correct xfer_size at read (start failure)",
  		.run = mmc_test_xfersize_read,
  	},
  
  	{
  		.name = "Correct xfer_size at write (midway failure)",
  		.run = mmc_test_multi_xfersize_write,
  	},
  
  	{
  		.name = "Correct xfer_size at read (midway failure)",
  		.run = mmc_test_multi_xfersize_read,
  	},
2661081f5   Pierre Ossman   mmc_test: highmem...
2587
2588
2589
2590
2591
2592
2593
2594
2595
2596
2597
2598
2599
2600
2601
2602
2603
2604
2605
2606
2607
2608
2609
2610
2611
2612
2613
2614
2615
2616
  
  #ifdef CONFIG_HIGHMEM
  
  	{
  		.name = "Highmem write",
  		.prepare = mmc_test_prepare_write,
  		.run = mmc_test_write_high,
  		.cleanup = mmc_test_cleanup,
  	},
  
  	{
  		.name = "Highmem read",
  		.prepare = mmc_test_prepare_read,
  		.run = mmc_test_read_high,
  		.cleanup = mmc_test_cleanup,
  	},
  
  	{
  		.name = "Multi-block highmem write",
  		.prepare = mmc_test_prepare_write,
  		.run = mmc_test_multi_write_high,
  		.cleanup = mmc_test_cleanup,
  	},
  
  	{
  		.name = "Multi-block highmem read",
  		.prepare = mmc_test_prepare_read,
  		.run = mmc_test_multi_read_high,
  		.cleanup = mmc_test_cleanup,
  	},
64f7120d8   Adrian Hunter   mmc_test: add per...
2617
2618
2619
2620
2621
2622
2623
2624
2625
2626
2627
2628
2629
2630
2631
2632
2633
2634
2635
2636
2637
  #else
  
  	{
  		.name = "Highmem write",
  		.run = mmc_test_no_highmem,
  	},
  
  	{
  		.name = "Highmem read",
  		.run = mmc_test_no_highmem,
  	},
  
  	{
  		.name = "Multi-block highmem write",
  		.run = mmc_test_no_highmem,
  	},
  
  	{
  		.name = "Multi-block highmem read",
  		.run = mmc_test_no_highmem,
  	},
2661081f5   Pierre Ossman   mmc_test: highmem...
2638
  #endif /* CONFIG_HIGHMEM */
64f7120d8   Adrian Hunter   mmc_test: add per...
2639
2640
2641
2642
2643
2644
2645
2646
2647
2648
2649
2650
2651
2652
2653
2654
2655
2656
2657
2658
2659
2660
2661
2662
2663
2664
2665
2666
2667
2668
2669
2670
2671
2672
2673
2674
2675
2676
2677
2678
2679
2680
2681
2682
2683
2684
2685
2686
2687
2688
2689
2690
2691
2692
2693
2694
2695
2696
2697
2698
2699
2700
2701
2702
2703
2704
2705
2706
2707
  	{
  		.name = "Best-case read performance",
  		.prepare = mmc_test_area_prepare_fill,
  		.run = mmc_test_best_read_performance,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Best-case write performance",
  		.prepare = mmc_test_area_prepare_erase,
  		.run = mmc_test_best_write_performance,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Best-case read performance into scattered pages",
  		.prepare = mmc_test_area_prepare_fill,
  		.run = mmc_test_best_read_perf_max_scatter,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Best-case write performance from scattered pages",
  		.prepare = mmc_test_area_prepare_erase,
  		.run = mmc_test_best_write_perf_max_scatter,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Single read performance by transfer size",
  		.prepare = mmc_test_area_prepare_fill,
  		.run = mmc_test_profile_read_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Single write performance by transfer size",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_write_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Single trim performance by transfer size",
  		.prepare = mmc_test_area_prepare_fill,
  		.run = mmc_test_profile_trim_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Consecutive read performance by transfer size",
  		.prepare = mmc_test_area_prepare_fill,
  		.run = mmc_test_profile_seq_read_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Consecutive write performance by transfer size",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_seq_write_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Consecutive trim performance by transfer size",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_seq_trim_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
2708
2709
2710
2711
2712
2713
2714
2715
2716
2717
2718
2719
2720
  	{
  		.name = "Random read performance by transfer size",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_random_read_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Random write performance by transfer size",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_random_write_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
a803d551d   Adrian Hunter   mmc: mmc_test: ad...
2721
2722
2723
2724
2725
2726
2727
2728
2729
2730
2731
2732
2733
  	{
  		.name = "Large sequential read into scattered pages",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_large_seq_read_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Large sequential write from scattered pages",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_large_seq_write_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
9f9c4180f   Per Forlin   mmc: mmc_test: ad...
2734
2735
2736
2737
2738
2739
2740
2741
2742
2743
2744
2745
2746
2747
2748
2749
2750
2751
2752
2753
2754
2755
2756
2757
2758
2759
2760
  	{
  		.name = "Write performance with blocking req 4k to 4MB",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_mult_write_blocking_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Write performance with non-blocking req 4k to 4MB",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_mult_write_nonblock_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Read performance with blocking req 4k to 4MB",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_mult_read_blocking_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Read performance with non-blocking req 4k to 4MB",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_mult_read_nonblock_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
bf0433303   Per Forlin   mmc: mmc_test: te...
2761
2762
2763
2764
2765
2766
2767
2768
2769
2770
2771
2772
2773
2774
2775
2776
2777
2778
2779
2780
2781
2782
2783
2784
2785
2786
2787
2788
  
  	{
  		.name = "Write performance blocking req 1 to 512 sg elems",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_sglen_wr_blocking_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Write performance non-blocking req 1 to 512 sg elems",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_sglen_wr_nonblock_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Read performance blocking req 1 to 512 sg elems",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_sglen_r_blocking_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Read performance non-blocking req 1 to 512 sg elems",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_profile_sglen_r_nonblock_perf,
  		.cleanup = mmc_test_area_cleanup,
  	},
2311344c3   Adrian Hunter   mmc: mmc-test: ad...
2789
2790
  
  	{
08b137d90   Chaotian Jing   mmc: core: Fix in...
2791
2792
  		.name = "Reset test",
  		.run = mmc_test_reset,
2311344c3   Adrian Hunter   mmc: mmc-test: ad...
2793
  	},
4bbb9aac9   Adrian Hunter   mmc: mmc_test: Ad...
2794
2795
2796
2797
2798
2799
2800
2801
2802
2803
2804
2805
2806
2807
2808
2809
2810
2811
2812
2813
2814
2815
2816
2817
2818
2819
2820
2821
2822
2823
2824
2825
2826
2827
2828
2829
2830
2831
2832
2833
2834
2835
  
  	{
  		.name = "Commands during read - no Set Block Count (CMD23)",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_cmds_during_read,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Commands during write - no Set Block Count (CMD23)",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_cmds_during_write,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Commands during read - use Set Block Count (CMD23)",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_cmds_during_read_cmd23,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Commands during write - use Set Block Count (CMD23)",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_cmds_during_write_cmd23,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Commands during non-blocking read - use Set Block Count (CMD23)",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_cmds_during_read_cmd23_nonblock,
  		.cleanup = mmc_test_area_cleanup,
  	},
  
  	{
  		.name = "Commands during non-blocking write - use Set Block Count (CMD23)",
  		.prepare = mmc_test_area_prepare,
  		.run = mmc_test_cmds_during_write_cmd23_nonblock,
  		.cleanup = mmc_test_area_cleanup,
  	},
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2836
  };
a650031a6   Akinobu Mita   mmc_test: initial...
2837
  static DEFINE_MUTEX(mmc_test_lock);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2838

3183aa153   Andy Shevchenko   mmc_test: collect...
2839
  static LIST_HEAD(mmc_test_result);
fd8c326ca   Pierre Ossman   mmc_test: add tes...
2840
  static void mmc_test_run(struct mmc_test_card *test, int testcase)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2841
2842
  {
  	int i, ret;
a3c76eb9d   Girish K S   mmc: replace prin...
2843
2844
  	pr_info("%s: Starting tests of card %s...
  ",
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2845
2846
2847
2848
2849
  		mmc_hostname(test->card->host), mmc_card_id(test->card));
  
  	mmc_claim_host(test->card->host);
  
  	for (i = 0;i < ARRAY_SIZE(mmc_test_cases);i++) {
3183aa153   Andy Shevchenko   mmc_test: collect...
2850
  		struct mmc_test_general_result *gr;
fd8c326ca   Pierre Ossman   mmc_test: add tes...
2851
2852
  		if (testcase && ((i + 1) != testcase))
  			continue;
a3c76eb9d   Girish K S   mmc: replace prin...
2853
2854
  		pr_info("%s: Test case %d. %s...
  ",
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2855
2856
2857
2858
2859
2860
  			mmc_hostname(test->card->host), i + 1,
  			mmc_test_cases[i].name);
  
  		if (mmc_test_cases[i].prepare) {
  			ret = mmc_test_cases[i].prepare(test);
  			if (ret) {
a3c76eb9d   Girish K S   mmc: replace prin...
2861
  				pr_info("%s: Result: Prepare "
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2862
2863
2864
2865
2866
2867
2868
  					"stage failed! (%d)
  ",
  					mmc_hostname(test->card->host),
  					ret);
  				continue;
  			}
  		}
3183aa153   Andy Shevchenko   mmc_test: collect...
2869
2870
2871
2872
2873
2874
2875
2876
2877
2878
2879
2880
2881
2882
2883
2884
2885
2886
  		gr = kzalloc(sizeof(struct mmc_test_general_result),
  			GFP_KERNEL);
  		if (gr) {
  			INIT_LIST_HEAD(&gr->tr_lst);
  
  			/* Assign data what we know already */
  			gr->card = test->card;
  			gr->testcase = i;
  
  			/* Append container to global one */
  			list_add_tail(&gr->link, &mmc_test_result);
  
  			/*
  			 * Save the pointer to created container in our private
  			 * structure.
  			 */
  			test->gr = gr;
  		}
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2887
2888
2889
  		ret = mmc_test_cases[i].run(test);
  		switch (ret) {
  		case RESULT_OK:
a3c76eb9d   Girish K S   mmc: replace prin...
2890
2891
  			pr_info("%s: Result: OK
  ",
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2892
2893
2894
  				mmc_hostname(test->card->host));
  			break;
  		case RESULT_FAIL:
a3c76eb9d   Girish K S   mmc: replace prin...
2895
2896
  			pr_info("%s: Result: FAILED
  ",
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2897
2898
2899
  				mmc_hostname(test->card->host));
  			break;
  		case RESULT_UNSUP_HOST:
a3c76eb9d   Girish K S   mmc: replace prin...
2900
  			pr_info("%s: Result: UNSUPPORTED "
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2901
2902
2903
2904
2905
  				"(by host)
  ",
  				mmc_hostname(test->card->host));
  			break;
  		case RESULT_UNSUP_CARD:
a3c76eb9d   Girish K S   mmc: replace prin...
2906
  			pr_info("%s: Result: UNSUPPORTED "
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2907
2908
2909
2910
2911
  				"(by card)
  ",
  				mmc_hostname(test->card->host));
  			break;
  		default:
a3c76eb9d   Girish K S   mmc: replace prin...
2912
2913
  			pr_info("%s: Result: ERROR (%d)
  ",
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2914
2915
  				mmc_hostname(test->card->host), ret);
  		}
3183aa153   Andy Shevchenko   mmc_test: collect...
2916
2917
2918
  		/* Save the result */
  		if (gr)
  			gr->result = ret;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2919
2920
2921
  		if (mmc_test_cases[i].cleanup) {
  			ret = mmc_test_cases[i].cleanup(test);
  			if (ret) {
a3c76eb9d   Girish K S   mmc: replace prin...
2922
  				pr_info("%s: Warning: Cleanup "
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2923
2924
2925
2926
2927
2928
2929
2930
2931
  					"stage failed! (%d)
  ",
  					mmc_hostname(test->card->host),
  					ret);
  			}
  		}
  	}
  
  	mmc_release_host(test->card->host);
a3c76eb9d   Girish K S   mmc: replace prin...
2932
2933
  	pr_info("%s: Tests completed.
  ",
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2934
2935
  		mmc_hostname(test->card->host));
  }
3183aa153   Andy Shevchenko   mmc_test: collect...
2936
2937
2938
2939
2940
2941
2942
2943
2944
2945
2946
2947
2948
2949
2950
2951
2952
2953
2954
2955
2956
2957
2958
  static void mmc_test_free_result(struct mmc_card *card)
  {
  	struct mmc_test_general_result *gr, *grs;
  
  	mutex_lock(&mmc_test_lock);
  
  	list_for_each_entry_safe(gr, grs, &mmc_test_result, link) {
  		struct mmc_test_transfer_result *tr, *trs;
  
  		if (card && gr->card != card)
  			continue;
  
  		list_for_each_entry_safe(tr, trs, &gr->tr_lst, link) {
  			list_del(&tr->link);
  			kfree(tr);
  		}
  
  		list_del(&gr->link);
  		kfree(gr);
  	}
  
  	mutex_unlock(&mmc_test_lock);
  }
130067ed1   Andy Shevchenko   mmc_test: move fi...
2959
2960
2961
  static LIST_HEAD(mmc_test_file_test);
  
  static int mtf_test_show(struct seq_file *sf, void *data)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2962
  {
130067ed1   Andy Shevchenko   mmc_test: move fi...
2963
  	struct mmc_card *card = (struct mmc_card *)sf->private;
3183aa153   Andy Shevchenko   mmc_test: collect...
2964
  	struct mmc_test_general_result *gr;
3183aa153   Andy Shevchenko   mmc_test: collect...
2965

88ae600d5   Pierre Ossman   mmc: mmc host tes...
2966
  	mutex_lock(&mmc_test_lock);
3183aa153   Andy Shevchenko   mmc_test: collect...
2967
2968
2969
2970
2971
2972
  
  	list_for_each_entry(gr, &mmc_test_result, link) {
  		struct mmc_test_transfer_result *tr;
  
  		if (gr->card != card)
  			continue;
130067ed1   Andy Shevchenko   mmc_test: move fi...
2973
2974
  		seq_printf(sf, "Test %d: %d
  ", gr->testcase + 1, gr->result);
3183aa153   Andy Shevchenko   mmc_test: collect...
2975
2976
  
  		list_for_each_entry(tr, &gr->tr_lst, link) {
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
2977
2978
  			seq_printf(sf, "%u %d %lu.%09lu %u %u.%02u
  ",
3183aa153   Andy Shevchenko   mmc_test: collect...
2979
2980
2981
  				tr->count, tr->sectors,
  				(unsigned long)tr->ts.tv_sec,
  				(unsigned long)tr->ts.tv_nsec,
b6056d123   Adrian Hunter   mmc: mmc_test: ad...
2982
  				tr->rate, tr->iops / 100, tr->iops % 100);
3183aa153   Andy Shevchenko   mmc_test: collect...
2983
2984
  		}
  	}
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2985
  	mutex_unlock(&mmc_test_lock);
130067ed1   Andy Shevchenko   mmc_test: move fi...
2986
  	return 0;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2987
  }
130067ed1   Andy Shevchenko   mmc_test: move fi...
2988
  static int mtf_test_open(struct inode *inode, struct file *file)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2989
  {
130067ed1   Andy Shevchenko   mmc_test: move fi...
2990
2991
2992
2993
2994
2995
2996
2997
  	return single_open(file, mtf_test_show, inode->i_private);
  }
  
  static ssize_t mtf_test_write(struct file *file, const char __user *buf,
  	size_t count, loff_t *pos)
  {
  	struct seq_file *sf = (struct seq_file *)file->private_data;
  	struct mmc_card *card = (struct mmc_card *)sf->private;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
2998
  	struct mmc_test_card *test;
5c25aee53   Andy Shevchenko   mmc_test: change ...
2999
  	long testcase;
4be7085f7   Jingoo Han   mmc: mmc_test: re...
3000
  	int ret;
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3001

4be7085f7   Jingoo Han   mmc: mmc_test: re...
3002
3003
3004
  	ret = kstrtol_from_user(buf, count, 10, &testcase);
  	if (ret)
  		return ret;
fd8c326ca   Pierre Ossman   mmc_test: add tes...
3005

88ae600d5   Pierre Ossman   mmc: mmc host tes...
3006
3007
3008
  	test = kzalloc(sizeof(struct mmc_test_card), GFP_KERNEL);
  	if (!test)
  		return -ENOMEM;
3183aa153   Andy Shevchenko   mmc_test: collect...
3009
3010
3011
3012
3013
  	/*
  	 * Remove all test cases associated with given card. Thus we have only
  	 * actual data of the last run.
  	 */
  	mmc_test_free_result(card);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3014
3015
3016
  	test->card = card;
  
  	test->buffer = kzalloc(BUFFER_SIZE, GFP_KERNEL);
2661081f5   Pierre Ossman   mmc_test: highmem...
3017
3018
3019
3020
3021
3022
3023
  #ifdef CONFIG_HIGHMEM
  	test->highmem = alloc_pages(GFP_KERNEL | __GFP_HIGHMEM, BUFFER_ORDER);
  #endif
  
  #ifdef CONFIG_HIGHMEM
  	if (test->buffer && test->highmem) {
  #else
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3024
  	if (test->buffer) {
2661081f5   Pierre Ossman   mmc_test: highmem...
3025
  #endif
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3026
  		mutex_lock(&mmc_test_lock);
fd8c326ca   Pierre Ossman   mmc_test: add tes...
3027
  		mmc_test_run(test, testcase);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3028
3029
  		mutex_unlock(&mmc_test_lock);
  	}
2661081f5   Pierre Ossman   mmc_test: highmem...
3030
3031
3032
  #ifdef CONFIG_HIGHMEM
  	__free_pages(test->highmem, BUFFER_ORDER);
  #endif
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3033
3034
3035
3036
3037
  	kfree(test->buffer);
  	kfree(test);
  
  	return count;
  }
130067ed1   Andy Shevchenko   mmc_test: move fi...
3038
3039
3040
3041
3042
3043
3044
  static const struct file_operations mmc_test_fops_test = {
  	.open		= mtf_test_open,
  	.read		= seq_read,
  	.write		= mtf_test_write,
  	.llseek		= seq_lseek,
  	.release	= single_release,
  };
54f3caf5b   Per Forlin   mmc: mmc_test: ad...
3045
3046
3047
3048
3049
  static int mtf_testlist_show(struct seq_file *sf, void *data)
  {
  	int i;
  
  	mutex_lock(&mmc_test_lock);
1ac109ddc   Wolfram Sang   mmc: mmc_test: me...
3050
3051
  	seq_printf(sf, "0:\tRun all tests
  ");
54f3caf5b   Per Forlin   mmc: mmc_test: ad...
3052
3053
3054
3055
3056
3057
3058
3059
3060
3061
3062
3063
3064
3065
3066
3067
3068
3069
3070
3071
  	for (i = 0; i < ARRAY_SIZE(mmc_test_cases); i++)
  		seq_printf(sf, "%d:\t%s
  ", i+1, mmc_test_cases[i].name);
  
  	mutex_unlock(&mmc_test_lock);
  
  	return 0;
  }
  
  static int mtf_testlist_open(struct inode *inode, struct file *file)
  {
  	return single_open(file, mtf_testlist_show, inode->i_private);
  }
  
  static const struct file_operations mmc_test_fops_testlist = {
  	.open		= mtf_testlist_open,
  	.read		= seq_read,
  	.llseek		= seq_lseek,
  	.release	= single_release,
  };
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3072
  static void mmc_test_free_dbgfs_file(struct mmc_card *card)
130067ed1   Andy Shevchenko   mmc_test: move fi...
3073
3074
3075
3076
3077
3078
3079
3080
3081
3082
3083
3084
3085
3086
3087
  {
  	struct mmc_test_dbgfs_file *df, *dfs;
  
  	mutex_lock(&mmc_test_lock);
  
  	list_for_each_entry_safe(df, dfs, &mmc_test_file_test, link) {
  		if (card && df->card != card)
  			continue;
  		debugfs_remove(df->file);
  		list_del(&df->link);
  		kfree(df);
  	}
  
  	mutex_unlock(&mmc_test_lock);
  }
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3088
  static int __mmc_test_register_dbgfs_file(struct mmc_card *card,
f4ae40a6a   Al Viro   switch debugfs to...
3089
  	const char *name, umode_t mode, const struct file_operations *fops)
130067ed1   Andy Shevchenko   mmc_test: move fi...
3090
3091
3092
  {
  	struct dentry *file = NULL;
  	struct mmc_test_dbgfs_file *df;
54f3caf5b   Per Forlin   mmc: mmc_test: ad...
3093
3094
  
  	if (card->debugfs_root)
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3095
3096
  		file = debugfs_create_file(name, mode, card->debugfs_root,
  			card, fops);
54f3caf5b   Per Forlin   mmc: mmc_test: ad...
3097
3098
3099
  
  	if (IS_ERR_OR_NULL(file)) {
  		dev_err(&card->dev,
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3100
3101
3102
3103
  			"Can't create %s. Perhaps debugfs is disabled.
  ",
  			name);
  		return -ENODEV;
130067ed1   Andy Shevchenko   mmc_test: move fi...
3104
3105
3106
3107
3108
3109
3110
3111
  	}
  
  	df = kmalloc(sizeof(struct mmc_test_dbgfs_file), GFP_KERNEL);
  	if (!df) {
  		debugfs_remove(file);
  		dev_err(&card->dev,
  			"Can't allocate memory for internal usage.
  ");
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3112
  		return -ENOMEM;
130067ed1   Andy Shevchenko   mmc_test: move fi...
3113
3114
3115
3116
3117
3118
  	}
  
  	df->card = card;
  	df->file = file;
  
  	list_add(&df->link, &mmc_test_file_test);
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3119
3120
3121
3122
3123
3124
3125
3126
3127
3128
3129
3130
3131
3132
3133
3134
3135
3136
  	return 0;
  }
  
  static int mmc_test_register_dbgfs_file(struct mmc_card *card)
  {
  	int ret;
  
  	mutex_lock(&mmc_test_lock);
  
  	ret = __mmc_test_register_dbgfs_file(card, "test", S_IWUSR | S_IRUGO,
  		&mmc_test_fops_test);
  	if (ret)
  		goto err;
  
  	ret = __mmc_test_register_dbgfs_file(card, "testlist", S_IRUGO,
  		&mmc_test_fops_testlist);
  	if (ret)
  		goto err;
130067ed1   Andy Shevchenko   mmc_test: move fi...
3137
3138
3139
3140
3141
3142
  
  err:
  	mutex_unlock(&mmc_test_lock);
  
  	return ret;
  }
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3143

96541bac0   Ulf Hansson   Revert "mmc: core...
3144
  static int mmc_test_probe(struct mmc_card *card)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3145
3146
  {
  	int ret;
63be54cef   Andy Shevchenko   mmc_test: use API...
3147
  	if (!mmc_card_mmc(card) && !mmc_card_sd(card))
0121a9829   Pierre Ossman   mmc_test: only bi...
3148
  		return -ENODEV;
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3149
  	ret = mmc_test_register_dbgfs_file(card);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3150
3151
  	if (ret)
  		return ret;
60c9c7b1d   Pierre Ossman   mmc_test: print m...
3152
3153
  	dev_info(&card->dev, "Card claimed for testing.
  ");
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3154
3155
  	return 0;
  }
96541bac0   Ulf Hansson   Revert "mmc: core...
3156
  static void mmc_test_remove(struct mmc_card *card)
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3157
  {
3183aa153   Andy Shevchenko   mmc_test: collect...
3158
  	mmc_test_free_result(card);
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3159
  	mmc_test_free_dbgfs_file(card);
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3160
  }
96541bac0   Ulf Hansson   Revert "mmc: core...
3161
  static void mmc_test_shutdown(struct mmc_card *card)
762877485   Ulf Hansson   mmc: core: Handle...
3162
3163
  {
  }
96541bac0   Ulf Hansson   Revert "mmc: core...
3164
3165
3166
3167
  static struct mmc_driver mmc_driver = {
  	.drv		= {
  		.name	= "mmc_test",
  	},
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3168
3169
  	.probe		= mmc_test_probe,
  	.remove		= mmc_test_remove,
762877485   Ulf Hansson   mmc: core: Handle...
3170
  	.shutdown	= mmc_test_shutdown,
88ae600d5   Pierre Ossman   mmc: mmc host tes...
3171
3172
3173
3174
3175
3176
3177
3178
3179
  };
  
  static int __init mmc_test_init(void)
  {
  	return mmc_register_driver(&mmc_driver);
  }
  
  static void __exit mmc_test_exit(void)
  {
3183aa153   Andy Shevchenko   mmc_test: collect...
3180
3181
  	/* Clear stalled data if card is still plugged */
  	mmc_test_free_result(NULL);
d5a5bd1c3   Andy Shevchenko   mmc: mmc_test: av...
3182
  	mmc_test_free_dbgfs_file(NULL);
3183aa153   Andy Shevchenko   mmc_test: collect...
3183

88ae600d5   Pierre Ossman   mmc: mmc host tes...
3184
3185
3186
3187
3188
3189
3190
3191
3192
  	mmc_unregister_driver(&mmc_driver);
  }
  
  module_init(mmc_test_init);
  module_exit(mmc_test_exit);
  
  MODULE_LICENSE("GPL");
  MODULE_DESCRIPTION("Multimedia Card (MMC) host test driver");
  MODULE_AUTHOR("Pierre Ossman");