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 = display->panel_ops->get_edid(display->panel_ctx, connector);
123 if (IS_ERR_OR_NULL(edid)) {
126 DRM_ERROR("Panel operation get_edid failed %d\n", ret);
130 ret = drm_mode_connector_update_edid_property(connector, edid);
132 DRM_ERROR("update edid property failed(%d)\n", ret);
136 ret = drm_add_edid_modes(connector, edid);
138 DRM_ERROR("Add edid modes failed %d\n", ret);
143 connector->display_info.raw_edid = NULL;
148 static int exynos_drm_connector_get_panel(struct drm_connector *connector)
150 struct exynos_drm_display *display = display_from_connector(connector);
151 struct drm_display_mode *mode;
152 struct exynos_drm_panel_info *panel;
155 if (!display->controller_ops->get_panel)
158 panel = display->controller_ops->get_panel(
159 display->controller_ctx);
161 for (ret = 0; panel && ret < MAX_NR_PANELS; ret++) {
162 if (panel[ret].timing.xres == -1 &&
163 panel[ret].timing.yres == -1)
166 mode = drm_mode_create(connector->dev);
167 mode->type = DRM_MODE_TYPE_DRIVER;
169 /* Only the first panel is preferred mode */
171 mode->type |= DRM_MODE_TYPE_PREFERRED;
173 mode->type |= DRM_MODE_TYPE_USERDEF;
175 convert_to_display_mode(mode, &panel[ret]);
176 connector->display_info.width_mm = mode->width_mm;
177 connector->display_info.height_mm = mode->height_mm;
178 drm_mode_set_name(mode);
179 drm_mode_probed_add(connector, mode);
185 static int exynos_drm_connector_get_modes(struct drm_connector *connector)
189 DRM_DEBUG_KMS("%s\n", __FILE__);
192 * First try getting modes from EDID. If that doesn't yield any results,
193 * fall back to the panel call.
195 ret = exynos_drm_connector_get_edid(connector);
199 return exynos_drm_connector_get_panel(connector);
202 static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
203 struct drm_display_mode *mode)
205 struct exynos_drm_display *display = display_from_connector(connector);
206 struct fb_videomode timing;
209 DRM_DEBUG_KMS("%s\n", __FILE__);
211 convert_to_video_timing(&timing, mode);
213 if (!display->panel_ops->check_timing)
216 if (!display->panel_ops->check_timing(display->panel_ctx, &timing))
222 struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
224 struct drm_device *dev = connector->dev;
225 struct exynos_drm_connector *exynos_connector =
226 to_exynos_connector(connector);
227 struct drm_mode_object *obj;
228 struct drm_encoder *encoder;
230 DRM_DEBUG_KMS("%s\n", __FILE__);
232 obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
233 DRM_MODE_OBJECT_ENCODER);
235 DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
236 exynos_connector->encoder_id);
240 encoder = obj_to_encoder(obj);
245 static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
246 .get_modes = exynos_drm_connector_get_modes,
247 .mode_valid = exynos_drm_connector_mode_valid,
248 .best_encoder = exynos_drm_best_encoder,
251 static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
252 unsigned int max_width, unsigned int max_height)
254 struct exynos_drm_display *display = display_from_connector(connector);
255 unsigned int width, height;
261 * If the specific driver wants to find desired_mode using maximum
262 * resolution then get max width and height from that driver.
264 if (display->panel_ops->get_max_res)
265 display->panel_ops->get_max_res(display->panel_ctx, &width,
268 return drm_helper_probe_single_connector_modes(connector, width,
272 /* get detection status of display device. */
273 static enum drm_connector_status
274 exynos_drm_connector_detect(struct drm_connector *connector, bool force)
276 struct exynos_drm_display *display = display_from_connector(connector);
277 enum drm_connector_status status;
279 DRM_DEBUG_KMS("%s\n", __FILE__);
281 if (display->panel_ops->is_connected &&
282 display->panel_ops->is_connected(display->panel_ctx))
283 status = connector_status_connected;
285 status = connector_status_disconnected;
290 static void exynos_drm_connector_destroy(struct drm_connector *connector)
292 struct exynos_drm_connector *exynos_connector =
293 to_exynos_connector(connector);
295 DRM_DEBUG_KMS("%s\n", __FILE__);
297 drm_sysfs_connector_remove(connector);
298 drm_connector_cleanup(connector);
299 kfree(exynos_connector);
302 static struct drm_connector_funcs exynos_connector_funcs = {
303 .dpms = drm_helper_connector_dpms,
304 .fill_modes = exynos_drm_connector_fill_modes,
305 .detect = exynos_drm_connector_detect,
306 .destroy = exynos_drm_connector_destroy,
309 struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
310 struct drm_encoder *encoder)
312 struct exynos_drm_connector *exynos_connector;
313 struct exynos_drm_display *display = exynos_drm_get_display(encoder);
314 struct drm_connector *connector;
318 DRM_DEBUG_KMS("%s\n", __FILE__);
320 exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
321 if (!exynos_connector) {
322 DRM_ERROR("failed to allocate connector\n");
326 connector = &exynos_connector->drm_connector;
328 switch (display->display_type) {
329 case EXYNOS_DRM_DISPLAY_TYPE_MIXER:
330 type = DRM_MODE_CONNECTOR_HDMIA;
331 connector->interlace_allowed = true;
332 connector->polled = DRM_CONNECTOR_POLL_HPD;
334 case EXYNOS_DRM_DISPLAY_TYPE_VIDI:
335 type = DRM_MODE_CONNECTOR_VIRTUAL;
336 connector->polled = DRM_CONNECTOR_POLL_HPD;
338 case EXYNOS_DRM_DISPLAY_TYPE_FIMD:
339 type = DRM_MODE_CONNECTOR_eDP;
340 connector->polled = DRM_CONNECTOR_POLL_HPD;
343 type = DRM_MODE_CONNECTOR_Unknown;
347 drm_connector_init(dev, connector, &exynos_connector_funcs, type);
348 drm_connector_helper_add(connector, &exynos_connector_helper_funcs);
350 err = drm_sysfs_connector_add(connector);
354 exynos_connector->encoder_id = encoder->base.id;
355 exynos_connector->display = display;
356 connector->encoder = encoder;
358 err = drm_mode_connector_attach_encoder(connector, encoder);
360 DRM_ERROR("failed to attach a connector to a encoder\n");
364 DRM_DEBUG_KMS("connector has been created\n");
369 drm_sysfs_connector_remove(connector);
371 drm_connector_cleanup(connector);
372 kfree(exynos_connector);