blob: 55ea4ac6fd50c6f6e5697611183fd2b80654e54c [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
Damien Lespiau560a0672013-09-25 16:45:29 +010079 if (flags == (DRM_MODE_FLAG_DBLSCAN | DRM_MODE_FLAG_INTERLACE |
80 DRM_MODE_FLAG_3D_MASK))
yakui_zhao67149772009-04-02 11:52:12 +080081 return;
82
Sascha Hauera1178ca2012-02-01 11:38:30 +010083 list_for_each_entry(mode, &connector->modes, head) {
yakui_zhao67149772009-04-02 11:52:12 +080084 if ((mode->flags & DRM_MODE_FLAG_INTERLACE) &&
85 !(flags & DRM_MODE_FLAG_INTERLACE))
86 mode->status = MODE_NO_INTERLACE;
87 if ((mode->flags & DRM_MODE_FLAG_DBLSCAN) &&
88 !(flags & DRM_MODE_FLAG_DBLSCAN))
89 mode->status = MODE_NO_DBLESCAN;
Damien Lespiau560a0672013-09-25 16:45:29 +010090 if ((mode->flags & DRM_MODE_FLAG_3D_MASK) &&
91 !(flags & DRM_MODE_FLAG_3D_MASK))
92 mode->status = MODE_NO_STEREO;
yakui_zhao67149772009-04-02 11:52:12 +080093 }
94
95 return;
96}
97
Dave Airlief453ba02008-11-07 14:05:41 -080098/**
Dave Airlie38651672010-03-30 05:34:13 +000099 * drm_helper_probe_single_connector_modes - get complete set of display modes
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100100 * @connector: connector to probe
Dave Airlief453ba02008-11-07 14:05:41 -0800101 * @maxX: max width for modes
102 * @maxY: max height for modes
103 *
104 * LOCKING:
105 * Caller must hold mode config lock.
106 *
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100107 * Based on the helper callbacks implemented by @connector try to detect all
108 * valid modes. Modes will first be added to the connector's probed_modes list,
109 * then culled (based on validity and the @maxX, @maxY parameters) and put into
110 * the normal modes list.
Dave Airlief453ba02008-11-07 14:05:41 -0800111 *
Lespiau, Damien1eee8142013-09-23 14:48:09 +0100112 * Intended to be use as a generic implementation of the ->fill_modes()
113 * @connector vfunc for drivers that use the crtc helpers for output mode
114 * filtering and detection.
Jesse Barnes40a518d2009-01-12 12:05:32 -0800115 *
116 * RETURNS:
117 * Number of modes found on @connector.
Dave Airlief453ba02008-11-07 14:05:41 -0800118 */
Jesse Barnes40a518d2009-01-12 12:05:32 -0800119int drm_helper_probe_single_connector_modes(struct drm_connector *connector,
120 uint32_t maxX, uint32_t maxY)
Dave Airlief453ba02008-11-07 14:05:41 -0800121{
122 struct drm_device *dev = connector->dev;
Sascha Hauera1178ca2012-02-01 11:38:30 +0100123 struct drm_display_mode *mode;
Dave Airlief453ba02008-11-07 14:05:41 -0800124 struct drm_connector_helper_funcs *connector_funcs =
125 connector->helper_private;
Jesse Barnes40a518d2009-01-12 12:05:32 -0800126 int count = 0;
yakui_zhao67149772009-04-02 11:52:12 +0800127 int mode_flags = 0;
Damien Lespiauebbd97a2013-05-08 17:03:32 +0100128 bool verbose_prune = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800129
Jerome Glisse94401062010-07-15 15:43:25 -0400130 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id,
131 drm_get_connector_name(connector));
Dave Airlief453ba02008-11-07 14:05:41 -0800132 /* set all modes to the unverified state */
Sascha Hauera1178ca2012-02-01 11:38:30 +0100133 list_for_each_entry(mode, &connector->modes, head)
Dave Airlief453ba02008-11-07 14:05:41 -0800134 mode->status = MODE_UNVERIFIED;
135
Dave Airlied50ba252009-09-23 14:44:08 +1000136 if (connector->force) {
137 if (connector->force == DRM_FORCE_ON)
138 connector->status = connector_status_connected;
139 else
140 connector->status = connector_status_disconnected;
141 if (connector->funcs->force)
142 connector->funcs->force(connector);
Chris Wilsone58f6372010-08-20 09:13:36 +0100143 } else {
Chris Wilson930a9e22010-09-14 11:07:23 +0100144 connector->status = connector->funcs->detect(connector, true);
Chris Wilsone58f6372010-08-20 09:13:36 +0100145 }
Dave Airlief453ba02008-11-07 14:05:41 -0800146
Daniel Vetter905bc9f2012-10-23 18:23:36 +0000147 /* Re-enable polling in case the global poll config changed. */
148 if (drm_kms_helper_poll != dev->mode_config.poll_running)
149 drm_kms_helper_poll_enable(dev);
150
151 dev->mode_config.poll_running = drm_kms_helper_poll;
152
Dave Airlief453ba02008-11-07 14:05:41 -0800153 if (connector->status == connector_status_disconnected) {
Jerome Glisse94401062010-07-15 15:43:25 -0400154 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] disconnected\n",
155 connector->base.id, drm_get_connector_name(connector));
Zhao Yakui72539832010-03-04 08:25:55 +0000156 drm_mode_connector_update_edid_property(connector, NULL);
Damien Lespiauebbd97a2013-05-08 17:03:32 +0100157 verbose_prune = false;
Adam Jackson620f3782009-09-08 11:51:46 +1000158 goto prune;
Dave Airlief453ba02008-11-07 14:05:41 -0800159 }
160
Carsten Emdeda0df922012-03-18 22:37:33 +0100161#ifdef CONFIG_DRM_LOAD_EDID_FIRMWARE
162 count = drm_load_edid_firmware(connector);
163 if (count == 0)
164#endif
165 count = (*connector_funcs->get_modes)(connector);
166
Chris Wilsonc7ef35a2010-09-05 16:55:25 +0100167 if (count == 0 && connector->status == connector_status_connected)
Adam Jackson9632b412009-11-23 14:23:07 -0500168 count = drm_add_modes_noedid(connector, 1024, 768);
Chris Wilsonc7ef35a2010-09-05 16:55:25 +0100169 if (count == 0)
170 goto prune;
Dave Airlief453ba02008-11-07 14:05:41 -0800171
Jesse Barnes40a518d2009-01-12 12:05:32 -0800172 drm_mode_connector_list_update(connector);
Dave Airlief453ba02008-11-07 14:05:41 -0800173
174 if (maxX && maxY)
175 drm_mode_validate_size(dev, &connector->modes, maxX,
176 maxY, 0);
yakui_zhao67149772009-04-02 11:52:12 +0800177
178 if (connector->interlace_allowed)
179 mode_flags |= DRM_MODE_FLAG_INTERLACE;
180 if (connector->doublescan_allowed)
181 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
Damien Lespiau560a0672013-09-25 16:45:29 +0100182 if (connector->stereo_allowed)
183 mode_flags |= DRM_MODE_FLAG_3D_MASK;
yakui_zhao67149772009-04-02 11:52:12 +0800184 drm_mode_validate_flag(connector, mode_flags);
185
Sascha Hauera1178ca2012-02-01 11:38:30 +0100186 list_for_each_entry(mode, &connector->modes, head) {
Dave Airlief453ba02008-11-07 14:05:41 -0800187 if (mode->status == MODE_OK)
188 mode->status = connector_funcs->mode_valid(connector,
189 mode);
190 }
191
Adam Jackson620f3782009-09-08 11:51:46 +1000192prune:
Damien Lespiauebbd97a2013-05-08 17:03:32 +0100193 drm_mode_prune_invalid(dev, &connector->modes, verbose_prune);
Dave Airlief453ba02008-11-07 14:05:41 -0800194
Jesse Barnes40a518d2009-01-12 12:05:32 -0800195 if (list_empty(&connector->modes))
196 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800197
Ville Syrjälä9bc3cd52013-05-31 12:17:08 +0000198 list_for_each_entry(mode, &connector->modes, head)
199 mode->vrefresh = drm_mode_vrefresh(mode);
200
Dave Airlief453ba02008-11-07 14:05:41 -0800201 drm_mode_sort(&connector->modes);
202
Jerome Glisse94401062010-07-15 15:43:25 -0400203 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector->base.id,
204 drm_get_connector_name(connector));
Sascha Hauera1178ca2012-02-01 11:38:30 +0100205 list_for_each_entry(mode, &connector->modes, head) {
Dave Airlief453ba02008-11-07 14:05:41 -0800206 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
207 drm_mode_debug_printmodeline(mode);
208 }
Jesse Barnes40a518d2009-01-12 12:05:32 -0800209
210 return count;
Dave Airlief453ba02008-11-07 14:05:41 -0800211}
212EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
213
Dave Airlief453ba02008-11-07 14:05:41 -0800214/**
Keith Packardc9fb15f2009-05-30 20:42:28 -0700215 * drm_helper_encoder_in_use - check if a given encoder is in use
216 * @encoder: encoder to check
217 *
218 * LOCKING:
219 * Caller must hold mode config lock.
220 *
221 * Walk @encoders's DRM device's mode_config and see if it's in use.
222 *
223 * RETURNS:
224 * True if @encoder is part of the mode_config, false otherwise.
225 */
226bool drm_helper_encoder_in_use(struct drm_encoder *encoder)
227{
228 struct drm_connector *connector;
229 struct drm_device *dev = encoder->dev;
230 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
231 if (connector->encoder == encoder)
232 return true;
233 return false;
234}
235EXPORT_SYMBOL(drm_helper_encoder_in_use);
236
237/**
Dave Airlief453ba02008-11-07 14:05:41 -0800238 * drm_helper_crtc_in_use - check if a given CRTC is in a mode_config
239 * @crtc: CRTC to check
240 *
241 * LOCKING:
242 * Caller must hold mode config lock.
243 *
244 * Walk @crtc's DRM device's mode_config and see if it's in use.
245 *
246 * RETURNS:
247 * True if @crtc is part of the mode_config, false otherwise.
248 */
249bool drm_helper_crtc_in_use(struct drm_crtc *crtc)
250{
251 struct drm_encoder *encoder;
252 struct drm_device *dev = crtc->dev;
253 /* FIXME: Locking around list access? */
254 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
Keith Packardc9fb15f2009-05-30 20:42:28 -0700255 if (encoder->crtc == crtc && drm_helper_encoder_in_use(encoder))
Dave Airlief453ba02008-11-07 14:05:41 -0800256 return true;
257 return false;
258}
259EXPORT_SYMBOL(drm_helper_crtc_in_use);
260
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000261static void
262drm_encoder_disable(struct drm_encoder *encoder)
263{
264 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
265
Sean Paul3b336ec2013-08-14 16:47:37 -0400266 if (encoder->bridge)
267 encoder->bridge->funcs->disable(encoder->bridge);
268
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000269 if (encoder_funcs->disable)
270 (*encoder_funcs->disable)(encoder);
271 else
272 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
Sean Paul3b336ec2013-08-14 16:47:37 -0400273
274 if (encoder->bridge)
275 encoder->bridge->funcs->post_disable(encoder->bridge);
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000276}
277
Dave Airlief453ba02008-11-07 14:05:41 -0800278/**
David John89347bb2009-12-31 12:00:46 +0530279 * drm_helper_disable_unused_functions - disable unused objects
Dave Airlief453ba02008-11-07 14:05:41 -0800280 * @dev: DRM device
281 *
282 * LOCKING:
283 * Caller must hold mode config lock.
284 *
285 * If an connector or CRTC isn't part of @dev's mode_config, it can be disabled
286 * by calling its dpms function, which should power it off.
287 */
288void drm_helper_disable_unused_functions(struct drm_device *dev)
289{
290 struct drm_encoder *encoder;
Dave Airliea3a05442009-08-31 15:16:30 +1000291 struct drm_connector *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800292 struct drm_crtc *crtc;
293
Dave Airliea3a05442009-08-31 15:16:30 +1000294 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
295 if (!connector->encoder)
296 continue;
297 if (connector->status == connector_status_disconnected)
298 connector->encoder = NULL;
299 }
300
Dave Airlief453ba02008-11-07 14:05:41 -0800301 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
Dave Airlie929710212010-12-21 12:47:56 +1000302 if (!drm_helper_encoder_in_use(encoder)) {
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000303 drm_encoder_disable(encoder);
Dave Airlie9c552dd2009-09-02 14:00:11 +1000304 /* disconnector encoder from any connector */
305 encoder->crtc = NULL;
Dave Airliea3a05442009-08-31 15:16:30 +1000306 }
Dave Airlief453ba02008-11-07 14:05:41 -0800307 }
308
309 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
310 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
311 crtc->enabled = drm_helper_crtc_in_use(crtc);
312 if (!crtc->enabled) {
Alex Deucher5c8d7172010-06-11 17:04:35 -0400313 if (crtc_funcs->disable)
314 (*crtc_funcs->disable)(crtc);
315 else
316 (*crtc_funcs->dpms)(crtc, DRM_MODE_DPMS_OFF);
Dave Airlief453ba02008-11-07 14:05:41 -0800317 crtc->fb = NULL;
318 }
319 }
320}
321EXPORT_SYMBOL(drm_helper_disable_unused_functions);
322
Jesse Barnes7bec7562009-02-23 16:09:34 -0800323/**
324 * drm_encoder_crtc_ok - can a given crtc drive a given encoder?
325 * @encoder: encoder to test
326 * @crtc: crtc to test
327 *
328 * Return false if @encoder can't be driven by @crtc, true otherwise.
329 */
330static bool drm_encoder_crtc_ok(struct drm_encoder *encoder,
331 struct drm_crtc *crtc)
332{
333 struct drm_device *dev;
334 struct drm_crtc *tmp;
335 int crtc_mask = 1;
336
Joe Perchesfce7d612010-10-30 21:08:30 +0000337 WARN(!crtc, "checking null crtc?\n");
Jesse Barnes7bec7562009-02-23 16:09:34 -0800338
339 dev = crtc->dev;
340
341 list_for_each_entry(tmp, &dev->mode_config.crtc_list, head) {
342 if (tmp == crtc)
343 break;
344 crtc_mask <<= 1;
345 }
346
347 if (encoder->possible_crtcs & crtc_mask)
348 return true;
349 return false;
350}
351
352/*
353 * Check the CRTC we're going to map each output to vs. its current
354 * CRTC. If they don't match, we have to disable the output and the CRTC
355 * since the driver will have to re-route things.
356 */
357static void
358drm_crtc_prepare_encoders(struct drm_device *dev)
359{
360 struct drm_encoder_helper_funcs *encoder_funcs;
361 struct drm_encoder *encoder;
362
363 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
364 encoder_funcs = encoder->helper_private;
365 /* Disable unused encoders */
366 if (encoder->crtc == NULL)
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000367 drm_encoder_disable(encoder);
Jesse Barnes7bec7562009-02-23 16:09:34 -0800368 /* Disable encoders whose CRTC is about to change */
369 if (encoder_funcs->get_crtc &&
370 encoder->crtc != (*encoder_funcs->get_crtc)(encoder))
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000371 drm_encoder_disable(encoder);
Jesse Barnes7bec7562009-02-23 16:09:34 -0800372 }
373}
374
Dave Airlief453ba02008-11-07 14:05:41 -0800375/**
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100376 * drm_crtc_helper_set_mode - internal helper to set a mode
Dave Airlief453ba02008-11-07 14:05:41 -0800377 * @crtc: CRTC to program
378 * @mode: mode to use
Alex Deucher4c9287c2012-11-09 17:26:32 +0000379 * @x: horizontal offset into the surface
380 * @y: vertical offset into the surface
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100381 * @old_fb: old framebuffer, for cleanup
Dave Airlief453ba02008-11-07 14:05:41 -0800382 *
383 * LOCKING:
384 * Caller must hold mode config lock.
385 *
386 * Try to set @mode on @crtc. Give @crtc and its associated connectors a chance
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100387 * to fixup or reject the mode prior to trying to set it. This is an internal
388 * helper that drivers could e.g. use to update properties that require the
389 * entire output pipe to be disabled and re-enabled in a new configuration. For
390 * example for changing whether audio is enabled on a hdmi link or for changing
391 * panel fitter or dither attributes. It is also called by the
392 * drm_crtc_helper_set_config() helper function to drive the mode setting
393 * sequence.
Dave Airlief453ba02008-11-07 14:05:41 -0800394 *
395 * RETURNS:
396 * True if the mode was set successfully, or false otherwise.
397 */
398bool drm_crtc_helper_set_mode(struct drm_crtc *crtc,
399 struct drm_display_mode *mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500400 int x, int y,
401 struct drm_framebuffer *old_fb)
Dave Airlief453ba02008-11-07 14:05:41 -0800402{
403 struct drm_device *dev = crtc->dev;
Mario Kleiner27641c32010-10-23 04:20:23 +0200404 struct drm_display_mode *adjusted_mode, saved_mode, saved_hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800405 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
406 struct drm_encoder_helper_funcs *encoder_funcs;
407 int saved_x, saved_y;
408 struct drm_encoder *encoder;
409 bool ret = true;
410
Dave Airlief453ba02008-11-07 14:05:41 -0800411 crtc->enabled = drm_helper_crtc_in_use(crtc);
Dave Airlief453ba02008-11-07 14:05:41 -0800412 if (!crtc->enabled)
413 return true;
414
Chris Wilson021a8452011-01-28 11:31:56 +0000415 adjusted_mode = drm_mode_duplicate(dev, mode);
Ville Syrjälä6bfc56a2012-03-13 12:35:48 +0200416 if (!adjusted_mode)
417 return false;
Chris Wilson021a8452011-01-28 11:31:56 +0000418
Mario Kleiner27641c32010-10-23 04:20:23 +0200419 saved_hwmode = crtc->hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800420 saved_mode = crtc->mode;
421 saved_x = crtc->x;
422 saved_y = crtc->y;
423
424 /* Update crtc values up front so the driver can rely on them for mode
425 * setting.
426 */
427 crtc->mode = *mode;
428 crtc->x = x;
429 crtc->y = y;
430
Dave Airlief453ba02008-11-07 14:05:41 -0800431 /* Pass our mode to the connectors and the CRTC to give them a chance to
432 * adjust it according to limitations or connector properties, and also
433 * a chance to reject the mode entirely.
434 */
435 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
436
437 if (encoder->crtc != crtc)
438 continue;
Sean Paul3b336ec2013-08-14 16:47:37 -0400439
440 if (encoder->bridge && encoder->bridge->funcs->mode_fixup) {
441 ret = encoder->bridge->funcs->mode_fixup(
442 encoder->bridge, mode, adjusted_mode);
443 if (!ret) {
444 DRM_DEBUG_KMS("Bridge fixup failed\n");
445 goto done;
446 }
447 }
448
Dave Airlief453ba02008-11-07 14:05:41 -0800449 encoder_funcs = encoder->helper_private;
450 if (!(ret = encoder_funcs->mode_fixup(encoder, mode,
451 adjusted_mode))) {
Adam Jackson836e53d2011-10-10 16:21:27 -0400452 DRM_DEBUG_KMS("Encoder fixup failed\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800453 goto done;
454 }
455 }
456
457 if (!(ret = crtc_funcs->mode_fixup(crtc, mode, adjusted_mode))) {
Adam Jackson836e53d2011-10-10 16:21:27 -0400458 DRM_DEBUG_KMS("CRTC fixup failed\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800459 goto done;
460 }
Jerome Glisse94401062010-07-15 15:43:25 -0400461 DRM_DEBUG_KMS("[CRTC:%d]\n", crtc->base.id);
Dave Airlief453ba02008-11-07 14:05:41 -0800462
463 /* Prepare the encoders and CRTCs before setting the mode. */
464 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
465
466 if (encoder->crtc != crtc)
467 continue;
Sean Paul3b336ec2013-08-14 16:47:37 -0400468
469 if (encoder->bridge)
470 encoder->bridge->funcs->disable(encoder->bridge);
471
Dave Airlief453ba02008-11-07 14:05:41 -0800472 encoder_funcs = encoder->helper_private;
473 /* Disable the encoders as the first thing we do. */
474 encoder_funcs->prepare(encoder);
Sean Paul3b336ec2013-08-14 16:47:37 -0400475
476 if (encoder->bridge)
477 encoder->bridge->funcs->post_disable(encoder->bridge);
Dave Airlief453ba02008-11-07 14:05:41 -0800478 }
479
Jesse Barnes7bec7562009-02-23 16:09:34 -0800480 drm_crtc_prepare_encoders(dev);
481
Dave Airlief453ba02008-11-07 14:05:41 -0800482 crtc_funcs->prepare(crtc);
483
484 /* Set up the DPLL and any encoders state that needs to adjust or depend
485 * on the DPLL.
486 */
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000487 ret = !crtc_funcs->mode_set(crtc, mode, adjusted_mode, x, y, old_fb);
488 if (!ret)
489 goto done;
Dave Airlief453ba02008-11-07 14:05:41 -0800490
491 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
492
493 if (encoder->crtc != crtc)
494 continue;
495
Jerome Glisse94401062010-07-15 15:43:25 -0400496 DRM_DEBUG_KMS("[ENCODER:%d:%s] set [MODE:%d:%s]\n",
497 encoder->base.id, drm_get_encoder_name(encoder),
498 mode->base.id, mode->name);
Dave Airlief453ba02008-11-07 14:05:41 -0800499 encoder_funcs = encoder->helper_private;
500 encoder_funcs->mode_set(encoder, mode, adjusted_mode);
Sean Paul3b336ec2013-08-14 16:47:37 -0400501
502 if (encoder->bridge && encoder->bridge->funcs->mode_set)
503 encoder->bridge->funcs->mode_set(encoder->bridge, mode,
504 adjusted_mode);
Dave Airlief453ba02008-11-07 14:05:41 -0800505 }
506
507 /* Now enable the clocks, plane, pipe, and connectors that we set up. */
508 crtc_funcs->commit(crtc);
509
510 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
511
512 if (encoder->crtc != crtc)
513 continue;
514
Sean Paul3b336ec2013-08-14 16:47:37 -0400515 if (encoder->bridge)
516 encoder->bridge->funcs->pre_enable(encoder->bridge);
517
Dave Airlief453ba02008-11-07 14:05:41 -0800518 encoder_funcs = encoder->helper_private;
519 encoder_funcs->commit(encoder);
520
Sean Paul3b336ec2013-08-14 16:47:37 -0400521 if (encoder->bridge)
522 encoder->bridge->funcs->enable(encoder->bridge);
Dave Airlief453ba02008-11-07 14:05:41 -0800523 }
524
Mario Kleiner27641c32010-10-23 04:20:23 +0200525 /* Store real post-adjustment hardware mode. */
526 crtc->hwmode = *adjusted_mode;
527
528 /* Calculate and store various constants which
529 * are later needed by vblank and swap-completion
530 * timestamping. They are derived from true hwmode.
531 */
532 drm_calc_timestamping_constants(crtc);
533
Dave Airlief453ba02008-11-07 14:05:41 -0800534 /* FIXME: add subpixel order */
535done:
Chris Wilson021a8452011-01-28 11:31:56 +0000536 drm_mode_destroy(dev, adjusted_mode);
Dave Airlief453ba02008-11-07 14:05:41 -0800537 if (!ret) {
Mario Kleiner27641c32010-10-23 04:20:23 +0200538 crtc->hwmode = saved_hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800539 crtc->mode = saved_mode;
540 crtc->x = saved_x;
541 crtc->y = saved_y;
542 }
543
544 return ret;
545}
546EXPORT_SYMBOL(drm_crtc_helper_set_mode);
547
548
Chris Wilson6eebd6b2011-11-28 21:10:05 +0000549static int
550drm_crtc_helper_disable(struct drm_crtc *crtc)
551{
552 struct drm_device *dev = crtc->dev;
553 struct drm_connector *connector;
554 struct drm_encoder *encoder;
555
556 /* Decouple all encoders and their attached connectors from this crtc */
557 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
558 if (encoder->crtc != crtc)
559 continue;
560
561 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
562 if (connector->encoder != encoder)
563 continue;
564
565 connector->encoder = NULL;
566 }
567 }
568
569 drm_helper_disable_unused_functions(dev);
570 return 0;
571}
572
Dave Airlief453ba02008-11-07 14:05:41 -0800573/**
574 * drm_crtc_helper_set_config - set a new config from userspace
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100575 * @set: mode set configuration
Dave Airlief453ba02008-11-07 14:05:41 -0800576 *
577 * LOCKING:
578 * Caller must hold mode config lock.
579 *
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100580 * Setup a new configuration, provided by the upper layers (either an ioctl call
581 * from userspace or internally e.g. from the fbdev suppport code) in @set, and
582 * enable it. This is the main helper functions for drivers that implement
583 * kernel mode setting with the crtc helper functions and the assorted
584 * ->prepare(), ->modeset() and ->commit() helper callbacks.
Dave Airlief453ba02008-11-07 14:05:41 -0800585 *
586 * RETURNS:
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100587 * Returns 0 on success, -ERRNO on failure.
Dave Airlief453ba02008-11-07 14:05:41 -0800588 */
589int drm_crtc_helper_set_config(struct drm_mode_set *set)
590{
591 struct drm_device *dev;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200592 struct drm_crtc *save_crtcs, *new_crtc, *crtc;
593 struct drm_encoder *save_encoders, *new_encoder, *encoder;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800594 struct drm_framebuffer *old_fb = NULL;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100595 bool mode_changed = false; /* if true do a full mode set */
596 bool fb_changed = false; /* if true and !mode_changed just do a flip */
Maarten Maathuise67aae72009-08-27 10:18:29 +0200597 struct drm_connector *save_connectors, *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800598 int count = 0, ro, fail = 0;
599 struct drm_crtc_helper_funcs *crtc_funcs;
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800600 struct drm_mode_set save_set;
Laurent Pinchart4a1b0712012-05-17 13:27:21 +0200601 int ret;
Keith Packardbf9dc102010-11-26 10:45:58 -0800602 int i;
Dave Airlief453ba02008-11-07 14:05:41 -0800603
Zhao Yakui58367ed2009-07-20 13:48:07 +0800604 DRM_DEBUG_KMS("\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800605
Daniel Vettere58de882013-06-15 00:13:11 +0200606 BUG_ON(!set);
607 BUG_ON(!set->crtc);
608 BUG_ON(!set->crtc->helper_private);
Dave Airlief453ba02008-11-07 14:05:41 -0800609
Daniel Vettere58de882013-06-15 00:13:11 +0200610 /* Enforce sane interface api - has been abused by the fb helper. */
611 BUG_ON(!set->mode && set->fb);
612 BUG_ON(set->fb && set->num_connectors == 0);
Dave Airlief453ba02008-11-07 14:05:41 -0800613
614 crtc_funcs = set->crtc->helper_private;
615
Chris Wilsonede3ff52011-01-31 11:16:33 +0000616 if (!set->mode)
617 set->fb = NULL;
618
Jerome Glisse94401062010-07-15 15:43:25 -0400619 if (set->fb) {
620 DRM_DEBUG_KMS("[CRTC:%d] [FB:%d] #connectors=%d (x y) (%i %i)\n",
621 set->crtc->base.id, set->fb->base.id,
622 (int)set->num_connectors, set->x, set->y);
623 } else {
Chris Wilsonede3ff52011-01-31 11:16:33 +0000624 DRM_DEBUG_KMS("[CRTC:%d] [NOFB]\n", set->crtc->base.id);
Chris Wilson6eebd6b2011-11-28 21:10:05 +0000625 return drm_crtc_helper_disable(set->crtc);
Jerome Glisse94401062010-07-15 15:43:25 -0400626 }
Dave Airlief453ba02008-11-07 14:05:41 -0800627
628 dev = set->crtc->dev;
629
Maarten Maathuise67aae72009-08-27 10:18:29 +0200630 /* Allocate space for the backup of all (non-pointer) crtc, encoder and
631 * connector data. */
632 save_crtcs = kzalloc(dev->mode_config.num_crtc *
633 sizeof(struct drm_crtc), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800634 if (!save_crtcs)
635 return -ENOMEM;
636
Maarten Maathuise67aae72009-08-27 10:18:29 +0200637 save_encoders = kzalloc(dev->mode_config.num_encoder *
638 sizeof(struct drm_encoder), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800639 if (!save_encoders) {
640 kfree(save_crtcs);
641 return -ENOMEM;
642 }
643
Maarten Maathuise67aae72009-08-27 10:18:29 +0200644 save_connectors = kzalloc(dev->mode_config.num_connector *
645 sizeof(struct drm_connector), GFP_KERNEL);
646 if (!save_connectors) {
647 kfree(save_crtcs);
648 kfree(save_encoders);
649 return -ENOMEM;
650 }
651
652 /* Copy data. Note that driver private data is not affected.
653 * Should anything bad happen only the expected state is
654 * restored, not the drivers personal bookkeeping.
655 */
656 count = 0;
657 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
658 save_crtcs[count++] = *crtc;
659 }
660
661 count = 0;
662 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
663 save_encoders[count++] = *encoder;
664 }
665
666 count = 0;
667 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
668 save_connectors[count++] = *connector;
669 }
670
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800671 save_set.crtc = set->crtc;
672 save_set.mode = &set->crtc->mode;
673 save_set.x = set->crtc->x;
674 save_set.y = set->crtc->y;
675 save_set.fb = set->crtc->fb;
676
Dave Airlief453ba02008-11-07 14:05:41 -0800677 /* We should be able to check here if the fb has the same properties
678 * and then just flip_or_move it */
679 if (set->crtc->fb != set->fb) {
Jesse Barnes712531b2009-01-09 13:56:14 -0800680 /* If we have no fb then treat it as a full mode set */
Jesse Barnes7bec7562009-02-23 16:09:34 -0800681 if (set->crtc->fb == NULL) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800682 DRM_DEBUG_KMS("crtc has no fb, full mode set\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800683 mode_changed = true;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100684 } else if (set->fb == NULL) {
685 mode_changed = true;
Laurent Pinchartce83adf2013-04-22 01:38:47 +0200686 } else if (set->fb->pixel_format !=
687 set->crtc->fb->pixel_format) {
688 mode_changed = true;
Dave Airlie8dff4742010-02-11 14:28:58 +1000689 } else
Jesse Barnes712531b2009-01-09 13:56:14 -0800690 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800691 }
692
693 if (set->x != set->crtc->x || set->y != set->crtc->y)
Jesse Barnes712531b2009-01-09 13:56:14 -0800694 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800695
696 if (set->mode && !drm_mode_equal(set->mode, &set->crtc->mode)) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800697 DRM_DEBUG_KMS("modes are different, full mode set\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800698 drm_mode_debug_printmodeline(&set->crtc->mode);
699 drm_mode_debug_printmodeline(set->mode);
Jesse Barnes712531b2009-01-09 13:56:14 -0800700 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800701 }
702
703 /* a) traverse passed in connector list and get encoders for them */
704 count = 0;
705 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
706 struct drm_connector_helper_funcs *connector_funcs =
707 connector->helper_private;
Dave Airlief453ba02008-11-07 14:05:41 -0800708 new_encoder = connector->encoder;
709 for (ro = 0; ro < set->num_connectors; ro++) {
710 if (set->connectors[ro] == connector) {
711 new_encoder = connector_funcs->best_encoder(connector);
712 /* if we can't get an encoder for a connector
713 we are setting now - then fail */
714 if (new_encoder == NULL)
715 /* don't break so fail path works correct */
716 fail = 1;
717 break;
Daniel Vetter25f397a2013-07-19 18:57:11 +0200718
719 if (connector->dpms != DRM_MODE_DPMS_ON) {
720 DRM_DEBUG_KMS("connector dpms not on, full mode switch\n");
721 mode_changed = true;
722 }
Dave Airlief453ba02008-11-07 14:05:41 -0800723 }
724 }
725
726 if (new_encoder != connector->encoder) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800727 DRM_DEBUG_KMS("encoder changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800728 mode_changed = true;
Maarten Maathuisff846ab2009-08-19 00:56:45 +0200729 /* If the encoder is reused for another connector, then
730 * the appropriate crtc will be set later.
731 */
Maarten Maathuisff6fdbe2009-09-01 03:39:04 +0200732 if (connector->encoder)
733 connector->encoder->crtc = NULL;
Dave Airlief453ba02008-11-07 14:05:41 -0800734 connector->encoder = new_encoder;
735 }
736 }
737
738 if (fail) {
739 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200740 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800741 }
742
743 count = 0;
744 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
745 if (!connector->encoder)
746 continue;
747
Dave Airlief453ba02008-11-07 14:05:41 -0800748 if (connector->encoder->crtc == set->crtc)
749 new_crtc = NULL;
750 else
751 new_crtc = connector->encoder->crtc;
752
753 for (ro = 0; ro < set->num_connectors; ro++) {
754 if (set->connectors[ro] == connector)
755 new_crtc = set->crtc;
756 }
Jesse Barnes7bec7562009-02-23 16:09:34 -0800757
758 /* Make sure the new CRTC will work with the encoder */
759 if (new_crtc &&
760 !drm_encoder_crtc_ok(connector->encoder, new_crtc)) {
761 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200762 goto fail;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800763 }
Dave Airlief453ba02008-11-07 14:05:41 -0800764 if (new_crtc != connector->encoder->crtc) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800765 DRM_DEBUG_KMS("crtc changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800766 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800767 connector->encoder->crtc = new_crtc;
768 }
Jerome Glisse94401062010-07-15 15:43:25 -0400769 if (new_crtc) {
770 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [CRTC:%d]\n",
771 connector->base.id, drm_get_connector_name(connector),
772 new_crtc->base.id);
773 } else {
774 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [NOCRTC]\n",
775 connector->base.id, drm_get_connector_name(connector));
776 }
Dave Airlief453ba02008-11-07 14:05:41 -0800777 }
778
779 /* mode_set_base is not a required function */
Jesse Barnes712531b2009-01-09 13:56:14 -0800780 if (fb_changed && !crtc_funcs->mode_set_base)
781 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800782
Jesse Barnes712531b2009-01-09 13:56:14 -0800783 if (mode_changed) {
Chris Wilson9334ef72011-01-28 11:53:03 +0000784 set->crtc->enabled = drm_helper_crtc_in_use(set->crtc);
785 if (set->crtc->enabled) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800786 DRM_DEBUG_KMS("attempting to set mode from"
787 " userspace\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800788 drm_mode_debug_printmodeline(set->mode);
Chris Wilson356ad3c2010-09-09 09:41:32 +0100789 old_fb = set->crtc->fb;
790 set->crtc->fb = set->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800791 if (!drm_crtc_helper_set_mode(set->crtc, set->mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500792 set->x, set->y,
793 old_fb)) {
Jerome Glisse94401062010-07-15 15:43:25 -0400794 DRM_ERROR("failed to set mode on [CRTC:%d]\n",
795 set->crtc->base.id);
Chris Wilson0ba41e42011-01-08 15:10:41 +0000796 set->crtc->fb = old_fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800797 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200798 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800799 }
Daniel Vetter25f397a2013-07-19 18:57:11 +0200800 DRM_DEBUG_KMS("Setting connector DPMS state to on\n");
801 for (i = 0; i < set->num_connectors; i++) {
802 DRM_DEBUG_KMS("\t[CONNECTOR:%d:%s] set DPMS on\n", set->connectors[i]->base.id,
803 drm_get_connector_name(set->connectors[i]));
804 set->connectors[i]->funcs->dpms(set->connectors[i], DRM_MODE_DPMS_ON);
805 }
Dave Airlief453ba02008-11-07 14:05:41 -0800806 }
807 drm_helper_disable_unused_functions(dev);
Jesse Barnes712531b2009-01-09 13:56:14 -0800808 } else if (fb_changed) {
Ben Skeggs9b1596a2009-09-18 10:43:52 +1000809 set->crtc->x = set->x;
810 set->crtc->y = set->y;
811
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500812 old_fb = set->crtc->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800813 if (set->crtc->fb != set->fb)
814 set->crtc->fb = set->fb;
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000815 ret = crtc_funcs->mode_set_base(set->crtc,
816 set->x, set->y, old_fb);
Chris Wilson0ba41e42011-01-08 15:10:41 +0000817 if (ret != 0) {
818 set->crtc->fb = old_fb;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200819 goto fail;
Chris Wilson0ba41e42011-01-08 15:10:41 +0000820 }
Dave Airlief453ba02008-11-07 14:05:41 -0800821 }
822
Maarten Maathuise67aae72009-08-27 10:18:29 +0200823 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800824 kfree(save_encoders);
825 kfree(save_crtcs);
826 return 0;
827
Maarten Maathuise67aae72009-08-27 10:18:29 +0200828fail:
829 /* Restore all previous data. */
Dave Airlief453ba02008-11-07 14:05:41 -0800830 count = 0;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200831 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
832 *crtc = save_crtcs[count++];
833 }
Chris Wilsone62fb642009-02-11 16:39:21 +0000834
Maarten Maathuise67aae72009-08-27 10:18:29 +0200835 count = 0;
836 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
837 *encoder = save_encoders[count++];
Chris Wilsone62fb642009-02-11 16:39:21 +0000838 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200839
Dave Airlief453ba02008-11-07 14:05:41 -0800840 count = 0;
841 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Maarten Maathuise67aae72009-08-27 10:18:29 +0200842 *connector = save_connectors[count++];
Dave Airlief453ba02008-11-07 14:05:41 -0800843 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200844
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800845 /* Try to restore the config */
846 if (mode_changed &&
847 !drm_crtc_helper_set_mode(save_set.crtc, save_set.mode, save_set.x,
848 save_set.y, save_set.fb))
849 DRM_ERROR("failed to restore config after modeset failure\n");
850
Maarten Maathuise67aae72009-08-27 10:18:29 +0200851 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800852 kfree(save_encoders);
Maarten Maathuise67aae72009-08-27 10:18:29 +0200853 kfree(save_crtcs);
Dave Airlief453ba02008-11-07 14:05:41 -0800854 return ret;
855}
856EXPORT_SYMBOL(drm_crtc_helper_set_config);
857
Keith Packardc9fb15f2009-05-30 20:42:28 -0700858static int drm_helper_choose_encoder_dpms(struct drm_encoder *encoder)
859{
860 int dpms = DRM_MODE_DPMS_OFF;
861 struct drm_connector *connector;
862 struct drm_device *dev = encoder->dev;
863
864 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
865 if (connector->encoder == encoder)
866 if (connector->dpms < dpms)
867 dpms = connector->dpms;
868 return dpms;
869}
870
Sean Paul3b336ec2013-08-14 16:47:37 -0400871/* Helper which handles bridge ordering around encoder dpms */
872static void drm_helper_encoder_dpms(struct drm_encoder *encoder, int mode)
873{
874 struct drm_bridge *bridge = encoder->bridge;
875 struct drm_encoder_helper_funcs *encoder_funcs;
876
877 if (bridge) {
878 if (mode == DRM_MODE_DPMS_ON)
879 bridge->funcs->pre_enable(bridge);
880 else
881 bridge->funcs->disable(bridge);
882 }
883
884 encoder_funcs = encoder->helper_private;
885 if (encoder_funcs->dpms)
886 encoder_funcs->dpms(encoder, mode);
887
888 if (bridge) {
889 if (mode == DRM_MODE_DPMS_ON)
890 bridge->funcs->enable(bridge);
891 else
892 bridge->funcs->post_disable(bridge);
893 }
894}
895
Keith Packardc9fb15f2009-05-30 20:42:28 -0700896static int drm_helper_choose_crtc_dpms(struct drm_crtc *crtc)
897{
898 int dpms = DRM_MODE_DPMS_OFF;
899 struct drm_connector *connector;
900 struct drm_device *dev = crtc->dev;
901
902 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
903 if (connector->encoder && connector->encoder->crtc == crtc)
904 if (connector->dpms < dpms)
905 dpms = connector->dpms;
906 return dpms;
907}
908
909/**
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100910 * drm_helper_connector_dpms() - connector dpms helper implementation
911 * @connector: affected connector
912 * @mode: DPMS mode
Keith Packardc9fb15f2009-05-30 20:42:28 -0700913 *
Daniel Vetter0d4ed4c2012-11-01 14:45:16 +0100914 * This is the main helper function provided by the crtc helper framework for
915 * implementing the DPMS connector attribute. It computes the new desired DPMS
916 * state for all encoders and crtcs in the output mesh and calls the ->dpms()
917 * callback provided by the driver appropriately.
Keith Packardc9fb15f2009-05-30 20:42:28 -0700918 */
919void drm_helper_connector_dpms(struct drm_connector *connector, int mode)
920{
921 struct drm_encoder *encoder = connector->encoder;
922 struct drm_crtc *crtc = encoder ? encoder->crtc : NULL;
Sean Paul3b336ec2013-08-14 16:47:37 -0400923 int old_dpms, encoder_dpms = DRM_MODE_DPMS_OFF;
Keith Packardc9fb15f2009-05-30 20:42:28 -0700924
925 if (mode == connector->dpms)
926 return;
927
928 old_dpms = connector->dpms;
929 connector->dpms = mode;
930
Sean Paul3b336ec2013-08-14 16:47:37 -0400931 if (encoder)
932 encoder_dpms = drm_helper_choose_encoder_dpms(encoder);
933
Keith Packardc9fb15f2009-05-30 20:42:28 -0700934 /* from off to on, do crtc then encoder */
935 if (mode < old_dpms) {
936 if (crtc) {
937 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
938 if (crtc_funcs->dpms)
939 (*crtc_funcs->dpms) (crtc,
940 drm_helper_choose_crtc_dpms(crtc));
941 }
Sean Paul3b336ec2013-08-14 16:47:37 -0400942 if (encoder)
943 drm_helper_encoder_dpms(encoder, encoder_dpms);
Keith Packardc9fb15f2009-05-30 20:42:28 -0700944 }
945
946 /* from on to off, do encoder then crtc */
947 if (mode > old_dpms) {
Sean Paul3b336ec2013-08-14 16:47:37 -0400948 if (encoder)
949 drm_helper_encoder_dpms(encoder, encoder_dpms);
Keith Packardc9fb15f2009-05-30 20:42:28 -0700950 if (crtc) {
951 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
952 if (crtc_funcs->dpms)
953 (*crtc_funcs->dpms) (crtc,
954 drm_helper_choose_crtc_dpms(crtc));
955 }
956 }
957
958 return;
959}
960EXPORT_SYMBOL(drm_helper_connector_dpms);
961
Dave Airlief453ba02008-11-07 14:05:41 -0800962int drm_helper_mode_fill_fb_struct(struct drm_framebuffer *fb,
Jesse Barnes308e5bc2011-11-14 14:51:28 -0800963 struct drm_mode_fb_cmd2 *mode_cmd)
Dave Airlief453ba02008-11-07 14:05:41 -0800964{
Ville Syrjälä01f2c772011-12-20 00:06:49 +0200965 int i;
966
Dave Airlief453ba02008-11-07 14:05:41 -0800967 fb->width = mode_cmd->width;
968 fb->height = mode_cmd->height;
Ville Syrjälä01f2c772011-12-20 00:06:49 +0200969 for (i = 0; i < 4; i++) {
970 fb->pitches[i] = mode_cmd->pitches[i];
971 fb->offsets[i] = mode_cmd->offsets[i];
972 }
Dave Airlie248dbc22011-11-29 20:02:54 +0000973 drm_fb_get_bpp_depth(mode_cmd->pixel_format, &fb->depth,
Jesse Barnes308e5bc2011-11-14 14:51:28 -0800974 &fb->bits_per_pixel);
975 fb->pixel_format = mode_cmd->pixel_format;
Dave Airlief453ba02008-11-07 14:05:41 -0800976
977 return 0;
978}
979EXPORT_SYMBOL(drm_helper_mode_fill_fb_struct);
980
981int drm_helper_resume_force_mode(struct drm_device *dev)
982{
983 struct drm_crtc *crtc;
David John89347bb2009-12-31 12:00:46 +0530984 struct drm_encoder *encoder;
David John89347bb2009-12-31 12:00:46 +0530985 struct drm_crtc_helper_funcs *crtc_funcs;
Sean Paul3b336ec2013-08-14 16:47:37 -0400986 int ret, encoder_dpms;
Dave Airlief453ba02008-11-07 14:05:41 -0800987
988 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
989
990 if (!crtc->enabled)
991 continue;
992
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500993 ret = drm_crtc_helper_set_mode(crtc, &crtc->mode,
994 crtc->x, crtc->y, crtc->fb);
Dave Airlief453ba02008-11-07 14:05:41 -0800995
996 if (ret == false)
997 DRM_ERROR("failed to set mode on crtc %p\n", crtc);
David John89347bb2009-12-31 12:00:46 +0530998
999 /* Turn off outputs that were already powered off */
1000 if (drm_helper_choose_crtc_dpms(crtc)) {
1001 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
1002
1003 if(encoder->crtc != crtc)
1004 continue;
1005
Sean Paul3b336ec2013-08-14 16:47:37 -04001006 encoder_dpms = drm_helper_choose_encoder_dpms(
1007 encoder);
1008
1009 drm_helper_encoder_dpms(encoder, encoder_dpms);
David John89347bb2009-12-31 12:00:46 +05301010 }
Chris Wilson817e6312010-08-06 15:03:31 +01001011
1012 crtc_funcs = crtc->helper_private;
1013 if (crtc_funcs->dpms)
1014 (*crtc_funcs->dpms) (crtc,
1015 drm_helper_choose_crtc_dpms(crtc));
David John89347bb2009-12-31 12:00:46 +05301016 }
Dave Airlief453ba02008-11-07 14:05:41 -08001017 }
Zhao Yakuiaf4fcb52009-07-08 14:13:13 +08001018 /* disable the unused connectors while restoring the modesetting */
1019 drm_helper_disable_unused_functions(dev);
Dave Airlief453ba02008-11-07 14:05:41 -08001020 return 0;
1021}
1022EXPORT_SYMBOL(drm_helper_resume_force_mode);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001023
Daniel Vetter3d3683f2012-10-23 18:23:32 +00001024void drm_kms_helper_hotplug_event(struct drm_device *dev)
1025{
1026 /* send a uevent + call fbdev */
1027 drm_sysfs_hotplug_event(dev);
1028 if (dev->mode_config.funcs->output_poll_changed)
1029 dev->mode_config.funcs->output_poll_changed(dev);
1030}
1031EXPORT_SYMBOL(drm_kms_helper_hotplug_event);
1032
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001033#define DRM_OUTPUT_POLL_PERIOD (10*HZ)
Tejun Heo991ea752010-07-20 22:09:02 +02001034static void output_poll_execute(struct work_struct *work)
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001035{
Tejun Heo991ea752010-07-20 22:09:02 +02001036 struct delayed_work *delayed_work = to_delayed_work(work);
1037 struct drm_device *dev = container_of(delayed_work, struct drm_device, mode_config.output_poll_work);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001038 struct drm_connector *connector;
Keith Packardc5027de2010-11-26 10:45:59 -08001039 enum drm_connector_status old_status;
Dave Airlied482e5f2013-06-28 20:31:34 +10001040 bool repoll = false, changed = false;
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001041
Chris Wilsone58f6372010-08-20 09:13:36 +01001042 if (!drm_kms_helper_poll)
1043 return;
1044
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001045 mutex_lock(&dev->mode_config.mutex);
1046 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
1047
Daniel Vetter11e68682012-10-23 18:23:38 +00001048 /* Ignore forced connectors. */
1049 if (connector->force)
1050 continue;
1051
Daniel Vetter816da852012-10-23 18:23:33 +00001052 /* Ignore HPD capable connectors and connectors where we don't
1053 * want any hotplug detection at all for polling. */
1054 if (!connector->polled || connector->polled == DRM_CONNECTOR_POLL_HPD)
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001055 continue;
1056
Daniel Vettera4f968d2012-10-24 13:35:50 +00001057 repoll = true;
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001058
1059 old_status = connector->status;
1060 /* if we are connected and don't want to poll for disconnect
1061 skip it */
1062 if (old_status == connector_status_connected &&
Daniel Vetter816da852012-10-23 18:23:33 +00001063 !(connector->polled & DRM_CONNECTOR_POLL_DISCONNECT))
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001064 continue;
1065
Keith Packardc5027de2010-11-26 10:45:59 -08001066 connector->status = connector->funcs->detect(connector, false);
Lespiau, Damienb2dfcae2013-05-10 12:36:44 +00001067 if (old_status != connector->status) {
1068 const char *old, *new;
1069
1070 old = drm_get_connector_status_name(old_status);
1071 new = drm_get_connector_status_name(connector->status);
1072
1073 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] "
1074 "status updated from %s to %s\n",
1075 connector->base.id,
1076 drm_get_connector_name(connector),
1077 old, new);
1078
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001079 changed = true;
Lespiau, Damienb2dfcae2013-05-10 12:36:44 +00001080 }
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001081 }
1082
1083 mutex_unlock(&dev->mode_config.mutex);
1084
Daniel Vetter3d3683f2012-10-23 18:23:32 +00001085 if (changed)
1086 drm_kms_helper_hotplug_event(dev);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001087
Tejun Heo9a919c42010-08-09 12:01:27 +02001088 if (repoll)
Tejun Heo3b07e9c2012-08-20 14:51:24 -07001089 schedule_delayed_work(delayed_work, DRM_OUTPUT_POLL_PERIOD);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001090}
1091
Dave Airliefbf81762010-06-01 09:09:06 +10001092void drm_kms_helper_poll_disable(struct drm_device *dev)
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001093{
Dave Airliefbf81762010-06-01 09:09:06 +10001094 if (!dev->mode_config.poll_enabled)
1095 return;
Tejun Heo991ea752010-07-20 22:09:02 +02001096 cancel_delayed_work_sync(&dev->mode_config.output_poll_work);
Dave Airliefbf81762010-06-01 09:09:06 +10001097}
1098EXPORT_SYMBOL(drm_kms_helper_poll_disable);
1099
1100void drm_kms_helper_poll_enable(struct drm_device *dev)
1101{
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001102 bool poll = false;
Dave Airliefbf81762010-06-01 09:09:06 +10001103 struct drm_connector *connector;
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001104
Chris Wilsone58f6372010-08-20 09:13:36 +01001105 if (!dev->mode_config.poll_enabled || !drm_kms_helper_poll)
1106 return;
1107
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001108 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Daniel Vettera4f968d2012-10-24 13:35:50 +00001109 if (connector->polled & (DRM_CONNECTOR_POLL_CONNECT |
1110 DRM_CONNECTOR_POLL_DISCONNECT))
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001111 poll = true;
1112 }
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001113
Tejun Heo9a919c42010-08-09 12:01:27 +02001114 if (poll)
Tejun Heo3b07e9c2012-08-20 14:51:24 -07001115 schedule_delayed_work(&dev->mode_config.output_poll_work, DRM_OUTPUT_POLL_PERIOD);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001116}
Dave Airliefbf81762010-06-01 09:09:06 +10001117EXPORT_SYMBOL(drm_kms_helper_poll_enable);
1118
1119void drm_kms_helper_poll_init(struct drm_device *dev)
1120{
Tejun Heo991ea752010-07-20 22:09:02 +02001121 INIT_DELAYED_WORK(&dev->mode_config.output_poll_work, output_poll_execute);
Dave Airliefbf81762010-06-01 09:09:06 +10001122 dev->mode_config.poll_enabled = true;
1123
1124 drm_kms_helper_poll_enable(dev);
1125}
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001126EXPORT_SYMBOL(drm_kms_helper_poll_init);
1127
1128void drm_kms_helper_poll_fini(struct drm_device *dev)
1129{
Dave Airliefbf81762010-06-01 09:09:06 +10001130 drm_kms_helper_poll_disable(dev);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001131}
1132EXPORT_SYMBOL(drm_kms_helper_poll_fini);
1133
Marc-André Lureaub8206d32013-10-18 16:11:28 +02001134bool drm_helper_hpd_irq_event(struct drm_device *dev)
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001135{
Daniel Vetter816da852012-10-23 18:23:33 +00001136 struct drm_connector *connector;
1137 enum drm_connector_status old_status;
1138 bool changed = false;
1139
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001140 if (!dev->mode_config.poll_enabled)
Marc-André Lureaub8206d32013-10-18 16:11:28 +02001141 return false;
Chris Wilsone58f6372010-08-20 09:13:36 +01001142
Daniel Vetter816da852012-10-23 18:23:33 +00001143 mutex_lock(&dev->mode_config.mutex);
1144 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
1145
1146 /* Only handle HPD capable connectors. */
1147 if (!(connector->polled & DRM_CONNECTOR_POLL_HPD))
1148 continue;
1149
1150 old_status = connector->status;
1151
1152 connector->status = connector->funcs->detect(connector, false);
Lespiau, Damiened7951d2013-05-10 12:36:42 +00001153 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n",
Daniel Vetter816da852012-10-23 18:23:33 +00001154 connector->base.id,
1155 drm_get_connector_name(connector),
Lespiau, Damiened7951d2013-05-10 12:36:42 +00001156 drm_get_connector_status_name(old_status),
1157 drm_get_connector_status_name(connector->status));
Daniel Vetter816da852012-10-23 18:23:33 +00001158 if (old_status != connector->status)
1159 changed = true;
1160 }
1161
1162 mutex_unlock(&dev->mode_config.mutex);
1163
1164 if (changed)
1165 drm_kms_helper_hotplug_event(dev);
Marc-André Lureaub8206d32013-10-18 16:11:28 +02001166
1167 return changed;
Daniel Vetter816da852012-10-23 18:23:33 +00001168}
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001169EXPORT_SYMBOL(drm_helper_hpd_irq_event);