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