blob: 9085db634092ac72483dde72b8a00bf4eced8f28 [file] [log] [blame]
Dave Airlief453ba02008-11-07 14:05:41 -08001/*
2 * Copyright (c) 2006-2008 Intel Corporation
3 * Copyright (c) 2007 Dave Airlie <airlied@linux.ie>
4 *
5 * DRM core CRTC related functions
6 *
7 * Permission to use, copy, modify, distribute, and sell this software and its
8 * documentation for any purpose is hereby granted without fee, provided that
9 * the above copyright notice appear in all copies and that both that copyright
10 * notice and this permission notice appear in supporting documentation, and
11 * that the name of the copyright holders not be used in advertising or
12 * publicity pertaining to distribution of the software without specific,
13 * written prior permission. The copyright holders make no representations
14 * about the suitability of this software for any purpose. It is provided "as
15 * is" without express or implied warranty.
16 *
17 * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
18 * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
19 * EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY SPECIAL, INDIRECT OR
20 * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
21 * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
22 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE
23 * OF THIS SOFTWARE.
24 *
25 * Authors:
26 * Keith Packard
27 * Eric Anholt <eric@anholt.net>
28 * Dave Airlie <airlied@linux.ie>
29 * Jesse Barnes <jesse.barnes@intel.com>
30 */
31
Paul Gortmaker2d1a8a42011-08-30 18:16:33 -040032#include <linux/export.h>
Paul Gortmaker0603ba12011-08-31 11:29:09 -040033#include <linux/moduleparam.h>
Paul Gortmaker2d1a8a42011-08-30 18:16:33 -040034
David Howells760285e2012-10-02 18:01:07 +010035#include <drm/drmP.h>
36#include <drm/drm_crtc.h>
37#include <drm/drm_fourcc.h>
38#include <drm/drm_crtc_helper.h>
39#include <drm/drm_fb_helper.h>
40#include <drm/drm_edid.h>
Dave Airlief453ba02008-11-07 14:05:41 -080041
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +010042/**
43 * drm_helper_move_panel_connectors_to_head() - move panels to the front in the
44 * connector list
45 * @dev: drm device to operate on
46 *
47 * Some userspace presumes that the first connected connector is the main
48 * display, where it's supposed to display e.g. the login screen. For
49 * laptops, this should be the main panel. Use this function to sort all
50 * (eDP/LVDS) panels to the front of the connector list, instead of
51 * painstakingly trying to initialize them in the right order.
52 */
Daniel Vettercfc1a062012-10-27 15:52:04 +020053void drm_helper_move_panel_connectors_to_head(struct drm_device *dev)
54{
55 struct drm_connector *connector, *tmp;
56 struct list_head panel_list;
57
58 INIT_LIST_HEAD(&panel_list);
59
60 list_for_each_entry_safe(connector, tmp,
61 &dev->mode_config.connector_list, head) {
62 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS ||
63 connector->connector_type == DRM_MODE_CONNECTOR_eDP)
64 list_move_tail(&connector->head, &panel_list);
65 }
66
67 list_splice(&panel_list, &dev->mode_config.connector_list);
68}
69EXPORT_SYMBOL(drm_helper_move_panel_connectors_to_head);
70
Chris Wilsone58f6372010-08-20 09:13:36 +010071static bool drm_kms_helper_poll = true;
72module_param_named(poll, drm_kms_helper_poll, bool, 0600);
73
yakui_zhao67149772009-04-02 11:52:12 +080074static void drm_mode_validate_flag(struct drm_connector *connector,
75 int flags)
76{
Sascha Hauera1178ca2012-02-01 11:38:30 +010077 struct drm_display_mode *mode;
yakui_zhao67149772009-04-02 11:52:12 +080078
79 if (flags == (DRM_MODE_FLAG_DBLSCAN | DRM_MODE_FLAG_INTERLACE))
80 return;
81
Sascha Hauera1178ca2012-02-01 11:38:30 +010082 list_for_each_entry(mode, &connector->modes, head) {
yakui_zhao67149772009-04-02 11:52:12 +080083 if ((mode->flags & DRM_MODE_FLAG_INTERLACE) &&
84 !(flags & DRM_MODE_FLAG_INTERLACE))
85 mode->status = MODE_NO_INTERLACE;
86 if ((mode->flags & DRM_MODE_FLAG_DBLSCAN) &&
87 !(flags & DRM_MODE_FLAG_DBLSCAN))
88 mode->status = MODE_NO_DBLESCAN;
89 }
90
91 return;
92}
93
Dave Airlief453ba02008-11-07 14:05:41 -080094/**
Dave Airlie38651672010-03-30 05:34:13 +000095 * drm_helper_probe_single_connector_modes - get complete set of display modes
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +010096 * @connector: connector to probe
Dave Airlief453ba02008-11-07 14:05:41 -080097 * @maxX: max width for modes
98 * @maxY: max height for modes
99 *
100 * LOCKING:
101 * Caller must hold mode config lock.
102 *
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100103 * Based on the helper callbacks implemented by @connector try to detect all
104 * valid modes. Modes will first be added to the connector's probed_modes list,
105 * then culled (based on validity and the @maxX, @maxY parameters) and put into
106 * the normal modes list.
Dave Airlief453ba02008-11-07 14:05:41 -0800107 *
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100108 * Intended to be use as a generic implementation of the ->probe() @connector
109 * callback for drivers that use the crtc helpers for output mode filtering and
110 * detection.
Jesse Barnes40a518d2009-01-12 12:05:32 -0800111 *
112 * RETURNS:
113 * Number of modes found on @connector.
Dave Airlief453ba02008-11-07 14:05:41 -0800114 */
Jesse Barnes40a518d2009-01-12 12:05:32 -0800115int drm_helper_probe_single_connector_modes(struct drm_connector *connector,
116 uint32_t maxX, uint32_t maxY)
Dave Airlief453ba02008-11-07 14:05:41 -0800117{
118 struct drm_device *dev = connector->dev;
Sascha Hauera1178ca2012-02-01 11:38:30 +0100119 struct drm_display_mode *mode;
Dave Airlief453ba02008-11-07 14:05:41 -0800120 struct drm_connector_helper_funcs *connector_funcs =
121 connector->helper_private;
Jesse Barnes40a518d2009-01-12 12:05:32 -0800122 int count = 0;
yakui_zhao67149772009-04-02 11:52:12 +0800123 int mode_flags = 0;
Damien Lespiauebbd97a2013-05-08 17:03:32 +0100124 bool verbose_prune = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800125
Jerome Glisse94401062010-07-15 15:43:25 -0400126 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id,
127 drm_get_connector_name(connector));
Dave Airlief453ba02008-11-07 14:05:41 -0800128 /* set all modes to the unverified state */
Sascha Hauera1178ca2012-02-01 11:38:30 +0100129 list_for_each_entry(mode, &connector->modes, head)
Dave Airlief453ba02008-11-07 14:05:41 -0800130 mode->status = MODE_UNVERIFIED;
131
Dave Airlied50ba252009-09-23 14:44:08 +1000132 if (connector->force) {
133 if (connector->force == DRM_FORCE_ON)
134 connector->status = connector_status_connected;
135 else
136 connector->status = connector_status_disconnected;
137 if (connector->funcs->force)
138 connector->funcs->force(connector);
Chris Wilsone58f6372010-08-20 09:13:36 +0100139 } else {
Chris Wilson930a9e22010-09-14 11:07:23 +0100140 connector->status = connector->funcs->detect(connector, true);
Chris Wilsone58f6372010-08-20 09:13:36 +0100141 }
Dave Airlief453ba02008-11-07 14:05:41 -0800142
Daniel Vetter905bc9f2012-10-23 18:23:36 +0000143 /* Re-enable polling in case the global poll config changed. */
144 if (drm_kms_helper_poll != dev->mode_config.poll_running)
145 drm_kms_helper_poll_enable(dev);
146
147 dev->mode_config.poll_running = drm_kms_helper_poll;
148
Dave Airlief453ba02008-11-07 14:05:41 -0800149 if (connector->status == connector_status_disconnected) {
Jerome Glisse94401062010-07-15 15:43:25 -0400150 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] disconnected\n",
151 connector->base.id, drm_get_connector_name(connector));
Zhao Yakui72539832010-03-04 08:25:55 +0000152 drm_mode_connector_update_edid_property(connector, NULL);
Damien Lespiauebbd97a2013-05-08 17:03:32 +0100153 verbose_prune = false;
Adam Jackson620f3782009-09-08 11:51:46 +1000154 goto prune;
Dave Airlief453ba02008-11-07 14:05:41 -0800155 }
156
Carsten Emdeda0df922012-03-18 22:37:33 +0100157#ifdef CONFIG_DRM_LOAD_EDID_FIRMWARE
158 count = drm_load_edid_firmware(connector);
159 if (count == 0)
160#endif
161 count = (*connector_funcs->get_modes)(connector);
162
Chris Wilsonc7ef35a2010-09-05 16:55:25 +0100163 if (count == 0 && connector->status == connector_status_connected)
Adam Jackson9632b412009-11-23 14:23:07 -0500164 count = drm_add_modes_noedid(connector, 1024, 768);
Chris Wilsonc7ef35a2010-09-05 16:55:25 +0100165 if (count == 0)
166 goto prune;
Dave Airlief453ba02008-11-07 14:05:41 -0800167
Jesse Barnes40a518d2009-01-12 12:05:32 -0800168 drm_mode_connector_list_update(connector);
Dave Airlief453ba02008-11-07 14:05:41 -0800169
170 if (maxX && maxY)
171 drm_mode_validate_size(dev, &connector->modes, maxX,
172 maxY, 0);
yakui_zhao67149772009-04-02 11:52:12 +0800173
174 if (connector->interlace_allowed)
175 mode_flags |= DRM_MODE_FLAG_INTERLACE;
176 if (connector->doublescan_allowed)
177 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
178 drm_mode_validate_flag(connector, mode_flags);
179
Sascha Hauera1178ca2012-02-01 11:38:30 +0100180 list_for_each_entry(mode, &connector->modes, head) {
Dave Airlief453ba02008-11-07 14:05:41 -0800181 if (mode->status == MODE_OK)
182 mode->status = connector_funcs->mode_valid(connector,
183 mode);
184 }
185
Adam Jackson620f3782009-09-08 11:51:46 +1000186prune:
Damien Lespiauebbd97a2013-05-08 17:03:32 +0100187 drm_mode_prune_invalid(dev, &connector->modes, verbose_prune);
Dave Airlief453ba02008-11-07 14:05:41 -0800188
Jesse Barnes40a518d2009-01-12 12:05:32 -0800189 if (list_empty(&connector->modes))
190 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800191
192 drm_mode_sort(&connector->modes);
193
Jerome Glisse94401062010-07-15 15:43:25 -0400194 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector->base.id,
195 drm_get_connector_name(connector));
Sascha Hauera1178ca2012-02-01 11:38:30 +0100196 list_for_each_entry(mode, &connector->modes, head) {
Dave Airlief453ba02008-11-07 14:05:41 -0800197 mode->vrefresh = drm_mode_vrefresh(mode);
198
199 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
200 drm_mode_debug_printmodeline(mode);
201 }
Jesse Barnes40a518d2009-01-12 12:05:32 -0800202
203 return count;
Dave Airlief453ba02008-11-07 14:05:41 -0800204}
205EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
206
Dave Airlief453ba02008-11-07 14:05:41 -0800207/**
Keith Packardc9fb15f2009-05-30 20:42:28 -0700208 * drm_helper_encoder_in_use - check if a given encoder is in use
209 * @encoder: encoder to check
210 *
211 * LOCKING:
212 * Caller must hold mode config lock.
213 *
214 * Walk @encoders's DRM device's mode_config and see if it's in use.
215 *
216 * RETURNS:
217 * True if @encoder is part of the mode_config, false otherwise.
218 */
219bool drm_helper_encoder_in_use(struct drm_encoder *encoder)
220{
221 struct drm_connector *connector;
222 struct drm_device *dev = encoder->dev;
223 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
224 if (connector->encoder == encoder)
225 return true;
226 return false;
227}
228EXPORT_SYMBOL(drm_helper_encoder_in_use);
229
230/**
Dave Airlief453ba02008-11-07 14:05:41 -0800231 * drm_helper_crtc_in_use - check if a given CRTC is in a mode_config
232 * @crtc: CRTC to check
233 *
234 * LOCKING:
235 * Caller must hold mode config lock.
236 *
237 * Walk @crtc's DRM device's mode_config and see if it's in use.
238 *
239 * RETURNS:
240 * True if @crtc is part of the mode_config, false otherwise.
241 */
242bool drm_helper_crtc_in_use(struct drm_crtc *crtc)
243{
244 struct drm_encoder *encoder;
245 struct drm_device *dev = crtc->dev;
246 /* FIXME: Locking around list access? */
247 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
Keith Packardc9fb15f2009-05-30 20:42:28 -0700248 if (encoder->crtc == crtc && drm_helper_encoder_in_use(encoder))
Dave Airlief453ba02008-11-07 14:05:41 -0800249 return true;
250 return false;
251}
252EXPORT_SYMBOL(drm_helper_crtc_in_use);
253
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000254static void
255drm_encoder_disable(struct drm_encoder *encoder)
256{
257 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
258
259 if (encoder_funcs->disable)
260 (*encoder_funcs->disable)(encoder);
261 else
262 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
263}
264
Dave Airlief453ba02008-11-07 14:05:41 -0800265/**
David John89347bb2009-12-31 12:00:46 +0530266 * drm_helper_disable_unused_functions - disable unused objects
Dave Airlief453ba02008-11-07 14:05:41 -0800267 * @dev: DRM device
268 *
269 * LOCKING:
270 * Caller must hold mode config lock.
271 *
272 * If an connector or CRTC isn't part of @dev's mode_config, it can be disabled
273 * by calling its dpms function, which should power it off.
274 */
275void drm_helper_disable_unused_functions(struct drm_device *dev)
276{
277 struct drm_encoder *encoder;
Dave Airliea3a05442009-08-31 15:16:30 +1000278 struct drm_connector *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800279 struct drm_crtc *crtc;
280
Dave Airliea3a05442009-08-31 15:16:30 +1000281 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
282 if (!connector->encoder)
283 continue;
284 if (connector->status == connector_status_disconnected)
285 connector->encoder = NULL;
286 }
287
Dave Airlief453ba02008-11-07 14:05:41 -0800288 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
Dave Airlie929710212010-12-21 12:47:56 +1000289 if (!drm_helper_encoder_in_use(encoder)) {
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000290 drm_encoder_disable(encoder);
Dave Airlie9c552dd2009-09-02 14:00:11 +1000291 /* disconnector encoder from any connector */
292 encoder->crtc = NULL;
Dave Airliea3a05442009-08-31 15:16:30 +1000293 }
Dave Airlief453ba02008-11-07 14:05:41 -0800294 }
295
296 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
297 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
298 crtc->enabled = drm_helper_crtc_in_use(crtc);
299 if (!crtc->enabled) {
Alex Deucher5c8d7172010-06-11 17:04:35 -0400300 if (crtc_funcs->disable)
301 (*crtc_funcs->disable)(crtc);
302 else
303 (*crtc_funcs->dpms)(crtc, DRM_MODE_DPMS_OFF);
Dave Airlief453ba02008-11-07 14:05:41 -0800304 crtc->fb = NULL;
305 }
306 }
307}
308EXPORT_SYMBOL(drm_helper_disable_unused_functions);
309
Jesse Barnes7bec7562009-02-23 16:09:34 -0800310/**
311 * drm_encoder_crtc_ok - can a given crtc drive a given encoder?
312 * @encoder: encoder to test
313 * @crtc: crtc to test
314 *
315 * Return false if @encoder can't be driven by @crtc, true otherwise.
316 */
317static bool drm_encoder_crtc_ok(struct drm_encoder *encoder,
318 struct drm_crtc *crtc)
319{
320 struct drm_device *dev;
321 struct drm_crtc *tmp;
322 int crtc_mask = 1;
323
Joe Perchesfce7d612010-10-30 21:08:30 +0000324 WARN(!crtc, "checking null crtc?\n");
Jesse Barnes7bec7562009-02-23 16:09:34 -0800325
326 dev = crtc->dev;
327
328 list_for_each_entry(tmp, &dev->mode_config.crtc_list, head) {
329 if (tmp == crtc)
330 break;
331 crtc_mask <<= 1;
332 }
333
334 if (encoder->possible_crtcs & crtc_mask)
335 return true;
336 return false;
337}
338
339/*
340 * Check the CRTC we're going to map each output to vs. its current
341 * CRTC. If they don't match, we have to disable the output and the CRTC
342 * since the driver will have to re-route things.
343 */
344static void
345drm_crtc_prepare_encoders(struct drm_device *dev)
346{
347 struct drm_encoder_helper_funcs *encoder_funcs;
348 struct drm_encoder *encoder;
349
350 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
351 encoder_funcs = encoder->helper_private;
352 /* Disable unused encoders */
353 if (encoder->crtc == NULL)
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000354 drm_encoder_disable(encoder);
Jesse Barnes7bec7562009-02-23 16:09:34 -0800355 /* Disable encoders whose CRTC is about to change */
356 if (encoder_funcs->get_crtc &&
357 encoder->crtc != (*encoder_funcs->get_crtc)(encoder))
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000358 drm_encoder_disable(encoder);
Jesse Barnes7bec7562009-02-23 16:09:34 -0800359 }
360}
361
Dave Airlief453ba02008-11-07 14:05:41 -0800362/**
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100363 * drm_crtc_helper_set_mode - internal helper to set a mode
Dave Airlief453ba02008-11-07 14:05:41 -0800364 * @crtc: CRTC to program
365 * @mode: mode to use
Alex Deucher4c9287c2012-11-09 17:26:32 +0000366 * @x: horizontal offset into the surface
367 * @y: vertical offset into the surface
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100368 * @old_fb: old framebuffer, for cleanup
Dave Airlief453ba02008-11-07 14:05:41 -0800369 *
370 * LOCKING:
371 * Caller must hold mode config lock.
372 *
373 * Try to set @mode on @crtc. Give @crtc and its associated connectors a chance
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100374 * to fixup or reject the mode prior to trying to set it. This is an internal
375 * helper that drivers could e.g. use to update properties that require the
376 * entire output pipe to be disabled and re-enabled in a new configuration. For
377 * example for changing whether audio is enabled on a hdmi link or for changing
378 * panel fitter or dither attributes. It is also called by the
379 * drm_crtc_helper_set_config() helper function to drive the mode setting
380 * sequence.
Dave Airlief453ba02008-11-07 14:05:41 -0800381 *
382 * RETURNS:
383 * True if the mode was set successfully, or false otherwise.
384 */
385bool drm_crtc_helper_set_mode(struct drm_crtc *crtc,
386 struct drm_display_mode *mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500387 int x, int y,
388 struct drm_framebuffer *old_fb)
Dave Airlief453ba02008-11-07 14:05:41 -0800389{
390 struct drm_device *dev = crtc->dev;
Mario Kleiner27641c32010-10-23 04:20:23 +0200391 struct drm_display_mode *adjusted_mode, saved_mode, saved_hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800392 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
393 struct drm_encoder_helper_funcs *encoder_funcs;
394 int saved_x, saved_y;
395 struct drm_encoder *encoder;
396 bool ret = true;
397
Dave Airlief453ba02008-11-07 14:05:41 -0800398 crtc->enabled = drm_helper_crtc_in_use(crtc);
Dave Airlief453ba02008-11-07 14:05:41 -0800399 if (!crtc->enabled)
400 return true;
401
Chris Wilson021a8452011-01-28 11:31:56 +0000402 adjusted_mode = drm_mode_duplicate(dev, mode);
Ville Syrjälä6bfc56a2012-03-13 12:35:48 +0200403 if (!adjusted_mode)
404 return false;
Chris Wilson021a8452011-01-28 11:31:56 +0000405
Mario Kleiner27641c32010-10-23 04:20:23 +0200406 saved_hwmode = crtc->hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800407 saved_mode = crtc->mode;
408 saved_x = crtc->x;
409 saved_y = crtc->y;
410
411 /* Update crtc values up front so the driver can rely on them for mode
412 * setting.
413 */
414 crtc->mode = *mode;
415 crtc->x = x;
416 crtc->y = y;
417
Dave Airlief453ba02008-11-07 14:05:41 -0800418 /* Pass our mode to the connectors and the CRTC to give them a chance to
419 * adjust it according to limitations or connector properties, and also
420 * a chance to reject the mode entirely.
421 */
422 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
423
424 if (encoder->crtc != crtc)
425 continue;
426 encoder_funcs = encoder->helper_private;
427 if (!(ret = encoder_funcs->mode_fixup(encoder, mode,
428 adjusted_mode))) {
Adam Jackson836e53d2011-10-10 16:21:27 -0400429 DRM_DEBUG_KMS("Encoder fixup failed\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800430 goto done;
431 }
432 }
433
434 if (!(ret = crtc_funcs->mode_fixup(crtc, mode, adjusted_mode))) {
Adam Jackson836e53d2011-10-10 16:21:27 -0400435 DRM_DEBUG_KMS("CRTC fixup failed\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800436 goto done;
437 }
Jerome Glisse94401062010-07-15 15:43:25 -0400438 DRM_DEBUG_KMS("[CRTC:%d]\n", crtc->base.id);
Dave Airlief453ba02008-11-07 14:05:41 -0800439
440 /* Prepare the encoders and CRTCs before setting the mode. */
441 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
442
443 if (encoder->crtc != crtc)
444 continue;
445 encoder_funcs = encoder->helper_private;
446 /* Disable the encoders as the first thing we do. */
447 encoder_funcs->prepare(encoder);
448 }
449
Jesse Barnes7bec7562009-02-23 16:09:34 -0800450 drm_crtc_prepare_encoders(dev);
451
Dave Airlief453ba02008-11-07 14:05:41 -0800452 crtc_funcs->prepare(crtc);
453
454 /* Set up the DPLL and any encoders state that needs to adjust or depend
455 * on the DPLL.
456 */
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000457 ret = !crtc_funcs->mode_set(crtc, mode, adjusted_mode, x, y, old_fb);
458 if (!ret)
459 goto done;
Dave Airlief453ba02008-11-07 14:05:41 -0800460
461 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
462
463 if (encoder->crtc != crtc)
464 continue;
465
Jerome Glisse94401062010-07-15 15:43:25 -0400466 DRM_DEBUG_KMS("[ENCODER:%d:%s] set [MODE:%d:%s]\n",
467 encoder->base.id, drm_get_encoder_name(encoder),
468 mode->base.id, mode->name);
Dave Airlief453ba02008-11-07 14:05:41 -0800469 encoder_funcs = encoder->helper_private;
470 encoder_funcs->mode_set(encoder, mode, adjusted_mode);
471 }
472
473 /* Now enable the clocks, plane, pipe, and connectors that we set up. */
474 crtc_funcs->commit(crtc);
475
476 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
477
478 if (encoder->crtc != crtc)
479 continue;
480
481 encoder_funcs = encoder->helper_private;
482 encoder_funcs->commit(encoder);
483
484 }
485
Mario Kleiner27641c32010-10-23 04:20:23 +0200486 /* Store real post-adjustment hardware mode. */
487 crtc->hwmode = *adjusted_mode;
488
489 /* Calculate and store various constants which
490 * are later needed by vblank and swap-completion
491 * timestamping. They are derived from true hwmode.
492 */
493 drm_calc_timestamping_constants(crtc);
494
Dave Airlief453ba02008-11-07 14:05:41 -0800495 /* FIXME: add subpixel order */
496done:
Chris Wilson021a8452011-01-28 11:31:56 +0000497 drm_mode_destroy(dev, adjusted_mode);
Dave Airlief453ba02008-11-07 14:05:41 -0800498 if (!ret) {
Mario Kleiner27641c32010-10-23 04:20:23 +0200499 crtc->hwmode = saved_hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800500 crtc->mode = saved_mode;
501 crtc->x = saved_x;
502 crtc->y = saved_y;
503 }
504
505 return ret;
506}
507EXPORT_SYMBOL(drm_crtc_helper_set_mode);
508
509
Chris Wilson6eebd6b2011-11-28 21:10:05 +0000510static int
511drm_crtc_helper_disable(struct drm_crtc *crtc)
512{
513 struct drm_device *dev = crtc->dev;
514 struct drm_connector *connector;
515 struct drm_encoder *encoder;
516
517 /* Decouple all encoders and their attached connectors from this crtc */
518 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
519 if (encoder->crtc != crtc)
520 continue;
521
522 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
523 if (connector->encoder != encoder)
524 continue;
525
526 connector->encoder = NULL;
527 }
528 }
529
530 drm_helper_disable_unused_functions(dev);
531 return 0;
532}
533
Dave Airlief453ba02008-11-07 14:05:41 -0800534/**
535 * drm_crtc_helper_set_config - set a new config from userspace
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100536 * @set: mode set configuration
Dave Airlief453ba02008-11-07 14:05:41 -0800537 *
538 * LOCKING:
539 * Caller must hold mode config lock.
540 *
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100541 * Setup a new configuration, provided by the upper layers (either an ioctl call
542 * from userspace or internally e.g. from the fbdev suppport code) in @set, and
543 * enable it. This is the main helper functions for drivers that implement
544 * kernel mode setting with the crtc helper functions and the assorted
545 * ->prepare(), ->modeset() and ->commit() helper callbacks.
Dave Airlief453ba02008-11-07 14:05:41 -0800546 *
547 * RETURNS:
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100548 * Returns 0 on success, -ERRNO on failure.
Dave Airlief453ba02008-11-07 14:05:41 -0800549 */
550int drm_crtc_helper_set_config(struct drm_mode_set *set)
551{
552 struct drm_device *dev;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200553 struct drm_crtc *save_crtcs, *new_crtc, *crtc;
554 struct drm_encoder *save_encoders, *new_encoder, *encoder;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800555 struct drm_framebuffer *old_fb = NULL;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100556 bool mode_changed = false; /* if true do a full mode set */
557 bool fb_changed = false; /* if true and !mode_changed just do a flip */
Maarten Maathuise67aae72009-08-27 10:18:29 +0200558 struct drm_connector *save_connectors, *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800559 int count = 0, ro, fail = 0;
560 struct drm_crtc_helper_funcs *crtc_funcs;
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800561 struct drm_mode_set save_set;
Laurent Pinchart4a1b0712012-05-17 13:27:21 +0200562 int ret;
Keith Packardbf9dc102010-11-26 10:45:58 -0800563 int i;
Dave Airlief453ba02008-11-07 14:05:41 -0800564
Zhao Yakui58367ed2009-07-20 13:48:07 +0800565 DRM_DEBUG_KMS("\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800566
567 if (!set)
568 return -EINVAL;
569
570 if (!set->crtc)
571 return -EINVAL;
572
573 if (!set->crtc->helper_private)
574 return -EINVAL;
575
576 crtc_funcs = set->crtc->helper_private;
577
Chris Wilsonede3ff52011-01-31 11:16:33 +0000578 if (!set->mode)
579 set->fb = NULL;
580
Jerome Glisse94401062010-07-15 15:43:25 -0400581 if (set->fb) {
582 DRM_DEBUG_KMS("[CRTC:%d] [FB:%d] #connectors=%d (x y) (%i %i)\n",
583 set->crtc->base.id, set->fb->base.id,
584 (int)set->num_connectors, set->x, set->y);
585 } else {
Chris Wilsonede3ff52011-01-31 11:16:33 +0000586 DRM_DEBUG_KMS("[CRTC:%d] [NOFB]\n", set->crtc->base.id);
Chris Wilson6eebd6b2011-11-28 21:10:05 +0000587 return drm_crtc_helper_disable(set->crtc);
Jerome Glisse94401062010-07-15 15:43:25 -0400588 }
Dave Airlief453ba02008-11-07 14:05:41 -0800589
590 dev = set->crtc->dev;
591
Maarten Maathuise67aae72009-08-27 10:18:29 +0200592 /* Allocate space for the backup of all (non-pointer) crtc, encoder and
593 * connector data. */
594 save_crtcs = kzalloc(dev->mode_config.num_crtc *
595 sizeof(struct drm_crtc), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800596 if (!save_crtcs)
597 return -ENOMEM;
598
Maarten Maathuise67aae72009-08-27 10:18:29 +0200599 save_encoders = kzalloc(dev->mode_config.num_encoder *
600 sizeof(struct drm_encoder), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800601 if (!save_encoders) {
602 kfree(save_crtcs);
603 return -ENOMEM;
604 }
605
Maarten Maathuise67aae72009-08-27 10:18:29 +0200606 save_connectors = kzalloc(dev->mode_config.num_connector *
607 sizeof(struct drm_connector), GFP_KERNEL);
608 if (!save_connectors) {
609 kfree(save_crtcs);
610 kfree(save_encoders);
611 return -ENOMEM;
612 }
613
614 /* Copy data. Note that driver private data is not affected.
615 * Should anything bad happen only the expected state is
616 * restored, not the drivers personal bookkeeping.
617 */
618 count = 0;
619 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
620 save_crtcs[count++] = *crtc;
621 }
622
623 count = 0;
624 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
625 save_encoders[count++] = *encoder;
626 }
627
628 count = 0;
629 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
630 save_connectors[count++] = *connector;
631 }
632
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800633 save_set.crtc = set->crtc;
634 save_set.mode = &set->crtc->mode;
635 save_set.x = set->crtc->x;
636 save_set.y = set->crtc->y;
637 save_set.fb = set->crtc->fb;
638
Dave Airlief453ba02008-11-07 14:05:41 -0800639 /* We should be able to check here if the fb has the same properties
640 * and then just flip_or_move it */
641 if (set->crtc->fb != set->fb) {
Jesse Barnes712531b2009-01-09 13:56:14 -0800642 /* If we have no fb then treat it as a full mode set */
Jesse Barnes7bec7562009-02-23 16:09:34 -0800643 if (set->crtc->fb == NULL) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800644 DRM_DEBUG_KMS("crtc has no fb, full mode set\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800645 mode_changed = true;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100646 } else if (set->fb == NULL) {
647 mode_changed = true;
Jesse Barnes46e48452011-06-24 12:19:26 -0700648 } else if (set->fb->depth != set->crtc->fb->depth) {
649 mode_changed = true;
650 } else if (set->fb->bits_per_pixel !=
651 set->crtc->fb->bits_per_pixel) {
652 mode_changed = true;
Laurent Pinchartce83adf2013-04-22 01:38:47 +0200653 } else if (set->fb->pixel_format !=
654 set->crtc->fb->pixel_format) {
655 mode_changed = true;
Dave Airlie8dff4742010-02-11 14:28:58 +1000656 } else
Jesse Barnes712531b2009-01-09 13:56:14 -0800657 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800658 }
659
660 if (set->x != set->crtc->x || set->y != set->crtc->y)
Jesse Barnes712531b2009-01-09 13:56:14 -0800661 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800662
663 if (set->mode && !drm_mode_equal(set->mode, &set->crtc->mode)) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800664 DRM_DEBUG_KMS("modes are different, full mode set\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800665 drm_mode_debug_printmodeline(&set->crtc->mode);
666 drm_mode_debug_printmodeline(set->mode);
Jesse Barnes712531b2009-01-09 13:56:14 -0800667 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800668 }
669
670 /* a) traverse passed in connector list and get encoders for them */
671 count = 0;
672 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
673 struct drm_connector_helper_funcs *connector_funcs =
674 connector->helper_private;
Dave Airlief453ba02008-11-07 14:05:41 -0800675 new_encoder = connector->encoder;
676 for (ro = 0; ro < set->num_connectors; ro++) {
677 if (set->connectors[ro] == connector) {
678 new_encoder = connector_funcs->best_encoder(connector);
679 /* if we can't get an encoder for a connector
680 we are setting now - then fail */
681 if (new_encoder == NULL)
682 /* don't break so fail path works correct */
683 fail = 1;
684 break;
685 }
686 }
687
688 if (new_encoder != connector->encoder) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800689 DRM_DEBUG_KMS("encoder changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800690 mode_changed = true;
Maarten Maathuisff846ab2009-08-19 00:56:45 +0200691 /* If the encoder is reused for another connector, then
692 * the appropriate crtc will be set later.
693 */
Maarten Maathuisff6fdbe2009-09-01 03:39:04 +0200694 if (connector->encoder)
695 connector->encoder->crtc = NULL;
Dave Airlief453ba02008-11-07 14:05:41 -0800696 connector->encoder = new_encoder;
697 }
698 }
699
700 if (fail) {
701 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200702 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800703 }
704
705 count = 0;
706 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
707 if (!connector->encoder)
708 continue;
709
Dave Airlief453ba02008-11-07 14:05:41 -0800710 if (connector->encoder->crtc == set->crtc)
711 new_crtc = NULL;
712 else
713 new_crtc = connector->encoder->crtc;
714
715 for (ro = 0; ro < set->num_connectors; ro++) {
716 if (set->connectors[ro] == connector)
717 new_crtc = set->crtc;
718 }
Jesse Barnes7bec7562009-02-23 16:09:34 -0800719
720 /* Make sure the new CRTC will work with the encoder */
721 if (new_crtc &&
722 !drm_encoder_crtc_ok(connector->encoder, new_crtc)) {
723 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200724 goto fail;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800725 }
Dave Airlief453ba02008-11-07 14:05:41 -0800726 if (new_crtc != connector->encoder->crtc) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800727 DRM_DEBUG_KMS("crtc changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800728 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800729 connector->encoder->crtc = new_crtc;
730 }
Jerome Glisse94401062010-07-15 15:43:25 -0400731 if (new_crtc) {
732 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [CRTC:%d]\n",
733 connector->base.id, drm_get_connector_name(connector),
734 new_crtc->base.id);
735 } else {
736 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [NOCRTC]\n",
737 connector->base.id, drm_get_connector_name(connector));
738 }
Dave Airlief453ba02008-11-07 14:05:41 -0800739 }
740
741 /* mode_set_base is not a required function */
Jesse Barnes712531b2009-01-09 13:56:14 -0800742 if (fb_changed && !crtc_funcs->mode_set_base)
743 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800744
Jesse Barnes712531b2009-01-09 13:56:14 -0800745 if (mode_changed) {
Chris Wilson9334ef72011-01-28 11:53:03 +0000746 set->crtc->enabled = drm_helper_crtc_in_use(set->crtc);
747 if (set->crtc->enabled) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800748 DRM_DEBUG_KMS("attempting to set mode from"
749 " userspace\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800750 drm_mode_debug_printmodeline(set->mode);
Chris Wilson356ad3c2010-09-09 09:41:32 +0100751 old_fb = set->crtc->fb;
752 set->crtc->fb = set->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800753 if (!drm_crtc_helper_set_mode(set->crtc, set->mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500754 set->x, set->y,
755 old_fb)) {
Jerome Glisse94401062010-07-15 15:43:25 -0400756 DRM_ERROR("failed to set mode on [CRTC:%d]\n",
757 set->crtc->base.id);
Chris Wilson0ba41e42011-01-08 15:10:41 +0000758 set->crtc->fb = old_fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800759 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200760 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800761 }
Keith Packard811aaa52011-02-03 16:57:28 -0800762 DRM_DEBUG_KMS("Setting connector DPMS state to on\n");
763 for (i = 0; i < set->num_connectors; i++) {
764 DRM_DEBUG_KMS("\t[CONNECTOR:%d:%s] set DPMS on\n", set->connectors[i]->base.id,
765 drm_get_connector_name(set->connectors[i]));
Rob Clarkc7548832011-12-15 14:53:24 -0600766 set->connectors[i]->funcs->dpms(set->connectors[i], DRM_MODE_DPMS_ON);
Keith Packard811aaa52011-02-03 16:57:28 -0800767 }
Dave Airlief453ba02008-11-07 14:05:41 -0800768 }
769 drm_helper_disable_unused_functions(dev);
Jesse Barnes712531b2009-01-09 13:56:14 -0800770 } else if (fb_changed) {
Ben Skeggs9b1596a2009-09-18 10:43:52 +1000771 set->crtc->x = set->x;
772 set->crtc->y = set->y;
773
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500774 old_fb = set->crtc->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800775 if (set->crtc->fb != set->fb)
776 set->crtc->fb = set->fb;
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000777 ret = crtc_funcs->mode_set_base(set->crtc,
778 set->x, set->y, old_fb);
Chris Wilson0ba41e42011-01-08 15:10:41 +0000779 if (ret != 0) {
780 set->crtc->fb = old_fb;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200781 goto fail;
Chris Wilson0ba41e42011-01-08 15:10:41 +0000782 }
Dave Airlief453ba02008-11-07 14:05:41 -0800783 }
784
Maarten Maathuise67aae72009-08-27 10:18:29 +0200785 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800786 kfree(save_encoders);
787 kfree(save_crtcs);
788 return 0;
789
Maarten Maathuise67aae72009-08-27 10:18:29 +0200790fail:
791 /* Restore all previous data. */
Dave Airlief453ba02008-11-07 14:05:41 -0800792 count = 0;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200793 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
794 *crtc = save_crtcs[count++];
795 }
Chris Wilsone62fb642009-02-11 16:39:21 +0000796
Maarten Maathuise67aae72009-08-27 10:18:29 +0200797 count = 0;
798 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
799 *encoder = save_encoders[count++];
Chris Wilsone62fb642009-02-11 16:39:21 +0000800 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200801
Dave Airlief453ba02008-11-07 14:05:41 -0800802 count = 0;
803 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Maarten Maathuise67aae72009-08-27 10:18:29 +0200804 *connector = save_connectors[count++];
Dave Airlief453ba02008-11-07 14:05:41 -0800805 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200806
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800807 /* Try to restore the config */
808 if (mode_changed &&
809 !drm_crtc_helper_set_mode(save_set.crtc, save_set.mode, save_set.x,
810 save_set.y, save_set.fb))
811 DRM_ERROR("failed to restore config after modeset failure\n");
812
Maarten Maathuise67aae72009-08-27 10:18:29 +0200813 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800814 kfree(save_encoders);
Maarten Maathuise67aae72009-08-27 10:18:29 +0200815 kfree(save_crtcs);
Dave Airlief453ba02008-11-07 14:05:41 -0800816 return ret;
817}
818EXPORT_SYMBOL(drm_crtc_helper_set_config);
819
Keith Packardc9fb15f2009-05-30 20:42:28 -0700820static int drm_helper_choose_encoder_dpms(struct drm_encoder *encoder)
821{
822 int dpms = DRM_MODE_DPMS_OFF;
823 struct drm_connector *connector;
824 struct drm_device *dev = encoder->dev;
825
826 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
827 if (connector->encoder == encoder)
828 if (connector->dpms < dpms)
829 dpms = connector->dpms;
830 return dpms;
831}
832
833static int drm_helper_choose_crtc_dpms(struct drm_crtc *crtc)
834{
835 int dpms = DRM_MODE_DPMS_OFF;
836 struct drm_connector *connector;
837 struct drm_device *dev = crtc->dev;
838
839 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
840 if (connector->encoder && connector->encoder->crtc == crtc)
841 if (connector->dpms < dpms)
842 dpms = connector->dpms;
843 return dpms;
844}
845
846/**
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100847 * drm_helper_connector_dpms() - connector dpms helper implementation
848 * @connector: affected connector
849 * @mode: DPMS mode
Keith Packardc9fb15f2009-05-30 20:42:28 -0700850 *
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100851 * This is the main helper function provided by the crtc helper framework for
852 * implementing the DPMS connector attribute. It computes the new desired DPMS
853 * state for all encoders and crtcs in the output mesh and calls the ->dpms()
854 * callback provided by the driver appropriately.
Keith Packardc9fb15f2009-05-30 20:42:28 -0700855 */
856void drm_helper_connector_dpms(struct drm_connector *connector, int mode)
857{
858 struct drm_encoder *encoder = connector->encoder;
859 struct drm_crtc *crtc = encoder ? encoder->crtc : NULL;
860 int old_dpms;
861
862 if (mode == connector->dpms)
863 return;
864
865 old_dpms = connector->dpms;
866 connector->dpms = mode;
867
868 /* from off to on, do crtc then encoder */
869 if (mode < old_dpms) {
870 if (crtc) {
871 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
872 if (crtc_funcs->dpms)
873 (*crtc_funcs->dpms) (crtc,
874 drm_helper_choose_crtc_dpms(crtc));
875 }
876 if (encoder) {
877 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
878 if (encoder_funcs->dpms)
879 (*encoder_funcs->dpms) (encoder,
880 drm_helper_choose_encoder_dpms(encoder));
881 }
882 }
883
884 /* from on to off, do encoder then crtc */
885 if (mode > old_dpms) {
886 if (encoder) {
887 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
888 if (encoder_funcs->dpms)
889 (*encoder_funcs->dpms) (encoder,
890 drm_helper_choose_encoder_dpms(encoder));
891 }
892 if (crtc) {
893 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
894 if (crtc_funcs->dpms)
895 (*crtc_funcs->dpms) (crtc,
896 drm_helper_choose_crtc_dpms(crtc));
897 }
898 }
899
900 return;
901}
902EXPORT_SYMBOL(drm_helper_connector_dpms);
903
Dave Airlief453ba02008-11-07 14:05:41 -0800904int drm_helper_mode_fill_fb_struct(struct drm_framebuffer *fb,
Jesse Barnes308e5bc2011-11-14 14:51:28 -0800905 struct drm_mode_fb_cmd2 *mode_cmd)
Dave Airlief453ba02008-11-07 14:05:41 -0800906{
Ville Syrjälä01f2c772011-12-20 00:06:49 +0200907 int i;
908
Dave Airlief453ba02008-11-07 14:05:41 -0800909 fb->width = mode_cmd->width;
910 fb->height = mode_cmd->height;
Ville Syrjälä01f2c772011-12-20 00:06:49 +0200911 for (i = 0; i < 4; i++) {
912 fb->pitches[i] = mode_cmd->pitches[i];
913 fb->offsets[i] = mode_cmd->offsets[i];
914 }
Dave Airlie248dbc22011-11-29 20:02:54 +0000915 drm_fb_get_bpp_depth(mode_cmd->pixel_format, &fb->depth,
Jesse Barnes308e5bc2011-11-14 14:51:28 -0800916 &fb->bits_per_pixel);
917 fb->pixel_format = mode_cmd->pixel_format;
Dave Airlief453ba02008-11-07 14:05:41 -0800918
919 return 0;
920}
921EXPORT_SYMBOL(drm_helper_mode_fill_fb_struct);
922
923int drm_helper_resume_force_mode(struct drm_device *dev)
924{
925 struct drm_crtc *crtc;
David John89347bb2009-12-31 12:00:46 +0530926 struct drm_encoder *encoder;
927 struct drm_encoder_helper_funcs *encoder_funcs;
928 struct drm_crtc_helper_funcs *crtc_funcs;
Dave Airlief453ba02008-11-07 14:05:41 -0800929 int ret;
930
931 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
932
933 if (!crtc->enabled)
934 continue;
935
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500936 ret = drm_crtc_helper_set_mode(crtc, &crtc->mode,
937 crtc->x, crtc->y, crtc->fb);
Dave Airlief453ba02008-11-07 14:05:41 -0800938
939 if (ret == false)
940 DRM_ERROR("failed to set mode on crtc %p\n", crtc);
David John89347bb2009-12-31 12:00:46 +0530941
942 /* Turn off outputs that were already powered off */
943 if (drm_helper_choose_crtc_dpms(crtc)) {
944 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
945
946 if(encoder->crtc != crtc)
947 continue;
948
949 encoder_funcs = encoder->helper_private;
950 if (encoder_funcs->dpms)
951 (*encoder_funcs->dpms) (encoder,
952 drm_helper_choose_encoder_dpms(encoder));
David John89347bb2009-12-31 12:00:46 +0530953 }
Chris Wilson817e6312010-08-06 15:03:31 +0100954
955 crtc_funcs = crtc->helper_private;
956 if (crtc_funcs->dpms)
957 (*crtc_funcs->dpms) (crtc,
958 drm_helper_choose_crtc_dpms(crtc));
David John89347bb2009-12-31 12:00:46 +0530959 }
Dave Airlief453ba02008-11-07 14:05:41 -0800960 }
Zhao Yakuiaf4fcb52009-07-08 14:13:13 +0800961 /* disable the unused connectors while restoring the modesetting */
962 drm_helper_disable_unused_functions(dev);
Dave Airlief453ba02008-11-07 14:05:41 -0800963 return 0;
964}
965EXPORT_SYMBOL(drm_helper_resume_force_mode);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000966
Daniel Vetter3d3683f2012-10-23 18:23:32 +0000967void drm_kms_helper_hotplug_event(struct drm_device *dev)
968{
969 /* send a uevent + call fbdev */
970 drm_sysfs_hotplug_event(dev);
971 if (dev->mode_config.funcs->output_poll_changed)
972 dev->mode_config.funcs->output_poll_changed(dev);
973}
974EXPORT_SYMBOL(drm_kms_helper_hotplug_event);
975
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000976#define DRM_OUTPUT_POLL_PERIOD (10*HZ)
Tejun Heo991ea752010-07-20 22:09:02 +0200977static void output_poll_execute(struct work_struct *work)
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000978{
Tejun Heo991ea752010-07-20 22:09:02 +0200979 struct delayed_work *delayed_work = to_delayed_work(work);
980 struct drm_device *dev = container_of(delayed_work, struct drm_device, mode_config.output_poll_work);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000981 struct drm_connector *connector;
Keith Packardc5027de2010-11-26 10:45:59 -0800982 enum drm_connector_status old_status;
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000983 bool repoll = false, changed = false;
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000984
Chris Wilsone58f6372010-08-20 09:13:36 +0100985 if (!drm_kms_helper_poll)
986 return;
987
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000988 mutex_lock(&dev->mode_config.mutex);
989 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
990
Daniel Vetter11e68682012-10-23 18:23:38 +0000991 /* Ignore forced connectors. */
992 if (connector->force)
993 continue;
994
Daniel Vetter816da852012-10-23 18:23:33 +0000995 /* Ignore HPD capable connectors and connectors where we don't
996 * want any hotplug detection at all for polling. */
997 if (!connector->polled || connector->polled == DRM_CONNECTOR_POLL_HPD)
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000998 continue;
999
Daniel Vettera4f968d2012-10-24 13:35:50 +00001000 repoll = true;
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001001
1002 old_status = connector->status;
1003 /* if we are connected and don't want to poll for disconnect
1004 skip it */
1005 if (old_status == connector_status_connected &&
Daniel Vetter816da852012-10-23 18:23:33 +00001006 !(connector->polled & DRM_CONNECTOR_POLL_DISCONNECT))
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001007 continue;
1008
Keith Packardc5027de2010-11-26 10:45:59 -08001009 connector->status = connector->funcs->detect(connector, false);
Lespiau, Damiened7951d2013-05-10 12:36:42 +00001010 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n",
Chris Wilson0f168302010-12-21 22:49:28 +00001011 connector->base.id,
1012 drm_get_connector_name(connector),
Lespiau, Damiened7951d2013-05-10 12:36:42 +00001013 drm_get_connector_status_name(old_status),
1014 drm_get_connector_status_name(connector->status));
Keith Packardc5027de2010-11-26 10:45:59 -08001015 if (old_status != connector->status)
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001016 changed = true;
1017 }
1018
1019 mutex_unlock(&dev->mode_config.mutex);
1020
Daniel Vetter3d3683f2012-10-23 18:23:32 +00001021 if (changed)
1022 drm_kms_helper_hotplug_event(dev);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001023
Tejun Heo9a919c42010-08-09 12:01:27 +02001024 if (repoll)
Tejun Heo3b07e9c2012-08-20 14:51:24 -07001025 schedule_delayed_work(delayed_work, DRM_OUTPUT_POLL_PERIOD);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001026}
1027
Dave Airliefbf81762010-06-01 09:09:06 +10001028void drm_kms_helper_poll_disable(struct drm_device *dev)
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001029{
Dave Airliefbf81762010-06-01 09:09:06 +10001030 if (!dev->mode_config.poll_enabled)
1031 return;
Tejun Heo991ea752010-07-20 22:09:02 +02001032 cancel_delayed_work_sync(&dev->mode_config.output_poll_work);
Dave Airliefbf81762010-06-01 09:09:06 +10001033}
1034EXPORT_SYMBOL(drm_kms_helper_poll_disable);
1035
1036void drm_kms_helper_poll_enable(struct drm_device *dev)
1037{
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001038 bool poll = false;
Dave Airliefbf81762010-06-01 09:09:06 +10001039 struct drm_connector *connector;
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001040
Chris Wilsone58f6372010-08-20 09:13:36 +01001041 if (!dev->mode_config.poll_enabled || !drm_kms_helper_poll)
1042 return;
1043
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001044 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Daniel Vettera4f968d2012-10-24 13:35:50 +00001045 if (connector->polled & (DRM_CONNECTOR_POLL_CONNECT |
1046 DRM_CONNECTOR_POLL_DISCONNECT))
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001047 poll = true;
1048 }
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001049
Tejun Heo9a919c42010-08-09 12:01:27 +02001050 if (poll)
Tejun Heo3b07e9c2012-08-20 14:51:24 -07001051 schedule_delayed_work(&dev->mode_config.output_poll_work, DRM_OUTPUT_POLL_PERIOD);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001052}
Dave Airliefbf81762010-06-01 09:09:06 +10001053EXPORT_SYMBOL(drm_kms_helper_poll_enable);
1054
1055void drm_kms_helper_poll_init(struct drm_device *dev)
1056{
Tejun Heo991ea752010-07-20 22:09:02 +02001057 INIT_DELAYED_WORK(&dev->mode_config.output_poll_work, output_poll_execute);
Dave Airliefbf81762010-06-01 09:09:06 +10001058 dev->mode_config.poll_enabled = true;
1059
1060 drm_kms_helper_poll_enable(dev);
1061}
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001062EXPORT_SYMBOL(drm_kms_helper_poll_init);
1063
1064void drm_kms_helper_poll_fini(struct drm_device *dev)
1065{
Dave Airliefbf81762010-06-01 09:09:06 +10001066 drm_kms_helper_poll_disable(dev);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001067}
1068EXPORT_SYMBOL(drm_kms_helper_poll_fini);
1069
Daniel Vetter69787f72012-10-23 18:23:34 +00001070void drm_helper_hpd_irq_event(struct drm_device *dev)
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001071{
Daniel Vetter816da852012-10-23 18:23:33 +00001072 struct drm_connector *connector;
1073 enum drm_connector_status old_status;
1074 bool changed = false;
1075
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001076 if (!dev->mode_config.poll_enabled)
1077 return;
Chris Wilsone58f6372010-08-20 09:13:36 +01001078
Daniel Vetter816da852012-10-23 18:23:33 +00001079 mutex_lock(&dev->mode_config.mutex);
1080 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
1081
1082 /* Only handle HPD capable connectors. */
1083 if (!(connector->polled & DRM_CONNECTOR_POLL_HPD))
1084 continue;
1085
1086 old_status = connector->status;
1087
1088 connector->status = connector->funcs->detect(connector, false);
Lespiau, Damiened7951d2013-05-10 12:36:42 +00001089 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n",
Daniel Vetter816da852012-10-23 18:23:33 +00001090 connector->base.id,
1091 drm_get_connector_name(connector),
Lespiau, Damiened7951d2013-05-10 12:36:42 +00001092 drm_get_connector_status_name(old_status),
1093 drm_get_connector_status_name(connector->status));
Daniel Vetter816da852012-10-23 18:23:33 +00001094 if (old_status != connector->status)
1095 changed = true;
1096 }
1097
1098 mutex_unlock(&dev->mode_config.mutex);
1099
1100 if (changed)
1101 drm_kms_helper_hotplug_event(dev);
1102}
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001103EXPORT_SYMBOL(drm_helper_hpd_irq_event);