2 * Copyright (c) 2006-2008 Intel Corporation
3 * Copyright (c) 2007 Dave Airlie <airlied@linux.ie>
5 * DRM core CRTC related functions
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.
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
27 * Eric Anholt <eric@anholt.net>
28 * Dave Airlie <airlied@linux.ie>
29 * Jesse Barnes <jesse.barnes@intel.com>
32 #include <linux/export.h>
33 #include <linux/moduleparam.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>
42 MODULE_AUTHOR("David Airlie, Jesse Barnes");
43 MODULE_DESCRIPTION("DRM KMS helper");
44 MODULE_LICENSE("GPL and additional rights");
47 * drm_helper_move_panel_connectors_to_head() - move panels to the front in the
49 * @dev: drm device to operate on
51 * Some userspace presumes that the first connected connector is the main
52 * display, where it's supposed to display e.g. the login screen. For
53 * laptops, this should be the main panel. Use this function to sort all
54 * (eDP/LVDS) panels to the front of the connector list, instead of
55 * painstakingly trying to initialize them in the right order.
57 void drm_helper_move_panel_connectors_to_head(struct drm_device *dev)
59 struct drm_connector *connector, *tmp;
60 struct list_head panel_list;
62 INIT_LIST_HEAD(&panel_list);
64 list_for_each_entry_safe(connector, tmp,
65 &dev->mode_config.connector_list, head) {
66 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS ||
67 connector->connector_type == DRM_MODE_CONNECTOR_eDP)
68 list_move_tail(&connector->head, &panel_list);
71 list_splice(&panel_list, &dev->mode_config.connector_list);
73 EXPORT_SYMBOL(drm_helper_move_panel_connectors_to_head);
75 static bool drm_kms_helper_poll = true;
76 module_param_named(poll, drm_kms_helper_poll, bool, 0600);
78 static void drm_mode_validate_flag(struct drm_connector *connector,
81 struct drm_display_mode *mode;
83 if (flags == (DRM_MODE_FLAG_DBLSCAN | DRM_MODE_FLAG_INTERLACE |
84 DRM_MODE_FLAG_3D_MASK))
87 list_for_each_entry(mode, &connector->modes, head) {
88 if ((mode->flags & DRM_MODE_FLAG_INTERLACE) &&
89 !(flags & DRM_MODE_FLAG_INTERLACE))
90 mode->status = MODE_NO_INTERLACE;
91 if ((mode->flags & DRM_MODE_FLAG_DBLSCAN) &&
92 !(flags & DRM_MODE_FLAG_DBLSCAN))
93 mode->status = MODE_NO_DBLESCAN;
94 if ((mode->flags & DRM_MODE_FLAG_3D_MASK) &&
95 !(flags & DRM_MODE_FLAG_3D_MASK))
96 mode->status = MODE_NO_STEREO;
103 * drm_helper_probe_single_connector_modes - get complete set of display modes
104 * @connector: connector to probe
105 * @maxX: max width for modes
106 * @maxY: max height for modes
108 * Based on the helper callbacks implemented by @connector try to detect all
109 * valid modes. Modes will first be added to the connector's probed_modes list,
110 * then culled (based on validity and the @maxX, @maxY parameters) and put into
111 * the normal modes list.
113 * Intended to be use as a generic implementation of the ->fill_modes()
114 * @connector vfunc for drivers that use the crtc helpers for output mode
115 * filtering and detection.
118 * The number of modes found on @connector.
120 int drm_helper_probe_single_connector_modes(struct drm_connector *connector,
121 uint32_t maxX, uint32_t maxY)
123 struct drm_device *dev = connector->dev;
124 struct drm_display_mode *mode;
125 struct drm_connector_helper_funcs *connector_funcs =
126 connector->helper_private;
129 bool verbose_prune = true;
131 WARN_ON(!mutex_is_locked(&dev->mode_config.mutex));
133 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id,
134 drm_get_connector_name(connector));
135 /* set all modes to the unverified state */
136 list_for_each_entry(mode, &connector->modes, head)
137 mode->status = MODE_UNVERIFIED;
139 if (connector->force) {
140 if (connector->force == DRM_FORCE_ON)
141 connector->status = connector_status_connected;
143 connector->status = connector_status_disconnected;
144 if (connector->funcs->force)
145 connector->funcs->force(connector);
147 connector->status = connector->funcs->detect(connector, true);
150 /* Re-enable polling in case the global poll config changed. */
151 if (drm_kms_helper_poll != dev->mode_config.poll_running)
152 drm_kms_helper_poll_enable(dev);
154 dev->mode_config.poll_running = drm_kms_helper_poll;
156 if (connector->status == connector_status_disconnected) {
157 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] disconnected\n",
158 connector->base.id, drm_get_connector_name(connector));
159 drm_mode_connector_update_edid_property(connector, NULL);
160 verbose_prune = false;
164 #ifdef CONFIG_DRM_LOAD_EDID_FIRMWARE
165 count = drm_load_edid_firmware(connector);
168 count = (*connector_funcs->get_modes)(connector);
170 if (count == 0 && connector->status == connector_status_connected)
171 count = drm_add_modes_noedid(connector, 1024, 768);
175 drm_mode_connector_list_update(connector);
178 drm_mode_validate_size(dev, &connector->modes, maxX, maxY);
180 if (connector->interlace_allowed)
181 mode_flags |= DRM_MODE_FLAG_INTERLACE;
182 if (connector->doublescan_allowed)
183 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
184 if (connector->stereo_allowed)
185 mode_flags |= DRM_MODE_FLAG_3D_MASK;
186 drm_mode_validate_flag(connector, mode_flags);
188 list_for_each_entry(mode, &connector->modes, head) {
189 if (mode->status == MODE_OK)
190 mode->status = connector_funcs->mode_valid(connector,
195 drm_mode_prune_invalid(dev, &connector->modes, verbose_prune);
197 if (list_empty(&connector->modes))
200 list_for_each_entry(mode, &connector->modes, head)
201 mode->vrefresh = drm_mode_vrefresh(mode);
203 drm_mode_sort(&connector->modes);
205 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector->base.id,
206 drm_get_connector_name(connector));
207 list_for_each_entry(mode, &connector->modes, head) {
208 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
209 drm_mode_debug_printmodeline(mode);
214 EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
217 * drm_helper_encoder_in_use - check if a given encoder is in use
218 * @encoder: encoder to check
220 * Checks whether @encoder is with the current mode setting output configuration
221 * in use by any connector. This doesn't mean that it is actually enabled since
222 * the DPMS state is tracked separately.
225 * True if @encoder is used, false otherwise.
227 bool drm_helper_encoder_in_use(struct drm_encoder *encoder)
229 struct drm_connector *connector;
230 struct drm_device *dev = encoder->dev;
232 WARN_ON(!mutex_is_locked(&dev->mode_config.mutex));
233 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
234 if (connector->encoder == encoder)
238 EXPORT_SYMBOL(drm_helper_encoder_in_use);
241 * drm_helper_crtc_in_use - check if a given CRTC is in a mode_config
242 * @crtc: CRTC to check
244 * Checks whether @crtc is with the current mode setting output configuration
245 * in use by any connector. This doesn't mean that it is actually enabled since
246 * the DPMS state is tracked separately.
249 * True if @crtc is used, false otherwise.
251 bool drm_helper_crtc_in_use(struct drm_crtc *crtc)
253 struct drm_encoder *encoder;
254 struct drm_device *dev = crtc->dev;
256 WARN_ON(!mutex_is_locked(&dev->mode_config.mutex));
257 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
258 if (encoder->crtc == crtc && drm_helper_encoder_in_use(encoder))
262 EXPORT_SYMBOL(drm_helper_crtc_in_use);
265 drm_encoder_disable(struct drm_encoder *encoder)
267 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
270 encoder->bridge->funcs->disable(encoder->bridge);
272 if (encoder_funcs->disable)
273 (*encoder_funcs->disable)(encoder);
275 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
278 encoder->bridge->funcs->post_disable(encoder->bridge);
281 static void __drm_helper_disable_unused_functions(struct drm_device *dev)
283 struct drm_encoder *encoder;
284 struct drm_connector *connector;
285 struct drm_crtc *crtc;
287 drm_warn_on_modeset_not_all_locked(dev);
289 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
290 if (!connector->encoder)
294 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
295 if (!drm_helper_encoder_in_use(encoder)) {
296 drm_encoder_disable(encoder);
297 /* disconnector encoder from any connector */
298 encoder->crtc = NULL;
302 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
303 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
304 crtc->enabled = drm_helper_crtc_in_use(crtc);
305 if (!crtc->enabled) {
306 if (crtc_funcs->disable)
307 (*crtc_funcs->disable)(crtc);
309 (*crtc_funcs->dpms)(crtc, DRM_MODE_DPMS_OFF);
310 crtc->primary->fb = NULL;
316 * drm_helper_disable_unused_functions - disable unused objects
319 * This function walks through the entire mode setting configuration of @dev. It
320 * will remove any crtc links of unused encoders and encoder links of
321 * disconnected connectors. Then it will disable all unused encoders and crtcs
322 * either by calling their disable callback if available or by calling their
323 * dpms callback with DRM_MODE_DPMS_OFF.
325 void drm_helper_disable_unused_functions(struct drm_device *dev)
327 drm_modeset_lock_all(dev);
328 __drm_helper_disable_unused_functions(dev);
329 drm_modeset_unlock_all(dev);
331 EXPORT_SYMBOL(drm_helper_disable_unused_functions);
334 * Check the CRTC we're going to map each output to vs. its current
335 * CRTC. If they don't match, we have to disable the output and the CRTC
336 * since the driver will have to re-route things.
339 drm_crtc_prepare_encoders(struct drm_device *dev)
341 struct drm_encoder_helper_funcs *encoder_funcs;
342 struct drm_encoder *encoder;
344 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
345 encoder_funcs = encoder->helper_private;
346 /* Disable unused encoders */
347 if (encoder->crtc == NULL)
348 drm_encoder_disable(encoder);
349 /* Disable encoders whose CRTC is about to change */
350 if (encoder_funcs->get_crtc &&
351 encoder->crtc != (*encoder_funcs->get_crtc)(encoder))
352 drm_encoder_disable(encoder);
357 * drm_crtc_helper_set_mode - internal helper to set a mode
358 * @crtc: CRTC to program
360 * @x: horizontal offset into the surface
361 * @y: vertical offset into the surface
362 * @old_fb: old framebuffer, for cleanup
364 * Try to set @mode on @crtc. Give @crtc and its associated connectors a chance
365 * to fixup or reject the mode prior to trying to set it. This is an internal
366 * helper that drivers could e.g. use to update properties that require the
367 * entire output pipe to be disabled and re-enabled in a new configuration. For
368 * example for changing whether audio is enabled on a hdmi link or for changing
369 * panel fitter or dither attributes. It is also called by the
370 * drm_crtc_helper_set_config() helper function to drive the mode setting
374 * True if the mode was set successfully, false otherwise.
376 bool drm_crtc_helper_set_mode(struct drm_crtc *crtc,
377 struct drm_display_mode *mode,
379 struct drm_framebuffer *old_fb)
381 struct drm_device *dev = crtc->dev;
382 struct drm_display_mode *adjusted_mode, saved_mode;
383 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
384 struct drm_encoder_helper_funcs *encoder_funcs;
385 int saved_x, saved_y;
387 struct drm_encoder *encoder;
390 drm_warn_on_modeset_not_all_locked(dev);
392 saved_enabled = crtc->enabled;
393 crtc->enabled = drm_helper_crtc_in_use(crtc);
397 adjusted_mode = drm_mode_duplicate(dev, mode);
398 if (!adjusted_mode) {
399 crtc->enabled = saved_enabled;
403 saved_mode = crtc->mode;
407 /* Update crtc values up front so the driver can rely on them for mode
414 /* Pass our mode to the connectors and the CRTC to give them a chance to
415 * adjust it according to limitations or connector properties, and also
416 * a chance to reject the mode entirely.
418 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
420 if (encoder->crtc != crtc)
423 if (encoder->bridge && encoder->bridge->funcs->mode_fixup) {
424 ret = encoder->bridge->funcs->mode_fixup(
425 encoder->bridge, mode, adjusted_mode);
427 DRM_DEBUG_KMS("Bridge fixup failed\n");
432 encoder_funcs = encoder->helper_private;
433 if (!(ret = encoder_funcs->mode_fixup(encoder, mode,
435 DRM_DEBUG_KMS("Encoder fixup failed\n");
440 if (!(ret = crtc_funcs->mode_fixup(crtc, mode, adjusted_mode))) {
441 DRM_DEBUG_KMS("CRTC fixup failed\n");
444 DRM_DEBUG_KMS("[CRTC:%d]\n", crtc->base.id);
446 /* Prepare the encoders and CRTCs before setting the mode. */
447 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
449 if (encoder->crtc != crtc)
453 encoder->bridge->funcs->disable(encoder->bridge);
455 encoder_funcs = encoder->helper_private;
456 /* Disable the encoders as the first thing we do. */
457 encoder_funcs->prepare(encoder);
460 encoder->bridge->funcs->post_disable(encoder->bridge);
463 drm_crtc_prepare_encoders(dev);
465 crtc_funcs->prepare(crtc);
467 /* Set up the DPLL and any encoders state that needs to adjust or depend
470 ret = !crtc_funcs->mode_set(crtc, mode, adjusted_mode, x, y, old_fb);
474 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
476 if (encoder->crtc != crtc)
479 DRM_DEBUG_KMS("[ENCODER:%d:%s] set [MODE:%d:%s]\n",
480 encoder->base.id, drm_get_encoder_name(encoder),
481 mode->base.id, mode->name);
482 encoder_funcs = encoder->helper_private;
483 encoder_funcs->mode_set(encoder, mode, adjusted_mode);
485 if (encoder->bridge && encoder->bridge->funcs->mode_set)
486 encoder->bridge->funcs->mode_set(encoder->bridge, mode,
490 /* Now enable the clocks, plane, pipe, and connectors that we set up. */
491 crtc_funcs->commit(crtc);
493 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
495 if (encoder->crtc != crtc)
499 encoder->bridge->funcs->pre_enable(encoder->bridge);
501 encoder_funcs = encoder->helper_private;
502 encoder_funcs->commit(encoder);
505 encoder->bridge->funcs->enable(encoder->bridge);
508 /* Store real post-adjustment hardware mode. */
509 crtc->hwmode = *adjusted_mode;
511 /* Calculate and store various constants which
512 * are later needed by vblank and swap-completion
513 * timestamping. They are derived from true hwmode.
515 drm_calc_timestamping_constants(crtc, &crtc->hwmode);
517 /* FIXME: add subpixel order */
519 drm_mode_destroy(dev, adjusted_mode);
521 crtc->enabled = saved_enabled;
522 crtc->mode = saved_mode;
529 EXPORT_SYMBOL(drm_crtc_helper_set_mode);
533 drm_crtc_helper_disable(struct drm_crtc *crtc)
535 struct drm_device *dev = crtc->dev;
536 struct drm_connector *connector;
537 struct drm_encoder *encoder;
539 /* Decouple all encoders and their attached connectors from this crtc */
540 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
541 if (encoder->crtc != crtc)
544 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
545 if (connector->encoder != encoder)
548 connector->encoder = NULL;
551 * drm_helper_disable_unused_functions() ought to be
552 * doing this, but since we've decoupled the encoder
553 * from the connector above, the required connection
554 * between them is henceforth no longer available.
556 connector->dpms = DRM_MODE_DPMS_OFF;
560 __drm_helper_disable_unused_functions(dev);
565 * drm_crtc_helper_set_config - set a new config from userspace
566 * @set: mode set configuration
568 * Setup a new configuration, provided by the upper layers (either an ioctl call
569 * from userspace or internally e.g. from the fbdev support code) in @set, and
570 * enable it. This is the main helper functions for drivers that implement
571 * kernel mode setting with the crtc helper functions and the assorted
572 * ->prepare(), ->modeset() and ->commit() helper callbacks.
575 * Returns 0 on success, negative errno numbers on failure.
577 int drm_crtc_helper_set_config(struct drm_mode_set *set)
579 struct drm_device *dev;
580 struct drm_crtc *new_crtc;
581 struct drm_encoder *save_encoders, *new_encoder, *encoder;
582 bool mode_changed = false; /* if true do a full mode set */
583 bool fb_changed = false; /* if true and !mode_changed just do a flip */
584 struct drm_connector *save_connectors, *connector;
585 int count = 0, ro, fail = 0;
586 struct drm_crtc_helper_funcs *crtc_funcs;
587 struct drm_mode_set save_set;
595 BUG_ON(!set->crtc->helper_private);
597 /* Enforce sane interface api - has been abused by the fb helper. */
598 BUG_ON(!set->mode && set->fb);
599 BUG_ON(set->fb && set->num_connectors == 0);
601 crtc_funcs = set->crtc->helper_private;
607 DRM_DEBUG_KMS("[CRTC:%d] [FB:%d] #connectors=%d (x y) (%i %i)\n",
608 set->crtc->base.id, set->fb->base.id,
609 (int)set->num_connectors, set->x, set->y);
611 DRM_DEBUG_KMS("[CRTC:%d] [NOFB]\n", set->crtc->base.id);
612 return drm_crtc_helper_disable(set->crtc);
615 dev = set->crtc->dev;
617 drm_warn_on_modeset_not_all_locked(dev);
620 * Allocate space for the backup of all (non-pointer) encoder and
623 save_encoders = kzalloc(dev->mode_config.num_encoder *
624 sizeof(struct drm_encoder), GFP_KERNEL);
628 save_connectors = kzalloc(dev->mode_config.num_connector *
629 sizeof(struct drm_connector), GFP_KERNEL);
630 if (!save_connectors) {
631 kfree(save_encoders);
636 * Copy data. Note that driver private data is not affected.
637 * Should anything bad happen only the expected state is
638 * restored, not the drivers personal bookkeeping.
641 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
642 save_encoders[count++] = *encoder;
646 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
647 save_connectors[count++] = *connector;
650 save_set.crtc = set->crtc;
651 save_set.mode = &set->crtc->mode;
652 save_set.x = set->crtc->x;
653 save_set.y = set->crtc->y;
654 save_set.fb = set->crtc->primary->fb;
656 /* We should be able to check here if the fb has the same properties
657 * and then just flip_or_move it */
658 if (set->crtc->primary->fb != set->fb) {
659 /* If we have no fb then treat it as a full mode set */
660 if (set->crtc->primary->fb == NULL) {
661 DRM_DEBUG_KMS("crtc has no fb, full mode set\n");
663 } else if (set->fb == NULL) {
665 } else if (set->fb->pixel_format !=
666 set->crtc->primary->fb->pixel_format) {
672 if (set->x != set->crtc->x || set->y != set->crtc->y)
675 if (set->mode && !drm_mode_equal(set->mode, &set->crtc->mode)) {
676 DRM_DEBUG_KMS("modes are different, full mode set\n");
677 drm_mode_debug_printmodeline(&set->crtc->mode);
678 drm_mode_debug_printmodeline(set->mode);
682 /* a) traverse passed in connector list and get encoders for them */
684 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
685 struct drm_connector_helper_funcs *connector_funcs =
686 connector->helper_private;
687 new_encoder = connector->encoder;
688 for (ro = 0; ro < set->num_connectors; ro++) {
689 if (set->connectors[ro] == connector) {
690 new_encoder = connector_funcs->best_encoder(connector);
691 /* if we can't get an encoder for a connector
692 we are setting now - then fail */
693 if (new_encoder == NULL)
694 /* don't break so fail path works correct */
697 if (connector->dpms != DRM_MODE_DPMS_ON) {
698 DRM_DEBUG_KMS("connector dpms not on, full mode switch\n");
706 if (new_encoder != connector->encoder) {
707 DRM_DEBUG_KMS("encoder changed, full mode switch\n");
709 /* If the encoder is reused for another connector, then
710 * the appropriate crtc will be set later.
712 if (connector->encoder)
713 connector->encoder->crtc = NULL;
714 connector->encoder = new_encoder;
724 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
725 if (!connector->encoder)
728 if (connector->encoder->crtc == set->crtc)
731 new_crtc = connector->encoder->crtc;
733 for (ro = 0; ro < set->num_connectors; ro++) {
734 if (set->connectors[ro] == connector)
735 new_crtc = set->crtc;
738 /* Make sure the new CRTC will work with the encoder */
740 !drm_encoder_crtc_ok(connector->encoder, new_crtc)) {
744 if (new_crtc != connector->encoder->crtc) {
745 DRM_DEBUG_KMS("crtc changed, full mode switch\n");
747 connector->encoder->crtc = new_crtc;
750 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [CRTC:%d]\n",
751 connector->base.id, drm_get_connector_name(connector),
754 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [NOCRTC]\n",
755 connector->base.id, drm_get_connector_name(connector));
759 /* mode_set_base is not a required function */
760 if (fb_changed && !crtc_funcs->mode_set_base)
764 if (drm_helper_crtc_in_use(set->crtc)) {
765 DRM_DEBUG_KMS("attempting to set mode from"
767 drm_mode_debug_printmodeline(set->mode);
768 set->crtc->primary->fb = set->fb;
769 if (!drm_crtc_helper_set_mode(set->crtc, set->mode,
772 DRM_ERROR("failed to set mode on [CRTC:%d]\n",
774 set->crtc->primary->fb = save_set.fb;
778 DRM_DEBUG_KMS("Setting connector DPMS state to on\n");
779 for (i = 0; i < set->num_connectors; i++) {
780 DRM_DEBUG_KMS("\t[CONNECTOR:%d:%s] set DPMS on\n", set->connectors[i]->base.id,
781 drm_get_connector_name(set->connectors[i]));
782 set->connectors[i]->funcs->dpms(set->connectors[i], DRM_MODE_DPMS_ON);
785 __drm_helper_disable_unused_functions(dev);
786 } else if (fb_changed) {
787 set->crtc->x = set->x;
788 set->crtc->y = set->y;
789 set->crtc->primary->fb = set->fb;
790 ret = crtc_funcs->mode_set_base(set->crtc,
791 set->x, set->y, save_set.fb);
793 set->crtc->x = save_set.x;
794 set->crtc->y = save_set.y;
795 set->crtc->primary->fb = save_set.fb;
800 kfree(save_connectors);
801 kfree(save_encoders);
805 /* Restore all previous data. */
807 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
808 *encoder = save_encoders[count++];
812 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
813 *connector = save_connectors[count++];
816 /* Try to restore the config */
818 !drm_crtc_helper_set_mode(save_set.crtc, save_set.mode, save_set.x,
819 save_set.y, save_set.fb))
820 DRM_ERROR("failed to restore config after modeset failure\n");
822 kfree(save_connectors);
823 kfree(save_encoders);
826 EXPORT_SYMBOL(drm_crtc_helper_set_config);
828 static int drm_helper_choose_encoder_dpms(struct drm_encoder *encoder)
830 int dpms = DRM_MODE_DPMS_OFF;
831 struct drm_connector *connector;
832 struct drm_device *dev = encoder->dev;
834 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
835 if (connector->encoder == encoder)
836 if (connector->dpms < dpms)
837 dpms = connector->dpms;
841 /* Helper which handles bridge ordering around encoder dpms */
842 static void drm_helper_encoder_dpms(struct drm_encoder *encoder, int mode)
844 struct drm_bridge *bridge = encoder->bridge;
845 struct drm_encoder_helper_funcs *encoder_funcs;
848 if (mode == DRM_MODE_DPMS_ON)
849 bridge->funcs->pre_enable(bridge);
851 bridge->funcs->disable(bridge);
854 encoder_funcs = encoder->helper_private;
855 if (encoder_funcs->dpms)
856 encoder_funcs->dpms(encoder, mode);
859 if (mode == DRM_MODE_DPMS_ON)
860 bridge->funcs->enable(bridge);
862 bridge->funcs->post_disable(bridge);
866 static int drm_helper_choose_crtc_dpms(struct drm_crtc *crtc)
868 int dpms = DRM_MODE_DPMS_OFF;
869 struct drm_connector *connector;
870 struct drm_device *dev = crtc->dev;
872 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
873 if (connector->encoder && connector->encoder->crtc == crtc)
874 if (connector->dpms < dpms)
875 dpms = connector->dpms;
880 * drm_helper_connector_dpms() - connector dpms helper implementation
881 * @connector: affected connector
884 * This is the main helper function provided by the crtc helper framework for
885 * implementing the DPMS connector attribute. It computes the new desired DPMS
886 * state for all encoders and crtcs in the output mesh and calls the ->dpms()
887 * callback provided by the driver appropriately.
889 void drm_helper_connector_dpms(struct drm_connector *connector, int mode)
891 struct drm_encoder *encoder = connector->encoder;
892 struct drm_crtc *crtc = encoder ? encoder->crtc : NULL;
893 int old_dpms, encoder_dpms = DRM_MODE_DPMS_OFF;
895 if (mode == connector->dpms)
898 old_dpms = connector->dpms;
899 connector->dpms = mode;
902 encoder_dpms = drm_helper_choose_encoder_dpms(encoder);
904 /* from off to on, do crtc then encoder */
905 if (mode < old_dpms) {
907 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
908 if (crtc_funcs->dpms)
909 (*crtc_funcs->dpms) (crtc,
910 drm_helper_choose_crtc_dpms(crtc));
913 drm_helper_encoder_dpms(encoder, encoder_dpms);
916 /* from on to off, do encoder then crtc */
917 if (mode > old_dpms) {
919 drm_helper_encoder_dpms(encoder, encoder_dpms);
921 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
922 if (crtc_funcs->dpms)
923 (*crtc_funcs->dpms) (crtc,
924 drm_helper_choose_crtc_dpms(crtc));
930 EXPORT_SYMBOL(drm_helper_connector_dpms);
933 * drm_helper_mode_fill_fb_struct - fill out framebuffer metadata
934 * @fb: drm_framebuffer object to fill out
935 * @mode_cmd: metadata from the userspace fb creation request
937 * This helper can be used in a drivers fb_create callback to pre-fill the fb's
940 void drm_helper_mode_fill_fb_struct(struct drm_framebuffer *fb,
941 struct drm_mode_fb_cmd2 *mode_cmd)
945 fb->width = mode_cmd->width;
946 fb->height = mode_cmd->height;
947 for (i = 0; i < 4; i++) {
948 fb->pitches[i] = mode_cmd->pitches[i];
949 fb->offsets[i] = mode_cmd->offsets[i];
951 drm_fb_get_bpp_depth(mode_cmd->pixel_format, &fb->depth,
952 &fb->bits_per_pixel);
953 fb->pixel_format = mode_cmd->pixel_format;
955 EXPORT_SYMBOL(drm_helper_mode_fill_fb_struct);
958 * drm_helper_resume_force_mode - force-restore mode setting configuration
959 * @dev: drm_device which should be restored
961 * Drivers which use the mode setting helpers can use this function to
962 * force-restore the mode setting configuration e.g. on resume or when something
963 * else might have trampled over the hw state (like some overzealous old BIOSen
966 * This helper doesn't provide a error return value since restoring the old
967 * config should never fail due to resource allocation issues since the driver
968 * has successfully set the restored configuration already. Hence this should
969 * boil down to the equivalent of a few dpms on calls, which also don't provide
972 * Drivers where simply restoring an old configuration again might fail (e.g.
973 * due to slight differences in allocating shared resources when the
974 * configuration is restored in a different order than when userspace set it up)
975 * need to use their own restore logic.
977 void drm_helper_resume_force_mode(struct drm_device *dev)
979 struct drm_crtc *crtc;
980 struct drm_encoder *encoder;
981 struct drm_crtc_helper_funcs *crtc_funcs;
985 drm_modeset_lock_all(dev);
986 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
991 ret = drm_crtc_helper_set_mode(crtc, &crtc->mode,
992 crtc->x, crtc->y, crtc->primary->fb);
994 /* Restoring the old config should never fail! */
996 DRM_ERROR("failed to set mode on crtc %p\n", crtc);
998 /* Turn off outputs that were already powered off */
999 if (drm_helper_choose_crtc_dpms(crtc)) {
1000 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
1002 if(encoder->crtc != crtc)
1005 encoder_dpms = drm_helper_choose_encoder_dpms(
1008 drm_helper_encoder_dpms(encoder, encoder_dpms);
1011 crtc_funcs = crtc->helper_private;
1012 if (crtc_funcs->dpms)
1013 (*crtc_funcs->dpms) (crtc,
1014 drm_helper_choose_crtc_dpms(crtc));
1018 /* disable the unused connectors while restoring the modesetting */
1019 __drm_helper_disable_unused_functions(dev);
1020 drm_modeset_unlock_all(dev);
1022 EXPORT_SYMBOL(drm_helper_resume_force_mode);
1025 * drm_kms_helper_hotplug_event - fire off KMS hotplug events
1026 * @dev: drm_device whose connector state changed
1028 * This function fires off the uevent for userspace and also calls the
1029 * output_poll_changed function, which is most commonly used to inform the fbdev
1030 * emulation code and allow it to update the fbcon output configuration.
1032 * Drivers should call this from their hotplug handling code when a change is
1033 * detected. Note that this function does not do any output detection of its
1034 * own, like drm_helper_hpd_irq_event() does - this is assumed to be done by the
1037 * This function must be called from process context with no mode
1038 * setting locks held.
1040 void drm_kms_helper_hotplug_event(struct drm_device *dev)
1042 /* send a uevent + call fbdev */
1043 drm_sysfs_hotplug_event(dev);
1044 if (dev->mode_config.funcs->output_poll_changed)
1045 dev->mode_config.funcs->output_poll_changed(dev);
1047 EXPORT_SYMBOL(drm_kms_helper_hotplug_event);
1049 #define DRM_OUTPUT_POLL_PERIOD (10*HZ)
1050 static void output_poll_execute(struct work_struct *work)
1052 struct delayed_work *delayed_work = to_delayed_work(work);
1053 struct drm_device *dev = container_of(delayed_work, struct drm_device, mode_config.output_poll_work);
1054 struct drm_connector *connector;
1055 enum drm_connector_status old_status;
1056 bool repoll = false, changed = false;
1058 if (!drm_kms_helper_poll)
1061 mutex_lock(&dev->mode_config.mutex);
1062 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
1064 /* Ignore forced connectors. */
1065 if (connector->force)
1068 /* Ignore HPD capable connectors and connectors where we don't
1069 * want any hotplug detection at all for polling. */
1070 if (!connector->polled || connector->polled == DRM_CONNECTOR_POLL_HPD)
1075 old_status = connector->status;
1076 /* if we are connected and don't want to poll for disconnect
1078 if (old_status == connector_status_connected &&
1079 !(connector->polled & DRM_CONNECTOR_POLL_DISCONNECT))
1082 connector->status = connector->funcs->detect(connector, false);
1083 if (old_status != connector->status) {
1084 const char *old, *new;
1086 old = drm_get_connector_status_name(old_status);
1087 new = drm_get_connector_status_name(connector->status);
1089 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] "
1090 "status updated from %s to %s\n",
1092 drm_get_connector_name(connector),
1099 mutex_unlock(&dev->mode_config.mutex);
1102 drm_kms_helper_hotplug_event(dev);
1105 schedule_delayed_work(delayed_work, DRM_OUTPUT_POLL_PERIOD);
1109 * drm_kms_helper_poll_disable - disable output polling
1112 * This function disables the output polling work.
1114 * Drivers can call this helper from their device suspend implementation. It is
1115 * not an error to call this even when output polling isn't enabled or arlready
1118 void drm_kms_helper_poll_disable(struct drm_device *dev)
1120 if (!dev->mode_config.poll_enabled)
1122 cancel_delayed_work_sync(&dev->mode_config.output_poll_work);
1124 EXPORT_SYMBOL(drm_kms_helper_poll_disable);
1127 * drm_kms_helper_poll_enable - re-enable output polling.
1130 * This function re-enables the output polling work.
1132 * Drivers can call this helper from their device resume implementation. It is
1133 * an error to call this when the output polling support has not yet been set
1136 void drm_kms_helper_poll_enable(struct drm_device *dev)
1139 struct drm_connector *connector;
1141 if (!dev->mode_config.poll_enabled || !drm_kms_helper_poll)
1144 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
1145 if (connector->polled & (DRM_CONNECTOR_POLL_CONNECT |
1146 DRM_CONNECTOR_POLL_DISCONNECT))
1151 schedule_delayed_work(&dev->mode_config.output_poll_work, DRM_OUTPUT_POLL_PERIOD);
1153 EXPORT_SYMBOL(drm_kms_helper_poll_enable);
1156 * drm_kms_helper_poll_init - initialize and enable output polling
1159 * This function intializes and then also enables output polling support for
1160 * @dev. Drivers which do not have reliable hotplug support in hardware can use
1161 * this helper infrastructure to regularly poll such connectors for changes in
1162 * their connection state.
1164 * Drivers can control which connectors are polled by setting the
1165 * DRM_CONNECTOR_POLL_CONNECT and DRM_CONNECTOR_POLL_DISCONNECT flags. On
1166 * connectors where probing live outputs can result in visual distortion drivers
1167 * should not set the DRM_CONNECTOR_POLL_DISCONNECT flag to avoid this.
1168 * Connectors which have no flag or only DRM_CONNECTOR_POLL_HPD set are
1169 * completely ignored by the polling logic.
1171 * Note that a connector can be both polled and probed from the hotplug handler,
1172 * in case the hotplug interrupt is known to be unreliable.
1174 void drm_kms_helper_poll_init(struct drm_device *dev)
1176 INIT_DELAYED_WORK(&dev->mode_config.output_poll_work, output_poll_execute);
1177 dev->mode_config.poll_enabled = true;
1179 drm_kms_helper_poll_enable(dev);
1181 EXPORT_SYMBOL(drm_kms_helper_poll_init);
1184 * drm_kms_helper_poll_fini - disable output polling and clean it up
1187 void drm_kms_helper_poll_fini(struct drm_device *dev)
1189 drm_kms_helper_poll_disable(dev);
1191 EXPORT_SYMBOL(drm_kms_helper_poll_fini);
1194 * drm_helper_hpd_irq_event - hotplug processing
1197 * Drivers can use this helper function to run a detect cycle on all connectors
1198 * which have the DRM_CONNECTOR_POLL_HPD flag set in their &polled member. All
1199 * other connectors are ignored, which is useful to avoid reprobing fixed
1202 * This helper function is useful for drivers which can't or don't track hotplug
1203 * interrupts for each connector.
1205 * Drivers which support hotplug interrupts for each connector individually and
1206 * which have a more fine-grained detect logic should bypass this code and
1207 * directly call drm_kms_helper_hotplug_event() in case the connector state
1210 * This function must be called from process context with no mode
1211 * setting locks held.
1213 * Note that a connector can be both polled and probed from the hotplug handler,
1214 * in case the hotplug interrupt is known to be unreliable.
1216 bool drm_helper_hpd_irq_event(struct drm_device *dev)
1218 struct drm_connector *connector;
1219 enum drm_connector_status old_status;
1220 bool changed = false;
1222 if (!dev->mode_config.poll_enabled)
1225 mutex_lock(&dev->mode_config.mutex);
1226 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
1228 /* Only handle HPD capable connectors. */
1229 if (!(connector->polled & DRM_CONNECTOR_POLL_HPD))
1232 old_status = connector->status;
1234 connector->status = connector->funcs->detect(connector, false);
1235 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n",
1237 drm_get_connector_name(connector),
1238 drm_get_connector_status_name(old_status),
1239 drm_get_connector_status_name(connector->status));
1240 if (old_status != connector->status)
1244 mutex_unlock(&dev->mode_config.mutex);
1247 drm_kms_helper_hotplug_event(dev);
1251 EXPORT_SYMBOL(drm_helper_hpd_irq_event);