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 void drm_helper_move_panel_connectors_to_head(struct drm_device
*dev
)
44 struct drm_connector
*connector
, *tmp
;
45 struct list_head panel_list
;
47 INIT_LIST_HEAD(&panel_list
);
49 list_for_each_entry_safe(connector
, tmp
,
50 &dev
->mode_config
.connector_list
, head
) {
51 if (connector
->connector_type
== DRM_MODE_CONNECTOR_LVDS
||
52 connector
->connector_type
== DRM_MODE_CONNECTOR_eDP
)
53 list_move_tail(&connector
->head
, &panel_list
);
56 list_splice(&panel_list
, &dev
->mode_config
.connector_list
);
58 EXPORT_SYMBOL(drm_helper_move_panel_connectors_to_head
);
60 static bool drm_kms_helper_poll
= true;
61 module_param_named(poll
, drm_kms_helper_poll
, bool, 0600);
63 static void drm_mode_validate_flag(struct drm_connector
*connector
,
66 struct drm_display_mode
*mode
;
68 if (flags
== (DRM_MODE_FLAG_DBLSCAN
| DRM_MODE_FLAG_INTERLACE
))
71 list_for_each_entry(mode
, &connector
->modes
, head
) {
72 if ((mode
->flags
& DRM_MODE_FLAG_INTERLACE
) &&
73 !(flags
& DRM_MODE_FLAG_INTERLACE
))
74 mode
->status
= MODE_NO_INTERLACE
;
75 if ((mode
->flags
& DRM_MODE_FLAG_DBLSCAN
) &&
76 !(flags
& DRM_MODE_FLAG_DBLSCAN
))
77 mode
->status
= MODE_NO_DBLESCAN
;
84 * drm_helper_probe_single_connector_modes - get complete set of display modes
86 * @maxX: max width for modes
87 * @maxY: max height for modes
90 * Caller must hold mode config lock.
92 * Based on @dev's mode_config layout, scan all the connectors and try to detect
93 * modes on them. Modes will first be added to the connector's probed_modes
94 * list, then culled (based on validity and the @maxX, @maxY parameters) and
95 * put into the normal modes list.
97 * Intended to be used either at bootup time or when major configuration
98 * changes have occurred.
100 * FIXME: take into account monitor limits
103 * Number of modes found on @connector.
105 int drm_helper_probe_single_connector_modes(struct drm_connector
*connector
,
106 uint32_t maxX
, uint32_t maxY
)
108 struct drm_device
*dev
= connector
->dev
;
109 struct drm_display_mode
*mode
;
110 struct drm_connector_helper_funcs
*connector_funcs
=
111 connector
->helper_private
;
115 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector
->base
.id
,
116 drm_get_connector_name(connector
));
117 /* set all modes to the unverified state */
118 list_for_each_entry(mode
, &connector
->modes
, head
)
119 mode
->status
= MODE_UNVERIFIED
;
121 if (connector
->force
) {
122 if (connector
->force
== DRM_FORCE_ON
)
123 connector
->status
= connector_status_connected
;
125 connector
->status
= connector_status_disconnected
;
126 if (connector
->funcs
->force
)
127 connector
->funcs
->force(connector
);
129 connector
->status
= connector
->funcs
->detect(connector
, true);
130 drm_kms_helper_poll_enable(dev
);
133 if (connector
->status
== connector_status_disconnected
) {
134 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] disconnected\n",
135 connector
->base
.id
, drm_get_connector_name(connector
));
136 drm_mode_connector_update_edid_property(connector
, NULL
);
140 #ifdef CONFIG_DRM_LOAD_EDID_FIRMWARE
141 count
= drm_load_edid_firmware(connector
);
144 count
= (*connector_funcs
->get_modes
)(connector
);
146 if (count
== 0 && connector
->status
== connector_status_connected
)
147 count
= drm_add_modes_noedid(connector
, 1024, 768);
151 drm_mode_connector_list_update(connector
);
154 drm_mode_validate_size(dev
, &connector
->modes
, maxX
,
157 if (connector
->interlace_allowed
)
158 mode_flags
|= DRM_MODE_FLAG_INTERLACE
;
159 if (connector
->doublescan_allowed
)
160 mode_flags
|= DRM_MODE_FLAG_DBLSCAN
;
161 drm_mode_validate_flag(connector
, mode_flags
);
163 list_for_each_entry(mode
, &connector
->modes
, head
) {
164 if (mode
->status
== MODE_OK
)
165 mode
->status
= connector_funcs
->mode_valid(connector
,
170 drm_mode_prune_invalid(dev
, &connector
->modes
, true);
172 if (list_empty(&connector
->modes
))
175 drm_mode_sort(&connector
->modes
);
177 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector
->base
.id
,
178 drm_get_connector_name(connector
));
179 list_for_each_entry(mode
, &connector
->modes
, head
) {
180 mode
->vrefresh
= drm_mode_vrefresh(mode
);
182 drm_mode_set_crtcinfo(mode
, CRTC_INTERLACE_HALVE_V
);
183 drm_mode_debug_printmodeline(mode
);
188 EXPORT_SYMBOL(drm_helper_probe_single_connector_modes
);
191 * drm_helper_encoder_in_use - check if a given encoder is in use
192 * @encoder: encoder to check
195 * Caller must hold mode config lock.
197 * Walk @encoders's DRM device's mode_config and see if it's in use.
200 * True if @encoder is part of the mode_config, false otherwise.
202 bool drm_helper_encoder_in_use(struct drm_encoder
*encoder
)
204 struct drm_connector
*connector
;
205 struct drm_device
*dev
= encoder
->dev
;
206 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
)
207 if (connector
->encoder
== encoder
)
211 EXPORT_SYMBOL(drm_helper_encoder_in_use
);
214 * drm_helper_crtc_in_use - check if a given CRTC is in a mode_config
215 * @crtc: CRTC to check
218 * Caller must hold mode config lock.
220 * Walk @crtc's DRM device's mode_config and see if it's in use.
223 * True if @crtc is part of the mode_config, false otherwise.
225 bool drm_helper_crtc_in_use(struct drm_crtc
*crtc
)
227 struct drm_encoder
*encoder
;
228 struct drm_device
*dev
= crtc
->dev
;
229 /* FIXME: Locking around list access? */
230 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
)
231 if (encoder
->crtc
== crtc
&& drm_helper_encoder_in_use(encoder
))
235 EXPORT_SYMBOL(drm_helper_crtc_in_use
);
238 drm_encoder_disable(struct drm_encoder
*encoder
)
240 struct drm_encoder_helper_funcs
*encoder_funcs
= encoder
->helper_private
;
242 if (encoder_funcs
->disable
)
243 (*encoder_funcs
->disable
)(encoder
);
245 (*encoder_funcs
->dpms
)(encoder
, DRM_MODE_DPMS_OFF
);
249 * drm_helper_disable_unused_functions - disable unused objects
253 * Caller must hold mode config lock.
255 * If an connector or CRTC isn't part of @dev's mode_config, it can be disabled
256 * by calling its dpms function, which should power it off.
258 void drm_helper_disable_unused_functions(struct drm_device
*dev
)
260 struct drm_encoder
*encoder
;
261 struct drm_connector
*connector
;
262 struct drm_crtc
*crtc
;
264 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
265 if (!connector
->encoder
)
267 if (connector
->status
== connector_status_disconnected
)
268 connector
->encoder
= NULL
;
271 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
272 if (!drm_helper_encoder_in_use(encoder
)) {
273 drm_encoder_disable(encoder
);
274 /* disconnector encoder from any connector */
275 encoder
->crtc
= NULL
;
279 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
280 struct drm_crtc_helper_funcs
*crtc_funcs
= crtc
->helper_private
;
281 crtc
->enabled
= drm_helper_crtc_in_use(crtc
);
282 if (!crtc
->enabled
) {
283 if (crtc_funcs
->disable
)
284 (*crtc_funcs
->disable
)(crtc
);
286 (*crtc_funcs
->dpms
)(crtc
, DRM_MODE_DPMS_OFF
);
291 EXPORT_SYMBOL(drm_helper_disable_unused_functions
);
294 * drm_encoder_crtc_ok - can a given crtc drive a given encoder?
295 * @encoder: encoder to test
296 * @crtc: crtc to test
298 * Return false if @encoder can't be driven by @crtc, true otherwise.
300 static bool drm_encoder_crtc_ok(struct drm_encoder
*encoder
,
301 struct drm_crtc
*crtc
)
303 struct drm_device
*dev
;
304 struct drm_crtc
*tmp
;
307 WARN(!crtc
, "checking null crtc?\n");
311 list_for_each_entry(tmp
, &dev
->mode_config
.crtc_list
, head
) {
317 if (encoder
->possible_crtcs
& crtc_mask
)
323 * Check the CRTC we're going to map each output to vs. its current
324 * CRTC. If they don't match, we have to disable the output and the CRTC
325 * since the driver will have to re-route things.
328 drm_crtc_prepare_encoders(struct drm_device
*dev
)
330 struct drm_encoder_helper_funcs
*encoder_funcs
;
331 struct drm_encoder
*encoder
;
333 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
334 encoder_funcs
= encoder
->helper_private
;
335 /* Disable unused encoders */
336 if (encoder
->crtc
== NULL
)
337 drm_encoder_disable(encoder
);
338 /* Disable encoders whose CRTC is about to change */
339 if (encoder_funcs
->get_crtc
&&
340 encoder
->crtc
!= (*encoder_funcs
->get_crtc
)(encoder
))
341 drm_encoder_disable(encoder
);
346 * drm_crtc_set_mode - set a mode
347 * @crtc: CRTC to program
349 * @x: horizontal offset into the surface
350 * @y: vertical offset into the surface
353 * Caller must hold mode config lock.
355 * Try to set @mode on @crtc. Give @crtc and its associated connectors a chance
356 * to fixup or reject the mode prior to trying to set it.
359 * True if the mode was set successfully, or false otherwise.
361 bool drm_crtc_helper_set_mode(struct drm_crtc
*crtc
,
362 struct drm_display_mode
*mode
,
364 struct drm_framebuffer
*old_fb
)
366 struct drm_device
*dev
= crtc
->dev
;
367 struct drm_display_mode
*adjusted_mode
, saved_mode
, saved_hwmode
;
368 struct drm_crtc_helper_funcs
*crtc_funcs
= crtc
->helper_private
;
369 struct drm_encoder_helper_funcs
*encoder_funcs
;
370 int saved_x
, saved_y
;
371 struct drm_encoder
*encoder
;
374 crtc
->enabled
= drm_helper_crtc_in_use(crtc
);
378 adjusted_mode
= drm_mode_duplicate(dev
, mode
);
382 saved_hwmode
= crtc
->hwmode
;
383 saved_mode
= crtc
->mode
;
387 /* Update crtc values up front so the driver can rely on them for mode
394 /* Pass our mode to the connectors and the CRTC to give them a chance to
395 * adjust it according to limitations or connector properties, and also
396 * a chance to reject the mode entirely.
398 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
400 if (encoder
->crtc
!= crtc
)
402 encoder_funcs
= encoder
->helper_private
;
403 if (!(ret
= encoder_funcs
->mode_fixup(encoder
, mode
,
405 DRM_DEBUG_KMS("Encoder fixup failed\n");
410 if (!(ret
= crtc_funcs
->mode_fixup(crtc
, mode
, adjusted_mode
))) {
411 DRM_DEBUG_KMS("CRTC fixup failed\n");
414 DRM_DEBUG_KMS("[CRTC:%d]\n", crtc
->base
.id
);
416 /* Prepare the encoders and CRTCs before setting the mode. */
417 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
419 if (encoder
->crtc
!= crtc
)
421 encoder_funcs
= encoder
->helper_private
;
422 /* Disable the encoders as the first thing we do. */
423 encoder_funcs
->prepare(encoder
);
426 drm_crtc_prepare_encoders(dev
);
428 crtc_funcs
->prepare(crtc
);
430 /* Set up the DPLL and any encoders state that needs to adjust or depend
433 ret
= !crtc_funcs
->mode_set(crtc
, mode
, adjusted_mode
, x
, y
, old_fb
);
437 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
439 if (encoder
->crtc
!= crtc
)
442 DRM_DEBUG_KMS("[ENCODER:%d:%s] set [MODE:%d:%s]\n",
443 encoder
->base
.id
, drm_get_encoder_name(encoder
),
444 mode
->base
.id
, mode
->name
);
445 encoder_funcs
= encoder
->helper_private
;
446 encoder_funcs
->mode_set(encoder
, mode
, adjusted_mode
);
449 /* Now enable the clocks, plane, pipe, and connectors that we set up. */
450 crtc_funcs
->commit(crtc
);
452 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
454 if (encoder
->crtc
!= crtc
)
457 encoder_funcs
= encoder
->helper_private
;
458 encoder_funcs
->commit(encoder
);
462 /* Store real post-adjustment hardware mode. */
463 crtc
->hwmode
= *adjusted_mode
;
465 /* Calculate and store various constants which
466 * are later needed by vblank and swap-completion
467 * timestamping. They are derived from true hwmode.
469 drm_calc_timestamping_constants(crtc
);
471 /* FIXME: add subpixel order */
473 drm_mode_destroy(dev
, adjusted_mode
);
475 crtc
->hwmode
= saved_hwmode
;
476 crtc
->mode
= saved_mode
;
483 EXPORT_SYMBOL(drm_crtc_helper_set_mode
);
487 drm_crtc_helper_disable(struct drm_crtc
*crtc
)
489 struct drm_device
*dev
= crtc
->dev
;
490 struct drm_connector
*connector
;
491 struct drm_encoder
*encoder
;
493 /* Decouple all encoders and their attached connectors from this crtc */
494 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
495 if (encoder
->crtc
!= crtc
)
498 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
499 if (connector
->encoder
!= encoder
)
502 connector
->encoder
= NULL
;
506 drm_helper_disable_unused_functions(dev
);
511 * drm_crtc_helper_set_config - set a new config from userspace
512 * @crtc: CRTC to setup
513 * @crtc_info: user provided configuration
514 * @new_mode: new mode to set
515 * @connector_set: set of connectors for the new config
516 * @fb: new framebuffer
519 * Caller must hold mode config lock.
521 * Setup a new configuration, provided by the user in @crtc_info, and enable
527 int drm_crtc_helper_set_config(struct drm_mode_set
*set
)
529 struct drm_device
*dev
;
530 struct drm_crtc
*save_crtcs
, *new_crtc
, *crtc
;
531 struct drm_encoder
*save_encoders
, *new_encoder
, *encoder
;
532 struct drm_framebuffer
*old_fb
= NULL
;
533 bool mode_changed
= false; /* if true do a full mode set */
534 bool fb_changed
= false; /* if true and !mode_changed just do a flip */
535 struct drm_connector
*save_connectors
, *connector
;
536 int count
= 0, ro
, fail
= 0;
537 struct drm_crtc_helper_funcs
*crtc_funcs
;
538 struct drm_mode_set save_set
;
550 if (!set
->crtc
->helper_private
)
553 crtc_funcs
= set
->crtc
->helper_private
;
559 DRM_DEBUG_KMS("[CRTC:%d] [FB:%d] #connectors=%d (x y) (%i %i)\n",
560 set
->crtc
->base
.id
, set
->fb
->base
.id
,
561 (int)set
->num_connectors
, set
->x
, set
->y
);
563 DRM_DEBUG_KMS("[CRTC:%d] [NOFB]\n", set
->crtc
->base
.id
);
564 return drm_crtc_helper_disable(set
->crtc
);
567 dev
= set
->crtc
->dev
;
569 /* Allocate space for the backup of all (non-pointer) crtc, encoder and
571 save_crtcs
= kzalloc(dev
->mode_config
.num_crtc
*
572 sizeof(struct drm_crtc
), GFP_KERNEL
);
576 save_encoders
= kzalloc(dev
->mode_config
.num_encoder
*
577 sizeof(struct drm_encoder
), GFP_KERNEL
);
578 if (!save_encoders
) {
583 save_connectors
= kzalloc(dev
->mode_config
.num_connector
*
584 sizeof(struct drm_connector
), GFP_KERNEL
);
585 if (!save_connectors
) {
587 kfree(save_encoders
);
591 /* Copy data. Note that driver private data is not affected.
592 * Should anything bad happen only the expected state is
593 * restored, not the drivers personal bookkeeping.
596 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
597 save_crtcs
[count
++] = *crtc
;
601 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
602 save_encoders
[count
++] = *encoder
;
606 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
607 save_connectors
[count
++] = *connector
;
610 save_set
.crtc
= set
->crtc
;
611 save_set
.mode
= &set
->crtc
->mode
;
612 save_set
.x
= set
->crtc
->x
;
613 save_set
.y
= set
->crtc
->y
;
614 save_set
.fb
= set
->crtc
->fb
;
616 /* We should be able to check here if the fb has the same properties
617 * and then just flip_or_move it */
618 if (set
->crtc
->fb
!= set
->fb
) {
619 /* If we have no fb then treat it as a full mode set */
620 if (set
->crtc
->fb
== NULL
) {
621 DRM_DEBUG_KMS("crtc has no fb, full mode set\n");
623 } else if (set
->fb
== NULL
) {
625 } else if (set
->fb
->depth
!= set
->crtc
->fb
->depth
) {
627 } else if (set
->fb
->bits_per_pixel
!=
628 set
->crtc
->fb
->bits_per_pixel
) {
634 if (set
->x
!= set
->crtc
->x
|| set
->y
!= set
->crtc
->y
)
637 if (set
->mode
&& !drm_mode_equal(set
->mode
, &set
->crtc
->mode
)) {
638 DRM_DEBUG_KMS("modes are different, full mode set\n");
639 drm_mode_debug_printmodeline(&set
->crtc
->mode
);
640 drm_mode_debug_printmodeline(set
->mode
);
644 /* a) traverse passed in connector list and get encoders for them */
646 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
647 struct drm_connector_helper_funcs
*connector_funcs
=
648 connector
->helper_private
;
649 new_encoder
= connector
->encoder
;
650 for (ro
= 0; ro
< set
->num_connectors
; ro
++) {
651 if (set
->connectors
[ro
] == connector
) {
652 new_encoder
= connector_funcs
->best_encoder(connector
);
653 /* if we can't get an encoder for a connector
654 we are setting now - then fail */
655 if (new_encoder
== NULL
)
656 /* don't break so fail path works correct */
662 if (new_encoder
!= connector
->encoder
) {
663 DRM_DEBUG_KMS("encoder changed, full mode switch\n");
665 /* If the encoder is reused for another connector, then
666 * the appropriate crtc will be set later.
668 if (connector
->encoder
)
669 connector
->encoder
->crtc
= NULL
;
670 connector
->encoder
= new_encoder
;
680 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
681 if (!connector
->encoder
)
684 if (connector
->encoder
->crtc
== set
->crtc
)
687 new_crtc
= connector
->encoder
->crtc
;
689 for (ro
= 0; ro
< set
->num_connectors
; ro
++) {
690 if (set
->connectors
[ro
] == connector
)
691 new_crtc
= set
->crtc
;
694 /* Make sure the new CRTC will work with the encoder */
696 !drm_encoder_crtc_ok(connector
->encoder
, new_crtc
)) {
700 if (new_crtc
!= connector
->encoder
->crtc
) {
701 DRM_DEBUG_KMS("crtc changed, full mode switch\n");
703 connector
->encoder
->crtc
= new_crtc
;
706 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [CRTC:%d]\n",
707 connector
->base
.id
, drm_get_connector_name(connector
),
710 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [NOCRTC]\n",
711 connector
->base
.id
, drm_get_connector_name(connector
));
715 /* mode_set_base is not a required function */
716 if (fb_changed
&& !crtc_funcs
->mode_set_base
)
720 set
->crtc
->enabled
= drm_helper_crtc_in_use(set
->crtc
);
721 if (set
->crtc
->enabled
) {
722 DRM_DEBUG_KMS("attempting to set mode from"
724 drm_mode_debug_printmodeline(set
->mode
);
725 old_fb
= set
->crtc
->fb
;
726 set
->crtc
->fb
= set
->fb
;
727 if (!drm_crtc_helper_set_mode(set
->crtc
, set
->mode
,
730 DRM_ERROR("failed to set mode on [CRTC:%d]\n",
732 set
->crtc
->fb
= old_fb
;
736 DRM_DEBUG_KMS("Setting connector DPMS state to on\n");
737 for (i
= 0; i
< set
->num_connectors
; i
++) {
738 DRM_DEBUG_KMS("\t[CONNECTOR:%d:%s] set DPMS on\n", set
->connectors
[i
]->base
.id
,
739 drm_get_connector_name(set
->connectors
[i
]));
740 set
->connectors
[i
]->funcs
->dpms(set
->connectors
[i
], DRM_MODE_DPMS_ON
);
743 drm_helper_disable_unused_functions(dev
);
744 } else if (fb_changed
) {
745 set
->crtc
->x
= set
->x
;
746 set
->crtc
->y
= set
->y
;
748 old_fb
= set
->crtc
->fb
;
749 if (set
->crtc
->fb
!= set
->fb
)
750 set
->crtc
->fb
= set
->fb
;
751 ret
= crtc_funcs
->mode_set_base(set
->crtc
,
752 set
->x
, set
->y
, old_fb
);
754 set
->crtc
->fb
= old_fb
;
759 kfree(save_connectors
);
760 kfree(save_encoders
);
765 /* Restore all previous data. */
767 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
768 *crtc
= save_crtcs
[count
++];
772 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
773 *encoder
= save_encoders
[count
++];
777 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
778 *connector
= save_connectors
[count
++];
781 /* Try to restore the config */
783 !drm_crtc_helper_set_mode(save_set
.crtc
, save_set
.mode
, save_set
.x
,
784 save_set
.y
, save_set
.fb
))
785 DRM_ERROR("failed to restore config after modeset failure\n");
787 kfree(save_connectors
);
788 kfree(save_encoders
);
792 EXPORT_SYMBOL(drm_crtc_helper_set_config
);
794 static int drm_helper_choose_encoder_dpms(struct drm_encoder
*encoder
)
796 int dpms
= DRM_MODE_DPMS_OFF
;
797 struct drm_connector
*connector
;
798 struct drm_device
*dev
= encoder
->dev
;
800 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
)
801 if (connector
->encoder
== encoder
)
802 if (connector
->dpms
< dpms
)
803 dpms
= connector
->dpms
;
807 static int drm_helper_choose_crtc_dpms(struct drm_crtc
*crtc
)
809 int dpms
= DRM_MODE_DPMS_OFF
;
810 struct drm_connector
*connector
;
811 struct drm_device
*dev
= crtc
->dev
;
813 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
)
814 if (connector
->encoder
&& connector
->encoder
->crtc
== crtc
)
815 if (connector
->dpms
< dpms
)
816 dpms
= connector
->dpms
;
821 * drm_helper_connector_dpms
822 * @connector affected connector
825 * Calls the low-level connector DPMS function, then
826 * calls appropriate encoder and crtc DPMS functions as well
828 void drm_helper_connector_dpms(struct drm_connector
*connector
, int mode
)
830 struct drm_encoder
*encoder
= connector
->encoder
;
831 struct drm_crtc
*crtc
= encoder
? encoder
->crtc
: NULL
;
834 if (mode
== connector
->dpms
)
837 old_dpms
= connector
->dpms
;
838 connector
->dpms
= mode
;
840 /* from off to on, do crtc then encoder */
841 if (mode
< old_dpms
) {
843 struct drm_crtc_helper_funcs
*crtc_funcs
= crtc
->helper_private
;
844 if (crtc_funcs
->dpms
)
845 (*crtc_funcs
->dpms
) (crtc
,
846 drm_helper_choose_crtc_dpms(crtc
));
849 struct drm_encoder_helper_funcs
*encoder_funcs
= encoder
->helper_private
;
850 if (encoder_funcs
->dpms
)
851 (*encoder_funcs
->dpms
) (encoder
,
852 drm_helper_choose_encoder_dpms(encoder
));
856 /* from on to off, do encoder then crtc */
857 if (mode
> old_dpms
) {
859 struct drm_encoder_helper_funcs
*encoder_funcs
= encoder
->helper_private
;
860 if (encoder_funcs
->dpms
)
861 (*encoder_funcs
->dpms
) (encoder
,
862 drm_helper_choose_encoder_dpms(encoder
));
865 struct drm_crtc_helper_funcs
*crtc_funcs
= crtc
->helper_private
;
866 if (crtc_funcs
->dpms
)
867 (*crtc_funcs
->dpms
) (crtc
,
868 drm_helper_choose_crtc_dpms(crtc
));
874 EXPORT_SYMBOL(drm_helper_connector_dpms
);
876 int drm_helper_mode_fill_fb_struct(struct drm_framebuffer
*fb
,
877 struct drm_mode_fb_cmd2
*mode_cmd
)
881 fb
->width
= mode_cmd
->width
;
882 fb
->height
= mode_cmd
->height
;
883 for (i
= 0; i
< 4; i
++) {
884 fb
->pitches
[i
] = mode_cmd
->pitches
[i
];
885 fb
->offsets
[i
] = mode_cmd
->offsets
[i
];
887 drm_fb_get_bpp_depth(mode_cmd
->pixel_format
, &fb
->depth
,
888 &fb
->bits_per_pixel
);
889 fb
->pixel_format
= mode_cmd
->pixel_format
;
893 EXPORT_SYMBOL(drm_helper_mode_fill_fb_struct
);
895 int drm_helper_resume_force_mode(struct drm_device
*dev
)
897 struct drm_crtc
*crtc
;
898 struct drm_encoder
*encoder
;
899 struct drm_encoder_helper_funcs
*encoder_funcs
;
900 struct drm_crtc_helper_funcs
*crtc_funcs
;
903 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
908 ret
= drm_crtc_helper_set_mode(crtc
, &crtc
->mode
,
909 crtc
->x
, crtc
->y
, crtc
->fb
);
912 DRM_ERROR("failed to set mode on crtc %p\n", crtc
);
914 /* Turn off outputs that were already powered off */
915 if (drm_helper_choose_crtc_dpms(crtc
)) {
916 list_for_each_entry(encoder
, &dev
->mode_config
.encoder_list
, head
) {
918 if(encoder
->crtc
!= crtc
)
921 encoder_funcs
= encoder
->helper_private
;
922 if (encoder_funcs
->dpms
)
923 (*encoder_funcs
->dpms
) (encoder
,
924 drm_helper_choose_encoder_dpms(encoder
));
927 crtc_funcs
= crtc
->helper_private
;
928 if (crtc_funcs
->dpms
)
929 (*crtc_funcs
->dpms
) (crtc
,
930 drm_helper_choose_crtc_dpms(crtc
));
933 /* disable the unused connectors while restoring the modesetting */
934 drm_helper_disable_unused_functions(dev
);
937 EXPORT_SYMBOL(drm_helper_resume_force_mode
);
939 void drm_kms_helper_hotplug_event(struct drm_device
*dev
)
941 /* send a uevent + call fbdev */
942 drm_sysfs_hotplug_event(dev
);
943 if (dev
->mode_config
.funcs
->output_poll_changed
)
944 dev
->mode_config
.funcs
->output_poll_changed(dev
);
946 EXPORT_SYMBOL(drm_kms_helper_hotplug_event
);
948 #define DRM_OUTPUT_POLL_PERIOD (10*HZ)
949 static void output_poll_execute(struct work_struct
*work
)
951 struct delayed_work
*delayed_work
= to_delayed_work(work
);
952 struct drm_device
*dev
= container_of(delayed_work
, struct drm_device
, mode_config
.output_poll_work
);
953 struct drm_connector
*connector
;
954 enum drm_connector_status old_status
;
955 bool repoll
= false, changed
= false;
957 if (!drm_kms_helper_poll
)
960 mutex_lock(&dev
->mode_config
.mutex
);
961 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
963 /* if this is HPD or polled don't check it -
964 TV out for instance */
965 if (!connector
->polled
)
968 else if (connector
->polled
& (DRM_CONNECTOR_POLL_CONNECT
| DRM_CONNECTOR_POLL_DISCONNECT
))
971 old_status
= connector
->status
;
972 /* if we are connected and don't want to poll for disconnect
974 if (old_status
== connector_status_connected
&&
975 !(connector
->polled
& DRM_CONNECTOR_POLL_DISCONNECT
) &&
976 !(connector
->polled
& DRM_CONNECTOR_POLL_HPD
))
979 connector
->status
= connector
->funcs
->detect(connector
, false);
980 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %d to %d\n",
982 drm_get_connector_name(connector
),
983 old_status
, connector
->status
);
984 if (old_status
!= connector
->status
)
988 mutex_unlock(&dev
->mode_config
.mutex
);
991 drm_kms_helper_hotplug_event(dev
);
994 schedule_delayed_work(delayed_work
, DRM_OUTPUT_POLL_PERIOD
);
997 void drm_kms_helper_poll_disable(struct drm_device
*dev
)
999 if (!dev
->mode_config
.poll_enabled
)
1001 cancel_delayed_work_sync(&dev
->mode_config
.output_poll_work
);
1003 EXPORT_SYMBOL(drm_kms_helper_poll_disable
);
1005 void drm_kms_helper_poll_enable(struct drm_device
*dev
)
1008 struct drm_connector
*connector
;
1010 if (!dev
->mode_config
.poll_enabled
|| !drm_kms_helper_poll
)
1013 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
) {
1014 if (connector
->polled
)
1019 schedule_delayed_work(&dev
->mode_config
.output_poll_work
, DRM_OUTPUT_POLL_PERIOD
);
1021 EXPORT_SYMBOL(drm_kms_helper_poll_enable
);
1023 void drm_kms_helper_poll_init(struct drm_device
*dev
)
1025 INIT_DELAYED_WORK(&dev
->mode_config
.output_poll_work
, output_poll_execute
);
1026 dev
->mode_config
.poll_enabled
= true;
1028 drm_kms_helper_poll_enable(dev
);
1030 EXPORT_SYMBOL(drm_kms_helper_poll_init
);
1032 void drm_kms_helper_poll_fini(struct drm_device
*dev
)
1034 drm_kms_helper_poll_disable(dev
);
1036 EXPORT_SYMBOL(drm_kms_helper_poll_fini
);
1038 void drm_helper_hpd_irq_event(struct drm_device
*dev
)
1040 if (!dev
->mode_config
.poll_enabled
)
1043 /* kill timer and schedule immediate execution, this doesn't block */
1044 cancel_delayed_work(&dev
->mode_config
.output_poll_work
);
1045 if (drm_kms_helper_poll
)
1046 schedule_delayed_work(&dev
->mode_config
.output_poll_work
, 0);
1048 EXPORT_SYMBOL(drm_helper_hpd_irq_event
);