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
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	60
61
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