blob: fa1323ff56b3ada755acebf0a92500f090814229 [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
32#include "drmP.h"
33#include "drm_crtc.h"
34#include "drm_crtc_helper.h"
Dave Airlied50ba252009-09-23 14:44:08 +100035#include "drm_fb_helper.h"
Dave Airlief453ba02008-11-07 14:05:41 -080036
yakui_zhao67149772009-04-02 11:52:12 +080037static void drm_mode_validate_flag(struct drm_connector *connector,
38 int flags)
39{
40 struct drm_display_mode *mode, *t;
41
42 if (flags == (DRM_MODE_FLAG_DBLSCAN | DRM_MODE_FLAG_INTERLACE))
43 return;
44
45 list_for_each_entry_safe(mode, t, &connector->modes, head) {
46 if ((mode->flags & DRM_MODE_FLAG_INTERLACE) &&
47 !(flags & DRM_MODE_FLAG_INTERLACE))
48 mode->status = MODE_NO_INTERLACE;
49 if ((mode->flags & DRM_MODE_FLAG_DBLSCAN) &&
50 !(flags & DRM_MODE_FLAG_DBLSCAN))
51 mode->status = MODE_NO_DBLESCAN;
52 }
53
54 return;
55}
56
Dave Airlief453ba02008-11-07 14:05:41 -080057/**
Dave Airlie38651672010-03-30 05:34:13 +000058 * drm_helper_probe_single_connector_modes - get complete set of display modes
Dave Airlief453ba02008-11-07 14:05:41 -080059 * @dev: DRM device
60 * @maxX: max width for modes
61 * @maxY: max height for modes
62 *
63 * LOCKING:
64 * Caller must hold mode config lock.
65 *
66 * Based on @dev's mode_config layout, scan all the connectors and try to detect
67 * modes on them. Modes will first be added to the connector's probed_modes
68 * list, then culled (based on validity and the @maxX, @maxY parameters) and
69 * put into the normal modes list.
70 *
71 * Intended to be used either at bootup time or when major configuration
72 * changes have occurred.
73 *
74 * FIXME: take into account monitor limits
Jesse Barnes40a518d2009-01-12 12:05:32 -080075 *
76 * RETURNS:
77 * Number of modes found on @connector.
Dave Airlief453ba02008-11-07 14:05:41 -080078 */
Jesse Barnes40a518d2009-01-12 12:05:32 -080079int drm_helper_probe_single_connector_modes(struct drm_connector *connector,
80 uint32_t maxX, uint32_t maxY)
Dave Airlief453ba02008-11-07 14:05:41 -080081{
82 struct drm_device *dev = connector->dev;
83 struct drm_display_mode *mode, *t;
84 struct drm_connector_helper_funcs *connector_funcs =
85 connector->helper_private;
Jesse Barnes40a518d2009-01-12 12:05:32 -080086 int count = 0;
yakui_zhao67149772009-04-02 11:52:12 +080087 int mode_flags = 0;
Dave Airlief453ba02008-11-07 14:05:41 -080088
Zhao Yakui58367ed2009-07-20 13:48:07 +080089 DRM_DEBUG_KMS("%s\n", drm_get_connector_name(connector));
Dave Airlief453ba02008-11-07 14:05:41 -080090 /* set all modes to the unverified state */
91 list_for_each_entry_safe(mode, t, &connector->modes, head)
92 mode->status = MODE_UNVERIFIED;
93
Dave Airlied50ba252009-09-23 14:44:08 +100094 if (connector->force) {
95 if (connector->force == DRM_FORCE_ON)
96 connector->status = connector_status_connected;
97 else
98 connector->status = connector_status_disconnected;
99 if (connector->funcs->force)
100 connector->funcs->force(connector);
101 } else
102 connector->status = connector->funcs->detect(connector);
Dave Airlief453ba02008-11-07 14:05:41 -0800103
104 if (connector->status == connector_status_disconnected) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800105 DRM_DEBUG_KMS("%s is disconnected\n",
Dave Airlief453ba02008-11-07 14:05:41 -0800106 drm_get_connector_name(connector));
Zhao Yakui72539832010-03-04 08:25:55 +0000107 drm_mode_connector_update_edid_property(connector, NULL);
Adam Jackson620f3782009-09-08 11:51:46 +1000108 goto prune;
Dave Airlief453ba02008-11-07 14:05:41 -0800109 }
110
Jesse Barnes40a518d2009-01-12 12:05:32 -0800111 count = (*connector_funcs->get_modes)(connector);
ykzhao50fe4cf2009-09-03 14:30:04 +0800112 if (!count) {
Adam Jackson9632b412009-11-23 14:23:07 -0500113 count = drm_add_modes_noedid(connector, 1024, 768);
ykzhao50fe4cf2009-09-03 14:30:04 +0800114 if (!count)
115 return 0;
116 }
Dave Airlief453ba02008-11-07 14:05:41 -0800117
Jesse Barnes40a518d2009-01-12 12:05:32 -0800118 drm_mode_connector_list_update(connector);
Dave Airlief453ba02008-11-07 14:05:41 -0800119
120 if (maxX && maxY)
121 drm_mode_validate_size(dev, &connector->modes, maxX,
122 maxY, 0);
yakui_zhao67149772009-04-02 11:52:12 +0800123
124 if (connector->interlace_allowed)
125 mode_flags |= DRM_MODE_FLAG_INTERLACE;
126 if (connector->doublescan_allowed)
127 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
128 drm_mode_validate_flag(connector, mode_flags);
129
Dave Airlief453ba02008-11-07 14:05:41 -0800130 list_for_each_entry_safe(mode, t, &connector->modes, head) {
131 if (mode->status == MODE_OK)
132 mode->status = connector_funcs->mode_valid(connector,
133 mode);
134 }
135
Adam Jackson620f3782009-09-08 11:51:46 +1000136prune:
Dave Airlief453ba02008-11-07 14:05:41 -0800137 drm_mode_prune_invalid(dev, &connector->modes, true);
138
Jesse Barnes40a518d2009-01-12 12:05:32 -0800139 if (list_empty(&connector->modes))
140 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800141
142 drm_mode_sort(&connector->modes);
143
Zhao Yakui58367ed2009-07-20 13:48:07 +0800144 DRM_DEBUG_KMS("Probed modes for %s\n",
145 drm_get_connector_name(connector));
Dave Airlief453ba02008-11-07 14:05:41 -0800146 list_for_each_entry_safe(mode, t, &connector->modes, head) {
147 mode->vrefresh = drm_mode_vrefresh(mode);
148
149 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
150 drm_mode_debug_printmodeline(mode);
151 }
Jesse Barnes40a518d2009-01-12 12:05:32 -0800152
153 return count;
Dave Airlief453ba02008-11-07 14:05:41 -0800154}
155EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
156
Dave Airlief453ba02008-11-07 14:05:41 -0800157/**
Keith Packardc9fb15f2009-05-30 20:42:28 -0700158 * drm_helper_encoder_in_use - check if a given encoder is in use
159 * @encoder: encoder to check
160 *
161 * LOCKING:
162 * Caller must hold mode config lock.
163 *
164 * Walk @encoders's DRM device's mode_config and see if it's in use.
165 *
166 * RETURNS:
167 * True if @encoder is part of the mode_config, false otherwise.
168 */
169bool drm_helper_encoder_in_use(struct drm_encoder *encoder)
170{
171 struct drm_connector *connector;
172 struct drm_device *dev = encoder->dev;
173 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
174 if (connector->encoder == encoder)
175 return true;
176 return false;
177}
178EXPORT_SYMBOL(drm_helper_encoder_in_use);
179
180/**
Dave Airlief453ba02008-11-07 14:05:41 -0800181 * drm_helper_crtc_in_use - check if a given CRTC is in a mode_config
182 * @crtc: CRTC to check
183 *
184 * LOCKING:
185 * Caller must hold mode config lock.
186 *
187 * Walk @crtc's DRM device's mode_config and see if it's in use.
188 *
189 * RETURNS:
190 * True if @crtc is part of the mode_config, false otherwise.
191 */
192bool drm_helper_crtc_in_use(struct drm_crtc *crtc)
193{
194 struct drm_encoder *encoder;
195 struct drm_device *dev = crtc->dev;
196 /* FIXME: Locking around list access? */
197 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
Keith Packardc9fb15f2009-05-30 20:42:28 -0700198 if (encoder->crtc == crtc && drm_helper_encoder_in_use(encoder))
Dave Airlief453ba02008-11-07 14:05:41 -0800199 return true;
200 return false;
201}
202EXPORT_SYMBOL(drm_helper_crtc_in_use);
203
204/**
David John89347bb2009-12-31 12:00:46 +0530205 * drm_helper_disable_unused_functions - disable unused objects
Dave Airlief453ba02008-11-07 14:05:41 -0800206 * @dev: DRM device
207 *
208 * LOCKING:
209 * Caller must hold mode config lock.
210 *
211 * If an connector or CRTC isn't part of @dev's mode_config, it can be disabled
212 * by calling its dpms function, which should power it off.
213 */
214void drm_helper_disable_unused_functions(struct drm_device *dev)
215{
216 struct drm_encoder *encoder;
Dave Airliea3a05442009-08-31 15:16:30 +1000217 struct drm_connector *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800218 struct drm_encoder_helper_funcs *encoder_funcs;
219 struct drm_crtc *crtc;
220
Dave Airliea3a05442009-08-31 15:16:30 +1000221 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
222 if (!connector->encoder)
223 continue;
224 if (connector->status == connector_status_disconnected)
225 connector->encoder = NULL;
226 }
227
Dave Airlief453ba02008-11-07 14:05:41 -0800228 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
229 encoder_funcs = encoder->helper_private;
Dave Airliea3a05442009-08-31 15:16:30 +1000230 if (!drm_helper_encoder_in_use(encoder)) {
231 if (encoder_funcs->disable)
232 (*encoder_funcs->disable)(encoder);
233 else
234 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
Dave Airlie9c552dd2009-09-02 14:00:11 +1000235 /* disconnector encoder from any connector */
236 encoder->crtc = NULL;
Dave Airliea3a05442009-08-31 15:16:30 +1000237 }
Dave Airlief453ba02008-11-07 14:05:41 -0800238 }
239
240 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
241 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
242 crtc->enabled = drm_helper_crtc_in_use(crtc);
243 if (!crtc->enabled) {
Alex Deucher5c8d7172010-06-11 17:04:35 -0400244 if (crtc_funcs->disable)
245 (*crtc_funcs->disable)(crtc);
246 else
247 (*crtc_funcs->dpms)(crtc, DRM_MODE_DPMS_OFF);
Dave Airlief453ba02008-11-07 14:05:41 -0800248 crtc->fb = NULL;
249 }
250 }
251}
252EXPORT_SYMBOL(drm_helper_disable_unused_functions);
253
Jesse Barnes7bec7562009-02-23 16:09:34 -0800254/**
255 * drm_encoder_crtc_ok - can a given crtc drive a given encoder?
256 * @encoder: encoder to test
257 * @crtc: crtc to test
258 *
259 * Return false if @encoder can't be driven by @crtc, true otherwise.
260 */
261static bool drm_encoder_crtc_ok(struct drm_encoder *encoder,
262 struct drm_crtc *crtc)
263{
264 struct drm_device *dev;
265 struct drm_crtc *tmp;
266 int crtc_mask = 1;
267
268 WARN(!crtc, "checking null crtc?");
269
270 dev = crtc->dev;
271
272 list_for_each_entry(tmp, &dev->mode_config.crtc_list, head) {
273 if (tmp == crtc)
274 break;
275 crtc_mask <<= 1;
276 }
277
278 if (encoder->possible_crtcs & crtc_mask)
279 return true;
280 return false;
281}
282
283/*
284 * Check the CRTC we're going to map each output to vs. its current
285 * CRTC. If they don't match, we have to disable the output and the CRTC
286 * since the driver will have to re-route things.
287 */
288static void
289drm_crtc_prepare_encoders(struct drm_device *dev)
290{
291 struct drm_encoder_helper_funcs *encoder_funcs;
292 struct drm_encoder *encoder;
293
294 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
295 encoder_funcs = encoder->helper_private;
296 /* Disable unused encoders */
297 if (encoder->crtc == NULL)
298 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
299 /* Disable encoders whose CRTC is about to change */
300 if (encoder_funcs->get_crtc &&
301 encoder->crtc != (*encoder_funcs->get_crtc)(encoder))
302 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
303 }
304}
305
Dave Airlief453ba02008-11-07 14:05:41 -0800306/**
307 * drm_crtc_set_mode - set a mode
308 * @crtc: CRTC to program
309 * @mode: mode to use
310 * @x: width of mode
311 * @y: height of mode
312 *
313 * LOCKING:
314 * Caller must hold mode config lock.
315 *
316 * Try to set @mode on @crtc. Give @crtc and its associated connectors a chance
317 * to fixup or reject the mode prior to trying to set it.
318 *
319 * RETURNS:
320 * True if the mode was set successfully, or false otherwise.
321 */
322bool drm_crtc_helper_set_mode(struct drm_crtc *crtc,
323 struct drm_display_mode *mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500324 int x, int y,
325 struct drm_framebuffer *old_fb)
Dave Airlief453ba02008-11-07 14:05:41 -0800326{
327 struct drm_device *dev = crtc->dev;
328 struct drm_display_mode *adjusted_mode, saved_mode;
329 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
330 struct drm_encoder_helper_funcs *encoder_funcs;
331 int saved_x, saved_y;
332 struct drm_encoder *encoder;
333 bool ret = true;
334
335 adjusted_mode = drm_mode_duplicate(dev, mode);
336
337 crtc->enabled = drm_helper_crtc_in_use(crtc);
338
339 if (!crtc->enabled)
340 return true;
341
342 saved_mode = crtc->mode;
343 saved_x = crtc->x;
344 saved_y = crtc->y;
345
346 /* Update crtc values up front so the driver can rely on them for mode
347 * setting.
348 */
349 crtc->mode = *mode;
350 crtc->x = x;
351 crtc->y = y;
352
Dave Airlief453ba02008-11-07 14:05:41 -0800353 /* Pass our mode to the connectors and the CRTC to give them a chance to
354 * adjust it according to limitations or connector properties, and also
355 * a chance to reject the mode entirely.
356 */
357 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
358
359 if (encoder->crtc != crtc)
360 continue;
361 encoder_funcs = encoder->helper_private;
362 if (!(ret = encoder_funcs->mode_fixup(encoder, mode,
363 adjusted_mode))) {
364 goto done;
365 }
366 }
367
368 if (!(ret = crtc_funcs->mode_fixup(crtc, mode, adjusted_mode))) {
369 goto done;
370 }
371
372 /* Prepare the encoders and CRTCs before setting the mode. */
373 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
374
375 if (encoder->crtc != crtc)
376 continue;
377 encoder_funcs = encoder->helper_private;
378 /* Disable the encoders as the first thing we do. */
379 encoder_funcs->prepare(encoder);
380 }
381
Jesse Barnes7bec7562009-02-23 16:09:34 -0800382 drm_crtc_prepare_encoders(dev);
383
Dave Airlief453ba02008-11-07 14:05:41 -0800384 crtc_funcs->prepare(crtc);
385
386 /* Set up the DPLL and any encoders state that needs to adjust or depend
387 * on the DPLL.
388 */
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000389 ret = !crtc_funcs->mode_set(crtc, mode, adjusted_mode, x, y, old_fb);
390 if (!ret)
391 goto done;
Dave Airlief453ba02008-11-07 14:05:41 -0800392
393 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
394
395 if (encoder->crtc != crtc)
396 continue;
397
Dave Youngef145872010-01-13 13:38:59 +0800398 DRM_DEBUG("%s: set mode %s %x\n", drm_get_encoder_name(encoder),
Dave Airlief453ba02008-11-07 14:05:41 -0800399 mode->name, mode->base.id);
400 encoder_funcs = encoder->helper_private;
401 encoder_funcs->mode_set(encoder, mode, adjusted_mode);
402 }
403
404 /* Now enable the clocks, plane, pipe, and connectors that we set up. */
405 crtc_funcs->commit(crtc);
406
407 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
408
409 if (encoder->crtc != crtc)
410 continue;
411
412 encoder_funcs = encoder->helper_private;
413 encoder_funcs->commit(encoder);
414
415 }
416
417 /* XXX free adjustedmode */
418 drm_mode_destroy(dev, adjusted_mode);
419 /* FIXME: add subpixel order */
420done:
421 if (!ret) {
422 crtc->mode = saved_mode;
423 crtc->x = saved_x;
424 crtc->y = saved_y;
425 }
426
427 return ret;
428}
429EXPORT_SYMBOL(drm_crtc_helper_set_mode);
430
431
432/**
433 * drm_crtc_helper_set_config - set a new config from userspace
434 * @crtc: CRTC to setup
435 * @crtc_info: user provided configuration
436 * @new_mode: new mode to set
437 * @connector_set: set of connectors for the new config
438 * @fb: new framebuffer
439 *
440 * LOCKING:
441 * Caller must hold mode config lock.
442 *
443 * Setup a new configuration, provided by the user in @crtc_info, and enable
444 * it.
445 *
446 * RETURNS:
447 * Zero. (FIXME)
448 */
449int drm_crtc_helper_set_config(struct drm_mode_set *set)
450{
451 struct drm_device *dev;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200452 struct drm_crtc *save_crtcs, *new_crtc, *crtc;
453 struct drm_encoder *save_encoders, *new_encoder, *encoder;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800454 struct drm_framebuffer *old_fb = NULL;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100455 bool mode_changed = false; /* if true do a full mode set */
456 bool fb_changed = false; /* if true and !mode_changed just do a flip */
Maarten Maathuise67aae72009-08-27 10:18:29 +0200457 struct drm_connector *save_connectors, *connector;
Dave Airlief453ba02008-11-07 14:05:41 -0800458 int count = 0, ro, fail = 0;
459 struct drm_crtc_helper_funcs *crtc_funcs;
460 int ret = 0;
461
Zhao Yakui58367ed2009-07-20 13:48:07 +0800462 DRM_DEBUG_KMS("\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800463
464 if (!set)
465 return -EINVAL;
466
467 if (!set->crtc)
468 return -EINVAL;
469
470 if (!set->crtc->helper_private)
471 return -EINVAL;
472
473 crtc_funcs = set->crtc->helper_private;
474
Zhao Yakui58367ed2009-07-20 13:48:07 +0800475 DRM_DEBUG_KMS("crtc: %p %d fb: %p connectors: %p num_connectors:"
476 " %d (x, y) (%i, %i)\n",
Dave Airlief453ba02008-11-07 14:05:41 -0800477 set->crtc, set->crtc->base.id, set->fb, set->connectors,
478 (int)set->num_connectors, set->x, set->y);
479
480 dev = set->crtc->dev;
481
Maarten Maathuise67aae72009-08-27 10:18:29 +0200482 /* Allocate space for the backup of all (non-pointer) crtc, encoder and
483 * connector data. */
484 save_crtcs = kzalloc(dev->mode_config.num_crtc *
485 sizeof(struct drm_crtc), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800486 if (!save_crtcs)
487 return -ENOMEM;
488
Maarten Maathuise67aae72009-08-27 10:18:29 +0200489 save_encoders = kzalloc(dev->mode_config.num_encoder *
490 sizeof(struct drm_encoder), GFP_KERNEL);
Dave Airlief453ba02008-11-07 14:05:41 -0800491 if (!save_encoders) {
492 kfree(save_crtcs);
493 return -ENOMEM;
494 }
495
Maarten Maathuise67aae72009-08-27 10:18:29 +0200496 save_connectors = kzalloc(dev->mode_config.num_connector *
497 sizeof(struct drm_connector), GFP_KERNEL);
498 if (!save_connectors) {
499 kfree(save_crtcs);
500 kfree(save_encoders);
501 return -ENOMEM;
502 }
503
504 /* Copy data. Note that driver private data is not affected.
505 * Should anything bad happen only the expected state is
506 * restored, not the drivers personal bookkeeping.
507 */
508 count = 0;
509 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
510 save_crtcs[count++] = *crtc;
511 }
512
513 count = 0;
514 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
515 save_encoders[count++] = *encoder;
516 }
517
518 count = 0;
519 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
520 save_connectors[count++] = *connector;
521 }
522
Dave Airlief453ba02008-11-07 14:05:41 -0800523 /* We should be able to check here if the fb has the same properties
524 * and then just flip_or_move it */
525 if (set->crtc->fb != set->fb) {
Jesse Barnes712531b2009-01-09 13:56:14 -0800526 /* If we have no fb then treat it as a full mode set */
Jesse Barnes7bec7562009-02-23 16:09:34 -0800527 if (set->crtc->fb == NULL) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800528 DRM_DEBUG_KMS("crtc has no fb, full mode set\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800529 mode_changed = true;
Jakob Bornecrantz4cb72b12009-08-03 13:43:59 +0100530 } else if (set->fb == NULL) {
531 mode_changed = true;
Dave Airlie8dff4742010-02-11 14:28:58 +1000532 } else
Jesse Barnes712531b2009-01-09 13:56:14 -0800533 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800534 }
535
536 if (set->x != set->crtc->x || set->y != set->crtc->y)
Jesse Barnes712531b2009-01-09 13:56:14 -0800537 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800538
539 if (set->mode && !drm_mode_equal(set->mode, &set->crtc->mode)) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800540 DRM_DEBUG_KMS("modes are different, full mode set\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800541 drm_mode_debug_printmodeline(&set->crtc->mode);
542 drm_mode_debug_printmodeline(set->mode);
Jesse Barnes712531b2009-01-09 13:56:14 -0800543 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800544 }
545
546 /* a) traverse passed in connector list and get encoders for them */
547 count = 0;
548 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
549 struct drm_connector_helper_funcs *connector_funcs =
550 connector->helper_private;
Dave Airlief453ba02008-11-07 14:05:41 -0800551 new_encoder = connector->encoder;
552 for (ro = 0; ro < set->num_connectors; ro++) {
553 if (set->connectors[ro] == connector) {
554 new_encoder = connector_funcs->best_encoder(connector);
555 /* if we can't get an encoder for a connector
556 we are setting now - then fail */
557 if (new_encoder == NULL)
558 /* don't break so fail path works correct */
559 fail = 1;
560 break;
561 }
562 }
563
564 if (new_encoder != connector->encoder) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800565 DRM_DEBUG_KMS("encoder changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800566 mode_changed = true;
Maarten Maathuisff846ab2009-08-19 00:56:45 +0200567 /* If the encoder is reused for another connector, then
568 * the appropriate crtc will be set later.
569 */
Maarten Maathuisff6fdbe2009-09-01 03:39:04 +0200570 if (connector->encoder)
571 connector->encoder->crtc = NULL;
Dave Airlief453ba02008-11-07 14:05:41 -0800572 connector->encoder = new_encoder;
573 }
574 }
575
576 if (fail) {
577 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200578 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800579 }
580
581 count = 0;
582 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
583 if (!connector->encoder)
584 continue;
585
Dave Airlief453ba02008-11-07 14:05:41 -0800586 if (connector->encoder->crtc == set->crtc)
587 new_crtc = NULL;
588 else
589 new_crtc = connector->encoder->crtc;
590
591 for (ro = 0; ro < set->num_connectors; ro++) {
592 if (set->connectors[ro] == connector)
593 new_crtc = set->crtc;
594 }
Jesse Barnes7bec7562009-02-23 16:09:34 -0800595
596 /* Make sure the new CRTC will work with the encoder */
597 if (new_crtc &&
598 !drm_encoder_crtc_ok(connector->encoder, new_crtc)) {
599 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200600 goto fail;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800601 }
Dave Airlief453ba02008-11-07 14:05:41 -0800602 if (new_crtc != connector->encoder->crtc) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800603 DRM_DEBUG_KMS("crtc changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800604 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800605 connector->encoder->crtc = new_crtc;
606 }
Zhao Yakui58367ed2009-07-20 13:48:07 +0800607 DRM_DEBUG_KMS("setting connector %d crtc to %p\n",
Jesse Barnes7bec7562009-02-23 16:09:34 -0800608 connector->base.id, new_crtc);
Dave Airlief453ba02008-11-07 14:05:41 -0800609 }
610
611 /* mode_set_base is not a required function */
Jesse Barnes712531b2009-01-09 13:56:14 -0800612 if (fb_changed && !crtc_funcs->mode_set_base)
613 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800614
Jesse Barnes712531b2009-01-09 13:56:14 -0800615 if (mode_changed) {
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500616 old_fb = set->crtc->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800617 set->crtc->fb = set->fb;
618 set->crtc->enabled = (set->mode != NULL);
619 if (set->mode != NULL) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800620 DRM_DEBUG_KMS("attempting to set mode from"
621 " userspace\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800622 drm_mode_debug_printmodeline(set->mode);
623 if (!drm_crtc_helper_set_mode(set->crtc, set->mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500624 set->x, set->y,
625 old_fb)) {
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000626 DRM_ERROR("failed to set mode on crtc %p\n",
627 set->crtc);
Dave Airlief453ba02008-11-07 14:05:41 -0800628 ret = -EINVAL;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200629 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800630 }
Dave Airlief453ba02008-11-07 14:05:41 -0800631 }
632 drm_helper_disable_unused_functions(dev);
Jesse Barnes712531b2009-01-09 13:56:14 -0800633 } else if (fb_changed) {
Ben Skeggs9b1596a2009-09-18 10:43:52 +1000634 set->crtc->x = set->x;
635 set->crtc->y = set->y;
636
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500637 old_fb = set->crtc->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800638 if (set->crtc->fb != set->fb)
639 set->crtc->fb = set->fb;
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000640 ret = crtc_funcs->mode_set_base(set->crtc,
641 set->x, set->y, old_fb);
642 if (ret != 0)
Maarten Maathuise67aae72009-08-27 10:18:29 +0200643 goto fail;
Dave Airlief453ba02008-11-07 14:05:41 -0800644 }
645
Maarten Maathuise67aae72009-08-27 10:18:29 +0200646 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800647 kfree(save_encoders);
648 kfree(save_crtcs);
649 return 0;
650
Maarten Maathuise67aae72009-08-27 10:18:29 +0200651fail:
652 /* Restore all previous data. */
Dave Airlief453ba02008-11-07 14:05:41 -0800653 count = 0;
Maarten Maathuise67aae72009-08-27 10:18:29 +0200654 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
655 *crtc = save_crtcs[count++];
656 }
Chris Wilsone62fb642009-02-11 16:39:21 +0000657
Maarten Maathuise67aae72009-08-27 10:18:29 +0200658 count = 0;
659 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
660 *encoder = save_encoders[count++];
Chris Wilsone62fb642009-02-11 16:39:21 +0000661 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200662
Dave Airlief453ba02008-11-07 14:05:41 -0800663 count = 0;
664 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Maarten Maathuise67aae72009-08-27 10:18:29 +0200665 *connector = save_connectors[count++];
Dave Airlief453ba02008-11-07 14:05:41 -0800666 }
Maarten Maathuise67aae72009-08-27 10:18:29 +0200667
668 kfree(save_connectors);
Dave Airlief453ba02008-11-07 14:05:41 -0800669 kfree(save_encoders);
Maarten Maathuise67aae72009-08-27 10:18:29 +0200670 kfree(save_crtcs);
Dave Airlief453ba02008-11-07 14:05:41 -0800671 return ret;
672}
673EXPORT_SYMBOL(drm_crtc_helper_set_config);
674
Keith Packardc9fb15f2009-05-30 20:42:28 -0700675static int drm_helper_choose_encoder_dpms(struct drm_encoder *encoder)
676{
677 int dpms = DRM_MODE_DPMS_OFF;
678 struct drm_connector *connector;
679 struct drm_device *dev = encoder->dev;
680
681 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
682 if (connector->encoder == encoder)
683 if (connector->dpms < dpms)
684 dpms = connector->dpms;
685 return dpms;
686}
687
688static int drm_helper_choose_crtc_dpms(struct drm_crtc *crtc)
689{
690 int dpms = DRM_MODE_DPMS_OFF;
691 struct drm_connector *connector;
692 struct drm_device *dev = crtc->dev;
693
694 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
695 if (connector->encoder && connector->encoder->crtc == crtc)
696 if (connector->dpms < dpms)
697 dpms = connector->dpms;
698 return dpms;
699}
700
701/**
702 * drm_helper_connector_dpms
703 * @connector affected connector
704 * @mode DPMS mode
705 *
706 * Calls the low-level connector DPMS function, then
707 * calls appropriate encoder and crtc DPMS functions as well
708 */
709void drm_helper_connector_dpms(struct drm_connector *connector, int mode)
710{
711 struct drm_encoder *encoder = connector->encoder;
712 struct drm_crtc *crtc = encoder ? encoder->crtc : NULL;
713 int old_dpms;
714
715 if (mode == connector->dpms)
716 return;
717
718 old_dpms = connector->dpms;
719 connector->dpms = mode;
720
721 /* from off to on, do crtc then encoder */
722 if (mode < old_dpms) {
723 if (crtc) {
724 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
725 if (crtc_funcs->dpms)
726 (*crtc_funcs->dpms) (crtc,
727 drm_helper_choose_crtc_dpms(crtc));
728 }
729 if (encoder) {
730 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
731 if (encoder_funcs->dpms)
732 (*encoder_funcs->dpms) (encoder,
733 drm_helper_choose_encoder_dpms(encoder));
734 }
735 }
736
737 /* from on to off, do encoder then crtc */
738 if (mode > old_dpms) {
739 if (encoder) {
740 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
741 if (encoder_funcs->dpms)
742 (*encoder_funcs->dpms) (encoder,
743 drm_helper_choose_encoder_dpms(encoder));
744 }
745 if (crtc) {
746 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
747 if (crtc_funcs->dpms)
748 (*crtc_funcs->dpms) (crtc,
749 drm_helper_choose_crtc_dpms(crtc));
750 }
751 }
752
753 return;
754}
755EXPORT_SYMBOL(drm_helper_connector_dpms);
756
Dave Airlief453ba02008-11-07 14:05:41 -0800757int drm_helper_mode_fill_fb_struct(struct drm_framebuffer *fb,
758 struct drm_mode_fb_cmd *mode_cmd)
759{
760 fb->width = mode_cmd->width;
761 fb->height = mode_cmd->height;
762 fb->pitch = mode_cmd->pitch;
763 fb->bits_per_pixel = mode_cmd->bpp;
764 fb->depth = mode_cmd->depth;
765
766 return 0;
767}
768EXPORT_SYMBOL(drm_helper_mode_fill_fb_struct);
769
770int drm_helper_resume_force_mode(struct drm_device *dev)
771{
772 struct drm_crtc *crtc;
David John89347bb2009-12-31 12:00:46 +0530773 struct drm_encoder *encoder;
774 struct drm_encoder_helper_funcs *encoder_funcs;
775 struct drm_crtc_helper_funcs *crtc_funcs;
Dave Airlief453ba02008-11-07 14:05:41 -0800776 int ret;
777
778 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
779
780 if (!crtc->enabled)
781 continue;
782
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500783 ret = drm_crtc_helper_set_mode(crtc, &crtc->mode,
784 crtc->x, crtc->y, crtc->fb);
Dave Airlief453ba02008-11-07 14:05:41 -0800785
786 if (ret == false)
787 DRM_ERROR("failed to set mode on crtc %p\n", crtc);
David John89347bb2009-12-31 12:00:46 +0530788
789 /* Turn off outputs that were already powered off */
790 if (drm_helper_choose_crtc_dpms(crtc)) {
791 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
792
793 if(encoder->crtc != crtc)
794 continue;
795
796 encoder_funcs = encoder->helper_private;
797 if (encoder_funcs->dpms)
798 (*encoder_funcs->dpms) (encoder,
799 drm_helper_choose_encoder_dpms(encoder));
800
801 crtc_funcs = crtc->helper_private;
802 if (crtc_funcs->dpms)
803 (*crtc_funcs->dpms) (crtc,
804 drm_helper_choose_crtc_dpms(crtc));
805 }
806 }
Dave Airlief453ba02008-11-07 14:05:41 -0800807 }
Zhao Yakuiaf4fcb52009-07-08 14:13:13 +0800808 /* disable the unused connectors while restoring the modesetting */
809 drm_helper_disable_unused_functions(dev);
Dave Airlief453ba02008-11-07 14:05:41 -0800810 return 0;
811}
812EXPORT_SYMBOL(drm_helper_resume_force_mode);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000813
814static struct slow_work_ops output_poll_ops;
815
816#define DRM_OUTPUT_POLL_PERIOD (10*HZ)
817static void output_poll_execute(struct slow_work *work)
818{
819 struct delayed_slow_work *delayed_work = container_of(work, struct delayed_slow_work, work);
820 struct drm_device *dev = container_of(delayed_work, struct drm_device, mode_config.output_poll_slow_work);
821 struct drm_connector *connector;
822 enum drm_connector_status old_status, status;
823 bool repoll = false, changed = false;
824 int ret;
825
826 mutex_lock(&dev->mode_config.mutex);
827 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
828
829 /* if this is HPD or polled don't check it -
830 TV out for instance */
831 if (!connector->polled)
832 continue;
833
834 else if (connector->polled & (DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT))
835 repoll = true;
836
837 old_status = connector->status;
838 /* if we are connected and don't want to poll for disconnect
839 skip it */
840 if (old_status == connector_status_connected &&
841 !(connector->polled & DRM_CONNECTOR_POLL_DISCONNECT) &&
842 !(connector->polled & DRM_CONNECTOR_POLL_HPD))
843 continue;
844
845 status = connector->funcs->detect(connector);
846 if (old_status != status)
847 changed = true;
848 }
849
850 mutex_unlock(&dev->mode_config.mutex);
851
852 if (changed) {
853 /* send a uevent + call fbdev */
854 drm_sysfs_hotplug_event(dev);
855 if (dev->mode_config.funcs->output_poll_changed)
856 dev->mode_config.funcs->output_poll_changed(dev);
857 }
858
859 if (repoll) {
860 ret = delayed_slow_work_enqueue(delayed_work, DRM_OUTPUT_POLL_PERIOD);
861 if (ret)
862 DRM_ERROR("delayed enqueue failed %d\n", ret);
863 }
864}
865
Dave Airliefbf81762010-06-01 09:09:06 +1000866void drm_kms_helper_poll_disable(struct drm_device *dev)
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000867{
Dave Airliefbf81762010-06-01 09:09:06 +1000868 if (!dev->mode_config.poll_enabled)
869 return;
870 delayed_slow_work_cancel(&dev->mode_config.output_poll_slow_work);
871}
872EXPORT_SYMBOL(drm_kms_helper_poll_disable);
873
874void drm_kms_helper_poll_enable(struct drm_device *dev)
875{
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000876 bool poll = false;
Dave Airliefbf81762010-06-01 09:09:06 +1000877 struct drm_connector *connector;
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000878 int ret;
879
880 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
881 if (connector->polled)
882 poll = true;
883 }
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000884
885 if (poll) {
886 ret = delayed_slow_work_enqueue(&dev->mode_config.output_poll_slow_work, DRM_OUTPUT_POLL_PERIOD);
887 if (ret)
888 DRM_ERROR("delayed enqueue failed %d\n", ret);
889 }
890}
Dave Airliefbf81762010-06-01 09:09:06 +1000891EXPORT_SYMBOL(drm_kms_helper_poll_enable);
892
893void drm_kms_helper_poll_init(struct drm_device *dev)
894{
895 slow_work_register_user(THIS_MODULE);
896 delayed_slow_work_init(&dev->mode_config.output_poll_slow_work,
897 &output_poll_ops);
898 dev->mode_config.poll_enabled = true;
899
900 drm_kms_helper_poll_enable(dev);
901}
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000902EXPORT_SYMBOL(drm_kms_helper_poll_init);
903
904void drm_kms_helper_poll_fini(struct drm_device *dev)
905{
Dave Airliefbf81762010-06-01 09:09:06 +1000906 drm_kms_helper_poll_disable(dev);
Dave Airlieeb1f8e42010-05-07 06:42:51 +0000907 slow_work_unregister_user(THIS_MODULE);
908}
909EXPORT_SYMBOL(drm_kms_helper_poll_fini);
910
911void drm_helper_hpd_irq_event(struct drm_device *dev)
912{
913 if (!dev->mode_config.poll_enabled)
914 return;
915 delayed_slow_work_cancel(&dev->mode_config.output_poll_slow_work);
916 /* schedule a slow work asap */
917 delayed_slow_work_enqueue(&dev->mode_config.output_poll_slow_work, 0);
918}
919EXPORT_SYMBOL(drm_helper_hpd_irq_event);
920
921static struct slow_work_ops output_poll_ops = {
922 .execute = output_poll_execute,
923};