mirror of
https://github.com/systemd/systemd.git
synced 2024-11-08 11:27:32 +03:00
f131770b14
https://github.com/vlajos/misspell_fixer
b6fdeb618c
Thanks to Torstein Husebo <torstein@huseboe.net>.
3097 lines
110 KiB
C
3097 lines
110 KiB
C
/*-*- Mode: C; c-basic-offset: 8; indent-tabs-mode: nil -*-*/
|
|
|
|
/***
|
|
This file is part of systemd.
|
|
|
|
Copyright (C) 2014 David Herrmann <dh.herrmann@gmail.com>
|
|
|
|
systemd is free software; you can redistribute it and/or modify it
|
|
under the terms of the GNU Lesser General Public License as published by
|
|
the Free Software Foundation; either version 2.1 of the License, or
|
|
(at your option) any later version.
|
|
|
|
systemd is distributed in the hope that it will be useful, but
|
|
WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Lesser General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Lesser General Public License
|
|
along with systemd; If not, see <http://www.gnu.org/licenses/>.
|
|
***/
|
|
|
|
#include <fcntl.h>
|
|
#include <inttypes.h>
|
|
#include <libudev.h>
|
|
#include <stdbool.h>
|
|
#include <stdlib.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/mman.h>
|
|
#include <sys/types.h>
|
|
#include <systemd/sd-bus.h>
|
|
#include <systemd/sd-event.h>
|
|
#include <unistd.h>
|
|
|
|
/* Yuck! DRM headers need system headers included first.. but we have to
|
|
* include it before shared/missing.h to avoid redefining ioctl bits */
|
|
#include <drm.h>
|
|
#include <drm_fourcc.h>
|
|
#include <drm_mode.h>
|
|
|
|
#include "bus-util.h"
|
|
#include "hashmap.h"
|
|
#include "grdev.h"
|
|
#include "grdev-internal.h"
|
|
#include "macro.h"
|
|
#include "udev-util.h"
|
|
#include "util.h"
|
|
|
|
#define GRDRM_MAX_TRIES (16)
|
|
|
|
typedef struct grdrm_object grdrm_object;
|
|
typedef struct grdrm_plane grdrm_plane;
|
|
typedef struct grdrm_connector grdrm_connector;
|
|
typedef struct grdrm_encoder grdrm_encoder;
|
|
typedef struct grdrm_crtc grdrm_crtc;
|
|
|
|
typedef struct grdrm_fb grdrm_fb;
|
|
typedef struct grdrm_pipe grdrm_pipe;
|
|
typedef struct grdrm_card grdrm_card;
|
|
typedef struct unmanaged_card unmanaged_card;
|
|
typedef struct managed_card managed_card;
|
|
|
|
/*
|
|
* Objects
|
|
*/
|
|
|
|
enum {
|
|
GRDRM_TYPE_CRTC,
|
|
GRDRM_TYPE_ENCODER,
|
|
GRDRM_TYPE_CONNECTOR,
|
|
GRDRM_TYPE_PLANE,
|
|
GRDRM_TYPE_CNT
|
|
};
|
|
|
|
struct grdrm_object {
|
|
grdrm_card *card;
|
|
uint32_t id;
|
|
uint32_t index;
|
|
unsigned int type;
|
|
void (*free_fn) (grdrm_object *object);
|
|
|
|
bool present : 1;
|
|
bool assigned : 1;
|
|
};
|
|
|
|
struct grdrm_plane {
|
|
grdrm_object object;
|
|
|
|
struct {
|
|
uint32_t used_crtc;
|
|
uint32_t used_fb;
|
|
uint32_t gamma_size;
|
|
|
|
uint32_t n_crtcs;
|
|
uint32_t max_crtcs;
|
|
uint32_t *crtcs;
|
|
uint32_t n_formats;
|
|
uint32_t max_formats;
|
|
uint32_t *formats;
|
|
} kern;
|
|
};
|
|
|
|
struct grdrm_connector {
|
|
grdrm_object object;
|
|
|
|
struct {
|
|
uint32_t type;
|
|
uint32_t type_id;
|
|
uint32_t used_encoder;
|
|
uint32_t connection;
|
|
uint32_t mm_width;
|
|
uint32_t mm_height;
|
|
uint32_t subpixel;
|
|
|
|
uint32_t n_encoders;
|
|
uint32_t max_encoders;
|
|
uint32_t *encoders;
|
|
uint32_t n_modes;
|
|
uint32_t max_modes;
|
|
struct drm_mode_modeinfo *modes;
|
|
uint32_t n_props;
|
|
uint32_t max_props;
|
|
uint32_t *prop_ids;
|
|
uint64_t *prop_values;
|
|
} kern;
|
|
};
|
|
|
|
struct grdrm_encoder {
|
|
grdrm_object object;
|
|
|
|
struct {
|
|
uint32_t type;
|
|
uint32_t used_crtc;
|
|
|
|
uint32_t n_crtcs;
|
|
uint32_t max_crtcs;
|
|
uint32_t *crtcs;
|
|
uint32_t n_clones;
|
|
uint32_t max_clones;
|
|
uint32_t *clones;
|
|
} kern;
|
|
};
|
|
|
|
struct grdrm_crtc {
|
|
grdrm_object object;
|
|
|
|
struct {
|
|
uint32_t used_fb;
|
|
uint32_t fb_offset_x;
|
|
uint32_t fb_offset_y;
|
|
uint32_t gamma_size;
|
|
|
|
uint32_t n_used_connectors;
|
|
uint32_t max_used_connectors;
|
|
uint32_t *used_connectors;
|
|
|
|
bool mode_set;
|
|
struct drm_mode_modeinfo mode;
|
|
} kern;
|
|
|
|
struct {
|
|
bool set;
|
|
uint32_t fb;
|
|
uint32_t fb_x;
|
|
uint32_t fb_y;
|
|
uint32_t gamma;
|
|
|
|
uint32_t n_connectors;
|
|
uint32_t *connectors;
|
|
|
|
bool mode_set;
|
|
struct drm_mode_modeinfo mode;
|
|
} old;
|
|
|
|
struct {
|
|
struct drm_mode_modeinfo mode;
|
|
uint32_t n_connectors;
|
|
uint32_t max_connectors;
|
|
uint32_t *connectors;
|
|
} set;
|
|
|
|
grdrm_pipe *pipe;
|
|
|
|
bool applied : 1;
|
|
};
|
|
|
|
#define GRDRM_OBJECT_INIT(_card, _id, _index, _type, _free_fn) ((grdrm_object){ \
|
|
.card = (_card), \
|
|
.id = (_id), \
|
|
.index = (_index), \
|
|
.type = (_type), \
|
|
.free_fn = (_free_fn), \
|
|
})
|
|
|
|
grdrm_object *grdrm_find_object(grdrm_card *card, uint32_t id);
|
|
int grdrm_object_add(grdrm_object *object);
|
|
grdrm_object *grdrm_object_free(grdrm_object *object);
|
|
|
|
DEFINE_TRIVIAL_CLEANUP_FUNC(grdrm_object*, grdrm_object_free);
|
|
|
|
int grdrm_plane_new(grdrm_plane **out, grdrm_card *card, uint32_t id, uint32_t index);
|
|
int grdrm_connector_new(grdrm_connector **out, grdrm_card *card, uint32_t id, uint32_t index);
|
|
int grdrm_encoder_new(grdrm_encoder **out, grdrm_card *card, uint32_t id, uint32_t index);
|
|
int grdrm_crtc_new(grdrm_crtc **out, grdrm_card *card, uint32_t id, uint32_t index);
|
|
|
|
#define plane_from_object(_obj) container_of((_obj), grdrm_plane, object)
|
|
#define connector_from_object(_obj) container_of((_obj), grdrm_connector, object)
|
|
#define encoder_from_object(_obj) container_of((_obj), grdrm_encoder, object)
|
|
#define crtc_from_object(_obj) container_of((_obj), grdrm_crtc, object)
|
|
|
|
/*
|
|
* Framebuffers
|
|
*/
|
|
|
|
struct grdrm_fb {
|
|
grdev_fb base;
|
|
grdrm_card *card;
|
|
uint32_t id;
|
|
uint32_t handles[4];
|
|
uint32_t offsets[4];
|
|
uint32_t sizes[4];
|
|
uint32_t flipid;
|
|
};
|
|
|
|
static int grdrm_fb_new(grdrm_fb **out, grdrm_card *card, const struct drm_mode_modeinfo *mode);
|
|
grdrm_fb *grdrm_fb_free(grdrm_fb *fb);
|
|
|
|
DEFINE_TRIVIAL_CLEANUP_FUNC(grdrm_fb*, grdrm_fb_free);
|
|
|
|
#define fb_from_base(_fb) container_of((_fb), grdrm_fb, base)
|
|
|
|
/*
|
|
* Pipes
|
|
*/
|
|
|
|
struct grdrm_pipe {
|
|
grdev_pipe base;
|
|
grdrm_crtc *crtc;
|
|
uint32_t counter;
|
|
};
|
|
|
|
#define grdrm_pipe_from_base(_e) container_of((_e), grdrm_pipe, base)
|
|
|
|
#define GRDRM_PIPE_NAME_MAX (GRDRM_CARD_NAME_MAX + 1 + DECIMAL_STR_MAX(uint32_t))
|
|
|
|
static const grdev_pipe_vtable grdrm_pipe_vtable;
|
|
|
|
static int grdrm_pipe_new(grdrm_pipe **out, grdrm_crtc *crtc, struct drm_mode_modeinfo *mode, size_t n_fbs);
|
|
|
|
/*
|
|
* Cards
|
|
*/
|
|
|
|
struct grdrm_card {
|
|
grdev_card base;
|
|
|
|
int fd;
|
|
sd_event_source *fd_src;
|
|
|
|
uint32_t n_crtcs;
|
|
uint32_t n_encoders;
|
|
uint32_t n_connectors;
|
|
uint32_t n_planes;
|
|
uint32_t max_ids;
|
|
Hashmap *object_map;
|
|
|
|
bool async_hotplug : 1;
|
|
bool hotplug : 1;
|
|
bool running : 1;
|
|
bool ready : 1;
|
|
bool cap_dumb : 1;
|
|
bool cap_monotonic : 1;
|
|
};
|
|
|
|
struct unmanaged_card {
|
|
grdrm_card card;
|
|
char *devnode;
|
|
};
|
|
|
|
struct managed_card {
|
|
grdrm_card card;
|
|
dev_t devnum;
|
|
|
|
sd_bus_slot *slot_pause_device;
|
|
sd_bus_slot *slot_resume_device;
|
|
sd_bus_slot *slot_take_device;
|
|
|
|
bool requested : 1; /* TakeDevice() was sent */
|
|
bool acquired : 1; /* TakeDevice() was successful */
|
|
bool master : 1; /* we are DRM-Master */
|
|
};
|
|
|
|
#define grdrm_card_from_base(_e) container_of((_e), grdrm_card, base)
|
|
#define unmanaged_card_from_base(_e) \
|
|
container_of(grdrm_card_from_base(_e), unmanaged_card, card)
|
|
#define managed_card_from_base(_e) \
|
|
container_of(grdrm_card_from_base(_e), managed_card, card)
|
|
|
|
#define GRDRM_CARD_INIT(_vtable, _session) ((grdrm_card){ \
|
|
.base = GRDEV_CARD_INIT((_vtable), (_session)), \
|
|
.fd = -1, \
|
|
.max_ids = 32, \
|
|
})
|
|
|
|
#define GRDRM_CARD_NAME_MAX (6 + DECIMAL_STR_MAX(unsigned) * 2)
|
|
|
|
static const grdev_card_vtable unmanaged_card_vtable;
|
|
static const grdev_card_vtable managed_card_vtable;
|
|
|
|
static int grdrm_card_open(grdrm_card *card, int dev_fd);
|
|
static void grdrm_card_close(grdrm_card *card);
|
|
static bool grdrm_card_async(grdrm_card *card, int r);
|
|
|
|
/*
|
|
* The page-flip event of the kernel provides 64bit of arbitrary user-data. As
|
|
* drivers tend to drop events on intermediate deep mode-sets or because we
|
|
* might receive events during session activation, we try to avoid allocaing
|
|
* dynamic data on those events. Instead, we safe the CRTC id plus a 32bit
|
|
* counter in there. This way, we only get 32bit counters, not 64bit, but that
|
|
* should be more than enough. On the bright side, we no longer care whether we
|
|
* lose events. No memory leaks will occur.
|
|
* Modern DRM drivers might be fixed to no longer leak events, but we want to
|
|
* be safe. And associating dynamically allocated data with those events is
|
|
* kinda ugly, anyway.
|
|
*/
|
|
|
|
static uint64_t grdrm_encode_vblank_data(uint32_t id, uint32_t counter) {
|
|
return id | ((uint64_t)counter << 32);
|
|
}
|
|
|
|
static void grdrm_decode_vblank_data(uint64_t data, uint32_t *out_id, uint32_t *out_counter) {
|
|
if (out_id)
|
|
*out_id = data & 0xffffffffU;
|
|
if (out_counter)
|
|
*out_counter = (data >> 32) & 0xffffffffU;
|
|
}
|
|
|
|
static bool grdrm_modes_compatible(const struct drm_mode_modeinfo *a, const struct drm_mode_modeinfo *b) {
|
|
assert(a);
|
|
assert(b);
|
|
|
|
/* Test whether both modes are compatible according to our internal
|
|
* assumptions on modes. This comparison is highly dependent on how
|
|
* we treat modes in grdrm. If we export mode details, we need to
|
|
* make this comparison much stricter. */
|
|
|
|
if (a->hdisplay != b->hdisplay)
|
|
return false;
|
|
if (a->vdisplay != b->vdisplay)
|
|
return false;
|
|
if (a->vrefresh != b->vrefresh)
|
|
return false;
|
|
|
|
return true;
|
|
}
|
|
|
|
/*
|
|
* Objects
|
|
*/
|
|
|
|
grdrm_object *grdrm_find_object(grdrm_card *card, uint32_t id) {
|
|
assert_return(card, NULL);
|
|
|
|
return id > 0 ? hashmap_get(card->object_map, UINT32_TO_PTR(id)) : NULL;
|
|
}
|
|
|
|
int grdrm_object_add(grdrm_object *object) {
|
|
int r;
|
|
|
|
assert(object);
|
|
assert(object->card);
|
|
assert(object->id > 0);
|
|
assert(IN_SET(object->type, GRDRM_TYPE_CRTC, GRDRM_TYPE_ENCODER, GRDRM_TYPE_CONNECTOR, GRDRM_TYPE_PLANE));
|
|
assert(object->free_fn);
|
|
|
|
if (object->index >= 32)
|
|
log_debug("grdrm: %s: object index exceeds 32bit masks: type=%u, index=%" PRIu32,
|
|
object->card->base.name, object->type, object->index);
|
|
|
|
r = hashmap_put(object->card->object_map, UINT32_TO_PTR(object->id), object);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
return 0;
|
|
}
|
|
|
|
grdrm_object *grdrm_object_free(grdrm_object *object) {
|
|
if (!object)
|
|
return NULL;
|
|
|
|
assert(object->card);
|
|
assert(object->id > 0);
|
|
assert(IN_SET(object->type, GRDRM_TYPE_CRTC, GRDRM_TYPE_ENCODER, GRDRM_TYPE_CONNECTOR, GRDRM_TYPE_PLANE));
|
|
assert(object->free_fn);
|
|
|
|
hashmap_remove_value(object->card->object_map, UINT32_TO_PTR(object->id), object);
|
|
|
|
object->free_fn(object);
|
|
return NULL;
|
|
}
|
|
|
|
/*
|
|
* Planes
|
|
*/
|
|
|
|
static void plane_free(grdrm_object *object) {
|
|
grdrm_plane *plane = plane_from_object(object);
|
|
|
|
free(plane->kern.formats);
|
|
free(plane->kern.crtcs);
|
|
free(plane);
|
|
}
|
|
|
|
int grdrm_plane_new(grdrm_plane **out, grdrm_card *card, uint32_t id, uint32_t index) {
|
|
_cleanup_(grdrm_object_freep) grdrm_object *object = NULL;
|
|
grdrm_plane *plane;
|
|
int r;
|
|
|
|
assert(card);
|
|
|
|
plane = new0(grdrm_plane, 1);
|
|
if (!plane)
|
|
return -ENOMEM;
|
|
|
|
object = &plane->object;
|
|
*object = GRDRM_OBJECT_INIT(card, id, index, GRDRM_TYPE_PLANE, plane_free);
|
|
|
|
plane->kern.max_crtcs = 32;
|
|
plane->kern.crtcs = new0(uint32_t, plane->kern.max_crtcs);
|
|
if (!plane->kern.crtcs)
|
|
return -ENOMEM;
|
|
|
|
plane->kern.max_formats = 32;
|
|
plane->kern.formats = new0(uint32_t, plane->kern.max_formats);
|
|
if (!plane->kern.formats)
|
|
return -ENOMEM;
|
|
|
|
r = grdrm_object_add(object);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
if (out)
|
|
*out = plane;
|
|
object = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static int grdrm_plane_resync(grdrm_plane *plane) {
|
|
grdrm_card *card = plane->object.card;
|
|
size_t tries;
|
|
int r;
|
|
|
|
assert(plane);
|
|
|
|
for (tries = 0; tries < GRDRM_MAX_TRIES; ++tries) {
|
|
struct drm_mode_get_plane res;
|
|
grdrm_object *object;
|
|
bool resized = false;
|
|
Iterator iter;
|
|
|
|
zero(res);
|
|
res.plane_id = plane->object.id;
|
|
res.format_type_ptr = PTR_TO_UINT64(plane->kern.formats);
|
|
res.count_format_types = plane->kern.max_formats;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_GETPLANE, &res);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
if (r == -ENOENT) {
|
|
card->async_hotplug = true;
|
|
r = 0;
|
|
log_debug("grdrm: %s: plane %u removed during resync",
|
|
card->base.name, plane->object.id);
|
|
} else {
|
|
log_debug_errno(errno, "grdrm: %s: cannot retrieve plane %u: %m",
|
|
card->base.name, plane->object.id);
|
|
}
|
|
|
|
return r;
|
|
}
|
|
|
|
plane->kern.n_crtcs = 0;
|
|
memzero(plane->kern.crtcs, sizeof(uint32_t) * plane->kern.max_crtcs);
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (object->type != GRDRM_TYPE_CRTC || object->index >= 32)
|
|
continue;
|
|
if (!(res.possible_crtcs & (1 << object->index)))
|
|
continue;
|
|
if (plane->kern.n_crtcs >= 32) {
|
|
log_debug("grdrm: %s: possible_crtcs of plane %" PRIu32 " exceeds 32bit mask",
|
|
card->base.name, plane->object.id);
|
|
continue;
|
|
}
|
|
|
|
plane->kern.crtcs[plane->kern.n_crtcs++] = object->id;
|
|
}
|
|
|
|
if (res.count_format_types > plane->kern.max_formats) {
|
|
uint32_t max, *t;
|
|
|
|
max = ALIGN_POWER2(res.count_format_types);
|
|
if (!max || max > UINT16_MAX) {
|
|
log_debug("grdrm: %s: excessive plane resource limit: %" PRIu32, card->base.name, max);
|
|
return -ERANGE;
|
|
}
|
|
|
|
t = realloc(plane->kern.formats, sizeof(*t) * max);
|
|
if (!t)
|
|
return -ENOMEM;
|
|
|
|
plane->kern.formats = t;
|
|
plane->kern.max_formats = max;
|
|
resized = true;
|
|
}
|
|
|
|
if (resized)
|
|
continue;
|
|
|
|
plane->kern.n_formats = res.count_format_types;
|
|
plane->kern.used_crtc = res.crtc_id;
|
|
plane->kern.used_fb = res.fb_id;
|
|
plane->kern.gamma_size = res.gamma_size;
|
|
|
|
break;
|
|
}
|
|
|
|
if (tries >= GRDRM_MAX_TRIES) {
|
|
log_debug("grdrm: %s: plane %u not settled for retrieval", card->base.name, plane->object.id);
|
|
return -EFAULT;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Connectors
|
|
*/
|
|
|
|
static void connector_free(grdrm_object *object) {
|
|
grdrm_connector *connector = connector_from_object(object);
|
|
|
|
free(connector->kern.prop_values);
|
|
free(connector->kern.prop_ids);
|
|
free(connector->kern.modes);
|
|
free(connector->kern.encoders);
|
|
free(connector);
|
|
}
|
|
|
|
int grdrm_connector_new(grdrm_connector **out, grdrm_card *card, uint32_t id, uint32_t index) {
|
|
_cleanup_(grdrm_object_freep) grdrm_object *object = NULL;
|
|
grdrm_connector *connector;
|
|
int r;
|
|
|
|
assert(card);
|
|
|
|
connector = new0(grdrm_connector, 1);
|
|
if (!connector)
|
|
return -ENOMEM;
|
|
|
|
object = &connector->object;
|
|
*object = GRDRM_OBJECT_INIT(card, id, index, GRDRM_TYPE_CONNECTOR, connector_free);
|
|
|
|
connector->kern.max_encoders = 32;
|
|
connector->kern.encoders = new0(uint32_t, connector->kern.max_encoders);
|
|
if (!connector->kern.encoders)
|
|
return -ENOMEM;
|
|
|
|
connector->kern.max_modes = 32;
|
|
connector->kern.modes = new0(struct drm_mode_modeinfo, connector->kern.max_modes);
|
|
if (!connector->kern.modes)
|
|
return -ENOMEM;
|
|
|
|
connector->kern.max_props = 32;
|
|
connector->kern.prop_ids = new0(uint32_t, connector->kern.max_props);
|
|
connector->kern.prop_values = new0(uint64_t, connector->kern.max_props);
|
|
if (!connector->kern.prop_ids || !connector->kern.prop_values)
|
|
return -ENOMEM;
|
|
|
|
r = grdrm_object_add(object);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
if (out)
|
|
*out = connector;
|
|
object = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static int grdrm_connector_resync(grdrm_connector *connector) {
|
|
grdrm_card *card = connector->object.card;
|
|
size_t tries;
|
|
int r;
|
|
|
|
assert(connector);
|
|
|
|
for (tries = 0; tries < GRDRM_MAX_TRIES; ++tries) {
|
|
struct drm_mode_get_connector res;
|
|
bool resized = false;
|
|
uint32_t max;
|
|
|
|
zero(res);
|
|
res.connector_id = connector->object.id;
|
|
res.encoders_ptr = PTR_TO_UINT64(connector->kern.encoders);
|
|
res.props_ptr = PTR_TO_UINT64(connector->kern.prop_ids);
|
|
res.prop_values_ptr = PTR_TO_UINT64(connector->kern.prop_values);
|
|
res.count_encoders = connector->kern.max_encoders;
|
|
res.count_props = connector->kern.max_props;
|
|
|
|
/* The kernel reads modes from the EDID information only if we
|
|
* pass count_modes==0. This is a legacy hack for libdrm (which
|
|
* called every ioctl twice). Now we have to adopt.. *sigh*.
|
|
* If we never received an hotplug event, there's no reason to
|
|
* sync modes. EDID reads are heavy, so skip that if not
|
|
* required. */
|
|
if (card->hotplug) {
|
|
if (tries > 0) {
|
|
res.modes_ptr = PTR_TO_UINT64(connector->kern.modes);
|
|
res.count_modes = connector->kern.max_modes;
|
|
} else {
|
|
resized = true;
|
|
}
|
|
}
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_GETCONNECTOR, &res);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
if (r == -ENOENT) {
|
|
card->async_hotplug = true;
|
|
r = 0;
|
|
log_debug("grdrm: %s: connector %u removed during resync",
|
|
card->base.name, connector->object.id);
|
|
} else {
|
|
log_debug_errno(errno, "grdrm: %s: cannot retrieve connector %u: %m",
|
|
card->base.name, connector->object.id);
|
|
}
|
|
|
|
return r;
|
|
}
|
|
|
|
if (res.count_encoders > connector->kern.max_encoders) {
|
|
uint32_t *t;
|
|
|
|
max = ALIGN_POWER2(res.count_encoders);
|
|
if (!max || max > UINT16_MAX) {
|
|
log_debug("grdrm: %s: excessive connector resource limit: %" PRIu32, card->base.name, max);
|
|
return -ERANGE;
|
|
}
|
|
|
|
t = realloc(connector->kern.encoders, sizeof(*t) * max);
|
|
if (!t)
|
|
return -ENOMEM;
|
|
|
|
connector->kern.encoders = t;
|
|
connector->kern.max_encoders = max;
|
|
resized = true;
|
|
}
|
|
|
|
if (res.count_modes > connector->kern.max_modes) {
|
|
struct drm_mode_modeinfo *t;
|
|
|
|
max = ALIGN_POWER2(res.count_modes);
|
|
if (!max || max > UINT16_MAX) {
|
|
log_debug("grdrm: %s: excessive connector resource limit: %" PRIu32, card->base.name, max);
|
|
return -ERANGE;
|
|
}
|
|
|
|
t = realloc(connector->kern.modes, sizeof(*t) * max);
|
|
if (!t)
|
|
return -ENOMEM;
|
|
|
|
connector->kern.modes = t;
|
|
connector->kern.max_modes = max;
|
|
resized = true;
|
|
}
|
|
|
|
if (res.count_props > connector->kern.max_props) {
|
|
uint32_t *tids;
|
|
uint64_t *tvals;
|
|
|
|
max = ALIGN_POWER2(res.count_props);
|
|
if (!max || max > UINT16_MAX) {
|
|
log_debug("grdrm: %s: excessive connector resource limit: %" PRIu32, card->base.name, max);
|
|
return -ERANGE;
|
|
}
|
|
|
|
tids = realloc(connector->kern.prop_ids, sizeof(*tids) * max);
|
|
if (!tids)
|
|
return -ENOMEM;
|
|
connector->kern.prop_ids = tids;
|
|
|
|
tvals = realloc(connector->kern.prop_values, sizeof(*tvals) * max);
|
|
if (!tvals)
|
|
return -ENOMEM;
|
|
connector->kern.prop_values = tvals;
|
|
|
|
connector->kern.max_props = max;
|
|
resized = true;
|
|
}
|
|
|
|
if (resized)
|
|
continue;
|
|
|
|
connector->kern.n_encoders = res.count_encoders;
|
|
connector->kern.n_props = res.count_props;
|
|
connector->kern.type = res.connector_type;
|
|
connector->kern.type_id = res.connector_type_id;
|
|
connector->kern.used_encoder = res.encoder_id;
|
|
connector->kern.connection = res.connection;
|
|
connector->kern.mm_width = res.mm_width;
|
|
connector->kern.mm_height = res.mm_height;
|
|
connector->kern.subpixel = res.subpixel;
|
|
if (res.modes_ptr == PTR_TO_UINT64(connector->kern.modes))
|
|
connector->kern.n_modes = res.count_modes;
|
|
|
|
break;
|
|
}
|
|
|
|
if (tries >= GRDRM_MAX_TRIES) {
|
|
log_debug("grdrm: %s: connector %u not settled for retrieval", card->base.name, connector->object.id);
|
|
return -EFAULT;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Encoders
|
|
*/
|
|
|
|
static void encoder_free(grdrm_object *object) {
|
|
grdrm_encoder *encoder = encoder_from_object(object);
|
|
|
|
free(encoder->kern.clones);
|
|
free(encoder->kern.crtcs);
|
|
free(encoder);
|
|
}
|
|
|
|
int grdrm_encoder_new(grdrm_encoder **out, grdrm_card *card, uint32_t id, uint32_t index) {
|
|
_cleanup_(grdrm_object_freep) grdrm_object *object = NULL;
|
|
grdrm_encoder *encoder;
|
|
int r;
|
|
|
|
assert(card);
|
|
|
|
encoder = new0(grdrm_encoder, 1);
|
|
if (!encoder)
|
|
return -ENOMEM;
|
|
|
|
object = &encoder->object;
|
|
*object = GRDRM_OBJECT_INIT(card, id, index, GRDRM_TYPE_ENCODER, encoder_free);
|
|
|
|
encoder->kern.max_crtcs = 32;
|
|
encoder->kern.crtcs = new0(uint32_t, encoder->kern.max_crtcs);
|
|
if (!encoder->kern.crtcs)
|
|
return -ENOMEM;
|
|
|
|
encoder->kern.max_clones = 32;
|
|
encoder->kern.clones = new0(uint32_t, encoder->kern.max_clones);
|
|
if (!encoder->kern.clones)
|
|
return -ENOMEM;
|
|
|
|
r = grdrm_object_add(object);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
if (out)
|
|
*out = encoder;
|
|
object = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static int grdrm_encoder_resync(grdrm_encoder *encoder) {
|
|
grdrm_card *card = encoder->object.card;
|
|
struct drm_mode_get_encoder res;
|
|
grdrm_object *object;
|
|
Iterator iter;
|
|
int r;
|
|
|
|
assert(encoder);
|
|
|
|
zero(res);
|
|
res.encoder_id = encoder->object.id;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_GETENCODER, &res);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
if (r == -ENOENT) {
|
|
card->async_hotplug = true;
|
|
r = 0;
|
|
log_debug("grdrm: %s: encoder %u removed during resync",
|
|
card->base.name, encoder->object.id);
|
|
} else {
|
|
log_debug_errno(errno, "grdrm: %s: cannot retrieve encoder %u: %m",
|
|
card->base.name, encoder->object.id);
|
|
}
|
|
|
|
return r;
|
|
}
|
|
|
|
encoder->kern.type = res.encoder_type;
|
|
encoder->kern.used_crtc = res.crtc_id;
|
|
|
|
encoder->kern.n_crtcs = 0;
|
|
memzero(encoder->kern.crtcs, sizeof(uint32_t) * encoder->kern.max_crtcs);
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (object->type != GRDRM_TYPE_CRTC || object->index >= 32)
|
|
continue;
|
|
if (!(res.possible_crtcs & (1 << object->index)))
|
|
continue;
|
|
if (encoder->kern.n_crtcs >= 32) {
|
|
log_debug("grdrm: %s: possible_crtcs exceeds 32bit mask", card->base.name);
|
|
continue;
|
|
}
|
|
|
|
encoder->kern.crtcs[encoder->kern.n_crtcs++] = object->id;
|
|
}
|
|
|
|
encoder->kern.n_clones = 0;
|
|
memzero(encoder->kern.clones, sizeof(uint32_t) * encoder->kern.max_clones);
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (object->type != GRDRM_TYPE_ENCODER || object->index >= 32)
|
|
continue;
|
|
if (!(res.possible_clones & (1 << object->index)))
|
|
continue;
|
|
if (encoder->kern.n_clones >= 32) {
|
|
log_debug("grdrm: %s: possible_encoders exceeds 32bit mask", card->base.name);
|
|
continue;
|
|
}
|
|
|
|
encoder->kern.clones[encoder->kern.n_clones++] = object->id;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Crtcs
|
|
*/
|
|
|
|
static void crtc_free(grdrm_object *object) {
|
|
grdrm_crtc *crtc = crtc_from_object(object);
|
|
|
|
if (crtc->pipe)
|
|
grdev_pipe_free(&crtc->pipe->base);
|
|
free(crtc->set.connectors);
|
|
free(crtc->old.connectors);
|
|
free(crtc->kern.used_connectors);
|
|
free(crtc);
|
|
}
|
|
|
|
int grdrm_crtc_new(grdrm_crtc **out, grdrm_card *card, uint32_t id, uint32_t index) {
|
|
_cleanup_(grdrm_object_freep) grdrm_object *object = NULL;
|
|
grdrm_crtc *crtc;
|
|
int r;
|
|
|
|
assert(card);
|
|
|
|
crtc = new0(grdrm_crtc, 1);
|
|
if (!crtc)
|
|
return -ENOMEM;
|
|
|
|
object = &crtc->object;
|
|
*object = GRDRM_OBJECT_INIT(card, id, index, GRDRM_TYPE_CRTC, crtc_free);
|
|
|
|
crtc->kern.max_used_connectors = 32;
|
|
crtc->kern.used_connectors = new0(uint32_t, crtc->kern.max_used_connectors);
|
|
if (!crtc->kern.used_connectors)
|
|
return -ENOMEM;
|
|
|
|
crtc->old.connectors = new0(uint32_t, crtc->kern.max_used_connectors);
|
|
if (!crtc->old.connectors)
|
|
return -ENOMEM;
|
|
|
|
r = grdrm_object_add(object);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
if (out)
|
|
*out = crtc;
|
|
object = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static int grdrm_crtc_resync(grdrm_crtc *crtc) {
|
|
grdrm_card *card = crtc->object.card;
|
|
struct drm_mode_crtc res = { .crtc_id = crtc->object.id };
|
|
int r;
|
|
|
|
assert(crtc);
|
|
|
|
/* make sure we can cache any combination later */
|
|
if (card->n_connectors > crtc->kern.max_used_connectors) {
|
|
uint32_t max, *t;
|
|
|
|
max = ALIGN_POWER2(card->n_connectors);
|
|
if (!max)
|
|
return -ENOMEM;
|
|
|
|
t = realloc_multiply(crtc->kern.used_connectors, sizeof(*t), max);
|
|
if (!t)
|
|
return -ENOMEM;
|
|
|
|
crtc->kern.used_connectors = t;
|
|
crtc->kern.max_used_connectors = max;
|
|
|
|
if (!crtc->old.set) {
|
|
crtc->old.connectors = calloc(sizeof(*t), max);
|
|
if (!crtc->old.connectors)
|
|
return -ENOMEM;
|
|
}
|
|
}
|
|
|
|
/* GETCRTC doesn't return connectors. We have to read all
|
|
* encoder-state and deduce the setup ourselves.. */
|
|
crtc->kern.n_used_connectors = 0;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_GETCRTC, &res);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
if (r == -ENOENT) {
|
|
card->async_hotplug = true;
|
|
r = 0;
|
|
log_debug("grdrm: %s: crtc %u removed during resync",
|
|
card->base.name, crtc->object.id);
|
|
} else {
|
|
log_debug_errno(errno, "grdrm: %s: cannot retrieve crtc %u: %m",
|
|
card->base.name, crtc->object.id);
|
|
}
|
|
|
|
return r;
|
|
}
|
|
|
|
crtc->kern.used_fb = res.fb_id;
|
|
crtc->kern.fb_offset_x = res.x;
|
|
crtc->kern.fb_offset_y = res.y;
|
|
crtc->kern.gamma_size = res.gamma_size;
|
|
crtc->kern.mode_set = res.mode_valid;
|
|
crtc->kern.mode = res.mode;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void grdrm_crtc_assign(grdrm_crtc *crtc, grdrm_connector *connector) {
|
|
uint32_t n_connectors;
|
|
int r;
|
|
|
|
assert(crtc);
|
|
assert(!crtc->object.assigned);
|
|
assert(!connector || !connector->object.assigned);
|
|
|
|
/* always mark both as assigned; even if assignments cannot be set */
|
|
crtc->object.assigned = true;
|
|
if (connector)
|
|
connector->object.assigned = true;
|
|
|
|
/* we will support hw clone mode in the future */
|
|
n_connectors = connector ? 1 : 0;
|
|
|
|
/* bail out if configuration is preserved */
|
|
if (crtc->set.n_connectors == n_connectors &&
|
|
(n_connectors == 0 || crtc->set.connectors[0] == connector->object.id))
|
|
return;
|
|
|
|
crtc->applied = false;
|
|
crtc->set.n_connectors = 0;
|
|
|
|
if (n_connectors > crtc->set.max_connectors) {
|
|
uint32_t max, *t;
|
|
|
|
max = ALIGN_POWER2(n_connectors);
|
|
if (!max) {
|
|
r = -ENOMEM;
|
|
goto error;
|
|
}
|
|
|
|
t = realloc(crtc->set.connectors, sizeof(*t) * max);
|
|
if (!t) {
|
|
r = -ENOMEM;
|
|
goto error;
|
|
}
|
|
|
|
crtc->set.connectors = t;
|
|
crtc->set.max_connectors = max;
|
|
}
|
|
|
|
if (connector) {
|
|
struct drm_mode_modeinfo *m, *pref = NULL;
|
|
uint32_t i;
|
|
|
|
for (i = 0; i < connector->kern.n_modes; ++i) {
|
|
m = &connector->kern.modes[i];
|
|
|
|
/* ignore 3D modes by default */
|
|
if (m->flags & DRM_MODE_FLAG_3D_MASK)
|
|
continue;
|
|
|
|
if (!pref) {
|
|
pref = m;
|
|
continue;
|
|
}
|
|
|
|
/* use PREFERRED over non-PREFERRED */
|
|
if ((pref->type & DRM_MODE_TYPE_PREFERRED) &&
|
|
!(m->type & DRM_MODE_TYPE_PREFERRED))
|
|
continue;
|
|
|
|
/* use DRIVER over non-PREFERRED|DRIVER */
|
|
if ((pref->type & DRM_MODE_TYPE_DRIVER) &&
|
|
!(m->type & (DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED)))
|
|
continue;
|
|
|
|
/* always prefer higher resolution */
|
|
if (pref->hdisplay > m->hdisplay ||
|
|
(pref->hdisplay == m->hdisplay && pref->vdisplay > m->vdisplay))
|
|
continue;
|
|
|
|
pref = m;
|
|
}
|
|
|
|
if (pref) {
|
|
crtc->set.mode = *pref;
|
|
crtc->set.n_connectors = 1;
|
|
crtc->set.connectors[0] = connector->object.id;
|
|
log_debug("grdrm: %s: assigned connector %" PRIu32 " to crtc %" PRIu32 " with mode %s",
|
|
crtc->object.card->base.name, connector->object.id, crtc->object.id, pref->name);
|
|
} else {
|
|
log_debug("grdrm: %s: connector %" PRIu32 " to be assigned but has no valid mode",
|
|
crtc->object.card->base.name, connector->object.id);
|
|
}
|
|
}
|
|
|
|
return;
|
|
|
|
error:
|
|
log_debug("grdrm: %s: cannot assign crtc %" PRIu32 ": %s",
|
|
crtc->object.card->base.name, crtc->object.id, strerror(-r));
|
|
}
|
|
|
|
static void grdrm_crtc_expose(grdrm_crtc *crtc) {
|
|
grdrm_pipe *pipe;
|
|
grdrm_fb *fb;
|
|
size_t i;
|
|
int r;
|
|
|
|
assert(crtc);
|
|
assert(crtc->object.assigned);
|
|
|
|
if (crtc->set.n_connectors < 1) {
|
|
if (crtc->pipe)
|
|
grdev_pipe_free(&crtc->pipe->base);
|
|
crtc->pipe = NULL;
|
|
return;
|
|
}
|
|
|
|
pipe = crtc->pipe;
|
|
if (pipe) {
|
|
if (pipe->base.width != crtc->set.mode.hdisplay ||
|
|
pipe->base.height != crtc->set.mode.vdisplay ||
|
|
pipe->base.vrefresh != crtc->set.mode.vrefresh) {
|
|
grdev_pipe_free(&pipe->base);
|
|
crtc->pipe = NULL;
|
|
pipe = NULL;
|
|
}
|
|
}
|
|
|
|
if (crtc->pipe) {
|
|
pipe->base.front = NULL;
|
|
pipe->base.back = NULL;
|
|
for (i = 0; i < pipe->base.max_fbs; ++i) {
|
|
fb = fb_from_base(pipe->base.fbs[i]);
|
|
if (fb->id == crtc->kern.used_fb)
|
|
pipe->base.front = &fb->base;
|
|
else if (!fb->flipid)
|
|
pipe->base.back = &fb->base;
|
|
}
|
|
} else {
|
|
r = grdrm_pipe_new(&pipe, crtc, &crtc->set.mode, 2);
|
|
if (r < 0) {
|
|
log_debug("grdrm: %s: cannot create pipe for crtc %" PRIu32 ": %s",
|
|
crtc->object.card->base.name, crtc->object.id, strerror(-r));
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < pipe->base.max_fbs; ++i) {
|
|
r = grdrm_fb_new(&fb, crtc->object.card, &crtc->set.mode);
|
|
if (r < 0) {
|
|
log_debug("grdrm: %s: cannot allocate framebuffer for crtc %" PRIu32 ": %s",
|
|
crtc->object.card->base.name, crtc->object.id, strerror(-r));
|
|
grdev_pipe_free(&pipe->base);
|
|
return;
|
|
}
|
|
|
|
pipe->base.fbs[i] = &fb->base;
|
|
}
|
|
|
|
pipe->base.front = NULL;
|
|
pipe->base.back = pipe->base.fbs[0];
|
|
crtc->pipe = pipe;
|
|
}
|
|
|
|
grdev_pipe_ready(&crtc->pipe->base, true);
|
|
}
|
|
|
|
static void grdrm_crtc_commit_deep(grdrm_crtc *crtc, grdev_fb *basefb) {
|
|
struct drm_mode_crtc set_crtc = { .crtc_id = crtc->object.id };
|
|
grdrm_card *card = crtc->object.card;
|
|
grdrm_pipe *pipe = crtc->pipe;
|
|
grdrm_fb *fb;
|
|
int r;
|
|
|
|
assert(crtc);
|
|
assert(basefb);
|
|
assert(pipe);
|
|
|
|
fb = fb_from_base(basefb);
|
|
|
|
set_crtc.set_connectors_ptr = PTR_TO_UINT64(crtc->set.connectors);
|
|
set_crtc.count_connectors = crtc->set.n_connectors;
|
|
set_crtc.fb_id = fb->id;
|
|
set_crtc.x = 0;
|
|
set_crtc.y = 0;
|
|
set_crtc.mode_valid = 1;
|
|
set_crtc.mode = crtc->set.mode;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_SETCRTC, &set_crtc);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
log_debug_errno(errno, "grdrm: %s: cannot set crtc %" PRIu32 ": %m",
|
|
card->base.name, crtc->object.id);
|
|
|
|
grdrm_card_async(card, r);
|
|
return;
|
|
}
|
|
|
|
if (!crtc->applied) {
|
|
log_debug("grdrm: %s: crtc %" PRIu32 " applied via deep modeset",
|
|
card->base.name, crtc->object.id);
|
|
crtc->applied = true;
|
|
}
|
|
|
|
pipe->base.back = NULL;
|
|
pipe->base.front = &fb->base;
|
|
fb->flipid = 0;
|
|
++pipe->counter;
|
|
pipe->base.flipping = false;
|
|
pipe->base.flip = false;
|
|
|
|
/* We cannot schedule dummy page-flips on pipes, hence, the
|
|
* application would have to schedule their own frame-timers.
|
|
* To avoid duplicating that everywhere, we schedule our own
|
|
* timer and raise a fake FRAME event when it fires. */
|
|
grdev_pipe_schedule(&pipe->base, 1);
|
|
}
|
|
|
|
static int grdrm_crtc_commit_flip(grdrm_crtc *crtc, grdev_fb *basefb) {
|
|
struct drm_mode_crtc_page_flip page_flip = { .crtc_id = crtc->object.id };
|
|
grdrm_card *card = crtc->object.card;
|
|
grdrm_pipe *pipe = crtc->pipe;
|
|
grdrm_fb *fb;
|
|
uint32_t cnt;
|
|
int r;
|
|
|
|
assert(crtc);
|
|
assert(basefb);
|
|
assert(pipe);
|
|
|
|
if (!crtc->applied) {
|
|
if (!grdrm_modes_compatible(&crtc->kern.mode, &crtc->set.mode))
|
|
return 0;
|
|
|
|
/* TODO: Theoretically, we should be able to page-flip to our
|
|
* framebuffer here. We didn't perform any deep modeset, but the
|
|
* DRM driver is really supposed to reject our page-flip in case
|
|
* the FB is not compatible. We then properly fall back to a
|
|
* deep modeset.
|
|
* As it turns out, drivers don't to this. Therefore, we need to
|
|
* perform a full modeset on enter now. We might avoid this in
|
|
* the future with fixed drivers.. */
|
|
|
|
return 0;
|
|
}
|
|
|
|
fb = fb_from_base(basefb);
|
|
|
|
cnt = ++pipe->counter ? : ++pipe->counter;
|
|
page_flip.fb_id = fb->id;
|
|
page_flip.flags = DRM_MODE_PAGE_FLIP_EVENT;
|
|
page_flip.user_data = grdrm_encode_vblank_data(crtc->object.id, cnt);
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_PAGE_FLIP, &page_flip);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
/* Avoid excessive logging on EINVAL; it is currently not
|
|
* possible to see whether cards support page-flipping, so
|
|
* avoid logging on each frame. */
|
|
if (r != -EINVAL)
|
|
log_debug_errno(errno, "grdrm: %s: cannot schedule page-flip on crtc %" PRIu32 ": %m",
|
|
card->base.name, crtc->object.id);
|
|
|
|
if (grdrm_card_async(card, r))
|
|
return r;
|
|
|
|
return 0;
|
|
}
|
|
|
|
if (!crtc->applied) {
|
|
log_debug("grdrm: %s: crtc %" PRIu32 " applied via page flip",
|
|
card->base.name, crtc->object.id);
|
|
crtc->applied = true;
|
|
}
|
|
|
|
pipe->base.flipping = true;
|
|
pipe->base.flip = false;
|
|
pipe->counter = cnt;
|
|
fb->flipid = cnt;
|
|
pipe->base.back = NULL;
|
|
|
|
/* Raise fake FRAME event if it takes longer than 2
|
|
* frames to receive the pageflip event. We assume the
|
|
* queue ran over or some other error happened. */
|
|
grdev_pipe_schedule(&pipe->base, 2);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static void grdrm_crtc_commit(grdrm_crtc *crtc) {
|
|
struct drm_mode_crtc set_crtc = { .crtc_id = crtc->object.id };
|
|
grdrm_card *card = crtc->object.card;
|
|
grdrm_pipe *pipe;
|
|
grdev_fb *fb;
|
|
int r;
|
|
|
|
assert(crtc);
|
|
assert(crtc->object.assigned);
|
|
|
|
pipe = crtc->pipe;
|
|
if (!pipe) {
|
|
/* If a crtc is not assigned any connector, we want any
|
|
* previous setup to be cleared, so make sure the CRTC is
|
|
* disabled. Otherwise, there might be content on the CRTC
|
|
* while we run, which is not what we want.
|
|
* If you want to avoid modesets on specific CRTCs, you should
|
|
* still keep their assignment, but never enable the resulting
|
|
* pipe. This way, we wouldn't touch it at all. */
|
|
if (!crtc->applied) {
|
|
crtc->applied = true;
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_SETCRTC, &set_crtc);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
log_debug_errno(errno, "grdrm: %s: cannot shutdown crtc %" PRIu32 ": %m",
|
|
card->base.name, crtc->object.id);
|
|
|
|
grdrm_card_async(card, r);
|
|
return;
|
|
}
|
|
|
|
log_debug("grdrm: %s: crtc %" PRIu32 " applied via shutdown",
|
|
card->base.name, crtc->object.id);
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
/* we always fully ignore disabled pipes */
|
|
if (!pipe->base.enabled)
|
|
return;
|
|
|
|
assert(crtc->set.n_connectors > 0);
|
|
|
|
if (pipe->base.flip)
|
|
fb = pipe->base.back;
|
|
else if (!crtc->applied)
|
|
fb = pipe->base.front;
|
|
else
|
|
return;
|
|
|
|
if (!fb)
|
|
return;
|
|
|
|
r = grdrm_crtc_commit_flip(crtc, fb);
|
|
if (r == 0) {
|
|
/* in case we couldn't page-flip, perform deep modeset */
|
|
grdrm_crtc_commit_deep(crtc, fb);
|
|
}
|
|
}
|
|
|
|
static void grdrm_crtc_restore(grdrm_crtc *crtc) {
|
|
struct drm_mode_crtc set_crtc = { .crtc_id = crtc->object.id };
|
|
grdrm_card *card = crtc->object.card;
|
|
int r;
|
|
|
|
if (!crtc->old.set)
|
|
return;
|
|
|
|
set_crtc.set_connectors_ptr = PTR_TO_UINT64(crtc->old.connectors);
|
|
set_crtc.count_connectors = crtc->old.n_connectors;
|
|
set_crtc.fb_id = crtc->old.fb;
|
|
set_crtc.x = crtc->old.fb_x;
|
|
set_crtc.y = crtc->old.fb_y;
|
|
set_crtc.gamma_size = crtc->old.gamma;
|
|
set_crtc.mode_valid = crtc->old.mode_set;
|
|
set_crtc.mode = crtc->old.mode;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_SETCRTC, &set_crtc);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
log_debug_errno(errno, "grdrm: %s: cannot restore crtc %" PRIu32 ": %m",
|
|
card->base.name, crtc->object.id);
|
|
|
|
grdrm_card_async(card, r);
|
|
return;
|
|
}
|
|
|
|
if (crtc->pipe) {
|
|
++crtc->pipe->counter;
|
|
crtc->pipe->base.front = NULL;
|
|
crtc->pipe->base.flipping = false;
|
|
}
|
|
|
|
log_debug("grdrm: %s: crtc %" PRIu32 " restored", card->base.name, crtc->object.id);
|
|
}
|
|
|
|
static void grdrm_crtc_flip_complete(grdrm_crtc *crtc, uint32_t counter, struct drm_event_vblank *event) {
|
|
bool flipped = false;
|
|
grdrm_pipe *pipe;
|
|
size_t i;
|
|
|
|
assert(crtc);
|
|
assert(event);
|
|
|
|
pipe = crtc->pipe;
|
|
if (!pipe)
|
|
return;
|
|
|
|
/* We got a page-flip event. To be safe, we reset all FBs on the same
|
|
* pipe that have smaller flipids than the flip we got as we know they
|
|
* are executed in order. We need to do this to guarantee
|
|
* queue-overflows or other missed events don't cause starvation.
|
|
* Furthermore, if we find the exact FB this event is for, *and* this
|
|
* is the most recent event, we mark it as front FB and raise a
|
|
* frame event. */
|
|
|
|
for (i = 0; i < pipe->base.max_fbs; ++i) {
|
|
grdrm_fb *fb;
|
|
|
|
if (!pipe->base.fbs[i])
|
|
continue;
|
|
|
|
fb = fb_from_base(pipe->base.fbs[i]);
|
|
if (counter != 0 && counter == pipe->counter && fb->flipid == counter) {
|
|
pipe->base.front = &fb->base;
|
|
fb->flipid = 0;
|
|
flipped = true;
|
|
} else if (counter - fb->flipid < UINT16_MAX) {
|
|
fb->flipid = 0;
|
|
}
|
|
}
|
|
|
|
if (flipped) {
|
|
crtc->pipe->base.flipping = false;
|
|
grdev_pipe_frame(&pipe->base);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Framebuffers
|
|
*/
|
|
|
|
static int grdrm_fb_new(grdrm_fb **out, grdrm_card *card, const struct drm_mode_modeinfo *mode) {
|
|
_cleanup_(grdrm_fb_freep) grdrm_fb *fb = NULL;
|
|
struct drm_mode_create_dumb create_dumb = { };
|
|
struct drm_mode_map_dumb map_dumb = { };
|
|
struct drm_mode_fb_cmd2 add_fb = { };
|
|
unsigned int i;
|
|
int r;
|
|
|
|
assert_return(out, -EINVAL);
|
|
assert_return(card, -EINVAL);
|
|
|
|
fb = new0(grdrm_fb, 1);
|
|
if (!fb)
|
|
return -ENOMEM;
|
|
|
|
/* TODO: we should choose a compatible format of the previous CRTC
|
|
* setting to allow page-flip to it. Only choose fallback if the
|
|
* previous setting was crap (non xrgb32'ish). */
|
|
|
|
fb->card = card;
|
|
fb->base.format = DRM_FORMAT_XRGB8888;
|
|
fb->base.width = mode->hdisplay;
|
|
fb->base.height = mode->vdisplay;
|
|
|
|
for (i = 0; i < ELEMENTSOF(fb->base.maps); ++i)
|
|
fb->base.maps[i] = MAP_FAILED;
|
|
|
|
create_dumb.width = fb->base.width;
|
|
create_dumb.height = fb->base.height;
|
|
create_dumb.bpp = 32;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_CREATE_DUMB, &create_dumb);
|
|
if (r < 0) {
|
|
r = negative_errno();
|
|
log_debug_errno(errno, "grdrm: %s: cannot create dumb buffer %" PRIu32 "x%" PRIu32": %m",
|
|
card->base.name, fb->base.width, fb->base.height);
|
|
return r;
|
|
}
|
|
|
|
fb->handles[0] = create_dumb.handle;
|
|
fb->base.strides[0] = create_dumb.pitch;
|
|
fb->sizes[0] = create_dumb.size;
|
|
|
|
map_dumb.handle = fb->handles[0];
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_MAP_DUMB, &map_dumb);
|
|
if (r < 0) {
|
|
r = negative_errno();
|
|
log_debug_errno(errno, "grdrm: %s: cannot map dumb buffer %" PRIu32 "x%" PRIu32": %m",
|
|
card->base.name, fb->base.width, fb->base.height);
|
|
return r;
|
|
}
|
|
|
|
fb->base.maps[0] = mmap(0, fb->sizes[0], PROT_WRITE, MAP_SHARED, card->fd, map_dumb.offset);
|
|
if (fb->base.maps[0] == MAP_FAILED) {
|
|
r = negative_errno();
|
|
log_debug_errno(errno, "grdrm: %s: cannot memory-map dumb buffer %" PRIu32 "x%" PRIu32": %m",
|
|
card->base.name, fb->base.width, fb->base.height);
|
|
return r;
|
|
}
|
|
|
|
memzero(fb->base.maps[0], fb->sizes[0]);
|
|
|
|
add_fb.width = fb->base.width;
|
|
add_fb.height = fb->base.height;
|
|
add_fb.pixel_format = fb->base.format;
|
|
add_fb.flags = 0;
|
|
memcpy(add_fb.handles, fb->handles, sizeof(fb->handles));
|
|
memcpy(add_fb.pitches, fb->base.strides, sizeof(fb->base.strides));
|
|
memcpy(add_fb.offsets, fb->offsets, sizeof(fb->offsets));
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_ADDFB2, &add_fb);
|
|
if (r < 0) {
|
|
r = negative_errno();
|
|
log_debug_errno(errno, "grdrm: %s: cannot add framebuffer %" PRIu32 "x%" PRIu32": %m",
|
|
card->base.name, fb->base.width, fb->base.height);
|
|
return r;
|
|
}
|
|
|
|
fb->id = add_fb.fb_id;
|
|
|
|
*out = fb;
|
|
fb = NULL;
|
|
return 0;
|
|
}
|
|
|
|
grdrm_fb *grdrm_fb_free(grdrm_fb *fb) {
|
|
unsigned int i;
|
|
int r;
|
|
|
|
if (!fb)
|
|
return NULL;
|
|
|
|
assert(fb->card);
|
|
|
|
if (fb->base.free_fn)
|
|
fb->base.free_fn(fb->base.data.ptr);
|
|
|
|
if (fb->id > 0 && fb->card->fd >= 0) {
|
|
r = ioctl(fb->card->fd, DRM_IOCTL_MODE_RMFB, fb->id);
|
|
if (r < 0)
|
|
log_debug_errno(errno, "grdrm: %s: cannot delete framebuffer %" PRIu32 ": %m",
|
|
fb->card->base.name, fb->id);
|
|
}
|
|
|
|
for (i = 0; i < ELEMENTSOF(fb->handles); ++i) {
|
|
struct drm_mode_destroy_dumb destroy_dumb = { };
|
|
|
|
if (fb->base.maps[i] != MAP_FAILED)
|
|
munmap(fb->base.maps[i], fb->sizes[i]);
|
|
|
|
if (fb->handles[i] > 0 && fb->card->fd >= 0) {
|
|
destroy_dumb.handle = fb->handles[i];
|
|
r = ioctl(fb->card->fd, DRM_IOCTL_MODE_DESTROY_DUMB, &destroy_dumb);
|
|
if (r < 0)
|
|
log_debug_errno(errno, "grdrm: %s: cannot destroy dumb-buffer %" PRIu32 ": %m",
|
|
fb->card->base.name, fb->handles[i]);
|
|
}
|
|
}
|
|
|
|
free(fb);
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/*
|
|
* Pipes
|
|
*/
|
|
|
|
static void grdrm_pipe_name(char *out, grdrm_crtc *crtc) {
|
|
/* @out must be at least of size GRDRM_PIPE_NAME_MAX */
|
|
sprintf(out, "%s/%" PRIu32, crtc->object.card->base.name, crtc->object.id);
|
|
}
|
|
|
|
static int grdrm_pipe_new(grdrm_pipe **out, grdrm_crtc *crtc, struct drm_mode_modeinfo *mode, size_t n_fbs) {
|
|
_cleanup_(grdev_pipe_freep) grdev_pipe *basepipe = NULL;
|
|
grdrm_card *card = crtc->object.card;
|
|
char name[GRDRM_PIPE_NAME_MAX];
|
|
grdrm_pipe *pipe;
|
|
int r;
|
|
|
|
assert_return(crtc, -EINVAL);
|
|
assert_return(grdev_is_drm_card(&card->base), -EINVAL);
|
|
|
|
pipe = new0(grdrm_pipe, 1);
|
|
if (!pipe)
|
|
return -ENOMEM;
|
|
|
|
basepipe = &pipe->base;
|
|
pipe->base = GRDEV_PIPE_INIT(&grdrm_pipe_vtable, &card->base);
|
|
pipe->crtc = crtc;
|
|
pipe->base.width = mode->hdisplay;
|
|
pipe->base.height = mode->vdisplay;
|
|
pipe->base.vrefresh = mode->vrefresh ? : 25;
|
|
|
|
grdrm_pipe_name(name, crtc);
|
|
r = grdev_pipe_add(&pipe->base, name, n_fbs);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
if (out)
|
|
*out = pipe;
|
|
basepipe = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static void grdrm_pipe_free(grdev_pipe *basepipe) {
|
|
grdrm_pipe *pipe = grdrm_pipe_from_base(basepipe);
|
|
size_t i;
|
|
|
|
assert(pipe->crtc);
|
|
|
|
for (i = 0; i < pipe->base.max_fbs; ++i)
|
|
if (pipe->base.fbs[i])
|
|
grdrm_fb_free(fb_from_base(pipe->base.fbs[i]));
|
|
|
|
free(pipe);
|
|
}
|
|
|
|
static grdev_fb *grdrm_pipe_target(grdev_pipe *basepipe) {
|
|
grdrm_fb *fb;
|
|
size_t i;
|
|
|
|
if (!basepipe->back) {
|
|
for (i = 0; i < basepipe->max_fbs; ++i) {
|
|
if (!basepipe->fbs[i])
|
|
continue;
|
|
|
|
fb = fb_from_base(basepipe->fbs[i]);
|
|
if (&fb->base == basepipe->front)
|
|
continue;
|
|
if (basepipe->flipping && fb->flipid)
|
|
continue;
|
|
|
|
basepipe->back = &fb->base;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return basepipe->back;
|
|
}
|
|
|
|
static void grdrm_pipe_enable(grdev_pipe *basepipe) {
|
|
grdrm_pipe *pipe = grdrm_pipe_from_base(basepipe);
|
|
|
|
pipe->crtc->applied = false;
|
|
}
|
|
|
|
static void grdrm_pipe_disable(grdev_pipe *basepipe) {
|
|
grdrm_pipe *pipe = grdrm_pipe_from_base(basepipe);
|
|
|
|
pipe->crtc->applied = false;
|
|
}
|
|
|
|
static const grdev_pipe_vtable grdrm_pipe_vtable = {
|
|
.free = grdrm_pipe_free,
|
|
.target = grdrm_pipe_target,
|
|
.enable = grdrm_pipe_enable,
|
|
.disable = grdrm_pipe_disable,
|
|
};
|
|
|
|
/*
|
|
* Cards
|
|
*/
|
|
|
|
static void grdrm_name(char *out, dev_t devnum) {
|
|
/* @out must be at least of size GRDRM_CARD_NAME_MAX */
|
|
sprintf(out, "drm/%u:%u", major(devnum), minor(devnum));
|
|
}
|
|
|
|
static void grdrm_card_print(grdrm_card *card) {
|
|
grdrm_object *object;
|
|
grdrm_crtc *crtc;
|
|
grdrm_encoder *encoder;
|
|
grdrm_connector *connector;
|
|
grdrm_plane *plane;
|
|
Iterator iter;
|
|
uint32_t i;
|
|
char *p, *buf;
|
|
|
|
log_debug("grdrm: %s: state dump", card->base.name);
|
|
|
|
log_debug(" crtcs:");
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (object->type != GRDRM_TYPE_CRTC)
|
|
continue;
|
|
|
|
crtc = crtc_from_object(object);
|
|
log_debug(" (id: %u index: %d)", object->id, object->index);
|
|
|
|
if (crtc->kern.mode_set)
|
|
log_debug(" mode: %dx%d", crtc->kern.mode.hdisplay, crtc->kern.mode.vdisplay);
|
|
else
|
|
log_debug(" mode: <none>");
|
|
}
|
|
|
|
log_debug(" encoders:");
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (object->type != GRDRM_TYPE_ENCODER)
|
|
continue;
|
|
|
|
encoder = encoder_from_object(object);
|
|
log_debug(" (id: %u index: %d)", object->id, object->index);
|
|
|
|
if (encoder->kern.used_crtc)
|
|
log_debug(" crtc: %u", encoder->kern.used_crtc);
|
|
else
|
|
log_debug(" crtc: <none>");
|
|
|
|
buf = malloc((DECIMAL_STR_MAX(uint32_t) + 1) * encoder->kern.n_crtcs + 1);
|
|
if (buf) {
|
|
buf[0] = 0;
|
|
p = buf;
|
|
|
|
for (i = 0; i < encoder->kern.n_crtcs; ++i)
|
|
p += sprintf(p, " %" PRIu32, encoder->kern.crtcs[i]);
|
|
|
|
log_debug(" possible crtcs:%s", buf);
|
|
free(buf);
|
|
}
|
|
|
|
buf = malloc((DECIMAL_STR_MAX(uint32_t) + 1) * encoder->kern.n_clones + 1);
|
|
if (buf) {
|
|
buf[0] = 0;
|
|
p = buf;
|
|
|
|
for (i = 0; i < encoder->kern.n_clones; ++i)
|
|
p += sprintf(p, " %" PRIu32, encoder->kern.clones[i]);
|
|
|
|
log_debug(" possible clones:%s", buf);
|
|
free(buf);
|
|
}
|
|
}
|
|
|
|
log_debug(" connectors:");
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (object->type != GRDRM_TYPE_CONNECTOR)
|
|
continue;
|
|
|
|
connector = connector_from_object(object);
|
|
log_debug(" (id: %u index: %d)", object->id, object->index);
|
|
log_debug(" type: %" PRIu32 "-%" PRIu32 " connection: %" PRIu32 " subpixel: %" PRIu32 " extents: %" PRIu32 "x%" PRIu32,
|
|
connector->kern.type, connector->kern.type_id, connector->kern.connection, connector->kern.subpixel,
|
|
connector->kern.mm_width, connector->kern.mm_height);
|
|
|
|
if (connector->kern.used_encoder)
|
|
log_debug(" encoder: %" PRIu32, connector->kern.used_encoder);
|
|
else
|
|
log_debug(" encoder: <none>");
|
|
|
|
buf = malloc((DECIMAL_STR_MAX(uint32_t) + 1) * connector->kern.n_encoders + 1);
|
|
if (buf) {
|
|
buf[0] = 0;
|
|
p = buf;
|
|
|
|
for (i = 0; i < connector->kern.n_encoders; ++i)
|
|
p += sprintf(p, " %" PRIu32, connector->kern.encoders[i]);
|
|
|
|
log_debug(" possible encoders:%s", buf);
|
|
free(buf);
|
|
}
|
|
|
|
for (i = 0; i < connector->kern.n_modes; ++i) {
|
|
struct drm_mode_modeinfo *mode = &connector->kern.modes[i];
|
|
log_debug(" mode: %" PRIu32 "x%" PRIu32, mode->hdisplay, mode->vdisplay);
|
|
}
|
|
}
|
|
|
|
log_debug(" planes:");
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (object->type != GRDRM_TYPE_PLANE)
|
|
continue;
|
|
|
|
plane = plane_from_object(object);
|
|
log_debug(" (id: %u index: %d)", object->id, object->index);
|
|
log_debug(" gamma-size: %" PRIu32, plane->kern.gamma_size);
|
|
|
|
if (plane->kern.used_crtc)
|
|
log_debug(" crtc: %" PRIu32, plane->kern.used_crtc);
|
|
else
|
|
log_debug(" crtc: <none>");
|
|
|
|
buf = malloc((DECIMAL_STR_MAX(uint32_t) + 1) * plane->kern.n_crtcs + 1);
|
|
if (buf) {
|
|
buf[0] = 0;
|
|
p = buf;
|
|
|
|
for (i = 0; i < plane->kern.n_crtcs; ++i)
|
|
p += sprintf(p, " %" PRIu32, plane->kern.crtcs[i]);
|
|
|
|
log_debug(" possible crtcs:%s", buf);
|
|
free(buf);
|
|
}
|
|
|
|
buf = malloc((DECIMAL_STR_MAX(unsigned int) + 3) * plane->kern.n_formats + 1);
|
|
if (buf) {
|
|
buf[0] = 0;
|
|
p = buf;
|
|
|
|
for (i = 0; i < plane->kern.n_formats; ++i)
|
|
p += sprintf(p, " 0x%x", (unsigned int)plane->kern.formats[i]);
|
|
|
|
log_debug(" possible formats:%s", buf);
|
|
free(buf);
|
|
}
|
|
}
|
|
}
|
|
|
|
static int grdrm_card_resync(grdrm_card *card) {
|
|
_cleanup_free_ uint32_t *crtc_ids = NULL, *encoder_ids = NULL, *connector_ids = NULL, *plane_ids = NULL;
|
|
uint32_t allocated = 0;
|
|
grdrm_object *object;
|
|
Iterator iter;
|
|
size_t tries;
|
|
int r;
|
|
|
|
assert(card);
|
|
|
|
card->async_hotplug = false;
|
|
allocated = 0;
|
|
|
|
/* mark existing objects for possible removal */
|
|
HASHMAP_FOREACH(object, card->object_map, iter)
|
|
object->present = false;
|
|
|
|
for (tries = 0; tries < GRDRM_MAX_TRIES; ++tries) {
|
|
struct drm_mode_get_plane_res pres;
|
|
struct drm_mode_card_res res;
|
|
uint32_t i, max;
|
|
|
|
if (allocated < card->max_ids) {
|
|
free(crtc_ids);
|
|
free(encoder_ids);
|
|
free(connector_ids);
|
|
free(plane_ids);
|
|
crtc_ids = new0(uint32_t, card->max_ids);
|
|
encoder_ids = new0(uint32_t, card->max_ids);
|
|
connector_ids = new0(uint32_t, card->max_ids);
|
|
plane_ids = new0(uint32_t, card->max_ids);
|
|
|
|
if (!crtc_ids || !encoder_ids || !connector_ids || !plane_ids)
|
|
return -ENOMEM;
|
|
|
|
allocated = card->max_ids;
|
|
}
|
|
|
|
zero(res);
|
|
res.crtc_id_ptr = PTR_TO_UINT64(crtc_ids);
|
|
res.connector_id_ptr = PTR_TO_UINT64(connector_ids);
|
|
res.encoder_id_ptr = PTR_TO_UINT64(encoder_ids);
|
|
res.count_crtcs = allocated;
|
|
res.count_encoders = allocated;
|
|
res.count_connectors = allocated;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_GETRESOURCES, &res);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
log_debug_errno(errno, "grdrm: %s: cannot retrieve drm resources: %m",
|
|
card->base.name);
|
|
return r;
|
|
}
|
|
|
|
zero(pres);
|
|
pres.plane_id_ptr = PTR_TO_UINT64(plane_ids);
|
|
pres.count_planes = allocated;
|
|
|
|
r = ioctl(card->fd, DRM_IOCTL_MODE_GETPLANERESOURCES, &pres);
|
|
if (r < 0) {
|
|
r = -errno;
|
|
log_debug_errno(errno, "grdrm: %s: cannot retrieve drm plane-resources: %m",
|
|
card->base.name);
|
|
return r;
|
|
}
|
|
|
|
max = MAX(MAX(res.count_crtcs, res.count_encoders),
|
|
MAX(res.count_connectors, pres.count_planes));
|
|
if (max > allocated) {
|
|
uint32_t n;
|
|
|
|
n = ALIGN_POWER2(max);
|
|
if (!n || n > UINT16_MAX) {
|
|
log_debug("grdrm: %s: excessive DRM resource limit: %" PRIu32,
|
|
card->base.name, max);
|
|
return -ERANGE;
|
|
}
|
|
|
|
/* retry with resized buffers */
|
|
card->max_ids = n;
|
|
continue;
|
|
}
|
|
|
|
/* mark available objects as present */
|
|
|
|
for (i = 0; i < res.count_crtcs; ++i) {
|
|
object = grdrm_find_object(card, crtc_ids[i]);
|
|
if (object && object->type == GRDRM_TYPE_CRTC) {
|
|
object->present = true;
|
|
object->index = i;
|
|
crtc_ids[i] = 0;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < res.count_encoders; ++i) {
|
|
object = grdrm_find_object(card, encoder_ids[i]);
|
|
if (object && object->type == GRDRM_TYPE_ENCODER) {
|
|
object->present = true;
|
|
object->index = i;
|
|
encoder_ids[i] = 0;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < res.count_connectors; ++i) {
|
|
object = grdrm_find_object(card, connector_ids[i]);
|
|
if (object && object->type == GRDRM_TYPE_CONNECTOR) {
|
|
object->present = true;
|
|
object->index = i;
|
|
connector_ids[i] = 0;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < pres.count_planes; ++i) {
|
|
object = grdrm_find_object(card, plane_ids[i]);
|
|
if (object && object->type == GRDRM_TYPE_PLANE) {
|
|
object->present = true;
|
|
object->index = i;
|
|
plane_ids[i] = 0;
|
|
}
|
|
}
|
|
|
|
/* drop removed objects */
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, iter)
|
|
if (!object->present)
|
|
grdrm_object_free(object);
|
|
|
|
/* add new objects */
|
|
|
|
card->n_crtcs = res.count_crtcs;
|
|
for (i = 0; i < res.count_crtcs; ++i) {
|
|
if (crtc_ids[i] < 1)
|
|
continue;
|
|
|
|
r = grdrm_crtc_new(NULL, card, crtc_ids[i], i);
|
|
if (r < 0)
|
|
return r;
|
|
}
|
|
|
|
card->n_encoders = res.count_encoders;
|
|
for (i = 0; i < res.count_encoders; ++i) {
|
|
if (encoder_ids[i] < 1)
|
|
continue;
|
|
|
|
r = grdrm_encoder_new(NULL, card, encoder_ids[i], i);
|
|
if (r < 0)
|
|
return r;
|
|
}
|
|
|
|
card->n_connectors = res.count_connectors;
|
|
for (i = 0; i < res.count_connectors; ++i) {
|
|
if (connector_ids[i] < 1)
|
|
continue;
|
|
|
|
r = grdrm_connector_new(NULL, card, connector_ids[i], i);
|
|
if (r < 0)
|
|
return r;
|
|
}
|
|
|
|
card->n_planes = pres.count_planes;
|
|
for (i = 0; i < pres.count_planes; ++i) {
|
|
if (plane_ids[i] < 1)
|
|
continue;
|
|
|
|
r = grdrm_plane_new(NULL, card, plane_ids[i], i);
|
|
if (r < 0)
|
|
return r;
|
|
}
|
|
|
|
/* re-sync objects after object_map is synced */
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
switch (object->type) {
|
|
case GRDRM_TYPE_CRTC:
|
|
r = grdrm_crtc_resync(crtc_from_object(object));
|
|
break;
|
|
case GRDRM_TYPE_ENCODER:
|
|
r = grdrm_encoder_resync(encoder_from_object(object));
|
|
break;
|
|
case GRDRM_TYPE_CONNECTOR:
|
|
r = grdrm_connector_resync(connector_from_object(object));
|
|
break;
|
|
case GRDRM_TYPE_PLANE:
|
|
r = grdrm_plane_resync(plane_from_object(object));
|
|
break;
|
|
default:
|
|
assert_not_reached("grdrm: invalid object type");
|
|
r = 0;
|
|
}
|
|
|
|
if (r < 0)
|
|
return r;
|
|
|
|
if (card->async_hotplug)
|
|
break;
|
|
}
|
|
|
|
/* if modeset objects change during sync, start over */
|
|
if (card->async_hotplug) {
|
|
card->async_hotplug = false;
|
|
continue;
|
|
}
|
|
|
|
/* cache crtc/connector relationship */
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
grdrm_connector *connector;
|
|
grdrm_encoder *encoder;
|
|
grdrm_crtc *crtc;
|
|
|
|
if (object->type != GRDRM_TYPE_CONNECTOR)
|
|
continue;
|
|
|
|
connector = connector_from_object(object);
|
|
if (connector->kern.connection != 1 || connector->kern.used_encoder < 1)
|
|
continue;
|
|
|
|
object = grdrm_find_object(card, connector->kern.used_encoder);
|
|
if (!object || object->type != GRDRM_TYPE_ENCODER)
|
|
continue;
|
|
|
|
encoder = encoder_from_object(object);
|
|
if (encoder->kern.used_crtc < 1)
|
|
continue;
|
|
|
|
object = grdrm_find_object(card, encoder->kern.used_crtc);
|
|
if (!object || object->type != GRDRM_TYPE_CRTC)
|
|
continue;
|
|
|
|
crtc = crtc_from_object(object);
|
|
assert(crtc->kern.n_used_connectors < crtc->kern.max_used_connectors);
|
|
crtc->kern.used_connectors[crtc->kern.n_used_connectors++] = connector->object.id;
|
|
}
|
|
|
|
/* cache old crtc settings for later restore */
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
grdrm_crtc *crtc;
|
|
|
|
if (object->type != GRDRM_TYPE_CRTC)
|
|
continue;
|
|
|
|
crtc = crtc_from_object(object);
|
|
|
|
/* Save data if it is the first time we refresh the CRTC. This data can
|
|
* be used optionally to restore any previous configuration. For
|
|
* instance, it allows us to restore VT configurations after we close
|
|
* our session again. */
|
|
if (!crtc->old.set) {
|
|
crtc->old.fb = crtc->kern.used_fb;
|
|
crtc->old.fb_x = crtc->kern.fb_offset_x;
|
|
crtc->old.fb_y = crtc->kern.fb_offset_y;
|
|
crtc->old.gamma = crtc->kern.gamma_size;
|
|
crtc->old.n_connectors = crtc->kern.n_used_connectors;
|
|
if (crtc->old.n_connectors)
|
|
memcpy(crtc->old.connectors, crtc->kern.used_connectors, sizeof(uint32_t) * crtc->old.n_connectors);
|
|
crtc->old.mode_set = crtc->kern.mode_set;
|
|
crtc->old.mode = crtc->kern.mode;
|
|
crtc->old.set = true;
|
|
}
|
|
}
|
|
|
|
/* everything synced */
|
|
break;
|
|
}
|
|
|
|
if (tries >= GRDRM_MAX_TRIES) {
|
|
/*
|
|
* Ugh! We were unable to sync the DRM card state due to heavy
|
|
* hotplugging. This should never happen, so print a debug
|
|
* message and bail out. The next uevent will trigger
|
|
* this again.
|
|
*/
|
|
|
|
log_debug("grdrm: %s: hotplug-storm when syncing card", card->base.name);
|
|
return -EFAULT;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static bool card_configure_crtc(grdrm_crtc *crtc, grdrm_connector *connector) {
|
|
grdrm_card *card = crtc->object.card;
|
|
grdrm_encoder *encoder;
|
|
grdrm_object *object;
|
|
uint32_t i, j;
|
|
|
|
if (crtc->object.assigned || connector->object.assigned)
|
|
return false;
|
|
if (connector->kern.connection != 1)
|
|
return false;
|
|
|
|
for (i = 0; i < connector->kern.n_encoders; ++i) {
|
|
object = grdrm_find_object(card, connector->kern.encoders[i]);
|
|
if (!object || object->type != GRDRM_TYPE_ENCODER)
|
|
continue;
|
|
|
|
encoder = encoder_from_object(object);
|
|
for (j = 0; j < encoder->kern.n_crtcs; ++j) {
|
|
if (encoder->kern.crtcs[j] == crtc->object.id) {
|
|
grdrm_crtc_assign(crtc, connector);
|
|
return true;
|
|
}
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static void grdrm_card_configure(grdrm_card *card) {
|
|
/*
|
|
* Modeset Configuration
|
|
* This is where we update our modeset configuration and assign
|
|
* connectors to CRTCs. This means, each connector that we want to
|
|
* enable needs a CRTC, disabled (or unavailable) connectors are left
|
|
* alone in the dark. Once all CRTCs are assigned, the remaining CRTCs
|
|
* are disabled.
|
|
* Sounds trivial, but there're several caveats:
|
|
*
|
|
* * Multiple connectors can be driven by the same CRTC. This is
|
|
* known as 'hardware clone mode'. Advantage over software clone
|
|
* mode is that only a single CRTC is needed to drive multiple
|
|
* displays. However, few hardware supports this and it's a huge
|
|
* headache to configure on dynamic demands. Therefore, we only
|
|
* support it if configured statically beforehand.
|
|
*
|
|
* * CRTCs are not created equal. Some might be much more powerful
|
|
* than others, including more advanced plane support. So far, our
|
|
* CRTC selection is random. You need to supply static
|
|
* configuration if you want special setups. So far, there is no
|
|
* proper way to do advanced CRTC selection on dynamic demands. It
|
|
* is not really clear which demands require what CRTC, so, like
|
|
* everyone else, we do random CRTC selection unless explicitly
|
|
* states otherwise.
|
|
*
|
|
* * Each Connector has a list of possible encoders that can drive
|
|
* it, and each encoder has a list of possible CRTCs. If this graph
|
|
* is a tree, assignment is trivial. However, if not, we cannot
|
|
* reliably decide on configurations beforehand. The encoder is
|
|
* always selected by the kernel, so we have to actually set a mode
|
|
* to know which encoder is used. There is no way to ask the kernel
|
|
* whether a given configuration is possible. This will change with
|
|
* atomic-modesetting, but until then, we keep our configurations
|
|
* simple and assume they work all just fine. If one fails
|
|
* unexpectedly, we print a warning and disable it.
|
|
*
|
|
* Configuring a card consists of several steps:
|
|
*
|
|
* 1) First of all, we apply any user-configuration. If a user wants
|
|
* a fixed configuration, we apply it and preserve it.
|
|
* So far, we don't support user configuration files, so this step
|
|
* is skipped.
|
|
*
|
|
* 2) Secondly, we need to apply any quirks from hwdb. Some hardware
|
|
* might only support limited configurations or require special
|
|
* CRTC/Connector mappings. We read this from hwdb and apply it, if
|
|
* present.
|
|
* So far, we don't support this as there is no known quirk, so
|
|
* this step is skipped.
|
|
*
|
|
* 3) As deep modesets are expensive, we try to avoid them if
|
|
* possible. Therefore, we read the current configuration from the
|
|
* kernel and try to preserve it, if compatible with our demands.
|
|
* If not, we break it and reassign it in a following step.
|
|
*
|
|
* 4) The main step involves configuring all remaining objects. By
|
|
* default, all available connectors are enabled, except for those
|
|
* disabled by user-configuration. We lookup a suitable CRTC for
|
|
* each connector and assign them. As there might be more
|
|
* connectors than CRTCs, we apply some ordering so users can
|
|
* select which connectors are more important right now.
|
|
* So far, we only apply the default ordering, more might be added
|
|
* in the future.
|
|
*/
|
|
|
|
grdrm_object *object;
|
|
grdrm_crtc *crtc;
|
|
Iterator i, j;
|
|
|
|
/* clear assignments */
|
|
HASHMAP_FOREACH(object, card->object_map, i)
|
|
object->assigned = false;
|
|
|
|
/* preserve existing configurations */
|
|
HASHMAP_FOREACH(object, card->object_map, i) {
|
|
if (object->type != GRDRM_TYPE_CRTC || object->assigned)
|
|
continue;
|
|
|
|
crtc = crtc_from_object(object);
|
|
|
|
if (crtc->applied) {
|
|
/* If our mode is set, preserve it. If no connector is
|
|
* set, modeset either failed or the pipe is unused. In
|
|
* both cases, leave it alone. It might be tried again
|
|
* below in case there're remaining connectors.
|
|
* Otherwise, try restoring the assignments. If they
|
|
* are no longer valid, leave the pipe untouched. */
|
|
|
|
if (crtc->set.n_connectors < 1)
|
|
continue;
|
|
|
|
assert(crtc->set.n_connectors == 1);
|
|
|
|
object = grdrm_find_object(card, crtc->set.connectors[0]);
|
|
if (!object || object->type != GRDRM_TYPE_CONNECTOR)
|
|
continue;
|
|
|
|
card_configure_crtc(crtc, connector_from_object(object));
|
|
} else if (crtc->kern.mode_set && crtc->kern.n_used_connectors != 1) {
|
|
/* If our mode is not set on the pipe, we know the kern
|
|
* information is valid. Try keeping it. If it's not
|
|
* possible, leave the pipe untouched for later
|
|
* assignements. */
|
|
|
|
object = grdrm_find_object(card, crtc->kern.used_connectors[0]);
|
|
if (!object || object->type != GRDRM_TYPE_CONNECTOR)
|
|
continue;
|
|
|
|
card_configure_crtc(crtc, connector_from_object(object));
|
|
}
|
|
}
|
|
|
|
/* assign remaining objects */
|
|
HASHMAP_FOREACH(object, card->object_map, i) {
|
|
if (object->type != GRDRM_TYPE_CRTC || object->assigned)
|
|
continue;
|
|
|
|
crtc = crtc_from_object(object);
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, j) {
|
|
if (object->type != GRDRM_TYPE_CONNECTOR)
|
|
continue;
|
|
|
|
if (card_configure_crtc(crtc, connector_from_object(object)))
|
|
break;
|
|
}
|
|
|
|
if (!crtc->object.assigned)
|
|
grdrm_crtc_assign(crtc, NULL);
|
|
}
|
|
|
|
/* expose configuration */
|
|
HASHMAP_FOREACH(object, card->object_map, i) {
|
|
if (object->type != GRDRM_TYPE_CRTC)
|
|
continue;
|
|
|
|
grdrm_crtc_expose(crtc_from_object(object));
|
|
}
|
|
}
|
|
|
|
static void grdrm_card_hotplug(grdrm_card *card) {
|
|
int r;
|
|
|
|
assert(card);
|
|
|
|
if (!card->running)
|
|
return;
|
|
|
|
log_debug("grdrm: %s/%s: reconfigure card", card->base.session->name, card->base.name);
|
|
|
|
card->ready = false;
|
|
r = grdrm_card_resync(card);
|
|
if (r < 0) {
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot re-sync card: %m",
|
|
card->base.session->name, card->base.name);
|
|
return;
|
|
}
|
|
|
|
grdev_session_pin(card->base.session);
|
|
|
|
/* debug statement to print card information */
|
|
if (0)
|
|
grdrm_card_print(card);
|
|
|
|
grdrm_card_configure(card);
|
|
card->ready = true;
|
|
card->hotplug = false;
|
|
|
|
grdev_session_unpin(card->base.session);
|
|
}
|
|
|
|
static int grdrm_card_io_fn(sd_event_source *s, int fd, uint32_t revents, void *userdata) {
|
|
grdrm_card *card = userdata;
|
|
struct drm_event_vblank *vblank;
|
|
struct drm_event *event;
|
|
uint32_t id, counter;
|
|
grdrm_object *object;
|
|
char buf[4096];
|
|
size_t len;
|
|
ssize_t l;
|
|
|
|
if (revents & (EPOLLHUP | EPOLLERR)) {
|
|
/* Immediately close device on HUP; no need to flush pending
|
|
* data.. there're no events we care about here. */
|
|
log_debug("grdrm: %s/%s: HUP", card->base.session->name, card->base.name);
|
|
grdrm_card_close(card);
|
|
return 0;
|
|
}
|
|
|
|
if (revents & (EPOLLIN)) {
|
|
l = read(card->fd, buf, sizeof(buf));
|
|
if (l < 0) {
|
|
if (errno == EAGAIN || errno == EINTR)
|
|
return 0;
|
|
|
|
log_debug_errno(errno, "grdrm: %s/%s: read error: %m",
|
|
card->base.session->name, card->base.name);
|
|
grdrm_card_close(card);
|
|
return 0;
|
|
}
|
|
|
|
for (len = l; len > 0; len -= event->length) {
|
|
event = (void*)buf;
|
|
|
|
if (len < sizeof(*event) || len < event->length) {
|
|
log_debug("grdrm: %s/%s: truncated event",
|
|
card->base.session->name, card->base.name);
|
|
break;
|
|
}
|
|
|
|
switch (event->type) {
|
|
case DRM_EVENT_FLIP_COMPLETE:
|
|
vblank = (void*)event;
|
|
if (event->length < sizeof(*vblank)) {
|
|
log_debug("grdrm: %s/%s: truncated vblank event",
|
|
card->base.session->name, card->base.name);
|
|
break;
|
|
}
|
|
|
|
grdrm_decode_vblank_data(vblank->user_data, &id, &counter);
|
|
object = grdrm_find_object(card, id);
|
|
if (!object || object->type != GRDRM_TYPE_CRTC)
|
|
break;
|
|
|
|
grdrm_crtc_flip_complete(crtc_from_object(object), counter, vblank);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int grdrm_card_add(grdrm_card *card, const char *name) {
|
|
assert(card);
|
|
assert(card->fd < 0);
|
|
|
|
card->object_map = hashmap_new(&trivial_hash_ops);
|
|
if (!card->object_map)
|
|
return -ENOMEM;
|
|
|
|
return grdev_card_add(&card->base, name);
|
|
}
|
|
|
|
static void grdrm_card_destroy(grdrm_card *card) {
|
|
assert(card);
|
|
assert(!card->running);
|
|
assert(card->fd < 0);
|
|
assert(hashmap_size(card->object_map) == 0);
|
|
|
|
hashmap_free(card->object_map);
|
|
}
|
|
|
|
static void grdrm_card_commit(grdev_card *basecard) {
|
|
grdrm_card *card = grdrm_card_from_base(basecard);
|
|
grdrm_object *object;
|
|
Iterator iter;
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (!card->ready)
|
|
break;
|
|
|
|
if (object->type != GRDRM_TYPE_CRTC)
|
|
continue;
|
|
|
|
grdrm_crtc_commit(crtc_from_object(object));
|
|
}
|
|
}
|
|
|
|
static void grdrm_card_restore(grdev_card *basecard) {
|
|
grdrm_card *card = grdrm_card_from_base(basecard);
|
|
grdrm_object *object;
|
|
Iterator iter;
|
|
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
if (!card->ready)
|
|
break;
|
|
|
|
if (object->type != GRDRM_TYPE_CRTC)
|
|
continue;
|
|
|
|
grdrm_crtc_restore(crtc_from_object(object));
|
|
}
|
|
}
|
|
|
|
static void grdrm_card_enable(grdrm_card *card) {
|
|
assert(card);
|
|
|
|
if (card->fd < 0 || card->running)
|
|
return;
|
|
|
|
/* ignore cards without DUMB_BUFFER capability */
|
|
if (!card->cap_dumb)
|
|
return;
|
|
|
|
assert(card->fd_src);
|
|
|
|
log_debug("grdrm: %s/%s: enable", card->base.session->name, card->base.name);
|
|
|
|
card->running = true;
|
|
sd_event_source_set_enabled(card->fd_src, SD_EVENT_ON);
|
|
grdrm_card_hotplug(card);
|
|
}
|
|
|
|
static void grdrm_card_disable(grdrm_card *card) {
|
|
grdrm_object *object;
|
|
Iterator iter;
|
|
|
|
assert(card);
|
|
|
|
if (card->fd < 0 || !card->running)
|
|
return;
|
|
|
|
assert(card->fd_src);
|
|
|
|
log_debug("grdrm: %s/%s: disable", card->base.session->name, card->base.name);
|
|
|
|
card->running = false;
|
|
card->ready = false;
|
|
sd_event_source_set_enabled(card->fd_src, SD_EVENT_OFF);
|
|
|
|
/* stop all pipes */
|
|
HASHMAP_FOREACH(object, card->object_map, iter) {
|
|
grdrm_crtc *crtc;
|
|
|
|
if (object->type != GRDRM_TYPE_CRTC)
|
|
continue;
|
|
|
|
crtc = crtc_from_object(object);
|
|
crtc->applied = false;
|
|
if (crtc->pipe)
|
|
grdev_pipe_ready(&crtc->pipe->base, false);
|
|
}
|
|
}
|
|
|
|
static int grdrm_card_open(grdrm_card *card, int dev_fd) {
|
|
_cleanup_(grdev_session_unpinp) grdev_session *pin = NULL;
|
|
_cleanup_close_ int fd = dev_fd;
|
|
struct drm_get_cap cap;
|
|
int r, flags;
|
|
|
|
assert(card);
|
|
assert(dev_fd >= 0);
|
|
assert(card->fd != dev_fd);
|
|
|
|
pin = grdev_session_pin(card->base.session);
|
|
grdrm_card_close(card);
|
|
|
|
log_debug("grdrm: %s/%s: open", card->base.session->name, card->base.name);
|
|
|
|
r = fd_nonblock(fd, true);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
r = fd_cloexec(fd, true);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
flags = fcntl(fd, F_GETFL, 0);
|
|
if (flags < 0)
|
|
return -errno;
|
|
if ((flags & O_ACCMODE) != O_RDWR)
|
|
return -EACCES;
|
|
|
|
r = sd_event_add_io(card->base.session->context->event,
|
|
&card->fd_src,
|
|
fd,
|
|
EPOLLHUP | EPOLLERR | EPOLLIN,
|
|
grdrm_card_io_fn,
|
|
card);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
sd_event_source_set_enabled(card->fd_src, SD_EVENT_OFF);
|
|
|
|
card->hotplug = true;
|
|
card->fd = fd;
|
|
fd = -1;
|
|
|
|
/* cache DUMB_BUFFER capability */
|
|
cap.capability = DRM_CAP_DUMB_BUFFER;
|
|
cap.value = 0;
|
|
r = ioctl(card->fd, DRM_IOCTL_GET_CAP, &cap);
|
|
card->cap_dumb = r >= 0 && cap.value;
|
|
if (r < 0)
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot retrieve DUMB_BUFFER capability: %m",
|
|
card->base.session->name, card->base.name);
|
|
else if (!card->cap_dumb)
|
|
log_debug("grdrm: %s/%s: DUMB_BUFFER capability not supported",
|
|
card->base.session->name, card->base.name);
|
|
|
|
/* cache TIMESTAMP_MONOTONIC capability */
|
|
cap.capability = DRM_CAP_TIMESTAMP_MONOTONIC;
|
|
cap.value = 0;
|
|
r = ioctl(card->fd, DRM_IOCTL_GET_CAP, &cap);
|
|
card->cap_monotonic = r >= 0 && cap.value;
|
|
if (r < 0)
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot retrieve TIMESTAMP_MONOTONIC capability: %m",
|
|
card->base.session->name, card->base.name);
|
|
else if (!card->cap_monotonic)
|
|
log_debug("grdrm: %s/%s: TIMESTAMP_MONOTONIC is disabled globally, fix this NOW!",
|
|
card->base.session->name, card->base.name);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void grdrm_card_close(grdrm_card *card) {
|
|
grdrm_object *object;
|
|
|
|
if (card->fd < 0)
|
|
return;
|
|
|
|
log_debug("grdrm: %s/%s: close", card->base.session->name, card->base.name);
|
|
|
|
grdrm_card_disable(card);
|
|
|
|
card->fd_src = sd_event_source_unref(card->fd_src);
|
|
card->fd = safe_close(card->fd);
|
|
|
|
grdev_session_pin(card->base.session);
|
|
while ((object = hashmap_first(card->object_map)))
|
|
grdrm_object_free(object);
|
|
grdev_session_unpin(card->base.session);
|
|
}
|
|
|
|
static bool grdrm_card_async(grdrm_card *card, int r) {
|
|
switch (r) {
|
|
case -EACCES:
|
|
/* If we get EACCES on runtime DRM calls, we lost DRM-Master
|
|
* (or we did something terribly wrong). Immediately disable
|
|
* the card, so we stop all pipes and wait to be activated
|
|
* again. */
|
|
grdrm_card_disable(card);
|
|
break;
|
|
case -ENOENT:
|
|
/* DRM objects can be hotplugged at any time. If an object is
|
|
* removed that we use, we remember that state so a following
|
|
* call can test for this.
|
|
* Note that we also get a uevent as followup, this will resync
|
|
* the whole device. */
|
|
card->async_hotplug = true;
|
|
break;
|
|
}
|
|
|
|
return !card->ready;
|
|
}
|
|
|
|
/*
|
|
* Unmanaged Cards
|
|
* The unmanaged DRM card opens the device node for a given DRM device
|
|
* directly (/dev/dri/cardX) and thus needs sufficient privileges. It opens
|
|
* the device only if we really require it and releases it as soon as we're
|
|
* disabled or closed.
|
|
* The unmanaged element can be used in all situations where you have direct
|
|
* access to DRM device nodes. Unlike managed DRM elements, it can be used
|
|
* outside of user sessions and in emergency situations where logind is not
|
|
* available.
|
|
*/
|
|
|
|
static void unmanaged_card_enable(grdev_card *basecard) {
|
|
unmanaged_card *cu = unmanaged_card_from_base(basecard);
|
|
int r, fd;
|
|
|
|
if (cu->card.fd < 0) {
|
|
/* try open on activation if it failed during allocation */
|
|
fd = open(cu->devnode, O_RDWR | O_CLOEXEC | O_NOCTTY | O_NONBLOCK);
|
|
if (fd < 0) {
|
|
/* not fatal; simply ignore the device */
|
|
log_debug_errno(errno, "grdrm: %s/%s: cannot open node %s: %m",
|
|
basecard->session->name, basecard->name, cu->devnode);
|
|
return;
|
|
}
|
|
|
|
/* we might already be DRM-Master by open(); that's fine */
|
|
|
|
r = grdrm_card_open(&cu->card, fd);
|
|
if (r < 0) {
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot open: %m",
|
|
basecard->session->name, basecard->name);
|
|
return;
|
|
}
|
|
}
|
|
|
|
r = ioctl(cu->card.fd, DRM_IOCTL_SET_MASTER, 0);
|
|
if (r < 0) {
|
|
log_debug_errno(errno, "grdrm: %s/%s: cannot acquire DRM-Master: %m",
|
|
basecard->session->name, basecard->name);
|
|
return;
|
|
}
|
|
|
|
grdrm_card_enable(&cu->card);
|
|
}
|
|
|
|
static void unmanaged_card_disable(grdev_card *basecard) {
|
|
unmanaged_card *cu = unmanaged_card_from_base(basecard);
|
|
|
|
grdrm_card_disable(&cu->card);
|
|
}
|
|
|
|
static int unmanaged_card_new(grdev_card **out, grdev_session *session, struct udev_device *ud) {
|
|
_cleanup_(grdev_card_freep) grdev_card *basecard = NULL;
|
|
char name[GRDRM_CARD_NAME_MAX];
|
|
unmanaged_card *cu;
|
|
const char *devnode;
|
|
dev_t devnum;
|
|
int r, fd;
|
|
|
|
assert_return(session, -EINVAL);
|
|
assert_return(ud, -EINVAL);
|
|
|
|
devnode = udev_device_get_devnode(ud);
|
|
devnum = udev_device_get_devnum(ud);
|
|
if (!devnode || devnum == 0)
|
|
return -ENODEV;
|
|
|
|
grdrm_name(name, devnum);
|
|
|
|
cu = new0(unmanaged_card, 1);
|
|
if (!cu)
|
|
return -ENOMEM;
|
|
|
|
basecard = &cu->card.base;
|
|
cu->card = GRDRM_CARD_INIT(&unmanaged_card_vtable, session);
|
|
|
|
cu->devnode = strdup(devnode);
|
|
if (!cu->devnode)
|
|
return -ENOMEM;
|
|
|
|
r = grdrm_card_add(&cu->card, name);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
/* try to open but ignore errors */
|
|
fd = open(cu->devnode, O_RDWR | O_CLOEXEC | O_NOCTTY | O_NONBLOCK);
|
|
if (fd < 0) {
|
|
/* not fatal; allow uaccess based control on activation */
|
|
log_debug_errno(errno, "grdrm: %s/%s: cannot open node %s: %m",
|
|
basecard->session->name, basecard->name, cu->devnode);
|
|
} else {
|
|
/* We might get DRM-Master implicitly on open(); drop it immediately
|
|
* so we acquire it only once we're actually enabled. We don't
|
|
* really care whether this call fails or not, but lets log any
|
|
* weird errors, anyway. */
|
|
r = ioctl(fd, DRM_IOCTL_DROP_MASTER, 0);
|
|
if (r < 0 && errno != EACCES && errno != EINVAL)
|
|
log_debug_errno(errno, "grdrm: %s/%s: cannot drop DRM-Master: %m",
|
|
basecard->session->name, basecard->name);
|
|
|
|
r = grdrm_card_open(&cu->card, fd);
|
|
if (r < 0)
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot open: %m",
|
|
basecard->session->name, basecard->name);
|
|
}
|
|
|
|
if (out)
|
|
*out = basecard;
|
|
basecard = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static void unmanaged_card_free(grdev_card *basecard) {
|
|
unmanaged_card *cu = unmanaged_card_from_base(basecard);
|
|
|
|
assert(!basecard->enabled);
|
|
|
|
grdrm_card_close(&cu->card);
|
|
grdrm_card_destroy(&cu->card);
|
|
free(cu->devnode);
|
|
free(cu);
|
|
}
|
|
|
|
static const grdev_card_vtable unmanaged_card_vtable = {
|
|
.free = unmanaged_card_free,
|
|
.enable = unmanaged_card_enable,
|
|
.disable = unmanaged_card_disable,
|
|
.commit = grdrm_card_commit,
|
|
.restore = grdrm_card_restore,
|
|
};
|
|
|
|
/*
|
|
* Managed Cards
|
|
* The managed DRM card uses systemd-logind to acquire DRM devices. This
|
|
* means, we do not open the device node /dev/dri/cardX directly. Instead,
|
|
* logind passes us a file-descriptor whenever our session is activated. Thus,
|
|
* we don't need access to the device node directly.
|
|
* Furthermore, whenever the session is put asleep, logind revokes the
|
|
* file-descriptor so we loose access to the device.
|
|
* Managed DRM cards should be preferred over unmanaged DRM cards whenever
|
|
* you run inside a user session with exclusive device access.
|
|
*/
|
|
|
|
static void managed_card_enable(grdev_card *card) {
|
|
managed_card *cm = managed_card_from_base(card);
|
|
|
|
/* If the device is manually re-enabled, we try to resume our card
|
|
* management. Note that we have no control over DRM-Master and the fd,
|
|
* so we have to take over the state from the last logind event. */
|
|
|
|
if (cm->master)
|
|
grdrm_card_enable(&cm->card);
|
|
}
|
|
|
|
static void managed_card_disable(grdev_card *card) {
|
|
managed_card *cm = managed_card_from_base(card);
|
|
|
|
/* If the device is manually disabled, we keep the FD but put our card
|
|
* management asleep. This way, we can wake up at any time, but don't
|
|
* touch the device while asleep. */
|
|
|
|
grdrm_card_disable(&cm->card);
|
|
}
|
|
|
|
static int managed_card_pause_device_fn(sd_bus *bus,
|
|
sd_bus_message *signal,
|
|
void *userdata,
|
|
sd_bus_error *ret_error) {
|
|
managed_card *cm = userdata;
|
|
grdev_session *session = cm->card.base.session;
|
|
uint32_t major, minor;
|
|
const char *mode;
|
|
int r;
|
|
|
|
/*
|
|
* We get PauseDevice() signals from logind whenever a device we
|
|
* requested was, or is about to be, paused. Arguments are major/minor
|
|
* number of the device and the mode of the operation.
|
|
* In case the event is not about our device, we ignore it. Otherwise,
|
|
* we treat it as asynchronous DRM-DROP-MASTER. Note that we might have
|
|
* already handled an EACCES error from a modeset ioctl, in which case
|
|
* we already disabled the device.
|
|
*
|
|
* @mode can be one of the following:
|
|
* "pause": The device is about to be paused. We must react
|
|
* immediately and respond with PauseDeviceComplete(). Once
|
|
* we replied, logind will pause the device. Note that
|
|
* logind might apply any kind of timeout and force pause
|
|
* the device if we don't respond in a timely manner. In
|
|
* this case, we will receive a second PauseDevice event
|
|
* with @mode set to "force" (or similar).
|
|
* "force": The device was disabled forecfully by logind. DRM-Master
|
|
* was already dropped. This is just an asynchronous
|
|
* notification so we can put the device asleep (in case
|
|
* we didn't already notice the dropped DRM-Master).
|
|
* "gone": This is like "force" but is sent if the device was
|
|
* paused due to a device-removal event.
|
|
*
|
|
* We always handle PauseDevice signals as "force" as we properly
|
|
* support asynchronously dropping DRM-Master, anyway. But in case
|
|
* logind sent mode "pause", we also call PauseDeviceComplete() to
|
|
* immediately acknowledge the request.
|
|
*/
|
|
|
|
r = sd_bus_message_read(signal, "uus", &major, &minor, &mode);
|
|
if (r < 0) {
|
|
log_debug("grdrm: %s/%s: erroneous PauseDevice signal",
|
|
session->name, cm->card.base.name);
|
|
return 0;
|
|
}
|
|
|
|
/* not our device? */
|
|
if (makedev(major, minor) != cm->devnum)
|
|
return 0;
|
|
|
|
cm->master = false;
|
|
grdrm_card_disable(&cm->card);
|
|
|
|
if (streq(mode, "pause")) {
|
|
_cleanup_bus_message_unref_ sd_bus_message *m = NULL;
|
|
|
|
/*
|
|
* Sending PauseDeviceComplete() is racy if logind triggers the
|
|
* timeout. That is, if we take too long and logind pauses the
|
|
* device by sending a forced PauseDevice, our
|
|
* PauseDeviceComplete call will be stray. That's fine, though.
|
|
* logind ignores such stray calls. Only if logind also sent a
|
|
* further PauseDevice() signal, it might match our call
|
|
* incorrectly to the newer PauseDevice(). That's fine, too, as
|
|
* we handle that event asynchronously, anyway. Therefore,
|
|
* whatever happens, we're fine. Yay!
|
|
*/
|
|
|
|
r = sd_bus_message_new_method_call(session->context->sysbus,
|
|
&m,
|
|
"org.freedesktop.login1",
|
|
session->path,
|
|
"org.freedesktop.login1.Session",
|
|
"PauseDeviceComplete");
|
|
if (r >= 0) {
|
|
r = sd_bus_message_append(m, "uu", major, minor);
|
|
if (r >= 0)
|
|
r = sd_bus_send(session->context->sysbus, m, NULL);
|
|
}
|
|
|
|
if (r < 0)
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot send PauseDeviceComplete: %m",
|
|
session->name, cm->card.base.name);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int managed_card_resume_device_fn(sd_bus *bus,
|
|
sd_bus_message *signal,
|
|
void *userdata,
|
|
sd_bus_error *ret_error) {
|
|
managed_card *cm = userdata;
|
|
grdev_session *session = cm->card.base.session;
|
|
uint32_t major, minor;
|
|
int r, fd;
|
|
|
|
/*
|
|
* We get ResumeDevice signals whenever logind resumed a previously
|
|
* paused device. The arguments contain the major/minor number of the
|
|
* related device and a new file-descriptor for the freshly opened
|
|
* device-node.
|
|
* If the signal is not about our device, we simply ignore it.
|
|
* Otherwise, we immediately resume the device. Note that we drop the
|
|
* new file-descriptor as we already have one from TakeDevice(). logind
|
|
* preserves the file-context across pause/resume for DRM but only
|
|
* drops/acquires DRM-Master accordingly. This way, our context (like
|
|
* DRM-FBs and BOs) is preserved.
|
|
*/
|
|
|
|
r = sd_bus_message_read(signal, "uuh", &major, &minor, &fd);
|
|
if (r < 0) {
|
|
log_debug("grdrm: %s/%s: erroneous ResumeDevice signal",
|
|
session->name, cm->card.base.name);
|
|
return 0;
|
|
}
|
|
|
|
/* not our device? */
|
|
if (makedev(major, minor) != cm->devnum)
|
|
return 0;
|
|
|
|
if (cm->card.fd < 0) {
|
|
/* This shouldn't happen. We should already own an FD from
|
|
* TakeDevice(). However, lets be safe and use this FD in case
|
|
* we really don't have one. There is no harm in doing this
|
|
* and our code works fine this way. */
|
|
fd = fcntl(fd, F_DUPFD_CLOEXEC, 3);
|
|
if (fd < 0) {
|
|
log_debug_errno(errno, "grdrm: %s/%s: cannot duplicate fd: %m",
|
|
session->name, cm->card.base.name);
|
|
return 0;
|
|
}
|
|
|
|
r = grdrm_card_open(&cm->card, fd);
|
|
if (r < 0) {
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot open: %m",
|
|
session->name, cm->card.base.name);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
cm->master = true;
|
|
if (cm->card.base.enabled)
|
|
grdrm_card_enable(&cm->card);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int managed_card_setup_bus(managed_card *cm) {
|
|
grdev_session *session = cm->card.base.session;
|
|
_cleanup_free_ char *match = NULL;
|
|
int r;
|
|
|
|
match = strjoin("type='signal',"
|
|
"sender='org.freedesktop.login1',"
|
|
"interface='org.freedesktop.login1.Session',"
|
|
"member='PauseDevice',"
|
|
"path='", session->path, "'",
|
|
NULL);
|
|
if (!match)
|
|
return -ENOMEM;
|
|
|
|
r = sd_bus_add_match(session->context->sysbus,
|
|
&cm->slot_pause_device,
|
|
match,
|
|
managed_card_pause_device_fn,
|
|
cm);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
free(match);
|
|
match = strjoin("type='signal',"
|
|
"sender='org.freedesktop.login1',"
|
|
"interface='org.freedesktop.login1.Session',"
|
|
"member='ResumeDevice',"
|
|
"path='", session->path, "'",
|
|
NULL);
|
|
if (!match)
|
|
return -ENOMEM;
|
|
|
|
r = sd_bus_add_match(session->context->sysbus,
|
|
&cm->slot_resume_device,
|
|
match,
|
|
managed_card_resume_device_fn,
|
|
cm);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int managed_card_take_device_fn(sd_bus *bus,
|
|
sd_bus_message *reply,
|
|
void *userdata,
|
|
sd_bus_error *ret_error) {
|
|
managed_card *cm = userdata;
|
|
grdev_session *session = cm->card.base.session;
|
|
int r, paused, fd;
|
|
|
|
cm->slot_take_device = sd_bus_slot_unref(cm->slot_take_device);
|
|
|
|
if (sd_bus_message_is_method_error(reply, NULL)) {
|
|
const sd_bus_error *error = sd_bus_message_get_error(reply);
|
|
|
|
log_debug("grdrm: %s/%s: TakeDevice failed: %s: %s",
|
|
session->name, cm->card.base.name, error->name, error->message);
|
|
return 0;
|
|
}
|
|
|
|
cm->acquired = true;
|
|
|
|
r = sd_bus_message_read(reply, "hb", &fd, &paused);
|
|
if (r < 0) {
|
|
log_debug("grdrm: %s/%s: erroneous TakeDevice reply",
|
|
session->name, cm->card.base.name);
|
|
return 0;
|
|
}
|
|
|
|
fd = fcntl(fd, F_DUPFD_CLOEXEC, 3);
|
|
if (fd < 0) {
|
|
log_debug_errno(errno, "grdrm: %s/%s: cannot duplicate fd: %m",
|
|
session->name, cm->card.base.name);
|
|
return 0;
|
|
}
|
|
|
|
r = grdrm_card_open(&cm->card, fd);
|
|
if (r < 0) {
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot open: %m",
|
|
session->name, cm->card.base.name);
|
|
return 0;
|
|
}
|
|
|
|
if (!paused && cm->card.base.enabled)
|
|
grdrm_card_enable(&cm->card);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void managed_card_take_device(managed_card *cm) {
|
|
_cleanup_bus_message_unref_ sd_bus_message *m = NULL;
|
|
grdev_session *session = cm->card.base.session;
|
|
int r;
|
|
|
|
r = sd_bus_message_new_method_call(session->context->sysbus,
|
|
&m,
|
|
"org.freedesktop.login1",
|
|
session->path,
|
|
"org.freedesktop.login1.Session",
|
|
"TakeDevice");
|
|
if (r < 0)
|
|
goto error;
|
|
|
|
r = sd_bus_message_append(m, "uu", major(cm->devnum), minor(cm->devnum));
|
|
if (r < 0)
|
|
goto error;
|
|
|
|
r = sd_bus_call_async(session->context->sysbus,
|
|
&cm->slot_take_device,
|
|
m,
|
|
managed_card_take_device_fn,
|
|
cm,
|
|
0);
|
|
if (r < 0)
|
|
goto error;
|
|
|
|
cm->requested = true;
|
|
return;
|
|
|
|
error:
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot send TakeDevice request: %m",
|
|
session->name, cm->card.base.name);
|
|
}
|
|
|
|
static void managed_card_release_device(managed_card *cm) {
|
|
_cleanup_bus_message_unref_ sd_bus_message *m = NULL;
|
|
grdev_session *session = cm->card.base.session;
|
|
int r;
|
|
|
|
/*
|
|
* If TakeDevice() is pending or was successful, make sure to
|
|
* release the device again. We don't care for return-values,
|
|
* so send it without waiting or callbacks.
|
|
* If a failed TakeDevice() is pending, but someone else took
|
|
* the device on the same bus-connection, we might incorrectly
|
|
* release their device. This is an unlikely race, though.
|
|
* Furthermore, you really shouldn't have two users of the
|
|
* controller-API on the same session, on the same devices, *AND* on
|
|
* the same bus-connection. So we don't care for that race..
|
|
*/
|
|
|
|
grdrm_card_close(&cm->card);
|
|
cm->requested = false;
|
|
|
|
if (!cm->acquired && !cm->slot_take_device)
|
|
return;
|
|
|
|
cm->slot_take_device = sd_bus_slot_unref(cm->slot_take_device);
|
|
cm->acquired = false;
|
|
|
|
r = sd_bus_message_new_method_call(session->context->sysbus,
|
|
&m,
|
|
"org.freedesktop.login1",
|
|
session->path,
|
|
"org.freedesktop.login1.Session",
|
|
"ReleaseDevice");
|
|
if (r >= 0) {
|
|
r = sd_bus_message_append(m, "uu", major(cm->devnum), minor(cm->devnum));
|
|
if (r >= 0)
|
|
r = sd_bus_send(session->context->sysbus, m, NULL);
|
|
}
|
|
|
|
if (r < 0 && r != -ENOTCONN)
|
|
log_debug_errno(r, "grdrm: %s/%s: cannot send ReleaseDevice: %m",
|
|
session->name, cm->card.base.name);
|
|
}
|
|
|
|
static int managed_card_new(grdev_card **out, grdev_session *session, struct udev_device *ud) {
|
|
_cleanup_(grdev_card_freep) grdev_card *basecard = NULL;
|
|
char name[GRDRM_CARD_NAME_MAX];
|
|
managed_card *cm;
|
|
dev_t devnum;
|
|
int r;
|
|
|
|
assert_return(session, -EINVAL);
|
|
assert_return(session->managed, -EINVAL);
|
|
assert_return(session->context->sysbus, -EINVAL);
|
|
assert_return(ud, -EINVAL);
|
|
|
|
devnum = udev_device_get_devnum(ud);
|
|
if (devnum == 0)
|
|
return -ENODEV;
|
|
|
|
grdrm_name(name, devnum);
|
|
|
|
cm = new0(managed_card, 1);
|
|
if (!cm)
|
|
return -ENOMEM;
|
|
|
|
basecard = &cm->card.base;
|
|
cm->card = GRDRM_CARD_INIT(&managed_card_vtable, session);
|
|
cm->devnum = devnum;
|
|
|
|
r = managed_card_setup_bus(cm);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
r = grdrm_card_add(&cm->card, name);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
managed_card_take_device(cm);
|
|
|
|
if (out)
|
|
*out = basecard;
|
|
basecard = NULL;
|
|
return 0;
|
|
}
|
|
|
|
static void managed_card_free(grdev_card *basecard) {
|
|
managed_card *cm = managed_card_from_base(basecard);
|
|
|
|
assert(!basecard->enabled);
|
|
|
|
managed_card_release_device(cm);
|
|
cm->slot_resume_device = sd_bus_slot_unref(cm->slot_resume_device);
|
|
cm->slot_pause_device = sd_bus_slot_unref(cm->slot_pause_device);
|
|
grdrm_card_destroy(&cm->card);
|
|
free(cm);
|
|
}
|
|
|
|
static const grdev_card_vtable managed_card_vtable = {
|
|
.free = managed_card_free,
|
|
.enable = managed_card_enable,
|
|
.disable = managed_card_disable,
|
|
.commit = grdrm_card_commit,
|
|
.restore = grdrm_card_restore,
|
|
};
|
|
|
|
/*
|
|
* Generic Constructor
|
|
* Instead of relying on the caller to choose between managed and unmanaged
|
|
* DRM devices, the grdev_drm_new() constructor does that for you (by
|
|
* looking at session->managed).
|
|
*/
|
|
|
|
bool grdev_is_drm_card(grdev_card *basecard) {
|
|
return basecard && (basecard->vtable == &unmanaged_card_vtable ||
|
|
basecard->vtable == &managed_card_vtable);
|
|
}
|
|
|
|
grdev_card *grdev_find_drm_card(grdev_session *session, dev_t devnum) {
|
|
char name[GRDRM_CARD_NAME_MAX];
|
|
|
|
assert_return(session, NULL);
|
|
assert_return(devnum != 0, NULL);
|
|
|
|
grdrm_name(name, devnum);
|
|
return grdev_find_card(session, name);
|
|
}
|
|
|
|
int grdev_drm_card_new(grdev_card **out, grdev_session *session, struct udev_device *ud) {
|
|
assert_return(session, -EINVAL);
|
|
assert_return(ud, -EINVAL);
|
|
|
|
return session->managed ? managed_card_new(out, session, ud) : unmanaged_card_new(out, session, ud);
|
|
}
|
|
|
|
void grdev_drm_card_hotplug(grdev_card *basecard, struct udev_device *ud) {
|
|
const char *p, *action;
|
|
grdrm_card *card;
|
|
dev_t devnum;
|
|
|
|
assert(basecard);
|
|
assert(grdev_is_drm_card(basecard));
|
|
assert(ud);
|
|
|
|
card = grdrm_card_from_base(basecard);
|
|
|
|
action = udev_device_get_action(ud);
|
|
if (!action || streq(action, "add") || streq(action, "remove")) {
|
|
/* If we get add/remove events on DRM nodes without devnum, we
|
|
* got hotplugged DRM objects so refresh the device. */
|
|
devnum = udev_device_get_devnum(ud);
|
|
if (devnum == 0) {
|
|
card->hotplug = true;
|
|
grdrm_card_hotplug(card);
|
|
}
|
|
} else if (streq_ptr(action, "change")) {
|
|
/* A change event with HOTPLUG=1 is sent whenever a connector
|
|
* changed state. Refresh the device to update our state. */
|
|
p = udev_device_get_property_value(ud, "HOTPLUG");
|
|
if (streq_ptr(p, "1")) {
|
|
card->hotplug = true;
|
|
grdrm_card_hotplug(card);
|
|
}
|
|
}
|
|
}
|