1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2019-2022 Bootlin
4  * Author: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
5  */
6 
7 #include <linux/types.h>
8 
9 #include <drm/drm_atomic_helper.h>
10 #include <drm/drm_bridge.h>
11 #include <drm/drm_connector.h>
12 #include <drm/drm_drv.h>
13 #include <drm/drm_encoder.h>
14 #include <drm/drm_gem_dma_helper.h>
15 #include <drm/drm_modeset_helper_vtables.h>
16 #include <drm/drm_of.h>
17 #include <drm/drm_panel.h>
18 #include <drm/drm_print.h>
19 #include <drm/drm_probe_helper.h>
20 
21 #include "logicvc_crtc.h"
22 #include "logicvc_drm.h"
23 #include "logicvc_interface.h"
24 #include "logicvc_regs.h"
25 
26 #define logicvc_interface_from_drm_encoder(c) \
27 	container_of(c, struct logicvc_interface, drm_encoder)
28 #define logicvc_interface_from_drm_connector(c) \
29 	container_of(c, struct logicvc_interface, drm_connector)
30 
31 static void logicvc_encoder_enable(struct drm_encoder *drm_encoder)
32 {
33 	struct logicvc_drm *logicvc = logicvc_drm(drm_encoder->dev);
34 	struct logicvc_interface *interface =
35 		logicvc_interface_from_drm_encoder(drm_encoder);
36 
37 	regmap_update_bits(logicvc->regmap, LOGICVC_POWER_CTRL_REG,
38 			   LOGICVC_POWER_CTRL_VIDEO_ENABLE,
39 			   LOGICVC_POWER_CTRL_VIDEO_ENABLE);
40 
41 	if (interface->drm_panel) {
42 		drm_panel_prepare(interface->drm_panel);
43 		drm_panel_enable(interface->drm_panel);
44 	}
45 }
46 
47 static void logicvc_encoder_disable(struct drm_encoder *drm_encoder)
48 {
49 	struct logicvc_interface *interface =
50 		logicvc_interface_from_drm_encoder(drm_encoder);
51 
52 	if (interface->drm_panel) {
53 		drm_panel_disable(interface->drm_panel);
54 		drm_panel_unprepare(interface->drm_panel);
55 	}
56 }
57 
58 static const struct drm_encoder_helper_funcs logicvc_encoder_helper_funcs = {
59 	.enable			= logicvc_encoder_enable,
60 	.disable		= logicvc_encoder_disable,
61 };
62 
63 static const struct drm_encoder_funcs logicvc_encoder_funcs = {
64 	.destroy		= drm_encoder_cleanup,
65 };
66 
67 static int logicvc_connector_get_modes(struct drm_connector *drm_connector)
68 {
69 	struct logicvc_interface *interface =
70 		logicvc_interface_from_drm_connector(drm_connector);
71 
72 	if (interface->drm_panel)
73 		return drm_panel_get_modes(interface->drm_panel, drm_connector);
74 
75 	WARN_ONCE(1, "Retrieving modes from a native connector is not implemented.");
76 
77 	return 0;
78 }
79 
80 static const struct drm_connector_helper_funcs logicvc_connector_helper_funcs = {
81 	.get_modes		= logicvc_connector_get_modes,
82 };
83 
84 static const struct drm_connector_funcs logicvc_connector_funcs = {
85 	.reset			= drm_atomic_helper_connector_reset,
86 	.fill_modes		= drm_helper_probe_single_connector_modes,
87 	.destroy		= drm_connector_cleanup,
88 	.atomic_duplicate_state	= drm_atomic_helper_connector_duplicate_state,
89 	.atomic_destroy_state	= drm_atomic_helper_connector_destroy_state,
90 };
91 
92 static int logicvc_interface_encoder_type(struct logicvc_drm *logicvc)
93 {
94 	switch (logicvc->config.display_interface) {
95 	case LOGICVC_DISPLAY_INTERFACE_LVDS_4BITS:
96 	case LOGICVC_DISPLAY_INTERFACE_LVDS_4BITS_CAMERA:
97 	case LOGICVC_DISPLAY_INTERFACE_LVDS_3BITS:
98 		return DRM_MODE_ENCODER_LVDS;
99 	case LOGICVC_DISPLAY_INTERFACE_DVI:
100 		return DRM_MODE_ENCODER_TMDS;
101 	case LOGICVC_DISPLAY_INTERFACE_RGB:
102 		return DRM_MODE_ENCODER_DPI;
103 	default:
104 		return DRM_MODE_ENCODER_NONE;
105 	}
106 }
107 
108 static int logicvc_interface_connector_type(struct logicvc_drm *logicvc)
109 {
110 	switch (logicvc->config.display_interface) {
111 	case LOGICVC_DISPLAY_INTERFACE_LVDS_4BITS:
112 	case LOGICVC_DISPLAY_INTERFACE_LVDS_4BITS_CAMERA:
113 	case LOGICVC_DISPLAY_INTERFACE_LVDS_3BITS:
114 		return DRM_MODE_CONNECTOR_LVDS;
115 	case LOGICVC_DISPLAY_INTERFACE_DVI:
116 		return DRM_MODE_CONNECTOR_DVID;
117 	case LOGICVC_DISPLAY_INTERFACE_RGB:
118 		return DRM_MODE_CONNECTOR_DPI;
119 	default:
120 		return DRM_MODE_CONNECTOR_Unknown;
121 	}
122 }
123 
124 static bool logicvc_interface_native_connector(struct logicvc_drm *logicvc)
125 {
126 	switch (logicvc->config.display_interface) {
127 	case LOGICVC_DISPLAY_INTERFACE_DVI:
128 		return true;
129 	default:
130 		return false;
131 	}
132 }
133 
134 void logicvc_interface_attach_crtc(struct logicvc_drm *logicvc)
135 {
136 	uint32_t possible_crtcs = drm_crtc_mask(&logicvc->crtc->drm_crtc);
137 
138 	logicvc->interface->drm_encoder.possible_crtcs = possible_crtcs;
139 }
140 
141 int logicvc_interface_init(struct logicvc_drm *logicvc)
142 {
143 	struct logicvc_interface *interface;
144 	struct drm_device *drm_dev = &logicvc->drm_dev;
145 	struct device *dev = drm_dev->dev;
146 	struct device_node *of_node = dev->of_node;
147 	int encoder_type = logicvc_interface_encoder_type(logicvc);
148 	int connector_type = logicvc_interface_connector_type(logicvc);
149 	bool native_connector = logicvc_interface_native_connector(logicvc);
150 	int ret;
151 
152 	interface = devm_kzalloc(dev, sizeof(*interface), GFP_KERNEL);
153 	if (!interface) {
154 		ret = -ENOMEM;
155 		goto error_early;
156 	}
157 
158 	ret = drm_of_find_panel_or_bridge(of_node, 0, 0, &interface->drm_panel,
159 					  &interface->drm_bridge);
160 	if (ret == -EPROBE_DEFER)
161 		goto error_early;
162 
163 	ret = drm_encoder_init(drm_dev, &interface->drm_encoder,
164 			       &logicvc_encoder_funcs, encoder_type, NULL);
165 	if (ret) {
166 		drm_err(drm_dev, "Failed to initialize encoder\n");
167 		goto error_early;
168 	}
169 
170 	drm_encoder_helper_add(&interface->drm_encoder,
171 			       &logicvc_encoder_helper_funcs);
172 
173 	if (native_connector || interface->drm_panel) {
174 		ret = drm_connector_init(drm_dev, &interface->drm_connector,
175 					 &logicvc_connector_funcs,
176 					 connector_type);
177 		if (ret) {
178 			drm_err(drm_dev, "Failed to initialize connector\n");
179 			goto error_encoder;
180 		}
181 
182 		drm_connector_helper_add(&interface->drm_connector,
183 					 &logicvc_connector_helper_funcs);
184 
185 		ret = drm_connector_attach_encoder(&interface->drm_connector,
186 						   &interface->drm_encoder);
187 		if (ret) {
188 			drm_err(drm_dev,
189 				"Failed to attach connector to encoder\n");
190 			goto error_encoder;
191 		}
192 	}
193 
194 	if (interface->drm_bridge) {
195 		ret = drm_bridge_attach(&interface->drm_encoder,
196 					interface->drm_bridge, NULL, 0);
197 		if (ret) {
198 			drm_err(drm_dev,
199 				"Failed to attach bridge to encoder\n");
200 			goto error_encoder;
201 		}
202 	}
203 
204 	logicvc->interface = interface;
205 
206 	return 0;
207 
208 error_encoder:
209 	drm_encoder_cleanup(&interface->drm_encoder);
210 
211 error_early:
212 	return ret;
213 }
214