2 * drivers/staging/omapdrm/omap_connector.c
4 * Copyright (C) 2011 Texas Instruments
5 * Author: Rob Clark <rob@ti.com>
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License version 2 as published by
9 * the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * You should have received a copy of the GNU General Public License along with
17 * this program. If not, see <http://www.gnu.org/licenses/>.
23 #include "drm_crtc_helper.h"
29 #define to_omap_connector(x) container_of(x, struct omap_connector, base)
31 struct omap_connector {
32 struct drm_connector base;
33 struct omap_dss_device *dssdev;
36 static inline void copy_timings_omap_to_drm(struct drm_display_mode *mode,
37 struct omap_video_timings *timings)
39 mode->clock = timings->pixel_clock;
41 mode->hdisplay = timings->x_res;
42 mode->hsync_start = mode->hdisplay + timings->hfp;
43 mode->hsync_end = mode->hsync_start + timings->hsw;
44 mode->htotal = mode->hsync_end + timings->hbp;
46 mode->vdisplay = timings->y_res;
47 mode->vsync_start = mode->vdisplay + timings->vfp;
48 mode->vsync_end = mode->vsync_start + timings->vsw;
49 mode->vtotal = mode->vsync_end + timings->vbp;
53 if (timings->interlace)
54 mode->flags |= DRM_MODE_FLAG_INTERLACE;
56 if (timings->hsync_level == OMAPDSS_SIG_ACTIVE_HIGH)
57 mode->flags |= DRM_MODE_FLAG_PHSYNC;
59 mode->flags |= DRM_MODE_FLAG_NHSYNC;
61 if (timings->vsync_level == OMAPDSS_SIG_ACTIVE_HIGH)
62 mode->flags |= DRM_MODE_FLAG_PVSYNC;
64 mode->flags |= DRM_MODE_FLAG_NVSYNC;
67 static inline void copy_timings_drm_to_omap(struct omap_video_timings *timings,
68 struct drm_display_mode *mode)
70 timings->pixel_clock = mode->clock;
72 timings->x_res = mode->hdisplay;
73 timings->hfp = mode->hsync_start - mode->hdisplay;
74 timings->hsw = mode->hsync_end - mode->hsync_start;
75 timings->hbp = mode->htotal - mode->hsync_end;
77 timings->y_res = mode->vdisplay;
78 timings->vfp = mode->vsync_start - mode->vdisplay;
79 timings->vsw = mode->vsync_end - mode->vsync_start;
80 timings->vbp = mode->vtotal - mode->vsync_end;
82 timings->interlace = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
84 if (mode->flags & DRM_MODE_FLAG_PHSYNC)
85 timings->hsync_level = OMAPDSS_SIG_ACTIVE_HIGH;
87 timings->hsync_level = OMAPDSS_SIG_ACTIVE_LOW;
89 if (mode->flags & DRM_MODE_FLAG_PVSYNC)
90 timings->vsync_level = OMAPDSS_SIG_ACTIVE_HIGH;
92 timings->vsync_level = OMAPDSS_SIG_ACTIVE_LOW;
94 timings->data_pclk_edge = OMAPDSS_DRIVE_SIG_RISING_EDGE;
95 timings->de_level = OMAPDSS_SIG_ACTIVE_HIGH;
96 timings->sync_pclk_edge = OMAPDSS_DRIVE_SIG_OPPOSITE_EDGES;
99 static void omap_connector_dpms(struct drm_connector *connector, int mode)
101 struct omap_connector *omap_connector = to_omap_connector(connector);
102 struct omap_dss_device *dssdev = omap_connector->dssdev;
105 DBG("%s: %d", dssdev->name, mode);
107 old_dpms = connector->dpms;
109 /* from off to on, do from crtc to connector */
111 drm_helper_connector_dpms(connector, mode);
113 if (mode == DRM_MODE_DPMS_ON) {
114 /* store resume info for suspended displays */
115 switch (dssdev->state) {
116 case OMAP_DSS_DISPLAY_SUSPENDED:
117 dssdev->activate_after_resume = true;
119 case OMAP_DSS_DISPLAY_DISABLED: {
120 int ret = dssdev->driver->enable(dssdev);
122 DBG("%s: failed to enable: %d",
124 dssdev->driver->disable(dssdev);
135 /* from on to off, do from connector to crtc */
137 drm_helper_connector_dpms(connector, mode);
140 enum drm_connector_status omap_connector_detect(
141 struct drm_connector *connector, bool force)
143 struct omap_connector *omap_connector = to_omap_connector(connector);
144 struct omap_dss_device *dssdev = omap_connector->dssdev;
145 struct omap_dss_driver *dssdrv = dssdev->driver;
146 enum drm_connector_status ret;
148 if (dssdrv->detect) {
149 if (dssdrv->detect(dssdev))
150 ret = connector_status_connected;
152 ret = connector_status_disconnected;
154 ret = connector_status_unknown;
157 VERB("%s: %d (force=%d)", omap_connector->dssdev->name, ret, force);
162 static void omap_connector_destroy(struct drm_connector *connector)
164 struct omap_connector *omap_connector = to_omap_connector(connector);
165 struct omap_dss_device *dssdev = omap_connector->dssdev;
167 dssdev->driver->disable(dssdev);
169 DBG("%s", omap_connector->dssdev->name);
170 drm_sysfs_connector_remove(connector);
171 drm_connector_cleanup(connector);
172 kfree(omap_connector);
174 omap_dss_put_device(dssdev);
179 static int omap_connector_get_modes(struct drm_connector *connector)
181 struct omap_connector *omap_connector = to_omap_connector(connector);
182 struct omap_dss_device *dssdev = omap_connector->dssdev;
183 struct omap_dss_driver *dssdrv = dssdev->driver;
184 struct drm_device *dev = connector->dev;
187 DBG("%s", omap_connector->dssdev->name);
189 /* if display exposes EDID, then we parse that in the normal way to
190 * build table of supported modes.. otherwise (ie. fixed resolution
191 * LCD panels) we just return a single mode corresponding to the
192 * currently configured timings:
194 if (dssdrv->read_edid) {
195 void *edid = kzalloc(MAX_EDID, GFP_KERNEL);
197 if ((dssdrv->read_edid(dssdev, edid, MAX_EDID) > 0) &&
198 drm_edid_is_valid(edid)) {
199 drm_mode_connector_update_edid_property(
201 n = drm_add_edid_modes(connector, edid);
203 drm_mode_connector_update_edid_property(
208 struct drm_display_mode *mode = drm_mode_create(dev);
209 struct omap_video_timings timings = {0};
211 dssdrv->get_timings(dssdev, &timings);
213 copy_timings_omap_to_drm(mode, &timings);
215 mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
216 drm_mode_set_name(mode);
217 drm_mode_probed_add(connector, mode);
225 static int omap_connector_mode_valid(struct drm_connector *connector,
226 struct drm_display_mode *mode)
228 struct omap_connector *omap_connector = to_omap_connector(connector);
229 struct omap_dss_device *dssdev = omap_connector->dssdev;
230 struct omap_dss_driver *dssdrv = dssdev->driver;
231 struct omap_video_timings timings = {0};
232 struct drm_device *dev = connector->dev;
233 struct drm_display_mode *new_mode;
236 copy_timings_drm_to_omap(&timings, mode);
237 mode->vrefresh = drm_mode_vrefresh(mode);
239 if (!dssdrv->check_timings(dssdev, &timings)) {
240 /* check if vrefresh is still valid */
241 new_mode = drm_mode_duplicate(dev, mode);
242 new_mode->clock = timings.pixel_clock;
243 new_mode->vrefresh = 0;
244 if (mode->vrefresh == drm_mode_vrefresh(new_mode))
246 drm_mode_destroy(dev, new_mode);
249 DBG("connector: mode %s: "
250 "%d:\"%s\" %d %d %d %d %d %d %d %d %d %d 0x%x 0x%x",
251 (ret == MODE_OK) ? "valid" : "invalid",
252 mode->base.id, mode->name, mode->vrefresh, mode->clock,
253 mode->hdisplay, mode->hsync_start,
254 mode->hsync_end, mode->htotal,
255 mode->vdisplay, mode->vsync_start,
256 mode->vsync_end, mode->vtotal, mode->type, mode->flags);
261 struct drm_encoder *omap_connector_attached_encoder(
262 struct drm_connector *connector)
265 struct omap_connector *omap_connector = to_omap_connector(connector);
267 for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++) {
268 struct drm_mode_object *obj;
270 if (connector->encoder_ids[i] == 0)
273 obj = drm_mode_object_find(connector->dev,
274 connector->encoder_ids[i],
275 DRM_MODE_OBJECT_ENCODER);
278 struct drm_encoder *encoder = obj_to_encoder(obj);
279 struct omap_overlay_manager *mgr =
280 omap_encoder_get_manager(encoder);
281 DBG("%s: found %s", omap_connector->dssdev->name,
287 DBG("%s: no encoder", omap_connector->dssdev->name);
292 static const struct drm_connector_funcs omap_connector_funcs = {
293 .dpms = omap_connector_dpms,
294 .detect = omap_connector_detect,
295 .fill_modes = drm_helper_probe_single_connector_modes,
296 .destroy = omap_connector_destroy,
299 static const struct drm_connector_helper_funcs omap_connector_helper_funcs = {
300 .get_modes = omap_connector_get_modes,
301 .mode_valid = omap_connector_mode_valid,
302 .best_encoder = omap_connector_attached_encoder,
305 /* called from encoder when mode is set, to propagate settings to the dssdev */
306 void omap_connector_mode_set(struct drm_connector *connector,
307 struct drm_display_mode *mode)
309 struct drm_device *dev = connector->dev;
310 struct omap_connector *omap_connector = to_omap_connector(connector);
311 struct omap_dss_device *dssdev = omap_connector->dssdev;
312 struct omap_dss_driver *dssdrv = dssdev->driver;
313 struct omap_video_timings timings = {0};
315 copy_timings_drm_to_omap(&timings, mode);
317 DBG("%s: set mode: %d:\"%s\" %d %d %d %d %d %d %d %d %d %d 0x%x 0x%x",
318 omap_connector->dssdev->name,
319 mode->base.id, mode->name, mode->vrefresh, mode->clock,
320 mode->hdisplay, mode->hsync_start,
321 mode->hsync_end, mode->htotal,
322 mode->vdisplay, mode->vsync_start,
323 mode->vsync_end, mode->vtotal, mode->type, mode->flags);
325 if (dssdrv->check_timings(dssdev, &timings)) {
326 dev_err(dev->dev, "could not set timings\n");
330 dssdrv->set_timings(dssdev, &timings);
333 /* flush an area of the framebuffer (in case of manual update display that
334 * is not automatically flushed)
336 void omap_connector_flush(struct drm_connector *connector,
337 int x, int y, int w, int h)
339 struct omap_connector *omap_connector = to_omap_connector(connector);
341 /* TODO: enable when supported in dss */
342 VERB("%s: %d,%d, %dx%d", omap_connector->dssdev->name, x, y, w, h);
345 /* initialize connector */
346 struct drm_connector *omap_connector_init(struct drm_device *dev,
347 int connector_type, struct omap_dss_device *dssdev)
349 struct drm_connector *connector = NULL;
350 struct omap_connector *omap_connector;
352 DBG("%s", dssdev->name);
354 omap_dss_get_device(dssdev);
356 omap_connector = kzalloc(sizeof(struct omap_connector), GFP_KERNEL);
357 if (!omap_connector) {
358 dev_err(dev->dev, "could not allocate connector\n");
362 omap_connector->dssdev = dssdev;
363 connector = &omap_connector->base;
365 drm_connector_init(dev, connector, &omap_connector_funcs,
367 drm_connector_helper_add(connector, &omap_connector_helper_funcs);
369 #if 0 /* enable when dss2 supports hotplug */
370 if (dssdev->caps & OMAP_DSS_DISPLAY_CAP_HPD)
371 connector->polled = 0;
374 connector->polled = DRM_CONNECTOR_POLL_CONNECT |
375 DRM_CONNECTOR_POLL_DISCONNECT;
377 connector->interlace_allowed = 1;
378 connector->doublescan_allowed = 0;
380 drm_sysfs_connector_add(connector);
386 omap_connector_destroy(connector);