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