1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
|
#include <linux/device.h>
#include <linux/dma-map-ops.h>
#include <linux/dma-mapping.h>
#include <linux/dmapool.h>
#include <linux/kernel.h>
#include <linux/ktime.h>
#include <linux/module.h>
#define NR_TESTS (100)
struct dma_pool_pair {
dma_addr_t dma;
void *v;
};
struct dmapool_parms {
size_t size;
size_t align;
size_t boundary;
};
static const struct dmapool_parms pool_parms[] = {
{ .size = 16, .align = 16, .boundary = 0 },
{ .size = 64, .align = 64, .boundary = 0 },
{ .size = 256, .align = 256, .boundary = 0 },
{ .size = 1024, .align = 1024, .boundary = 0 },
{ .size = 4096, .align = 4096, .boundary = 0 },
{ .size = 68, .align = 32, .boundary = 4096 },
};
static struct dma_pool *pool;
static struct device test_dev;
static u64 dma_mask;
static inline int nr_blocks(int size)
{
return clamp_t(int, (PAGE_SIZE / size) * 512, 1024, 8192);
}
static int dmapool_test_alloc(struct dma_pool_pair *p, int blocks)
{
int i;
for (i = 0; i < blocks; i++) {
p[i].v = dma_pool_alloc(pool, GFP_KERNEL,
&p[i].dma);
if (!p[i].v)
goto pool_fail;
}
for (i = 0; i < blocks; i++)
dma_pool_free(pool, p[i].v, p[i].dma);
return 0;
pool_fail:
for (--i; i >= 0; i--)
dma_pool_free(pool, p[i].v, p[i].dma);
return -ENOMEM;
}
static int dmapool_test_block(const struct dmapool_parms *parms)
{
int blocks = nr_blocks(parms->size);
ktime_t start_time, end_time;
struct dma_pool_pair *p;
int i, ret;
p = kcalloc(blocks, sizeof(*p), GFP_KERNEL);
if (!p)
return -ENOMEM;
pool = dma_pool_create("test pool", &test_dev, parms->size,
parms->align, parms->boundary);
if (!pool) {
ret = -ENOMEM;
goto free_pairs;
}
start_time = ktime_get();
for (i = 0; i < NR_TESTS; i++) {
ret = dmapool_test_alloc(p, blocks);
if (ret)
goto free_pool;
if (need_resched())
cond_resched();
}
end_time = ktime_get();
printk("dmapool test: size:%-4zu align:%-4zu blocks:%-4d time:%llu\n",
parms->size, parms->align, blocks,
ktime_us_delta(end_time, start_time));
free_pool:
dma_pool_destroy(pool);
free_pairs:
kfree(p);
return ret;
}
static void dmapool_test_release(struct device *dev)
{
}
static int dmapool_checks(void)
{
int i, ret;
ret = dev_set_name(&test_dev, "dmapool-test");
if (ret)
return ret;
ret = device_register(&test_dev);
if (ret) {
printk("%s: register failed:%d\n", __func__, ret);
goto put_device;
}
test_dev.release = dmapool_test_release;
set_dma_ops(&test_dev, NULL);
test_dev.dma_mask = &dma_mask;
ret = dma_set_mask_and_coherent(&test_dev, DMA_BIT_MASK(64));
if (ret) {
printk("%s: mask failed:%d\n", __func__, ret);
goto del_device;
}
for (i = 0; i < ARRAY_SIZE(pool_parms); i++) {
ret = dmapool_test_block(&pool_parms[i]);
if (ret)
break;
}
del_device:
device_del(&test_dev);
put_device:
put_device(&test_dev);
return ret;
}
static void dmapool_exit(void)
{
}
module_init(dmapool_checks);
module_exit(dmapool_exit);
MODULE_LICENSE("GPL");
|
