blob: 3252e7067d8b3ea11ecfbcf47cab922c0919bf91 [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
Dave Airlief453ba02008-11-07 14:05:41 -080035#include "drmP.h"
36#include "drm_crtc.h"
Jesse Barnes308e5bc2011-11-14 14:51:28 -080037#include "drm_fourcc.h"
Dave Airlief453ba02008-11-07 14:05:41 -080038#include "drm_crtc_helper.h"
Dave Airlied50ba252009-09-23 14:44:08 +100039#include "drm_fb_helper.h"
Carsten Emdeda0df922012-03-18 22:37:33 +010040#include "drm_edid.h"
Dave Airlief453ba02008-11-07 14:05:41 -080041
Chris Wilsone58f6372010-08-20 09:13:36 +010042static bool drm_kms_helper_poll = true;
43module_param_named(poll, drm_kms_helper_poll, bool, 0600);
44
yakui_zhao67149772009-04-02 11:52:12 +080045static void drm_mode_validate_flag(struct drm_connector *connector,
46 int flags)
47{
Sascha Hauera1178ca2012-02-01 11:38:30 +010048 struct drm_display_mode *mode;
yakui_zhao67149772009-04-02 11:52:12 +080049
50 if (flags == (DRM_MODE_FLAG_DBLSCAN | DRM_MODE_FLAG_INTERLACE))
51 return;
52
Sascha Hauera1178ca2012-02-01 11:38:30 +010053 list_for_each_entry(mode, &connector->modes, head) {
yakui_zhao67149772009-04-02 11:52:12 +080054 if ((mode->flags & DRM_MODE_FLAG_INTERLACE) &&
55 !(flags & DRM_MODE_FLAG_INTERLACE))
56 mode->status = MODE_NO_INTERLACE;
57 if ((mode->flags & DRM_MODE_FLAG_DBLSCAN) &&
58 !(flags & DRM_MODE_FLAG_DBLSCAN))
59 mode->status = MODE_NO_DBLESCAN;
60 }
61
62 return;
63}
64
Dave Airlief453ba02008-11-07 14:05:41 -080065/**
Dave Airlie38651672010-03-30 05:34:13 +000066 * drm_helper_probe_single_connector_modes - get complete set of display modes
Dave Airlief453ba02008-11-07 14:05:41 -080067 * @dev: DRM device
68 * @maxX: max width for modes
69 * @maxY: max height for modes
70 *
71 * LOCKING:
72 * Caller must hold mode config lock.
73 *
74 * Based on @dev's mode_config layout, scan all the connectors and try to detect
75 * modes on them. Modes will first be added to the connector's probed_modes
76 * list, then culled (based on validity and the @maxX, @maxY parameters) and
77 * put into the normal modes list.
78 *
79 * Intended to be used either at bootup time or when major configuration
80 * changes have occurred.
81 *
82 * FIXME: take into account monitor limits
Jesse Barnes40a518d2009-01-12 12:05:32 -080083 *
84 * RETURNS:
85 * Number of modes found on @connector.
Dave Airlief453ba02008-11-07 14:05:41 -080086 */
Jesse Barnes40a518d2009-01-12 12:05:32 -080087int drm_helper_probe_single_connector_modes(struct drm_connector *connector,
88 uint32_t maxX, uint32_t maxY)
Dave Airlief453ba02008-11-07 14:05:41 -080089{
90 struct drm_device *dev = connector->dev;
Sascha Hauera1178ca2012-02-01 11:38:30 +010091 struct drm_display_mode *mode;
Dave Airlief453ba02008-11-07 14:05:41 -080092 struct drm_connector_helper_funcs *connector_funcs =
93 connector->helper_private;
Jesse Barnes40a518d2009-01-12 12:05:32 -080094 int count = 0;
yakui_zhao67149772009-04-02 11:52:12 +080095 int mode_flags = 0;
Dave Airlief453ba02008-11-07 14:05:41 -080096
Jerome Glisse94401062010-07-15 15:43:25 -040097 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id,
98 drm_get_connector_name(connector));
Dave Airlief453ba02008-11-07 14:05:41 -080099 /* set all modes to the unverified state */
Sascha Hauera1178ca2012-02-01 11:38:30 +0100100 list_for_each_entry(mode, &connector->modes, head)
Dave Airlief453ba02008-11-07 14:05:41 -0800101 mode->status = MODE_UNVERIFIED;
102
Dave Airlied50ba252009-09-23 14:44:08 +1000103 if (connector->force) {
104 if (connector->force == DRM_FORCE_ON)
105 connector->status = connector_status_connected;
106 else
107 connector->status = connector_status_disconnected;
108 if (connector->funcs->force)
109 connector->funcs->force(connector);
Chris Wilsone58f6372010-08-20 09:13:36 +0100110 } else {
Chris Wilson930a9e22010-09-14 11:07:23 +0100111 connector->status = connector->funcs->detect(connector, true);
Chris Wilson551402a2010-09-06 23:53:47 +0100112 drm_kms_helper_poll_enable(dev);
Chris Wilsone58f6372010-08-20 09:13:36 +0100113 }
Dave Airlief453ba02008-11-07 14:05:41 -0800114
115 if (connector->status == connector_status_disconnected) {
Jerome Glisse94401062010-07-15 15:43:25 -0400116 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] disconnected\n",
117 connector->base.id, drm_get_connector_name(connector));
Zhao Yakui72539832010-03-04 08:25:55 +0000118 drm_mode_connector_update_edid_property(connector, NULL);
Adam Jackson620f3782009-09-08 11:51:46 +1000119 goto prune;
Dave Airlief453ba02008-11-07 14:05:41 -0800120 }
121
Carsten Emdeda0df922012-03-18 22:37:33 +0100122#ifdef CONFIG_DRM_LOAD_EDID_FIRMWARE
123 count = drm_load_edid_firmware(connector);
124 if (count == 0)
125#endif
126 count = (*connector_funcs->get_modes)(connector);
127
Chris Wilsonc7ef35a2010-09-05 16:55:25 +0100128 if (count == 0 && connector->status == connector_status_connected)
Adam Jackson9632b412009-11-23 14:23:07 -0500129 count = drm_add_modes_noedid(connector, 1024, 768);
Chris Wilsonc7ef35a2010-09-05 16:55:25 +0100130 if (count == 0)
131 goto prune;
Dave Airlief453ba02008-11-07 14:05:41 -0800132
Jesse Barnes40a518d2009-01-12 12:05:32 -0800133 drm_mode_connector_list_update(connector);
Dave Airlief453ba02008-11-07 14:05:41 -0800134
135 if (maxX && maxY)
136 drm_mode_validate_size(dev, &connector->modes, maxX,
137 maxY, 0);
yakui_zhao67149772009-04-02 11:52:12 +0800138
139 if (connector->interlace_allowed)
140 mode_flags |= DRM_MODE_FLAG_INTERLACE;
141 if (connector->doublescan_allowed)
142 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
143 drm_mode_validate_flag(connector, mode_flags);
144
Sascha Hauera1178ca2012-02-01 11:38:30 +0100145 list_for_each_entry(mode, &connector->modes, head) {
Dave Airlief453ba02008-11-07 14:05:41 -0800146 if (mode->status == MODE_OK)
147 mode->status = connector_funcs->mode_valid(connector,
148 mode);
149 }
150
Adam Jackson620f3782009-09-08 11:51:46 +1000151prune:
Dave Airlief453ba02008-11-07 14:05:41 -0800152 drm_mode_prune_invalid(dev, &connector->modes, true);
153
Jesse Barnes40a518d2009-01-12 12:05:32 -0800154 if (list_empty(&connector->modes))
155 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800156
157 drm_mode_sort(&connector->modes);
158
Jerome Glisse94401062010-07-15 15:43:25 -0400159 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector->base.id,
160 drm_get_connector_name(connector));
Sascha Hauera1178ca2012-02-01 11:38:30 +0100161 list_for_each_entry(mode, &connector->modes, head) {
Dave Airlief453ba02008-11-07 14:05:41 -0800162 mode->vrefresh = drm_mode_vrefresh(mode);
163
164 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
165 drm_mode_debug_printmodeline(mode);
166 }
Jesse Barnes40a518d2009-01-12 12:05:32 -0800167
168 return count;
Dave Airlief453ba02008-11-07 14:05:41 -0800169}
170EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
171
Dave Airlief453ba02008-11-07 14:05:41 -0800172/**
Keith Packardc9fb15f2009-05-30 20:42:28 -0700173 * drm_helper_encoder_in_use - check if a given encoder is in use
174 * @encoder: encoder to check
175 *
176 * LOCKING:
177 * Caller must hold mode config lock.
178 *
179 * Walk @encoders's DRM device's mode_config and see if it's in use.
180 *
181 * RETURNS:
182 * True if @encoder is part of the mode_config, false otherwise.
183 */
184bool drm_helper_encoder_in_use(struct drm_encoder *encoder)
185{
186 struct drm_connector *connector;
187 struct drm_device *dev = encoder->dev;
188 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
189 if (connector->encoder == encoder)
190 return true;
191 return false;
192}
193EXPORT_SYMBOL(drm_helper_encoder_in_use);
194
195/**
Dave Airlief453ba02008-11-07 14:05:41 -0800196 * drm_helper_crtc_in_use - check if a given CRTC is in a mode_config
197 * @crtc: CRTC to check
198 *
199 * LOCKING:
200 * Caller must hold mode config lock.
201 *
202 * Walk @crtc's DRM device's mode_config and see if it's in use.
203 *
204 * RETURNS:
205 * True if @crtc is part of the mode_config, false otherwise.
206 */
207bool drm_helper_crtc_in_use(struct drm_crtc *crtc)
208{
209 struct drm_encoder *encoder;
210 struct drm_device *dev = crtc->dev;
211 /* FIXME: Locking around list access? */
212 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
Keith Packardc9fb15f2009-05-30 20:42:28 -0700213 if (encoder->crtc == crtc && drm_helper_encoder_in_use(encoder))
Dave Airlief453ba02008-11-07 14:05:41 -0800214 return true;
215 return false;
216}
217EXPORT_SYMBOL(drm_helper_crtc_in_use);
218
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000219static void
220drm_encoder_disable(struct drm_encoder *encoder)
221{
222 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
223
224 if (encoder_funcs->disable)
225 (*encoder_funcs->disable)(encoder);
226 else
227 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
228}
229
Dave Airlief453ba02008-11-07 14:05:41 -0800230/**
David John89347bb2009-12-31 12:00:46 +0530231 * drm_helper_disable_unused_functions - disable unused objects
Dave Airlief453ba02008-11-07 14:05:41 -0800232 * @dev: DRM device
233 *
234 * LOCKING:
235 * Caller must hold mode config lock.
236 *
237 * If an connector or CRTC isn't part of @dev's mode_config, it can be disabled
238 * by calling its dpms function, which should power it off.
239 */
240void drm_helper_disable_unused_functions(struct drm_device *dev)
241{
242 struct drm_encoder *encoder;
Dave Airliea3a05442009-08-31 15:16:30 +1000243 struct drm_connector *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800244 struct drm_crtc *crtc;
245
Dave Airliea3a05442009-08-31 15:16:30 +1000246 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
247 if (!connector->encoder)
248 continue;
249 if (connector->status == connector_status_disconnected)
250 connector->encoder = NULL;
251 }
252
Dave Airlief453ba02008-11-07 14:05:41 -0800253 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
Dave Airlie929710212010-12-21 12:47:56 +1000254 if (!drm_helper_encoder_in_use(encoder)) {
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000255 drm_encoder_disable(encoder);
Dave Airlie9c552dd2009-09-02 14:00:11 +1000256 /* disconnector encoder from any connector */
257 encoder->crtc = NULL;
Dave Airliea3a05442009-08-31 15:16:30 +1000258 }
Dave Airlief453ba02008-11-07 14:05:41 -0800259 }
260
261 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
262 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
263 crtc->enabled = drm_helper_crtc_in_use(crtc);
264 if (!crtc->enabled) {
Alex Deucher5c8d7172010-06-11 17:04:35 -0400265 if (crtc_funcs->disable)
266 (*crtc_funcs->disable)(crtc);
267 else
268 (*crtc_funcs->dpms)(crtc, DRM_MODE_DPMS_OFF);
Dave Airlief453ba02008-11-07 14:05:41 -0800269 crtc->fb = NULL;
270 }
271 }
272}
273EXPORT_SYMBOL(drm_helper_disable_unused_functions);
274
Jesse Barnes7bec7562009-02-23 16:09:34 -0800275/**
276 * drm_encoder_crtc_ok - can a given crtc drive a given encoder?
277 * @encoder: encoder to test
278 * @crtc: crtc to test
279 *
280 * Return false if @encoder can't be driven by @crtc, true otherwise.
281 */
282static bool drm_encoder_crtc_ok(struct drm_encoder *encoder,
283 struct drm_crtc *crtc)
284{
285 struct drm_device *dev;
286 struct drm_crtc *tmp;
287 int crtc_mask = 1;
288
Joe Perchesfce7d612010-10-30 21:08:30 +0000289 WARN(!crtc, "checking null crtc?\n");
Jesse Barnes7bec7562009-02-23 16:09:34 -0800290
291 dev = crtc->dev;
292
293 list_for_each_entry(tmp, &dev->mode_config.crtc_list, head) {
294 if (tmp == crtc)
295 break;
296 crtc_mask <<= 1;
297 }
298
299 if (encoder->possible_crtcs & crtc_mask)
300 return true;
301 return false;
302}
303
304/*
305 * Check the CRTC we're going to map each output to vs. its current
306 * CRTC. If they don't match, we have to disable the output and the CRTC
307 * since the driver will have to re-route things.
308 */
309static void
310drm_crtc_prepare_encoders(struct drm_device *dev)
311{
312 struct drm_encoder_helper_funcs *encoder_funcs;
313 struct drm_encoder *encoder;
314
315 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
316 encoder_funcs = encoder->helper_private;
317 /* Disable unused encoders */
318 if (encoder->crtc == NULL)
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000319 drm_encoder_disable(encoder);
Jesse Barnes7bec7562009-02-23 16:09:34 -0800320 /* Disable encoders whose CRTC is about to change */
321 if (encoder_funcs->get_crtc &&
322 encoder->crtc != (*encoder_funcs->get_crtc)(encoder))
Ben Skeggs86a1b9d2010-07-01 16:49:57 +1000323 drm_encoder_disable(encoder);
Jesse Barnes7bec7562009-02-23 16:09:34 -0800324 }
325}
326
Dave Airlief453ba02008-11-07 14:05:41 -0800327/**
328 * drm_crtc_set_mode - set a mode
329 * @crtc: CRTC to program
330 * @mode: mode to use
331 * @x: width of mode
332 * @y: height of mode
333 *
334 * LOCKING:
335 * Caller must hold mode config lock.
336 *
337 * Try to set @mode on @crtc. Give @crtc and its associated connectors a chance
338 * to fixup or reject the mode prior to trying to set it.
339 *
340 * RETURNS:
341 * True if the mode was set successfully, or false otherwise.
342 */
343bool drm_crtc_helper_set_mode(struct drm_crtc *crtc,
344 struct drm_display_mode *mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500345 int x, int y,
346 struct drm_framebuffer *old_fb)
Dave Airlief453ba02008-11-07 14:05:41 -0800347{
348 struct drm_device *dev = crtc->dev;
Mario Kleiner27641c32010-10-23 04:20:23 +0200349 struct drm_display_mode *adjusted_mode, saved_mode, saved_hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800350 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
351 struct drm_encoder_helper_funcs *encoder_funcs;
352 int saved_x, saved_y;
353 struct drm_encoder *encoder;
354 bool ret = true;
355
Dave Airlief453ba02008-11-07 14:05:41 -0800356 crtc->enabled = drm_helper_crtc_in_use(crtc);
Dave Airlief453ba02008-11-07 14:05:41 -0800357 if (!crtc->enabled)
358 return true;
359
Chris Wilson021a8452011-01-28 11:31:56 +0000360 adjusted_mode = drm_mode_duplicate(dev, mode);
Ville Syrjälä6bfc56a2012-03-13 12:35:48 +0200361 if (!adjusted_mode)
362 return false;
Chris Wilson021a8452011-01-28 11:31:56 +0000363
Mario Kleiner27641c32010-10-23 04:20:23 +0200364 saved_hwmode = crtc->hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800365 saved_mode = crtc->mode;
366 saved_x = crtc->x;
367 saved_y = crtc->y;
368
369 /* Update crtc values up front so the driver can rely on them for mode
370 * setting.
371 */
372 crtc->mode = *mode;
373 crtc->x = x;
374 crtc->y = y;
375
Dave Airlief453ba02008-11-07 14:05:41 -0800376 /* Pass our mode to the connectors and the CRTC to give them a chance to
377 * adjust it according to limitations or connector properties, and also
378 * a chance to reject the mode entirely.
379 */
380 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
381
382 if (encoder->crtc != crtc)
383 continue;
384 encoder_funcs = encoder->helper_private;
385 if (!(ret = encoder_funcs->mode_fixup(encoder, mode,
386 adjusted_mode))) {
Adam Jackson836e53d2011-10-10 16:21:27 -0400387 DRM_DEBUG_KMS("Encoder fixup failed\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800388 goto done;
389 }
390 }
391
392 if (!(ret = crtc_funcs->mode_fixup(crtc, mode, adjusted_mode))) {
Adam Jackson836e53d2011-10-10 16:21:27 -0400393 DRM_DEBUG_KMS("CRTC fixup failed\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800394 goto done;
395 }
Jerome Glisse94401062010-07-15 15:43:25 -0400396 DRM_DEBUG_KMS("[CRTC:%d]\n", crtc->base.id);
Dave Airlief453ba02008-11-07 14:05:41 -0800397
398 /* Prepare the encoders and CRTCs before setting the mode. */
399 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
400
401 if (encoder->crtc != crtc)
402 continue;
403 encoder_funcs = encoder->helper_private;
404 /* Disable the encoders as the first thing we do. */
405 encoder_funcs->prepare(encoder);
406 }
407
Jesse Barnes7bec7562009-02-23 16:09:34 -0800408 drm_crtc_prepare_encoders(dev);
409
Dave Airlief453ba02008-11-07 14:05:41 -0800410 crtc_funcs->prepare(crtc);
411
412 /* Set up the DPLL and any encoders state that needs to adjust or depend
413 * on the DPLL.
414 */
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000415 ret = !crtc_funcs->mode_set(crtc, mode, adjusted_mode, x, y, old_fb);
416 if (!ret)
417 goto done;
Dave Airlief453ba02008-11-07 14:05:41 -0800418
419 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
420
421 if (encoder->crtc != crtc)
422 continue;
423
Jerome Glisse94401062010-07-15 15:43:25 -0400424 DRM_DEBUG_KMS("[ENCODER:%d:%s] set [MODE:%d:%s]\n",
425 encoder->base.id, drm_get_encoder_name(encoder),
426 mode->base.id, mode->name);
Dave Airlief453ba02008-11-07 14:05:41 -0800427 encoder_funcs = encoder->helper_private;
428 encoder_funcs->mode_set(encoder, mode, adjusted_mode);
429 }
430
431 /* Now enable the clocks, plane, pipe, and connectors that we set up. */
432 crtc_funcs->commit(crtc);
433
434 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
435
436 if (encoder->crtc != crtc)
437 continue;
438
439 encoder_funcs = encoder->helper_private;
440 encoder_funcs->commit(encoder);
441
442 }
443
Mario Kleiner27641c32010-10-23 04:20:23 +0200444 /* Store real post-adjustment hardware mode. */
445 crtc->hwmode = *adjusted_mode;
446
447 /* Calculate and store various constants which
448 * are later needed by vblank and swap-completion
449 * timestamping. They are derived from true hwmode.
450 */
451 drm_calc_timestamping_constants(crtc);
452
Dave Airlief453ba02008-11-07 14:05:41 -0800453 /* FIXME: add subpixel order */
454done:
Chris Wilson021a8452011-01-28 11:31:56 +0000455 drm_mode_destroy(dev, adjusted_mode);
Dave Airlief453ba02008-11-07 14:05:41 -0800456 if (!ret) {
Mario Kleiner27641c32010-10-23 04:20:23 +0200457 crtc->hwmode = saved_hwmode;
Dave Airlief453ba02008-11-07 14:05:41 -0800458 crtc->mode = saved_mode;
459 crtc->x = saved_x;
460 crtc->y = saved_y;
461 }
462
463 return ret;
464}
465EXPORT_SYMBOL(drm_crtc_helper_set_mode);
466
467
Chris Wilson6eebd6b2011-11-28 21:10:05 +0000468static int
469drm_crtc_helper_disable(struct drm_crtc *crtc)
470{
471 struct drm_device *dev = crtc->dev;
472 struct drm_connector *connector;
473 struct drm_encoder *encoder;
474
475 /* Decouple all encoders and their attached connectors from this crtc */
476 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
477 if (encoder->crtc != crtc)
478 continue;
479
480 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
481 if (connector->encoder != encoder)
482 continue;
483
484 connector->encoder = NULL;
485 }
486 }
487
488 drm_helper_disable_unused_functions(dev);
489 return 0;
490}
491
Dave Airlief453ba02008-11-07 14:05:41 -0800492/**
493 * drm_crtc_helper_set_config - set a new config from userspace
494 * @crtc: CRTC to setup
495 * @crtc_info: user provided configuration
496 * @new_mode: new mode to set
497 * @connector_set: set of connectors for the new config
498 * @fb: new framebuffer
499 *
500 * LOCKING:
501 * Caller must hold mode config lock.
502 *
503 * Setup a new configuration, provided by the user in @crtc_info, and enable
504 * it.
505 *
506 * RETURNS:
507 * Zero. (FIXME)
508 */
509int drm_crtc_helper_set_config(struct drm_mode_set *set)
510{
511 struct drm_device *dev;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200512 struct drm_crtc *save_crtcs, *new_crtc, *crtc;
513 struct drm_encoder *save_encoders, *new_encoder, *encoder;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800514 struct drm_framebuffer *old_fb = NULL;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100515 bool mode_changed = false; /* if true do a full mode set */
516 bool fb_changed = false; /* if true and !mode_changed just do a flip */
Maarten Maathuise67aae72009-08-27 10:18:29 +0200517 struct drm_connector *save_connectors, *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800518 int count = 0, ro, fail = 0;
519 struct drm_crtc_helper_funcs *crtc_funcs;
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800520 struct drm_mode_set save_set;
Laurent Pinchart4a1b0712012-05-17 13:27:21 +0200521 int ret;
Keith Packardbf9dc102010-11-26 10:45:58 -0800522 int i;
Dave Airlief453ba02008-11-07 14:05:41 -0800523
Zhao Yakui58367ed2009-07-20 13:48:07 +0800524 DRM_DEBUG_KMS("\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800525
526 if (!set)
527 return -EINVAL;
528
529 if (!set->crtc)
530 return -EINVAL;
531
532 if (!set->crtc->helper_private)
533 return -EINVAL;
534
535 crtc_funcs = set->crtc->helper_private;
536
Chris Wilsonede3ff52011-01-31 11:16:33 +0000537 if (!set->mode)
538 set->fb = NULL;
539
Jerome Glisse94401062010-07-15 15:43:25 -0400540 if (set->fb) {
541 DRM_DEBUG_KMS("[CRTC:%d] [FB:%d] #connectors=%d (x y) (%i %i)\n",
542 set->crtc->base.id, set->fb->base.id,
543 (int)set->num_connectors, set->x, set->y);
544 } else {
Chris Wilsonede3ff52011-01-31 11:16:33 +0000545 DRM_DEBUG_KMS("[CRTC:%d] [NOFB]\n", set->crtc->base.id);
Chris Wilson6eebd6b2011-11-28 21:10:05 +0000546 return drm_crtc_helper_disable(set->crtc);
Jerome Glisse94401062010-07-15 15:43:25 -0400547 }
Dave Airlief453ba02008-11-07 14:05:41 -0800548
549 dev = set->crtc->dev;
550
Maarten Maathuise67aae72009-08-27 10:18:29 +0200551 /* Allocate space for the backup of all (non-pointer) crtc, encoder and
552 * connector data. */
553 save_crtcs = kzalloc(dev->mode_config.num_crtc *
554 sizeof(struct drm_crtc), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800555 if (!save_crtcs)
556 return -ENOMEM;
557
Maarten Maathuise67aae72009-08-27 10:18:29 +0200558 save_encoders = kzalloc(dev->mode_config.num_encoder *
559 sizeof(struct drm_encoder), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800560 if (!save_encoders) {
561 kfree(save_crtcs);
562 return -ENOMEM;
563 }
564
Maarten Maathuise67aae72009-08-27 10:18:29 +0200565 save_connectors = kzalloc(dev->mode_config.num_connector *
566 sizeof(struct drm_connector), GFP_KERNEL);
567 if (!save_connectors) {
568 kfree(save_crtcs);
569 kfree(save_encoders);
570 return -ENOMEM;
571 }
572
573 /* Copy data. Note that driver private data is not affected.
574 * Should anything bad happen only the expected state is
575 * restored, not the drivers personal bookkeeping.
576 */
577 count = 0;
578 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
579 save_crtcs[count++] = *crtc;
580 }
581
582 count = 0;
583 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
584 save_encoders[count++] = *encoder;
585 }
586
587 count = 0;
588 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
589 save_connectors[count++] = *connector;
590 }
591
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800592 save_set.crtc = set->crtc;
593 save_set.mode = &set->crtc->mode;
594 save_set.x = set->crtc->x;
595 save_set.y = set->crtc->y;
596 save_set.fb = set->crtc->fb;
597
Dave Airlief453ba02008-11-07 14:05:41 -0800598 /* We should be able to check here if the fb has the same properties
599 * and then just flip_or_move it */
600 if (set->crtc->fb != set->fb) {
Jesse Barnes712531b2009-01-09 13:56:14 -0800601 /* If we have no fb then treat it as a full mode set */
Jesse Barnes7bec7562009-02-23 16:09:34 -0800602 if (set->crtc->fb == NULL) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800603 DRM_DEBUG_KMS("crtc has no fb, full mode set\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800604 mode_changed = true;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100605 } else if (set->fb == NULL) {
606 mode_changed = true;
Jesse Barnes46e48452011-06-24 12:19:26 -0700607 } else if (set->fb->depth != set->crtc->fb->depth) {
608 mode_changed = true;
609 } else if (set->fb->bits_per_pixel !=
610 set->crtc->fb->bits_per_pixel) {
611 mode_changed = true;
Dave Airlie8dff4742010-02-11 14:28:58 +1000612 } else
Jesse Barnes712531b2009-01-09 13:56:14 -0800613 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800614 }
615
616 if (set->x != set->crtc->x || set->y != set->crtc->y)
Jesse Barnes712531b2009-01-09 13:56:14 -0800617 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800618
619 if (set->mode && !drm_mode_equal(set->mode, &set->crtc->mode)) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800620 DRM_DEBUG_KMS("modes are different, full mode set\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800621 drm_mode_debug_printmodeline(&set->crtc->mode);
622 drm_mode_debug_printmodeline(set->mode);
Jesse Barnes712531b2009-01-09 13:56:14 -0800623 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800624 }
625
626 /* a) traverse passed in connector list and get encoders for them */
627 count = 0;
628 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
629 struct drm_connector_helper_funcs *connector_funcs =
630 connector->helper_private;
Dave Airlief453ba02008-11-07 14:05:41 -0800631 new_encoder = connector->encoder;
632 for (ro = 0; ro < set->num_connectors; ro++) {
633 if (set->connectors[ro] == connector) {
634 new_encoder = connector_funcs->best_encoder(connector);
635 /* if we can't get an encoder for a connector
636 we are setting now - then fail */
637 if (new_encoder == NULL)
638 /* don't break so fail path works correct */
639 fail = 1;
640 break;
641 }
642 }
643
644 if (new_encoder != connector->encoder) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800645 DRM_DEBUG_KMS("encoder changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800646 mode_changed = true;
Maarten Maathuisff846ab2009-08-19 00:56:45 +0200647 /* If the encoder is reused for another connector, then
648 * the appropriate crtc will be set later.
649 */
Maarten Maathuisff6fdbe2009-09-01 03:39:04 +0200650 if (connector->encoder)
651 connector->encoder->crtc = NULL;
Dave Airlief453ba02008-11-07 14:05:41 -0800652 connector->encoder = new_encoder;
653 }
654 }
655
656 if (fail) {
657 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200658 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800659 }
660
661 count = 0;
662 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
663 if (!connector->encoder)
664 continue;
665
Dave Airlief453ba02008-11-07 14:05:41 -0800666 if (connector->encoder->crtc == set->crtc)
667 new_crtc = NULL;
668 else
669 new_crtc = connector->encoder->crtc;
670
671 for (ro = 0; ro < set->num_connectors; ro++) {
672 if (set->connectors[ro] == connector)
673 new_crtc = set->crtc;
674 }
Jesse Barnes7bec7562009-02-23 16:09:34 -0800675
676 /* Make sure the new CRTC will work with the encoder */
677 if (new_crtc &&
678 !drm_encoder_crtc_ok(connector->encoder, new_crtc)) {
679 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200680 goto fail;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800681 }
Dave Airlief453ba02008-11-07 14:05:41 -0800682 if (new_crtc != connector->encoder->crtc) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800683 DRM_DEBUG_KMS("crtc changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800684 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800685 connector->encoder->crtc = new_crtc;
686 }
Jerome Glisse94401062010-07-15 15:43:25 -0400687 if (new_crtc) {
688 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [CRTC:%d]\n",
689 connector->base.id, drm_get_connector_name(connector),
690 new_crtc->base.id);
691 } else {
692 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] to [NOCRTC]\n",
693 connector->base.id, drm_get_connector_name(connector));
694 }
Dave Airlief453ba02008-11-07 14:05:41 -0800695 }
696
697 /* mode_set_base is not a required function */
Jesse Barnes712531b2009-01-09 13:56:14 -0800698 if (fb_changed && !crtc_funcs->mode_set_base)
699 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800700
Jesse Barnes712531b2009-01-09 13:56:14 -0800701 if (mode_changed) {
Chris Wilson9334ef72011-01-28 11:53:03 +0000702 set->crtc->enabled = drm_helper_crtc_in_use(set->crtc);
703 if (set->crtc->enabled) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800704 DRM_DEBUG_KMS("attempting to set mode from"
705 " userspace\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800706 drm_mode_debug_printmodeline(set->mode);
Chris Wilson356ad3c2010-09-09 09:41:32 +0100707 old_fb = set->crtc->fb;
708 set->crtc->fb = set->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800709 if (!drm_crtc_helper_set_mode(set->crtc, set->mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500710 set->x, set->y,
711 old_fb)) {
Jerome Glisse94401062010-07-15 15:43:25 -0400712 DRM_ERROR("failed to set mode on [CRTC:%d]\n",
713 set->crtc->base.id);
Chris Wilson0ba41e42011-01-08 15:10:41 +0000714 set->crtc->fb = old_fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800715 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200716 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800717 }
Keith Packard811aaa52011-02-03 16:57:28 -0800718 DRM_DEBUG_KMS("Setting connector DPMS state to on\n");
719 for (i = 0; i < set->num_connectors; i++) {
720 DRM_DEBUG_KMS("\t[CONNECTOR:%d:%s] set DPMS on\n", set->connectors[i]->base.id,
721 drm_get_connector_name(set->connectors[i]));
Rob Clarkc7548832011-12-15 14:53:24 -0600722 set->connectors[i]->funcs->dpms(set->connectors[i], DRM_MODE_DPMS_ON);
Keith Packard811aaa52011-02-03 16:57:28 -0800723 }
Dave Airlief453ba02008-11-07 14:05:41 -0800724 }
725 drm_helper_disable_unused_functions(dev);
Jesse Barnes712531b2009-01-09 13:56:14 -0800726 } else if (fb_changed) {
Ben Skeggs9b1596a2009-09-18 10:43:52 +1000727 set->crtc->x = set->x;
728 set->crtc->y = set->y;
729
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500730 old_fb = set->crtc->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800731 if (set->crtc->fb != set->fb)
732 set->crtc->fb = set->fb;
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000733 ret = crtc_funcs->mode_set_base(set->crtc,
734 set->x, set->y, old_fb);
Chris Wilson0ba41e42011-01-08 15:10:41 +0000735 if (ret != 0) {
736 set->crtc->fb = old_fb;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200737 goto fail;
Chris Wilson0ba41e42011-01-08 15:10:41 +0000738 }
Dave Airlief453ba02008-11-07 14:05:41 -0800739 }
740
Maarten Maathuise67aae72009-08-27 10:18:29 +0200741 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800742 kfree(save_encoders);
743 kfree(save_crtcs);
744 return 0;
745
Maarten Maathuise67aae72009-08-27 10:18:29 +0200746fail:
747 /* Restore all previous data. */
Dave Airlief453ba02008-11-07 14:05:41 -0800748 count = 0;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200749 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
750 *crtc = save_crtcs[count++];
751 }
Chris Wilsone62fb642009-02-11 16:39:21 +0000752
Maarten Maathuise67aae72009-08-27 10:18:29 +0200753 count = 0;
754 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
755 *encoder = save_encoders[count++];
Chris Wilsone62fb642009-02-11 16:39:21 +0000756 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200757
Dave Airlief453ba02008-11-07 14:05:41 -0800758 count = 0;
759 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Maarten Maathuise67aae72009-08-27 10:18:29 +0200760 *connector = save_connectors[count++];
Dave Airlief453ba02008-11-07 14:05:41 -0800761 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200762
Jesse Barnesc5006cfe2011-11-07 10:39:57 -0800763 /* Try to restore the config */
764 if (mode_changed &&
765 !drm_crtc_helper_set_mode(save_set.crtc, save_set.mode, save_set.x,
766 save_set.y, save_set.fb))
767 DRM_ERROR("failed to restore config after modeset failure\n");
768
Maarten Maathuise67aae72009-08-27 10:18:29 +0200769 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800770 kfree(save_encoders);
Maarten Maathuise67aae72009-08-27 10:18:29 +0200771 kfree(save_crtcs);
Dave Airlief453ba02008-11-07 14:05:41 -0800772 return ret;
773}
774EXPORT_SYMBOL(drm_crtc_helper_set_config);
775
Keith Packardc9fb15f2009-05-30 20:42:28 -0700776static int drm_helper_choose_encoder_dpms(struct drm_encoder *encoder)
777{
778 int dpms = DRM_MODE_DPMS_OFF;
779 struct drm_connector *connector;
780 struct drm_device *dev = encoder->dev;
781
782 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
783 if (connector->encoder == encoder)
784 if (connector->dpms < dpms)
785 dpms = connector->dpms;
786 return dpms;
787}
788
789static int drm_helper_choose_crtc_dpms(struct drm_crtc *crtc)
790{
791 int dpms = DRM_MODE_DPMS_OFF;
792 struct drm_connector *connector;
793 struct drm_device *dev = crtc->dev;
794
795 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
796 if (connector->encoder && connector->encoder->crtc == crtc)
797 if (connector->dpms < dpms)
798 dpms = connector->dpms;
799 return dpms;
800}
801
802/**
803 * drm_helper_connector_dpms
804 * @connector affected connector
805 * @mode DPMS mode
806 *
807 * Calls the low-level connector DPMS function, then
808 * calls appropriate encoder and crtc DPMS functions as well
809 */
810void drm_helper_connector_dpms(struct drm_connector *connector, int mode)
811{
812 struct drm_encoder *encoder = connector->encoder;
813 struct drm_crtc *crtc = encoder ? encoder->crtc : NULL;
814 int old_dpms;
815
816 if (mode == connector->dpms)
817 return;
818
819 old_dpms = connector->dpms;
820 connector->dpms = mode;
821
822 /* from off to on, do crtc then encoder */
823 if (mode < old_dpms) {
824 if (crtc) {
825 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
826 if (crtc_funcs->dpms)
827 (*crtc_funcs->dpms) (crtc,
828 drm_helper_choose_crtc_dpms(crtc));
829 }
830 if (encoder) {
831 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
832 if (encoder_funcs->dpms)
833 (*encoder_funcs->dpms) (encoder,
834 drm_helper_choose_encoder_dpms(encoder));
835 }
836 }
837
838 /* from on to off, do encoder then crtc */
839 if (mode > old_dpms) {
840 if (encoder) {
841 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
842 if (encoder_funcs->dpms)
843 (*encoder_funcs->dpms) (encoder,
844 drm_helper_choose_encoder_dpms(encoder));
845 }
846 if (crtc) {
847 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
848 if (crtc_funcs->dpms)
849 (*crtc_funcs->dpms) (crtc,
850 drm_helper_choose_crtc_dpms(crtc));
851 }
852 }
853
854 return;
855}
856EXPORT_SYMBOL(drm_helper_connector_dpms);
857
Dave Airlief453ba02008-11-07 14:05:41 -0800858int drm_helper_mode_fill_fb_struct(struct drm_framebuffer *fb,
Jesse Barnes308e5bc2011-11-14 14:51:28 -0800859 struct drm_mode_fb_cmd2 *mode_cmd)
Dave Airlief453ba02008-11-07 14:05:41 -0800860{
Ville Syrjälä01f2c772011-12-20 00:06:49 +0200861 int i;
862
Dave Airlief453ba02008-11-07 14:05:41 -0800863 fb->width = mode_cmd->width;
864 fb->height = mode_cmd->height;
Ville Syrjälä01f2c772011-12-20 00:06:49 +0200865 for (i = 0; i < 4; i++) {
866 fb->pitches[i] = mode_cmd->pitches[i];
867 fb->offsets[i] = mode_cmd->offsets[i];
868 }
Dave Airlie248dbc22011-11-29 20:02:54 +0000869 drm_fb_get_bpp_depth(mode_cmd->pixel_format, &fb->depth,
Jesse Barnes308e5bc2011-11-14 14:51:28 -0800870 &fb->bits_per_pixel);
871 fb->pixel_format = mode_cmd->pixel_format;
Dave Airlief453ba02008-11-07 14:05:41 -0800872
873 return 0;
874}
875EXPORT_SYMBOL(drm_helper_mode_fill_fb_struct);
876
877int drm_helper_resume_force_mode(struct drm_device *dev)
878{
879 struct drm_crtc *crtc;
David John89347bb2009-12-31 12:00:46 +0530880 struct drm_encoder *encoder;
881 struct drm_encoder_helper_funcs *encoder_funcs;
882 struct drm_crtc_helper_funcs *crtc_funcs;
Dave Airlief453ba02008-11-07 14:05:41 -0800883 int ret;
884
885 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
886
887 if (!crtc->enabled)
888 continue;
889
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500890 ret = drm_crtc_helper_set_mode(crtc, &crtc->mode,
891 crtc->x, crtc->y, crtc->fb);
Dave Airlief453ba02008-11-07 14:05:41 -0800892
893 if (ret == false)
894 DRM_ERROR("failed to set mode on crtc %p\n", crtc);
David John89347bb2009-12-31 12:00:46 +0530895
896 /* Turn off outputs that were already powered off */
897 if (drm_helper_choose_crtc_dpms(crtc)) {
898 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
899
900 if(encoder->crtc != crtc)
901 continue;
902
903 encoder_funcs = encoder->helper_private;
904 if (encoder_funcs->dpms)
905 (*encoder_funcs->dpms) (encoder,
906 drm_helper_choose_encoder_dpms(encoder));
David John89347bb2009-12-31 12:00:46 +0530907 }
Chris Wilson817e6312010-08-06 15:03:31 +0100908
909 crtc_funcs = crtc->helper_private;
910 if (crtc_funcs->dpms)
911 (*crtc_funcs->dpms) (crtc,
912 drm_helper_choose_crtc_dpms(crtc));
David John89347bb2009-12-31 12:00:46 +0530913 }
Dave Airlief453ba02008-11-07 14:05:41 -0800914 }
Zhao Yakuiaf4fcb52009-07-08 14:13:13 +0800915 /* disable the unused connectors while restoring the modesetting */
916 drm_helper_disable_unused_functions(dev);
Dave Airlief453ba02008-11-07 14:05:41 -0800917 return 0;
918}
919EXPORT_SYMBOL(drm_helper_resume_force_mode);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000920
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000921#define DRM_OUTPUT_POLL_PERIOD (10*HZ)
Tejun Heo991ea752010-07-20 22:09:02 +0200922static void output_poll_execute(struct work_struct *work)
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000923{
Tejun Heo991ea752010-07-20 22:09:02 +0200924 struct delayed_work *delayed_work = to_delayed_work(work);
925 struct drm_device *dev = container_of(delayed_work, struct drm_device, mode_config.output_poll_work);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000926 struct drm_connector *connector;
Keith Packardc5027de2010-11-26 10:45:59 -0800927 enum drm_connector_status old_status;
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000928 bool repoll = false, changed = false;
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000929
Chris Wilsone58f6372010-08-20 09:13:36 +0100930 if (!drm_kms_helper_poll)
931 return;
932
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000933 mutex_lock(&dev->mode_config.mutex);
934 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
935
936 /* if this is HPD or polled don't check it -
937 TV out for instance */
938 if (!connector->polled)
939 continue;
940
941 else if (connector->polled & (DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT))
942 repoll = true;
943
944 old_status = connector->status;
945 /* if we are connected and don't want to poll for disconnect
946 skip it */
947 if (old_status == connector_status_connected &&
948 !(connector->polled & DRM_CONNECTOR_POLL_DISCONNECT) &&
949 !(connector->polled & DRM_CONNECTOR_POLL_HPD))
950 continue;
951
Keith Packardc5027de2010-11-26 10:45:59 -0800952 connector->status = connector->funcs->detect(connector, false);
Chris Wilson0f168302010-12-21 22:49:28 +0000953 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %d to %d\n",
954 connector->base.id,
955 drm_get_connector_name(connector),
956 old_status, connector->status);
Keith Packardc5027de2010-11-26 10:45:59 -0800957 if (old_status != connector->status)
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000958 changed = true;
959 }
960
961 mutex_unlock(&dev->mode_config.mutex);
962
963 if (changed) {
964 /* send a uevent + call fbdev */
965 drm_sysfs_hotplug_event(dev);
966 if (dev->mode_config.funcs->output_poll_changed)
967 dev->mode_config.funcs->output_poll_changed(dev);
968 }
969
Tejun Heo9a919c42010-08-09 12:01:27 +0200970 if (repoll)
971 queue_delayed_work(system_nrt_wq, delayed_work, DRM_OUTPUT_POLL_PERIOD);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000972}
973
Dave Airliefbf81762010-06-01 09:09:06 +1000974void drm_kms_helper_poll_disable(struct drm_device *dev)
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000975{
Dave Airliefbf81762010-06-01 09:09:06 +1000976 if (!dev->mode_config.poll_enabled)
977 return;
Tejun Heo991ea752010-07-20 22:09:02 +0200978 cancel_delayed_work_sync(&dev->mode_config.output_poll_work);
Dave Airliefbf81762010-06-01 09:09:06 +1000979}
980EXPORT_SYMBOL(drm_kms_helper_poll_disable);
981
982void drm_kms_helper_poll_enable(struct drm_device *dev)
983{
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000984 bool poll = false;
Dave Airliefbf81762010-06-01 09:09:06 +1000985 struct drm_connector *connector;
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000986
Chris Wilsone58f6372010-08-20 09:13:36 +0100987 if (!dev->mode_config.poll_enabled || !drm_kms_helper_poll)
988 return;
989
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000990 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
991 if (connector->polled)
992 poll = true;
993 }
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000994
Tejun Heo9a919c42010-08-09 12:01:27 +0200995 if (poll)
996 queue_delayed_work(system_nrt_wq, &dev->mode_config.output_poll_work, DRM_OUTPUT_POLL_PERIOD);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000997}
Dave Airliefbf81762010-06-01 09:09:06 +1000998EXPORT_SYMBOL(drm_kms_helper_poll_enable);
999
1000void drm_kms_helper_poll_init(struct drm_device *dev)
1001{
Tejun Heo991ea752010-07-20 22:09:02 +02001002 INIT_DELAYED_WORK(&dev->mode_config.output_poll_work, output_poll_execute);
Dave Airliefbf81762010-06-01 09:09:06 +10001003 dev->mode_config.poll_enabled = true;
1004
1005 drm_kms_helper_poll_enable(dev);
1006}
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001007EXPORT_SYMBOL(drm_kms_helper_poll_init);
1008
1009void drm_kms_helper_poll_fini(struct drm_device *dev)
1010{
Dave Airliefbf81762010-06-01 09:09:06 +10001011 drm_kms_helper_poll_disable(dev);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001012}
1013EXPORT_SYMBOL(drm_kms_helper_poll_fini);
1014
1015void drm_helper_hpd_irq_event(struct drm_device *dev)
1016{
1017 if (!dev->mode_config.poll_enabled)
1018 return;
Chris Wilsone58f6372010-08-20 09:13:36 +01001019
Tejun Heo991ea752010-07-20 22:09:02 +02001020 /* kill timer and schedule immediate execution, this doesn't block */
1021 cancel_delayed_work(&dev->mode_config.output_poll_work);
Chris Wilsone58f6372010-08-20 09:13:36 +01001022 if (drm_kms_helper_poll)
1023 queue_delayed_work(system_nrt_wq, &dev->mode_config.output_poll_work, 0);
Dave Airlieeb1f8e42010-05-07 06:42:51 +00001024}
1025EXPORT_SYMBOL(drm_helper_hpd_irq_event);