Create a new file for the DRM backend's handling of output modes, e.g. resolution, aspect ratio, preferred mode selection, EDID parsing. Signed-off-by: Daniel Stone <daniels@collabora.com>dev
Daniel Stone
6 years ago
parent
3448cfce0f
commit
fbe6c1db7b
@ -0,0 +1,772 @@ |
||||
/*
|
||||
* Copyright © 2008-2011 Kristian Høgsberg |
||||
* Copyright © 2011 Intel Corporation |
||||
* Copyright © 2017, 2018 Collabora, Ltd. |
||||
* Copyright © 2017, 2018 General Electric Company |
||||
* Copyright (c) 2018 DisplayLink (UK) Ltd. |
||||
* |
||||
* Permission is hereby granted, free of charge, to any person obtaining |
||||
* a copy of this software and associated documentation files (the |
||||
* "Software"), to deal in the Software without restriction, including |
||||
* without limitation the rights to use, copy, modify, merge, publish, |
||||
* distribute, sublicense, and/or sell copies of the Software, and to |
||||
* permit persons to whom the Software is furnished to do so, subject to |
||||
* the following conditions: |
||||
* |
||||
* The above copyright notice and this permission notice (including the |
||||
* next paragraph) shall be included in all copies or substantial |
||||
* portions of the Software. |
||||
* |
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
||||
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS |
||||
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN |
||||
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
||||
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
||||
* SOFTWARE. |
||||
*/ |
||||
|
||||
#include "config.h" |
||||
|
||||
#include <xf86drm.h> |
||||
#include <xf86drmMode.h> |
||||
#include <drm_fourcc.h> |
||||
|
||||
#include "drm-internal.h" |
||||
|
||||
static const char *const aspect_ratio_as_string[] = { |
||||
[WESTON_MODE_PIC_AR_NONE] = "", |
||||
[WESTON_MODE_PIC_AR_4_3] = " 4:3", |
||||
[WESTON_MODE_PIC_AR_16_9] = " 16:9", |
||||
[WESTON_MODE_PIC_AR_64_27] = " 64:27", |
||||
[WESTON_MODE_PIC_AR_256_135] = " 256:135", |
||||
}; |
||||
|
||||
/*
|
||||
* Get the aspect-ratio from drmModeModeInfo mode flags. |
||||
* |
||||
* @param drm_mode_flags- flags from drmModeModeInfo structure. |
||||
* @returns aspect-ratio as encoded in enum 'weston_mode_aspect_ratio'. |
||||
*/ |
||||
static enum weston_mode_aspect_ratio |
||||
drm_to_weston_mode_aspect_ratio(uint32_t drm_mode_flags) |
||||
{ |
||||
return (drm_mode_flags & DRM_MODE_FLAG_PIC_AR_MASK) >> |
||||
DRM_MODE_FLAG_PIC_AR_BITS_POS; |
||||
} |
||||
|
||||
static const char * |
||||
aspect_ratio_to_string(enum weston_mode_aspect_ratio ratio) |
||||
{ |
||||
if (ratio < 0 || ratio >= ARRAY_LENGTH(aspect_ratio_as_string) || |
||||
!aspect_ratio_as_string[ratio]) |
||||
return " (unknown aspect ratio)"; |
||||
|
||||
return aspect_ratio_as_string[ratio]; |
||||
} |
||||
|
||||
static int |
||||
drm_subpixel_to_wayland(int drm_value) |
||||
{ |
||||
switch (drm_value) { |
||||
default: |
||||
case DRM_MODE_SUBPIXEL_UNKNOWN: |
||||
return WL_OUTPUT_SUBPIXEL_UNKNOWN; |
||||
case DRM_MODE_SUBPIXEL_NONE: |
||||
return WL_OUTPUT_SUBPIXEL_NONE; |
||||
case DRM_MODE_SUBPIXEL_HORIZONTAL_RGB: |
||||
return WL_OUTPUT_SUBPIXEL_HORIZONTAL_RGB; |
||||
case DRM_MODE_SUBPIXEL_HORIZONTAL_BGR: |
||||
return WL_OUTPUT_SUBPIXEL_HORIZONTAL_BGR; |
||||
case DRM_MODE_SUBPIXEL_VERTICAL_RGB: |
||||
return WL_OUTPUT_SUBPIXEL_VERTICAL_RGB; |
||||
case DRM_MODE_SUBPIXEL_VERTICAL_BGR: |
||||
return WL_OUTPUT_SUBPIXEL_VERTICAL_BGR; |
||||
} |
||||
} |
||||
|
||||
int |
||||
drm_mode_ensure_blob(struct drm_backend *backend, struct drm_mode *mode) |
||||
{ |
||||
int ret; |
||||
|
||||
if (mode->blob_id) |
||||
return 0; |
||||
|
||||
ret = drmModeCreatePropertyBlob(backend->drm.fd, |
||||
&mode->mode_info, |
||||
sizeof(mode->mode_info), |
||||
&mode->blob_id); |
||||
if (ret != 0) |
||||
weston_log("failed to create mode property blob: %s\n", |
||||
strerror(errno)); |
||||
|
||||
drm_debug(backend, "\t\t\t[atomic] created new mode blob %lu for %s\n", |
||||
(unsigned long) mode->blob_id, mode->mode_info.name); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static bool |
||||
check_non_desktop(struct drm_head *head, drmModeObjectPropertiesPtr props) |
||||
{ |
||||
struct drm_property_info *non_desktop_info = |
||||
&head->props_conn[WDRM_CONNECTOR_NON_DESKTOP]; |
||||
|
||||
return drm_property_get_value(non_desktop_info, props, 0); |
||||
} |
||||
|
||||
static int |
||||
parse_modeline(const char *s, drmModeModeInfo *mode) |
||||
{ |
||||
char hsync[16]; |
||||
char vsync[16]; |
||||
float fclock; |
||||
|
||||
memset(mode, 0, sizeof *mode); |
||||
|
||||
mode->type = DRM_MODE_TYPE_USERDEF; |
||||
mode->hskew = 0; |
||||
mode->vscan = 0; |
||||
mode->vrefresh = 0; |
||||
mode->flags = 0; |
||||
|
||||
if (sscanf(s, "%f %hd %hd %hd %hd %hd %hd %hd %hd %15s %15s", |
||||
&fclock, |
||||
&mode->hdisplay, |
||||
&mode->hsync_start, |
||||
&mode->hsync_end, |
||||
&mode->htotal, |
||||
&mode->vdisplay, |
||||
&mode->vsync_start, |
||||
&mode->vsync_end, |
||||
&mode->vtotal, hsync, vsync) != 11) |
||||
return -1; |
||||
|
||||
mode->clock = fclock * 1000; |
||||
if (strcasecmp(hsync, "+hsync") == 0) |
||||
mode->flags |= DRM_MODE_FLAG_PHSYNC; |
||||
else if (strcasecmp(hsync, "-hsync") == 0) |
||||
mode->flags |= DRM_MODE_FLAG_NHSYNC; |
||||
else |
||||
return -1; |
||||
|
||||
if (strcasecmp(vsync, "+vsync") == 0) |
||||
mode->flags |= DRM_MODE_FLAG_PVSYNC; |
||||
else if (strcasecmp(vsync, "-vsync") == 0) |
||||
mode->flags |= DRM_MODE_FLAG_NVSYNC; |
||||
else |
||||
return -1; |
||||
|
||||
snprintf(mode->name, sizeof mode->name, "%dx%d@%.3f", |
||||
mode->hdisplay, mode->vdisplay, fclock); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static void |
||||
edid_parse_string(const uint8_t *data, char text[]) |
||||
{ |
||||
int i; |
||||
int replaced = 0; |
||||
|
||||
/* this is always 12 bytes, but we can't guarantee it's null
|
||||
* terminated or not junk. */ |
||||
strncpy(text, (const char *) data, 12); |
||||
|
||||
/* guarantee our new string is null-terminated */ |
||||
text[12] = '\0'; |
||||
|
||||
/* remove insane chars */ |
||||
for (i = 0; text[i] != '\0'; i++) { |
||||
if (text[i] == '\n' || |
||||
text[i] == '\r') { |
||||
text[i] = '\0'; |
||||
break; |
||||
} |
||||
} |
||||
|
||||
/* ensure string is printable */ |
||||
for (i = 0; text[i] != '\0'; i++) { |
||||
if (!isprint(text[i])) { |
||||
text[i] = '-'; |
||||
replaced++; |
||||
} |
||||
} |
||||
|
||||
/* if the string is random junk, ignore the string */ |
||||
if (replaced > 4) |
||||
text[0] = '\0'; |
||||
} |
||||
|
||||
#define EDID_DESCRIPTOR_ALPHANUMERIC_DATA_STRING 0xfe |
||||
#define EDID_DESCRIPTOR_DISPLAY_PRODUCT_NAME 0xfc |
||||
#define EDID_DESCRIPTOR_DISPLAY_PRODUCT_SERIAL_NUMBER 0xff |
||||
#define EDID_OFFSET_DATA_BLOCKS 0x36 |
||||
#define EDID_OFFSET_LAST_BLOCK 0x6c |
||||
#define EDID_OFFSET_PNPID 0x08 |
||||
#define EDID_OFFSET_SERIAL 0x0c |
||||
|
||||
static int |
||||
edid_parse(struct drm_edid *edid, const uint8_t *data, size_t length) |
||||
{ |
||||
int i; |
||||
uint32_t serial_number; |
||||
|
||||
/* check header */ |
||||
if (length < 128) |
||||
return -1; |
||||
if (data[0] != 0x00 || data[1] != 0xff) |
||||
return -1; |
||||
|
||||
/* decode the PNP ID from three 5 bit words packed into 2 bytes
|
||||
* /--08--\/--09--\
|
||||
* 7654321076543210 |
||||
* |\---/\---/\---/ |
||||
* R C1 C2 C3 */ |
||||
edid->pnp_id[0] = 'A' + ((data[EDID_OFFSET_PNPID + 0] & 0x7c) / 4) - 1; |
||||
edid->pnp_id[1] = 'A' + ((data[EDID_OFFSET_PNPID + 0] & 0x3) * 8) + ((data[EDID_OFFSET_PNPID + 1] & 0xe0) / 32) - 1; |
||||
edid->pnp_id[2] = 'A' + (data[EDID_OFFSET_PNPID + 1] & 0x1f) - 1; |
||||
edid->pnp_id[3] = '\0'; |
||||
|
||||
/* maybe there isn't a ASCII serial number descriptor, so use this instead */ |
||||
serial_number = (uint32_t) data[EDID_OFFSET_SERIAL + 0]; |
||||
serial_number += (uint32_t) data[EDID_OFFSET_SERIAL + 1] * 0x100; |
||||
serial_number += (uint32_t) data[EDID_OFFSET_SERIAL + 2] * 0x10000; |
||||
serial_number += (uint32_t) data[EDID_OFFSET_SERIAL + 3] * 0x1000000; |
||||
if (serial_number > 0) |
||||
sprintf(edid->serial_number, "%lu", (unsigned long) serial_number); |
||||
|
||||
/* parse EDID data */ |
||||
for (i = EDID_OFFSET_DATA_BLOCKS; |
||||
i <= EDID_OFFSET_LAST_BLOCK; |
||||
i += 18) { |
||||
/* ignore pixel clock data */ |
||||
if (data[i] != 0) |
||||
continue; |
||||
if (data[i+2] != 0) |
||||
continue; |
||||
|
||||
/* any useful blocks? */ |
||||
if (data[i+3] == EDID_DESCRIPTOR_DISPLAY_PRODUCT_NAME) { |
||||
edid_parse_string(&data[i+5], |
||||
edid->monitor_name); |
||||
} else if (data[i+3] == EDID_DESCRIPTOR_DISPLAY_PRODUCT_SERIAL_NUMBER) { |
||||
edid_parse_string(&data[i+5], |
||||
edid->serial_number); |
||||
} else if (data[i+3] == EDID_DESCRIPTOR_ALPHANUMERIC_DATA_STRING) { |
||||
edid_parse_string(&data[i+5], |
||||
edid->eisa_id); |
||||
} |
||||
} |
||||
return 0; |
||||
} |
||||
|
||||
/** Parse monitor make, model and serial from EDID
|
||||
* |
||||
* \param head The head whose \c drm_edid to fill in. |
||||
* \param props The DRM connector properties to get the EDID from. |
||||
* \param[out] make The monitor make (PNP ID). |
||||
* \param[out] model The monitor model (name). |
||||
* \param[out] serial_number The monitor serial number. |
||||
* |
||||
* Each of \c *make, \c *model and \c *serial_number are set only if the |
||||
* information is found in the EDID. The pointers they are set to must not |
||||
* be free()'d explicitly, instead they get implicitly freed when the |
||||
* \c drm_head is destroyed. |
||||
*/ |
||||
static void |
||||
find_and_parse_output_edid(struct drm_head *head, |
||||
drmModeObjectPropertiesPtr props, |
||||
const char **make, |
||||
const char **model, |
||||
const char **serial_number) |
||||
{ |
||||
drmModePropertyBlobPtr edid_blob = NULL; |
||||
uint32_t blob_id; |
||||
int rc; |
||||
|
||||
blob_id = |
||||
drm_property_get_value(&head->props_conn[WDRM_CONNECTOR_EDID], |
||||
props, 0); |
||||
if (!blob_id) |
||||
return; |
||||
|
||||
edid_blob = drmModeGetPropertyBlob(head->backend->drm.fd, blob_id); |
||||
if (!edid_blob) |
||||
return; |
||||
|
||||
rc = edid_parse(&head->edid, |
||||
edid_blob->data, |
||||
edid_blob->length); |
||||
if (!rc) { |
||||
if (head->edid.pnp_id[0] != '\0') |
||||
*make = head->edid.pnp_id; |
||||
if (head->edid.monitor_name[0] != '\0') |
||||
*model = head->edid.monitor_name; |
||||
if (head->edid.serial_number[0] != '\0') |
||||
*serial_number = head->edid.serial_number; |
||||
} |
||||
drmModeFreePropertyBlob(edid_blob); |
||||
} |
||||
|
||||
static uint32_t |
||||
drm_refresh_rate_mHz(const drmModeModeInfo *info) |
||||
{ |
||||
uint64_t refresh; |
||||
|
||||
/* Calculate higher precision (mHz) refresh rate */ |
||||
refresh = (info->clock * 1000000LL / info->htotal + |
||||
info->vtotal / 2) / info->vtotal; |
||||
|
||||
if (info->flags & DRM_MODE_FLAG_INTERLACE) |
||||
refresh *= 2; |
||||
if (info->flags & DRM_MODE_FLAG_DBLSCAN) |
||||
refresh /= 2; |
||||
if (info->vscan > 1) |
||||
refresh /= info->vscan; |
||||
|
||||
return refresh; |
||||
} |
||||
|
||||
/**
|
||||
* Add a mode to output's mode list |
||||
* |
||||
* Copy the supplied DRM mode into a Weston mode structure, and add it to the |
||||
* output's mode list. |
||||
* |
||||
* @param output DRM output to add mode to |
||||
* @param info DRM mode structure to add |
||||
* @returns Newly-allocated Weston/DRM mode structure |
||||
*/ |
||||
static struct drm_mode * |
||||
drm_output_add_mode(struct drm_output *output, const drmModeModeInfo *info) |
||||
{ |
||||
struct drm_mode *mode; |
||||
|
||||
mode = malloc(sizeof *mode); |
||||
if (mode == NULL) |
||||
return NULL; |
||||
|
||||
mode->base.flags = 0; |
||||
mode->base.width = info->hdisplay; |
||||
mode->base.height = info->vdisplay; |
||||
|
||||
mode->base.refresh = drm_refresh_rate_mHz(info); |
||||
mode->mode_info = *info; |
||||
mode->blob_id = 0; |
||||
|
||||
if (info->type & DRM_MODE_TYPE_PREFERRED) |
||||
mode->base.flags |= WL_OUTPUT_MODE_PREFERRED; |
||||
|
||||
mode->base.aspect_ratio = drm_to_weston_mode_aspect_ratio(info->flags); |
||||
|
||||
wl_list_insert(output->base.mode_list.prev, &mode->base.link); |
||||
|
||||
return mode; |
||||
} |
||||
|
||||
/**
|
||||
* Destroys a mode, and removes it from the list. |
||||
*/ |
||||
static void |
||||
drm_output_destroy_mode(struct drm_backend *backend, struct drm_mode *mode) |
||||
{ |
||||
if (mode->blob_id) |
||||
drmModeDestroyPropertyBlob(backend->drm.fd, mode->blob_id); |
||||
wl_list_remove(&mode->base.link); |
||||
free(mode); |
||||
} |
||||
|
||||
/** Destroy a list of drm_modes
|
||||
* |
||||
* @param backend The backend for releasing mode property blobs. |
||||
* @param mode_list The list linked by drm_mode::base.link. |
||||
*/ |
||||
void |
||||
drm_mode_list_destroy(struct drm_backend *backend, struct wl_list *mode_list) |
||||
{ |
||||
struct drm_mode *mode, *next; |
||||
|
||||
wl_list_for_each_safe(mode, next, mode_list, base.link) |
||||
drm_output_destroy_mode(backend, mode); |
||||
} |
||||
|
||||
void |
||||
drm_output_print_modes(struct drm_output *output) |
||||
{ |
||||
struct weston_mode *m; |
||||
struct drm_mode *dm; |
||||
const char *aspect_ratio; |
||||
|
||||
wl_list_for_each(m, &output->base.mode_list, link) { |
||||
dm = to_drm_mode(m); |
||||
|
||||
aspect_ratio = aspect_ratio_to_string(m->aspect_ratio); |
||||
weston_log_continue(STAMP_SPACE "%dx%d@%.1f%s%s%s, %.1f MHz\n", |
||||
m->width, m->height, m->refresh / 1000.0, |
||||
aspect_ratio, |
||||
m->flags & WL_OUTPUT_MODE_PREFERRED ? |
||||
", preferred" : "", |
||||
m->flags & WL_OUTPUT_MODE_CURRENT ? |
||||
", current" : "", |
||||
dm->mode_info.clock / 1000.0); |
||||
} |
||||
} |
||||
|
||||
|
||||
/**
|
||||
* Find the closest-matching mode for a given target |
||||
* |
||||
* Given a target mode, find the most suitable mode amongst the output's |
||||
* current mode list to use, preferring the current mode if possible, to |
||||
* avoid an expensive mode switch. |
||||
* |
||||
* @param output DRM output |
||||
* @param target_mode Mode to attempt to match |
||||
* @returns Pointer to a mode from the output's mode list |
||||
*/ |
||||
struct drm_mode * |
||||
drm_output_choose_mode(struct drm_output *output, |
||||
struct weston_mode *target_mode) |
||||
{ |
||||
struct drm_mode *tmp_mode = NULL, *mode_fall_back = NULL, *mode; |
||||
enum weston_mode_aspect_ratio src_aspect = WESTON_MODE_PIC_AR_NONE; |
||||
enum weston_mode_aspect_ratio target_aspect = WESTON_MODE_PIC_AR_NONE; |
||||
struct drm_backend *b; |
||||
|
||||
b = to_drm_backend(output->base.compositor); |
||||
target_aspect = target_mode->aspect_ratio; |
||||
src_aspect = output->base.current_mode->aspect_ratio; |
||||
if (output->base.current_mode->width == target_mode->width && |
||||
output->base.current_mode->height == target_mode->height && |
||||
(output->base.current_mode->refresh == target_mode->refresh || |
||||
target_mode->refresh == 0)) { |
||||
if (!b->aspect_ratio_supported || src_aspect == target_aspect) |
||||
return to_drm_mode(output->base.current_mode); |
||||
} |
||||
|
||||
wl_list_for_each(mode, &output->base.mode_list, base.link) { |
||||
|
||||
src_aspect = mode->base.aspect_ratio; |
||||
if (mode->mode_info.hdisplay == target_mode->width && |
||||
mode->mode_info.vdisplay == target_mode->height) { |
||||
if (mode->base.refresh == target_mode->refresh || |
||||
target_mode->refresh == 0) { |
||||
if (!b->aspect_ratio_supported || |
||||
src_aspect == target_aspect) |
||||
return mode; |
||||
else if (!mode_fall_back) |
||||
mode_fall_back = mode; |
||||
} else if (!tmp_mode) { |
||||
tmp_mode = mode; |
||||
} |
||||
} |
||||
} |
||||
|
||||
if (mode_fall_back) |
||||
return mode_fall_back; |
||||
|
||||
return tmp_mode; |
||||
} |
||||
|
||||
void |
||||
update_head_from_connector(struct drm_head *head, |
||||
drmModeObjectProperties *props) |
||||
{ |
||||
const char *make = "unknown"; |
||||
const char *model = "unknown"; |
||||
const char *serial_number = "unknown"; |
||||
|
||||
find_and_parse_output_edid(head, props, &make, &model, &serial_number); |
||||
weston_head_set_monitor_strings(&head->base, make, model, serial_number); |
||||
weston_head_set_non_desktop(&head->base, |
||||
check_non_desktop(head, props)); |
||||
weston_head_set_subpixel(&head->base, |
||||
drm_subpixel_to_wayland(head->connector->subpixel)); |
||||
|
||||
weston_head_set_physical_size(&head->base, head->connector->mmWidth, |
||||
head->connector->mmHeight); |
||||
|
||||
/* Unknown connection status is assumed disconnected. */ |
||||
weston_head_set_connection_status(&head->base, |
||||
head->connector->connection == DRM_MODE_CONNECTED); |
||||
} |
||||
|
||||
/**
|
||||
* Choose suitable mode for an output |
||||
* |
||||
* Find the most suitable mode to use for initial setup (or reconfiguration on |
||||
* hotplug etc) for a DRM output. |
||||
* |
||||
* @param backend the DRM backend |
||||
* @param output DRM output to choose mode for |
||||
* @param mode Strategy and preference to use when choosing mode |
||||
* @param modeline Manually-entered mode (may be NULL) |
||||
* @param current_mode Mode currently being displayed on this output |
||||
* @returns A mode from the output's mode list, or NULL if none available |
||||
*/ |
||||
static struct drm_mode * |
||||
drm_output_choose_initial_mode(struct drm_backend *backend, |
||||
struct drm_output *output, |
||||
enum weston_drm_backend_output_mode mode, |
||||
const char *modeline, |
||||
const drmModeModeInfo *current_mode) |
||||
{ |
||||
struct drm_mode *preferred = NULL; |
||||
struct drm_mode *current = NULL; |
||||
struct drm_mode *configured = NULL; |
||||
struct drm_mode *config_fall_back = NULL; |
||||
struct drm_mode *best = NULL; |
||||
struct drm_mode *drm_mode; |
||||
drmModeModeInfo drm_modeline; |
||||
int32_t width = 0; |
||||
int32_t height = 0; |
||||
uint32_t refresh = 0; |
||||
uint32_t aspect_width = 0; |
||||
uint32_t aspect_height = 0; |
||||
enum weston_mode_aspect_ratio aspect_ratio = WESTON_MODE_PIC_AR_NONE; |
||||
int n; |
||||
|
||||
if (mode == WESTON_DRM_BACKEND_OUTPUT_PREFERRED && modeline) { |
||||
n = sscanf(modeline, "%dx%d@%d %u:%u", &width, &height, |
||||
&refresh, &aspect_width, &aspect_height); |
||||
if (backend->aspect_ratio_supported && n == 5) { |
||||
if (aspect_width == 4 && aspect_height == 3) |
||||
aspect_ratio = WESTON_MODE_PIC_AR_4_3; |
||||
else if (aspect_width == 16 && aspect_height == 9) |
||||
aspect_ratio = WESTON_MODE_PIC_AR_16_9; |
||||
else if (aspect_width == 64 && aspect_height == 27) |
||||
aspect_ratio = WESTON_MODE_PIC_AR_64_27; |
||||
else if (aspect_width == 256 && aspect_height == 135) |
||||
aspect_ratio = WESTON_MODE_PIC_AR_256_135; |
||||
else |
||||
weston_log("Invalid modeline \"%s\" for output %s\n", |
||||
modeline, output->base.name); |
||||
} |
||||
if (n != 2 && n != 3 && n != 5) { |
||||
width = -1; |
||||
|
||||
if (parse_modeline(modeline, &drm_modeline) == 0) { |
||||
configured = drm_output_add_mode(output, &drm_modeline); |
||||
if (!configured) |
||||
return NULL; |
||||
} else { |
||||
weston_log("Invalid modeline \"%s\" for output %s\n", |
||||
modeline, output->base.name); |
||||
} |
||||
} |
||||
} |
||||
|
||||
wl_list_for_each_reverse(drm_mode, &output->base.mode_list, base.link) { |
||||
if (width == drm_mode->base.width && |
||||
height == drm_mode->base.height && |
||||
(refresh == 0 || refresh == drm_mode->mode_info.vrefresh)) { |
||||
if (!backend->aspect_ratio_supported || |
||||
aspect_ratio == drm_mode->base.aspect_ratio) |
||||
configured = drm_mode; |
||||
else |
||||
config_fall_back = drm_mode; |
||||
} |
||||
|
||||
if (memcmp(current_mode, &drm_mode->mode_info, |
||||
sizeof *current_mode) == 0) |
||||
current = drm_mode; |
||||
|
||||
if (drm_mode->base.flags & WL_OUTPUT_MODE_PREFERRED) |
||||
preferred = drm_mode; |
||||
|
||||
best = drm_mode; |
||||
} |
||||
|
||||
if (current == NULL && current_mode->clock != 0) { |
||||
current = drm_output_add_mode(output, current_mode); |
||||
if (!current) |
||||
return NULL; |
||||
} |
||||
|
||||
if (mode == WESTON_DRM_BACKEND_OUTPUT_CURRENT) |
||||
configured = current; |
||||
|
||||
if (configured) |
||||
return configured; |
||||
|
||||
if (config_fall_back) |
||||
return config_fall_back; |
||||
|
||||
if (preferred) |
||||
return preferred; |
||||
|
||||
if (current) |
||||
return current; |
||||
|
||||
if (best) |
||||
return best; |
||||
|
||||
weston_log("no available modes for %s\n", output->base.name); |
||||
return NULL; |
||||
} |
||||
|
||||
static uint32_t |
||||
u32distance(uint32_t a, uint32_t b) |
||||
{ |
||||
if (a < b) |
||||
return b - a; |
||||
else |
||||
return a - b; |
||||
} |
||||
|
||||
/** Choose equivalent mode
|
||||
* |
||||
* If the two modes are not equivalent, return NULL. |
||||
* Otherwise return the mode that is more likely to work in place of both. |
||||
* |
||||
* None of the fuzzy matching criteria in this function have any justification. |
||||
* |
||||
* typedef struct _drmModeModeInfo { |
||||
* uint32_t clock; |
||||
* uint16_t hdisplay, hsync_start, hsync_end, htotal, hskew; |
||||
* uint16_t vdisplay, vsync_start, vsync_end, vtotal, vscan; |
||||
* |
||||
* uint32_t vrefresh; |
||||
* |
||||
* uint32_t flags; |
||||
* uint32_t type; |
||||
* char name[DRM_DISPLAY_MODE_LEN]; |
||||
* } drmModeModeInfo, *drmModeModeInfoPtr; |
||||
*/ |
||||
static const drmModeModeInfo * |
||||
drm_mode_pick_equivalent(const drmModeModeInfo *a, const drmModeModeInfo *b) |
||||
{ |
||||
uint32_t refresh_a, refresh_b; |
||||
|
||||
if (a->hdisplay != b->hdisplay || a->vdisplay != b->vdisplay) |
||||
return NULL; |
||||
|
||||
if (a->flags != b->flags) |
||||
return NULL; |
||||
|
||||
/* kHz */ |
||||
if (u32distance(a->clock, b->clock) > 500) |
||||
return NULL; |
||||
|
||||
refresh_a = drm_refresh_rate_mHz(a); |
||||
refresh_b = drm_refresh_rate_mHz(b); |
||||
if (u32distance(refresh_a, refresh_b) > 50) |
||||
return NULL; |
||||
|
||||
if ((a->type ^ b->type) & DRM_MODE_TYPE_PREFERRED) { |
||||
if (a->type & DRM_MODE_TYPE_PREFERRED) |
||||
return a; |
||||
else |
||||
return b; |
||||
} |
||||
|
||||
return a; |
||||
} |
||||
|
||||
/* If the given mode info is not already in the list, add it.
|
||||
* If it is in the list, either keep the existing or replace it, |
||||
* depending on which one is "better". |
||||
*/ |
||||
static int |
||||
drm_output_try_add_mode(struct drm_output *output, const drmModeModeInfo *info) |
||||
{ |
||||
struct weston_mode *base; |
||||
struct drm_mode *mode; |
||||
struct drm_backend *backend; |
||||
const drmModeModeInfo *chosen = NULL; |
||||
|
||||
assert(info); |
||||
|
||||
wl_list_for_each(base, &output->base.mode_list, link) { |
||||
mode = to_drm_mode(base); |
||||
chosen = drm_mode_pick_equivalent(&mode->mode_info, info); |
||||
if (chosen) |
||||
break; |
||||
} |
||||
|
||||
if (chosen == info) { |
||||
backend = to_drm_backend(output->base.compositor); |
||||
drm_output_destroy_mode(backend, mode); |
||||
chosen = NULL; |
||||
} |
||||
|
||||
if (!chosen) { |
||||
mode = drm_output_add_mode(output, info); |
||||
if (!mode) |
||||
return -1; |
||||
} |
||||
/* else { the equivalent mode is already in the list } */ |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
/** Rewrite the output's mode list
|
||||
* |
||||
* @param output The output. |
||||
* @return 0 on success, -1 on failure. |
||||
* |
||||
* Destroy all existing modes in the list, and reconstruct a new list from |
||||
* scratch, based on the currently attached heads. |
||||
* |
||||
* On failure the output's mode list may contain some modes. |
||||
*/ |
||||
static int |
||||
drm_output_update_modelist_from_heads(struct drm_output *output) |
||||
{ |
||||
struct drm_backend *backend = to_drm_backend(output->base.compositor); |
||||
struct weston_head *head_base; |
||||
struct drm_head *head; |
||||
int i; |
||||
int ret; |
||||
|
||||
assert(!output->base.enabled); |
||||
|
||||
drm_mode_list_destroy(backend, &output->base.mode_list); |
||||
|
||||
wl_list_for_each(head_base, &output->base.head_list, output_link) { |
||||
head = to_drm_head(head_base); |
||||
for (i = 0; i < head->connector->count_modes; i++) { |
||||
ret = drm_output_try_add_mode(output, |
||||
&head->connector->modes[i]); |
||||
if (ret < 0) |
||||
return -1; |
||||
} |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
int |
||||
drm_output_set_mode(struct weston_output *base, |
||||
enum weston_drm_backend_output_mode mode, |
||||
const char *modeline) |
||||
{ |
||||
struct drm_output *output = to_drm_output(base); |
||||
struct drm_backend *b = to_drm_backend(base->compositor); |
||||
struct drm_head *head = to_drm_head(weston_output_get_first_head(base)); |
||||
|
||||
struct drm_mode *current; |
||||
|
||||
if (output->virtual) |
||||
return -1; |
||||
|
||||
if (drm_output_update_modelist_from_heads(output) < 0) |
||||
return -1; |
||||
|
||||
current = drm_output_choose_initial_mode(b, output, mode, modeline, |
||||
&head->inherited_mode); |
||||
if (!current) |
||||
return -1; |
||||
|
||||
output->base.current_mode = ¤t->base; |
||||
output->base.current_mode->flags |= WL_OUTPUT_MODE_CURRENT; |
||||
|
||||
/* Set native_ fields, so weston_output_mode_switch_to_native() works */ |
||||
output->base.native_mode = output->base.current_mode; |
||||
output->base.native_scale = output->base.current_scale; |
||||
|
||||
return 0; |
||||
} |
||||
Loading…
Reference in new issue