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
 21static struct xen_drm_front_drm_pipeline *
 22to_xen_drm_pipeline(struct drm_connector *connector)
 23{
 24	return container_of(connector, struct xen_drm_front_drm_pipeline, conn);
 25}
 26
 27static 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
 38const u32 *xen_drm_front_conn_get_formats(int *format_count)
 39{
 40	*format_count = ARRAY_SIZE(plane_formats);
 41	return plane_formats;
 42}
 43
 44static 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
 60static 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
 87static const struct drm_connector_helper_funcs connector_helper_funcs = {
 88	.get_modes = connector_get_modes,
 89	.detect_ctx = connector_detect,
 90};
 91
 92static 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
100int 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}