blob: 9cd8451325805cdef37280db06b9dd61b0fdb813 [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"
35
36/*
Dave Airlieaa91c662008-12-08 14:55:27 +100037 * Detailed mode info for 800x600@60Hz
Dave Airlief453ba02008-11-07 14:05:41 -080038 */
Jesse Barnes40a518d2009-01-12 12:05:32 -080039static struct drm_display_mode std_modes[] = {
Dave Airlieaa91c662008-12-08 14:55:27 +100040 { DRM_MODE("800x600", DRM_MODE_TYPE_DEFAULT, 40000, 800, 840,
41 968, 1056, 0, 600, 601, 605, 628, 0,
42 DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Dave Airlief453ba02008-11-07 14:05:41 -080043};
44
yakui_zhao67149772009-04-02 11:52:12 +080045static void drm_mode_validate_flag(struct drm_connector *connector,
46 int flags)
47{
48 struct drm_display_mode *mode, *t;
49
50 if (flags == (DRM_MODE_FLAG_DBLSCAN | DRM_MODE_FLAG_INTERLACE))
51 return;
52
53 list_for_each_entry_safe(mode, t, &connector->modes, head) {
54 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/**
66 * drm_helper_probe_connector_modes - get complete set of display modes
67 * @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;
91 struct drm_display_mode *mode, *t;
92 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
Zhao Yakui58367ed2009-07-20 13:48:07 +080097 DRM_DEBUG_KMS("%s\n", drm_get_connector_name(connector));
Dave Airlief453ba02008-11-07 14:05:41 -080098 /* set all modes to the unverified state */
99 list_for_each_entry_safe(mode, t, &connector->modes, head)
100 mode->status = MODE_UNVERIFIED;
101
102 connector->status = connector->funcs->detect(connector);
103
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));
107 /* TODO set EDID to NULL */
Jesse Barnes40a518d2009-01-12 12:05:32 -0800108 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800109 }
110
Jesse Barnes40a518d2009-01-12 12:05:32 -0800111 count = (*connector_funcs->get_modes)(connector);
112 if (!count)
113 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800114
Jesse Barnes40a518d2009-01-12 12:05:32 -0800115 drm_mode_connector_list_update(connector);
Dave Airlief453ba02008-11-07 14:05:41 -0800116
117 if (maxX && maxY)
118 drm_mode_validate_size(dev, &connector->modes, maxX,
119 maxY, 0);
yakui_zhao67149772009-04-02 11:52:12 +0800120
121 if (connector->interlace_allowed)
122 mode_flags |= DRM_MODE_FLAG_INTERLACE;
123 if (connector->doublescan_allowed)
124 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
125 drm_mode_validate_flag(connector, mode_flags);
126
Dave Airlief453ba02008-11-07 14:05:41 -0800127 list_for_each_entry_safe(mode, t, &connector->modes, head) {
128 if (mode->status == MODE_OK)
129 mode->status = connector_funcs->mode_valid(connector,
130 mode);
131 }
132
133
134 drm_mode_prune_invalid(dev, &connector->modes, true);
135
Jesse Barnes40a518d2009-01-12 12:05:32 -0800136 if (list_empty(&connector->modes))
137 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800138
139 drm_mode_sort(&connector->modes);
140
Zhao Yakui58367ed2009-07-20 13:48:07 +0800141 DRM_DEBUG_KMS("Probed modes for %s\n",
142 drm_get_connector_name(connector));
Dave Airlief453ba02008-11-07 14:05:41 -0800143 list_for_each_entry_safe(mode, t, &connector->modes, head) {
144 mode->vrefresh = drm_mode_vrefresh(mode);
145
146 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
147 drm_mode_debug_printmodeline(mode);
148 }
Jesse Barnes40a518d2009-01-12 12:05:32 -0800149
150 return count;
Dave Airlief453ba02008-11-07 14:05:41 -0800151}
152EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
153
Jesse Barnes40a518d2009-01-12 12:05:32 -0800154int drm_helper_probe_connector_modes(struct drm_device *dev, uint32_t maxX,
Dave Airlief453ba02008-11-07 14:05:41 -0800155 uint32_t maxY)
156{
157 struct drm_connector *connector;
Jesse Barnes40a518d2009-01-12 12:05:32 -0800158 int count = 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800159
160 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Jesse Barnes40a518d2009-01-12 12:05:32 -0800161 count += drm_helper_probe_single_connector_modes(connector,
162 maxX, maxY);
Dave Airlief453ba02008-11-07 14:05:41 -0800163 }
Jesse Barnes40a518d2009-01-12 12:05:32 -0800164
165 return count;
Dave Airlief453ba02008-11-07 14:05:41 -0800166}
167EXPORT_SYMBOL(drm_helper_probe_connector_modes);
168
Jesse Barnes40a518d2009-01-12 12:05:32 -0800169static void drm_helper_add_std_modes(struct drm_device *dev,
170 struct drm_connector *connector)
171{
172 struct drm_display_mode *mode, *t;
173 int i;
174
175 for (i = 0; i < ARRAY_SIZE(std_modes); i++) {
176 struct drm_display_mode *stdmode;
177
178 /*
179 * When no valid EDID modes are available we end up
180 * here and bailed in the past, now we add some standard
181 * modes and move on.
182 */
183 stdmode = drm_mode_duplicate(dev, &std_modes[i]);
184 drm_mode_probed_add(connector, stdmode);
185 drm_mode_list_concat(&connector->probed_modes,
186 &connector->modes);
187
Zhao Yakui58367ed2009-07-20 13:48:07 +0800188 DRM_DEBUG_KMS("Adding mode %s to %s\n", stdmode->name,
Jesse Barnes40a518d2009-01-12 12:05:32 -0800189 drm_get_connector_name(connector));
190 }
191 drm_mode_sort(&connector->modes);
192
Zhao Yakui58367ed2009-07-20 13:48:07 +0800193 DRM_DEBUG_KMS("Added std modes on %s\n",
194 drm_get_connector_name(connector));
Jesse Barnes40a518d2009-01-12 12:05:32 -0800195 list_for_each_entry_safe(mode, t, &connector->modes, head) {
196 mode->vrefresh = drm_mode_vrefresh(mode);
197
198 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
199 drm_mode_debug_printmodeline(mode);
200 }
201}
Dave Airlief453ba02008-11-07 14:05:41 -0800202
203/**
Keith Packardc9fb15f2009-05-30 20:42:28 -0700204 * drm_helper_encoder_in_use - check if a given encoder is in use
205 * @encoder: encoder to check
206 *
207 * LOCKING:
208 * Caller must hold mode config lock.
209 *
210 * Walk @encoders's DRM device's mode_config and see if it's in use.
211 *
212 * RETURNS:
213 * True if @encoder is part of the mode_config, false otherwise.
214 */
215bool drm_helper_encoder_in_use(struct drm_encoder *encoder)
216{
217 struct drm_connector *connector;
218 struct drm_device *dev = encoder->dev;
219 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
220 if (connector->encoder == encoder)
221 return true;
222 return false;
223}
224EXPORT_SYMBOL(drm_helper_encoder_in_use);
225
226/**
Dave Airlief453ba02008-11-07 14:05:41 -0800227 * drm_helper_crtc_in_use - check if a given CRTC is in a mode_config
228 * @crtc: CRTC to check
229 *
230 * LOCKING:
231 * Caller must hold mode config lock.
232 *
233 * Walk @crtc's DRM device's mode_config and see if it's in use.
234 *
235 * RETURNS:
236 * True if @crtc is part of the mode_config, false otherwise.
237 */
238bool drm_helper_crtc_in_use(struct drm_crtc *crtc)
239{
240 struct drm_encoder *encoder;
241 struct drm_device *dev = crtc->dev;
242 /* FIXME: Locking around list access? */
243 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
Keith Packardc9fb15f2009-05-30 20:42:28 -0700244 if (encoder->crtc == crtc && drm_helper_encoder_in_use(encoder))
Dave Airlief453ba02008-11-07 14:05:41 -0800245 return true;
246 return false;
247}
248EXPORT_SYMBOL(drm_helper_crtc_in_use);
249
250/**
251 * drm_disable_unused_functions - disable unused objects
252 * @dev: DRM device
253 *
254 * LOCKING:
255 * Caller must hold mode config lock.
256 *
257 * If an connector or CRTC isn't part of @dev's mode_config, it can be disabled
258 * by calling its dpms function, which should power it off.
259 */
260void drm_helper_disable_unused_functions(struct drm_device *dev)
261{
262 struct drm_encoder *encoder;
263 struct drm_encoder_helper_funcs *encoder_funcs;
264 struct drm_crtc *crtc;
265
266 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
267 encoder_funcs = encoder->helper_private;
Keith Packardc9fb15f2009-05-30 20:42:28 -0700268 if (!drm_helper_encoder_in_use(encoder))
Dave Airlief453ba02008-11-07 14:05:41 -0800269 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
270 }
271
272 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
273 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
274 crtc->enabled = drm_helper_crtc_in_use(crtc);
275 if (!crtc->enabled) {
276 crtc_funcs->dpms(crtc, DRM_MODE_DPMS_OFF);
277 crtc->fb = NULL;
278 }
279 }
280}
281EXPORT_SYMBOL(drm_helper_disable_unused_functions);
282
283static struct drm_display_mode *drm_has_preferred_mode(struct drm_connector *connector, int width, int height)
284{
285 struct drm_display_mode *mode;
286
287 list_for_each_entry(mode, &connector->modes, head) {
288 if (drm_mode_width(mode) > width ||
289 drm_mode_height(mode) > height)
290 continue;
291 if (mode->type & DRM_MODE_TYPE_PREFERRED)
292 return mode;
293 }
294 return NULL;
295}
296
297static bool drm_connector_enabled(struct drm_connector *connector, bool strict)
298{
299 bool enable;
300
301 if (strict) {
302 enable = connector->status == connector_status_connected;
303 } else {
304 enable = connector->status != connector_status_disconnected;
305 }
306 return enable;
307}
308
309static void drm_enable_connectors(struct drm_device *dev, bool *enabled)
310{
311 bool any_enabled = false;
312 struct drm_connector *connector;
313 int i = 0;
314
315 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
316 enabled[i] = drm_connector_enabled(connector, true);
Zhao Yakui58367ed2009-07-20 13:48:07 +0800317 DRM_DEBUG_KMS("connector %d enabled? %s\n", connector->base.id,
Jesse Barnes40a518d2009-01-12 12:05:32 -0800318 enabled[i] ? "yes" : "no");
Dave Airlief453ba02008-11-07 14:05:41 -0800319 any_enabled |= enabled[i];
320 i++;
321 }
322
323 if (any_enabled)
324 return;
325
326 i = 0;
327 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
328 enabled[i] = drm_connector_enabled(connector, false);
329 i++;
330 }
331}
332
333static bool drm_target_preferred(struct drm_device *dev,
334 struct drm_display_mode **modes,
335 bool *enabled, int width, int height)
336{
337 struct drm_connector *connector;
338 int i = 0;
339
340 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
341
342 if (enabled[i] == false) {
343 i++;
344 continue;
345 }
346
Zhao Yakui58367ed2009-07-20 13:48:07 +0800347 DRM_DEBUG_KMS("looking for preferred mode on connector %d\n",
Jesse Barnes40a518d2009-01-12 12:05:32 -0800348 connector->base.id);
349
Dave Airlief453ba02008-11-07 14:05:41 -0800350 modes[i] = drm_has_preferred_mode(connector, width, height);
Jesse Barnes40a518d2009-01-12 12:05:32 -0800351 /* No preferred modes, pick one off the list */
352 if (!modes[i] && !list_empty(&connector->modes)) {
Dave Airlief453ba02008-11-07 14:05:41 -0800353 list_for_each_entry(modes[i], &connector->modes, head)
354 break;
355 }
Zhao Yakui58367ed2009-07-20 13:48:07 +0800356 DRM_DEBUG_KMS("found mode %s\n", modes[i] ? modes[i]->name :
Jesse Barnes40a518d2009-01-12 12:05:32 -0800357 "none");
Dave Airlief453ba02008-11-07 14:05:41 -0800358 i++;
359 }
360 return true;
361}
362
363static int drm_pick_crtcs(struct drm_device *dev,
364 struct drm_crtc **best_crtcs,
365 struct drm_display_mode **modes,
366 int n, int width, int height)
367{
368 int c, o;
369 struct drm_connector *connector;
370 struct drm_connector_helper_funcs *connector_funcs;
371 struct drm_encoder *encoder;
372 struct drm_crtc *best_crtc;
373 int my_score, best_score, score;
374 struct drm_crtc **crtcs, *crtc;
375
376 if (n == dev->mode_config.num_connector)
377 return 0;
378 c = 0;
379 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
380 if (c == n)
381 break;
382 c++;
383 }
384
385 best_crtcs[n] = NULL;
386 best_crtc = NULL;
387 best_score = drm_pick_crtcs(dev, best_crtcs, modes, n+1, width, height);
388 if (modes[n] == NULL)
389 return best_score;
390
391 crtcs = kmalloc(dev->mode_config.num_connector *
392 sizeof(struct drm_crtc *), GFP_KERNEL);
393 if (!crtcs)
394 return best_score;
395
396 my_score = 1;
397 if (connector->status == connector_status_connected)
398 my_score++;
399 if (drm_has_preferred_mode(connector, width, height))
400 my_score++;
401
402 connector_funcs = connector->helper_private;
403 encoder = connector_funcs->best_encoder(connector);
404 if (!encoder)
405 goto out;
406
407 connector->encoder = encoder;
408
409 /* select a crtc for this connector and then attempt to configure
410 remaining connectors */
411 c = 0;
412 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
413
414 if ((connector->encoder->possible_crtcs & (1 << c)) == 0) {
415 c++;
416 continue;
417 }
418
419 for (o = 0; o < n; o++)
420 if (best_crtcs[o] == crtc)
421 break;
422
423 if (o < n) {
424 /* ignore cloning for now */
425 c++;
426 continue;
427 }
428
429 crtcs[n] = crtc;
430 memcpy(crtcs, best_crtcs, n * sizeof(struct drm_crtc *));
431 score = my_score + drm_pick_crtcs(dev, crtcs, modes, n + 1,
432 width, height);
433 if (score > best_score) {
434 best_crtc = crtc;
435 best_score = score;
436 memcpy(best_crtcs, crtcs,
437 dev->mode_config.num_connector *
438 sizeof(struct drm_crtc *));
439 }
440 c++;
441 }
442out:
443 kfree(crtcs);
444 return best_score;
445}
446
447static void drm_setup_crtcs(struct drm_device *dev)
448{
449 struct drm_crtc **crtcs;
450 struct drm_display_mode **modes;
451 struct drm_encoder *encoder;
452 struct drm_connector *connector;
453 bool *enabled;
454 int width, height;
455 int i, ret;
456
Zhao Yakui58367ed2009-07-20 13:48:07 +0800457 DRM_DEBUG_KMS("\n");
Jesse Barnes40a518d2009-01-12 12:05:32 -0800458
Dave Airlief453ba02008-11-07 14:05:41 -0800459 width = dev->mode_config.max_width;
460 height = dev->mode_config.max_height;
461
462 /* clean out all the encoder/crtc combos */
463 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
464 encoder->crtc = NULL;
465 }
466
467 crtcs = kcalloc(dev->mode_config.num_connector,
468 sizeof(struct drm_crtc *), GFP_KERNEL);
469 modes = kcalloc(dev->mode_config.num_connector,
470 sizeof(struct drm_display_mode *), GFP_KERNEL);
471 enabled = kcalloc(dev->mode_config.num_connector,
472 sizeof(bool), GFP_KERNEL);
473
474 drm_enable_connectors(dev, enabled);
475
476 ret = drm_target_preferred(dev, modes, enabled, width, height);
477 if (!ret)
478 DRM_ERROR("Unable to find initial modes\n");
479
Zhao Yakui58367ed2009-07-20 13:48:07 +0800480 DRM_DEBUG_KMS("picking CRTCs for %dx%d config\n", width, height);
Jesse Barnes40a518d2009-01-12 12:05:32 -0800481
Dave Airlief453ba02008-11-07 14:05:41 -0800482 drm_pick_crtcs(dev, crtcs, modes, 0, width, height);
483
484 i = 0;
485 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
486 struct drm_display_mode *mode = modes[i];
487 struct drm_crtc *crtc = crtcs[i];
488
489 if (connector->encoder == NULL) {
490 i++;
491 continue;
492 }
493
494 if (mode && crtc) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800495 DRM_DEBUG_KMS("desired mode %s set on crtc %d\n",
Jesse Barnes40a518d2009-01-12 12:05:32 -0800496 mode->name, crtc->base.id);
Dave Airlief453ba02008-11-07 14:05:41 -0800497 crtc->desired_mode = mode;
498 connector->encoder->crtc = crtc;
499 } else
500 connector->encoder->crtc = NULL;
501 i++;
502 }
503
504 kfree(crtcs);
505 kfree(modes);
506 kfree(enabled);
507}
Jesse Barnes7bec7562009-02-23 16:09:34 -0800508
509/**
510 * drm_encoder_crtc_ok - can a given crtc drive a given encoder?
511 * @encoder: encoder to test
512 * @crtc: crtc to test
513 *
514 * Return false if @encoder can't be driven by @crtc, true otherwise.
515 */
516static bool drm_encoder_crtc_ok(struct drm_encoder *encoder,
517 struct drm_crtc *crtc)
518{
519 struct drm_device *dev;
520 struct drm_crtc *tmp;
521 int crtc_mask = 1;
522
523 WARN(!crtc, "checking null crtc?");
524
525 dev = crtc->dev;
526
527 list_for_each_entry(tmp, &dev->mode_config.crtc_list, head) {
528 if (tmp == crtc)
529 break;
530 crtc_mask <<= 1;
531 }
532
533 if (encoder->possible_crtcs & crtc_mask)
534 return true;
535 return false;
536}
537
538/*
539 * Check the CRTC we're going to map each output to vs. its current
540 * CRTC. If they don't match, we have to disable the output and the CRTC
541 * since the driver will have to re-route things.
542 */
543static void
544drm_crtc_prepare_encoders(struct drm_device *dev)
545{
546 struct drm_encoder_helper_funcs *encoder_funcs;
547 struct drm_encoder *encoder;
548
549 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
550 encoder_funcs = encoder->helper_private;
551 /* Disable unused encoders */
552 if (encoder->crtc == NULL)
553 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
554 /* Disable encoders whose CRTC is about to change */
555 if (encoder_funcs->get_crtc &&
556 encoder->crtc != (*encoder_funcs->get_crtc)(encoder))
557 (*encoder_funcs->dpms)(encoder, DRM_MODE_DPMS_OFF);
558 }
559}
560
Dave Airlief453ba02008-11-07 14:05:41 -0800561/**
562 * drm_crtc_set_mode - set a mode
563 * @crtc: CRTC to program
564 * @mode: mode to use
565 * @x: width of mode
566 * @y: height of mode
567 *
568 * LOCKING:
569 * Caller must hold mode config lock.
570 *
571 * Try to set @mode on @crtc. Give @crtc and its associated connectors a chance
572 * to fixup or reject the mode prior to trying to set it.
573 *
574 * RETURNS:
575 * True if the mode was set successfully, or false otherwise.
576 */
577bool drm_crtc_helper_set_mode(struct drm_crtc *crtc,
578 struct drm_display_mode *mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500579 int x, int y,
580 struct drm_framebuffer *old_fb)
Dave Airlief453ba02008-11-07 14:05:41 -0800581{
582 struct drm_device *dev = crtc->dev;
583 struct drm_display_mode *adjusted_mode, saved_mode;
584 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
585 struct drm_encoder_helper_funcs *encoder_funcs;
586 int saved_x, saved_y;
587 struct drm_encoder *encoder;
588 bool ret = true;
589
590 adjusted_mode = drm_mode_duplicate(dev, mode);
591
592 crtc->enabled = drm_helper_crtc_in_use(crtc);
593
594 if (!crtc->enabled)
595 return true;
596
597 saved_mode = crtc->mode;
598 saved_x = crtc->x;
599 saved_y = crtc->y;
600
601 /* Update crtc values up front so the driver can rely on them for mode
602 * setting.
603 */
604 crtc->mode = *mode;
605 crtc->x = x;
606 crtc->y = y;
607
Dave Airlief453ba02008-11-07 14:05:41 -0800608 /* Pass our mode to the connectors and the CRTC to give them a chance to
609 * adjust it according to limitations or connector properties, and also
610 * a chance to reject the mode entirely.
611 */
612 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
613
614 if (encoder->crtc != crtc)
615 continue;
616 encoder_funcs = encoder->helper_private;
617 if (!(ret = encoder_funcs->mode_fixup(encoder, mode,
618 adjusted_mode))) {
619 goto done;
620 }
621 }
622
623 if (!(ret = crtc_funcs->mode_fixup(crtc, mode, adjusted_mode))) {
624 goto done;
625 }
626
627 /* Prepare the encoders and CRTCs before setting the mode. */
628 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
629
630 if (encoder->crtc != crtc)
631 continue;
632 encoder_funcs = encoder->helper_private;
633 /* Disable the encoders as the first thing we do. */
634 encoder_funcs->prepare(encoder);
635 }
636
Jesse Barnes7bec7562009-02-23 16:09:34 -0800637 drm_crtc_prepare_encoders(dev);
638
Dave Airlief453ba02008-11-07 14:05:41 -0800639 crtc_funcs->prepare(crtc);
640
641 /* Set up the DPLL and any encoders state that needs to adjust or depend
642 * on the DPLL.
643 */
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000644 ret = !crtc_funcs->mode_set(crtc, mode, adjusted_mode, x, y, old_fb);
645 if (!ret)
646 goto done;
Dave Airlief453ba02008-11-07 14:05:41 -0800647
648 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
649
650 if (encoder->crtc != crtc)
651 continue;
652
653 DRM_INFO("%s: set mode %s %x\n", drm_get_encoder_name(encoder),
654 mode->name, mode->base.id);
655 encoder_funcs = encoder->helper_private;
656 encoder_funcs->mode_set(encoder, mode, adjusted_mode);
657 }
658
659 /* Now enable the clocks, plane, pipe, and connectors that we set up. */
660 crtc_funcs->commit(crtc);
661
662 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
663
664 if (encoder->crtc != crtc)
665 continue;
666
667 encoder_funcs = encoder->helper_private;
668 encoder_funcs->commit(encoder);
669
670 }
671
672 /* XXX free adjustedmode */
673 drm_mode_destroy(dev, adjusted_mode);
674 /* FIXME: add subpixel order */
675done:
676 if (!ret) {
677 crtc->mode = saved_mode;
678 crtc->x = saved_x;
679 crtc->y = saved_y;
680 }
681
682 return ret;
683}
684EXPORT_SYMBOL(drm_crtc_helper_set_mode);
685
686
687/**
688 * drm_crtc_helper_set_config - set a new config from userspace
689 * @crtc: CRTC to setup
690 * @crtc_info: user provided configuration
691 * @new_mode: new mode to set
692 * @connector_set: set of connectors for the new config
693 * @fb: new framebuffer
694 *
695 * LOCKING:
696 * Caller must hold mode config lock.
697 *
698 * Setup a new configuration, provided by the user in @crtc_info, and enable
699 * it.
700 *
701 * RETURNS:
702 * Zero. (FIXME)
703 */
704int drm_crtc_helper_set_config(struct drm_mode_set *set)
705{
706 struct drm_device *dev;
707 struct drm_crtc **save_crtcs, *new_crtc;
708 struct drm_encoder **save_encoders, *new_encoder;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800709 struct drm_framebuffer *old_fb = NULL;
Dave Airlief453ba02008-11-07 14:05:41 -0800710 bool save_enabled;
Jesse Barnes712531b2009-01-09 13:56:14 -0800711 bool mode_changed = false;
712 bool fb_changed = false;
Dave Airlief453ba02008-11-07 14:05:41 -0800713 struct drm_connector *connector;
714 int count = 0, ro, fail = 0;
715 struct drm_crtc_helper_funcs *crtc_funcs;
716 int ret = 0;
717
Zhao Yakui58367ed2009-07-20 13:48:07 +0800718 DRM_DEBUG_KMS("\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800719
720 if (!set)
721 return -EINVAL;
722
723 if (!set->crtc)
724 return -EINVAL;
725
726 if (!set->crtc->helper_private)
727 return -EINVAL;
728
729 crtc_funcs = set->crtc->helper_private;
730
Zhao Yakui58367ed2009-07-20 13:48:07 +0800731 DRM_DEBUG_KMS("crtc: %p %d fb: %p connectors: %p num_connectors:"
732 " %d (x, y) (%i, %i)\n",
Dave Airlief453ba02008-11-07 14:05:41 -0800733 set->crtc, set->crtc->base.id, set->fb, set->connectors,
734 (int)set->num_connectors, set->x, set->y);
735
736 dev = set->crtc->dev;
737
738 /* save previous config */
739 save_enabled = set->crtc->enabled;
740
Jesse Barnes712531b2009-01-09 13:56:14 -0800741 /*
742 * We do mode_config.num_connectors here since we'll look at the
743 * CRTC and encoder associated with each connector later.
744 */
Dave Airlief453ba02008-11-07 14:05:41 -0800745 save_crtcs = kzalloc(dev->mode_config.num_connector *
746 sizeof(struct drm_crtc *), GFP_KERNEL);
747 if (!save_crtcs)
748 return -ENOMEM;
749
750 save_encoders = kzalloc(dev->mode_config.num_connector *
751 sizeof(struct drm_encoders *), GFP_KERNEL);
752 if (!save_encoders) {
753 kfree(save_crtcs);
754 return -ENOMEM;
755 }
756
757 /* We should be able to check here if the fb has the same properties
758 * and then just flip_or_move it */
759 if (set->crtc->fb != set->fb) {
Jesse Barnes712531b2009-01-09 13:56:14 -0800760 /* If we have no fb then treat it as a full mode set */
Jesse Barnes7bec7562009-02-23 16:09:34 -0800761 if (set->crtc->fb == NULL) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800762 DRM_DEBUG_KMS("crtc has no fb, full mode set\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800763 mode_changed = true;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800764 } else if ((set->fb->bits_per_pixel !=
Jesse Barnes712531b2009-01-09 13:56:14 -0800765 set->crtc->fb->bits_per_pixel) ||
766 set->fb->depth != set->crtc->fb->depth)
767 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800768 else
Jesse Barnes712531b2009-01-09 13:56:14 -0800769 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800770 }
771
772 if (set->x != set->crtc->x || set->y != set->crtc->y)
Jesse Barnes712531b2009-01-09 13:56:14 -0800773 fb_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800774
775 if (set->mode && !drm_mode_equal(set->mode, &set->crtc->mode)) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800776 DRM_DEBUG_KMS("modes are different, full mode set\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800777 drm_mode_debug_printmodeline(&set->crtc->mode);
778 drm_mode_debug_printmodeline(set->mode);
Jesse Barnes712531b2009-01-09 13:56:14 -0800779 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800780 }
781
782 /* a) traverse passed in connector list and get encoders for them */
783 count = 0;
784 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
785 struct drm_connector_helper_funcs *connector_funcs =
786 connector->helper_private;
787 save_encoders[count++] = connector->encoder;
788 new_encoder = connector->encoder;
789 for (ro = 0; ro < set->num_connectors; ro++) {
790 if (set->connectors[ro] == connector) {
791 new_encoder = connector_funcs->best_encoder(connector);
792 /* if we can't get an encoder for a connector
793 we are setting now - then fail */
794 if (new_encoder == NULL)
795 /* don't break so fail path works correct */
796 fail = 1;
797 break;
798 }
799 }
800
801 if (new_encoder != connector->encoder) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800802 DRM_DEBUG_KMS("encoder changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800803 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800804 connector->encoder = new_encoder;
805 }
806 }
807
808 if (fail) {
809 ret = -EINVAL;
810 goto fail_no_encoder;
811 }
812
813 count = 0;
814 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
815 if (!connector->encoder)
816 continue;
817
818 save_crtcs[count++] = connector->encoder->crtc;
819
820 if (connector->encoder->crtc == set->crtc)
821 new_crtc = NULL;
822 else
823 new_crtc = connector->encoder->crtc;
824
825 for (ro = 0; ro < set->num_connectors; ro++) {
826 if (set->connectors[ro] == connector)
827 new_crtc = set->crtc;
828 }
Jesse Barnes7bec7562009-02-23 16:09:34 -0800829
830 /* Make sure the new CRTC will work with the encoder */
831 if (new_crtc &&
832 !drm_encoder_crtc_ok(connector->encoder, new_crtc)) {
833 ret = -EINVAL;
834 goto fail_set_mode;
835 }
Dave Airlief453ba02008-11-07 14:05:41 -0800836 if (new_crtc != connector->encoder->crtc) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800837 DRM_DEBUG_KMS("crtc changed, full mode switch\n");
Jesse Barnes712531b2009-01-09 13:56:14 -0800838 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800839 connector->encoder->crtc = new_crtc;
840 }
Zhao Yakui58367ed2009-07-20 13:48:07 +0800841 DRM_DEBUG_KMS("setting connector %d crtc to %p\n",
Jesse Barnes7bec7562009-02-23 16:09:34 -0800842 connector->base.id, new_crtc);
Dave Airlief453ba02008-11-07 14:05:41 -0800843 }
844
845 /* mode_set_base is not a required function */
Jesse Barnes712531b2009-01-09 13:56:14 -0800846 if (fb_changed && !crtc_funcs->mode_set_base)
847 mode_changed = true;
Dave Airlief453ba02008-11-07 14:05:41 -0800848
Jesse Barnes712531b2009-01-09 13:56:14 -0800849 if (mode_changed) {
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500850 old_fb = set->crtc->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800851 set->crtc->fb = set->fb;
852 set->crtc->enabled = (set->mode != NULL);
853 if (set->mode != NULL) {
Zhao Yakui58367ed2009-07-20 13:48:07 +0800854 DRM_DEBUG_KMS("attempting to set mode from"
855 " userspace\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800856 drm_mode_debug_printmodeline(set->mode);
857 if (!drm_crtc_helper_set_mode(set->crtc, set->mode,
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500858 set->x, set->y,
859 old_fb)) {
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000860 DRM_ERROR("failed to set mode on crtc %p\n",
861 set->crtc);
Dave Airlief453ba02008-11-07 14:05:41 -0800862 ret = -EINVAL;
863 goto fail_set_mode;
864 }
865 /* TODO are these needed? */
866 set->crtc->desired_x = set->x;
867 set->crtc->desired_y = set->y;
868 set->crtc->desired_mode = set->mode;
869 }
870 drm_helper_disable_unused_functions(dev);
Jesse Barnes712531b2009-01-09 13:56:14 -0800871 } else if (fb_changed) {
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -0500872 old_fb = set->crtc->fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800873 if (set->crtc->fb != set->fb)
874 set->crtc->fb = set->fb;
Chris Wilson5c3b82e2009-02-11 13:25:09 +0000875 ret = crtc_funcs->mode_set_base(set->crtc,
876 set->x, set->y, old_fb);
877 if (ret != 0)
878 goto fail_set_mode;
Dave Airlief453ba02008-11-07 14:05:41 -0800879 }
880
881 kfree(save_encoders);
882 kfree(save_crtcs);
883 return 0;
884
885fail_set_mode:
886 set->crtc->enabled = save_enabled;
Jesse Barnes7bec7562009-02-23 16:09:34 -0800887 set->crtc->fb = old_fb;
Dave Airlief453ba02008-11-07 14:05:41 -0800888 count = 0;
Chris Wilsone62fb642009-02-11 16:39:21 +0000889 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
890 if (!connector->encoder)
891 continue;
892
Dave Airlief453ba02008-11-07 14:05:41 -0800893 connector->encoder->crtc = save_crtcs[count++];
Chris Wilsone62fb642009-02-11 16:39:21 +0000894 }
Dave Airlief453ba02008-11-07 14:05:41 -0800895fail_no_encoder:
896 kfree(save_crtcs);
897 count = 0;
898 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
899 connector->encoder = save_encoders[count++];
900 }
901 kfree(save_encoders);
902 return ret;
903}
904EXPORT_SYMBOL(drm_crtc_helper_set_config);
905
906bool drm_helper_plugged_event(struct drm_device *dev)
907{
Zhao Yakui58367ed2009-07-20 13:48:07 +0800908 DRM_DEBUG_KMS("\n");
Dave Airlief453ba02008-11-07 14:05:41 -0800909
910 drm_helper_probe_connector_modes(dev, dev->mode_config.max_width,
911 dev->mode_config.max_height);
912
913 drm_setup_crtcs(dev);
914
915 /* alert the driver fb layer */
916 dev->mode_config.funcs->fb_changed(dev);
917
918 /* FIXME: send hotplug event */
919 return true;
920}
921/**
922 * drm_initial_config - setup a sane initial connector configuration
923 * @dev: DRM device
Dave Airlief453ba02008-11-07 14:05:41 -0800924 *
925 * LOCKING:
926 * Called at init time, must take mode config lock.
927 *
928 * Scan the CRTCs and connectors and try to put together an initial setup.
929 * At the moment, this is a cloned configuration across all heads with
930 * a new framebuffer object as the backing store.
931 *
932 * RETURNS:
933 * Zero if everything went ok, nonzero otherwise.
934 */
Jesse Barnes7a1fb5d2009-03-27 13:05:19 -0700935bool drm_helper_initial_config(struct drm_device *dev)
Dave Airlief453ba02008-11-07 14:05:41 -0800936{
Jesse Barnes40a518d2009-01-12 12:05:32 -0800937 struct drm_connector *connector;
938 int count = 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800939
Jesse Barnes40a518d2009-01-12 12:05:32 -0800940 count = drm_helper_probe_connector_modes(dev,
941 dev->mode_config.max_width,
942 dev->mode_config.max_height);
943
944 /*
945 * None of the available connectors had any modes, so add some
946 * and try to light them up anyway
947 */
948 if (!count) {
949 DRM_ERROR("connectors have no modes, using standard modes\n");
950 list_for_each_entry(connector,
951 &dev->mode_config.connector_list,
952 head)
953 drm_helper_add_std_modes(dev, connector);
954 }
955
956 drm_setup_crtcs(dev);
957
958 /* alert the driver fb layer */
959 dev->mode_config.funcs->fb_changed(dev);
960
961 return 0;
Dave Airlief453ba02008-11-07 14:05:41 -0800962}
963EXPORT_SYMBOL(drm_helper_initial_config);
964
Keith Packardc9fb15f2009-05-30 20:42:28 -0700965static int drm_helper_choose_encoder_dpms(struct drm_encoder *encoder)
966{
967 int dpms = DRM_MODE_DPMS_OFF;
968 struct drm_connector *connector;
969 struct drm_device *dev = encoder->dev;
970
971 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
972 if (connector->encoder == encoder)
973 if (connector->dpms < dpms)
974 dpms = connector->dpms;
975 return dpms;
976}
977
978static int drm_helper_choose_crtc_dpms(struct drm_crtc *crtc)
979{
980 int dpms = DRM_MODE_DPMS_OFF;
981 struct drm_connector *connector;
982 struct drm_device *dev = crtc->dev;
983
984 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
985 if (connector->encoder && connector->encoder->crtc == crtc)
986 if (connector->dpms < dpms)
987 dpms = connector->dpms;
988 return dpms;
989}
990
991/**
992 * drm_helper_connector_dpms
993 * @connector affected connector
994 * @mode DPMS mode
995 *
996 * Calls the low-level connector DPMS function, then
997 * calls appropriate encoder and crtc DPMS functions as well
998 */
999void drm_helper_connector_dpms(struct drm_connector *connector, int mode)
1000{
1001 struct drm_encoder *encoder = connector->encoder;
1002 struct drm_crtc *crtc = encoder ? encoder->crtc : NULL;
1003 int old_dpms;
1004
1005 if (mode == connector->dpms)
1006 return;
1007
1008 old_dpms = connector->dpms;
1009 connector->dpms = mode;
1010
1011 /* from off to on, do crtc then encoder */
1012 if (mode < old_dpms) {
1013 if (crtc) {
1014 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
1015 if (crtc_funcs->dpms)
1016 (*crtc_funcs->dpms) (crtc,
1017 drm_helper_choose_crtc_dpms(crtc));
1018 }
1019 if (encoder) {
1020 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
1021 if (encoder_funcs->dpms)
1022 (*encoder_funcs->dpms) (encoder,
1023 drm_helper_choose_encoder_dpms(encoder));
1024 }
1025 }
1026
1027 /* from on to off, do encoder then crtc */
1028 if (mode > old_dpms) {
1029 if (encoder) {
1030 struct drm_encoder_helper_funcs *encoder_funcs = encoder->helper_private;
1031 if (encoder_funcs->dpms)
1032 (*encoder_funcs->dpms) (encoder,
1033 drm_helper_choose_encoder_dpms(encoder));
1034 }
1035 if (crtc) {
1036 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
1037 if (crtc_funcs->dpms)
1038 (*crtc_funcs->dpms) (crtc,
1039 drm_helper_choose_crtc_dpms(crtc));
1040 }
1041 }
1042
1043 return;
1044}
1045EXPORT_SYMBOL(drm_helper_connector_dpms);
1046
Dave Airlief453ba02008-11-07 14:05:41 -08001047/**
1048 * drm_hotplug_stage_two
1049 * @dev DRM device
1050 * @connector hotpluged connector
1051 *
1052 * LOCKING.
1053 * Caller must hold mode config lock, function might grab struct lock.
1054 *
1055 * Stage two of a hotplug.
1056 *
1057 * RETURNS:
1058 * Zero on success, errno on failure.
1059 */
1060int drm_helper_hotplug_stage_two(struct drm_device *dev)
1061{
Dave Airlief453ba02008-11-07 14:05:41 -08001062 drm_helper_plugged_event(dev);
1063
1064 return 0;
1065}
1066EXPORT_SYMBOL(drm_helper_hotplug_stage_two);
1067
1068int drm_helper_mode_fill_fb_struct(struct drm_framebuffer *fb,
1069 struct drm_mode_fb_cmd *mode_cmd)
1070{
1071 fb->width = mode_cmd->width;
1072 fb->height = mode_cmd->height;
1073 fb->pitch = mode_cmd->pitch;
1074 fb->bits_per_pixel = mode_cmd->bpp;
1075 fb->depth = mode_cmd->depth;
1076
1077 return 0;
1078}
1079EXPORT_SYMBOL(drm_helper_mode_fill_fb_struct);
1080
1081int drm_helper_resume_force_mode(struct drm_device *dev)
1082{
1083 struct drm_crtc *crtc;
1084 int ret;
1085
1086 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
1087
1088 if (!crtc->enabled)
1089 continue;
1090
Kristian Høgsberg3c4fdcf2008-12-17 22:14:46 -05001091 ret = drm_crtc_helper_set_mode(crtc, &crtc->mode,
1092 crtc->x, crtc->y, crtc->fb);
Dave Airlief453ba02008-11-07 14:05:41 -08001093
1094 if (ret == false)
1095 DRM_ERROR("failed to set mode on crtc %p\n", crtc);
1096 }
Zhao Yakuiaf4fcb52009-07-08 14:13:13 +08001097 /* disable the unused connectors while restoring the modesetting */
1098 drm_helper_disable_unused_functions(dev);
Dave Airlief453ba02008-11-07 14:05:41 -08001099 return 0;
1100}
1101EXPORT_SYMBOL(drm_helper_resume_force_mode);