1
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
22static 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
38static 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
64static 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
79static 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
88static 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
105static 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
126static 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
133static void dmabuf_sync(int fd, int start_stop)
134{
135 struct dma_buf_sync sync = {
136 .flags = start_stop | DMA_BUF_SYNC_RW,
137 };
138 int ret;
139
140 ret = ioctl(fd, DMA_BUF_IOCTL_SYNC, &sync);
141 if (ret)
142 printf("sync failed %d\n", errno);
143}
144
145#define ONE_MEG (1024 * 1024)
146
147static int test_alloc_and_import(char *heap_name)
148{
149 int heap_fd = -1, dmabuf_fd = -1, importer_fd = -1;
150 uint32_t handle = 0;
151 void *p = NULL;
152 int ret;
153
154 printf("Testing heap: %s\n", heap_name);
155
156 heap_fd = dmabuf_heap_open(heap_name);
157 if (heap_fd < 0)
158 return -1;
159
160 printf("Allocating 1 MEG\n");
161 ret = dmabuf_heap_alloc(heap_fd, ONE_MEG, 0, &dmabuf_fd);
162 if (ret) {
163 printf("Allocation Failed!\n");
164 ret = -1;
165 goto out;
166 }
167
168 p = mmap(NULL,
169 ONE_MEG,
170 PROT_READ | PROT_WRITE,
171 MAP_SHARED,
172 dmabuf_fd,
173 0);
174 if (p == MAP_FAILED) {
175 printf("mmap() failed: %m\n");
176 ret = -1;
177 goto out;
178 }
179 printf("mmap passed\n");
180
181 dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_START);
182 memset(p, 1, ONE_MEG / 2);
183 memset((char *)p + ONE_MEG / 2, 0, ONE_MEG / 2);
184 dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_END);
185
186 importer_fd = open_vgem();
187 if (importer_fd < 0) {
188 ret = importer_fd;
189 printf("Failed to open vgem\n");
190 goto out;
191 }
192
193 ret = import_vgem_fd(importer_fd, dmabuf_fd, &handle);
194 if (ret < 0) {
195 printf("Failed to import buffer\n");
196 goto out;
197 }
198 printf("import passed\n");
199
200 dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_START);
201 memset(p, 0xff, ONE_MEG);
202 dmabuf_sync(dmabuf_fd, DMA_BUF_SYNC_END);
203 printf("syncs passed\n");
204
205 close_handle(importer_fd, handle);
206 ret = 0;
207
208out:
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
221
222static int dmabuf_heap_alloc_older(int fd, size_t len, unsigned int flags,
223 int *dmabuf_fd)
224{
225 int ret;
226 unsigned int older_alloc_ioctl;
227 struct dma_heap_allocation_data_smaller {
228 __u64 len;
229 __u32 fd;
230 __u32 fd_flags;
231 } data = {
232 .len = len,
233 .fd = 0,
234 .fd_flags = O_RDWR | O_CLOEXEC,
235 };
236
237 older_alloc_ioctl = _IOWR(DMA_HEAP_IOC_MAGIC, 0x0,
238 struct dma_heap_allocation_data_smaller);
239 if (!dmabuf_fd)
240 return -EINVAL;
241
242 ret = ioctl(fd, older_alloc_ioctl, &data);
243 if (ret < 0)
244 return ret;
245 *dmabuf_fd = (int)data.fd;
246 return ret;
247}
248
249
250static int dmabuf_heap_alloc_newer(int fd, size_t len, unsigned int flags,
251 int *dmabuf_fd)
252{
253 int ret;
254 unsigned int newer_alloc_ioctl;
255 struct dma_heap_allocation_data_bigger {
256 __u64 len;
257 __u32 fd;
258 __u32 fd_flags;
259 __u64 heap_flags;
260 __u64 garbage1;
261 __u64 garbage2;
262 __u64 garbage3;
263 } data = {
264 .len = len,
265 .fd = 0,
266 .fd_flags = O_RDWR | O_CLOEXEC,
267 .heap_flags = flags,
268 .garbage1 = 0xffffffff,
269 .garbage2 = 0x88888888,
270 .garbage3 = 0x11111111,
271 };
272
273 newer_alloc_ioctl = _IOWR(DMA_HEAP_IOC_MAGIC, 0x0,
274 struct dma_heap_allocation_data_bigger);
275 if (!dmabuf_fd)
276 return -EINVAL;
277
278 ret = ioctl(fd, newer_alloc_ioctl, &data);
279 if (ret < 0)
280 return ret;
281
282 *dmabuf_fd = (int)data.fd;
283 return ret;
284}
285
286static int test_alloc_compat(char *heap_name)
287{
288 int heap_fd = -1, dmabuf_fd = -1;
289 int ret;
290
291 heap_fd = dmabuf_heap_open(heap_name);
292 if (heap_fd < 0)
293 return -1;
294
295 printf("Testing (theoretical)older alloc compat\n");
296 ret = dmabuf_heap_alloc_older(heap_fd, ONE_MEG, 0, &dmabuf_fd);
297 if (ret) {
298 printf("Older compat allocation failed!\n");
299 ret = -1;
300 goto out;
301 }
302 close(dmabuf_fd);
303
304 printf("Testing (theoretical)newer alloc compat\n");
305 ret = dmabuf_heap_alloc_newer(heap_fd, ONE_MEG, 0, &dmabuf_fd);
306 if (ret) {
307 printf("Newer compat allocation failed!\n");
308 ret = -1;
309 goto out;
310 }
311 printf("Ioctl compatibility tests passed\n");
312out:
313 if (dmabuf_fd >= 0)
314 close(dmabuf_fd);
315 if (heap_fd >= 0)
316 close(heap_fd);
317
318 return ret;
319}
320
321static int test_alloc_errors(char *heap_name)
322{
323 int heap_fd = -1, dmabuf_fd = -1;
324 int ret;
325
326 heap_fd = dmabuf_heap_open(heap_name);
327 if (heap_fd < 0)
328 return -1;
329
330 printf("Testing expected error cases\n");
331 ret = dmabuf_heap_alloc(0, ONE_MEG, 0x111111, &dmabuf_fd);
332 if (!ret) {
333 printf("Did not see expected error (invalid fd)!\n");
334 ret = -1;
335 goto out;
336 }
337
338 ret = dmabuf_heap_alloc(heap_fd, ONE_MEG, 0x111111, &dmabuf_fd);
339 if (!ret) {
340 printf("Did not see expected error (invalid heap flags)!\n");
341 ret = -1;
342 goto out;
343 }
344
345 ret = dmabuf_heap_alloc_fdflags(heap_fd, ONE_MEG,
346 ~(O_RDWR | O_CLOEXEC), 0, &dmabuf_fd);
347 if (!ret) {
348 printf("Did not see expected error (invalid fd flags)!\n");
349 ret = -1;
350 goto out;
351 }
352
353 printf("Expected error checking passed\n");
354 ret = 0;
355out:
356 if (dmabuf_fd >= 0)
357 close(dmabuf_fd);
358 if (heap_fd >= 0)
359 close(heap_fd);
360
361 return ret;
362}
363
364int main(void)
365{
366 DIR *d;
367 struct dirent *dir;
368 int ret = -1;
369
370 d = opendir(DEVPATH);
371 if (!d) {
372 printf("No %s directory?\n", DEVPATH);
373 return -1;
374 }
375
376 while ((dir = readdir(d)) != NULL) {
377 if (!strncmp(dir->d_name, ".", 2))
378 continue;
379 if (!strncmp(dir->d_name, "..", 3))
380 continue;
381
382 ret = test_alloc_and_import(dir->d_name);
383 if (ret)
384 break;
385
386 ret = test_alloc_compat(dir->d_name);
387 if (ret)
388 break;
389
390 ret = test_alloc_errors(dir->d_name);
391 if (ret)
392 break;
393 }
394 closedir(d);
395
396 return ret;
397}
398
