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 
vkms_connector_destroy(struct drm_connector * connector)8 static void vkms_connector_destroy(struct drm_connector *connector)
9 {
10 	drm_connector_cleanup(connector);
11 }
12 
13 static 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 
vkms_conn_get_modes(struct drm_connector * connector)21 static 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 
31 static const struct drm_connector_helper_funcs vkms_conn_helper_funcs = {
32 	.get_modes    = vkms_conn_get_modes,
33 };
34 
vkms_output_init(struct vkms_device * vkmsdev,int index)35 int 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 vkms_plane *primary, *cursor = NULL, *overlay = NULL;
43 	int ret;
44 	int writeback;
45 
46 	primary = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_PRIMARY, index);
47 	if (IS_ERR(primary))
48 		return PTR_ERR(primary);
49 
50 	if (vkmsdev->config->overlay) {
51 		overlay = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_OVERLAY, index);
52 		if (IS_ERR(overlay))
53 			return PTR_ERR(overlay);
54 
55 		if (!overlay->base.possible_crtcs)
56 			overlay->base.possible_crtcs = drm_crtc_mask(crtc);
57 	}
58 
59 	if (vkmsdev->config->cursor) {
60 		cursor = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_CURSOR, index);
61 		if (IS_ERR(cursor))
62 			return PTR_ERR(cursor);
63 	}
64 
65 	ret = vkms_crtc_init(dev, crtc, &primary->base, &cursor->base);
66 	if (ret)
67 		return ret;
68 
69 	ret = drm_connector_init(dev, connector, &vkms_connector_funcs,
70 				 DRM_MODE_CONNECTOR_VIRTUAL);
71 	if (ret) {
72 		DRM_ERROR("Failed to init connector\n");
73 		goto err_connector;
74 	}
75 
76 	drm_connector_helper_add(connector, &vkms_conn_helper_funcs);
77 
78 	ret = drm_simple_encoder_init(dev, encoder, DRM_MODE_ENCODER_VIRTUAL);
79 	if (ret) {
80 		DRM_ERROR("Failed to init encoder\n");
81 		goto err_encoder;
82 	}
83 	encoder->possible_crtcs = 1;
84 
85 	ret = drm_connector_attach_encoder(connector, encoder);
86 	if (ret) {
87 		DRM_ERROR("Failed to attach connector to encoder\n");
88 		goto err_attach;
89 	}
90 
91 	if (vkmsdev->config->writeback) {
92 		writeback = vkms_enable_writeback_connector(vkmsdev);
93 		if (writeback)
94 			DRM_ERROR("Failed to init writeback connector\n");
95 	}
96 
97 	drm_mode_config_reset(dev);
98 
99 	return 0;
100 
101 err_attach:
102 	drm_encoder_cleanup(encoder);
103 
104 err_encoder:
105 	drm_connector_cleanup(connector);
106 
107 err_connector:
108 	drm_crtc_cleanup(crtc);
109 
110 	return ret;
111 }
112