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