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("[MODE:%d:%s]\n", DRM_BASE_ID(mode), mode->name);
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("[MODE:%d:%s]\n", DRM_BASE_ID(mode), mode->name);
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 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
120 drm_get_connector_name(connector));
122 if (!display->panel_ops->get_edid)
125 edid = display->panel_ops->get_edid(display->panel_ctx, connector);
126 if (IS_ERR_OR_NULL(edid)) {
129 DRM_ERROR("Panel operation get_edid failed %d\n", ret);
133 ret = drm_mode_connector_update_edid_property(connector, edid);
135 DRM_ERROR("update edid property failed(%d)\n", ret);
139 ret = drm_add_edid_modes(connector, edid);
141 DRM_ERROR("Add edid modes failed %d\n", ret);
146 connector->display_info.raw_edid = NULL;
151 static int exynos_drm_connector_get_panel(struct drm_connector *connector)
153 struct exynos_drm_display *display = display_from_connector(connector);
154 struct drm_display_mode *mode;
155 struct exynos_drm_panel_info *panel;
157 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
158 drm_get_connector_name(connector));
160 if (!display->controller_ops->get_panel)
163 panel = display->controller_ops->get_panel(display->controller_ctx);
165 mode = drm_mode_create(connector->dev);
166 mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
168 convert_to_display_mode(mode, panel);
169 connector->display_info.width_mm = mode->width_mm;
170 connector->display_info.height_mm = mode->height_mm;
171 drm_mode_set_name(mode);
172 drm_mode_probed_add(connector, mode);
177 static int exynos_drm_connector_get_modes(struct drm_connector *connector)
181 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
182 drm_get_connector_name(connector));
185 * First try getting modes from EDID. If that doesn't yield any results,
186 * fall back to the panel call.
188 ret = exynos_drm_connector_get_edid(connector);
192 return exynos_drm_connector_get_panel(connector);
195 static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
196 struct drm_display_mode *mode)
198 struct exynos_drm_display *display = display_from_connector(connector);
199 struct fb_videomode timing;
202 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] [MODE:%d:%s]\n",
203 DRM_BASE_ID(connector),
204 drm_get_connector_name(connector), DRM_BASE_ID(mode),
207 convert_to_video_timing(&timing, mode);
209 if (!display->panel_ops->check_timing)
212 if (!display->panel_ops->check_timing(display->panel_ctx, &timing))
218 struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
220 struct drm_device *dev = connector->dev;
221 struct exynos_drm_connector *exynos_connector =
222 to_exynos_connector(connector);
223 struct drm_mode_object *obj;
224 struct drm_encoder *encoder;
226 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
227 drm_get_connector_name(connector));
229 obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
230 DRM_MODE_OBJECT_ENCODER);
232 DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
233 exynos_connector->encoder_id);
237 encoder = obj_to_encoder(obj);
239 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] == [ENCODER:%d:%s]\n",
240 DRM_BASE_ID(connector),
241 drm_get_connector_name(connector),
242 DRM_BASE_ID(encoder), drm_get_encoder_name(encoder));
247 struct drm_bridge *exynos_drm_best_bridge(struct drm_connector *connector)
249 struct drm_device *dev = connector->dev;
250 struct drm_bridge *bridge;
252 list_for_each_entry(bridge, &dev->mode_config.bridge_list, head) {
253 if (bridge->connector_type == connector->connector_type)
259 static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
260 .get_modes = exynos_drm_connector_get_modes,
261 .mode_valid = exynos_drm_connector_mode_valid,
262 .best_encoder = exynos_drm_best_encoder,
263 .best_bridge = exynos_drm_best_bridge,
266 static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
267 unsigned int max_width, unsigned int max_height)
269 struct exynos_drm_display *display = display_from_connector(connector);
271 unsigned int width, height;
273 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] %d x %d\n", DRM_BASE_ID(connector),
274 drm_get_connector_name(connector), max_width,
281 * If the specific driver wants to find desired_mode using maximum
282 * resolution then get max width and height from that driver.
284 if (display->panel_ops->get_max_res)
285 display->panel_ops->get_max_res(display->panel_ctx, &width,
288 ret = drm_helper_probe_single_connector_modes(connector, width,
291 DRM_ERROR("Failed to probe connector modes ret=%d\n", ret);
295 if (display->controller_ops->adjust_modes)
296 display->controller_ops->adjust_modes(display->controller_ctx,
302 /* get detection status of display device. */
303 static enum drm_connector_status
304 exynos_drm_connector_detect(struct drm_connector *connector, bool force)
306 struct exynos_drm_display *display = display_from_connector(connector);
307 enum drm_connector_status status;
309 if (display->panel_ops->is_connected &&
310 display->panel_ops->is_connected(display->panel_ctx))
311 status = connector_status_connected;
313 status = connector_status_disconnected;
315 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] force: %d == %s\n",
316 DRM_BASE_ID(connector),
317 drm_get_connector_name(connector), force,
318 drm_get_connector_status_name(status));
323 static void exynos_drm_connector_destroy(struct drm_connector *connector)
325 struct exynos_drm_connector *exynos_connector =
326 to_exynos_connector(connector);
328 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", DRM_BASE_ID(connector),
329 drm_get_connector_name(connector));
331 drm_sysfs_connector_remove(connector);
332 drm_connector_cleanup(connector);
333 kfree(exynos_connector);
336 static struct drm_connector_funcs exynos_connector_funcs = {
337 .dpms = drm_helper_connector_dpms,
338 .fill_modes = exynos_drm_connector_fill_modes,
339 .detect = exynos_drm_connector_detect,
340 .destroy = exynos_drm_connector_destroy,
343 struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
344 struct drm_encoder *encoder)
346 struct exynos_drm_connector *exynos_connector;
347 struct exynos_drm_display *display = exynos_drm_get_display(encoder);
348 struct drm_connector *connector;
352 DRM_DEBUG_KMS("[DEV:%s] [ENCODER:%d:%s]\n", dev->devname,
353 DRM_BASE_ID(encoder), drm_get_encoder_name(encoder));
355 exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
356 if (!exynos_connector) {
357 DRM_ERROR("failed to allocate connector\n");
361 connector = &exynos_connector->drm_connector;
362 connector->dpms = DRM_MODE_DPMS_OFF;
364 switch (display->display_type) {
365 case EXYNOS_DRM_DISPLAY_TYPE_MIXER:
366 type = DRM_MODE_CONNECTOR_HDMIA;
367 connector->interlace_allowed = true;
368 connector->polled = DRM_CONNECTOR_POLL_HPD;
370 case EXYNOS_DRM_DISPLAY_TYPE_VIDI:
371 type = DRM_MODE_CONNECTOR_VIRTUAL;
372 connector->polled = DRM_CONNECTOR_POLL_HPD;
374 case EXYNOS_DRM_DISPLAY_TYPE_FIMD:
375 type = DRM_MODE_CONNECTOR_eDP;
376 connector->polled = DRM_CONNECTOR_POLL_HPD;
379 type = DRM_MODE_CONNECTOR_Unknown;
383 drm_connector_init(dev, connector, &exynos_connector_funcs, type);
384 drm_connector_helper_add(connector, &exynos_connector_helper_funcs);
386 err = drm_sysfs_connector_add(connector);
390 exynos_connector->encoder_id = encoder->base.id;
391 exynos_connector->display = display;
392 connector->encoder = encoder;
394 err = drm_mode_connector_attach_encoder(connector, encoder);
396 DRM_ERROR("failed to attach a connector to a encoder\n");
400 DRM_DEBUG_KMS("New [CONNECTOR:%d:%s] attached to [ENCODER:%d:%s]\n",
401 DRM_BASE_ID(connector),
402 drm_get_connector_name(connector),
403 DRM_BASE_ID(encoder), drm_get_encoder_name(encoder));
408 drm_sysfs_connector_remove(connector);
410 drm_connector_cleanup(connector);
411 kfree(exynos_connector);