]>
Commit | Line | Data |
---|---|---|
13dfc054 EA |
1 | /* |
2 | * Copyright (C) 2016 Laurent Pinchart <laurent.pinchart@ideasonboard.com> | |
3 | * Copyright (C) 2017 Broadcom | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or | |
6 | * modify it under the terms of the GNU General Public License as | |
7 | * published by the Free Software Foundation; either version 2 of | |
8 | * the License, or (at your option) any later version. | |
9 | */ | |
10 | ||
11 | #include <drm/drmP.h> | |
12 | #include <drm/drm_panel.h> | |
13 | #include <drm/drm_atomic_helper.h> | |
14 | #include <drm/drm_connector.h> | |
15 | #include <drm/drm_crtc_helper.h> | |
16 | #include <drm/drm_encoder.h> | |
17 | #include <drm/drm_modeset_helper_vtables.h> | |
18 | #include <drm/drm_panel.h> | |
19 | ||
20 | struct panel_bridge { | |
21 | struct drm_bridge bridge; | |
22 | struct drm_connector connector; | |
23 | struct drm_panel *panel; | |
24 | u32 connector_type; | |
25 | }; | |
26 | ||
27 | static inline struct panel_bridge * | |
28 | drm_bridge_to_panel_bridge(struct drm_bridge *bridge) | |
29 | { | |
30 | return container_of(bridge, struct panel_bridge, bridge); | |
31 | } | |
32 | ||
33 | static inline struct panel_bridge * | |
34 | drm_connector_to_panel_bridge(struct drm_connector *connector) | |
35 | { | |
36 | return container_of(connector, struct panel_bridge, connector); | |
37 | } | |
38 | ||
39 | static int panel_bridge_connector_get_modes(struct drm_connector *connector) | |
40 | { | |
41 | struct panel_bridge *panel_bridge = | |
42 | drm_connector_to_panel_bridge(connector); | |
43 | ||
44 | return drm_panel_get_modes(panel_bridge->panel); | |
45 | } | |
46 | ||
47 | static const struct drm_connector_helper_funcs | |
48 | panel_bridge_connector_helper_funcs = { | |
49 | .get_modes = panel_bridge_connector_get_modes, | |
50 | }; | |
51 | ||
52 | static const struct drm_connector_funcs panel_bridge_connector_funcs = { | |
53 | .dpms = drm_atomic_helper_connector_dpms, | |
54 | .reset = drm_atomic_helper_connector_reset, | |
55 | .fill_modes = drm_helper_probe_single_connector_modes, | |
56 | .destroy = drm_connector_cleanup, | |
57 | .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, | |
58 | .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, | |
59 | }; | |
60 | ||
61 | static int panel_bridge_attach(struct drm_bridge *bridge) | |
62 | { | |
63 | struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge); | |
64 | struct drm_connector *connector = &panel_bridge->connector; | |
65 | int ret; | |
66 | ||
67 | if (!bridge->encoder) { | |
68 | DRM_ERROR("Missing encoder\n"); | |
69 | return -ENODEV; | |
70 | } | |
71 | ||
72 | drm_connector_helper_add(connector, | |
73 | &panel_bridge_connector_helper_funcs); | |
74 | ||
75 | ret = drm_connector_init(bridge->dev, connector, | |
76 | &panel_bridge_connector_funcs, | |
77 | panel_bridge->connector_type); | |
78 | if (ret) { | |
79 | DRM_ERROR("Failed to initialize connector\n"); | |
80 | return ret; | |
81 | } | |
82 | ||
83 | drm_mode_connector_attach_encoder(&panel_bridge->connector, | |
84 | bridge->encoder); | |
85 | ||
86 | ret = drm_panel_attach(panel_bridge->panel, &panel_bridge->connector); | |
87 | if (ret < 0) | |
88 | return ret; | |
89 | ||
90 | return 0; | |
91 | } | |
92 | ||
93 | static void panel_bridge_detach(struct drm_bridge *bridge) | |
94 | { | |
95 | struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge); | |
96 | ||
97 | drm_panel_detach(panel_bridge->panel); | |
98 | } | |
99 | ||
100 | static void panel_bridge_pre_enable(struct drm_bridge *bridge) | |
101 | { | |
102 | struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge); | |
103 | ||
104 | drm_panel_prepare(panel_bridge->panel); | |
105 | } | |
106 | ||
107 | static void panel_bridge_enable(struct drm_bridge *bridge) | |
108 | { | |
109 | struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge); | |
110 | ||
111 | drm_panel_enable(panel_bridge->panel); | |
112 | } | |
113 | ||
114 | static void panel_bridge_disable(struct drm_bridge *bridge) | |
115 | { | |
116 | struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge); | |
117 | ||
118 | drm_panel_disable(panel_bridge->panel); | |
119 | } | |
120 | ||
121 | static void panel_bridge_post_disable(struct drm_bridge *bridge) | |
122 | { | |
123 | struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge); | |
124 | ||
125 | drm_panel_unprepare(panel_bridge->panel); | |
126 | } | |
127 | ||
128 | static 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 | }; | |
136 | ||
137 | /** | |
138 | * drm_panel_bridge_add - Creates a drm_bridge and drm_connector that | |
139 | * just calls the appropriate functions from drm_panel. | |
140 | * | |
141 | * @panel: The drm_panel being wrapped. Must be non-NULL. | |
142 | * @connector_type: The DRM_MODE_CONNECTOR_* for the connector to be | |
143 | * created. | |
144 | * | |
145 | * For drivers converting from directly using drm_panel: The expected | |
146 | * usage pattern is that during either encoder module probe or DSI | |
147 | * host attach, a drm_panel will be looked up through | |
148 | * drm_of_find_panel_or_bridge(). drm_panel_bridge_add() is used to | |
149 | * wrap that panel in the new bridge, and the result can then be | |
150 | * passed to drm_bridge_attach(). The drm_panel_prepare() and related | |
151 | * functions can be dropped from the encoder driver (they're now | |
152 | * called by the KMS helpers before calling into the encoder), along | |
153 | * with connector creation. When done with the bridge, | |
154 | * drm_bridge_detach() should be called as normal, then | |
155 | * drm_panel_bridge_remove() to free it. | |
156 | */ | |
157 | struct drm_bridge *drm_panel_bridge_add(struct drm_panel *panel, | |
158 | u32 connector_type) | |
159 | { | |
160 | struct panel_bridge *panel_bridge; | |
13dfc054 EA |
161 | |
162 | if (!panel) | |
e6f0acb2 | 163 | return ERR_PTR(-EINVAL); |
13dfc054 EA |
164 | |
165 | panel_bridge = devm_kzalloc(panel->dev, sizeof(*panel_bridge), | |
166 | GFP_KERNEL); | |
167 | if (!panel_bridge) | |
168 | return ERR_PTR(-ENOMEM); | |
169 | ||
170 | panel_bridge->connector_type = connector_type; | |
171 | panel_bridge->panel = panel; | |
172 | ||
173 | panel_bridge->bridge.funcs = &panel_bridge_bridge_funcs; | |
174 | #ifdef CONFIG_OF | |
175 | panel_bridge->bridge.of_node = panel->dev->of_node; | |
176 | #endif | |
177 | ||
3a45d25d | 178 | drm_bridge_add(&panel_bridge->bridge); |
13dfc054 EA |
179 | |
180 | return &panel_bridge->bridge; | |
181 | } | |
182 | EXPORT_SYMBOL(drm_panel_bridge_add); | |
183 | ||
184 | /** | |
185 | * drm_panel_bridge_remove - Unregisters and frees a drm_bridge | |
186 | * created by drm_panel_bridge_add(). | |
187 | * | |
188 | * @bridge: The drm_bridge being freed. | |
189 | */ | |
190 | void drm_panel_bridge_remove(struct drm_bridge *bridge) | |
191 | { | |
192 | struct panel_bridge *panel_bridge = drm_bridge_to_panel_bridge(bridge); | |
193 | ||
194 | drm_bridge_remove(bridge); | |
195 | devm_kfree(panel_bridge->panel->dev, bridge); | |
196 | } | |
197 | EXPORT_SYMBOL(drm_panel_bridge_remove); |