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