1 // SPDX-License-Identifier: GPL-2.0
2
3 #include <dirent.h>
4 #include <errno.h>
5 #include <fcntl.h>
6 #include <stdio.h>
7 #include <stdlib.h>
8 #include <stdint.h>
9 #include <string.h>
10 #include <unistd.h>
11 #include <sys/ioctl.h>
12 #include <sys/mman.h>
13 #include <sys/types.h>
14
15 #include <linux/dma-buf.h>
16 #include <drm/drm.h>
17
18 #include "../../../../include/uapi/linux/dma-heap.h"
19
20 #define DEVPATH "/dev/dma_heap"
21
check_vgem(int fd)22 static int check_vgem(int fd)
23 {
24 drm_version_t version = { 0 };
25 char name[5];
26 int ret;
27
28 version.name_len = 4;
29 version.name = name;
30
31 ret = ioctl(fd, DRM_IOCTL_VERSION, &version);
32 if (ret)
33 return 0;
34
35 return !strcmp(name, "vgem");
36 }
37
open_vgem(void)38 static int open_vgem(void)
39 {
40 int i, fd;
41 const char *drmstr = "/dev/dri/card";
42
43 fd = -1;
44 for (i = 0; i < 16; i++) {
45 char name[80];
46
47 snprintf(name, 80, "%s%u", drmstr, i);
48
49 fd = open(name, O_RDWR);
50 if (fd < 0)
51 continue;
52
53 if (!check_vgem(fd)) {
54 close(fd);
55 fd = -1;
56 continue;
57 } else {
58 break;
59 }
60 }
61 return fd;
62 }
63
import_vgem_fd(int vgem_fd,int dma_buf_fd,uint32_t * handle)64 static int import_vgem_fd(int vgem_fd, int dma_buf_fd, uint32_t *handle)
65 {
66 struct drm_prime_handle import_handle = {
67 .fd = dma_buf_fd,
68 .flags = 0,
69 .handle = 0,
70 };
71 int ret;
72
73 ret = ioctl(vgem_fd, DRM_IOCTL_PRIME_FD_TO_HANDLE, &import_handle);
74 if (ret == 0)
75 *handle = import_handle.handle;
76 return ret;
77 }
78
close_handle(int vgem_fd,uint32_t handle)79 static void close_handle(int vgem_fd, uint32_t handle)
80 {
81 struct drm_gem_close close = {
82 .handle = handle,
83 };
84
85 ioctl(vgem_fd, DRM_IOCTL_GEM_CLOSE, &close);
86 }
87
dmabuf_heap_open(char * name)88 static int dmabuf_heap_open(char *name)
89 {
90 int ret, fd;
91 char buf[256];
92
93 ret = snprintf(buf, 256, "%s/%s", DEVPATH, name);
94 if (ret < 0) {
95 printf("snprintf failed!\n");
96 return ret;
97 }
98
99 fd = open(buf, O_RDWR);
100 if (fd < 0)
101 printf("open %s failed!\n", buf);
102 return fd;
103 }
104
dmabuf_heap_alloc_fdflags(int fd,size_t len,unsigned int fd_flags,unsigned int heap_flags,int * dmabuf_fd)105 static int dmabuf_heap_alloc_fdflags(int fd, size_t len, unsigned int fd_flags,
106 unsigned int heap_flags, int *dmabuf_fd)
107 {
108 struct dma_heap_allocation_data data = {
109 .len = len,
110 .fd = 0,
111 .fd_flags = fd_flags,
112 .heap_flags = heap_flags,
113 };
114 int ret;
115
116 if (!dmabuf_fd)
117 return -EINVAL;
118
119 ret = ioctl(fd, DMA_HEAP_IOCTL_ALLOC, &data);
120 if (ret < 0)
121 return ret;
122 *dmabuf_fd = (int)data.fd;
123 return ret;
124 }
125
dmabuf_heap_alloc(int fd,size_t len,unsigned int flags,int * dmabuf_fd)126 static int dmabuf_heap_alloc(int fd, size_t len, unsigned int flags,
127 int *dmabuf_fd)
128 {
129 return dmabuf_heap_alloc_fdflags(fd, len, O_RDWR | O_CLOEXEC, flags,
130 dmabuf_fd);
131 }
132
dmabuf_sync(int fd,int start_stop)133 static int dmabuf_sync(int fd, int start_stop)
134 {
135 struct dma_buf_sync sync = {
136 .flags = start_stop | DMA_BUF_SYNC_RW,
137 };
138
139 return ioctl(fd, DMA_BUF_IOCTL_SYNC, &sync);
140 }
141
142 #define ONE_MEG (1024 * 1024)
143
test_alloc_and_import(char * heap_name)144 static int test_alloc_and_import(char *heap_name)
145 {
146 int heap_fd = -1, dmabuf_fd = -1, importer_fd = -1;
147 uint32_t handle = 0;
148 void *p = NULL;
149 int ret;
150
151 heap_fd = dmabuf_heap_open(heap_name);
152 if (heap_fd < 0)
153 return -1;
154
155 printf(" Testing allocation and importing: ");
156 ret = dmabuf_heap_alloc(heap_fd, ONE_MEG, 0, &dmabuf_fd);
157 if (ret) {
158 printf("FAIL (Allocation Failed!)\n");
159 ret = -1;
160 goto out;
161 }
162 /* mmap and write a simple pattern */
163 p = mmap(NULL,
164 ONE_MEG,
165 PROT_READ | PROT_WRITE,
166 MAP_SHARED,
167 dmabuf_fd,
168 0);
169 if (p == MAP_FAILED) {
170 printf("FAIL (mmap() failed)\n");
171 ret = -1;
172 goto out;
173 }
174
175 dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_START);
176 memset(p, 1, ONE_MEG / 2);
177 memset((char *)p + ONE_MEG / 2, 0, ONE_MEG / 2);
178 dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_END);
179
180 importer_fd = open_vgem();
181 if (importer_fd < 0) {
182 ret = importer_fd;
183 printf("(Could not open vgem - skipping): ");
184 } else {
185 ret = import_vgem_fd(importer_fd, dmabuf_fd, &handle);
186 if (ret < 0) {
187 printf("FAIL (Failed to import buffer)\n");
188 goto out;
189 }
190 }
191
192 ret = dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_START);
193 if (ret < 0) {
194 printf("FAIL (DMA_BUF_SYNC_START failed!)\n");
195 goto out;
196 }
197
198 memset(p, 0xff, ONE_MEG);
199 ret = dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_END);
200 if (ret < 0) {
201 printf("FAIL (DMA_BUF_SYNC_END failed!)\n");
202 goto out;
203 }
204
205 close_handle(importer_fd, handle);
206 ret = 0;
207 printf(" OK\n");
208 out:
209 if (p)
210 munmap(p, ONE_MEG);
211 if (importer_fd >= 0)
212 close(importer_fd);
213 if (dmabuf_fd >= 0)
214 close(dmabuf_fd);
215 if (heap_fd >= 0)
216 close(heap_fd);
217
218 return ret;
219 }
220
test_alloc_zeroed(char * heap_name,size_t size)221 static int test_alloc_zeroed(char *heap_name, size_t size)
222 {
223 int heap_fd = -1, dmabuf_fd[32];
224 int i, j, ret;
225 void *p = NULL;
226 char *c;
227
228 printf(" Testing alloced %ldk buffers are zeroed: ", size / 1024);
229 heap_fd = dmabuf_heap_open(heap_name);
230 if (heap_fd < 0)
231 return -1;
232
233 /* Allocate and fill a bunch of buffers */
234 for (i = 0; i < 32; i++) {
235 ret = dmabuf_heap_alloc(heap_fd, size, 0, &dmabuf_fd[i]);
236 if (ret < 0) {
237 printf("FAIL (Allocation (%i) failed)\n", i);
238 goto out;
239 }
240 /* mmap and fill with simple pattern */
241 p = mmap(NULL, size, PROT_READ | PROT_WRITE, MAP_SHARED, dmabuf_fd[i], 0);
242 if (p == MAP_FAILED) {
243 printf("FAIL (mmap() failed!)\n");
244 ret = -1;
245 goto out;
246 }
247 dmabuf_sync(dmabuf_fd[i], DMA_BUF_SYNC_START);
248 memset(p, 0xff, size);
249 dmabuf_sync(dmabuf_fd[i], DMA_BUF_SYNC_END);
250 munmap(p, size);
251 }
252 /* close them all */
253 for (i = 0; i < 32; i++)
254 close(dmabuf_fd[i]);
255
256 /* Allocate and validate all buffers are zeroed */
257 for (i = 0; i < 32; i++) {
258 ret = dmabuf_heap_alloc(heap_fd, size, 0, &dmabuf_fd[i]);
259 if (ret < 0) {
260 printf("FAIL (Allocation (%i) failed)\n", i);
261 goto out;
262 }
263
264 /* mmap and validate everything is zero */
265 p = mmap(NULL, size, PROT_READ | PROT_WRITE, MAP_SHARED, dmabuf_fd[i], 0);
266 if (p == MAP_FAILED) {
267 printf("FAIL (mmap() failed!)\n");
268 ret = -1;
269 goto out;
270 }
271 dmabuf_sync(dmabuf_fd[i], DMA_BUF_SYNC_START);
272 c = (char *)p;
273 for (j = 0; j < size; j++) {
274 if (c[j] != 0) {
275 printf("FAIL (Allocated buffer not zeroed @ %i)\n", j);
276 break;
277 }
278 }
279 dmabuf_sync(dmabuf_fd[i], DMA_BUF_SYNC_END);
280 munmap(p, size);
281 }
282 /* close them all */
283 for (i = 0; i < 32; i++)
284 close(dmabuf_fd[i]);
285
286 close(heap_fd);
287 printf("OK\n");
288 return 0;
289
290 out:
291 while (i > 0) {
292 close(dmabuf_fd[i]);
293 i--;
294 }
295 close(heap_fd);
296 return ret;
297 }
298
299 /* Test the ioctl version compatibility w/ a smaller structure then expected */
dmabuf_heap_alloc_older(int fd,size_t len,unsigned int flags,int * dmabuf_fd)300 static int dmabuf_heap_alloc_older(int fd, size_t len, unsigned int flags,
301 int *dmabuf_fd)
302 {
303 int ret;
304 unsigned int older_alloc_ioctl;
305 struct dma_heap_allocation_data_smaller {
306 __u64 len;
307 __u32 fd;
308 __u32 fd_flags;
309 } data = {
310 .len = len,
311 .fd = 0,
312 .fd_flags = O_RDWR | O_CLOEXEC,
313 };
314
315 older_alloc_ioctl = _IOWR(DMA_HEAP_IOC_MAGIC, 0x0,
316 struct dma_heap_allocation_data_smaller);
317 if (!dmabuf_fd)
318 return -EINVAL;
319
320 ret = ioctl(fd, older_alloc_ioctl, &data);
321 if (ret < 0)
322 return ret;
323 *dmabuf_fd = (int)data.fd;
324 return ret;
325 }
326
327 /* Test the ioctl version compatibility w/ a larger structure then expected */
dmabuf_heap_alloc_newer(int fd,size_t len,unsigned int flags,int * dmabuf_fd)328 static int dmabuf_heap_alloc_newer(int fd, size_t len, unsigned int flags,
329 int *dmabuf_fd)
330 {
331 int ret;
332 unsigned int newer_alloc_ioctl;
333 struct dma_heap_allocation_data_bigger {
334 __u64 len;
335 __u32 fd;
336 __u32 fd_flags;
337 __u64 heap_flags;
338 __u64 garbage1;
339 __u64 garbage2;
340 __u64 garbage3;
341 } data = {
342 .len = len,
343 .fd = 0,
344 .fd_flags = O_RDWR | O_CLOEXEC,
345 .heap_flags = flags,
346 .garbage1 = 0xffffffff,
347 .garbage2 = 0x88888888,
348 .garbage3 = 0x11111111,
349 };
350
351 newer_alloc_ioctl = _IOWR(DMA_HEAP_IOC_MAGIC, 0x0,
352 struct dma_heap_allocation_data_bigger);
353 if (!dmabuf_fd)
354 return -EINVAL;
355
356 ret = ioctl(fd, newer_alloc_ioctl, &data);
357 if (ret < 0)
358 return ret;
359
360 *dmabuf_fd = (int)data.fd;
361 return ret;
362 }
363
test_alloc_compat(char * heap_name)364 static int test_alloc_compat(char *heap_name)
365 {
366 int heap_fd = -1, dmabuf_fd = -1;
367 int ret;
368
369 heap_fd = dmabuf_heap_open(heap_name);
370 if (heap_fd < 0)
371 return -1;
372
373 printf(" Testing (theoretical)older alloc compat: ");
374 ret = dmabuf_heap_alloc_older(heap_fd, ONE_MEG, 0, &dmabuf_fd);
375 if (ret) {
376 printf("FAIL (Older compat allocation failed!)\n");
377 ret = -1;
378 goto out;
379 }
380 close(dmabuf_fd);
381 printf("OK\n");
382
383 printf(" Testing (theoretical)newer alloc compat: ");
384 ret = dmabuf_heap_alloc_newer(heap_fd, ONE_MEG, 0, &dmabuf_fd);
385 if (ret) {
386 printf("FAIL (Newer compat allocation failed!)\n");
387 ret = -1;
388 goto out;
389 }
390 printf("OK\n");
391 out:
392 if (dmabuf_fd >= 0)
393 close(dmabuf_fd);
394 if (heap_fd >= 0)
395 close(heap_fd);
396
397 return ret;
398 }
399
test_alloc_errors(char * heap_name)400 static int test_alloc_errors(char *heap_name)
401 {
402 int heap_fd = -1, dmabuf_fd = -1;
403 int ret;
404
405 heap_fd = dmabuf_heap_open(heap_name);
406 if (heap_fd < 0)
407 return -1;
408
409 printf(" Testing expected error cases: ");
410 ret = dmabuf_heap_alloc(0, ONE_MEG, 0x111111, &dmabuf_fd);
411 if (!ret) {
412 printf("FAIL (Did not see expected error (invalid fd)!)\n");
413 ret = -1;
414 goto out;
415 }
416
417 ret = dmabuf_heap_alloc(heap_fd, ONE_MEG, 0x111111, &dmabuf_fd);
418 if (!ret) {
419 printf("FAIL (Did not see expected error (invalid heap flags)!)\n");
420 ret = -1;
421 goto out;
422 }
423
424 ret = dmabuf_heap_alloc_fdflags(heap_fd, ONE_MEG,
425 ~(O_RDWR | O_CLOEXEC), 0, &dmabuf_fd);
426 if (!ret) {
427 printf("FAIL (Did not see expected error (invalid fd flags)!)\n");
428 ret = -1;
429 goto out;
430 }
431
432 printf("OK\n");
433 ret = 0;
434 out:
435 if (dmabuf_fd >= 0)
436 close(dmabuf_fd);
437 if (heap_fd >= 0)
438 close(heap_fd);
439
440 return ret;
441 }
442
main(void)443 int main(void)
444 {
445 DIR *d;
446 struct dirent *dir;
447 int ret = -1;
448
449 d = opendir(DEVPATH);
450 if (!d) {
451 printf("No %s directory?\n", DEVPATH);
452 return -1;
453 }
454
455 while ((dir = readdir(d)) != NULL) {
456 if (!strncmp(dir->d_name, ".", 2))
457 continue;
458 if (!strncmp(dir->d_name, "..", 3))
459 continue;
460
461 printf("Testing heap: %s\n", dir->d_name);
462 printf("=======================================\n");
463 ret = test_alloc_and_import(dir->d_name);
464 if (ret)
465 break;
466
467 ret = test_alloc_zeroed(dir->d_name, 4 * 1024);
468 if (ret)
469 break;
470
471 ret = test_alloc_zeroed(dir->d_name, ONE_MEG);
472 if (ret)
473 break;
474
475 ret = test_alloc_compat(dir->d_name);
476 if (ret)
477 break;
478
479 ret = test_alloc_errors(dir->d_name);
480 if (ret)
481 break;
482 }
483 closedir(d);
484
485 return ret;
486 }
487