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