xf86drmMode.c revision a7d7de1e
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/*
37 * TODO the types we are after are defined in diffrent headers on diffrent
38 * platforms find which headers to include to get uint32_t
39 */
40#include <stdint.h>
41#include <sys/ioctl.h>
42#include <stdio.h>
43
44#ifdef HAVE_CONFIG_H
45#include "config.h"
46#endif
47
48#include "xf86drmMode.h"
49#include "xf86drm.h"
50#include <drm.h>
51#include <string.h>
52#include <dirent.h>
53#include <unistd.h>
54#include <errno.h>
55
56#ifdef HAVE_VALGRIND
57#include <valgrind.h>
58#include <memcheck.h>
59#define VG(x) x
60#else
61#define VG(x)
62#endif
63
64#define VG_CLEAR(s) VG(memset(&s, 0, sizeof(s)))
65
66#define U642VOID(x) ((void *)(unsigned long)(x))
67#define VOID2U64(x) ((uint64_t)(unsigned long)(x))
68
69static inline int DRM_IOCTL(int fd, unsigned long cmd, void *arg)
70{
71	int ret = drmIoctl(fd, cmd, arg);
72	return ret < 0 ? -errno : ret;
73}
74
75/*
76 * Util functions
77 */
78
79void* drmAllocCpy(void *array, int count, int entry_size)
80{
81	char *r;
82	int i;
83
84	if (!count || !array || !entry_size)
85		return 0;
86
87	if (!(r = drmMalloc(count*entry_size)))
88		return 0;
89
90	for (i = 0; i < count; i++)
91		memcpy(r+(entry_size*i), array+(entry_size*i), entry_size);
92
93	return r;
94}
95
96/*
97 * A couple of free functions.
98 */
99
100void drmModeFreeModeInfo(drmModeModeInfoPtr ptr)
101{
102	if (!ptr)
103		return;
104
105	drmFree(ptr);
106}
107
108void drmModeFreeResources(drmModeResPtr ptr)
109{
110	if (!ptr)
111		return;
112
113	drmFree(ptr->fbs);
114	drmFree(ptr->crtcs);
115	drmFree(ptr->connectors);
116	drmFree(ptr->encoders);
117	drmFree(ptr);
118
119}
120
121void drmModeFreeFB(drmModeFBPtr ptr)
122{
123	if (!ptr)
124		return;
125
126	/* we might add more frees later. */
127	drmFree(ptr);
128}
129
130void drmModeFreeCrtc(drmModeCrtcPtr ptr)
131{
132	if (!ptr)
133		return;
134
135	drmFree(ptr);
136
137}
138
139void drmModeFreeConnector(drmModeConnectorPtr ptr)
140{
141	if (!ptr)
142		return;
143
144	drmFree(ptr->encoders);
145	drmFree(ptr->prop_values);
146	drmFree(ptr->props);
147	drmFree(ptr->modes);
148	drmFree(ptr);
149
150}
151
152void drmModeFreeEncoder(drmModeEncoderPtr ptr)
153{
154	drmFree(ptr);
155}
156
157/*
158 * ModeSetting functions.
159 */
160
161drmModeResPtr drmModeGetResources(int fd)
162{
163	struct drm_mode_card_res res, counts;
164	drmModeResPtr r = 0;
165
166retry:
167	memset(&res, 0, sizeof(struct drm_mode_card_res));
168	if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res))
169		return 0;
170
171	counts = res;
172
173	if (res.count_fbs) {
174		res.fb_id_ptr = VOID2U64(drmMalloc(res.count_fbs*sizeof(uint32_t)));
175		if (!res.fb_id_ptr)
176			goto err_allocs;
177	}
178	if (res.count_crtcs) {
179		res.crtc_id_ptr = VOID2U64(drmMalloc(res.count_crtcs*sizeof(uint32_t)));
180		if (!res.crtc_id_ptr)
181			goto err_allocs;
182	}
183	if (res.count_connectors) {
184		res.connector_id_ptr = VOID2U64(drmMalloc(res.count_connectors*sizeof(uint32_t)));
185		if (!res.connector_id_ptr)
186			goto err_allocs;
187	}
188	if (res.count_encoders) {
189		res.encoder_id_ptr = VOID2U64(drmMalloc(res.count_encoders*sizeof(uint32_t)));
190		if (!res.encoder_id_ptr)
191			goto err_allocs;
192	}
193
194	if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res))
195		goto err_allocs;
196
197	/* The number of available connectors and etc may have changed with a
198	 * hotplug event in between the ioctls, in which case the field is
199	 * silently ignored by the kernel.
200	 */
201	if (counts.count_fbs < res.count_fbs ||
202	    counts.count_crtcs < res.count_crtcs ||
203	    counts.count_connectors < res.count_connectors ||
204	    counts.count_encoders < res.count_encoders)
205	{
206		drmFree(U642VOID(res.fb_id_ptr));
207		drmFree(U642VOID(res.crtc_id_ptr));
208		drmFree(U642VOID(res.connector_id_ptr));
209		drmFree(U642VOID(res.encoder_id_ptr));
210
211		goto retry;
212	}
213
214	/*
215	 * return
216	 */
217	if (!(r = drmMalloc(sizeof(*r))))
218		goto err_allocs;
219
220	r->min_width     = res.min_width;
221	r->max_width     = res.max_width;
222	r->min_height    = res.min_height;
223	r->max_height    = res.max_height;
224	r->count_fbs     = res.count_fbs;
225	r->count_crtcs   = res.count_crtcs;
226	r->count_connectors = res.count_connectors;
227	r->count_encoders = res.count_encoders;
228
229	r->fbs        = drmAllocCpy(U642VOID(res.fb_id_ptr), res.count_fbs, sizeof(uint32_t));
230	r->crtcs      = drmAllocCpy(U642VOID(res.crtc_id_ptr), res.count_crtcs, sizeof(uint32_t));
231	r->connectors = drmAllocCpy(U642VOID(res.connector_id_ptr), res.count_connectors, sizeof(uint32_t));
232	r->encoders   = drmAllocCpy(U642VOID(res.encoder_id_ptr), res.count_encoders, sizeof(uint32_t));
233	if ((res.count_fbs && !r->fbs) ||
234	    (res.count_crtcs && !r->crtcs) ||
235	    (res.count_connectors && !r->connectors) ||
236	    (res.count_encoders && !r->encoders))
237	{
238		drmFree(r->fbs);
239		drmFree(r->crtcs);
240		drmFree(r->connectors);
241		drmFree(r->encoders);
242		drmFree(r);
243		r = 0;
244	}
245
246err_allocs:
247	drmFree(U642VOID(res.fb_id_ptr));
248	drmFree(U642VOID(res.crtc_id_ptr));
249	drmFree(U642VOID(res.connector_id_ptr));
250	drmFree(U642VOID(res.encoder_id_ptr));
251
252	return r;
253}
254
255int drmModeAddFB(int fd, uint32_t width, uint32_t height, uint8_t depth,
256                 uint8_t bpp, uint32_t pitch, uint32_t bo_handle,
257		 uint32_t *buf_id)
258{
259	struct drm_mode_fb_cmd f;
260	int ret;
261
262	VG_CLEAR(f);
263	f.width  = width;
264	f.height = height;
265	f.pitch  = pitch;
266	f.bpp    = bpp;
267	f.depth  = depth;
268	f.handle = bo_handle;
269
270	if ((ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ADDFB, &f)))
271		return ret;
272
273	*buf_id = f.fb_id;
274	return 0;
275}
276
277int drmModeAddFB2(int fd, uint32_t width, uint32_t height,
278		  uint32_t pixel_format, uint32_t bo_handles[4],
279		  uint32_t pitches[4], uint32_t offsets[4],
280		  uint32_t *buf_id, uint32_t flags)
281{
282	struct drm_mode_fb_cmd2 f;
283	int ret;
284
285	f.width  = width;
286	f.height = height;
287	f.pixel_format = pixel_format;
288	f.flags = flags;
289	memcpy(f.handles, bo_handles, 4 * sizeof(bo_handles[0]));
290	memcpy(f.pitches, pitches, 4 * sizeof(pitches[0]));
291	memcpy(f.offsets, offsets, 4 * sizeof(offsets[0]));
292
293	if ((ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ADDFB2, &f)))
294		return ret;
295
296	*buf_id = f.fb_id;
297	return 0;
298}
299
300int drmModeRmFB(int fd, uint32_t bufferId)
301{
302	return DRM_IOCTL(fd, DRM_IOCTL_MODE_RMFB, &bufferId);
303
304
305}
306
307drmModeFBPtr drmModeGetFB(int fd, uint32_t buf)
308{
309	struct drm_mode_fb_cmd info;
310	drmModeFBPtr r;
311
312	info.fb_id = buf;
313
314	if (drmIoctl(fd, DRM_IOCTL_MODE_GETFB, &info))
315		return NULL;
316
317	if (!(r = drmMalloc(sizeof(*r))))
318		return NULL;
319
320	r->fb_id = info.fb_id;
321	r->width = info.width;
322	r->height = info.height;
323	r->pitch = info.pitch;
324	r->bpp = info.bpp;
325	r->handle = info.handle;
326	r->depth = info.depth;
327
328	return r;
329}
330
331int drmModeDirtyFB(int fd, uint32_t bufferId,
332		   drmModeClipPtr clips, uint32_t num_clips)
333{
334	struct drm_mode_fb_dirty_cmd dirty = { 0 };
335
336	dirty.fb_id = bufferId;
337	dirty.clips_ptr = VOID2U64(clips);
338	dirty.num_clips = num_clips;
339
340	return DRM_IOCTL(fd, DRM_IOCTL_MODE_DIRTYFB, &dirty);
341}
342
343
344/*
345 * Crtc functions
346 */
347
348drmModeCrtcPtr drmModeGetCrtc(int fd, uint32_t crtcId)
349{
350	struct drm_mode_crtc crtc;
351	drmModeCrtcPtr r;
352
353	VG_CLEAR(crtc);
354	crtc.crtc_id = crtcId;
355
356	if (drmIoctl(fd, DRM_IOCTL_MODE_GETCRTC, &crtc))
357		return 0;
358
359	/*
360	 * return
361	 */
362
363	if (!(r = drmMalloc(sizeof(*r))))
364		return 0;
365
366	r->crtc_id         = crtc.crtc_id;
367	r->x               = crtc.x;
368	r->y               = crtc.y;
369	r->mode_valid      = crtc.mode_valid;
370	if (r->mode_valid) {
371		memcpy(&r->mode, &crtc.mode, sizeof(struct drm_mode_modeinfo));
372		r->width = crtc.mode.hdisplay;
373		r->height = crtc.mode.vdisplay;
374	}
375	r->buffer_id       = crtc.fb_id;
376	r->gamma_size      = crtc.gamma_size;
377	return r;
378}
379
380
381int drmModeSetCrtc(int fd, uint32_t crtcId, uint32_t bufferId,
382                   uint32_t x, uint32_t y, uint32_t *connectors, int count,
383		   drmModeModeInfoPtr mode)
384{
385	struct drm_mode_crtc crtc;
386
387	VG_CLEAR(crtc);
388	crtc.x             = x;
389	crtc.y             = y;
390	crtc.crtc_id       = crtcId;
391	crtc.fb_id         = bufferId;
392	crtc.set_connectors_ptr = VOID2U64(connectors);
393	crtc.count_connectors = count;
394	if (mode) {
395	  memcpy(&crtc.mode, mode, sizeof(struct drm_mode_modeinfo));
396	  crtc.mode_valid = 1;
397	} else
398	  crtc.mode_valid = 0;
399
400	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETCRTC, &crtc);
401}
402
403/*
404 * Cursor manipulation
405 */
406
407int drmModeSetCursor(int fd, uint32_t crtcId, uint32_t bo_handle, uint32_t width, uint32_t height)
408{
409	struct drm_mode_cursor arg;
410
411	arg.flags = DRM_MODE_CURSOR_BO;
412	arg.crtc_id = crtcId;
413	arg.width = width;
414	arg.height = height;
415	arg.handle = bo_handle;
416
417	return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR, &arg);
418}
419
420int drmModeSetCursor2(int fd, uint32_t crtcId, uint32_t bo_handle, uint32_t width, uint32_t height, int32_t hot_x, int32_t hot_y)
421{
422	struct drm_mode_cursor2 arg;
423
424	arg.flags = DRM_MODE_CURSOR_BO;
425	arg.crtc_id = crtcId;
426	arg.width = width;
427	arg.height = height;
428	arg.handle = bo_handle;
429	arg.hot_x = hot_x;
430	arg.hot_y = hot_y;
431
432	return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR2, &arg);
433}
434
435int drmModeMoveCursor(int fd, uint32_t crtcId, int x, int y)
436{
437	struct drm_mode_cursor arg;
438
439	arg.flags = DRM_MODE_CURSOR_MOVE;
440	arg.crtc_id = crtcId;
441	arg.x = x;
442	arg.y = y;
443
444	return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR, &arg);
445}
446
447/*
448 * Encoder get
449 */
450drmModeEncoderPtr drmModeGetEncoder(int fd, uint32_t encoder_id)
451{
452	struct drm_mode_get_encoder enc;
453	drmModeEncoderPtr r = NULL;
454
455	enc.encoder_id = encoder_id;
456	enc.crtc_id = 0;
457	enc.encoder_type = 0;
458	enc.possible_crtcs = 0;
459	enc.possible_clones = 0;
460
461	if (drmIoctl(fd, DRM_IOCTL_MODE_GETENCODER, &enc))
462		return 0;
463
464	if (!(r = drmMalloc(sizeof(*r))))
465		return 0;
466
467	r->encoder_id = enc.encoder_id;
468	r->crtc_id = enc.crtc_id;
469	r->encoder_type = enc.encoder_type;
470	r->possible_crtcs = enc.possible_crtcs;
471	r->possible_clones = enc.possible_clones;
472
473	return r;
474}
475
476/*
477 * Connector manipulation
478 */
479
480drmModeConnectorPtr drmModeGetConnector(int fd, uint32_t connector_id)
481{
482	struct drm_mode_get_connector conn, counts;
483	drmModeConnectorPtr r = NULL;
484
485retry:
486	memset(&conn, 0, sizeof(struct drm_mode_get_connector));
487	conn.connector_id = connector_id;
488
489	if (drmIoctl(fd, DRM_IOCTL_MODE_GETCONNECTOR, &conn))
490		return 0;
491
492	counts = conn;
493
494	if (conn.count_props) {
495		conn.props_ptr = VOID2U64(drmMalloc(conn.count_props*sizeof(uint32_t)));
496		if (!conn.props_ptr)
497			goto err_allocs;
498		conn.prop_values_ptr = VOID2U64(drmMalloc(conn.count_props*sizeof(uint64_t)));
499		if (!conn.prop_values_ptr)
500			goto err_allocs;
501	}
502
503	if (conn.count_modes) {
504		conn.modes_ptr = VOID2U64(drmMalloc(conn.count_modes*sizeof(struct drm_mode_modeinfo)));
505		if (!conn.modes_ptr)
506			goto err_allocs;
507	}
508
509	if (conn.count_encoders) {
510		conn.encoders_ptr = VOID2U64(drmMalloc(conn.count_encoders*sizeof(uint32_t)));
511		if (!conn.encoders_ptr)
512			goto err_allocs;
513	}
514
515	if (drmIoctl(fd, DRM_IOCTL_MODE_GETCONNECTOR, &conn))
516		goto err_allocs;
517
518	/* The number of available connectors and etc may have changed with a
519	 * hotplug event in between the ioctls, in which case the field is
520	 * silently ignored by the kernel.
521	 */
522	if (counts.count_props < conn.count_props ||
523	    counts.count_modes < conn.count_modes ||
524	    counts.count_encoders < conn.count_encoders) {
525		drmFree(U642VOID(conn.props_ptr));
526		drmFree(U642VOID(conn.prop_values_ptr));
527		drmFree(U642VOID(conn.modes_ptr));
528		drmFree(U642VOID(conn.encoders_ptr));
529
530		goto retry;
531	}
532
533	if(!(r = drmMalloc(sizeof(*r)))) {
534		goto err_allocs;
535	}
536
537	r->connector_id = conn.connector_id;
538	r->encoder_id = conn.encoder_id;
539	r->connection   = conn.connection;
540	r->mmWidth      = conn.mm_width;
541	r->mmHeight     = conn.mm_height;
542	/* convert subpixel from kernel to userspace */
543	r->subpixel     = conn.subpixel + 1;
544	r->count_modes  = conn.count_modes;
545	r->count_props  = conn.count_props;
546	r->props        = drmAllocCpy(U642VOID(conn.props_ptr), conn.count_props, sizeof(uint32_t));
547	r->prop_values  = drmAllocCpy(U642VOID(conn.prop_values_ptr), conn.count_props, sizeof(uint64_t));
548	r->modes        = drmAllocCpy(U642VOID(conn.modes_ptr), conn.count_modes, sizeof(struct drm_mode_modeinfo));
549	r->count_encoders = conn.count_encoders;
550	r->encoders     = drmAllocCpy(U642VOID(conn.encoders_ptr), conn.count_encoders, sizeof(uint32_t));
551	r->connector_type  = conn.connector_type;
552	r->connector_type_id = conn.connector_type_id;
553
554	if ((r->count_props && !r->props) ||
555	    (r->count_props && !r->prop_values) ||
556	    (r->count_modes && !r->modes) ||
557	    (r->count_encoders && !r->encoders)) {
558		drmFree(r->props);
559		drmFree(r->prop_values);
560		drmFree(r->modes);
561		drmFree(r->encoders);
562		drmFree(r);
563		r = 0;
564	}
565
566err_allocs:
567	drmFree(U642VOID(conn.prop_values_ptr));
568	drmFree(U642VOID(conn.props_ptr));
569	drmFree(U642VOID(conn.modes_ptr));
570	drmFree(U642VOID(conn.encoders_ptr));
571
572	return r;
573}
574
575int drmModeAttachMode(int fd, uint32_t connector_id, drmModeModeInfoPtr mode_info)
576{
577	struct drm_mode_mode_cmd res;
578
579	memcpy(&res.mode, mode_info, sizeof(struct drm_mode_modeinfo));
580	res.connector_id = connector_id;
581
582	return DRM_IOCTL(fd, DRM_IOCTL_MODE_ATTACHMODE, &res);
583}
584
585int drmModeDetachMode(int fd, uint32_t connector_id, drmModeModeInfoPtr mode_info)
586{
587	struct drm_mode_mode_cmd res;
588
589	memcpy(&res.mode, mode_info, sizeof(struct drm_mode_modeinfo));
590	res.connector_id = connector_id;
591
592	return DRM_IOCTL(fd, DRM_IOCTL_MODE_DETACHMODE, &res);
593}
594
595
596drmModePropertyPtr drmModeGetProperty(int fd, uint32_t property_id)
597{
598	struct drm_mode_get_property prop;
599	drmModePropertyPtr r;
600
601	VG_CLEAR(prop);
602	prop.prop_id = property_id;
603	prop.count_enum_blobs = 0;
604	prop.count_values = 0;
605	prop.flags = 0;
606	prop.enum_blob_ptr = 0;
607	prop.values_ptr = 0;
608
609	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPERTY, &prop))
610		return 0;
611
612	if (prop.count_values)
613		prop.values_ptr = VOID2U64(drmMalloc(prop.count_values * sizeof(uint64_t)));
614
615	if (prop.count_enum_blobs && (prop.flags & (DRM_MODE_PROP_ENUM | DRM_MODE_PROP_BITMASK)))
616		prop.enum_blob_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(struct drm_mode_property_enum)));
617
618	if (prop.count_enum_blobs && (prop.flags & DRM_MODE_PROP_BLOB)) {
619		prop.values_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(uint32_t)));
620		prop.enum_blob_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(uint32_t)));
621	}
622
623	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPERTY, &prop)) {
624		r = NULL;
625		goto err_allocs;
626	}
627
628	if (!(r = drmMalloc(sizeof(*r))))
629		return NULL;
630
631	r->prop_id = prop.prop_id;
632	r->count_values = prop.count_values;
633
634	r->flags = prop.flags;
635	if (prop.count_values)
636		r->values = drmAllocCpy(U642VOID(prop.values_ptr), prop.count_values, sizeof(uint64_t));
637	if (prop.flags & (DRM_MODE_PROP_ENUM | DRM_MODE_PROP_BITMASK)) {
638		r->count_enums = prop.count_enum_blobs;
639		r->enums = drmAllocCpy(U642VOID(prop.enum_blob_ptr), prop.count_enum_blobs, sizeof(struct drm_mode_property_enum));
640	} else if (prop.flags & DRM_MODE_PROP_BLOB) {
641		r->values = drmAllocCpy(U642VOID(prop.values_ptr), prop.count_enum_blobs, sizeof(uint32_t));
642		r->blob_ids = drmAllocCpy(U642VOID(prop.enum_blob_ptr), prop.count_enum_blobs, sizeof(uint32_t));
643		r->count_blobs = prop.count_enum_blobs;
644	}
645	strncpy(r->name, prop.name, DRM_PROP_NAME_LEN);
646	r->name[DRM_PROP_NAME_LEN-1] = 0;
647
648err_allocs:
649	drmFree(U642VOID(prop.values_ptr));
650	drmFree(U642VOID(prop.enum_blob_ptr));
651
652	return r;
653}
654
655void drmModeFreeProperty(drmModePropertyPtr ptr)
656{
657	if (!ptr)
658		return;
659
660	drmFree(ptr->values);
661	drmFree(ptr->enums);
662	drmFree(ptr);
663}
664
665drmModePropertyBlobPtr drmModeGetPropertyBlob(int fd, uint32_t blob_id)
666{
667	struct drm_mode_get_blob blob;
668	drmModePropertyBlobPtr r;
669
670	blob.length = 0;
671	blob.data = 0;
672	blob.blob_id = blob_id;
673
674	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPBLOB, &blob))
675		return NULL;
676
677	if (blob.length)
678		blob.data = VOID2U64(drmMalloc(blob.length));
679
680	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPBLOB, &blob)) {
681		r = NULL;
682		goto err_allocs;
683	}
684
685	if (!(r = drmMalloc(sizeof(*r))))
686		goto err_allocs;
687
688	r->id = blob.blob_id;
689	r->length = blob.length;
690	r->data = drmAllocCpy(U642VOID(blob.data), 1, blob.length);
691
692err_allocs:
693	drmFree(U642VOID(blob.data));
694	return r;
695}
696
697void drmModeFreePropertyBlob(drmModePropertyBlobPtr ptr)
698{
699	if (!ptr)
700		return;
701
702	drmFree(ptr->data);
703	drmFree(ptr);
704}
705
706int drmModeConnectorSetProperty(int fd, uint32_t connector_id, uint32_t property_id,
707			     uint64_t value)
708{
709	struct drm_mode_connector_set_property osp;
710
711	osp.connector_id = connector_id;
712	osp.prop_id = property_id;
713	osp.value = value;
714
715	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETPROPERTY, &osp);
716}
717
718/*
719 * checks if a modesetting capable driver has attached to the pci id
720 * returns 0 if modesetting supported.
721 *  -EINVAL or invalid bus id
722 *  -ENOSYS if no modesetting support
723*/
724int drmCheckModesettingSupported(const char *busid)
725{
726#if defined (__linux__)
727	char pci_dev_dir[1024];
728	int domain, bus, dev, func;
729	DIR *sysdir;
730	struct dirent *dent;
731	int found = 0, ret;
732
733	ret = sscanf(busid, "pci:%04x:%02x:%02x.%d", &domain, &bus, &dev, &func);
734	if (ret != 4)
735		return -EINVAL;
736
737	sprintf(pci_dev_dir, "/sys/bus/pci/devices/%04x:%02x:%02x.%d/drm",
738		domain, bus, dev, func);
739
740	sysdir = opendir(pci_dev_dir);
741	if (sysdir) {
742		dent = readdir(sysdir);
743		while (dent) {
744			if (!strncmp(dent->d_name, "controlD", 8)) {
745				found = 1;
746				break;
747			}
748
749			dent = readdir(sysdir);
750		}
751		closedir(sysdir);
752		if (found)
753			return 0;
754	}
755
756	sprintf(pci_dev_dir, "/sys/bus/pci/devices/%04x:%02x:%02x.%d/",
757		domain, bus, dev, func);
758
759	sysdir = opendir(pci_dev_dir);
760	if (!sysdir)
761		return -EINVAL;
762
763	dent = readdir(sysdir);
764	while (dent) {
765		if (!strncmp(dent->d_name, "drm:controlD", 12)) {
766			found = 1;
767			break;
768		}
769
770		dent = readdir(sysdir);
771	}
772
773	closedir(sysdir);
774	if (found)
775		return 0;
776#elif defined (__FreeBSD__) || defined (__FreeBSD_kernel__)
777	char kbusid[1024], sbusid[1024];
778	char oid[128];
779	int domain, bus, dev, func;
780	int i, modesetting, ret;
781	size_t len;
782
783	ret = sscanf(busid, "pci:%04x:%02x:%02x.%d", &domain, &bus, &dev,
784	    &func);
785	if (ret != 4)
786		return -EINVAL;
787	snprintf(kbusid, sizeof(kbusid), "pci:%04x:%02x:%02x.%d", domain, bus,
788	    dev, func);
789
790	/* How many GPUs do we expect in the machine ? */
791	for (i = 0; i < 16; i++) {
792		snprintf(oid, sizeof(oid), "hw.dri.%d.busid", i);
793		len = sizeof(sbusid);
794		ret = sysctlbyname(oid, sbusid, &len, NULL, 0);
795		if (ret == -1) {
796			if (errno == ENOENT)
797				continue;
798			return -EINVAL;
799		}
800		if (strcmp(sbusid, kbusid) != 0)
801			continue;
802		snprintf(oid, sizeof(oid), "hw.dri.%d.modesetting", i);
803		len = sizeof(modesetting);
804		ret = sysctlbyname(oid, &modesetting, &len, NULL, 0);
805		if (ret == -1 || len != sizeof(modesetting))
806			return -EINVAL;
807		return (modesetting ? 0 : -ENOSYS);
808	}
809#else
810	int fd;
811	static const struct drm_mode_card_res zero_res;
812	struct drm_mode_card_res res = zero_res;
813	int ret;
814
815	fd = drmOpen(NULL, busid);
816	if (fd == -1)
817		return -EINVAL;
818	ret = drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res);
819	drmClose(fd);
820	if (ret == 0)
821		return 0;
822#endif
823	return -ENOSYS;
824
825}
826
827int drmModeCrtcGetGamma(int fd, uint32_t crtc_id, uint32_t size,
828			uint16_t *red, uint16_t *green, uint16_t *blue)
829{
830	struct drm_mode_crtc_lut l;
831
832	l.crtc_id = crtc_id;
833	l.gamma_size = size;
834	l.red = VOID2U64(red);
835	l.green = VOID2U64(green);
836	l.blue = VOID2U64(blue);
837
838	return DRM_IOCTL(fd, DRM_IOCTL_MODE_GETGAMMA, &l);
839}
840
841int drmModeCrtcSetGamma(int fd, uint32_t crtc_id, uint32_t size,
842			uint16_t *red, uint16_t *green, uint16_t *blue)
843{
844	struct drm_mode_crtc_lut l;
845
846	l.crtc_id = crtc_id;
847	l.gamma_size = size;
848	l.red = VOID2U64(red);
849	l.green = VOID2U64(green);
850	l.blue = VOID2U64(blue);
851
852	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETGAMMA, &l);
853}
854
855int drmHandleEvent(int fd, drmEventContextPtr evctx)
856{
857	char buffer[1024];
858	int len, i;
859	struct drm_event *e;
860	struct drm_event_vblank *vblank;
861
862	/* The DRM read semantics guarantees that we always get only
863	 * complete events. */
864
865	len = read(fd, buffer, sizeof buffer);
866	if (len == 0)
867		return 0;
868	if (len < sizeof *e)
869		return -1;
870
871	i = 0;
872	while (i < len) {
873		e = (struct drm_event *) &buffer[i];
874		switch (e->type) {
875		case DRM_EVENT_VBLANK:
876			if (evctx->version < 1 ||
877			    evctx->vblank_handler == NULL)
878				break;
879			vblank = (struct drm_event_vblank *) e;
880			evctx->vblank_handler(fd,
881					      vblank->sequence,
882					      vblank->tv_sec,
883					      vblank->tv_usec,
884					      U642VOID (vblank->user_data));
885			break;
886		case DRM_EVENT_FLIP_COMPLETE:
887			if (evctx->version < 2 ||
888			    evctx->page_flip_handler == NULL)
889				break;
890			vblank = (struct drm_event_vblank *) e;
891			evctx->page_flip_handler(fd,
892						 vblank->sequence,
893						 vblank->tv_sec,
894						 vblank->tv_usec,
895						 U642VOID (vblank->user_data));
896			break;
897		default:
898			break;
899		}
900		i += e->length;
901	}
902
903	return 0;
904}
905
906int drmModePageFlip(int fd, uint32_t crtc_id, uint32_t fb_id,
907		    uint32_t flags, void *user_data)
908{
909	struct drm_mode_crtc_page_flip flip;
910
911	flip.fb_id = fb_id;
912	flip.crtc_id = crtc_id;
913	flip.user_data = VOID2U64(user_data);
914	flip.flags = flags;
915	flip.reserved = 0;
916
917	return DRM_IOCTL(fd, DRM_IOCTL_MODE_PAGE_FLIP, &flip);
918}
919
920int drmModeSetPlane(int fd, uint32_t plane_id, uint32_t crtc_id,
921		    uint32_t fb_id, uint32_t flags,
922		    int32_t crtc_x, int32_t crtc_y,
923		    uint32_t crtc_w, uint32_t crtc_h,
924		    uint32_t src_x, uint32_t src_y,
925		    uint32_t src_w, uint32_t src_h)
926
927{
928	struct drm_mode_set_plane s;
929
930	s.plane_id = plane_id;
931	s.crtc_id = crtc_id;
932	s.fb_id = fb_id;
933	s.flags = flags;
934	s.crtc_x = crtc_x;
935	s.crtc_y = crtc_y;
936	s.crtc_w = crtc_w;
937	s.crtc_h = crtc_h;
938	s.src_x = src_x;
939	s.src_y = src_y;
940	s.src_w = src_w;
941	s.src_h = src_h;
942
943	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETPLANE, &s);
944}
945
946
947drmModePlanePtr drmModeGetPlane(int fd, uint32_t plane_id)
948{
949	struct drm_mode_get_plane ovr, counts;
950	drmModePlanePtr r = 0;
951
952retry:
953	memset(&ovr, 0, sizeof(struct drm_mode_get_plane));
954	ovr.plane_id = plane_id;
955	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANE, &ovr))
956		return 0;
957
958	counts = ovr;
959
960	if (ovr.count_format_types) {
961		ovr.format_type_ptr = VOID2U64(drmMalloc(ovr.count_format_types *
962							 sizeof(uint32_t)));
963		if (!ovr.format_type_ptr)
964			goto err_allocs;
965	}
966
967	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANE, &ovr))
968		goto err_allocs;
969
970	if (counts.count_format_types < ovr.count_format_types) {
971		drmFree(U642VOID(ovr.format_type_ptr));
972		goto retry;
973	}
974
975	if (!(r = drmMalloc(sizeof(*r))))
976		goto err_allocs;
977
978	r->count_formats = ovr.count_format_types;
979	r->plane_id = ovr.plane_id;
980	r->crtc_id = ovr.crtc_id;
981	r->fb_id = ovr.fb_id;
982	r->possible_crtcs = ovr.possible_crtcs;
983	r->gamma_size = ovr.gamma_size;
984	r->formats = drmAllocCpy(U642VOID(ovr.format_type_ptr),
985				 ovr.count_format_types, sizeof(uint32_t));
986	if (ovr.count_format_types && !r->formats) {
987		drmFree(r->formats);
988		drmFree(r);
989		r = 0;
990	}
991
992err_allocs:
993	drmFree(U642VOID(ovr.format_type_ptr));
994
995	return r;
996}
997
998void drmModeFreePlane(drmModePlanePtr ptr)
999{
1000	if (!ptr)
1001		return;
1002
1003	drmFree(ptr->formats);
1004	drmFree(ptr);
1005}
1006
1007drmModePlaneResPtr drmModeGetPlaneResources(int fd)
1008{
1009	struct drm_mode_get_plane_res res, counts;
1010	drmModePlaneResPtr r = 0;
1011
1012retry:
1013	memset(&res, 0, sizeof(struct drm_mode_get_plane_res));
1014	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANERESOURCES, &res))
1015		return 0;
1016
1017	counts = res;
1018
1019	if (res.count_planes) {
1020		res.plane_id_ptr = VOID2U64(drmMalloc(res.count_planes *
1021							sizeof(uint32_t)));
1022		if (!res.plane_id_ptr)
1023			goto err_allocs;
1024	}
1025
1026	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANERESOURCES, &res))
1027		goto err_allocs;
1028
1029	if (counts.count_planes < res.count_planes) {
1030		drmFree(U642VOID(res.plane_id_ptr));
1031		goto retry;
1032	}
1033
1034	if (!(r = drmMalloc(sizeof(*r))))
1035		goto err_allocs;
1036
1037	r->count_planes = res.count_planes;
1038	r->planes = drmAllocCpy(U642VOID(res.plane_id_ptr),
1039				  res.count_planes, sizeof(uint32_t));
1040	if (res.count_planes && !r->planes) {
1041		drmFree(r->planes);
1042		drmFree(r);
1043		r = 0;
1044	}
1045
1046err_allocs:
1047	drmFree(U642VOID(res.plane_id_ptr));
1048
1049	return r;
1050}
1051
1052void drmModeFreePlaneResources(drmModePlaneResPtr ptr)
1053{
1054	if (!ptr)
1055		return;
1056
1057	drmFree(ptr->planes);
1058	drmFree(ptr);
1059}
1060
1061drmModeObjectPropertiesPtr drmModeObjectGetProperties(int fd,
1062						      uint32_t object_id,
1063						      uint32_t object_type)
1064{
1065	struct drm_mode_obj_get_properties properties;
1066	drmModeObjectPropertiesPtr ret = NULL;
1067	uint32_t count;
1068
1069retry:
1070	memset(&properties, 0, sizeof(struct drm_mode_obj_get_properties));
1071	properties.obj_id = object_id;
1072	properties.obj_type = object_type;
1073
1074	if (drmIoctl(fd, DRM_IOCTL_MODE_OBJ_GETPROPERTIES, &properties))
1075		return 0;
1076
1077	count = properties.count_props;
1078
1079	if (count) {
1080		properties.props_ptr = VOID2U64(drmMalloc(count *
1081							  sizeof(uint32_t)));
1082		if (!properties.props_ptr)
1083			goto err_allocs;
1084		properties.prop_values_ptr = VOID2U64(drmMalloc(count *
1085						      sizeof(uint64_t)));
1086		if (!properties.prop_values_ptr)
1087			goto err_allocs;
1088	}
1089
1090	if (drmIoctl(fd, DRM_IOCTL_MODE_OBJ_GETPROPERTIES, &properties))
1091		goto err_allocs;
1092
1093	if (count < properties.count_props) {
1094		drmFree(U642VOID(properties.props_ptr));
1095		drmFree(U642VOID(properties.prop_values_ptr));
1096		goto retry;
1097	}
1098	count = properties.count_props;
1099
1100	ret = drmMalloc(sizeof(*ret));
1101	if (!ret)
1102		goto err_allocs;
1103
1104	ret->count_props = count;
1105	ret->props = drmAllocCpy(U642VOID(properties.props_ptr),
1106				 count, sizeof(uint32_t));
1107	ret->prop_values = drmAllocCpy(U642VOID(properties.prop_values_ptr),
1108				       count, sizeof(uint64_t));
1109	if (ret->count_props && (!ret->props || !ret->prop_values)) {
1110		drmFree(ret->props);
1111		drmFree(ret->prop_values);
1112		drmFree(ret);
1113		ret = NULL;
1114	}
1115
1116err_allocs:
1117	drmFree(U642VOID(properties.props_ptr));
1118	drmFree(U642VOID(properties.prop_values_ptr));
1119	return ret;
1120}
1121
1122void drmModeFreeObjectProperties(drmModeObjectPropertiesPtr ptr)
1123{
1124	if (!ptr)
1125		return;
1126	drmFree(ptr->props);
1127	drmFree(ptr->prop_values);
1128	drmFree(ptr);
1129}
1130
1131int drmModeObjectSetProperty(int fd, uint32_t object_id, uint32_t object_type,
1132			     uint32_t property_id, uint64_t value)
1133{
1134	struct drm_mode_obj_set_property prop;
1135
1136	prop.value = value;
1137	prop.prop_id = property_id;
1138	prop.obj_id = object_id;
1139	prop.obj_type = object_type;
1140
1141	return DRM_IOCTL(fd, DRM_IOCTL_MODE_OBJ_SETPROPERTY, &prop);
1142}
1143