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