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
  8static const struct drm_connector_funcs vkms_connector_funcs = {
  9	.fill_modes = drm_helper_probe_single_connector_modes,
 10	.destroy = drm_connector_cleanup,
 11	.reset = drm_atomic_helper_connector_reset,
 12	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
 13	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
 14};
 15
 16static const struct drm_encoder_funcs vkms_encoder_funcs = {
 17	.destroy = drm_encoder_cleanup,
 18};
 19
 20static int vkms_conn_get_modes(struct drm_connector *connector)
 21{
 22	int count;
 23
 24	/* Use the default modes list from DRM */
 25	count = drm_add_modes_noedid(connector, XRES_MAX, YRES_MAX);
 26	drm_set_preferred_mode(connector, XRES_DEF, YRES_DEF);
 27
 28	return count;
 29}
 30
 31static const struct drm_connector_helper_funcs vkms_conn_helper_funcs = {
 32	.get_modes    = vkms_conn_get_modes,
 33};
 34
 35static int vkms_add_overlay_plane(struct vkms_device *vkmsdev, int index,
 36				  struct drm_crtc *crtc)
 37{
 38	struct vkms_plane *overlay;
 39
 40	overlay = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_OVERLAY, index);
 41	if (IS_ERR(overlay))
 42		return PTR_ERR(overlay);
 43
 44	if (!overlay->base.possible_crtcs)
 45		overlay->base.possible_crtcs = drm_crtc_mask(crtc);
 46
 47	return 0;
 48}
 49
 50int vkms_output_init(struct vkms_device *vkmsdev, int index)
 51{
 52	struct vkms_output *output = &vkmsdev->output;
 53	struct drm_device *dev = &vkmsdev->drm;
 54	struct drm_connector *connector = &output->connector;
 55	struct drm_encoder *encoder = &output->encoder;
 56	struct drm_crtc *crtc = &output->crtc;
 57	struct vkms_plane *primary, *cursor = NULL;
 58	int ret;
 59	int writeback;
 60	unsigned int n;
 61
 62	/*
 63	 * Initialize used plane. One primary plane is required to perform the composition.
 64	 *
 65	 * The overlay and cursor planes are not mandatory, but can be used to perform complex
 66	 * composition.
 67	 */
 68	primary = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_PRIMARY, index);
 69	if (IS_ERR(primary))
 70		return PTR_ERR(primary);
 71
 72	if (vkmsdev->config->overlay) {
 73		for (n = 0; n < NUM_OVERLAY_PLANES; n++) {
 74			ret = vkms_add_overlay_plane(vkmsdev, index, crtc);
 75			if (ret)
 76				return ret;
 77		}
 78	}
 79
 80	if (vkmsdev->config->cursor) {
 81		cursor = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_CURSOR, index);
 82		if (IS_ERR(cursor))
 83			return PTR_ERR(cursor);
 84	}
 85
 86	/* [1]: Allocation of a CRTC, its index will be BIT(0) = 1 */
 87	ret = vkms_crtc_init(dev, crtc, &primary->base, &cursor->base);
 88	if (ret)
 89		return ret;
 90
 91	ret = drm_connector_init(dev, connector, &vkms_connector_funcs,
 92				 DRM_MODE_CONNECTOR_VIRTUAL);
 93	if (ret) {
 94		DRM_ERROR("Failed to init connector\n");
 95		return ret;
 96	}
 97
 98	drm_connector_helper_add(connector, &vkms_conn_helper_funcs);
 99
100	ret = drm_encoder_init(dev, encoder, &vkms_encoder_funcs,
101			       DRM_MODE_ENCODER_VIRTUAL, NULL);
102	if (ret) {
103		DRM_ERROR("Failed to init encoder\n");
104		goto err_encoder;
105	}
106	/*
107	 * This is a hardcoded value to select crtc for the encoder.
108	 * BIT(0) here designate the first registered CRTC, the one allocated in [1]
109	 */
110	encoder->possible_crtcs = BIT(0);
111
112	ret = drm_connector_attach_encoder(connector, encoder);
113	if (ret) {
114		DRM_ERROR("Failed to attach connector to encoder\n");
115		goto err_attach;
116	}
117
118	if (vkmsdev->config->writeback) {
119		writeback = vkms_enable_writeback_connector(vkmsdev);
120		if (writeback)
121			DRM_ERROR("Failed to init writeback connector\n");
122	}
123
124	drm_mode_config_reset(dev);
125
126	return 0;
127
128err_attach:
129	drm_encoder_cleanup(encoder);
130
131err_encoder:
132	drm_connector_cleanup(connector);
133
134	return ret;
135}