1// SPDX-License-Identifier: GPL-2.0+
  2
  3#include "vkms_drv.h"
  4#include <drm/drm_atomic_helper.h>
  5#include <drm/drm_edid.h>
  6#include <drm/drm_probe_helper.h>
  7#include <drm/drm_simple_kms_helper.h>
  8
  9static void vkms_connector_destroy(struct drm_connector *connector)
 10{
 11	drm_connector_cleanup(connector);
 12}
 13
 14static const struct drm_connector_funcs vkms_connector_funcs = {
 15	.fill_modes = drm_helper_probe_single_connector_modes,
 16	.destroy = vkms_connector_destroy,
 17	.reset = drm_atomic_helper_connector_reset,
 18	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
 19	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
 20};
 21
 22static int vkms_conn_get_modes(struct drm_connector *connector)
 23{
 24	int count;
 25
 26	count = drm_add_modes_noedid(connector, XRES_MAX, YRES_MAX);
 27	drm_set_preferred_mode(connector, XRES_DEF, YRES_DEF);
 28
 29	return count;
 30}
 31
 32static const struct drm_connector_helper_funcs vkms_conn_helper_funcs = {
 33	.get_modes    = vkms_conn_get_modes,
 34};
 35
 36static int vkms_add_overlay_plane(struct vkms_device *vkmsdev, int index,
 37				  struct drm_crtc *crtc)
 38{
 39	struct vkms_plane *overlay;
 40
 41	overlay = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_OVERLAY, index);
 42	if (IS_ERR(overlay))
 43		return PTR_ERR(overlay);
 44
 45	if (!overlay->base.possible_crtcs)
 46		overlay->base.possible_crtcs = drm_crtc_mask(crtc);
 47
 48	return 0;
 49}
 50
 51int vkms_output_init(struct vkms_device *vkmsdev, int index)
 52{
 53	struct vkms_output *output = &vkmsdev->output;
 54	struct drm_device *dev = &vkmsdev->drm;
 55	struct drm_connector *connector = &output->connector;
 56	struct drm_encoder *encoder = &output->encoder;
 57	struct drm_crtc *crtc = &output->crtc;
 58	struct vkms_plane *primary, *cursor = NULL;
 59	int ret;
 60	int writeback;
 61	unsigned int n;
 62
 63	primary = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_PRIMARY, index);
 64	if (IS_ERR(primary))
 65		return PTR_ERR(primary);
 66
 67	if (vkmsdev->config->overlay) {
 68		for (n = 0; n < NUM_OVERLAY_PLANES; n++) {
 69			ret = vkms_add_overlay_plane(vkmsdev, index, crtc);
 70			if (ret)
 71				return ret;
 72		}
 73	}
 74
 75	if (vkmsdev->config->cursor) {
 76		cursor = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_CURSOR, index);
 77		if (IS_ERR(cursor))
 78			return PTR_ERR(cursor);
 79	}
 80
 81	ret = vkms_crtc_init(dev, crtc, &primary->base, &cursor->base);
 82	if (ret)
 83		return ret;
 84
 85	ret = drm_connector_init(dev, connector, &vkms_connector_funcs,
 86				 DRM_MODE_CONNECTOR_VIRTUAL);
 87	if (ret) {
 88		DRM_ERROR("Failed to init connector\n");
 89		goto err_connector;
 90	}
 91
 92	drm_connector_helper_add(connector, &vkms_conn_helper_funcs);
 93
 94	ret = drm_simple_encoder_init(dev, encoder, DRM_MODE_ENCODER_VIRTUAL);
 95	if (ret) {
 96		DRM_ERROR("Failed to init encoder\n");
 97		goto err_encoder;
 98	}
 99	encoder->possible_crtcs = 1;
100
101	ret = drm_connector_attach_encoder(connector, encoder);
102	if (ret) {
103		DRM_ERROR("Failed to attach connector to encoder\n");
104		goto err_attach;
105	}
106
107	if (vkmsdev->config->writeback) {
108		writeback = vkms_enable_writeback_connector(vkmsdev);
109		if (writeback)
110			DRM_ERROR("Failed to init writeback connector\n");
111	}
112
113	drm_mode_config_reset(dev);
114
115	return 0;
116
117err_attach:
118	drm_encoder_cleanup(encoder);
119
120err_encoder:
121	drm_connector_cleanup(connector);
122
123err_connector:
124	drm_crtc_cleanup(crtc);
125
126	return ret;
127}