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
vkms_connector_destroy(struct drm_connector * connector)9 static void vkms_connector_destroy(struct drm_connector *connector)
10 {
11 drm_connector_cleanup(connector);
12 }
13
14 static 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
vkms_conn_get_modes(struct drm_connector * connector)22 static 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
32 static const struct drm_connector_helper_funcs vkms_conn_helper_funcs = {
33 .get_modes = vkms_conn_get_modes,
34 };
35
vkms_add_overlay_plane(struct vkms_device * vkmsdev,int index,struct drm_crtc * crtc)36 static 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
vkms_output_init(struct vkms_device * vkmsdev,int index)51 int 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
117 err_attach:
118 drm_encoder_cleanup(encoder);
119
120 err_encoder:
121 drm_connector_cleanup(connector);
122
123 err_connector:
124 drm_crtc_cleanup(crtc);
125
126 return ret;
127 }
128