1// SPDX-License-Identifier: GPL-2.0+
2
3#include "vkms_drv.h"
4#include <drm/drm_atomic_helper.h>
5#include <drm/drm_probe_helper.h>
6#include <drm/drm_simple_kms_helper.h>
7
8static void vkms_connector_destroy(struct drm_connector *connector)
9{
10	drm_connector_cleanup(connector);
11}
12
13static const struct drm_connector_funcs vkms_connector_funcs = {
14	.fill_modes = drm_helper_probe_single_connector_modes,
15	.destroy = vkms_connector_destroy,
16	.reset = drm_atomic_helper_connector_reset,
17	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
18	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
19};
20
21static int vkms_conn_get_modes(struct drm_connector *connector)
22{
23	int count;
24
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
35int vkms_output_init(struct vkms_device *vkmsdev, int index)
36{
37	struct vkms_output *output = &vkmsdev->output;
38	struct drm_device *dev = &vkmsdev->drm;
39	struct drm_connector *connector = &output->connector;
40	struct drm_encoder *encoder = &output->encoder;
41	struct drm_crtc *crtc = &output->crtc;
42	struct drm_plane *primary, *cursor = NULL;
43	int ret;
44
45	primary = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_PRIMARY, index);
46	if (IS_ERR(primary))
47		return PTR_ERR(primary);
48
49	if (enable_cursor) {
50		cursor = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_CURSOR, index);
51		if (IS_ERR(cursor)) {
52			ret = PTR_ERR(cursor);
53			goto err_cursor;
54		}
55	}
56
57	ret = vkms_crtc_init(dev, crtc, primary, cursor);
58	if (ret)
59		goto err_crtc;
60
61	ret = drm_connector_init(dev, connector, &vkms_connector_funcs,
62				 DRM_MODE_CONNECTOR_VIRTUAL);
63	if (ret) {
64		DRM_ERROR("Failed to init connector\n");
65		goto err_connector;
66	}
67
68	drm_connector_helper_add(connector, &vkms_conn_helper_funcs);
69
70	ret = drm_simple_encoder_init(dev, encoder, DRM_MODE_ENCODER_VIRTUAL);
71	if (ret) {
72		DRM_ERROR("Failed to init encoder\n");
73		goto err_encoder;
74	}
75	encoder->possible_crtcs = 1;
76
77	ret = drm_connector_attach_encoder(connector, encoder);
78	if (ret) {
79		DRM_ERROR("Failed to attach connector to encoder\n");
80		goto err_attach;
81	}
82
83	ret = vkms_enable_writeback_connector(vkmsdev);
84	if (ret)
85		DRM_ERROR("Failed to init writeback connector\n");
86
87	drm_mode_config_reset(dev);
88
89	return 0;
90
91err_attach:
92	drm_encoder_cleanup(encoder);
93
94err_encoder:
95	drm_connector_cleanup(connector);
96
97err_connector:
98	drm_crtc_cleanup(crtc);
99
100err_crtc:
101	if (enable_cursor)
102		drm_plane_cleanup(cursor);
103
104err_cursor:
105	drm_plane_cleanup(primary);
106
107	return ret;
108}
109