118 lines · c
1// SPDX-License-Identifier: GPL-2.0 OR MIT2 3/*4 * Xen para-virtual DRM device5 *6 * Copyright (C) 2016-2018 EPAM Systems Inc.7 *8 * Author: Oleksandr Andrushchenko <oleksandr_andrushchenko@epam.com>9 */10 11#include <drm/drm_atomic_helper.h>12#include <drm/drm_drv.h>13#include <drm/drm_fourcc.h>14#include <drm/drm_probe_helper.h>15 16#include <video/videomode.h>17 18#include "xen_drm_front.h"19#include "xen_drm_front_conn.h"20#include "xen_drm_front_kms.h"21 22static struct xen_drm_front_drm_pipeline *23to_xen_drm_pipeline(struct drm_connector *connector)24{25 return container_of(connector, struct xen_drm_front_drm_pipeline, conn);26}27 28static const u32 plane_formats[] = {29 DRM_FORMAT_RGB565,30 DRM_FORMAT_RGB888,31 DRM_FORMAT_XRGB8888,32 DRM_FORMAT_ARGB8888,33 DRM_FORMAT_XRGB4444,34 DRM_FORMAT_ARGB4444,35 DRM_FORMAT_XRGB1555,36 DRM_FORMAT_ARGB1555,37 DRM_FORMAT_YUYV,38};39 40const u32 *xen_drm_front_conn_get_formats(int *format_count)41{42 *format_count = ARRAY_SIZE(plane_formats);43 return plane_formats;44}45 46static int connector_detect(struct drm_connector *connector,47 struct drm_modeset_acquire_ctx *ctx,48 bool force)49{50 struct xen_drm_front_drm_pipeline *pipeline =51 to_xen_drm_pipeline(connector);52 53 if (drm_dev_is_unplugged(connector->dev))54 pipeline->conn_connected = false;55 56 return pipeline->conn_connected ? connector_status_connected :57 connector_status_disconnected;58}59 60#define XEN_DRM_CRTC_VREFRESH_HZ 6061 62static int connector_get_modes(struct drm_connector *connector)63{64 struct xen_drm_front_drm_pipeline *pipeline =65 to_xen_drm_pipeline(connector);66 struct drm_display_mode *mode;67 struct videomode videomode;68 int width, height;69 70 mode = drm_mode_create(connector->dev);71 if (!mode)72 return 0;73 74 memset(&videomode, 0, sizeof(videomode));75 videomode.hactive = pipeline->width;76 videomode.vactive = pipeline->height;77 width = videomode.hactive + videomode.hfront_porch +78 videomode.hback_porch + videomode.hsync_len;79 height = videomode.vactive + videomode.vfront_porch +80 videomode.vback_porch + videomode.vsync_len;81 videomode.pixelclock = width * height * XEN_DRM_CRTC_VREFRESH_HZ;82 mode->type = DRM_MODE_TYPE_PREFERRED | DRM_MODE_TYPE_DRIVER;83 84 drm_display_mode_from_videomode(&videomode, mode);85 drm_mode_probed_add(connector, mode);86 return 1;87}88 89static const struct drm_connector_helper_funcs connector_helper_funcs = {90 .get_modes = connector_get_modes,91 .detect_ctx = connector_detect,92};93 94static const struct drm_connector_funcs connector_funcs = {95 .fill_modes = drm_helper_probe_single_connector_modes,96 .destroy = drm_connector_cleanup,97 .reset = drm_atomic_helper_connector_reset,98 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,99 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,100};101 102int xen_drm_front_conn_init(struct xen_drm_front_drm_info *drm_info,103 struct drm_connector *connector)104{105 struct xen_drm_front_drm_pipeline *pipeline =106 to_xen_drm_pipeline(connector);107 108 drm_connector_helper_add(connector, &connector_helper_funcs);109 110 pipeline->conn_connected = true;111 112 connector->polled = DRM_CONNECTOR_POLL_CONNECT |113 DRM_CONNECTOR_POLL_DISCONNECT;114 115 return drm_connector_init(drm_info->drm_dev, connector,116 &connector_funcs, DRM_MODE_CONNECTOR_VIRTUAL);117}118