2 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
4 * Inki Dae <inki.dae@samsung.com>
5 * Joonyoung Shim <jy0922.shim@samsung.com>
6 * Seung-Woo Kim <sw0312.kim@samsung.com>
8 * Permission is hereby granted, free of charge, to any person obtaining a
9 * copy of this software and associated documentation files (the "Software"),
10 * to deal in the Software without restriction, including without limitation
11 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
12 * and/or sell copies of the Software, and to permit persons to whom the
13 * Software is furnished to do so, subject to the following conditions:
15 * The above copyright notice and this permission notice (including the next
16 * paragraph) shall be included in all copies or substantial portions of the
19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
22 * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
23 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
24 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
25 * OTHER DEALINGS IN THE SOFTWARE.
29 #include "drm_crtc_helper.h"
31 #include <drm/exynos_drm.h>
32 #include "exynos_drm_drv.h"
33 #include "exynos_drm_encoder.h"
34 #include "exynos_drm_display.h"
37 #define to_exynos_connector(x) container_of(x, struct exynos_drm_connector,\
40 struct exynos_drm_connector {
41 struct drm_connector drm_connector;
43 struct exynos_drm_display *display;
46 /* convert exynos_video_timings to drm_display_mode */
48 convert_to_display_mode(struct drm_display_mode *mode,
49 struct exynos_drm_panel_info *panel)
51 struct fb_videomode *timing = &panel->timing;
52 DRM_DEBUG_KMS("%s\n", __FILE__);
54 mode->clock = timing->pixclock / 1000;
55 mode->vrefresh = timing->refresh;
57 mode->hdisplay = timing->xres;
58 mode->hsync_start = mode->hdisplay + timing->right_margin;
59 mode->hsync_end = mode->hsync_start + timing->hsync_len;
60 mode->htotal = mode->hsync_end + timing->left_margin;
62 mode->vdisplay = timing->yres;
63 mode->vsync_start = mode->vdisplay + timing->lower_margin;
64 mode->vsync_end = mode->vsync_start + timing->vsync_len;
65 mode->vtotal = mode->vsync_end + timing->upper_margin;
66 mode->width_mm = panel->width_mm;
67 mode->height_mm = panel->height_mm;
69 if (timing->vmode & FB_VMODE_INTERLACED)
70 mode->flags |= DRM_MODE_FLAG_INTERLACE;
72 if (timing->vmode & FB_VMODE_DOUBLE)
73 mode->flags |= DRM_MODE_FLAG_DBLSCAN;
76 /* convert drm_display_mode to exynos_video_timings */
78 convert_to_video_timing(struct fb_videomode *timing,
79 struct drm_display_mode *mode)
81 DRM_DEBUG_KMS("%s\n", __FILE__);
83 memset(timing, 0, sizeof(*timing));
85 timing->pixclock = mode->clock * 1000;
86 timing->refresh = drm_mode_vrefresh(mode);
88 timing->xres = mode->hdisplay;
89 timing->right_margin = mode->hsync_start - mode->hdisplay;
90 timing->hsync_len = mode->hsync_end - mode->hsync_start;
91 timing->left_margin = mode->htotal - mode->hsync_end;
93 timing->yres = mode->vdisplay;
94 timing->lower_margin = mode->vsync_start - mode->vdisplay;
95 timing->vsync_len = mode->vsync_end - mode->vsync_start;
96 timing->upper_margin = mode->vtotal - mode->vsync_end;
98 if (mode->flags & DRM_MODE_FLAG_INTERLACE)
99 timing->vmode = FB_VMODE_INTERLACED;
101 timing->vmode = FB_VMODE_NONINTERLACED;
103 if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
104 timing->vmode |= FB_VMODE_DOUBLE;
107 static struct exynos_drm_display *display_from_connector(
108 struct drm_connector *connector)
110 return to_exynos_connector(connector)->display;
113 static int exynos_drm_connector_get_edid(struct drm_connector *connector)
115 struct exynos_drm_display *display = display_from_connector(connector);
119 if (!display->panel_ops->get_edid)
122 edid = kzalloc(MAX_EDID, GFP_KERNEL);
124 DRM_ERROR("failed to allocate edid\n");
128 ret = display->panel_ops->get_edid(display->panel_ctx,
129 connector, edid, MAX_EDID);
131 DRM_ERROR("Panel operation get_edid failed %d\n", ret);
135 ret = drm_mode_connector_update_edid_property(connector, edid);
137 DRM_ERROR("update edid property failed(%d)\n", ret);
141 ret = drm_add_edid_modes(connector, edid);
143 DRM_ERROR("Add edid modes failed %d\n", ret);
147 kfree(connector->display_info.raw_edid);
148 connector->display_info.raw_edid = edid;
157 static int exynos_drm_connector_get_panel(struct drm_connector *connector)
159 struct exynos_drm_display *display = display_from_connector(connector);
160 struct drm_display_mode *mode;
161 struct exynos_drm_panel_info *panel;
164 if (!display->controller_ops->get_panel)
167 panel = display->controller_ops->get_panel(
168 display->controller_ctx);
170 for (ret = 0; panel && ret < MAX_NR_PANELS; ret++) {
171 if (panel[ret].timing.xres == -1 &&
172 panel[ret].timing.yres == -1)
175 mode = drm_mode_create(connector->dev);
176 mode->type = DRM_MODE_TYPE_DRIVER;
178 /* Only the first panel is preferred mode */
180 mode->type |= DRM_MODE_TYPE_PREFERRED;
182 mode->type |= DRM_MODE_TYPE_USERDEF;
184 convert_to_display_mode(mode, &panel[ret]);
185 connector->display_info.width_mm = mode->width_mm;
186 connector->display_info.height_mm = mode->height_mm;
187 drm_mode_set_name(mode);
188 drm_mode_probed_add(connector, mode);
194 static int exynos_drm_connector_get_modes(struct drm_connector *connector)
198 DRM_DEBUG_KMS("%s\n", __FILE__);
201 * First try getting modes from EDID. If that doesn't yield any results,
202 * fall back to the panel call.
204 ret = exynos_drm_connector_get_edid(connector);
208 return exynos_drm_connector_get_panel(connector);
211 static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
212 struct drm_display_mode *mode)
214 struct exynos_drm_display *display = display_from_connector(connector);
215 struct fb_videomode timing;
218 DRM_DEBUG_KMS("%s\n", __FILE__);
220 convert_to_video_timing(&timing, mode);
222 if (!display->panel_ops->check_timing)
225 if (!display->panel_ops->check_timing(display->panel_ctx, &timing))
231 struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
233 struct drm_device *dev = connector->dev;
234 struct exynos_drm_connector *exynos_connector =
235 to_exynos_connector(connector);
236 struct drm_mode_object *obj;
237 struct drm_encoder *encoder;
239 DRM_DEBUG_KMS("%s\n", __FILE__);
241 obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
242 DRM_MODE_OBJECT_ENCODER);
244 DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
245 exynos_connector->encoder_id);
249 encoder = obj_to_encoder(obj);
254 static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
255 .get_modes = exynos_drm_connector_get_modes,
256 .mode_valid = exynos_drm_connector_mode_valid,
257 .best_encoder = exynos_drm_best_encoder,
260 static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
261 unsigned int max_width, unsigned int max_height)
263 struct exynos_drm_display *display = display_from_connector(connector);
264 unsigned int width, height;
270 * If the specific driver wants to find desired_mode using maximum
271 * resolution then get max width and height from that driver.
273 if (display->panel_ops->get_max_res)
274 display->panel_ops->get_max_res(display->panel_ctx, &width,
277 return drm_helper_probe_single_connector_modes(connector, width,
281 /* get detection status of display device. */
282 static enum drm_connector_status
283 exynos_drm_connector_detect(struct drm_connector *connector, bool force)
285 struct exynos_drm_display *display = display_from_connector(connector);
286 enum drm_connector_status status;
288 DRM_DEBUG_KMS("%s\n", __FILE__);
290 if (display->panel_ops->is_connected &&
291 display->panel_ops->is_connected(display->panel_ctx))
292 status = connector_status_connected;
294 status = connector_status_disconnected;
299 static void exynos_drm_connector_destroy(struct drm_connector *connector)
301 struct exynos_drm_connector *exynos_connector =
302 to_exynos_connector(connector);
304 DRM_DEBUG_KMS("%s\n", __FILE__);
306 drm_sysfs_connector_remove(connector);
307 drm_connector_cleanup(connector);
308 kfree(exynos_connector);
311 static struct drm_connector_funcs exynos_connector_funcs = {
312 .dpms = drm_helper_connector_dpms,
313 .fill_modes = exynos_drm_connector_fill_modes,
314 .detect = exynos_drm_connector_detect,
315 .destroy = exynos_drm_connector_destroy,
318 struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
319 struct drm_encoder *encoder)
321 struct exynos_drm_connector *exynos_connector;
322 struct exynos_drm_display *display = exynos_drm_get_display(encoder);
323 struct drm_connector *connector;
327 DRM_DEBUG_KMS("%s\n", __FILE__);
329 exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
330 if (!exynos_connector) {
331 DRM_ERROR("failed to allocate connector\n");
335 connector = &exynos_connector->drm_connector;
337 switch (display->display_type) {
338 case EXYNOS_DRM_DISPLAY_TYPE_MIXER:
339 type = DRM_MODE_CONNECTOR_HDMIA;
340 connector->interlace_allowed = true;
341 connector->polled = DRM_CONNECTOR_POLL_HPD;
343 case EXYNOS_DRM_DISPLAY_TYPE_VIDI:
344 type = DRM_MODE_CONNECTOR_VIRTUAL;
345 connector->polled = DRM_CONNECTOR_POLL_HPD;
347 case EXYNOS_DRM_DISPLAY_TYPE_FIMD:
348 type = DRM_MODE_CONNECTOR_eDP;
349 connector->polled = DRM_CONNECTOR_POLL_HPD;
352 type = DRM_MODE_CONNECTOR_Unknown;
356 drm_connector_init(dev, connector, &exynos_connector_funcs, type);
357 drm_connector_helper_add(connector, &exynos_connector_helper_funcs);
359 err = drm_sysfs_connector_add(connector);
363 exynos_connector->encoder_id = encoder->base.id;
364 exynos_connector->display = display;
365 connector->encoder = encoder;
367 err = drm_mode_connector_attach_encoder(connector, encoder);
369 DRM_ERROR("failed to attach a connector to a encoder\n");
373 DRM_DEBUG_KMS("connector has been created\n");
378 drm_sysfs_connector_remove(connector);
380 drm_connector_cleanup(connector);
381 kfree(exynos_connector);