1 // SPDX-License-Identifier: GPL-2.0 OR MIT 2 3 /* 4 * Xen para-virtual DRM device 5 * 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 22 static struct xen_drm_front_drm_pipeline * 23 to_xen_drm_pipeline(struct drm_connector *connector) 24 { 25 return container_of(connector, struct xen_drm_front_drm_pipeline, conn); 26 } 27 28 static 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 40 const u32 *xen_drm_front_conn_get_formats(int *format_count) 41 { 42 *format_count = ARRAY_SIZE(plane_formats); 43 return plane_formats; 44 } 45 46 static 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 60 61 62 static 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 89 static const struct drm_connector_helper_funcs connector_helper_funcs = { 90 .get_modes = connector_get_modes, 91 .detect_ctx = connector_detect, 92 }; 93 94 static 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 102 int 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