1 /*
2 * \file xf86drmMode.c
3 * Header for DRM modesetting interface.
4 *
5 * \author Jakob Bornecrantz <wallbraker@gmail.com>
6 *
7 * \par Acknowledgements:
8 * Feb 2007, Dave Airlie <airlied@linux.ie>
9 */
10
11 /*
12 * Copyright (c) 2007-2008 Tungsten Graphics, Inc., Cedar Park, Texas.
13 * Copyright (c) 2007-2008 Dave Airlie <airlied@linux.ie>
14 * Copyright (c) 2007-2008 Jakob Bornecrantz <wallbraker@gmail.com>
15 *
16 * Permission is hereby granted, free of charge, to any person obtaining a
17 * copy of this software and associated documentation files (the "Software"),
18 * to deal in the Software without restriction, including without limitation
19 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
20 * and/or sell copies of the Software, and to permit persons to whom the
21 * Software is furnished to do so, subject to the following conditions:
22 *
23 * The above copyright notice and this permission notice shall be included in
24 * all copies or substantial portions of the Software.
25 *
26 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
27 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
28 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
29 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
30 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
31 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
32 * IN THE SOFTWARE.
33 *
34 */
35
36 #include <assert.h>
37 #include <limits.h>
38 #include <stdint.h>
39 #include <stdlib.h>
40 #include <sys/ioctl.h>
41 #if HAVE_SYS_SYSCTL_H
42 #ifdef __FreeBSD__
43 #include <sys/types.h>
44 #endif
45 #include <sys/sysctl.h>
46 #endif
47 #include <stdio.h>
48 #include <stdbool.h>
49
50 #include "libdrm_macros.h"
51 #include "xf86drmMode.h"
52 #include "xf86drm.h"
53 #include <drm.h>
54 #include <drm_fourcc.h>
55 #include <string.h>
56 #include <dirent.h>
57 #include <unistd.h>
58 #include <errno.h>
59
60 #define memclear(s) memset(&s, 0, sizeof(s))
61
62 #define U642VOID(x) ((void *)(unsigned long)(x))
63 #define VOID2U64(x) ((uint64_t)(unsigned long)(x))
64
DRM_IOCTL(int fd,unsigned long cmd,void * arg)65 static inline int DRM_IOCTL(int fd, unsigned long cmd, void *arg)
66 {
67 int ret = drmIoctl(fd, cmd, arg);
68 return ret < 0 ? -errno : ret;
69 }
70
71 /*
72 * Util functions
73 */
74
drmAllocCpy(char * array,int count,int entry_size)75 static void* drmAllocCpy(char *array, int count, int entry_size)
76 {
77 char *r;
78 int i;
79
80 if (!count || !array || !entry_size)
81 return 0;
82
83 if (!(r = drmMalloc(count*entry_size)))
84 return 0;
85
86 for (i = 0; i < count; i++)
87 memcpy(r+(entry_size*i), array+(entry_size*i), entry_size);
88
89 return r;
90 }
91
92 /*
93 * A couple of free functions.
94 */
95
drmModeFreeModeInfo(drmModeModeInfoPtr ptr)96 drm_public void drmModeFreeModeInfo(drmModeModeInfoPtr ptr)
97 {
98 if (!ptr)
99 return;
100
101 drmFree(ptr);
102 }
103
drmModeFreeResources(drmModeResPtr ptr)104 drm_public void drmModeFreeResources(drmModeResPtr ptr)
105 {
106 if (!ptr)
107 return;
108
109 drmFree(ptr->fbs);
110 drmFree(ptr->crtcs);
111 drmFree(ptr->connectors);
112 drmFree(ptr->encoders);
113 drmFree(ptr);
114 }
115
drmModeFreeFB(drmModeFBPtr ptr)116 drm_public void drmModeFreeFB(drmModeFBPtr ptr)
117 {
118 if (!ptr)
119 return;
120
121 /* we might add more frees later. */
122 drmFree(ptr);
123 }
124
drmModeFreeCrtc(drmModeCrtcPtr ptr)125 drm_public void drmModeFreeCrtc(drmModeCrtcPtr ptr)
126 {
127 if (!ptr)
128 return;
129
130 drmFree(ptr);
131 }
132
drmModeFreeConnector(drmModeConnectorPtr ptr)133 drm_public void drmModeFreeConnector(drmModeConnectorPtr ptr)
134 {
135 if (!ptr)
136 return;
137
138 drmFree(ptr->encoders);
139 drmFree(ptr->prop_values);
140 drmFree(ptr->props);
141 drmFree(ptr->modes);
142 drmFree(ptr);
143 }
144
drmModeFreeEncoder(drmModeEncoderPtr ptr)145 drm_public void drmModeFreeEncoder(drmModeEncoderPtr ptr)
146 {
147 drmFree(ptr);
148 }
149
150 /*
151 * ModeSetting functions.
152 */
153
drmIsKMS(int fd)154 drm_public int drmIsKMS(int fd)
155 {
156 struct drm_mode_card_res res = {0};
157
158 if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res) != 0)
159 return 0;
160
161 return res.count_crtcs > 0 && res.count_connectors > 0 && res.count_encoders > 0;
162 }
163
drmModeGetResources(int fd)164 drm_public drmModeResPtr drmModeGetResources(int fd)
165 {
166 struct drm_mode_card_res res, counts;
167 drmModeResPtr r = 0;
168
169 retry:
170 memclear(res);
171 if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res))
172 return 0;
173
174 counts = res;
175
176 if (res.count_fbs) {
177 res.fb_id_ptr = VOID2U64(drmMalloc(res.count_fbs*sizeof(uint32_t)));
178 if (!res.fb_id_ptr)
179 goto err_allocs;
180 }
181 if (res.count_crtcs) {
182 res.crtc_id_ptr = VOID2U64(drmMalloc(res.count_crtcs*sizeof(uint32_t)));
183 if (!res.crtc_id_ptr)
184 goto err_allocs;
185 }
186 if (res.count_connectors) {
187 res.connector_id_ptr = VOID2U64(drmMalloc(res.count_connectors*sizeof(uint32_t)));
188 if (!res.connector_id_ptr)
189 goto err_allocs;
190 }
191 if (res.count_encoders) {
192 res.encoder_id_ptr = VOID2U64(drmMalloc(res.count_encoders*sizeof(uint32_t)));
193 if (!res.encoder_id_ptr)
194 goto err_allocs;
195 }
196
197 if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res))
198 goto err_allocs;
199
200 /* The number of available connectors and etc may have changed with a
201 * hotplug event in between the ioctls, in which case the field is
202 * silently ignored by the kernel.
203 */
204 if (counts.count_fbs < res.count_fbs ||
205 counts.count_crtcs < res.count_crtcs ||
206 counts.count_connectors < res.count_connectors ||
207 counts.count_encoders < res.count_encoders)
208 {
209 drmFree(U642VOID(res.fb_id_ptr));
210 drmFree(U642VOID(res.crtc_id_ptr));
211 drmFree(U642VOID(res.connector_id_ptr));
212 drmFree(U642VOID(res.encoder_id_ptr));
213
214 goto retry;
215 }
216
217 /*
218 * return
219 */
220 if (!(r = drmMalloc(sizeof(*r))))
221 goto err_allocs;
222
223 r->min_width = res.min_width;
224 r->max_width = res.max_width;
225 r->min_height = res.min_height;
226 r->max_height = res.max_height;
227 r->count_fbs = res.count_fbs;
228 r->count_crtcs = res.count_crtcs;
229 r->count_connectors = res.count_connectors;
230 r->count_encoders = res.count_encoders;
231
232 r->fbs = drmAllocCpy(U642VOID(res.fb_id_ptr), res.count_fbs, sizeof(uint32_t));
233 r->crtcs = drmAllocCpy(U642VOID(res.crtc_id_ptr), res.count_crtcs, sizeof(uint32_t));
234 r->connectors = drmAllocCpy(U642VOID(res.connector_id_ptr), res.count_connectors, sizeof(uint32_t));
235 r->encoders = drmAllocCpy(U642VOID(res.encoder_id_ptr), res.count_encoders, sizeof(uint32_t));
236 if ((res.count_fbs && !r->fbs) ||
237 (res.count_crtcs && !r->crtcs) ||
238 (res.count_connectors && !r->connectors) ||
239 (res.count_encoders && !r->encoders))
240 {
241 drmFree(r->fbs);
242 drmFree(r->crtcs);
243 drmFree(r->connectors);
244 drmFree(r->encoders);
245 drmFree(r);
246 r = 0;
247 }
248
249 err_allocs:
250 drmFree(U642VOID(res.fb_id_ptr));
251 drmFree(U642VOID(res.crtc_id_ptr));
252 drmFree(U642VOID(res.connector_id_ptr));
253 drmFree(U642VOID(res.encoder_id_ptr));
254
255 return r;
256 }
257
258
drmModeAddFB(int fd,uint32_t width,uint32_t height,uint8_t depth,uint8_t bpp,uint32_t pitch,uint32_t bo_handle,uint32_t * buf_id)259 drm_public int drmModeAddFB(int fd, uint32_t width, uint32_t height, uint8_t depth,
260 uint8_t bpp, uint32_t pitch, uint32_t bo_handle,
261 uint32_t *buf_id)
262 {
263 struct drm_mode_fb_cmd f;
264 int ret;
265
266 memclear(f);
267 f.width = width;
268 f.height = height;
269 f.pitch = pitch;
270 f.bpp = bpp;
271 f.depth = depth;
272 f.handle = bo_handle;
273
274 if ((ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ADDFB, &f)))
275 return ret;
276
277 *buf_id = f.fb_id;
278 return 0;
279 }
280
drmModeAddFB2WithModifiers(int fd,uint32_t width,uint32_t height,uint32_t pixel_format,const uint32_t bo_handles[4],const uint32_t pitches[4],const uint32_t offsets[4],const uint64_t modifier[4],uint32_t * buf_id,uint32_t flags)281 drm_public int drmModeAddFB2WithModifiers(int fd, uint32_t width,
282 uint32_t height, uint32_t pixel_format, const uint32_t bo_handles[4],
283 const uint32_t pitches[4], const uint32_t offsets[4],
284 const uint64_t modifier[4], uint32_t *buf_id, uint32_t flags)
285 {
286 struct drm_mode_fb_cmd2 f;
287 int ret;
288
289 memclear(f);
290 f.width = width;
291 f.height = height;
292 f.pixel_format = pixel_format;
293 f.flags = flags;
294 memcpy(f.handles, bo_handles, 4 * sizeof(bo_handles[0]));
295 memcpy(f.pitches, pitches, 4 * sizeof(pitches[0]));
296 memcpy(f.offsets, offsets, 4 * sizeof(offsets[0]));
297 if (modifier)
298 memcpy(f.modifier, modifier, 4 * sizeof(modifier[0]));
299
300 if ((ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ADDFB2, &f)))
301 return ret;
302
303 *buf_id = f.fb_id;
304 return 0;
305 }
306
drmModeAddFB2(int fd,uint32_t width,uint32_t height,uint32_t pixel_format,const uint32_t bo_handles[4],const uint32_t pitches[4],const uint32_t offsets[4],uint32_t * buf_id,uint32_t flags)307 drm_public int drmModeAddFB2(int fd, uint32_t width, uint32_t height,
308 uint32_t pixel_format, const uint32_t bo_handles[4],
309 const uint32_t pitches[4], const uint32_t offsets[4],
310 uint32_t *buf_id, uint32_t flags)
311 {
312 return drmModeAddFB2WithModifiers(fd, width, height,
313 pixel_format, bo_handles,
314 pitches, offsets, NULL,
315 buf_id, flags);
316 }
317
drmModeRmFB(int fd,uint32_t bufferId)318 drm_public int drmModeRmFB(int fd, uint32_t bufferId)
319 {
320 return DRM_IOCTL(fd, DRM_IOCTL_MODE_RMFB, &bufferId);
321 }
322
drmModeGetFB(int fd,uint32_t buf)323 drm_public drmModeFBPtr drmModeGetFB(int fd, uint32_t buf)
324 {
325 struct drm_mode_fb_cmd info;
326 drmModeFBPtr r;
327
328 memclear(info);
329 info.fb_id = buf;
330
331 if (drmIoctl(fd, DRM_IOCTL_MODE_GETFB, &info))
332 return NULL;
333
334 if (!(r = drmMalloc(sizeof(*r))))
335 return NULL;
336
337 r->fb_id = info.fb_id;
338 r->width = info.width;
339 r->height = info.height;
340 r->pitch = info.pitch;
341 r->bpp = info.bpp;
342 r->handle = info.handle;
343 r->depth = info.depth;
344
345 return r;
346 }
347
drmModeDirtyFB(int fd,uint32_t bufferId,drmModeClipPtr clips,uint32_t num_clips)348 drm_public int drmModeDirtyFB(int fd, uint32_t bufferId,
349 drmModeClipPtr clips, uint32_t num_clips)
350 {
351 struct drm_mode_fb_dirty_cmd dirty;
352
353 memclear(dirty);
354 dirty.fb_id = bufferId;
355 dirty.clips_ptr = VOID2U64(clips);
356 dirty.num_clips = num_clips;
357
358 return DRM_IOCTL(fd, DRM_IOCTL_MODE_DIRTYFB, &dirty);
359 }
360
361 /*
362 * Crtc functions
363 */
364
drmModeGetCrtc(int fd,uint32_t crtcId)365 drm_public drmModeCrtcPtr drmModeGetCrtc(int fd, uint32_t crtcId)
366 {
367 struct drm_mode_crtc crtc;
368 drmModeCrtcPtr r;
369
370 memclear(crtc);
371 crtc.crtc_id = crtcId;
372
373 if (drmIoctl(fd, DRM_IOCTL_MODE_GETCRTC, &crtc))
374 return 0;
375
376 /*
377 * return
378 */
379
380 if (!(r = drmMalloc(sizeof(*r))))
381 return 0;
382
383 r->crtc_id = crtc.crtc_id;
384 r->x = crtc.x;
385 r->y = crtc.y;
386 r->mode_valid = crtc.mode_valid;
387 if (r->mode_valid) {
388 memcpy(&r->mode, &crtc.mode, sizeof(struct drm_mode_modeinfo));
389 r->width = crtc.mode.hdisplay;
390 r->height = crtc.mode.vdisplay;
391 }
392 r->buffer_id = crtc.fb_id;
393 r->gamma_size = crtc.gamma_size;
394 return r;
395 }
396
drmModeSetCrtc(int fd,uint32_t crtcId,uint32_t bufferId,uint32_t x,uint32_t y,uint32_t * connectors,int count,drmModeModeInfoPtr mode)397 drm_public int drmModeSetCrtc(int fd, uint32_t crtcId, uint32_t bufferId,
398 uint32_t x, uint32_t y, uint32_t *connectors, int count,
399 drmModeModeInfoPtr mode)
400 {
401 struct drm_mode_crtc crtc;
402
403 memclear(crtc);
404 crtc.x = x;
405 crtc.y = y;
406 crtc.crtc_id = crtcId;
407 crtc.fb_id = bufferId;
408 crtc.set_connectors_ptr = VOID2U64(connectors);
409 crtc.count_connectors = count;
410 if (mode) {
411 memcpy(&crtc.mode, mode, sizeof(struct drm_mode_modeinfo));
412 crtc.mode_valid = 1;
413 }
414
415 return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETCRTC, &crtc);
416 }
417
418 /*
419 * Cursor manipulation
420 */
421
drmModeSetCursor(int fd,uint32_t crtcId,uint32_t bo_handle,uint32_t width,uint32_t height)422 drm_public int drmModeSetCursor(int fd, uint32_t crtcId, uint32_t bo_handle,
423 uint32_t width, uint32_t height)
424 {
425 struct drm_mode_cursor arg;
426
427 memclear(arg);
428 arg.flags = DRM_MODE_CURSOR_BO;
429 arg.crtc_id = crtcId;
430 arg.width = width;
431 arg.height = height;
432 arg.handle = bo_handle;
433
434 return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR, &arg);
435 }
436
drmModeSetCursor2(int fd,uint32_t crtcId,uint32_t bo_handle,uint32_t width,uint32_t height,int32_t hot_x,int32_t hot_y)437 drm_public int drmModeSetCursor2(int fd, uint32_t crtcId, uint32_t bo_handle,
438 uint32_t width, uint32_t height, int32_t hot_x,
439 int32_t hot_y)
440 {
441 struct drm_mode_cursor2 arg;
442
443 memclear(arg);
444 arg.flags = DRM_MODE_CURSOR_BO;
445 arg.crtc_id = crtcId;
446 arg.width = width;
447 arg.height = height;
448 arg.handle = bo_handle;
449 arg.hot_x = hot_x;
450 arg.hot_y = hot_y;
451
452 return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR2, &arg);
453 }
454
drmModeMoveCursor(int fd,uint32_t crtcId,int x,int y)455 drm_public int drmModeMoveCursor(int fd, uint32_t crtcId, int x, int y)
456 {
457 struct drm_mode_cursor arg;
458
459 memclear(arg);
460 arg.flags = DRM_MODE_CURSOR_MOVE;
461 arg.crtc_id = crtcId;
462 arg.x = x;
463 arg.y = y;
464
465 return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR, &arg);
466 }
467
468 /*
469 * Encoder get
470 */
drmModeGetEncoder(int fd,uint32_t encoder_id)471 drm_public drmModeEncoderPtr drmModeGetEncoder(int fd, uint32_t encoder_id)
472 {
473 struct drm_mode_get_encoder enc;
474 drmModeEncoderPtr r = NULL;
475
476 memclear(enc);
477 enc.encoder_id = encoder_id;
478
479 if (drmIoctl(fd, DRM_IOCTL_MODE_GETENCODER, &enc))
480 return 0;
481
482 if (!(r = drmMalloc(sizeof(*r))))
483 return 0;
484
485 r->encoder_id = enc.encoder_id;
486 r->crtc_id = enc.crtc_id;
487 r->encoder_type = enc.encoder_type;
488 r->possible_crtcs = enc.possible_crtcs;
489 r->possible_clones = enc.possible_clones;
490
491 return r;
492 }
493
494 /*
495 * Connector manipulation
496 */
497 static drmModeConnectorPtr
_drmModeGetConnector(int fd,uint32_t connector_id,int probe)498 _drmModeGetConnector(int fd, uint32_t connector_id, int probe)
499 {
500 struct drm_mode_get_connector conn, counts;
501 drmModeConnectorPtr r = NULL;
502 struct drm_mode_modeinfo stack_mode;
503
504 memclear(conn);
505 conn.connector_id = connector_id;
506 if (!probe) {
507 conn.count_modes = 1;
508 conn.modes_ptr = VOID2U64(&stack_mode);
509 }
510
511 if (drmIoctl(fd, DRM_IOCTL_MODE_GETCONNECTOR, &conn))
512 return 0;
513
514 retry:
515 counts = conn;
516
517 if (conn.count_props) {
518 conn.props_ptr = VOID2U64(drmMalloc(conn.count_props*sizeof(uint32_t)));
519 if (!conn.props_ptr)
520 goto err_allocs;
521 conn.prop_values_ptr = VOID2U64(drmMalloc(conn.count_props*sizeof(uint64_t)));
522 if (!conn.prop_values_ptr)
523 goto err_allocs;
524 }
525
526 if (conn.count_modes) {
527 conn.modes_ptr = VOID2U64(drmMalloc(conn.count_modes*sizeof(struct drm_mode_modeinfo)));
528 if (!conn.modes_ptr)
529 goto err_allocs;
530 } else {
531 conn.count_modes = 1;
532 conn.modes_ptr = VOID2U64(&stack_mode);
533 }
534
535 if (conn.count_encoders) {
536 conn.encoders_ptr = VOID2U64(drmMalloc(conn.count_encoders*sizeof(uint32_t)));
537 if (!conn.encoders_ptr)
538 goto err_allocs;
539 }
540
541 if (drmIoctl(fd, DRM_IOCTL_MODE_GETCONNECTOR, &conn))
542 goto err_allocs;
543
544 /* The number of available connectors and etc may have changed with a
545 * hotplug event in between the ioctls, in which case the field is
546 * silently ignored by the kernel.
547 */
548 if (counts.count_props < conn.count_props ||
549 counts.count_modes < conn.count_modes ||
550 counts.count_encoders < conn.count_encoders) {
551 drmFree(U642VOID(conn.props_ptr));
552 drmFree(U642VOID(conn.prop_values_ptr));
553 if (U642VOID(conn.modes_ptr) != &stack_mode)
554 drmFree(U642VOID(conn.modes_ptr));
555 drmFree(U642VOID(conn.encoders_ptr));
556
557 goto retry;
558 }
559
560 if(!(r = drmMalloc(sizeof(*r)))) {
561 goto err_allocs;
562 }
563
564 r->connector_id = conn.connector_id;
565 r->encoder_id = conn.encoder_id;
566 r->connection = conn.connection;
567 r->mmWidth = conn.mm_width;
568 r->mmHeight = conn.mm_height;
569 /* convert subpixel from kernel to userspace */
570 r->subpixel = conn.subpixel + 1;
571 r->count_modes = conn.count_modes;
572 r->count_props = conn.count_props;
573 r->props = drmAllocCpy(U642VOID(conn.props_ptr), conn.count_props, sizeof(uint32_t));
574 r->prop_values = drmAllocCpy(U642VOID(conn.prop_values_ptr), conn.count_props, sizeof(uint64_t));
575 r->modes = drmAllocCpy(U642VOID(conn.modes_ptr), conn.count_modes, sizeof(struct drm_mode_modeinfo));
576 r->count_encoders = conn.count_encoders;
577 r->encoders = drmAllocCpy(U642VOID(conn.encoders_ptr), conn.count_encoders, sizeof(uint32_t));
578 r->connector_type = conn.connector_type;
579 r->connector_type_id = conn.connector_type_id;
580
581 if ((r->count_props && !r->props) ||
582 (r->count_props && !r->prop_values) ||
583 (r->count_modes && !r->modes) ||
584 (r->count_encoders && !r->encoders)) {
585 drmFree(r->props);
586 drmFree(r->prop_values);
587 drmFree(r->modes);
588 drmFree(r->encoders);
589 drmFree(r);
590 r = 0;
591 }
592
593 err_allocs:
594 drmFree(U642VOID(conn.prop_values_ptr));
595 drmFree(U642VOID(conn.props_ptr));
596 if (U642VOID(conn.modes_ptr) != &stack_mode)
597 drmFree(U642VOID(conn.modes_ptr));
598 drmFree(U642VOID(conn.encoders_ptr));
599
600 return r;
601 }
602
drmModeGetConnector(int fd,uint32_t connector_id)603 drm_public drmModeConnectorPtr drmModeGetConnector(int fd, uint32_t connector_id)
604 {
605 return _drmModeGetConnector(fd, connector_id, 1);
606 }
607
drmModeGetConnectorCurrent(int fd,uint32_t connector_id)608 drm_public drmModeConnectorPtr drmModeGetConnectorCurrent(int fd, uint32_t connector_id)
609 {
610 return _drmModeGetConnector(fd, connector_id, 0);
611 }
612
drmModeAttachMode(int fd,uint32_t connector_id,drmModeModeInfoPtr mode_info)613 drm_public int drmModeAttachMode(int fd, uint32_t connector_id, drmModeModeInfoPtr mode_info)
614 {
615 struct drm_mode_mode_cmd res;
616
617 memclear(res);
618 memcpy(&res.mode, mode_info, sizeof(struct drm_mode_modeinfo));
619 res.connector_id = connector_id;
620
621 return DRM_IOCTL(fd, DRM_IOCTL_MODE_ATTACHMODE, &res);
622 }
623
drmModeDetachMode(int fd,uint32_t connector_id,drmModeModeInfoPtr mode_info)624 drm_public int drmModeDetachMode(int fd, uint32_t connector_id, drmModeModeInfoPtr mode_info)
625 {
626 struct drm_mode_mode_cmd res;
627
628 memclear(res);
629 memcpy(&res.mode, mode_info, sizeof(struct drm_mode_modeinfo));
630 res.connector_id = connector_id;
631
632 return DRM_IOCTL(fd, DRM_IOCTL_MODE_DETACHMODE, &res);
633 }
634
drmModeGetProperty(int fd,uint32_t property_id)635 drm_public drmModePropertyPtr drmModeGetProperty(int fd, uint32_t property_id)
636 {
637 struct drm_mode_get_property prop;
638 drmModePropertyPtr r;
639
640 memclear(prop);
641 prop.prop_id = property_id;
642
643 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPERTY, &prop))
644 return 0;
645
646 if (prop.count_values)
647 prop.values_ptr = VOID2U64(drmMalloc(prop.count_values * sizeof(uint64_t)));
648
649 if (prop.count_enum_blobs && (prop.flags & (DRM_MODE_PROP_ENUM | DRM_MODE_PROP_BITMASK)))
650 prop.enum_blob_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(struct drm_mode_property_enum)));
651
652 if (prop.count_enum_blobs && (prop.flags & DRM_MODE_PROP_BLOB)) {
653 prop.values_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(uint32_t)));
654 prop.enum_blob_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(uint32_t)));
655 }
656
657 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPERTY, &prop)) {
658 r = NULL;
659 goto err_allocs;
660 }
661
662 if (!(r = drmMalloc(sizeof(*r))))
663 goto err_allocs;
664
665 r->prop_id = prop.prop_id;
666 r->count_values = prop.count_values;
667
668 r->flags = prop.flags;
669 if (prop.count_values)
670 r->values = drmAllocCpy(U642VOID(prop.values_ptr), prop.count_values, sizeof(uint64_t));
671 if (prop.flags & (DRM_MODE_PROP_ENUM | DRM_MODE_PROP_BITMASK)) {
672 r->count_enums = prop.count_enum_blobs;
673 r->enums = drmAllocCpy(U642VOID(prop.enum_blob_ptr), prop.count_enum_blobs, sizeof(struct drm_mode_property_enum));
674 } else if (prop.flags & DRM_MODE_PROP_BLOB) {
675 r->values = drmAllocCpy(U642VOID(prop.values_ptr), prop.count_enum_blobs, sizeof(uint32_t));
676 r->blob_ids = drmAllocCpy(U642VOID(prop.enum_blob_ptr), prop.count_enum_blobs, sizeof(uint32_t));
677 r->count_blobs = prop.count_enum_blobs;
678 }
679 strncpy(r->name, prop.name, DRM_PROP_NAME_LEN);
680 r->name[DRM_PROP_NAME_LEN-1] = 0;
681
682 err_allocs:
683 drmFree(U642VOID(prop.values_ptr));
684 drmFree(U642VOID(prop.enum_blob_ptr));
685
686 return r;
687 }
688
drmModeFreeProperty(drmModePropertyPtr ptr)689 drm_public void drmModeFreeProperty(drmModePropertyPtr ptr)
690 {
691 if (!ptr)
692 return;
693
694 drmFree(ptr->values);
695 drmFree(ptr->enums);
696 drmFree(ptr->blob_ids);
697 drmFree(ptr);
698 }
699
drmModeGetPropertyBlob(int fd,uint32_t blob_id)700 drm_public drmModePropertyBlobPtr drmModeGetPropertyBlob(int fd,
701 uint32_t blob_id)
702 {
703 struct drm_mode_get_blob blob;
704 drmModePropertyBlobPtr r;
705
706 memclear(blob);
707 blob.blob_id = blob_id;
708
709 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPBLOB, &blob))
710 return NULL;
711
712 if (blob.length)
713 blob.data = VOID2U64(drmMalloc(blob.length));
714
715 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPBLOB, &blob)) {
716 r = NULL;
717 goto err_allocs;
718 }
719
720 if (!(r = drmMalloc(sizeof(*r))))
721 goto err_allocs;
722
723 r->id = blob.blob_id;
724 r->length = blob.length;
725 r->data = drmAllocCpy(U642VOID(blob.data), 1, blob.length);
726
727 err_allocs:
728 drmFree(U642VOID(blob.data));
729 return r;
730 }
731
732 static inline const uint32_t *
get_formats_ptr(const struct drm_format_modifier_blob * blob)733 get_formats_ptr(const struct drm_format_modifier_blob *blob)
734 {
735 return (const uint32_t *)(((uint8_t *)blob) + blob->formats_offset);
736 }
737
738 static inline const struct drm_format_modifier *
get_modifiers_ptr(const struct drm_format_modifier_blob * blob)739 get_modifiers_ptr(const struct drm_format_modifier_blob *blob)
740 {
741 return (const struct drm_format_modifier *)(((uint8_t *)blob) +
742 blob->modifiers_offset);
743 }
744
_drmModeFormatModifierGetNext(const drmModePropertyBlobRes * blob,drmModeFormatModifierIterator * iter)745 static bool _drmModeFormatModifierGetNext(const drmModePropertyBlobRes *blob,
746 drmModeFormatModifierIterator *iter)
747 {
748 const struct drm_format_modifier *blob_modifiers, *mod;
749 const struct drm_format_modifier_blob *fmt_mod_blob;
750 const uint32_t *blob_formats;
751
752 assert(blob && iter);
753
754 fmt_mod_blob = blob->data;
755 blob_modifiers = get_modifiers_ptr(fmt_mod_blob);
756 blob_formats = get_formats_ptr(fmt_mod_blob);
757
758 /* fmt_idx and mod_idx designate the number of processed formats
759 * and modifiers.
760 */
761 if (iter->fmt_idx >= fmt_mod_blob->count_formats ||
762 iter->mod_idx >= fmt_mod_blob->count_modifiers)
763 return false;
764
765 iter->fmt = blob_formats[iter->fmt_idx];
766 iter->mod = DRM_FORMAT_MOD_INVALID;
767
768 /* From the latest valid found, get the next valid modifier */
769 while (iter->mod_idx < fmt_mod_blob->count_modifiers) {
770 mod = &blob_modifiers[iter->mod_idx++];
771
772 /* Check if the format that fmt_idx designates, belongs to
773 * this modifier 64-bit window selected via mod->offset.
774 */
775 if (iter->fmt_idx < mod->offset ||
776 iter->fmt_idx >= mod->offset + 64)
777 continue;
778 if (!(mod->formats & (1 << (iter->fmt_idx - mod->offset))))
779 continue;
780
781 iter->mod = mod->modifier;
782 break;
783 }
784
785 if (iter->mod_idx == fmt_mod_blob->count_modifiers) {
786 iter->mod_idx = 0;
787 iter->fmt_idx++;
788 }
789
790 /* Since mod_idx reset, in order for the caller to iterate over
791 * the last modifier of the last format, always return true here
792 * and early return from the next call.
793 */
794 return true;
795 }
796
797 /**
798 * Iterate over formats first and then over modifiers. On each call, iter->fmt
799 * is retained until all associated modifiers are returned. Then, either update
800 * iter->fmt with the next format, or exit if there aren't any left.
801 *
802 * NOTE: clients should not make any assumption on mod_idx and fmt_idx values
803 *
804 * @blob: valid kernel blob holding formats and modifiers
805 * @iter: input and output iterator data. Iter data must be initialised to zero
806 * @return: false, on error or there aren't any further formats or modifiers left.
807 * true, on success and there are more formats or modifiers.
808 */
drmModeFormatModifierBlobIterNext(const drmModePropertyBlobRes * blob,drmModeFormatModifierIterator * iter)809 drm_public bool drmModeFormatModifierBlobIterNext(const drmModePropertyBlobRes *blob,
810 drmModeFormatModifierIterator *iter)
811 {
812 drmModeFormatModifierIterator tmp;
813 bool has_fmt;
814
815 if (!blob || !iter)
816 return false;
817
818 tmp.fmt_idx = iter->fmt_idx;
819 tmp.mod_idx = iter->mod_idx;
820
821 /* With the current state of things, DRM/KMS drivers are allowed to
822 * construct blobs having formats and no modifiers. Userspace can't
823 * legitimately abort in such cases.
824 *
825 * While waiting for the kernel to perhaps disallow formats with no
826 * modifiers in IN_FORMATS blobs, skip the format altogether.
827 */
828 do {
829 has_fmt = _drmModeFormatModifierGetNext(blob, &tmp);
830 if (has_fmt && tmp.mod != DRM_FORMAT_MOD_INVALID)
831 *iter = tmp;
832
833 } while (has_fmt && tmp.mod == DRM_FORMAT_MOD_INVALID);
834
835 return has_fmt;
836 }
837
drmModeFreePropertyBlob(drmModePropertyBlobPtr ptr)838 drm_public void drmModeFreePropertyBlob(drmModePropertyBlobPtr ptr)
839 {
840 if (!ptr)
841 return;
842
843 drmFree(ptr->data);
844 drmFree(ptr);
845 }
846
drmModeConnectorSetProperty(int fd,uint32_t connector_id,uint32_t property_id,uint64_t value)847 drm_public int drmModeConnectorSetProperty(int fd, uint32_t connector_id,
848 uint32_t property_id,
849 uint64_t value)
850 {
851 struct drm_mode_connector_set_property osp;
852
853 memclear(osp);
854 osp.connector_id = connector_id;
855 osp.prop_id = property_id;
856 osp.value = value;
857
858 return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETPROPERTY, &osp);
859 }
860
861 /*
862 * checks if a modesetting capable driver has attached to the pci id
863 * returns 0 if modesetting supported.
864 * -EINVAL or invalid bus id
865 * -ENOSYS if no modesetting support
866 */
drmCheckModesettingSupported(const char * busid)867 drm_public int drmCheckModesettingSupported(const char *busid)
868 {
869 #if defined (__linux__)
870 char pci_dev_dir[1024];
871 int domain, bus, dev, func;
872 DIR *sysdir;
873 struct dirent *dent;
874 int found = 0, ret;
875
876 ret = sscanf(busid, "pci:%04x:%02x:%02x.%d", &domain, &bus, &dev, &func);
877 if (ret != 4)
878 return -EINVAL;
879
880 sprintf(pci_dev_dir, "/sys/bus/pci/devices/%04x:%02x:%02x.%d/drm",
881 domain, bus, dev, func);
882
883 sysdir = opendir(pci_dev_dir);
884 if (sysdir) {
885 dent = readdir(sysdir);
886 while (dent) {
887 if (!strncmp(dent->d_name, "controlD", 8)) {
888 found = 1;
889 break;
890 }
891
892 dent = readdir(sysdir);
893 }
894 closedir(sysdir);
895 if (found)
896 return 0;
897 }
898
899 sprintf(pci_dev_dir, "/sys/bus/pci/devices/%04x:%02x:%02x.%d/",
900 domain, bus, dev, func);
901
902 sysdir = opendir(pci_dev_dir);
903 if (!sysdir)
904 return -EINVAL;
905
906 dent = readdir(sysdir);
907 while (dent) {
908 if (!strncmp(dent->d_name, "drm:controlD", 12)) {
909 found = 1;
910 break;
911 }
912
913 dent = readdir(sysdir);
914 }
915
916 closedir(sysdir);
917 if (found)
918 return 0;
919 #elif defined (__FreeBSD__) || defined (__FreeBSD_kernel__)
920 char sbusid[1024];
921 char oid[128];
922 int i, modesetting, ret;
923 size_t len;
924
925 /* How many GPUs do we expect in the machine ? */
926 for (i = 0; i < 10; i++) {
927 snprintf(oid, sizeof(oid), "hw.dri.%d.busid", i);
928 len = sizeof(sbusid);
929 ret = sysctlbyname(oid, sbusid, &len, NULL, 0);
930 if (ret == -1) {
931 if (errno == ENOENT)
932 continue;
933 return -EINVAL;
934 }
935 if (strcmp(sbusid, busid) != 0)
936 continue;
937 snprintf(oid, sizeof(oid), "hw.dri.%d.modesetting", i);
938 len = sizeof(modesetting);
939 ret = sysctlbyname(oid, &modesetting, &len, NULL, 0);
940 if (ret == -1 || len != sizeof(modesetting))
941 return -EINVAL;
942 return (modesetting ? 0 : -ENOSYS);
943 }
944 #elif defined(__DragonFly__)
945 return 0;
946 #elif defined(__OpenBSD__)
947 int fd;
948 struct drm_mode_card_res res;
949 drmModeResPtr r = 0;
950
951 if ((fd = drmOpen(NULL, busid)) < 0)
952 return -EINVAL;
953
954 memset(&res, 0, sizeof(struct drm_mode_card_res));
955
956 if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res)) {
957 drmClose(fd);
958 return -errno;
959 }
960
961 drmClose(fd);
962 return 0;
963 #endif
964 return -ENOSYS;
965 }
966
drmModeCrtcGetGamma(int fd,uint32_t crtc_id,uint32_t size,uint16_t * red,uint16_t * green,uint16_t * blue)967 drm_public int drmModeCrtcGetGamma(int fd, uint32_t crtc_id, uint32_t size,
968 uint16_t *red, uint16_t *green,
969 uint16_t *blue)
970 {
971 struct drm_mode_crtc_lut l;
972
973 memclear(l);
974 l.crtc_id = crtc_id;
975 l.gamma_size = size;
976 l.red = VOID2U64(red);
977 l.green = VOID2U64(green);
978 l.blue = VOID2U64(blue);
979
980 return DRM_IOCTL(fd, DRM_IOCTL_MODE_GETGAMMA, &l);
981 }
982
drmModeCrtcSetGamma(int fd,uint32_t crtc_id,uint32_t size,uint16_t * red,uint16_t * green,uint16_t * blue)983 drm_public int drmModeCrtcSetGamma(int fd, uint32_t crtc_id, uint32_t size,
984 uint16_t *red, uint16_t *green,
985 uint16_t *blue)
986 {
987 struct drm_mode_crtc_lut l;
988
989 memclear(l);
990 l.crtc_id = crtc_id;
991 l.gamma_size = size;
992 l.red = VOID2U64(red);
993 l.green = VOID2U64(green);
994 l.blue = VOID2U64(blue);
995
996 return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETGAMMA, &l);
997 }
998
drmHandleEvent(int fd,drmEventContextPtr evctx)999 drm_public int drmHandleEvent(int fd, drmEventContextPtr evctx)
1000 {
1001 char buffer[1024];
1002 int len, i;
1003 struct drm_event *e;
1004 struct drm_event_vblank *vblank;
1005 struct drm_event_crtc_sequence *seq;
1006 void *user_data;
1007
1008 /* The DRM read semantics guarantees that we always get only
1009 * complete events. */
1010
1011 len = read(fd, buffer, sizeof buffer);
1012 if (len == 0)
1013 return 0;
1014 if (len < (int)sizeof *e)
1015 return -1;
1016
1017 i = 0;
1018 while (i < len) {
1019 e = (struct drm_event *)(buffer + i);
1020 switch (e->type) {
1021 case DRM_EVENT_VBLANK:
1022 if (evctx->version < 1 ||
1023 evctx->vblank_handler == NULL)
1024 break;
1025 vblank = (struct drm_event_vblank *) e;
1026 evctx->vblank_handler(fd,
1027 vblank->sequence,
1028 vblank->tv_sec,
1029 vblank->tv_usec,
1030 U642VOID (vblank->user_data));
1031 break;
1032 case DRM_EVENT_FLIP_COMPLETE:
1033 vblank = (struct drm_event_vblank *) e;
1034 user_data = U642VOID (vblank->user_data);
1035
1036 if (evctx->version >= 3 && evctx->page_flip_handler2)
1037 evctx->page_flip_handler2(fd,
1038 vblank->sequence,
1039 vblank->tv_sec,
1040 vblank->tv_usec,
1041 vblank->crtc_id,
1042 user_data);
1043 else if (evctx->version >= 2 && evctx->page_flip_handler)
1044 evctx->page_flip_handler(fd,
1045 vblank->sequence,
1046 vblank->tv_sec,
1047 vblank->tv_usec,
1048 user_data);
1049 break;
1050 case DRM_EVENT_CRTC_SEQUENCE:
1051 seq = (struct drm_event_crtc_sequence *) e;
1052 if (evctx->version >= 4 && evctx->sequence_handler)
1053 evctx->sequence_handler(fd,
1054 seq->sequence,
1055 seq->time_ns,
1056 seq->user_data);
1057 break;
1058 default:
1059 break;
1060 }
1061 i += e->length;
1062 }
1063
1064 return 0;
1065 }
1066
drmModePageFlip(int fd,uint32_t crtc_id,uint32_t fb_id,uint32_t flags,void * user_data)1067 drm_public int drmModePageFlip(int fd, uint32_t crtc_id, uint32_t fb_id,
1068 uint32_t flags, void *user_data)
1069 {
1070 struct drm_mode_crtc_page_flip flip;
1071
1072 memclear(flip);
1073 flip.fb_id = fb_id;
1074 flip.crtc_id = crtc_id;
1075 flip.user_data = VOID2U64(user_data);
1076 flip.flags = flags;
1077
1078 return DRM_IOCTL(fd, DRM_IOCTL_MODE_PAGE_FLIP, &flip);
1079 }
1080
drmModePageFlipTarget(int fd,uint32_t crtc_id,uint32_t fb_id,uint32_t flags,void * user_data,uint32_t target_vblank)1081 drm_public int drmModePageFlipTarget(int fd, uint32_t crtc_id, uint32_t fb_id,
1082 uint32_t flags, void *user_data,
1083 uint32_t target_vblank)
1084 {
1085 struct drm_mode_crtc_page_flip_target flip_target;
1086
1087 memclear(flip_target);
1088 flip_target.fb_id = fb_id;
1089 flip_target.crtc_id = crtc_id;
1090 flip_target.user_data = VOID2U64(user_data);
1091 flip_target.flags = flags;
1092 flip_target.sequence = target_vblank;
1093
1094 return DRM_IOCTL(fd, DRM_IOCTL_MODE_PAGE_FLIP, &flip_target);
1095 }
1096
drmModeSetPlane(int fd,uint32_t plane_id,uint32_t crtc_id,uint32_t fb_id,uint32_t flags,int32_t crtc_x,int32_t crtc_y,uint32_t crtc_w,uint32_t crtc_h,uint32_t src_x,uint32_t src_y,uint32_t src_w,uint32_t src_h)1097 drm_public int drmModeSetPlane(int fd, uint32_t plane_id, uint32_t crtc_id,
1098 uint32_t fb_id, uint32_t flags,
1099 int32_t crtc_x, int32_t crtc_y,
1100 uint32_t crtc_w, uint32_t crtc_h,
1101 uint32_t src_x, uint32_t src_y,
1102 uint32_t src_w, uint32_t src_h)
1103 {
1104 struct drm_mode_set_plane s;
1105
1106 memclear(s);
1107 s.plane_id = plane_id;
1108 s.crtc_id = crtc_id;
1109 s.fb_id = fb_id;
1110 s.flags = flags;
1111 s.crtc_x = crtc_x;
1112 s.crtc_y = crtc_y;
1113 s.crtc_w = crtc_w;
1114 s.crtc_h = crtc_h;
1115 s.src_x = src_x;
1116 s.src_y = src_y;
1117 s.src_w = src_w;
1118 s.src_h = src_h;
1119
1120 return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETPLANE, &s);
1121 }
1122
drmModeGetPlane(int fd,uint32_t plane_id)1123 drm_public drmModePlanePtr drmModeGetPlane(int fd, uint32_t plane_id)
1124 {
1125 struct drm_mode_get_plane ovr, counts;
1126 drmModePlanePtr r = 0;
1127
1128 retry:
1129 memclear(ovr);
1130 ovr.plane_id = plane_id;
1131 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANE, &ovr))
1132 return 0;
1133
1134 counts = ovr;
1135
1136 if (ovr.count_format_types) {
1137 ovr.format_type_ptr = VOID2U64(drmMalloc(ovr.count_format_types *
1138 sizeof(uint32_t)));
1139 if (!ovr.format_type_ptr)
1140 goto err_allocs;
1141 }
1142
1143 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANE, &ovr))
1144 goto err_allocs;
1145
1146 if (counts.count_format_types < ovr.count_format_types) {
1147 drmFree(U642VOID(ovr.format_type_ptr));
1148 goto retry;
1149 }
1150
1151 if (!(r = drmMalloc(sizeof(*r))))
1152 goto err_allocs;
1153
1154 r->count_formats = ovr.count_format_types;
1155 r->plane_id = ovr.plane_id;
1156 r->crtc_id = ovr.crtc_id;
1157 r->fb_id = ovr.fb_id;
1158 r->possible_crtcs = ovr.possible_crtcs;
1159 r->gamma_size = ovr.gamma_size;
1160 r->formats = drmAllocCpy(U642VOID(ovr.format_type_ptr),
1161 ovr.count_format_types, sizeof(uint32_t));
1162 if (ovr.count_format_types && !r->formats) {
1163 drmFree(r->formats);
1164 drmFree(r);
1165 r = 0;
1166 }
1167
1168 err_allocs:
1169 drmFree(U642VOID(ovr.format_type_ptr));
1170
1171 return r;
1172 }
1173
drmModeFreePlane(drmModePlanePtr ptr)1174 drm_public void drmModeFreePlane(drmModePlanePtr ptr)
1175 {
1176 if (!ptr)
1177 return;
1178
1179 drmFree(ptr->formats);
1180 drmFree(ptr);
1181 }
1182
drmModeGetPlaneResources(int fd)1183 drm_public drmModePlaneResPtr drmModeGetPlaneResources(int fd)
1184 {
1185 struct drm_mode_get_plane_res res, counts;
1186 drmModePlaneResPtr r = 0;
1187
1188 retry:
1189 memclear(res);
1190 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANERESOURCES, &res))
1191 return 0;
1192
1193 counts = res;
1194
1195 if (res.count_planes) {
1196 res.plane_id_ptr = VOID2U64(drmMalloc(res.count_planes *
1197 sizeof(uint32_t)));
1198 if (!res.plane_id_ptr)
1199 goto err_allocs;
1200 }
1201
1202 if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANERESOURCES, &res))
1203 goto err_allocs;
1204
1205 if (counts.count_planes < res.count_planes) {
1206 drmFree(U642VOID(res.plane_id_ptr));
1207 goto retry;
1208 }
1209
1210 if (!(r = drmMalloc(sizeof(*r))))
1211 goto err_allocs;
1212
1213 r->count_planes = res.count_planes;
1214 r->planes = drmAllocCpy(U642VOID(res.plane_id_ptr),
1215 res.count_planes, sizeof(uint32_t));
1216 if (res.count_planes && !r->planes) {
1217 drmFree(r->planes);
1218 drmFree(r);
1219 r = 0;
1220 }
1221
1222 err_allocs:
1223 drmFree(U642VOID(res.plane_id_ptr));
1224
1225 return r;
1226 }
1227
drmModeFreePlaneResources(drmModePlaneResPtr ptr)1228 drm_public void drmModeFreePlaneResources(drmModePlaneResPtr ptr)
1229 {
1230 if (!ptr)
1231 return;
1232
1233 drmFree(ptr->planes);
1234 drmFree(ptr);
1235 }
1236
drmModeObjectGetProperties(int fd,uint32_t object_id,uint32_t object_type)1237 drm_public drmModeObjectPropertiesPtr drmModeObjectGetProperties(int fd,
1238 uint32_t object_id,
1239 uint32_t object_type)
1240 {
1241 struct drm_mode_obj_get_properties properties;
1242 drmModeObjectPropertiesPtr ret = NULL;
1243 uint32_t count;
1244
1245 retry:
1246 memclear(properties);
1247 properties.obj_id = object_id;
1248 properties.obj_type = object_type;
1249
1250 if (drmIoctl(fd, DRM_IOCTL_MODE_OBJ_GETPROPERTIES, &properties))
1251 return 0;
1252
1253 count = properties.count_props;
1254
1255 if (count) {
1256 properties.props_ptr = VOID2U64(drmMalloc(count *
1257 sizeof(uint32_t)));
1258 if (!properties.props_ptr)
1259 goto err_allocs;
1260 properties.prop_values_ptr = VOID2U64(drmMalloc(count *
1261 sizeof(uint64_t)));
1262 if (!properties.prop_values_ptr)
1263 goto err_allocs;
1264 }
1265
1266 if (drmIoctl(fd, DRM_IOCTL_MODE_OBJ_GETPROPERTIES, &properties))
1267 goto err_allocs;
1268
1269 if (count < properties.count_props) {
1270 drmFree(U642VOID(properties.props_ptr));
1271 drmFree(U642VOID(properties.prop_values_ptr));
1272 goto retry;
1273 }
1274 count = properties.count_props;
1275
1276 ret = drmMalloc(sizeof(*ret));
1277 if (!ret)
1278 goto err_allocs;
1279
1280 ret->count_props = count;
1281 ret->props = drmAllocCpy(U642VOID(properties.props_ptr),
1282 count, sizeof(uint32_t));
1283 ret->prop_values = drmAllocCpy(U642VOID(properties.prop_values_ptr),
1284 count, sizeof(uint64_t));
1285 if (ret->count_props && (!ret->props || !ret->prop_values)) {
1286 drmFree(ret->props);
1287 drmFree(ret->prop_values);
1288 drmFree(ret);
1289 ret = NULL;
1290 }
1291
1292 err_allocs:
1293 drmFree(U642VOID(properties.props_ptr));
1294 drmFree(U642VOID(properties.prop_values_ptr));
1295 return ret;
1296 }
1297
drmModeFreeObjectProperties(drmModeObjectPropertiesPtr ptr)1298 drm_public void drmModeFreeObjectProperties(drmModeObjectPropertiesPtr ptr)
1299 {
1300 if (!ptr)
1301 return;
1302 drmFree(ptr->props);
1303 drmFree(ptr->prop_values);
1304 drmFree(ptr);
1305 }
1306
drmModeObjectSetProperty(int fd,uint32_t object_id,uint32_t object_type,uint32_t property_id,uint64_t value)1307 drm_public int drmModeObjectSetProperty(int fd, uint32_t object_id, uint32_t object_type,
1308 uint32_t property_id, uint64_t value)
1309 {
1310 struct drm_mode_obj_set_property prop;
1311
1312 memclear(prop);
1313 prop.value = value;
1314 prop.prop_id = property_id;
1315 prop.obj_id = object_id;
1316 prop.obj_type = object_type;
1317
1318 return DRM_IOCTL(fd, DRM_IOCTL_MODE_OBJ_SETPROPERTY, &prop);
1319 }
1320
1321 typedef struct _drmModeAtomicReqItem drmModeAtomicReqItem, *drmModeAtomicReqItemPtr;
1322
1323 struct _drmModeAtomicReqItem {
1324 uint32_t object_id;
1325 uint32_t property_id;
1326 uint64_t value;
1327 uint32_t cursor;
1328 };
1329
1330 struct _drmModeAtomicReq {
1331 uint32_t cursor;
1332 uint32_t size_items;
1333 drmModeAtomicReqItemPtr items;
1334 };
1335
drmModeAtomicAlloc(void)1336 drm_public drmModeAtomicReqPtr drmModeAtomicAlloc(void)
1337 {
1338 drmModeAtomicReqPtr req;
1339
1340 req = drmMalloc(sizeof *req);
1341 if (!req)
1342 return NULL;
1343
1344 req->items = NULL;
1345 req->cursor = 0;
1346 req->size_items = 0;
1347
1348 return req;
1349 }
1350
drmModeAtomicDuplicate(drmModeAtomicReqPtr old)1351 drm_public drmModeAtomicReqPtr drmModeAtomicDuplicate(drmModeAtomicReqPtr old)
1352 {
1353 drmModeAtomicReqPtr new;
1354
1355 if (!old)
1356 return NULL;
1357
1358 new = drmMalloc(sizeof *new);
1359 if (!new)
1360 return NULL;
1361
1362 new->cursor = old->cursor;
1363 new->size_items = old->size_items;
1364
1365 if (old->size_items) {
1366 new->items = drmMalloc(old->size_items * sizeof(*new->items));
1367 if (!new->items) {
1368 free(new);
1369 return NULL;
1370 }
1371 memcpy(new->items, old->items,
1372 old->cursor * sizeof(*new->items));
1373 } else {
1374 new->items = NULL;
1375 }
1376
1377 return new;
1378 }
1379
drmModeAtomicMerge(drmModeAtomicReqPtr base,drmModeAtomicReqPtr augment)1380 drm_public int drmModeAtomicMerge(drmModeAtomicReqPtr base,
1381 drmModeAtomicReqPtr augment)
1382 {
1383 uint32_t i;
1384
1385 if (!base)
1386 return -EINVAL;
1387
1388 if (!augment || augment->cursor == 0)
1389 return 0;
1390
1391 if (base->cursor + augment->cursor >= base->size_items) {
1392 drmModeAtomicReqItemPtr new;
1393 int saved_size = base->size_items;
1394
1395 base->size_items = base->cursor + augment->cursor;
1396 new = realloc(base->items,
1397 base->size_items * sizeof(*base->items));
1398 if (!new) {
1399 base->size_items = saved_size;
1400 return -ENOMEM;
1401 }
1402 base->items = new;
1403 }
1404
1405 memcpy(&base->items[base->cursor], augment->items,
1406 augment->cursor * sizeof(*augment->items));
1407 for (i = base->cursor; i < base->cursor + augment->cursor; i++)
1408 base->items[i].cursor = i;
1409 base->cursor += augment->cursor;
1410
1411 return 0;
1412 }
1413
drmModeAtomicGetCursor(drmModeAtomicReqPtr req)1414 drm_public int drmModeAtomicGetCursor(drmModeAtomicReqPtr req)
1415 {
1416 if (!req)
1417 return -EINVAL;
1418 return req->cursor;
1419 }
1420
drmModeAtomicSetCursor(drmModeAtomicReqPtr req,int cursor)1421 drm_public void drmModeAtomicSetCursor(drmModeAtomicReqPtr req, int cursor)
1422 {
1423 if (req)
1424 req->cursor = cursor;
1425 }
1426
drmModeAtomicAddProperty(drmModeAtomicReqPtr req,uint32_t object_id,uint32_t property_id,uint64_t value)1427 drm_public int drmModeAtomicAddProperty(drmModeAtomicReqPtr req,
1428 uint32_t object_id,
1429 uint32_t property_id,
1430 uint64_t value)
1431 {
1432 if (!req)
1433 return -EINVAL;
1434
1435 if (object_id == 0 || property_id == 0)
1436 return -EINVAL;
1437
1438 if (req->cursor >= req->size_items) {
1439 const uint32_t item_size_inc = getpagesize() / sizeof(*req->items);
1440 drmModeAtomicReqItemPtr new;
1441
1442 req->size_items += item_size_inc;
1443 new = realloc(req->items, req->size_items * sizeof(*req->items));
1444 if (!new) {
1445 req->size_items -= item_size_inc;
1446 return -ENOMEM;
1447 }
1448 req->items = new;
1449 }
1450
1451 req->items[req->cursor].object_id = object_id;
1452 req->items[req->cursor].property_id = property_id;
1453 req->items[req->cursor].value = value;
1454 req->items[req->cursor].cursor = req->cursor;
1455 req->cursor++;
1456
1457 return req->cursor;
1458 }
1459
drmModeAtomicFree(drmModeAtomicReqPtr req)1460 drm_public void drmModeAtomicFree(drmModeAtomicReqPtr req)
1461 {
1462 if (!req)
1463 return;
1464
1465 if (req->items)
1466 drmFree(req->items);
1467 drmFree(req);
1468 }
1469
sort_req_list(const void * misc,const void * other)1470 static int sort_req_list(const void *misc, const void *other)
1471 {
1472 const drmModeAtomicReqItem *first = misc;
1473 const drmModeAtomicReqItem *second = other;
1474
1475 if (first->object_id != second->object_id)
1476 return first->object_id - second->object_id;
1477 else if (first->property_id != second->property_id)
1478 return first->property_id - second->property_id;
1479 else
1480 return first->cursor - second->cursor;
1481 }
1482
drmModeAtomicCommit(int fd,drmModeAtomicReqPtr req,uint32_t flags,void * user_data)1483 drm_public int drmModeAtomicCommit(int fd, drmModeAtomicReqPtr req,
1484 uint32_t flags, void *user_data)
1485 {
1486 drmModeAtomicReqPtr sorted;
1487 struct drm_mode_atomic atomic;
1488 uint32_t *objs_ptr = NULL;
1489 uint32_t *count_props_ptr = NULL;
1490 uint32_t *props_ptr = NULL;
1491 uint64_t *prop_values_ptr = NULL;
1492 uint32_t last_obj_id = 0;
1493 uint32_t i;
1494 int obj_idx = -1;
1495 int ret = -1;
1496
1497 if (!req)
1498 return -EINVAL;
1499
1500 if (req->cursor == 0)
1501 return 0;
1502
1503 sorted = drmModeAtomicDuplicate(req);
1504 if (sorted == NULL)
1505 return -ENOMEM;
1506
1507 memclear(atomic);
1508
1509 /* Sort the list by object ID, then by property ID. */
1510 qsort(sorted->items, sorted->cursor, sizeof(*sorted->items),
1511 sort_req_list);
1512
1513 /* Now the list is sorted, eliminate duplicate property sets. */
1514 for (i = 0; i < sorted->cursor; i++) {
1515 if (sorted->items[i].object_id != last_obj_id) {
1516 atomic.count_objs++;
1517 last_obj_id = sorted->items[i].object_id;
1518 }
1519
1520 if (i == sorted->cursor - 1)
1521 continue;
1522
1523 if (sorted->items[i].object_id != sorted->items[i + 1].object_id ||
1524 sorted->items[i].property_id != sorted->items[i + 1].property_id)
1525 continue;
1526
1527 memmove(&sorted->items[i], &sorted->items[i + 1],
1528 (sorted->cursor - i - 1) * sizeof(*sorted->items));
1529 sorted->cursor--;
1530 }
1531
1532 for (i = 0; i < sorted->cursor; i++)
1533 sorted->items[i].cursor = i;
1534
1535 objs_ptr = drmMalloc(atomic.count_objs * sizeof objs_ptr[0]);
1536 if (!objs_ptr) {
1537 errno = ENOMEM;
1538 goto out;
1539 }
1540
1541 count_props_ptr = drmMalloc(atomic.count_objs * sizeof count_props_ptr[0]);
1542 if (!count_props_ptr) {
1543 errno = ENOMEM;
1544 goto out;
1545 }
1546
1547 props_ptr = drmMalloc(sorted->cursor * sizeof props_ptr[0]);
1548 if (!props_ptr) {
1549 errno = ENOMEM;
1550 goto out;
1551 }
1552
1553 prop_values_ptr = drmMalloc(sorted->cursor * sizeof prop_values_ptr[0]);
1554 if (!prop_values_ptr) {
1555 errno = ENOMEM;
1556 goto out;
1557 }
1558
1559 for (i = 0, last_obj_id = 0; i < sorted->cursor; i++) {
1560 if (sorted->items[i].object_id != last_obj_id) {
1561 obj_idx++;
1562 objs_ptr[obj_idx] = sorted->items[i].object_id;
1563 last_obj_id = objs_ptr[obj_idx];
1564 }
1565
1566 count_props_ptr[obj_idx]++;
1567 props_ptr[i] = sorted->items[i].property_id;
1568 prop_values_ptr[i] = sorted->items[i].value;
1569
1570 }
1571
1572 atomic.flags = flags;
1573 atomic.objs_ptr = VOID2U64(objs_ptr);
1574 atomic.count_props_ptr = VOID2U64(count_props_ptr);
1575 atomic.props_ptr = VOID2U64(props_ptr);
1576 atomic.prop_values_ptr = VOID2U64(prop_values_ptr);
1577 atomic.user_data = VOID2U64(user_data);
1578
1579 ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ATOMIC, &atomic);
1580
1581 out:
1582 drmFree(objs_ptr);
1583 drmFree(count_props_ptr);
1584 drmFree(props_ptr);
1585 drmFree(prop_values_ptr);
1586 drmModeAtomicFree(sorted);
1587
1588 return ret;
1589 }
1590
1591 drm_public int
drmModeCreatePropertyBlob(int fd,const void * data,size_t length,uint32_t * id)1592 drmModeCreatePropertyBlob(int fd, const void *data, size_t length,
1593 uint32_t *id)
1594 {
1595 struct drm_mode_create_blob create;
1596 int ret;
1597
1598 if (length >= 0xffffffff)
1599 return -ERANGE;
1600
1601 memclear(create);
1602
1603 create.length = length;
1604 create.data = (uintptr_t) data;
1605 create.blob_id = 0;
1606 *id = 0;
1607
1608 ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_CREATEPROPBLOB, &create);
1609 if (ret != 0)
1610 return ret;
1611
1612 *id = create.blob_id;
1613 return 0;
1614 }
1615
1616 drm_public int
drmModeDestroyPropertyBlob(int fd,uint32_t id)1617 drmModeDestroyPropertyBlob(int fd, uint32_t id)
1618 {
1619 struct drm_mode_destroy_blob destroy;
1620
1621 memclear(destroy);
1622 destroy.blob_id = id;
1623 return DRM_IOCTL(fd, DRM_IOCTL_MODE_DESTROYPROPBLOB, &destroy);
1624 }
1625
1626 drm_public int
drmModeCreateLease(int fd,const uint32_t * objects,int num_objects,int flags,uint32_t * lessee_id)1627 drmModeCreateLease(int fd, const uint32_t *objects, int num_objects, int flags,
1628 uint32_t *lessee_id)
1629 {
1630 struct drm_mode_create_lease create;
1631 int ret;
1632
1633 memclear(create);
1634 create.object_ids = (uintptr_t) objects;
1635 create.object_count = num_objects;
1636 create.flags = flags;
1637
1638 ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_CREATE_LEASE, &create);
1639 if (ret == 0) {
1640 *lessee_id = create.lessee_id;
1641 return create.fd;
1642 }
1643 return -errno;
1644 }
1645
1646 drm_public drmModeLesseeListPtr
drmModeListLessees(int fd)1647 drmModeListLessees(int fd)
1648 {
1649 struct drm_mode_list_lessees list;
1650 uint32_t count;
1651 drmModeLesseeListPtr ret;
1652
1653 memclear(list);
1654
1655 if (DRM_IOCTL(fd, DRM_IOCTL_MODE_LIST_LESSEES, &list))
1656 return NULL;
1657
1658 count = list.count_lessees;
1659 ret = drmMalloc(sizeof (drmModeLesseeListRes) + count * sizeof (ret->lessees[0]));
1660 if (!ret)
1661 return NULL;
1662
1663 list.lessees_ptr = VOID2U64(&ret->lessees[0]);
1664 if (DRM_IOCTL(fd, DRM_IOCTL_MODE_LIST_LESSEES, &list)) {
1665 drmFree(ret);
1666 return NULL;
1667 }
1668
1669 ret->count = count;
1670 return ret;
1671 }
1672
1673 drm_public drmModeObjectListPtr
drmModeGetLease(int fd)1674 drmModeGetLease(int fd)
1675 {
1676 struct drm_mode_get_lease get;
1677 uint32_t count;
1678 drmModeObjectListPtr ret;
1679
1680 memclear(get);
1681
1682 if (DRM_IOCTL(fd, DRM_IOCTL_MODE_GET_LEASE, &get))
1683 return NULL;
1684
1685 count = get.count_objects;
1686 ret = drmMalloc(sizeof (drmModeObjectListRes) + count * sizeof (ret->objects[0]));
1687 if (!ret)
1688 return NULL;
1689
1690 get.objects_ptr = VOID2U64(&ret->objects[0]);
1691 if (DRM_IOCTL(fd, DRM_IOCTL_MODE_GET_LEASE, &get)) {
1692 drmFree(ret);
1693 return NULL;
1694 }
1695
1696 ret->count = count;
1697 return ret;
1698 }
1699
1700 drm_public int
drmModeRevokeLease(int fd,uint32_t lessee_id)1701 drmModeRevokeLease(int fd, uint32_t lessee_id)
1702 {
1703 struct drm_mode_revoke_lease revoke;
1704 int ret;
1705
1706 memclear(revoke);
1707
1708 revoke.lessee_id = lessee_id;
1709
1710 ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_REVOKE_LEASE, &revoke);
1711 if (ret == 0)
1712 return 0;
1713 return -errno;
1714 }
1715
1716 drm_public drmModeFB2Ptr
drmModeGetFB2(int fd,uint32_t fb_id)1717 drmModeGetFB2(int fd, uint32_t fb_id)
1718 {
1719 struct drm_mode_fb_cmd2 get = {
1720 .fb_id = fb_id,
1721 };
1722 drmModeFB2Ptr ret;
1723 int err;
1724
1725 err = DRM_IOCTL(fd, DRM_IOCTL_MODE_GETFB2, &get);
1726 if (err != 0)
1727 return NULL;
1728
1729 ret = drmMalloc(sizeof(drmModeFB2));
1730 if (!ret)
1731 return NULL;
1732
1733 ret->fb_id = fb_id;
1734 ret->width = get.width;
1735 ret->height = get.height;
1736 ret->pixel_format = get.pixel_format;
1737 ret->flags = get.flags;
1738 ret->modifier = get.modifier[0];
1739 memcpy(ret->handles, get.handles, sizeof(uint32_t) * 4);
1740 memcpy(ret->pitches, get.pitches, sizeof(uint32_t) * 4);
1741 memcpy(ret->offsets, get.offsets, sizeof(uint32_t) * 4);
1742
1743 return ret;
1744 }
1745
drmModeFreeFB2(drmModeFB2Ptr ptr)1746 drm_public void drmModeFreeFB2(drmModeFB2Ptr ptr)
1747 {
1748 drmFree(ptr);
1749 }
1750