1
2
3
4
5
6
7#include <drm/drm_atomic_helper.h>
8#include <drm/drm_bridge.h>
9#include <drm/drm_connector.h>
10#include <drm/drm_encoder.h>
11#include <drm/drm_modeset_helper_vtables.h>
12#include <drm/drm_panel.h>
13#include <drm/drm_print.h>
14#include <drm/drm_probe_helper.h>
15
16struct panel_bridge {
17 struct drm_bridge bridge;
18 struct drm_connector connector;
19 struct drm_panel *panel;
20 u32 connector_type;
21};
22
23static inline struct panel_bridge *
24drm_bridge_to_panel_bridge(struct drm_bridge *bridge)
25{
26 return container_of(bridge, struct panel_bridge, bridge);
27}
28
29static inline struct panel_bridge *
30drm_connector_to_panel_bridge(struct drm_connector *connector)
31{
32 return container_of(connector, struct panel_bridge, connector);
33}
34
35static int panel_bridge_connector_get_modes(struct drm_connector *connector)
36{
37 struct panel_bridge *panel_bridge =
38 drm_connector_to_panel_bridge(connector);
39
40 return drm_panel_get_modes(panel_bridge->panel, connector);
41}
42
43static const struct drm_connector_helper_funcs
44panel_bridge_connector_helper_funcs = {
45 .get_modes = panel_bridge_connector_get_modes,
46};
47
48static const struct drm_connector_funcs panel_bridge_connector_funcs = {
49 .reset = drm_atomic_helper_connector_reset,
50 .fill_modes = drm_helper_probe_single_connector_modes,
51 .destroy = drm_connector_cleanup,
52 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
53 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
54};
55
56static int panel_bridge_attach(struct drm_bridge *bridge,
57 enum drm_bridge_attach_flags flags)
58{
59 struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge);
60 struct drm_connector *connector = &panel_bridge->connector;
61 int ret;
62
63 if (flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)
64 return 0;
65
66 if (!bridge->encoder) {
67 DRM_ERROR("Missing encoder\n");
68 return -ENODEV;
69 }
70
71 drm_connector_helper_add(connector,
72 &panel_bridge_connector_helper_funcs);
73
74 ret = drm_connector_init(bridge->dev, connector,
75 &panel_bridge_connector_funcs,
76 panel_bridge->connector_type);
77 if (ret) {
78 DRM_ERROR("Failed to initialize connector\n");
79 return ret;
80 }
81
82 drm_connector_attach_encoder(&panel_bridge->connector,
83 bridge->encoder);
84
85 return 0;
86}
87
88static void panel_bridge_detach(struct drm_bridge *bridge)
89{
90}
91
92static void panel_bridge_pre_enable(struct drm_bridge *bridge)
93{
94 struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge);
95
96 drm_panel_prepare(panel_bridge->panel);
97}
98
99static void panel_bridge_enable(struct drm_bridge *bridge)
100{
101 struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge);
102
103 drm_panel_enable(panel_bridge->panel);
104}
105
106static void panel_bridge_disable(struct drm_bridge *bridge)
107{
108 struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge);
109
110 drm_panel_disable(panel_bridge->panel);
111}
112
113static void panel_bridge_post_disable(struct drm_bridge *bridge)
114{
115 struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge);
116
117 drm_panel_unprepare(panel_bridge->panel);
118}
119
120static int panel_bridge_get_modes(struct drm_bridge *bridge,
121 struct drm_connector *connector)
122{
123 struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge);
124
125 return drm_panel_get_modes(panel_bridge->panel, connector);
126}
127
128static const struct drm_bridge_funcs panel_bridge_bridge_funcs = {
129 .attach = panel_bridge_attach,
130 .detach = panel_bridge_detach,
131 .pre_enable = panel_bridge_pre_enable,
132 .enable = panel_bridge_enable,
133 .disable = panel_bridge_disable,
134 .post_disable = panel_bridge_post_disable,
135 .get_modes = panel_bridge_get_modes,
136 .atomic_reset = drm_atomic_helper_bridge_reset,
137 .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
138 .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
139 .atomic_get_input_bus_fmts = drm_atomic_helper_bridge_propagate_bus_fmt,
140};
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167struct drm_bridge *drm_panel_bridge_add(struct drm_panel *panel)
168{
169 if (WARN_ON(panel->connector_type == DRM_MODE_CONNECTOR_Unknown))
170 return ERR_PTR(-EINVAL);
171
172 return drm_panel_bridge_add_typed(panel, panel->connector_type);
173}
174EXPORT_SYMBOL(drm_panel_bridge_add);
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189struct drm_bridge *drm_panel_bridge_add_typed(struct drm_panel *panel,
190 u32 connector_type)
191{
192 struct panel_bridge *panel_bridge;
193
194 if (!panel)
195 return ERR_PTR(-EINVAL);
196
197 panel_bridge = devm_kzalloc(panel->dev, sizeof(*panel_bridge),
198 GFP_KERNEL);
199 if (!panel_bridge)
200 return ERR_PTR(-ENOMEM);
201
202 panel_bridge->connector_type = connector_type;
203 panel_bridge->panel = panel;
204
205 panel_bridge->bridge.funcs = &panel_bridge_bridge_funcs;
206#ifdef CONFIG_OF
207 panel_bridge->bridge.of_node = panel->dev->of_node;
208#endif
209 panel_bridge->bridge.ops = DRM_BRIDGE_OP_MODES;
210 panel_bridge->bridge.type = connector_type;
211
212 drm_bridge_add(&panel_bridge->bridge);
213
214 return &panel_bridge->bridge;
215}
216EXPORT_SYMBOL(drm_panel_bridge_add_typed);
217
218
219
220
221
222
223
224void drm_panel_bridge_remove(struct drm_bridge *bridge)
225{
226 struct panel_bridge *panel_bridge;
227
228 if (!bridge)
229 return;
230
231 if (bridge->funcs != &panel_bridge_bridge_funcs)
232 return;
233
234 panel_bridge = drm_bridge_to_panel_bridge(bridge);
235
236 drm_bridge_remove(bridge);
237 devm_kfree(panel_bridge->panel->dev, bridge);
238}
239EXPORT_SYMBOL(drm_panel_bridge_remove);
240
241static void devm_drm_panel_bridge_release(struct device *dev, void *res)
242{
243 struct drm_bridge **bridge = res;
244
245 drm_panel_bridge_remove(*bridge);
246}
247
248
249
250
251
252
253
254
255
256
257struct drm_bridge *devm_drm_panel_bridge_add(struct device *dev,
258 struct drm_panel *panel)
259{
260 if (WARN_ON(panel->connector_type == DRM_MODE_CONNECTOR_Unknown))
261 return ERR_PTR(-EINVAL);
262
263 return devm_drm_panel_bridge_add_typed(dev, panel,
264 panel->connector_type);
265}
266EXPORT_SYMBOL(devm_drm_panel_bridge_add);
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282struct drm_bridge *devm_drm_panel_bridge_add_typed(struct device *dev,
283 struct drm_panel *panel,
284 u32 connector_type)
285{
286 struct drm_bridge **ptr, *bridge;
287
288 ptr = devres_alloc(devm_drm_panel_bridge_release, sizeof(*ptr),
289 GFP_KERNEL);
290 if (!ptr)
291 return ERR_PTR(-ENOMEM);
292
293 bridge = drm_panel_bridge_add_typed(panel, connector_type);
294 if (!IS_ERR(bridge)) {
295 *ptr = bridge;
296 devres_add(dev, ptr);
297 } else {
298 devres_free(ptr);
299 }
300
301 return bridge;
302}
303EXPORT_SYMBOL(devm_drm_panel_bridge_add_typed);
304
305
306
307
308
309
310
311
312
313
314struct drm_connector *drm_panel_bridge_connector(struct drm_bridge *bridge)
315{
316 struct panel_bridge *panel_bridge;
317
318 panel_bridge = drm_bridge_to_panel_bridge(bridge);
319
320 return &panel_bridge->connector;
321}
322EXPORT_SYMBOL(drm_panel_bridge_connector);
323