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 * 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.
15 #include <drm/drm_crtc_helper.h>
17 #include <drm/exynos_drm.h>
18 #include "exynos_drm_drv.h"
19 #include "exynos_drm_encoder.h"
22 #define to_exynos_connector(x) container_of(x, struct exynos_drm_connector,\
25 struct exynos_drm_connector {
26 struct drm_connector drm_connector;
28 struct exynos_drm_manager *manager;
32 /* convert exynos_video_timings to drm_display_mode */
34 convert_to_display_mode(struct drm_display_mode *mode,
35 struct exynos_drm_panel_info *panel)
37 struct fb_videomode *timing = &panel->timing;
38 DRM_DEBUG_KMS("%s\n", __FILE__);
40 mode->clock = timing->pixclock / 1000;
41 mode->vrefresh = timing->refresh;
43 mode->hdisplay = timing->xres;
44 mode->hsync_start = mode->hdisplay + timing->right_margin;
45 mode->hsync_end = mode->hsync_start + timing->hsync_len;
46 mode->htotal = mode->hsync_end + timing->left_margin;
48 mode->vdisplay = timing->yres;
49 mode->vsync_start = mode->vdisplay + timing->lower_margin;
50 mode->vsync_end = mode->vsync_start + timing->vsync_len;
51 mode->vtotal = mode->vsync_end + timing->upper_margin;
52 mode->width_mm = panel->width_mm;
53 mode->height_mm = panel->height_mm;
55 if (timing->vmode & FB_VMODE_INTERLACED)
56 mode->flags |= DRM_MODE_FLAG_INTERLACE;
58 if (timing->vmode & FB_VMODE_DOUBLE)
59 mode->flags |= DRM_MODE_FLAG_DBLSCAN;
62 /* convert drm_display_mode to exynos_video_timings */
64 convert_to_video_timing(struct fb_videomode *timing,
65 struct drm_display_mode *mode)
67 DRM_DEBUG_KMS("%s\n", __FILE__);
69 memset(timing, 0, sizeof(*timing));
71 timing->pixclock = mode->clock * 1000;
72 timing->refresh = drm_mode_vrefresh(mode);
74 timing->xres = mode->hdisplay;
75 timing->right_margin = mode->hsync_start - mode->hdisplay;
76 timing->hsync_len = mode->hsync_end - mode->hsync_start;
77 timing->left_margin = mode->htotal - mode->hsync_end;
79 timing->yres = mode->vdisplay;
80 timing->lower_margin = mode->vsync_start - mode->vdisplay;
81 timing->vsync_len = mode->vsync_end - mode->vsync_start;
82 timing->upper_margin = mode->vtotal - mode->vsync_end;
84 if (mode->flags & DRM_MODE_FLAG_INTERLACE)
85 timing->vmode = FB_VMODE_INTERLACED;
87 timing->vmode = FB_VMODE_NONINTERLACED;
89 if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
90 timing->vmode |= FB_VMODE_DOUBLE;
93 static int exynos_drm_connector_get_modes(struct drm_connector *connector)
95 struct exynos_drm_connector *exynos_connector =
96 to_exynos_connector(connector);
97 struct exynos_drm_manager *manager = exynos_connector->manager;
98 struct exynos_drm_display_ops *display_ops = manager->display_ops;
101 DRM_DEBUG_KMS("%s\n", __FILE__);
104 DRM_DEBUG_KMS("display_ops is null.\n");
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).
113 * P.S. in case of lcd panel, count is always 1 if success
114 * because lcd panel has only one mode.
116 if (display_ops->get_edid) {
120 edid = kzalloc(MAX_EDID, GFP_KERNEL);
122 DRM_ERROR("failed to allocate edid\n");
126 ret = display_ops->get_edid(manager->dev, connector,
129 DRM_ERROR("failed to get edid data.\n");
135 drm_mode_connector_update_edid_property(connector, edid);
136 count = drm_add_edid_modes(connector, edid);
139 struct exynos_drm_panel_info *panel;
140 struct drm_display_mode *mode = drm_mode_create(connector->dev);
142 DRM_ERROR("failed to create a new display mode.\n");
146 if (display_ops->get_panel)
147 panel = display_ops->get_panel(manager->dev);
149 drm_mode_destroy(connector->dev, mode);
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;
157 mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
158 drm_mode_set_name(mode);
159 drm_mode_probed_add(connector, mode);
167 static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
168 struct drm_display_mode *mode)
170 struct exynos_drm_connector *exynos_connector =
171 to_exynos_connector(connector);
172 struct exynos_drm_manager *manager = exynos_connector->manager;
173 struct exynos_drm_display_ops *display_ops = manager->display_ops;
174 struct fb_videomode timing;
177 DRM_DEBUG_KMS("%s\n", __FILE__);
179 convert_to_video_timing(&timing, mode);
181 if (display_ops && display_ops->check_timing)
182 if (!display_ops->check_timing(manager->dev, (void *)&timing))
188 struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
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;
196 DRM_DEBUG_KMS("%s\n", __FILE__);
198 obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
199 DRM_MODE_OBJECT_ENCODER);
201 DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
202 exynos_connector->encoder_id);
206 encoder = obj_to_encoder(obj);
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,
217 void exynos_drm_display_power(struct drm_connector *connector, int mode)
219 struct drm_encoder *encoder = exynos_drm_best_encoder(connector);
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;
224 exynos_connector = to_exynos_connector(connector);
226 if (exynos_connector->dpms == mode) {
227 DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
231 if (display_ops && display_ops->power_on)
232 display_ops->power_on(manager->dev, mode);
234 exynos_connector->dpms = mode;
237 static void exynos_drm_connector_dpms(struct drm_connector *connector,
240 DRM_DEBUG_KMS("%s\n", __FILE__);
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.
248 drm_helper_connector_dpms(connector, mode);
250 exynos_drm_display_power(connector, mode);
254 static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
255 unsigned int max_width, unsigned int max_height)
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;
267 * if specific driver want to find desired_mode using maxmum
268 * resolution then get max width and height from that driver.
270 if (ops && ops->get_max_resol)
271 ops->get_max_resol(manager->dev, &width, &height);
273 return drm_helper_probe_single_connector_modes(connector, width,
277 /* get detection status of display device. */
278 static enum drm_connector_status
279 exynos_drm_connector_detect(struct drm_connector *connector, bool force)
281 struct exynos_drm_connector *exynos_connector =
282 to_exynos_connector(connector);
283 struct exynos_drm_manager *manager = exynos_connector->manager;
284 struct exynos_drm_display_ops *display_ops =
285 manager->display_ops;
286 enum drm_connector_status status = connector_status_disconnected;
288 DRM_DEBUG_KMS("%s\n", __FILE__);
290 if (display_ops && display_ops->is_connected) {
291 if (display_ops->is_connected(manager->dev))
292 status = connector_status_connected;
294 status = connector_status_disconnected;
300 static void exynos_drm_connector_destroy(struct drm_connector *connector)
302 struct exynos_drm_connector *exynos_connector =
303 to_exynos_connector(connector);
305 DRM_DEBUG_KMS("%s\n", __FILE__);
307 drm_sysfs_connector_remove(connector);
308 drm_connector_cleanup(connector);
309 kfree(exynos_connector);
312 static struct drm_connector_funcs exynos_connector_funcs = {
313 .dpms = exynos_drm_connector_dpms,
314 .fill_modes = exynos_drm_connector_fill_modes,
315 .detect = exynos_drm_connector_detect,
316 .destroy = exynos_drm_connector_destroy,
319 struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
320 struct drm_encoder *encoder)
322 struct exynos_drm_connector *exynos_connector;
323 struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
324 struct drm_connector *connector;
328 DRM_DEBUG_KMS("%s\n", __FILE__);
330 exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
331 if (!exynos_connector) {
332 DRM_ERROR("failed to allocate connector\n");
336 connector = &exynos_connector->drm_connector;
338 switch (manager->display_ops->type) {
339 case EXYNOS_DISPLAY_TYPE_HDMI:
340 type = DRM_MODE_CONNECTOR_HDMIA;
341 connector->interlace_allowed = true;
342 connector->polled = DRM_CONNECTOR_POLL_HPD;
344 case EXYNOS_DISPLAY_TYPE_VIDI:
345 type = DRM_MODE_CONNECTOR_VIRTUAL;
346 connector->polled = DRM_CONNECTOR_POLL_HPD;
349 type = DRM_MODE_CONNECTOR_Unknown;
353 drm_connector_init(dev, connector, &exynos_connector_funcs, type);
354 drm_connector_helper_add(connector, &exynos_connector_helper_funcs);
356 err = drm_sysfs_connector_add(connector);
360 exynos_connector->encoder_id = encoder->base.id;
361 exynos_connector->manager = manager;
362 exynos_connector->dpms = DRM_MODE_DPMS_OFF;
363 connector->dpms = DRM_MODE_DPMS_OFF;
364 connector->encoder = encoder;
366 err = drm_mode_connector_attach_encoder(connector, encoder);
368 DRM_ERROR("failed to attach a connector to a encoder\n");
372 DRM_DEBUG_KMS("connector has been created\n");
377 drm_sysfs_connector_remove(connector);
379 drm_connector_cleanup(connector);
380 kfree(exynos_connector);