projects/linux·blob master · refs

225 lines · 6.1 KiB

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