xf86drmMode.c revision adfa0b0c
122944501Smrg/*
222944501Smrg * \file xf86drmMode.c
322944501Smrg * Header for DRM modesetting interface.
422944501Smrg *
522944501Smrg * \author Jakob Bornecrantz <wallbraker@gmail.com>
622944501Smrg *
722944501Smrg * \par Acknowledgements:
822944501Smrg * Feb 2007, Dave Airlie <airlied@linux.ie>
922944501Smrg */
1022944501Smrg
1122944501Smrg/*
1222944501Smrg * Copyright (c) 2007-2008 Tungsten Graphics, Inc., Cedar Park, Texas.
1322944501Smrg * Copyright (c) 2007-2008 Dave Airlie <airlied@linux.ie>
1422944501Smrg * Copyright (c) 2007-2008 Jakob Bornecrantz <wallbraker@gmail.com>
1522944501Smrg *
1622944501Smrg * Permission is hereby granted, free of charge, to any person obtaining a
1722944501Smrg * copy of this software and associated documentation files (the "Software"),
1822944501Smrg * to deal in the Software without restriction, including without limitation
1922944501Smrg * the rights to use, copy, modify, merge, publish, distribute, sublicense,
2022944501Smrg * and/or sell copies of the Software, and to permit persons to whom the
2122944501Smrg * Software is furnished to do so, subject to the following conditions:
2222944501Smrg *
2322944501Smrg * The above copyright notice and this permission notice shall be included in
2422944501Smrg * all copies or substantial portions of the Software.
2522944501Smrg *
2622944501Smrg * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
2722944501Smrg * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
2822944501Smrg * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
2922944501Smrg * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
3022944501Smrg * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
3122944501Smrg * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
3222944501Smrg * IN THE SOFTWARE.
3322944501Smrg *
3422944501Smrg */
3522944501Smrg
36adfa0b0cSmrg#include <assert.h>
37424e9256Smrg#include <limits.h>
38424e9256Smrg#include <stdint.h>
39424e9256Smrg#include <stdlib.h>
40424e9256Smrg#include <sys/ioctl.h>
4187bf8e7cSmrg#if HAVE_SYS_SYSCTL_H
42636d5e9fSmrg#ifdef __FreeBSD__
43636d5e9fSmrg#include <sys/types.h>
44636d5e9fSmrg#endif
45fe517fc9Smrg#include <sys/sysctl.h>
46fe517fc9Smrg#endif
47424e9256Smrg#include <stdio.h>
48424e9256Smrg#include <stdbool.h>
49424e9256Smrg
506260e5d5Smrg#include "libdrm_macros.h"
5122944501Smrg#include "xf86drmMode.h"
5222944501Smrg#include "xf86drm.h"
5322944501Smrg#include <drm.h>
54adfa0b0cSmrg#include <drm_fourcc.h>
5522944501Smrg#include <string.h>
5622944501Smrg#include <dirent.h>
5722944501Smrg#include <unistd.h>
5822944501Smrg#include <errno.h>
5922944501Smrg
60424e9256Smrg#define memclear(s) memset(&s, 0, sizeof(s))
61e88f27b3Smrg
6222944501Smrg#define U642VOID(x) ((void *)(unsigned long)(x))
6322944501Smrg#define VOID2U64(x) ((uint64_t)(unsigned long)(x))
6422944501Smrg
65e88f27b3Smrgstatic inline int DRM_IOCTL(int fd, unsigned long cmd, void *arg)
66d049871aSmrg{
67d049871aSmrg	int ret = drmIoctl(fd, cmd, arg);
68d049871aSmrg	return ret < 0 ? -errno : ret;
69d049871aSmrg}
70d049871aSmrg
7122944501Smrg/*
7222944501Smrg * Util functions
7322944501Smrg */
7422944501Smrg
75424e9256Smrgstatic void* drmAllocCpy(char *array, int count, int entry_size)
7622944501Smrg{
7722944501Smrg	char *r;
7822944501Smrg	int i;
7922944501Smrg
8022944501Smrg	if (!count || !array || !entry_size)
8122944501Smrg		return 0;
8222944501Smrg
8322944501Smrg	if (!(r = drmMalloc(count*entry_size)))
8422944501Smrg		return 0;
8522944501Smrg
8622944501Smrg	for (i = 0; i < count; i++)
8722944501Smrg		memcpy(r+(entry_size*i), array+(entry_size*i), entry_size);
8822944501Smrg
8922944501Smrg	return r;
9022944501Smrg}
9122944501Smrg
9222944501Smrg/*
9322944501Smrg * A couple of free functions.
9422944501Smrg */
9522944501Smrg
966260e5d5Smrgdrm_public void drmModeFreeModeInfo(drmModeModeInfoPtr ptr)
9722944501Smrg{
9822944501Smrg	if (!ptr)
9922944501Smrg		return;
10022944501Smrg
10122944501Smrg	drmFree(ptr);
10222944501Smrg}
10322944501Smrg
1046260e5d5Smrgdrm_public void drmModeFreeResources(drmModeResPtr ptr)
10522944501Smrg{
10622944501Smrg	if (!ptr)
10722944501Smrg		return;
10822944501Smrg
109e88f27b3Smrg	drmFree(ptr->fbs);
110e88f27b3Smrg	drmFree(ptr->crtcs);
111e88f27b3Smrg	drmFree(ptr->connectors);
112e88f27b3Smrg	drmFree(ptr->encoders);
11322944501Smrg	drmFree(ptr);
11422944501Smrg}
11522944501Smrg
1166260e5d5Smrgdrm_public void drmModeFreeFB(drmModeFBPtr ptr)
11722944501Smrg{
11822944501Smrg	if (!ptr)
11922944501Smrg		return;
12022944501Smrg
12122944501Smrg	/* we might add more frees later. */
12222944501Smrg	drmFree(ptr);
12322944501Smrg}
12422944501Smrg
1256260e5d5Smrgdrm_public void drmModeFreeCrtc(drmModeCrtcPtr ptr)
12622944501Smrg{
12722944501Smrg	if (!ptr)
12822944501Smrg		return;
12922944501Smrg
13022944501Smrg	drmFree(ptr);
13122944501Smrg}
13222944501Smrg
1336260e5d5Smrgdrm_public void drmModeFreeConnector(drmModeConnectorPtr ptr)
13422944501Smrg{
13522944501Smrg	if (!ptr)
13622944501Smrg		return;
13722944501Smrg
13822944501Smrg	drmFree(ptr->encoders);
13922944501Smrg	drmFree(ptr->prop_values);
14022944501Smrg	drmFree(ptr->props);
14122944501Smrg	drmFree(ptr->modes);
14222944501Smrg	drmFree(ptr);
14322944501Smrg}
14422944501Smrg
1456260e5d5Smrgdrm_public void drmModeFreeEncoder(drmModeEncoderPtr ptr)
14622944501Smrg{
14722944501Smrg	drmFree(ptr);
14822944501Smrg}
14922944501Smrg
15022944501Smrg/*
15122944501Smrg * ModeSetting functions.
15222944501Smrg */
15322944501Smrg
1544b3d3f37Smrgdrm_public int drmIsKMS(int fd)
1554b3d3f37Smrg{
1564b3d3f37Smrg	struct drm_mode_card_res res = {0};
1574b3d3f37Smrg
1584b3d3f37Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res) != 0)
1594b3d3f37Smrg		return 0;
1604b3d3f37Smrg
1614b3d3f37Smrg	return res.count_crtcs > 0 && res.count_connectors > 0 && res.count_encoders > 0;
1624b3d3f37Smrg}
1634b3d3f37Smrg
1646260e5d5Smrgdrm_public drmModeResPtr drmModeGetResources(int fd)
16522944501Smrg{
16622944501Smrg	struct drm_mode_card_res res, counts;
16722944501Smrg	drmModeResPtr r = 0;
16822944501Smrg
16922944501Smrgretry:
170424e9256Smrg	memclear(res);
17122944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res))
17222944501Smrg		return 0;
17322944501Smrg
17422944501Smrg	counts = res;
17522944501Smrg
17622944501Smrg	if (res.count_fbs) {
17722944501Smrg		res.fb_id_ptr = VOID2U64(drmMalloc(res.count_fbs*sizeof(uint32_t)));
17822944501Smrg		if (!res.fb_id_ptr)
17922944501Smrg			goto err_allocs;
18022944501Smrg	}
18122944501Smrg	if (res.count_crtcs) {
18222944501Smrg		res.crtc_id_ptr = VOID2U64(drmMalloc(res.count_crtcs*sizeof(uint32_t)));
18322944501Smrg		if (!res.crtc_id_ptr)
18422944501Smrg			goto err_allocs;
18522944501Smrg	}
18622944501Smrg	if (res.count_connectors) {
18722944501Smrg		res.connector_id_ptr = VOID2U64(drmMalloc(res.count_connectors*sizeof(uint32_t)));
18822944501Smrg		if (!res.connector_id_ptr)
18922944501Smrg			goto err_allocs;
19022944501Smrg	}
19122944501Smrg	if (res.count_encoders) {
19222944501Smrg		res.encoder_id_ptr = VOID2U64(drmMalloc(res.count_encoders*sizeof(uint32_t)));
19322944501Smrg		if (!res.encoder_id_ptr)
19422944501Smrg			goto err_allocs;
19522944501Smrg	}
19622944501Smrg
19722944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res))
19822944501Smrg		goto err_allocs;
19922944501Smrg
20022944501Smrg	/* The number of available connectors and etc may have changed with a
20122944501Smrg	 * hotplug event in between the ioctls, in which case the field is
20222944501Smrg	 * silently ignored by the kernel.
20322944501Smrg	 */
20422944501Smrg	if (counts.count_fbs < res.count_fbs ||
20522944501Smrg	    counts.count_crtcs < res.count_crtcs ||
20622944501Smrg	    counts.count_connectors < res.count_connectors ||
20722944501Smrg	    counts.count_encoders < res.count_encoders)
20822944501Smrg	{
20922944501Smrg		drmFree(U642VOID(res.fb_id_ptr));
21022944501Smrg		drmFree(U642VOID(res.crtc_id_ptr));
21122944501Smrg		drmFree(U642VOID(res.connector_id_ptr));
21222944501Smrg		drmFree(U642VOID(res.encoder_id_ptr));
21322944501Smrg
21422944501Smrg		goto retry;
21522944501Smrg	}
21622944501Smrg
21722944501Smrg	/*
21822944501Smrg	 * return
21922944501Smrg	 */
22022944501Smrg	if (!(r = drmMalloc(sizeof(*r))))
22122944501Smrg		goto err_allocs;
22222944501Smrg
22322944501Smrg	r->min_width     = res.min_width;
22422944501Smrg	r->max_width     = res.max_width;
22522944501Smrg	r->min_height    = res.min_height;
22622944501Smrg	r->max_height    = res.max_height;
22722944501Smrg	r->count_fbs     = res.count_fbs;
22822944501Smrg	r->count_crtcs   = res.count_crtcs;
22922944501Smrg	r->count_connectors = res.count_connectors;
23022944501Smrg	r->count_encoders = res.count_encoders;
23122944501Smrg
23222944501Smrg	r->fbs        = drmAllocCpy(U642VOID(res.fb_id_ptr), res.count_fbs, sizeof(uint32_t));
23322944501Smrg	r->crtcs      = drmAllocCpy(U642VOID(res.crtc_id_ptr), res.count_crtcs, sizeof(uint32_t));
23422944501Smrg	r->connectors = drmAllocCpy(U642VOID(res.connector_id_ptr), res.count_connectors, sizeof(uint32_t));
23522944501Smrg	r->encoders   = drmAllocCpy(U642VOID(res.encoder_id_ptr), res.count_encoders, sizeof(uint32_t));
23622944501Smrg	if ((res.count_fbs && !r->fbs) ||
23722944501Smrg	    (res.count_crtcs && !r->crtcs) ||
23822944501Smrg	    (res.count_connectors && !r->connectors) ||
23922944501Smrg	    (res.count_encoders && !r->encoders))
24022944501Smrg	{
24122944501Smrg		drmFree(r->fbs);
24222944501Smrg		drmFree(r->crtcs);
24322944501Smrg		drmFree(r->connectors);
24422944501Smrg		drmFree(r->encoders);
24522944501Smrg		drmFree(r);
24622944501Smrg		r = 0;
24722944501Smrg	}
24822944501Smrg
24922944501Smrgerr_allocs:
25022944501Smrg	drmFree(U642VOID(res.fb_id_ptr));
25122944501Smrg	drmFree(U642VOID(res.crtc_id_ptr));
25222944501Smrg	drmFree(U642VOID(res.connector_id_ptr));
25322944501Smrg	drmFree(U642VOID(res.encoder_id_ptr));
25422944501Smrg
25522944501Smrg	return r;
25622944501Smrg}
25722944501Smrg
2586260e5d5Smrg
2596260e5d5Smrgdrm_public int drmModeAddFB(int fd, uint32_t width, uint32_t height, uint8_t depth,
2606260e5d5Smrg                            uint8_t bpp, uint32_t pitch, uint32_t bo_handle,
2616260e5d5Smrg                            uint32_t *buf_id)
26222944501Smrg{
26322944501Smrg	struct drm_mode_fb_cmd f;
26422944501Smrg	int ret;
26522944501Smrg
266424e9256Smrg	memclear(f);
26722944501Smrg	f.width  = width;
26822944501Smrg	f.height = height;
26922944501Smrg	f.pitch  = pitch;
27022944501Smrg	f.bpp    = bpp;
27122944501Smrg	f.depth  = depth;
27222944501Smrg	f.handle = bo_handle;
27322944501Smrg
274d049871aSmrg	if ((ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ADDFB, &f)))
27522944501Smrg		return ret;
27622944501Smrg
27722944501Smrg	*buf_id = f.fb_id;
27822944501Smrg	return 0;
27922944501Smrg}
28022944501Smrg
2816260e5d5Smrgdrm_public int drmModeAddFB2WithModifiers(int fd, uint32_t width,
2826260e5d5Smrg		uint32_t height, uint32_t pixel_format, const uint32_t bo_handles[4],
2836260e5d5Smrg		const uint32_t pitches[4], const uint32_t offsets[4],
2846260e5d5Smrg		const uint64_t modifier[4], uint32_t *buf_id, uint32_t flags)
285e88f27b3Smrg{
286e88f27b3Smrg	struct drm_mode_fb_cmd2 f;
287e88f27b3Smrg	int ret;
288e88f27b3Smrg
289424e9256Smrg	memclear(f);
290e88f27b3Smrg	f.width  = width;
291e88f27b3Smrg	f.height = height;
292e88f27b3Smrg	f.pixel_format = pixel_format;
293e88f27b3Smrg	f.flags = flags;
294e88f27b3Smrg	memcpy(f.handles, bo_handles, 4 * sizeof(bo_handles[0]));
295e88f27b3Smrg	memcpy(f.pitches, pitches, 4 * sizeof(pitches[0]));
296e88f27b3Smrg	memcpy(f.offsets, offsets, 4 * sizeof(offsets[0]));
297636d5e9fSmrg	if (modifier)
2982ee35494Smrg		memcpy(f.modifier, modifier, 4 * sizeof(modifier[0]));
299e88f27b3Smrg
300e88f27b3Smrg	if ((ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ADDFB2, &f)))
301e88f27b3Smrg		return ret;
302e88f27b3Smrg
303e88f27b3Smrg	*buf_id = f.fb_id;
304e88f27b3Smrg	return 0;
305e88f27b3Smrg}
306e88f27b3Smrg
3076260e5d5Smrgdrm_public int drmModeAddFB2(int fd, uint32_t width, uint32_t height,
3086260e5d5Smrg		uint32_t pixel_format, const uint32_t bo_handles[4],
3096260e5d5Smrg		const uint32_t pitches[4], const uint32_t offsets[4],
3106260e5d5Smrg		uint32_t *buf_id, uint32_t flags)
3112ee35494Smrg{
3122ee35494Smrg	return drmModeAddFB2WithModifiers(fd, width, height,
3132ee35494Smrg					  pixel_format, bo_handles,
3142ee35494Smrg					  pitches, offsets, NULL,
3152ee35494Smrg					  buf_id, flags);
3162ee35494Smrg}
3172ee35494Smrg
3186260e5d5Smrgdrm_public int drmModeRmFB(int fd, uint32_t bufferId)
31922944501Smrg{
320d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_RMFB, &bufferId);
32122944501Smrg}
32222944501Smrg
3236260e5d5Smrgdrm_public drmModeFBPtr drmModeGetFB(int fd, uint32_t buf)
32422944501Smrg{
32522944501Smrg	struct drm_mode_fb_cmd info;
32622944501Smrg	drmModeFBPtr r;
32722944501Smrg
328424e9256Smrg	memclear(info);
32922944501Smrg	info.fb_id = buf;
33022944501Smrg
33122944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETFB, &info))
33222944501Smrg		return NULL;
33322944501Smrg
33422944501Smrg	if (!(r = drmMalloc(sizeof(*r))))
33522944501Smrg		return NULL;
33622944501Smrg
33722944501Smrg	r->fb_id = info.fb_id;
33822944501Smrg	r->width = info.width;
33922944501Smrg	r->height = info.height;
34022944501Smrg	r->pitch = info.pitch;
34122944501Smrg	r->bpp = info.bpp;
34222944501Smrg	r->handle = info.handle;
34322944501Smrg	r->depth = info.depth;
34422944501Smrg
34522944501Smrg	return r;
34622944501Smrg}
34722944501Smrg
3486260e5d5Smrgdrm_public int drmModeDirtyFB(int fd, uint32_t bufferId,
34922944501Smrg		   drmModeClipPtr clips, uint32_t num_clips)
35022944501Smrg{
351424e9256Smrg	struct drm_mode_fb_dirty_cmd dirty;
35222944501Smrg
353424e9256Smrg	memclear(dirty);
35422944501Smrg	dirty.fb_id = bufferId;
35522944501Smrg	dirty.clips_ptr = VOID2U64(clips);
35622944501Smrg	dirty.num_clips = num_clips;
35722944501Smrg
358d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_DIRTYFB, &dirty);
35922944501Smrg}
36022944501Smrg
36122944501Smrg/*
36222944501Smrg * Crtc functions
36322944501Smrg */
36422944501Smrg
3656260e5d5Smrgdrm_public drmModeCrtcPtr drmModeGetCrtc(int fd, uint32_t crtcId)
36622944501Smrg{
36722944501Smrg	struct drm_mode_crtc crtc;
36822944501Smrg	drmModeCrtcPtr r;
36922944501Smrg
370424e9256Smrg	memclear(crtc);
37122944501Smrg	crtc.crtc_id = crtcId;
37222944501Smrg
37322944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETCRTC, &crtc))
37422944501Smrg		return 0;
37522944501Smrg
37622944501Smrg	/*
37722944501Smrg	 * return
37822944501Smrg	 */
37922944501Smrg
38022944501Smrg	if (!(r = drmMalloc(sizeof(*r))))
38122944501Smrg		return 0;
38222944501Smrg
38322944501Smrg	r->crtc_id         = crtc.crtc_id;
38422944501Smrg	r->x               = crtc.x;
38522944501Smrg	r->y               = crtc.y;
38622944501Smrg	r->mode_valid      = crtc.mode_valid;
387e88f27b3Smrg	if (r->mode_valid) {
38822944501Smrg		memcpy(&r->mode, &crtc.mode, sizeof(struct drm_mode_modeinfo));
389e88f27b3Smrg		r->width = crtc.mode.hdisplay;
390e88f27b3Smrg		r->height = crtc.mode.vdisplay;
391e88f27b3Smrg	}
39222944501Smrg	r->buffer_id       = crtc.fb_id;
39322944501Smrg	r->gamma_size      = crtc.gamma_size;
39422944501Smrg	return r;
39522944501Smrg}
39622944501Smrg
3976260e5d5Smrgdrm_public int drmModeSetCrtc(int fd, uint32_t crtcId, uint32_t bufferId,
398fe517fc9Smrg		   uint32_t x, uint32_t y, uint32_t *connectors, int count,
39922944501Smrg		   drmModeModeInfoPtr mode)
40022944501Smrg{
40122944501Smrg	struct drm_mode_crtc crtc;
40222944501Smrg
403424e9256Smrg	memclear(crtc);
40422944501Smrg	crtc.x             = x;
40522944501Smrg	crtc.y             = y;
40622944501Smrg	crtc.crtc_id       = crtcId;
40722944501Smrg	crtc.fb_id         = bufferId;
40822944501Smrg	crtc.set_connectors_ptr = VOID2U64(connectors);
40922944501Smrg	crtc.count_connectors = count;
41022944501Smrg	if (mode) {
41122944501Smrg	  memcpy(&crtc.mode, mode, sizeof(struct drm_mode_modeinfo));
41222944501Smrg	  crtc.mode_valid = 1;
413424e9256Smrg	}
41422944501Smrg
415d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETCRTC, &crtc);
41622944501Smrg}
41722944501Smrg
41822944501Smrg/*
41922944501Smrg * Cursor manipulation
42022944501Smrg */
42122944501Smrg
4226260e5d5Smrgdrm_public int drmModeSetCursor(int fd, uint32_t crtcId, uint32_t bo_handle,
4236260e5d5Smrg								uint32_t width, uint32_t height)
42422944501Smrg{
42522944501Smrg	struct drm_mode_cursor arg;
42622944501Smrg
427424e9256Smrg	memclear(arg);
42822944501Smrg	arg.flags = DRM_MODE_CURSOR_BO;
42922944501Smrg	arg.crtc_id = crtcId;
43022944501Smrg	arg.width = width;
43122944501Smrg	arg.height = height;
43222944501Smrg	arg.handle = bo_handle;
43322944501Smrg
434d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR, &arg);
43522944501Smrg}
43622944501Smrg
4376260e5d5Smrgdrm_public int drmModeSetCursor2(int fd, uint32_t crtcId, uint32_t bo_handle,
4386260e5d5Smrg								 uint32_t width, uint32_t height, int32_t hot_x,
4396260e5d5Smrg								 int32_t hot_y)
440e88f27b3Smrg{
441e88f27b3Smrg	struct drm_mode_cursor2 arg;
442e88f27b3Smrg
443424e9256Smrg	memclear(arg);
444e88f27b3Smrg	arg.flags = DRM_MODE_CURSOR_BO;
445e88f27b3Smrg	arg.crtc_id = crtcId;
446e88f27b3Smrg	arg.width = width;
447e88f27b3Smrg	arg.height = height;
448e88f27b3Smrg	arg.handle = bo_handle;
449e88f27b3Smrg	arg.hot_x = hot_x;
450e88f27b3Smrg	arg.hot_y = hot_y;
451e88f27b3Smrg
452e88f27b3Smrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR2, &arg);
453e88f27b3Smrg}
454e88f27b3Smrg
4556260e5d5Smrgdrm_public int drmModeMoveCursor(int fd, uint32_t crtcId, int x, int y)
45622944501Smrg{
45722944501Smrg	struct drm_mode_cursor arg;
45822944501Smrg
459424e9256Smrg	memclear(arg);
46022944501Smrg	arg.flags = DRM_MODE_CURSOR_MOVE;
46122944501Smrg	arg.crtc_id = crtcId;
46222944501Smrg	arg.x = x;
46322944501Smrg	arg.y = y;
46422944501Smrg
465d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_CURSOR, &arg);
46622944501Smrg}
46722944501Smrg
46822944501Smrg/*
46922944501Smrg * Encoder get
47022944501Smrg */
4716260e5d5Smrgdrm_public drmModeEncoderPtr drmModeGetEncoder(int fd, uint32_t encoder_id)
47222944501Smrg{
47322944501Smrg	struct drm_mode_get_encoder enc;
47422944501Smrg	drmModeEncoderPtr r = NULL;
47522944501Smrg
476424e9256Smrg	memclear(enc);
47722944501Smrg	enc.encoder_id = encoder_id;
47822944501Smrg
47922944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETENCODER, &enc))
48022944501Smrg		return 0;
48122944501Smrg
48222944501Smrg	if (!(r = drmMalloc(sizeof(*r))))
48322944501Smrg		return 0;
48422944501Smrg
48522944501Smrg	r->encoder_id = enc.encoder_id;
48622944501Smrg	r->crtc_id = enc.crtc_id;
48722944501Smrg	r->encoder_type = enc.encoder_type;
48822944501Smrg	r->possible_crtcs = enc.possible_crtcs;
48922944501Smrg	r->possible_clones = enc.possible_clones;
49022944501Smrg
49122944501Smrg	return r;
49222944501Smrg}
49322944501Smrg
49422944501Smrg/*
49522944501Smrg * Connector manipulation
49622944501Smrg */
497424e9256Smrgstatic drmModeConnectorPtr
498424e9256Smrg_drmModeGetConnector(int fd, uint32_t connector_id, int probe)
49922944501Smrg{
50022944501Smrg	struct drm_mode_get_connector conn, counts;
50122944501Smrg	drmModeConnectorPtr r = NULL;
502fe517fc9Smrg	struct drm_mode_modeinfo stack_mode;
50322944501Smrg
504424e9256Smrg	memclear(conn);
50522944501Smrg	conn.connector_id = connector_id;
506424e9256Smrg	if (!probe) {
507424e9256Smrg		conn.count_modes = 1;
508fe517fc9Smrg		conn.modes_ptr = VOID2U64(&stack_mode);
509424e9256Smrg	}
51022944501Smrg
51122944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETCONNECTOR, &conn))
51222944501Smrg		return 0;
51322944501Smrg
514424e9256Smrgretry:
51522944501Smrg	counts = conn;
51622944501Smrg
51722944501Smrg	if (conn.count_props) {
51822944501Smrg		conn.props_ptr = VOID2U64(drmMalloc(conn.count_props*sizeof(uint32_t)));
51922944501Smrg		if (!conn.props_ptr)
52022944501Smrg			goto err_allocs;
52122944501Smrg		conn.prop_values_ptr = VOID2U64(drmMalloc(conn.count_props*sizeof(uint64_t)));
52222944501Smrg		if (!conn.prop_values_ptr)
52322944501Smrg			goto err_allocs;
52422944501Smrg	}
52522944501Smrg
52622944501Smrg	if (conn.count_modes) {
52722944501Smrg		conn.modes_ptr = VOID2U64(drmMalloc(conn.count_modes*sizeof(struct drm_mode_modeinfo)));
52822944501Smrg		if (!conn.modes_ptr)
52922944501Smrg			goto err_allocs;
530424e9256Smrg	} else {
531424e9256Smrg		conn.count_modes = 1;
532fe517fc9Smrg		conn.modes_ptr = VOID2U64(&stack_mode);
53322944501Smrg	}
53422944501Smrg
53522944501Smrg	if (conn.count_encoders) {
53622944501Smrg		conn.encoders_ptr = VOID2U64(drmMalloc(conn.count_encoders*sizeof(uint32_t)));
53722944501Smrg		if (!conn.encoders_ptr)
53822944501Smrg			goto err_allocs;
53922944501Smrg	}
54022944501Smrg
54122944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETCONNECTOR, &conn))
54222944501Smrg		goto err_allocs;
54322944501Smrg
54422944501Smrg	/* The number of available connectors and etc may have changed with a
54522944501Smrg	 * hotplug event in between the ioctls, in which case the field is
54622944501Smrg	 * silently ignored by the kernel.
54722944501Smrg	 */
54822944501Smrg	if (counts.count_props < conn.count_props ||
54922944501Smrg	    counts.count_modes < conn.count_modes ||
55022944501Smrg	    counts.count_encoders < conn.count_encoders) {
55122944501Smrg		drmFree(U642VOID(conn.props_ptr));
55222944501Smrg		drmFree(U642VOID(conn.prop_values_ptr));
553fe517fc9Smrg		if (U642VOID(conn.modes_ptr) != &stack_mode)
554fe517fc9Smrg			drmFree(U642VOID(conn.modes_ptr));
55522944501Smrg		drmFree(U642VOID(conn.encoders_ptr));
55622944501Smrg
55722944501Smrg		goto retry;
55822944501Smrg	}
55922944501Smrg
56022944501Smrg	if(!(r = drmMalloc(sizeof(*r)))) {
56122944501Smrg		goto err_allocs;
56222944501Smrg	}
56322944501Smrg
56422944501Smrg	r->connector_id = conn.connector_id;
56522944501Smrg	r->encoder_id = conn.encoder_id;
56622944501Smrg	r->connection   = conn.connection;
56722944501Smrg	r->mmWidth      = conn.mm_width;
56822944501Smrg	r->mmHeight     = conn.mm_height;
56922944501Smrg	/* convert subpixel from kernel to userspace */
57022944501Smrg	r->subpixel     = conn.subpixel + 1;
57122944501Smrg	r->count_modes  = conn.count_modes;
57222944501Smrg	r->count_props  = conn.count_props;
57322944501Smrg	r->props        = drmAllocCpy(U642VOID(conn.props_ptr), conn.count_props, sizeof(uint32_t));
57422944501Smrg	r->prop_values  = drmAllocCpy(U642VOID(conn.prop_values_ptr), conn.count_props, sizeof(uint64_t));
57522944501Smrg	r->modes        = drmAllocCpy(U642VOID(conn.modes_ptr), conn.count_modes, sizeof(struct drm_mode_modeinfo));
57622944501Smrg	r->count_encoders = conn.count_encoders;
57722944501Smrg	r->encoders     = drmAllocCpy(U642VOID(conn.encoders_ptr), conn.count_encoders, sizeof(uint32_t));
57822944501Smrg	r->connector_type  = conn.connector_type;
57922944501Smrg	r->connector_type_id = conn.connector_type_id;
58022944501Smrg
58122944501Smrg	if ((r->count_props && !r->props) ||
58222944501Smrg	    (r->count_props && !r->prop_values) ||
58322944501Smrg	    (r->count_modes && !r->modes) ||
58422944501Smrg	    (r->count_encoders && !r->encoders)) {
58522944501Smrg		drmFree(r->props);
58622944501Smrg		drmFree(r->prop_values);
58722944501Smrg		drmFree(r->modes);
58822944501Smrg		drmFree(r->encoders);
58922944501Smrg		drmFree(r);
59022944501Smrg		r = 0;
59122944501Smrg	}
59222944501Smrg
59322944501Smrgerr_allocs:
59422944501Smrg	drmFree(U642VOID(conn.prop_values_ptr));
59522944501Smrg	drmFree(U642VOID(conn.props_ptr));
596fe517fc9Smrg	if (U642VOID(conn.modes_ptr) != &stack_mode)
597fe517fc9Smrg		drmFree(U642VOID(conn.modes_ptr));
59822944501Smrg	drmFree(U642VOID(conn.encoders_ptr));
59922944501Smrg
60022944501Smrg	return r;
60122944501Smrg}
60222944501Smrg
6036260e5d5Smrgdrm_public drmModeConnectorPtr drmModeGetConnector(int fd, uint32_t connector_id)
604424e9256Smrg{
605424e9256Smrg	return _drmModeGetConnector(fd, connector_id, 1);
606424e9256Smrg}
607424e9256Smrg
6086260e5d5Smrgdrm_public drmModeConnectorPtr drmModeGetConnectorCurrent(int fd, uint32_t connector_id)
609424e9256Smrg{
610424e9256Smrg	return _drmModeGetConnector(fd, connector_id, 0);
611424e9256Smrg}
612424e9256Smrg
6136260e5d5Smrgdrm_public int drmModeAttachMode(int fd, uint32_t connector_id, drmModeModeInfoPtr mode_info)
61422944501Smrg{
61522944501Smrg	struct drm_mode_mode_cmd res;
61622944501Smrg
617424e9256Smrg	memclear(res);
61822944501Smrg	memcpy(&res.mode, mode_info, sizeof(struct drm_mode_modeinfo));
61922944501Smrg	res.connector_id = connector_id;
62022944501Smrg
621d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_ATTACHMODE, &res);
62222944501Smrg}
62322944501Smrg
6246260e5d5Smrgdrm_public int drmModeDetachMode(int fd, uint32_t connector_id, drmModeModeInfoPtr mode_info)
62522944501Smrg{
62622944501Smrg	struct drm_mode_mode_cmd res;
62722944501Smrg
628424e9256Smrg	memclear(res);
62922944501Smrg	memcpy(&res.mode, mode_info, sizeof(struct drm_mode_modeinfo));
63022944501Smrg	res.connector_id = connector_id;
63122944501Smrg
632d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_DETACHMODE, &res);
63322944501Smrg}
63422944501Smrg
6356260e5d5Smrgdrm_public drmModePropertyPtr drmModeGetProperty(int fd, uint32_t property_id)
63622944501Smrg{
63722944501Smrg	struct drm_mode_get_property prop;
63822944501Smrg	drmModePropertyPtr r;
63922944501Smrg
640424e9256Smrg	memclear(prop);
64122944501Smrg	prop.prop_id = property_id;
64222944501Smrg
64322944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPERTY, &prop))
64422944501Smrg		return 0;
64522944501Smrg
64622944501Smrg	if (prop.count_values)
64722944501Smrg		prop.values_ptr = VOID2U64(drmMalloc(prop.count_values * sizeof(uint64_t)));
64822944501Smrg
649e88f27b3Smrg	if (prop.count_enum_blobs && (prop.flags & (DRM_MODE_PROP_ENUM | DRM_MODE_PROP_BITMASK)))
65022944501Smrg		prop.enum_blob_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(struct drm_mode_property_enum)));
65122944501Smrg
65222944501Smrg	if (prop.count_enum_blobs && (prop.flags & DRM_MODE_PROP_BLOB)) {
65322944501Smrg		prop.values_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(uint32_t)));
65422944501Smrg		prop.enum_blob_ptr = VOID2U64(drmMalloc(prop.count_enum_blobs * sizeof(uint32_t)));
65522944501Smrg	}
65622944501Smrg
65722944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPERTY, &prop)) {
65822944501Smrg		r = NULL;
65922944501Smrg		goto err_allocs;
66022944501Smrg	}
66122944501Smrg
66222944501Smrg	if (!(r = drmMalloc(sizeof(*r))))
663bf6cc7dcSmrg		goto err_allocs;
66422944501Smrg
66522944501Smrg	r->prop_id = prop.prop_id;
66622944501Smrg	r->count_values = prop.count_values;
66722944501Smrg
66822944501Smrg	r->flags = prop.flags;
66922944501Smrg	if (prop.count_values)
67022944501Smrg		r->values = drmAllocCpy(U642VOID(prop.values_ptr), prop.count_values, sizeof(uint64_t));
671e88f27b3Smrg	if (prop.flags & (DRM_MODE_PROP_ENUM | DRM_MODE_PROP_BITMASK)) {
67222944501Smrg		r->count_enums = prop.count_enum_blobs;
67322944501Smrg		r->enums = drmAllocCpy(U642VOID(prop.enum_blob_ptr), prop.count_enum_blobs, sizeof(struct drm_mode_property_enum));
67422944501Smrg	} else if (prop.flags & DRM_MODE_PROP_BLOB) {
67522944501Smrg		r->values = drmAllocCpy(U642VOID(prop.values_ptr), prop.count_enum_blobs, sizeof(uint32_t));
67622944501Smrg		r->blob_ids = drmAllocCpy(U642VOID(prop.enum_blob_ptr), prop.count_enum_blobs, sizeof(uint32_t));
67722944501Smrg		r->count_blobs = prop.count_enum_blobs;
67822944501Smrg	}
67922944501Smrg	strncpy(r->name, prop.name, DRM_PROP_NAME_LEN);
68022944501Smrg	r->name[DRM_PROP_NAME_LEN-1] = 0;
68122944501Smrg
68222944501Smrgerr_allocs:
68322944501Smrg	drmFree(U642VOID(prop.values_ptr));
68422944501Smrg	drmFree(U642VOID(prop.enum_blob_ptr));
68522944501Smrg
68622944501Smrg	return r;
68722944501Smrg}
68822944501Smrg
6896260e5d5Smrgdrm_public void drmModeFreeProperty(drmModePropertyPtr ptr)
69022944501Smrg{
69122944501Smrg	if (!ptr)
69222944501Smrg		return;
69322944501Smrg
69422944501Smrg	drmFree(ptr->values);
69522944501Smrg	drmFree(ptr->enums);
69687bf8e7cSmrg	drmFree(ptr->blob_ids);
69722944501Smrg	drmFree(ptr);
69822944501Smrg}
69922944501Smrg
7006260e5d5Smrgdrm_public drmModePropertyBlobPtr drmModeGetPropertyBlob(int fd,
7016260e5d5Smrg														 uint32_t blob_id)
70222944501Smrg{
70322944501Smrg	struct drm_mode_get_blob blob;
70422944501Smrg	drmModePropertyBlobPtr r;
70522944501Smrg
706424e9256Smrg	memclear(blob);
70722944501Smrg	blob.blob_id = blob_id;
70822944501Smrg
70922944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPBLOB, &blob))
71022944501Smrg		return NULL;
71122944501Smrg
71222944501Smrg	if (blob.length)
71322944501Smrg		blob.data = VOID2U64(drmMalloc(blob.length));
71422944501Smrg
71522944501Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPROPBLOB, &blob)) {
71622944501Smrg		r = NULL;
71722944501Smrg		goto err_allocs;
71822944501Smrg	}
71922944501Smrg
72022944501Smrg	if (!(r = drmMalloc(sizeof(*r))))
721d049871aSmrg		goto err_allocs;
72222944501Smrg
72322944501Smrg	r->id = blob.blob_id;
72422944501Smrg	r->length = blob.length;
72522944501Smrg	r->data = drmAllocCpy(U642VOID(blob.data), 1, blob.length);
72622944501Smrg
72722944501Smrgerr_allocs:
72822944501Smrg	drmFree(U642VOID(blob.data));
72922944501Smrg	return r;
73022944501Smrg}
73122944501Smrg
732adfa0b0cSmrgstatic inline const uint32_t *
733adfa0b0cSmrgget_formats_ptr(const struct drm_format_modifier_blob *blob)
734adfa0b0cSmrg{
735adfa0b0cSmrg	return (const uint32_t *)(((uint8_t *)blob) + blob->formats_offset);
736adfa0b0cSmrg}
737adfa0b0cSmrg
738adfa0b0cSmrgstatic inline const struct drm_format_modifier *
739adfa0b0cSmrgget_modifiers_ptr(const struct drm_format_modifier_blob *blob)
740adfa0b0cSmrg{
741adfa0b0cSmrg	return (const struct drm_format_modifier *)(((uint8_t *)blob) +
742adfa0b0cSmrg						    blob->modifiers_offset);
743adfa0b0cSmrg}
744adfa0b0cSmrg
745adfa0b0cSmrgstatic bool _drmModeFormatModifierGetNext(const drmModePropertyBlobRes *blob,
746adfa0b0cSmrg					  drmModeFormatModifierIterator *iter)
747adfa0b0cSmrg{
748adfa0b0cSmrg	const struct drm_format_modifier *blob_modifiers, *mod;
749adfa0b0cSmrg	const struct drm_format_modifier_blob *fmt_mod_blob;
750adfa0b0cSmrg	const uint32_t *blob_formats;
751adfa0b0cSmrg
752adfa0b0cSmrg	assert(blob && iter);
753adfa0b0cSmrg
754adfa0b0cSmrg	fmt_mod_blob = blob->data;
755adfa0b0cSmrg	blob_modifiers = get_modifiers_ptr(fmt_mod_blob);
756adfa0b0cSmrg	blob_formats = get_formats_ptr(fmt_mod_blob);
757adfa0b0cSmrg
758adfa0b0cSmrg	/* fmt_idx and mod_idx designate the number of processed formats
759adfa0b0cSmrg	 * and modifiers.
760adfa0b0cSmrg	 */
761adfa0b0cSmrg	if (iter->fmt_idx >= fmt_mod_blob->count_formats ||
762adfa0b0cSmrg	    iter->mod_idx >= fmt_mod_blob->count_modifiers)
763adfa0b0cSmrg		return false;
764adfa0b0cSmrg
765adfa0b0cSmrg	iter->fmt = blob_formats[iter->fmt_idx];
766adfa0b0cSmrg	iter->mod = DRM_FORMAT_MOD_INVALID;
767adfa0b0cSmrg
768adfa0b0cSmrg	/* From the latest valid found, get the next valid modifier */
769adfa0b0cSmrg	while (iter->mod_idx < fmt_mod_blob->count_modifiers) {
770adfa0b0cSmrg		mod = &blob_modifiers[iter->mod_idx++];
771adfa0b0cSmrg
772adfa0b0cSmrg		/* Check if the format that fmt_idx designates, belongs to
773adfa0b0cSmrg		 * this modifier 64-bit window selected via mod->offset.
774adfa0b0cSmrg		 */
775adfa0b0cSmrg		if (iter->fmt_idx < mod->offset ||
776adfa0b0cSmrg		    iter->fmt_idx >= mod->offset + 64)
777adfa0b0cSmrg			continue;
778adfa0b0cSmrg		if (!(mod->formats & (1 << (iter->fmt_idx - mod->offset))))
779adfa0b0cSmrg			continue;
780adfa0b0cSmrg
781adfa0b0cSmrg		iter->mod = mod->modifier;
782adfa0b0cSmrg		break;
783adfa0b0cSmrg	}
784adfa0b0cSmrg
785adfa0b0cSmrg	if (iter->mod_idx == fmt_mod_blob->count_modifiers) {
786adfa0b0cSmrg		iter->mod_idx = 0;
787adfa0b0cSmrg		iter->fmt_idx++;
788adfa0b0cSmrg	}
789adfa0b0cSmrg
790adfa0b0cSmrg	/* Since mod_idx reset, in order for the caller to iterate over
791adfa0b0cSmrg	 * the last modifier of the last format, always return true here
792adfa0b0cSmrg	 * and early return from the next call.
793adfa0b0cSmrg	 */
794adfa0b0cSmrg	return true;
795adfa0b0cSmrg}
796adfa0b0cSmrg
797adfa0b0cSmrg/**
798adfa0b0cSmrg * Iterate over formats first and then over modifiers. On each call, iter->fmt
799adfa0b0cSmrg * is retained until all associated modifiers are returned. Then, either update
800adfa0b0cSmrg * iter->fmt with the next format, or exit if there aren't any left.
801adfa0b0cSmrg *
802adfa0b0cSmrg * NOTE: clients should not make any assumption on mod_idx and fmt_idx values
803adfa0b0cSmrg *
804adfa0b0cSmrg * @blob: valid kernel blob holding formats and modifiers
805adfa0b0cSmrg * @iter: input and output iterator data. Iter data must be initialised to zero
806adfa0b0cSmrg * @return: false, on error or there aren't any further formats or modifiers left.
807adfa0b0cSmrg *          true, on success and there are more formats or modifiers.
808adfa0b0cSmrg */
809adfa0b0cSmrgdrm_public bool drmModeFormatModifierBlobIterNext(const drmModePropertyBlobRes *blob,
810adfa0b0cSmrg						  drmModeFormatModifierIterator *iter)
811adfa0b0cSmrg{
812adfa0b0cSmrg	drmModeFormatModifierIterator tmp;
813adfa0b0cSmrg	bool has_fmt;
814adfa0b0cSmrg
815adfa0b0cSmrg	if (!blob || !iter)
816adfa0b0cSmrg		return false;
817adfa0b0cSmrg
818adfa0b0cSmrg	tmp.fmt_idx = iter->fmt_idx;
819adfa0b0cSmrg	tmp.mod_idx = iter->mod_idx;
820adfa0b0cSmrg
821adfa0b0cSmrg	/* With the current state of things, DRM/KMS drivers are allowed to
822adfa0b0cSmrg	 * construct blobs having formats and no modifiers. Userspace can't
823adfa0b0cSmrg	 * legitimately abort in such cases.
824adfa0b0cSmrg	 *
825adfa0b0cSmrg	 * While waiting for the kernel to perhaps disallow formats with no
826adfa0b0cSmrg	 * modifiers in IN_FORMATS blobs, skip the format altogether.
827adfa0b0cSmrg	 */
828adfa0b0cSmrg	do {
829adfa0b0cSmrg		has_fmt = _drmModeFormatModifierGetNext(blob, &tmp);
830adfa0b0cSmrg		if (has_fmt && tmp.mod != DRM_FORMAT_MOD_INVALID)
831adfa0b0cSmrg			*iter = tmp;
832adfa0b0cSmrg
833adfa0b0cSmrg	} while (has_fmt && tmp.mod == DRM_FORMAT_MOD_INVALID);
834adfa0b0cSmrg
835adfa0b0cSmrg	return has_fmt;
836adfa0b0cSmrg}
837adfa0b0cSmrg
8386260e5d5Smrgdrm_public void drmModeFreePropertyBlob(drmModePropertyBlobPtr ptr)
83922944501Smrg{
84022944501Smrg	if (!ptr)
84122944501Smrg		return;
84222944501Smrg
84322944501Smrg	drmFree(ptr->data);
84422944501Smrg	drmFree(ptr);
84522944501Smrg}
84622944501Smrg
8476260e5d5Smrgdrm_public int drmModeConnectorSetProperty(int fd, uint32_t connector_id,
8486260e5d5Smrg										   uint32_t property_id,
8496260e5d5Smrg										   uint64_t value)
85022944501Smrg{
85122944501Smrg	struct drm_mode_connector_set_property osp;
85222944501Smrg
853424e9256Smrg	memclear(osp);
85422944501Smrg	osp.connector_id = connector_id;
85522944501Smrg	osp.prop_id = property_id;
85622944501Smrg	osp.value = value;
85722944501Smrg
858d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETPROPERTY, &osp);
85922944501Smrg}
86022944501Smrg
86122944501Smrg/*
86222944501Smrg * checks if a modesetting capable driver has attached to the pci id
86322944501Smrg * returns 0 if modesetting supported.
86422944501Smrg *  -EINVAL or invalid bus id
86522944501Smrg *  -ENOSYS if no modesetting support
86622944501Smrg*/
8676260e5d5Smrgdrm_public int drmCheckModesettingSupported(const char *busid)
86822944501Smrg{
869a7d7de1eSmrg#if defined (__linux__)
87022944501Smrg	char pci_dev_dir[1024];
87122944501Smrg	int domain, bus, dev, func;
87222944501Smrg	DIR *sysdir;
87322944501Smrg	struct dirent *dent;
87422944501Smrg	int found = 0, ret;
87522944501Smrg
87622944501Smrg	ret = sscanf(busid, "pci:%04x:%02x:%02x.%d", &domain, &bus, &dev, &func);
87722944501Smrg	if (ret != 4)
87822944501Smrg		return -EINVAL;
87922944501Smrg
88022944501Smrg	sprintf(pci_dev_dir, "/sys/bus/pci/devices/%04x:%02x:%02x.%d/drm",
88122944501Smrg		domain, bus, dev, func);
88222944501Smrg
88322944501Smrg	sysdir = opendir(pci_dev_dir);
88422944501Smrg	if (sysdir) {
88522944501Smrg		dent = readdir(sysdir);
88622944501Smrg		while (dent) {
88722944501Smrg			if (!strncmp(dent->d_name, "controlD", 8)) {
88822944501Smrg				found = 1;
88922944501Smrg				break;
89022944501Smrg			}
89122944501Smrg
89222944501Smrg			dent = readdir(sysdir);
89322944501Smrg		}
89422944501Smrg		closedir(sysdir);
89522944501Smrg		if (found)
89622944501Smrg			return 0;
89722944501Smrg	}
89822944501Smrg
89922944501Smrg	sprintf(pci_dev_dir, "/sys/bus/pci/devices/%04x:%02x:%02x.%d/",
90022944501Smrg		domain, bus, dev, func);
90122944501Smrg
90222944501Smrg	sysdir = opendir(pci_dev_dir);
90322944501Smrg	if (!sysdir)
90422944501Smrg		return -EINVAL;
90522944501Smrg
90622944501Smrg	dent = readdir(sysdir);
90722944501Smrg	while (dent) {
90822944501Smrg		if (!strncmp(dent->d_name, "drm:controlD", 12)) {
90922944501Smrg			found = 1;
91022944501Smrg			break;
91122944501Smrg		}
91222944501Smrg
91322944501Smrg		dent = readdir(sysdir);
91422944501Smrg	}
91522944501Smrg
91622944501Smrg	closedir(sysdir);
91722944501Smrg	if (found)
91822944501Smrg		return 0;
919a7d7de1eSmrg#elif defined (__FreeBSD__) || defined (__FreeBSD_kernel__)
92087bf8e7cSmrg	char sbusid[1024];
921a7d7de1eSmrg	char oid[128];
922a7d7de1eSmrg	int i, modesetting, ret;
923a7d7de1eSmrg	size_t len;
924a7d7de1eSmrg
925a7d7de1eSmrg	/* How many GPUs do we expect in the machine ? */
92687bf8e7cSmrg	for (i = 0; i < 10; i++) {
927a7d7de1eSmrg		snprintf(oid, sizeof(oid), "hw.dri.%d.busid", i);
928a7d7de1eSmrg		len = sizeof(sbusid);
929a7d7de1eSmrg		ret = sysctlbyname(oid, sbusid, &len, NULL, 0);
930a7d7de1eSmrg		if (ret == -1) {
931a7d7de1eSmrg			if (errno == ENOENT)
932a7d7de1eSmrg				continue;
933a7d7de1eSmrg			return -EINVAL;
934a7d7de1eSmrg		}
93587bf8e7cSmrg		if (strcmp(sbusid, busid) != 0)
936a7d7de1eSmrg			continue;
937a7d7de1eSmrg		snprintf(oid, sizeof(oid), "hw.dri.%d.modesetting", i);
938a7d7de1eSmrg		len = sizeof(modesetting);
939a7d7de1eSmrg		ret = sysctlbyname(oid, &modesetting, &len, NULL, 0);
940a7d7de1eSmrg		if (ret == -1 || len != sizeof(modesetting))
941a7d7de1eSmrg			return -EINVAL;
942a7d7de1eSmrg		return (modesetting ? 0 : -ENOSYS);
943a7d7de1eSmrg	}
944e05f3551Smrg#elif defined(__DragonFly__)
945e05f3551Smrg	return 0;
9466260e5d5Smrg#elif defined(__OpenBSD__) || defined(__NetBSD__)
947fe517fc9Smrg	int	fd;
948fe517fc9Smrg	struct drm_mode_card_res res;
949fe517fc9Smrg	drmModeResPtr r = 0;
950fe517fc9Smrg
951fe517fc9Smrg	if ((fd = drmOpen(NULL, busid)) < 0)
952fe517fc9Smrg		return -EINVAL;
9537d13a5d0Sriastradh
954fe517fc9Smrg	memset(&res, 0, sizeof(struct drm_mode_card_res));
955fe517fc9Smrg
956fe517fc9Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETRESOURCES, &res)) {
957fe517fc9Smrg		drmClose(fd);
958fe517fc9Smrg		return -errno;
959fe517fc9Smrg	}
960fe517fc9Smrg
961fe517fc9Smrg	drmClose(fd);
962fe517fc9Smrg	return 0;
963fe517fc9Smrg#endif
964fe517fc9Smrg	return -ENOSYS;
96522944501Smrg}
96622944501Smrg
9676260e5d5Smrgdrm_public int drmModeCrtcGetGamma(int fd, uint32_t crtc_id, uint32_t size,
9686260e5d5Smrg								   uint16_t *red, uint16_t *green,
9696260e5d5Smrg								   uint16_t *blue)
97022944501Smrg{
97122944501Smrg	struct drm_mode_crtc_lut l;
97222944501Smrg
973424e9256Smrg	memclear(l);
97422944501Smrg	l.crtc_id = crtc_id;
97522944501Smrg	l.gamma_size = size;
97622944501Smrg	l.red = VOID2U64(red);
97722944501Smrg	l.green = VOID2U64(green);
97822944501Smrg	l.blue = VOID2U64(blue);
97922944501Smrg
980d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_GETGAMMA, &l);
98122944501Smrg}
98222944501Smrg
9836260e5d5Smrgdrm_public int drmModeCrtcSetGamma(int fd, uint32_t crtc_id, uint32_t size,
9846260e5d5Smrg								   uint16_t *red, uint16_t *green,
9856260e5d5Smrg								   uint16_t *blue)
98622944501Smrg{
98722944501Smrg	struct drm_mode_crtc_lut l;
98822944501Smrg
989424e9256Smrg	memclear(l);
99022944501Smrg	l.crtc_id = crtc_id;
99122944501Smrg	l.gamma_size = size;
99222944501Smrg	l.red = VOID2U64(red);
99322944501Smrg	l.green = VOID2U64(green);
99422944501Smrg	l.blue = VOID2U64(blue);
99522944501Smrg
996d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETGAMMA, &l);
99722944501Smrg}
99822944501Smrg
9996260e5d5Smrgdrm_public int drmHandleEvent(int fd, drmEventContextPtr evctx)
100022944501Smrg{
100122944501Smrg	char buffer[1024];
100222944501Smrg	int len, i;
100322944501Smrg	struct drm_event *e;
100422944501Smrg	struct drm_event_vblank *vblank;
10052b90624aSmrg	struct drm_event_crtc_sequence *seq;
10060655efefSmrg	void *user_data;
1007fe517fc9Smrg
100822944501Smrg	/* The DRM read semantics guarantees that we always get only
100922944501Smrg	 * complete events. */
101022944501Smrg
101122944501Smrg	len = read(fd, buffer, sizeof buffer);
101222944501Smrg	if (len == 0)
101322944501Smrg		return 0;
1014424e9256Smrg	if (len < (int)sizeof *e)
101522944501Smrg		return -1;
101622944501Smrg
101722944501Smrg	i = 0;
101822944501Smrg	while (i < len) {
10192ee35494Smrg		e = (struct drm_event *)(buffer + i);
102022944501Smrg		switch (e->type) {
102122944501Smrg		case DRM_EVENT_VBLANK:
102222944501Smrg			if (evctx->version < 1 ||
102322944501Smrg			    evctx->vblank_handler == NULL)
102422944501Smrg				break;
102522944501Smrg			vblank = (struct drm_event_vblank *) e;
102622944501Smrg			evctx->vblank_handler(fd,
1027fe517fc9Smrg					      vblank->sequence,
102822944501Smrg					      vblank->tv_sec,
102922944501Smrg					      vblank->tv_usec,
103022944501Smrg					      U642VOID (vblank->user_data));
103122944501Smrg			break;
103222944501Smrg		case DRM_EVENT_FLIP_COMPLETE:
103322944501Smrg			vblank = (struct drm_event_vblank *) e;
10340655efefSmrg			user_data = U642VOID (vblank->user_data);
10350655efefSmrg
10360655efefSmrg			if (evctx->version >= 3 && evctx->page_flip_handler2)
10370655efefSmrg				evctx->page_flip_handler2(fd,
10380655efefSmrg							 vblank->sequence,
10390655efefSmrg							 vblank->tv_sec,
10400655efefSmrg							 vblank->tv_usec,
10410655efefSmrg							 vblank->crtc_id,
10420655efefSmrg							 user_data);
10430655efefSmrg			else if (evctx->version >= 2 && evctx->page_flip_handler)
10440655efefSmrg				evctx->page_flip_handler(fd,
10450655efefSmrg							 vblank->sequence,
10460655efefSmrg							 vblank->tv_sec,
10470655efefSmrg							 vblank->tv_usec,
10480655efefSmrg							 user_data);
104922944501Smrg			break;
10502b90624aSmrg		case DRM_EVENT_CRTC_SEQUENCE:
10512b90624aSmrg			seq = (struct drm_event_crtc_sequence *) e;
10522b90624aSmrg			if (evctx->version >= 4 && evctx->sequence_handler)
10532b90624aSmrg				evctx->sequence_handler(fd,
10542b90624aSmrg							seq->sequence,
10552b90624aSmrg							seq->time_ns,
10562b90624aSmrg							seq->user_data);
10572b90624aSmrg			break;
105822944501Smrg		default:
105922944501Smrg			break;
106022944501Smrg		}
106122944501Smrg		i += e->length;
106222944501Smrg	}
106322944501Smrg
106422944501Smrg	return 0;
106522944501Smrg}
106622944501Smrg
10676260e5d5Smrgdrm_public int drmModePageFlip(int fd, uint32_t crtc_id, uint32_t fb_id,
106822944501Smrg		    uint32_t flags, void *user_data)
106922944501Smrg{
107022944501Smrg	struct drm_mode_crtc_page_flip flip;
107122944501Smrg
1072424e9256Smrg	memclear(flip);
107322944501Smrg	flip.fb_id = fb_id;
107422944501Smrg	flip.crtc_id = crtc_id;
107522944501Smrg	flip.user_data = VOID2U64(user_data);
107622944501Smrg	flip.flags = flags;
107722944501Smrg
1078d049871aSmrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_PAGE_FLIP, &flip);
107922944501Smrg}
1080e88f27b3Smrg
10816260e5d5Smrgdrm_public int drmModePageFlipTarget(int fd, uint32_t crtc_id, uint32_t fb_id,
10822ee35494Smrg			  uint32_t flags, void *user_data,
10832ee35494Smrg			  uint32_t target_vblank)
10842ee35494Smrg{
10852ee35494Smrg	struct drm_mode_crtc_page_flip_target flip_target;
10862ee35494Smrg
10872ee35494Smrg	memclear(flip_target);
10882ee35494Smrg	flip_target.fb_id = fb_id;
10892ee35494Smrg	flip_target.crtc_id = crtc_id;
10902ee35494Smrg	flip_target.user_data = VOID2U64(user_data);
10912ee35494Smrg	flip_target.flags = flags;
10922ee35494Smrg	flip_target.sequence = target_vblank;
10932ee35494Smrg
10942ee35494Smrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_PAGE_FLIP, &flip_target);
10952ee35494Smrg}
10962ee35494Smrg
10976260e5d5Smrgdrm_public int drmModeSetPlane(int fd, uint32_t plane_id, uint32_t crtc_id,
1098e88f27b3Smrg		    uint32_t fb_id, uint32_t flags,
1099becaf760Smrg		    uint32_t crtc_x, uint32_t crtc_y,
1100e88f27b3Smrg		    uint32_t crtc_w, uint32_t crtc_h,
1101e88f27b3Smrg		    uint32_t src_x, uint32_t src_y,
1102e88f27b3Smrg		    uint32_t src_w, uint32_t src_h)
1103e88f27b3Smrg{
1104e88f27b3Smrg	struct drm_mode_set_plane s;
1105e88f27b3Smrg
1106424e9256Smrg	memclear(s);
1107e88f27b3Smrg	s.plane_id = plane_id;
1108e88f27b3Smrg	s.crtc_id = crtc_id;
1109e88f27b3Smrg	s.fb_id = fb_id;
1110e88f27b3Smrg	s.flags = flags;
1111e88f27b3Smrg	s.crtc_x = crtc_x;
1112e88f27b3Smrg	s.crtc_y = crtc_y;
1113e88f27b3Smrg	s.crtc_w = crtc_w;
1114e88f27b3Smrg	s.crtc_h = crtc_h;
1115e88f27b3Smrg	s.src_x = src_x;
1116e88f27b3Smrg	s.src_y = src_y;
1117e88f27b3Smrg	s.src_w = src_w;
1118e88f27b3Smrg	s.src_h = src_h;
1119e88f27b3Smrg
1120e88f27b3Smrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_SETPLANE, &s);
1121e88f27b3Smrg}
1122e88f27b3Smrg
11236260e5d5Smrgdrm_public drmModePlanePtr drmModeGetPlane(int fd, uint32_t plane_id)
1124e88f27b3Smrg{
1125e88f27b3Smrg	struct drm_mode_get_plane ovr, counts;
1126e88f27b3Smrg	drmModePlanePtr r = 0;
1127e88f27b3Smrg
1128e88f27b3Smrgretry:
1129424e9256Smrg	memclear(ovr);
1130e88f27b3Smrg	ovr.plane_id = plane_id;
1131e88f27b3Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANE, &ovr))
1132e88f27b3Smrg		return 0;
1133e88f27b3Smrg
1134e88f27b3Smrg	counts = ovr;
1135e88f27b3Smrg
1136e88f27b3Smrg	if (ovr.count_format_types) {
1137e88f27b3Smrg		ovr.format_type_ptr = VOID2U64(drmMalloc(ovr.count_format_types *
1138e88f27b3Smrg							 sizeof(uint32_t)));
1139e88f27b3Smrg		if (!ovr.format_type_ptr)
1140e88f27b3Smrg			goto err_allocs;
1141e88f27b3Smrg	}
1142e88f27b3Smrg
1143e88f27b3Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANE, &ovr))
1144e88f27b3Smrg		goto err_allocs;
1145e88f27b3Smrg
1146e88f27b3Smrg	if (counts.count_format_types < ovr.count_format_types) {
1147e88f27b3Smrg		drmFree(U642VOID(ovr.format_type_ptr));
1148e88f27b3Smrg		goto retry;
1149e88f27b3Smrg	}
1150e88f27b3Smrg
1151e88f27b3Smrg	if (!(r = drmMalloc(sizeof(*r))))
1152e88f27b3Smrg		goto err_allocs;
1153e88f27b3Smrg
1154e88f27b3Smrg	r->count_formats = ovr.count_format_types;
1155e88f27b3Smrg	r->plane_id = ovr.plane_id;
1156e88f27b3Smrg	r->crtc_id = ovr.crtc_id;
1157e88f27b3Smrg	r->fb_id = ovr.fb_id;
1158e88f27b3Smrg	r->possible_crtcs = ovr.possible_crtcs;
1159e88f27b3Smrg	r->gamma_size = ovr.gamma_size;
1160e88f27b3Smrg	r->formats = drmAllocCpy(U642VOID(ovr.format_type_ptr),
1161e88f27b3Smrg				 ovr.count_format_types, sizeof(uint32_t));
1162e88f27b3Smrg	if (ovr.count_format_types && !r->formats) {
1163e88f27b3Smrg		drmFree(r->formats);
1164e88f27b3Smrg		drmFree(r);
1165e88f27b3Smrg		r = 0;
1166e88f27b3Smrg	}
1167e88f27b3Smrg
1168e88f27b3Smrgerr_allocs:
1169e88f27b3Smrg	drmFree(U642VOID(ovr.format_type_ptr));
1170e88f27b3Smrg
1171e88f27b3Smrg	return r;
1172e88f27b3Smrg}
1173e88f27b3Smrg
11746260e5d5Smrgdrm_public void drmModeFreePlane(drmModePlanePtr ptr)
1175e88f27b3Smrg{
1176e88f27b3Smrg	if (!ptr)
1177e88f27b3Smrg		return;
1178e88f27b3Smrg
1179e88f27b3Smrg	drmFree(ptr->formats);
1180e88f27b3Smrg	drmFree(ptr);
1181e88f27b3Smrg}
1182e88f27b3Smrg
11836260e5d5Smrgdrm_public drmModePlaneResPtr drmModeGetPlaneResources(int fd)
1184e88f27b3Smrg{
1185e88f27b3Smrg	struct drm_mode_get_plane_res res, counts;
1186e88f27b3Smrg	drmModePlaneResPtr r = 0;
1187e88f27b3Smrg
1188e88f27b3Smrgretry:
1189424e9256Smrg	memclear(res);
1190e88f27b3Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANERESOURCES, &res))
1191e88f27b3Smrg		return 0;
1192e88f27b3Smrg
1193e88f27b3Smrg	counts = res;
1194e88f27b3Smrg
1195e88f27b3Smrg	if (res.count_planes) {
1196e88f27b3Smrg		res.plane_id_ptr = VOID2U64(drmMalloc(res.count_planes *
1197e88f27b3Smrg							sizeof(uint32_t)));
1198e88f27b3Smrg		if (!res.plane_id_ptr)
1199e88f27b3Smrg			goto err_allocs;
1200e88f27b3Smrg	}
1201e88f27b3Smrg
1202e88f27b3Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_GETPLANERESOURCES, &res))
1203e88f27b3Smrg		goto err_allocs;
1204e88f27b3Smrg
1205e88f27b3Smrg	if (counts.count_planes < res.count_planes) {
1206e88f27b3Smrg		drmFree(U642VOID(res.plane_id_ptr));
1207e88f27b3Smrg		goto retry;
1208e88f27b3Smrg	}
1209e88f27b3Smrg
1210e88f27b3Smrg	if (!(r = drmMalloc(sizeof(*r))))
1211e88f27b3Smrg		goto err_allocs;
1212e88f27b3Smrg
1213e88f27b3Smrg	r->count_planes = res.count_planes;
1214e88f27b3Smrg	r->planes = drmAllocCpy(U642VOID(res.plane_id_ptr),
1215e88f27b3Smrg				  res.count_planes, sizeof(uint32_t));
1216e88f27b3Smrg	if (res.count_planes && !r->planes) {
1217e88f27b3Smrg		drmFree(r->planes);
1218e88f27b3Smrg		drmFree(r);
1219e88f27b3Smrg		r = 0;
1220e88f27b3Smrg	}
1221e88f27b3Smrg
1222e88f27b3Smrgerr_allocs:
1223e88f27b3Smrg	drmFree(U642VOID(res.plane_id_ptr));
1224e88f27b3Smrg
1225e88f27b3Smrg	return r;
1226e88f27b3Smrg}
1227e88f27b3Smrg
12286260e5d5Smrgdrm_public void drmModeFreePlaneResources(drmModePlaneResPtr ptr)
1229e88f27b3Smrg{
1230e88f27b3Smrg	if (!ptr)
1231e88f27b3Smrg		return;
1232e88f27b3Smrg
1233e88f27b3Smrg	drmFree(ptr->planes);
1234e88f27b3Smrg	drmFree(ptr);
1235e88f27b3Smrg}
1236e88f27b3Smrg
12376260e5d5Smrgdrm_public drmModeObjectPropertiesPtr drmModeObjectGetProperties(int fd,
1238e88f27b3Smrg						      uint32_t object_id,
1239e88f27b3Smrg						      uint32_t object_type)
1240e88f27b3Smrg{
1241e88f27b3Smrg	struct drm_mode_obj_get_properties properties;
1242e88f27b3Smrg	drmModeObjectPropertiesPtr ret = NULL;
1243e88f27b3Smrg	uint32_t count;
1244e88f27b3Smrg
1245e88f27b3Smrgretry:
1246424e9256Smrg	memclear(properties);
1247e88f27b3Smrg	properties.obj_id = object_id;
1248e88f27b3Smrg	properties.obj_type = object_type;
1249e88f27b3Smrg
1250e88f27b3Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_OBJ_GETPROPERTIES, &properties))
1251e88f27b3Smrg		return 0;
1252e88f27b3Smrg
1253e88f27b3Smrg	count = properties.count_props;
1254e88f27b3Smrg
1255e88f27b3Smrg	if (count) {
1256e88f27b3Smrg		properties.props_ptr = VOID2U64(drmMalloc(count *
1257e88f27b3Smrg							  sizeof(uint32_t)));
1258e88f27b3Smrg		if (!properties.props_ptr)
1259e88f27b3Smrg			goto err_allocs;
1260e88f27b3Smrg		properties.prop_values_ptr = VOID2U64(drmMalloc(count *
1261e88f27b3Smrg						      sizeof(uint64_t)));
1262e88f27b3Smrg		if (!properties.prop_values_ptr)
1263e88f27b3Smrg			goto err_allocs;
1264e88f27b3Smrg	}
1265e88f27b3Smrg
1266e88f27b3Smrg	if (drmIoctl(fd, DRM_IOCTL_MODE_OBJ_GETPROPERTIES, &properties))
1267e88f27b3Smrg		goto err_allocs;
1268e88f27b3Smrg
1269e88f27b3Smrg	if (count < properties.count_props) {
1270e88f27b3Smrg		drmFree(U642VOID(properties.props_ptr));
1271e88f27b3Smrg		drmFree(U642VOID(properties.prop_values_ptr));
1272e88f27b3Smrg		goto retry;
1273e88f27b3Smrg	}
1274e88f27b3Smrg	count = properties.count_props;
1275e88f27b3Smrg
1276e88f27b3Smrg	ret = drmMalloc(sizeof(*ret));
1277e88f27b3Smrg	if (!ret)
1278e88f27b3Smrg		goto err_allocs;
1279e88f27b3Smrg
1280e88f27b3Smrg	ret->count_props = count;
1281e88f27b3Smrg	ret->props = drmAllocCpy(U642VOID(properties.props_ptr),
1282e88f27b3Smrg				 count, sizeof(uint32_t));
1283e88f27b3Smrg	ret->prop_values = drmAllocCpy(U642VOID(properties.prop_values_ptr),
1284e88f27b3Smrg				       count, sizeof(uint64_t));
1285e88f27b3Smrg	if (ret->count_props && (!ret->props || !ret->prop_values)) {
1286e88f27b3Smrg		drmFree(ret->props);
1287e88f27b3Smrg		drmFree(ret->prop_values);
1288e88f27b3Smrg		drmFree(ret);
1289e88f27b3Smrg		ret = NULL;
1290e88f27b3Smrg	}
1291e88f27b3Smrg
1292e88f27b3Smrgerr_allocs:
1293e88f27b3Smrg	drmFree(U642VOID(properties.props_ptr));
1294e88f27b3Smrg	drmFree(U642VOID(properties.prop_values_ptr));
1295e88f27b3Smrg	return ret;
1296e88f27b3Smrg}
1297e88f27b3Smrg
12986260e5d5Smrgdrm_public void drmModeFreeObjectProperties(drmModeObjectPropertiesPtr ptr)
1299e88f27b3Smrg{
1300e88f27b3Smrg	if (!ptr)
1301e88f27b3Smrg		return;
1302e88f27b3Smrg	drmFree(ptr->props);
1303e88f27b3Smrg	drmFree(ptr->prop_values);
1304e88f27b3Smrg	drmFree(ptr);
1305e88f27b3Smrg}
1306e88f27b3Smrg
13076260e5d5Smrgdrm_public int drmModeObjectSetProperty(int fd, uint32_t object_id, uint32_t object_type,
1308e88f27b3Smrg			     uint32_t property_id, uint64_t value)
1309e88f27b3Smrg{
1310e88f27b3Smrg	struct drm_mode_obj_set_property prop;
1311e88f27b3Smrg
1312424e9256Smrg	memclear(prop);
1313e88f27b3Smrg	prop.value = value;
1314e88f27b3Smrg	prop.prop_id = property_id;
1315e88f27b3Smrg	prop.obj_id = object_id;
1316e88f27b3Smrg	prop.obj_type = object_type;
1317e88f27b3Smrg
1318e88f27b3Smrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_OBJ_SETPROPERTY, &prop);
1319e88f27b3Smrg}
1320424e9256Smrg
1321424e9256Smrgtypedef struct _drmModeAtomicReqItem drmModeAtomicReqItem, *drmModeAtomicReqItemPtr;
1322424e9256Smrg
1323424e9256Smrgstruct _drmModeAtomicReqItem {
1324424e9256Smrg	uint32_t object_id;
1325424e9256Smrg	uint32_t property_id;
1326424e9256Smrg	uint64_t value;
1327424e9256Smrg};
1328424e9256Smrg
1329424e9256Smrgstruct _drmModeAtomicReq {
1330424e9256Smrg	uint32_t cursor;
1331424e9256Smrg	uint32_t size_items;
1332424e9256Smrg	drmModeAtomicReqItemPtr items;
1333424e9256Smrg};
1334424e9256Smrg
13356260e5d5Smrgdrm_public drmModeAtomicReqPtr drmModeAtomicAlloc(void)
1336424e9256Smrg{
1337424e9256Smrg	drmModeAtomicReqPtr req;
1338424e9256Smrg
1339424e9256Smrg	req = drmMalloc(sizeof *req);
1340424e9256Smrg	if (!req)
1341424e9256Smrg		return NULL;
1342424e9256Smrg
1343424e9256Smrg	req->items = NULL;
1344424e9256Smrg	req->cursor = 0;
1345424e9256Smrg	req->size_items = 0;
1346424e9256Smrg
1347424e9256Smrg	return req;
1348424e9256Smrg}
1349424e9256Smrg
13506260e5d5Smrgdrm_public drmModeAtomicReqPtr drmModeAtomicDuplicate(drmModeAtomicReqPtr old)
1351424e9256Smrg{
1352424e9256Smrg	drmModeAtomicReqPtr new;
1353424e9256Smrg
1354fe517fc9Smrg	if (!old)
1355fe517fc9Smrg		return NULL;
1356fe517fc9Smrg
1357424e9256Smrg	new = drmMalloc(sizeof *new);
1358424e9256Smrg	if (!new)
1359424e9256Smrg		return NULL;
1360424e9256Smrg
1361424e9256Smrg	new->cursor = old->cursor;
1362424e9256Smrg	new->size_items = old->size_items;
1363424e9256Smrg
1364424e9256Smrg	if (old->size_items) {
1365424e9256Smrg		new->items = drmMalloc(old->size_items * sizeof(*new->items));
1366424e9256Smrg		if (!new->items) {
1367424e9256Smrg			free(new);
1368424e9256Smrg			return NULL;
1369424e9256Smrg		}
1370424e9256Smrg		memcpy(new->items, old->items,
1371bf6cc7dcSmrg		       old->cursor * sizeof(*new->items));
1372424e9256Smrg	} else {
1373424e9256Smrg		new->items = NULL;
1374424e9256Smrg	}
1375424e9256Smrg
1376424e9256Smrg	return new;
1377424e9256Smrg}
1378424e9256Smrg
13796260e5d5Smrgdrm_public int drmModeAtomicMerge(drmModeAtomicReqPtr base,
13806260e5d5Smrg                                  drmModeAtomicReqPtr augment)
1381424e9256Smrg{
1382fe517fc9Smrg	if (!base)
1383fe517fc9Smrg		return -EINVAL;
1384fe517fc9Smrg
1385424e9256Smrg	if (!augment || augment->cursor == 0)
1386424e9256Smrg		return 0;
1387424e9256Smrg
1388424e9256Smrg	if (base->cursor + augment->cursor >= base->size_items) {
1389424e9256Smrg		drmModeAtomicReqItemPtr new;
1390424e9256Smrg		int saved_size = base->size_items;
1391424e9256Smrg
1392424e9256Smrg		base->size_items = base->cursor + augment->cursor;
1393424e9256Smrg		new = realloc(base->items,
1394424e9256Smrg			      base->size_items * sizeof(*base->items));
1395424e9256Smrg		if (!new) {
1396424e9256Smrg			base->size_items = saved_size;
1397424e9256Smrg			return -ENOMEM;
1398424e9256Smrg		}
1399424e9256Smrg		base->items = new;
1400424e9256Smrg	}
1401424e9256Smrg
1402424e9256Smrg	memcpy(&base->items[base->cursor], augment->items,
1403424e9256Smrg	       augment->cursor * sizeof(*augment->items));
1404424e9256Smrg	base->cursor += augment->cursor;
1405424e9256Smrg
1406424e9256Smrg	return 0;
1407424e9256Smrg}
1408424e9256Smrg
14096260e5d5Smrgdrm_public int drmModeAtomicGetCursor(drmModeAtomicReqPtr req)
1410424e9256Smrg{
1411fe517fc9Smrg	if (!req)
1412fe517fc9Smrg		return -EINVAL;
1413424e9256Smrg	return req->cursor;
1414424e9256Smrg}
1415424e9256Smrg
14166260e5d5Smrgdrm_public void drmModeAtomicSetCursor(drmModeAtomicReqPtr req, int cursor)
1417424e9256Smrg{
1418fe517fc9Smrg	if (req)
1419fe517fc9Smrg		req->cursor = cursor;
1420424e9256Smrg}
1421424e9256Smrg
14226260e5d5Smrgdrm_public int drmModeAtomicAddProperty(drmModeAtomicReqPtr req,
14236260e5d5Smrg                                        uint32_t object_id,
14246260e5d5Smrg                                        uint32_t property_id,
14256260e5d5Smrg                                        uint64_t value)
1426424e9256Smrg{
1427fe517fc9Smrg	if (!req)
1428fe517fc9Smrg		return -EINVAL;
1429fe517fc9Smrg
14306260e5d5Smrg	if (object_id == 0 || property_id == 0)
14316260e5d5Smrg		return -EINVAL;
14326260e5d5Smrg
1433424e9256Smrg	if (req->cursor >= req->size_items) {
1434bf6cc7dcSmrg		const uint32_t item_size_inc = getpagesize() / sizeof(*req->items);
1435424e9256Smrg		drmModeAtomicReqItemPtr new;
1436424e9256Smrg
1437bf6cc7dcSmrg		req->size_items += item_size_inc;
1438424e9256Smrg		new = realloc(req->items, req->size_items * sizeof(*req->items));
1439424e9256Smrg		if (!new) {
1440bf6cc7dcSmrg			req->size_items -= item_size_inc;
1441424e9256Smrg			return -ENOMEM;
1442424e9256Smrg		}
1443424e9256Smrg		req->items = new;
1444424e9256Smrg	}
1445424e9256Smrg
1446424e9256Smrg	req->items[req->cursor].object_id = object_id;
1447424e9256Smrg	req->items[req->cursor].property_id = property_id;
1448424e9256Smrg	req->items[req->cursor].value = value;
1449424e9256Smrg	req->cursor++;
1450424e9256Smrg
1451424e9256Smrg	return req->cursor;
1452424e9256Smrg}
1453424e9256Smrg
14546260e5d5Smrgdrm_public void drmModeAtomicFree(drmModeAtomicReqPtr req)
1455424e9256Smrg{
1456424e9256Smrg	if (!req)
1457424e9256Smrg		return;
1458424e9256Smrg
1459424e9256Smrg	if (req->items)
1460424e9256Smrg		drmFree(req->items);
1461424e9256Smrg	drmFree(req);
1462424e9256Smrg}
1463424e9256Smrg
1464424e9256Smrgstatic int sort_req_list(const void *misc, const void *other)
1465424e9256Smrg{
1466424e9256Smrg	const drmModeAtomicReqItem *first = misc;
1467424e9256Smrg	const drmModeAtomicReqItem *second = other;
1468424e9256Smrg
1469424e9256Smrg	if (first->object_id < second->object_id)
1470424e9256Smrg		return -1;
1471424e9256Smrg	else if (first->object_id > second->object_id)
1472424e9256Smrg		return 1;
1473424e9256Smrg	else
1474424e9256Smrg		return second->property_id - first->property_id;
1475424e9256Smrg}
1476424e9256Smrg
14776260e5d5Smrgdrm_public int drmModeAtomicCommit(int fd, drmModeAtomicReqPtr req,
14786260e5d5Smrg                                   uint32_t flags, void *user_data)
1479424e9256Smrg{
1480fe517fc9Smrg	drmModeAtomicReqPtr sorted;
1481424e9256Smrg	struct drm_mode_atomic atomic;
1482424e9256Smrg	uint32_t *objs_ptr = NULL;
1483424e9256Smrg	uint32_t *count_props_ptr = NULL;
1484424e9256Smrg	uint32_t *props_ptr = NULL;
1485424e9256Smrg	uint64_t *prop_values_ptr = NULL;
1486424e9256Smrg	uint32_t last_obj_id = 0;
1487424e9256Smrg	uint32_t i;
1488424e9256Smrg	int obj_idx = -1;
1489424e9256Smrg	int ret = -1;
1490424e9256Smrg
1491fe517fc9Smrg	if (!req)
1492fe517fc9Smrg		return -EINVAL;
1493fe517fc9Smrg
1494fe517fc9Smrg	if (req->cursor == 0)
1495fe517fc9Smrg		return 0;
1496fe517fc9Smrg
1497fe517fc9Smrg	sorted = drmModeAtomicDuplicate(req);
1498fe517fc9Smrg	if (sorted == NULL)
1499424e9256Smrg		return -ENOMEM;
1500424e9256Smrg
1501424e9256Smrg	memclear(atomic);
1502424e9256Smrg
1503424e9256Smrg	/* Sort the list by object ID, then by property ID. */
1504424e9256Smrg	qsort(sorted->items, sorted->cursor, sizeof(*sorted->items),
1505424e9256Smrg	      sort_req_list);
1506424e9256Smrg
1507424e9256Smrg	/* Now the list is sorted, eliminate duplicate property sets. */
1508424e9256Smrg	for (i = 0; i < sorted->cursor; i++) {
1509424e9256Smrg		if (sorted->items[i].object_id != last_obj_id) {
1510424e9256Smrg			atomic.count_objs++;
1511424e9256Smrg			last_obj_id = sorted->items[i].object_id;
1512424e9256Smrg		}
1513424e9256Smrg
1514424e9256Smrg		if (i == sorted->cursor - 1)
1515424e9256Smrg			continue;
1516424e9256Smrg
1517424e9256Smrg		if (sorted->items[i].object_id != sorted->items[i + 1].object_id ||
1518424e9256Smrg		    sorted->items[i].property_id != sorted->items[i + 1].property_id)
1519424e9256Smrg			continue;
1520424e9256Smrg
1521424e9256Smrg		memmove(&sorted->items[i], &sorted->items[i + 1],
1522424e9256Smrg			(sorted->cursor - i - 1) * sizeof(*sorted->items));
1523424e9256Smrg		sorted->cursor--;
1524424e9256Smrg	}
1525424e9256Smrg
1526424e9256Smrg	objs_ptr = drmMalloc(atomic.count_objs * sizeof objs_ptr[0]);
1527424e9256Smrg	if (!objs_ptr) {
1528424e9256Smrg		errno = ENOMEM;
1529424e9256Smrg		goto out;
1530424e9256Smrg	}
1531424e9256Smrg
1532424e9256Smrg	count_props_ptr = drmMalloc(atomic.count_objs * sizeof count_props_ptr[0]);
1533424e9256Smrg	if (!count_props_ptr) {
1534424e9256Smrg		errno = ENOMEM;
1535424e9256Smrg		goto out;
1536424e9256Smrg	}
1537424e9256Smrg
1538424e9256Smrg	props_ptr = drmMalloc(sorted->cursor * sizeof props_ptr[0]);
1539424e9256Smrg	if (!props_ptr) {
1540424e9256Smrg		errno = ENOMEM;
1541424e9256Smrg		goto out;
1542424e9256Smrg	}
1543424e9256Smrg
1544424e9256Smrg	prop_values_ptr = drmMalloc(sorted->cursor * sizeof prop_values_ptr[0]);
1545424e9256Smrg	if (!prop_values_ptr) {
1546424e9256Smrg		errno = ENOMEM;
1547424e9256Smrg		goto out;
1548424e9256Smrg	}
1549424e9256Smrg
1550424e9256Smrg	for (i = 0, last_obj_id = 0; i < sorted->cursor; i++) {
1551424e9256Smrg		if (sorted->items[i].object_id != last_obj_id) {
1552424e9256Smrg			obj_idx++;
1553424e9256Smrg			objs_ptr[obj_idx] = sorted->items[i].object_id;
1554424e9256Smrg			last_obj_id = objs_ptr[obj_idx];
1555424e9256Smrg		}
1556424e9256Smrg
1557424e9256Smrg		count_props_ptr[obj_idx]++;
1558424e9256Smrg		props_ptr[i] = sorted->items[i].property_id;
1559424e9256Smrg		prop_values_ptr[i] = sorted->items[i].value;
1560424e9256Smrg
1561424e9256Smrg	}
1562424e9256Smrg
1563424e9256Smrg	atomic.flags = flags;
1564424e9256Smrg	atomic.objs_ptr = VOID2U64(objs_ptr);
1565424e9256Smrg	atomic.count_props_ptr = VOID2U64(count_props_ptr);
1566424e9256Smrg	atomic.props_ptr = VOID2U64(props_ptr);
1567424e9256Smrg	atomic.prop_values_ptr = VOID2U64(prop_values_ptr);
1568424e9256Smrg	atomic.user_data = VOID2U64(user_data);
1569424e9256Smrg
1570424e9256Smrg	ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_ATOMIC, &atomic);
1571424e9256Smrg
1572424e9256Smrgout:
1573424e9256Smrg	drmFree(objs_ptr);
1574424e9256Smrg	drmFree(count_props_ptr);
1575424e9256Smrg	drmFree(props_ptr);
1576424e9256Smrg	drmFree(prop_values_ptr);
1577424e9256Smrg	drmModeAtomicFree(sorted);
1578424e9256Smrg
1579424e9256Smrg	return ret;
1580424e9256Smrg}
1581424e9256Smrg
15826260e5d5Smrgdrm_public int
15836260e5d5SmrgdrmModeCreatePropertyBlob(int fd, const void *data, size_t length,
15846260e5d5Smrg                                     uint32_t *id)
1585424e9256Smrg{
1586424e9256Smrg	struct drm_mode_create_blob create;
1587424e9256Smrg	int ret;
1588424e9256Smrg
1589424e9256Smrg	if (length >= 0xffffffff)
1590424e9256Smrg		return -ERANGE;
1591424e9256Smrg
1592424e9256Smrg	memclear(create);
1593424e9256Smrg
1594424e9256Smrg	create.length = length;
1595424e9256Smrg	create.data = (uintptr_t) data;
1596424e9256Smrg	create.blob_id = 0;
1597424e9256Smrg	*id = 0;
1598424e9256Smrg
1599424e9256Smrg	ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_CREATEPROPBLOB, &create);
1600424e9256Smrg	if (ret != 0)
1601424e9256Smrg		return ret;
1602424e9256Smrg
1603424e9256Smrg	*id = create.blob_id;
1604424e9256Smrg	return 0;
1605424e9256Smrg}
1606424e9256Smrg
16076260e5d5Smrgdrm_public int
1608424e9256SmrgdrmModeDestroyPropertyBlob(int fd, uint32_t id)
1609424e9256Smrg{
1610424e9256Smrg	struct drm_mode_destroy_blob destroy;
1611424e9256Smrg
1612424e9256Smrg	memclear(destroy);
1613424e9256Smrg	destroy.blob_id = id;
1614424e9256Smrg	return DRM_IOCTL(fd, DRM_IOCTL_MODE_DESTROYPROPBLOB, &destroy);
1615424e9256Smrg}
16162b90624aSmrg
16176260e5d5Smrgdrm_public int
16186260e5d5SmrgdrmModeCreateLease(int fd, const uint32_t *objects, int num_objects, int flags,
16196260e5d5Smrg                   uint32_t *lessee_id)
16202b90624aSmrg{
16212b90624aSmrg	struct drm_mode_create_lease create;
16222b90624aSmrg	int ret;
16232b90624aSmrg
16242b90624aSmrg	memclear(create);
16252b90624aSmrg	create.object_ids = (uintptr_t) objects;
16262b90624aSmrg	create.object_count = num_objects;
16272b90624aSmrg	create.flags = flags;
16282b90624aSmrg
16292b90624aSmrg	ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_CREATE_LEASE, &create);
16302b90624aSmrg	if (ret == 0) {
16312b90624aSmrg		*lessee_id = create.lessee_id;
16322b90624aSmrg		return create.fd;
16332b90624aSmrg	}
16342b90624aSmrg	return -errno;
16352b90624aSmrg}
16362b90624aSmrg
16376260e5d5Smrgdrm_public drmModeLesseeListPtr
16382b90624aSmrgdrmModeListLessees(int fd)
16392b90624aSmrg{
16402b90624aSmrg	struct drm_mode_list_lessees list;
16412b90624aSmrg	uint32_t count;
16422b90624aSmrg	drmModeLesseeListPtr ret;
16432b90624aSmrg
16442b90624aSmrg	memclear(list);
16452b90624aSmrg
16462b90624aSmrg	if (DRM_IOCTL(fd, DRM_IOCTL_MODE_LIST_LESSEES, &list))
16472b90624aSmrg		return NULL;
16482b90624aSmrg
16492b90624aSmrg	count = list.count_lessees;
16502b90624aSmrg	ret = drmMalloc(sizeof (drmModeLesseeListRes) + count * sizeof (ret->lessees[0]));
16512b90624aSmrg	if (!ret)
16522b90624aSmrg		return NULL;
16532b90624aSmrg
16542b90624aSmrg	list.lessees_ptr = VOID2U64(&ret->lessees[0]);
16552b90624aSmrg	if (DRM_IOCTL(fd, DRM_IOCTL_MODE_LIST_LESSEES, &list)) {
16562b90624aSmrg		drmFree(ret);
16572b90624aSmrg		return NULL;
16582b90624aSmrg	}
16592b90624aSmrg
16602b90624aSmrg	ret->count = count;
16612b90624aSmrg	return ret;
16622b90624aSmrg}
16632b90624aSmrg
16646260e5d5Smrgdrm_public drmModeObjectListPtr
16652b90624aSmrgdrmModeGetLease(int fd)
16662b90624aSmrg{
16672b90624aSmrg	struct drm_mode_get_lease get;
16682b90624aSmrg	uint32_t count;
16692b90624aSmrg	drmModeObjectListPtr ret;
16702b90624aSmrg
16712b90624aSmrg	memclear(get);
16722b90624aSmrg
16732b90624aSmrg	if (DRM_IOCTL(fd, DRM_IOCTL_MODE_GET_LEASE, &get))
16742b90624aSmrg		return NULL;
16752b90624aSmrg
16762b90624aSmrg	count = get.count_objects;
16772b90624aSmrg	ret = drmMalloc(sizeof (drmModeObjectListRes) + count * sizeof (ret->objects[0]));
16782b90624aSmrg	if (!ret)
16792b90624aSmrg		return NULL;
16802b90624aSmrg
16812b90624aSmrg	get.objects_ptr = VOID2U64(&ret->objects[0]);
16822b90624aSmrg	if (DRM_IOCTL(fd, DRM_IOCTL_MODE_GET_LEASE, &get)) {
16832b90624aSmrg		drmFree(ret);
16842b90624aSmrg		return NULL;
16852b90624aSmrg	}
16862b90624aSmrg
16872b90624aSmrg	ret->count = count;
16882b90624aSmrg	return ret;
16892b90624aSmrg}
16902b90624aSmrg
16916260e5d5Smrgdrm_public int
16922b90624aSmrgdrmModeRevokeLease(int fd, uint32_t lessee_id)
16932b90624aSmrg{
16942b90624aSmrg	struct drm_mode_revoke_lease revoke;
16952b90624aSmrg	int ret;
16962b90624aSmrg
16972b90624aSmrg	memclear(revoke);
16982b90624aSmrg
16992b90624aSmrg	revoke.lessee_id = lessee_id;
17002b90624aSmrg
17012b90624aSmrg	ret = DRM_IOCTL(fd, DRM_IOCTL_MODE_REVOKE_LEASE, &revoke);
17022b90624aSmrg	if (ret == 0)
17032b90624aSmrg		return 0;
17042b90624aSmrg	return -errno;
17052b90624aSmrg}
170687bf8e7cSmrg
170787bf8e7cSmrgdrm_public drmModeFB2Ptr
170887bf8e7cSmrgdrmModeGetFB2(int fd, uint32_t fb_id)
170987bf8e7cSmrg{
171087bf8e7cSmrg	struct drm_mode_fb_cmd2 get = {
171187bf8e7cSmrg		.fb_id = fb_id,
171287bf8e7cSmrg	};
171387bf8e7cSmrg	drmModeFB2Ptr ret;
171487bf8e7cSmrg	int err;
171587bf8e7cSmrg
171687bf8e7cSmrg	err = DRM_IOCTL(fd, DRM_IOCTL_MODE_GETFB2, &get);
171787bf8e7cSmrg	if (err != 0)
171887bf8e7cSmrg		return NULL;
171987bf8e7cSmrg
172087bf8e7cSmrg	ret = drmMalloc(sizeof(drmModeFB2));
172187bf8e7cSmrg	if (!ret)
172287bf8e7cSmrg		return NULL;
172387bf8e7cSmrg
172487bf8e7cSmrg	ret->fb_id = fb_id;
172587bf8e7cSmrg	ret->width = get.width;
172687bf8e7cSmrg	ret->height = get.height;
172787bf8e7cSmrg	ret->pixel_format = get.pixel_format;
172887bf8e7cSmrg	ret->flags = get.flags;
172987bf8e7cSmrg	ret->modifier = get.modifier[0];
173087bf8e7cSmrg	memcpy(ret->handles, get.handles, sizeof(uint32_t) * 4);
173187bf8e7cSmrg	memcpy(ret->pitches, get.pitches, sizeof(uint32_t) * 4);
173287bf8e7cSmrg	memcpy(ret->offsets, get.offsets, sizeof(uint32_t) * 4);
173387bf8e7cSmrg
173487bf8e7cSmrg	return ret;
173587bf8e7cSmrg}
173687bf8e7cSmrg
173787bf8e7cSmrgdrm_public void drmModeFreeFB2(drmModeFB2Ptr ptr)
173887bf8e7cSmrg{
173987bf8e7cSmrg	drmFree(ptr);
174087bf8e7cSmrg}
1741