Commit | Line | Data |
---|---|---|
1c248b7d ID |
1 | /* |
2 | * Copyright (c) 2011 Samsung Electronics Co., Ltd. | |
3 | * Authors: | |
4 | * Inki Dae <inki.dae@samsung.com> | |
5 | * Joonyoung Shim <jy0922.shim@samsung.com> | |
6 | * Seung-Woo Kim <sw0312.kim@samsung.com> | |
7 | * | |
d81aecb5 ID |
8 | * This program is free software; you can redistribute it and/or modify it |
9 | * under the terms of the GNU General Public License as published by the | |
10 | * Free Software Foundation; either version 2 of the License, or (at your | |
11 | * option) any later version. | |
1c248b7d ID |
12 | */ |
13 | ||
760285e7 DH |
14 | #include <drm/drmP.h> |
15 | #include <drm/drm_crtc_helper.h> | |
1c248b7d | 16 | |
607c50d4 | 17 | #include <drm/exynos_drm.h> |
1c248b7d ID |
18 | #include "exynos_drm_drv.h" |
19 | #include "exynos_drm_encoder.h" | |
20 | ||
21 | #define MAX_EDID 256 | |
22 | #define to_exynos_connector(x) container_of(x, struct exynos_drm_connector,\ | |
23 | drm_connector) | |
24 | ||
25 | struct exynos_drm_connector { | |
26 | struct drm_connector drm_connector; | |
adb6b159 ID |
27 | uint32_t encoder_id; |
28 | struct exynos_drm_manager *manager; | |
50caf25c | 29 | uint32_t dpms; |
1c248b7d ID |
30 | }; |
31 | ||
32 | /* convert exynos_video_timings to drm_display_mode */ | |
33 | static inline void | |
34 | convert_to_display_mode(struct drm_display_mode *mode, | |
607c50d4 | 35 | struct exynos_drm_panel_info *panel) |
1c248b7d | 36 | { |
607c50d4 | 37 | struct fb_videomode *timing = &panel->timing; |
1c248b7d ID |
38 | DRM_DEBUG_KMS("%s\n", __FILE__); |
39 | ||
40 | mode->clock = timing->pixclock / 1000; | |
8b58dfe0 | 41 | mode->vrefresh = timing->refresh; |
1c248b7d ID |
42 | |
43 | mode->hdisplay = timing->xres; | |
f7d86075 | 44 | mode->hsync_start = mode->hdisplay + timing->right_margin; |
1c248b7d | 45 | mode->hsync_end = mode->hsync_start + timing->hsync_len; |
f7d86075 | 46 | mode->htotal = mode->hsync_end + timing->left_margin; |
1c248b7d ID |
47 | |
48 | mode->vdisplay = timing->yres; | |
f7d86075 | 49 | mode->vsync_start = mode->vdisplay + timing->lower_margin; |
1c248b7d | 50 | mode->vsync_end = mode->vsync_start + timing->vsync_len; |
f7d86075 | 51 | mode->vtotal = mode->vsync_end + timing->upper_margin; |
607c50d4 ECK |
52 | mode->width_mm = panel->width_mm; |
53 | mode->height_mm = panel->height_mm; | |
8b58dfe0 SWK |
54 | |
55 | if (timing->vmode & FB_VMODE_INTERLACED) | |
56 | mode->flags |= DRM_MODE_FLAG_INTERLACE; | |
57 | ||
58 | if (timing->vmode & FB_VMODE_DOUBLE) | |
59 | mode->flags |= DRM_MODE_FLAG_DBLSCAN; | |
1c248b7d ID |
60 | } |
61 | ||
62 | /* convert drm_display_mode to exynos_video_timings */ | |
63 | static inline void | |
64 | convert_to_video_timing(struct fb_videomode *timing, | |
65 | struct drm_display_mode *mode) | |
66 | { | |
67 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
68 | ||
69 | memset(timing, 0, sizeof(*timing)); | |
70 | ||
71 | timing->pixclock = mode->clock * 1000; | |
8b58dfe0 | 72 | timing->refresh = drm_mode_vrefresh(mode); |
1c248b7d ID |
73 | |
74 | timing->xres = mode->hdisplay; | |
f7d86075 | 75 | timing->right_margin = mode->hsync_start - mode->hdisplay; |
1c248b7d | 76 | timing->hsync_len = mode->hsync_end - mode->hsync_start; |
f7d86075 | 77 | timing->left_margin = mode->htotal - mode->hsync_end; |
1c248b7d ID |
78 | |
79 | timing->yres = mode->vdisplay; | |
f7d86075 | 80 | timing->lower_margin = mode->vsync_start - mode->vdisplay; |
1c248b7d | 81 | timing->vsync_len = mode->vsync_end - mode->vsync_start; |
f7d86075 | 82 | timing->upper_margin = mode->vtotal - mode->vsync_end; |
1c248b7d ID |
83 | |
84 | if (mode->flags & DRM_MODE_FLAG_INTERLACE) | |
85 | timing->vmode = FB_VMODE_INTERLACED; | |
86 | else | |
87 | timing->vmode = FB_VMODE_NONINTERLACED; | |
88 | ||
89 | if (mode->flags & DRM_MODE_FLAG_DBLSCAN) | |
90 | timing->vmode |= FB_VMODE_DOUBLE; | |
91 | } | |
92 | ||
93 | static int exynos_drm_connector_get_modes(struct drm_connector *connector) | |
94 | { | |
adb6b159 ID |
95 | struct exynos_drm_connector *exynos_connector = |
96 | to_exynos_connector(connector); | |
97 | struct exynos_drm_manager *manager = exynos_connector->manager; | |
74ccc539 | 98 | struct exynos_drm_display_ops *display_ops = manager->display_ops; |
1c248b7d ID |
99 | unsigned int count; |
100 | ||
101 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
102 | ||
74ccc539 ID |
103 | if (!display_ops) { |
104 | DRM_DEBUG_KMS("display_ops is null.\n"); | |
1c248b7d ID |
105 | return 0; |
106 | } | |
107 | ||
108 | /* | |
109 | * if get_edid() exists then get_edid() callback of hdmi side | |
110 | * is called to get edid data through i2c interface else | |
111 | * get timing from the FIMD driver(display controller). | |
112 | * | |
113 | * P.S. in case of lcd panel, count is always 1 if success | |
114 | * because lcd panel has only one mode. | |
115 | */ | |
74ccc539 | 116 | if (display_ops->get_edid) { |
1c248b7d ID |
117 | int ret; |
118 | void *edid; | |
119 | ||
120 | edid = kzalloc(MAX_EDID, GFP_KERNEL); | |
121 | if (!edid) { | |
122 | DRM_ERROR("failed to allocate edid\n"); | |
123 | return 0; | |
124 | } | |
125 | ||
74ccc539 | 126 | ret = display_ops->get_edid(manager->dev, connector, |
1c248b7d ID |
127 | edid, MAX_EDID); |
128 | if (ret < 0) { | |
129 | DRM_ERROR("failed to get edid data.\n"); | |
130 | kfree(edid); | |
131 | edid = NULL; | |
132 | return 0; | |
133 | } | |
134 | ||
135 | drm_mode_connector_update_edid_property(connector, edid); | |
136 | count = drm_add_edid_modes(connector, edid); | |
451023dc | 137 | kfree(edid); |
1c248b7d | 138 | } else { |
607c50d4 | 139 | struct exynos_drm_panel_info *panel; |
53bd5556 SK |
140 | struct drm_display_mode *mode = drm_mode_create(connector->dev); |
141 | if (!mode) { | |
142 | DRM_ERROR("failed to create a new display mode.\n"); | |
143 | return 0; | |
144 | } | |
1c248b7d | 145 | |
607c50d4 ECK |
146 | if (display_ops->get_panel) |
147 | panel = display_ops->get_panel(manager->dev); | |
1c248b7d ID |
148 | else { |
149 | drm_mode_destroy(connector->dev, mode); | |
150 | return 0; | |
151 | } | |
152 | ||
607c50d4 ECK |
153 | convert_to_display_mode(mode, panel); |
154 | connector->display_info.width_mm = mode->width_mm; | |
155 | connector->display_info.height_mm = mode->height_mm; | |
1c248b7d ID |
156 | |
157 | mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED; | |
158 | drm_mode_set_name(mode); | |
159 | drm_mode_probed_add(connector, mode); | |
160 | ||
161 | count = 1; | |
162 | } | |
163 | ||
164 | return count; | |
165 | } | |
166 | ||
167 | static int exynos_drm_connector_mode_valid(struct drm_connector *connector, | |
168 | struct drm_display_mode *mode) | |
169 | { | |
adb6b159 ID |
170 | struct exynos_drm_connector *exynos_connector = |
171 | to_exynos_connector(connector); | |
172 | struct exynos_drm_manager *manager = exynos_connector->manager; | |
74ccc539 | 173 | struct exynos_drm_display_ops *display_ops = manager->display_ops; |
1c248b7d ID |
174 | struct fb_videomode timing; |
175 | int ret = MODE_BAD; | |
176 | ||
177 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
178 | ||
179 | convert_to_video_timing(&timing, mode); | |
180 | ||
74ccc539 ID |
181 | if (display_ops && display_ops->check_timing) |
182 | if (!display_ops->check_timing(manager->dev, (void *)&timing)) | |
1c248b7d ID |
183 | ret = MODE_OK; |
184 | ||
185 | return ret; | |
186 | } | |
187 | ||
58f6aad7 | 188 | struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector) |
1c248b7d | 189 | { |
adb6b159 ID |
190 | struct drm_device *dev = connector->dev; |
191 | struct exynos_drm_connector *exynos_connector = | |
192 | to_exynos_connector(connector); | |
193 | struct drm_mode_object *obj; | |
194 | struct drm_encoder *encoder; | |
195 | ||
1c248b7d ID |
196 | DRM_DEBUG_KMS("%s\n", __FILE__); |
197 | ||
adb6b159 ID |
198 | obj = drm_mode_object_find(dev, exynos_connector->encoder_id, |
199 | DRM_MODE_OBJECT_ENCODER); | |
200 | if (!obj) { | |
201 | DRM_DEBUG_KMS("Unknown ENCODER ID %d\n", | |
202 | exynos_connector->encoder_id); | |
203 | return NULL; | |
204 | } | |
205 | ||
206 | encoder = obj_to_encoder(obj); | |
207 | ||
208 | return encoder; | |
1c248b7d ID |
209 | } |
210 | ||
211 | static struct drm_connector_helper_funcs exynos_connector_helper_funcs = { | |
212 | .get_modes = exynos_drm_connector_get_modes, | |
213 | .mode_valid = exynos_drm_connector_mode_valid, | |
214 | .best_encoder = exynos_drm_best_encoder, | |
215 | }; | |
216 | ||
50caf25c ID |
217 | void exynos_drm_display_power(struct drm_connector *connector, int mode) |
218 | { | |
58f6aad7 | 219 | struct drm_encoder *encoder = exynos_drm_best_encoder(connector); |
50caf25c ID |
220 | struct exynos_drm_connector *exynos_connector; |
221 | struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder); | |
222 | struct exynos_drm_display_ops *display_ops = manager->display_ops; | |
223 | ||
224 | exynos_connector = to_exynos_connector(connector); | |
225 | ||
226 | if (exynos_connector->dpms == mode) { | |
227 | DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n"); | |
228 | return; | |
229 | } | |
230 | ||
231 | if (display_ops && display_ops->power_on) | |
232 | display_ops->power_on(manager->dev, mode); | |
233 | ||
234 | exynos_connector->dpms = mode; | |
235 | } | |
236 | ||
237 | static void exynos_drm_connector_dpms(struct drm_connector *connector, | |
238 | int mode) | |
239 | { | |
240 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
241 | ||
242 | /* | |
243 | * in case that drm_crtc_helper_set_mode() is called, | |
244 | * encoder/crtc->funcs->dpms() will be just returned | |
245 | * because they already were DRM_MODE_DPMS_ON so only | |
246 | * exynos_drm_display_power() will be called. | |
247 | */ | |
248 | drm_helper_connector_dpms(connector, mode); | |
249 | ||
250 | exynos_drm_display_power(connector, mode); | |
251 | ||
252 | } | |
253 | ||
1de425b0 ID |
254 | static int exynos_drm_connector_fill_modes(struct drm_connector *connector, |
255 | unsigned int max_width, unsigned int max_height) | |
256 | { | |
257 | struct exynos_drm_connector *exynos_connector = | |
258 | to_exynos_connector(connector); | |
259 | struct exynos_drm_manager *manager = exynos_connector->manager; | |
260 | struct exynos_drm_manager_ops *ops = manager->ops; | |
261 | unsigned int width, height; | |
262 | ||
263 | width = max_width; | |
264 | height = max_height; | |
265 | ||
266 | /* | |
267 | * if specific driver want to find desired_mode using maxmum | |
268 | * resolution then get max width and height from that driver. | |
269 | */ | |
270 | if (ops && ops->get_max_resol) | |
271 | ops->get_max_resol(manager->dev, &width, &height); | |
272 | ||
273 | return drm_helper_probe_single_connector_modes(connector, width, | |
274 | height); | |
275 | } | |
276 | ||
1c248b7d ID |
277 | /* get detection status of display device. */ |
278 | static enum drm_connector_status | |
279 | exynos_drm_connector_detect(struct drm_connector *connector, bool force) | |
280 | { | |
adb6b159 ID |
281 | struct exynos_drm_connector *exynos_connector = |
282 | to_exynos_connector(connector); | |
283 | struct exynos_drm_manager *manager = exynos_connector->manager; | |
74ccc539 ID |
284 | struct exynos_drm_display_ops *display_ops = |
285 | manager->display_ops; | |
1c248b7d ID |
286 | enum drm_connector_status status = connector_status_disconnected; |
287 | ||
288 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
289 | ||
74ccc539 ID |
290 | if (display_ops && display_ops->is_connected) { |
291 | if (display_ops->is_connected(manager->dev)) | |
1c248b7d ID |
292 | status = connector_status_connected; |
293 | else | |
294 | status = connector_status_disconnected; | |
295 | } | |
296 | ||
297 | return status; | |
298 | } | |
299 | ||
300 | static void exynos_drm_connector_destroy(struct drm_connector *connector) | |
301 | { | |
302 | struct exynos_drm_connector *exynos_connector = | |
303 | to_exynos_connector(connector); | |
304 | ||
305 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
306 | ||
307 | drm_sysfs_connector_remove(connector); | |
308 | drm_connector_cleanup(connector); | |
309 | kfree(exynos_connector); | |
310 | } | |
311 | ||
312 | static struct drm_connector_funcs exynos_connector_funcs = { | |
50caf25c | 313 | .dpms = exynos_drm_connector_dpms, |
1de425b0 | 314 | .fill_modes = exynos_drm_connector_fill_modes, |
1c248b7d ID |
315 | .detect = exynos_drm_connector_detect, |
316 | .destroy = exynos_drm_connector_destroy, | |
317 | }; | |
318 | ||
319 | struct drm_connector *exynos_drm_connector_create(struct drm_device *dev, | |
320 | struct drm_encoder *encoder) | |
321 | { | |
322 | struct exynos_drm_connector *exynos_connector; | |
323 | struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder); | |
324 | struct drm_connector *connector; | |
325 | int type; | |
326 | int err; | |
327 | ||
328 | DRM_DEBUG_KMS("%s\n", __FILE__); | |
329 | ||
330 | exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL); | |
331 | if (!exynos_connector) { | |
332 | DRM_ERROR("failed to allocate connector\n"); | |
333 | return NULL; | |
334 | } | |
335 | ||
336 | connector = &exynos_connector->drm_connector; | |
337 | ||
74ccc539 | 338 | switch (manager->display_ops->type) { |
1c248b7d ID |
339 | case EXYNOS_DISPLAY_TYPE_HDMI: |
340 | type = DRM_MODE_CONNECTOR_HDMIA; | |
1b17b206 SWK |
341 | connector->interlace_allowed = true; |
342 | connector->polled = DRM_CONNECTOR_POLL_HPD; | |
1c248b7d | 343 | break; |
b73d1230 ID |
344 | case EXYNOS_DISPLAY_TYPE_VIDI: |
345 | type = DRM_MODE_CONNECTOR_VIRTUAL; | |
346 | connector->polled = DRM_CONNECTOR_POLL_HPD; | |
347 | break; | |
1c248b7d ID |
348 | default: |
349 | type = DRM_MODE_CONNECTOR_Unknown; | |
350 | break; | |
351 | } | |
352 | ||
353 | drm_connector_init(dev, connector, &exynos_connector_funcs, type); | |
354 | drm_connector_helper_add(connector, &exynos_connector_helper_funcs); | |
355 | ||
356 | err = drm_sysfs_connector_add(connector); | |
357 | if (err) | |
358 | goto err_connector; | |
359 | ||
adb6b159 ID |
360 | exynos_connector->encoder_id = encoder->base.id; |
361 | exynos_connector->manager = manager; | |
50caf25c | 362 | exynos_connector->dpms = DRM_MODE_DPMS_OFF; |
44c91697 | 363 | connector->dpms = DRM_MODE_DPMS_OFF; |
1c248b7d | 364 | connector->encoder = encoder; |
adb6b159 | 365 | |
1c248b7d ID |
366 | err = drm_mode_connector_attach_encoder(connector, encoder); |
367 | if (err) { | |
368 | DRM_ERROR("failed to attach a connector to a encoder\n"); | |
369 | goto err_sysfs; | |
370 | } | |
371 | ||
372 | DRM_DEBUG_KMS("connector has been created\n"); | |
373 | ||
374 | return connector; | |
375 | ||
376 | err_sysfs: | |
377 | drm_sysfs_connector_remove(connector); | |
378 | err_connector: | |
379 | drm_connector_cleanup(connector); | |
380 | kfree(exynos_connector); | |
381 | return NULL; | |
382 | } |