1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <linux/slab.h>
25#include <linux/mm.h>
26#include <linux/dma-mapping.h>
27#include <linux/genalloc.h>
28#include <sound/memalloc.h>
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45void *snd_malloc_pages(size_t size, gfp_t gfp_flags)
46{
47 int pg;
48
49 if (WARN_ON(!size))
50 return NULL;
51 if (WARN_ON(!gfp_flags))
52 return NULL;
53 gfp_flags |= __GFP_COMP;
54 pg = get_order(size);
55 return (void *) __get_free_pages(gfp_flags, pg);
56}
57EXPORT_SYMBOL(snd_malloc_pages);
58
59
60
61
62
63
64
65
66void snd_free_pages(void *ptr, size_t size)
67{
68 int pg;
69
70 if (ptr == NULL)
71 return;
72 pg = get_order(size);
73 free_pages((unsigned long) ptr, pg);
74}
75EXPORT_SYMBOL(snd_free_pages);
76
77
78
79
80
81
82
83#ifdef CONFIG_HAS_DMA
84
85static void *snd_malloc_dev_pages(struct device *dev, size_t size, dma_addr_t *dma)
86{
87 int pg;
88 gfp_t gfp_flags;
89
90 if (WARN_ON(!dma))
91 return NULL;
92 pg = get_order(size);
93 gfp_flags = GFP_KERNEL
94 | __GFP_COMP
95 | __GFP_NORETRY
96 | __GFP_NOWARN;
97 return dma_alloc_coherent(dev, PAGE_SIZE << pg, dma, gfp_flags);
98}
99
100
101static void snd_free_dev_pages(struct device *dev, size_t size, void *ptr,
102 dma_addr_t dma)
103{
104 int pg;
105
106 if (ptr == NULL)
107 return;
108 pg = get_order(size);
109 dma_free_coherent(dev, PAGE_SIZE << pg, ptr, dma);
110}
111
112#ifdef CONFIG_GENERIC_ALLOCATOR
113
114
115
116
117
118
119
120static void snd_malloc_dev_iram(struct snd_dma_buffer *dmab, size_t size)
121{
122 struct device *dev = dmab->dev.dev;
123 struct gen_pool *pool = NULL;
124
125 dmab->area = NULL;
126 dmab->addr = 0;
127
128 if (dev->of_node)
129 pool = of_gen_pool_get(dev->of_node, "iram", 0);
130
131 if (!pool)
132 return;
133
134
135 dmab->private_data = pool;
136
137 dmab->area = gen_pool_dma_alloc(pool, size, &dmab->addr);
138}
139
140
141
142
143
144static void snd_free_dev_iram(struct snd_dma_buffer *dmab)
145{
146 struct gen_pool *pool = dmab->private_data;
147
148 if (pool && dmab->area)
149 gen_pool_free(pool, (unsigned long)dmab->area, dmab->bytes);
150}
151#endif
152#endif
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174int snd_dma_alloc_pages(int type, struct device *device, size_t size,
175 struct snd_dma_buffer *dmab)
176{
177 if (WARN_ON(!size))
178 return -ENXIO;
179 if (WARN_ON(!dmab))
180 return -ENXIO;
181
182 dmab->dev.type = type;
183 dmab->dev.dev = device;
184 dmab->bytes = 0;
185 switch (type) {
186 case SNDRV_DMA_TYPE_CONTINUOUS:
187 dmab->area = snd_malloc_pages(size,
188 (__force gfp_t)(unsigned long)device);
189 dmab->addr = 0;
190 break;
191#ifdef CONFIG_HAS_DMA
192#ifdef CONFIG_GENERIC_ALLOCATOR
193 case SNDRV_DMA_TYPE_DEV_IRAM:
194 snd_malloc_dev_iram(dmab, size);
195 if (dmab->area)
196 break;
197
198
199
200 dmab->dev.type = SNDRV_DMA_TYPE_DEV;
201#endif
202 case SNDRV_DMA_TYPE_DEV:
203 dmab->area = snd_malloc_dev_pages(device, size, &dmab->addr);
204 break;
205#endif
206#ifdef CONFIG_SND_DMA_SGBUF
207 case SNDRV_DMA_TYPE_DEV_SG:
208 snd_malloc_sgbuf_pages(device, size, dmab, NULL);
209 break;
210#endif
211 default:
212 pr_err("snd-malloc: invalid device type %d\n", type);
213 dmab->area = NULL;
214 dmab->addr = 0;
215 return -ENXIO;
216 }
217 if (! dmab->area)
218 return -ENOMEM;
219 dmab->bytes = size;
220 return 0;
221}
222EXPORT_SYMBOL(snd_dma_alloc_pages);
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239int snd_dma_alloc_pages_fallback(int type, struct device *device, size_t size,
240 struct snd_dma_buffer *dmab)
241{
242 int err;
243
244 while ((err = snd_dma_alloc_pages(type, device, size, dmab)) < 0) {
245 if (err != -ENOMEM)
246 return err;
247 if (size <= PAGE_SIZE)
248 return -ENOMEM;
249 size >>= 1;
250 size = PAGE_SIZE << get_order(size);
251 }
252 if (! dmab->area)
253 return -ENOMEM;
254 return 0;
255}
256EXPORT_SYMBOL(snd_dma_alloc_pages_fallback);
257
258
259
260
261
262
263
264
265void snd_dma_free_pages(struct snd_dma_buffer *dmab)
266{
267 switch (dmab->dev.type) {
268 case SNDRV_DMA_TYPE_CONTINUOUS:
269 snd_free_pages(dmab->area, dmab->bytes);
270 break;
271#ifdef CONFIG_HAS_DMA
272#ifdef CONFIG_GENERIC_ALLOCATOR
273 case SNDRV_DMA_TYPE_DEV_IRAM:
274 snd_free_dev_iram(dmab);
275 break;
276#endif
277 case SNDRV_DMA_TYPE_DEV:
278 snd_free_dev_pages(dmab->dev.dev, dmab->bytes, dmab->area, dmab->addr);
279 break;
280#endif
281#ifdef CONFIG_SND_DMA_SGBUF
282 case SNDRV_DMA_TYPE_DEV_SG:
283 snd_free_sgbuf_pages(dmab);
284 break;
285#endif
286 default:
287 pr_err("snd-malloc: invalid device type %d\n", dmab->dev.type);
288 }
289}
290EXPORT_SYMBOL(snd_dma_free_pages);
291