1 /* 2 * Copyright (c) 2006-2009 Red Hat Inc. 3 * Copyright (c) 2006-2008 Intel Corporation 4 * Copyright (c) 2007 Dave Airlie <airlied@linux.ie> 5 * 6 * DRM framebuffer helper functions 7 * 8 * Permission to use, copy, modify, distribute, and sell this software and its 9 * documentation for any purpose is hereby granted without fee, provided that 10 * the above copyright notice appear in all copies and that both that copyright 11 * notice and this permission notice appear in supporting documentation, and 12 * that the name of the copyright holders not be used in advertising or 13 * publicity pertaining to distribution of the software without specific, 14 * written prior permission. The copyright holders make no representations 15 * about the suitability of this software for any purpose. It is provided "as 16 * is" without express or implied warranty. 17 * 18 * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, 19 * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO 20 * EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY SPECIAL, INDIRECT OR 21 * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, 22 * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER 23 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE 24 * OF THIS SOFTWARE. 25 * 26 * Authors: 27 * Dave Airlie <airlied@linux.ie> 28 * Jesse Barnes <jesse.barnes@intel.com> 29 */ 30 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 31 32 #include <linux/kernel.h> 33 #include <linux/sysrq.h> 34 #include <linux/slab.h> 35 #include <linux/fb.h> 36 #include <linux/module.h> 37 #include <drm/drmP.h> 38 #include <drm/drm_crtc.h> 39 #include <drm/drm_fb_helper.h> 40 #include <drm/drm_crtc_helper.h> 41 42 MODULE_AUTHOR("David Airlie, Jesse Barnes"); 43 MODULE_DESCRIPTION("DRM KMS helper"); 44 MODULE_LICENSE("GPL and additional rights"); 45 46 static LIST_HEAD(kernel_fb_helper_list); 47 48 /** 49 * DOC: fbdev helpers 50 * 51 * The fb helper functions are useful to provide an fbdev on top of a drm kernel 52 * mode setting driver. They can be used mostly independantely from the crtc 53 * helper functions used by many drivers to implement the kernel mode setting 54 * interfaces. 55 * 56 * Initialization is done as a three-step process with drm_fb_helper_init(), 57 * drm_fb_helper_single_add_all_connectors() and drm_fb_helper_initial_config(). 58 * Drivers with fancier requirements than the default beheviour can override the 59 * second step with their own code. Teardown is done with drm_fb_helper_fini(). 60 * 61 * At runtime drivers should restore the fbdev console by calling 62 * drm_fb_helper_restore_fbdev_mode() from their ->lastclose callback. They 63 * should also notify the fb helper code from updates to the output 64 * configuration by calling drm_fb_helper_hotplug_event(). For easier 65 * integration with the output polling code in drm_crtc_helper.c the modeset 66 * code proves a ->output_poll_changed callback. 67 * 68 * All other functions exported by the fb helper library can be used to 69 * implement the fbdev driver interface by the driver. 70 */ 71 72 /** 73 * drm_fb_helper_single_add_all_connectors() - add all connectors to fbdev 74 * emulation helper 75 * @fb_helper: fbdev initialized with drm_fb_helper_init 76 * 77 * This functions adds all the available connectors for use with the given 78 * fb_helper. This is a separate step to allow drivers to freely assign 79 * connectors to the fbdev, e.g. if some are reserved for special purposes or 80 * not adequate to be used for the fbcon. 81 * 82 * Since this is part of the initial setup before the fbdev is published, no 83 * locking is required. 84 */ 85 int drm_fb_helper_single_add_all_connectors(struct drm_fb_helper *fb_helper) 86 { 87 struct drm_device *dev = fb_helper->dev; 88 struct drm_connector *connector; 89 int i; 90 91 list_for_each_entry(connector, &dev->mode_config.connector_list, head) { 92 struct drm_fb_helper_connector *fb_helper_connector; 93 94 fb_helper_connector = kzalloc(sizeof(struct drm_fb_helper_connector), GFP_KERNEL); 95 if (!fb_helper_connector) 96 goto fail; 97 98 fb_helper_connector->connector = connector; 99 fb_helper->connector_info[fb_helper->connector_count++] = fb_helper_connector; 100 } 101 return 0; 102 fail: 103 for (i = 0; i < fb_helper->connector_count; i++) { 104 kfree(fb_helper->connector_info[i]); 105 fb_helper->connector_info[i] = NULL; 106 } 107 fb_helper->connector_count = 0; 108 return -ENOMEM; 109 } 110 EXPORT_SYMBOL(drm_fb_helper_single_add_all_connectors); 111 112 static int drm_fb_helper_parse_command_line(struct drm_fb_helper *fb_helper) 113 { 114 struct drm_fb_helper_connector *fb_helper_conn; 115 int i; 116 117 for (i = 0; i < fb_helper->connector_count; i++) { 118 struct drm_cmdline_mode *mode; 119 struct drm_connector *connector; 120 char *option = NULL; 121 122 fb_helper_conn = fb_helper->connector_info[i]; 123 connector = fb_helper_conn->connector; 124 mode = &fb_helper_conn->cmdline_mode; 125 126 /* do something on return - turn off connector maybe */ 127 if (fb_get_options(drm_get_connector_name(connector), &option)) 128 continue; 129 130 if (drm_mode_parse_command_line_for_connector(option, 131 connector, 132 mode)) { 133 if (mode->force) { 134 const char *s; 135 switch (mode->force) { 136 case DRM_FORCE_OFF: 137 s = "OFF"; 138 break; 139 case DRM_FORCE_ON_DIGITAL: 140 s = "ON - dig"; 141 break; 142 default: 143 case DRM_FORCE_ON: 144 s = "ON"; 145 break; 146 } 147 148 DRM_INFO("forcing %s connector %s\n", 149 drm_get_connector_name(connector), s); 150 connector->force = mode->force; 151 } 152 153 DRM_DEBUG_KMS("cmdline mode for connector %s %dx%d@%dHz%s%s%s\n", 154 drm_get_connector_name(connector), 155 mode->xres, mode->yres, 156 mode->refresh_specified ? mode->refresh : 60, 157 mode->rb ? " reduced blanking" : "", 158 mode->margins ? " with margins" : "", 159 mode->interlace ? " interlaced" : ""); 160 } 161 162 } 163 return 0; 164 } 165 166 static void drm_fb_helper_save_lut_atomic(struct drm_crtc *crtc, struct drm_fb_helper *helper) 167 { 168 uint16_t *r_base, *g_base, *b_base; 169 int i; 170 171 r_base = crtc->gamma_store; 172 g_base = r_base + crtc->gamma_size; 173 b_base = g_base + crtc->gamma_size; 174 175 for (i = 0; i < crtc->gamma_size; i++) 176 helper->funcs->gamma_get(crtc, &r_base[i], &g_base[i], &b_base[i], i); 177 } 178 179 static void drm_fb_helper_restore_lut_atomic(struct drm_crtc *crtc) 180 { 181 uint16_t *r_base, *g_base, *b_base; 182 183 if (crtc->funcs->gamma_set == NULL) 184 return; 185 186 r_base = crtc->gamma_store; 187 g_base = r_base + crtc->gamma_size; 188 b_base = g_base + crtc->gamma_size; 189 190 crtc->funcs->gamma_set(crtc, r_base, g_base, b_base, 0, crtc->gamma_size); 191 } 192 193 /** 194 * drm_fb_helper_debug_enter - implementation for ->fb_debug_enter 195 * @info: fbdev registered by the helper 196 */ 197 int drm_fb_helper_debug_enter(struct fb_info *info) 198 { 199 struct drm_fb_helper *helper = info->par; 200 struct drm_crtc_helper_funcs *funcs; 201 int i; 202 203 if (list_empty(&kernel_fb_helper_list)) 204 return false; 205 206 list_for_each_entry(helper, &kernel_fb_helper_list, kernel_fb_list) { 207 for (i = 0; i < helper->crtc_count; i++) { 208 struct drm_mode_set *mode_set = 209 &helper->crtc_info[i].mode_set; 210 211 if (!mode_set->crtc->enabled) 212 continue; 213 214 funcs = mode_set->crtc->helper_private; 215 drm_fb_helper_save_lut_atomic(mode_set->crtc, helper); 216 funcs->mode_set_base_atomic(mode_set->crtc, 217 mode_set->fb, 218 mode_set->x, 219 mode_set->y, 220 ENTER_ATOMIC_MODE_SET); 221 } 222 } 223 224 return 0; 225 } 226 EXPORT_SYMBOL(drm_fb_helper_debug_enter); 227 228 /* Find the real fb for a given fb helper CRTC */ 229 static struct drm_framebuffer *drm_mode_config_fb(struct drm_crtc *crtc) 230 { 231 struct drm_device *dev = crtc->dev; 232 struct drm_crtc *c; 233 234 list_for_each_entry(c, &dev->mode_config.crtc_list, head) { 235 if (crtc->base.id == c->base.id) 236 return c->fb; 237 } 238 239 return NULL; 240 } 241 242 /** 243 * drm_fb_helper_debug_leave - implementation for ->fb_debug_leave 244 * @info: fbdev registered by the helper 245 */ 246 int drm_fb_helper_debug_leave(struct fb_info *info) 247 { 248 struct drm_fb_helper *helper = info->par; 249 struct drm_crtc *crtc; 250 struct drm_crtc_helper_funcs *funcs; 251 struct drm_framebuffer *fb; 252 int i; 253 254 for (i = 0; i < helper->crtc_count; i++) { 255 struct drm_mode_set *mode_set = &helper->crtc_info[i].mode_set; 256 crtc = mode_set->crtc; 257 funcs = crtc->helper_private; 258 fb = drm_mode_config_fb(crtc); 259 260 if (!crtc->enabled) 261 continue; 262 263 if (!fb) { 264 DRM_ERROR("no fb to restore??\n"); 265 continue; 266 } 267 268 drm_fb_helper_restore_lut_atomic(mode_set->crtc); 269 funcs->mode_set_base_atomic(mode_set->crtc, fb, crtc->x, 270 crtc->y, LEAVE_ATOMIC_MODE_SET); 271 } 272 273 return 0; 274 } 275 EXPORT_SYMBOL(drm_fb_helper_debug_leave); 276 277 /** 278 * drm_fb_helper_restore_fbdev_mode - restore fbdev configuration 279 * @fb_helper: fbcon to restore 280 * 281 * This should be called from driver's drm ->lastclose callback 282 * when implementing an fbcon on top of kms using this helper. This ensures that 283 * the user isn't greeted with a black screen when e.g. X dies. 284 */ 285 bool drm_fb_helper_restore_fbdev_mode(struct drm_fb_helper *fb_helper) 286 { 287 bool error = false; 288 int i, ret; 289 290 drm_warn_on_modeset_not_all_locked(fb_helper->dev); 291 292 for (i = 0; i < fb_helper->crtc_count; i++) { 293 struct drm_mode_set *mode_set = &fb_helper->crtc_info[i].mode_set; 294 ret = drm_mode_set_config_internal(mode_set); 295 if (ret) 296 error = true; 297 } 298 return error; 299 } 300 EXPORT_SYMBOL(drm_fb_helper_restore_fbdev_mode); 301 302 /* 303 * restore fbcon display for all kms driver's using this helper, used for sysrq 304 * and panic handling. 305 */ 306 static bool drm_fb_helper_force_kernel_mode(void) 307 { 308 bool ret, error = false; 309 struct drm_fb_helper *helper; 310 311 if (list_empty(&kernel_fb_helper_list)) 312 return false; 313 314 list_for_each_entry(helper, &kernel_fb_helper_list, kernel_fb_list) { 315 if (helper->dev->switch_power_state == DRM_SWITCH_POWER_OFF) 316 continue; 317 318 ret = drm_fb_helper_restore_fbdev_mode(helper); 319 if (ret) 320 error = true; 321 } 322 return error; 323 } 324 325 static int drm_fb_helper_panic(struct notifier_block *n, unsigned long ununsed, 326 void *panic_str) 327 { 328 /* 329 * It's a waste of time and effort to switch back to text console 330 * if the kernel should reboot before panic messages can be seen. 331 */ 332 if (panic_timeout < 0) 333 return 0; 334 335 pr_err("panic occurred, switching back to text console\n"); 336 return drm_fb_helper_force_kernel_mode(); 337 } 338 339 static struct notifier_block paniced = { 340 .notifier_call = drm_fb_helper_panic, 341 }; 342 343 static bool drm_fb_helper_is_bound(struct drm_fb_helper *fb_helper) 344 { 345 struct drm_device *dev = fb_helper->dev; 346 struct drm_crtc *crtc; 347 int bound = 0, crtcs_bound = 0; 348 349 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) { 350 if (crtc->fb) 351 crtcs_bound++; 352 if (crtc->fb == fb_helper->fb) 353 bound++; 354 } 355 356 if (bound < crtcs_bound) 357 return false; 358 return true; 359 } 360 361 #ifdef CONFIG_MAGIC_SYSRQ 362 static void drm_fb_helper_restore_work_fn(struct work_struct *ignored) 363 { 364 bool ret; 365 ret = drm_fb_helper_force_kernel_mode(); 366 if (ret == true) 367 DRM_ERROR("Failed to restore crtc configuration\n"); 368 } 369 static DECLARE_WORK(drm_fb_helper_restore_work, drm_fb_helper_restore_work_fn); 370 371 static void drm_fb_helper_sysrq(int dummy1) 372 { 373 schedule_work(&drm_fb_helper_restore_work); 374 } 375 376 static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = { 377 .handler = drm_fb_helper_sysrq, 378 .help_msg = "force-fb(V)", 379 .action_msg = "Restore framebuffer console", 380 }; 381 #else 382 static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = { }; 383 #endif 384 385 static void drm_fb_helper_dpms(struct fb_info *info, int dpms_mode) 386 { 387 struct drm_fb_helper *fb_helper = info->par; 388 struct drm_device *dev = fb_helper->dev; 389 struct drm_crtc *crtc; 390 struct drm_connector *connector; 391 int i, j; 392 393 /* 394 * fbdev->blank can be called from irq context in case of a panic. 395 * Since we already have our own special panic handler which will 396 * restore the fbdev console mode completely, just bail out early. 397 */ 398 if (oops_in_progress) 399 return; 400 401 /* 402 * For each CRTC in this fb, turn the connectors on/off. 403 */ 404 drm_modeset_lock_all(dev); 405 if (!drm_fb_helper_is_bound(fb_helper)) { 406 drm_modeset_unlock_all(dev); 407 return; 408 } 409 410 for (i = 0; i < fb_helper->crtc_count; i++) { 411 crtc = fb_helper->crtc_info[i].mode_set.crtc; 412 413 if (!crtc->enabled) 414 continue; 415 416 /* Walk the connectors & encoders on this fb turning them on/off */ 417 for (j = 0; j < fb_helper->connector_count; j++) { 418 connector = fb_helper->connector_info[j]->connector; 419 connector->funcs->dpms(connector, dpms_mode); 420 drm_object_property_set_value(&connector->base, 421 dev->mode_config.dpms_property, dpms_mode); 422 } 423 } 424 drm_modeset_unlock_all(dev); 425 } 426 427 /** 428 * drm_fb_helper_blank - implementation for ->fb_blank 429 * @blank: desired blanking state 430 * @info: fbdev registered by the helper 431 */ 432 int drm_fb_helper_blank(int blank, struct fb_info *info) 433 { 434 switch (blank) { 435 /* Display: On; HSync: On, VSync: On */ 436 case FB_BLANK_UNBLANK: 437 drm_fb_helper_dpms(info, DRM_MODE_DPMS_ON); 438 break; 439 /* Display: Off; HSync: On, VSync: On */ 440 case FB_BLANK_NORMAL: 441 drm_fb_helper_dpms(info, DRM_MODE_DPMS_STANDBY); 442 break; 443 /* Display: Off; HSync: Off, VSync: On */ 444 case FB_BLANK_HSYNC_SUSPEND: 445 drm_fb_helper_dpms(info, DRM_MODE_DPMS_STANDBY); 446 break; 447 /* Display: Off; HSync: On, VSync: Off */ 448 case FB_BLANK_VSYNC_SUSPEND: 449 drm_fb_helper_dpms(info, DRM_MODE_DPMS_SUSPEND); 450 break; 451 /* Display: Off; HSync: Off, VSync: Off */ 452 case FB_BLANK_POWERDOWN: 453 drm_fb_helper_dpms(info, DRM_MODE_DPMS_OFF); 454 break; 455 } 456 return 0; 457 } 458 EXPORT_SYMBOL(drm_fb_helper_blank); 459 460 static void drm_fb_helper_crtc_free(struct drm_fb_helper *helper) 461 { 462 int i; 463 464 for (i = 0; i < helper->connector_count; i++) 465 kfree(helper->connector_info[i]); 466 kfree(helper->connector_info); 467 for (i = 0; i < helper->crtc_count; i++) { 468 kfree(helper->crtc_info[i].mode_set.connectors); 469 if (helper->crtc_info[i].mode_set.mode) 470 drm_mode_destroy(helper->dev, helper->crtc_info[i].mode_set.mode); 471 } 472 kfree(helper->crtc_info); 473 } 474 475 /** 476 * drm_fb_helper_init - initialize a drm_fb_helper structure 477 * @dev: drm device 478 * @fb_helper: driver-allocated fbdev helper structure to initialize 479 * @crtc_count: maximum number of crtcs to support in this fbdev emulation 480 * @max_conn_count: max connector count 481 * 482 * This allocates the structures for the fbdev helper with the given limits. 483 * Note that this won't yet touch the hardware (through the driver interfaces) 484 * nor register the fbdev. This is only done in drm_fb_helper_initial_config() 485 * to allow driver writes more control over the exact init sequence. 486 * 487 * Drivers must set fb_helper->funcs before calling 488 * drm_fb_helper_initial_config(). 489 * 490 * RETURNS: 491 * Zero if everything went ok, nonzero otherwise. 492 */ 493 int drm_fb_helper_init(struct drm_device *dev, 494 struct drm_fb_helper *fb_helper, 495 int crtc_count, int max_conn_count) 496 { 497 struct drm_crtc *crtc; 498 int i; 499 500 fb_helper->dev = dev; 501 502 INIT_LIST_HEAD(&fb_helper->kernel_fb_list); 503 504 fb_helper->crtc_info = kcalloc(crtc_count, sizeof(struct drm_fb_helper_crtc), GFP_KERNEL); 505 if (!fb_helper->crtc_info) 506 return -ENOMEM; 507 508 fb_helper->crtc_count = crtc_count; 509 fb_helper->connector_info = kcalloc(dev->mode_config.num_connector, sizeof(struct drm_fb_helper_connector *), GFP_KERNEL); 510 if (!fb_helper->connector_info) { 511 kfree(fb_helper->crtc_info); 512 return -ENOMEM; 513 } 514 fb_helper->connector_count = 0; 515 516 for (i = 0; i < crtc_count; i++) { 517 fb_helper->crtc_info[i].mode_set.connectors = 518 kcalloc(max_conn_count, 519 sizeof(struct drm_connector *), 520 GFP_KERNEL); 521 522 if (!fb_helper->crtc_info[i].mode_set.connectors) 523 goto out_free; 524 fb_helper->crtc_info[i].mode_set.num_connectors = 0; 525 } 526 527 i = 0; 528 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) { 529 fb_helper->crtc_info[i].mode_set.crtc = crtc; 530 i++; 531 } 532 533 return 0; 534 out_free: 535 drm_fb_helper_crtc_free(fb_helper); 536 return -ENOMEM; 537 } 538 EXPORT_SYMBOL(drm_fb_helper_init); 539 540 void drm_fb_helper_fini(struct drm_fb_helper *fb_helper) 541 { 542 if (!list_empty(&fb_helper->kernel_fb_list)) { 543 list_del(&fb_helper->kernel_fb_list); 544 if (list_empty(&kernel_fb_helper_list)) { 545 pr_info("drm: unregistered panic notifier\n"); 546 atomic_notifier_chain_unregister(&panic_notifier_list, 547 &paniced); 548 unregister_sysrq_key('v', &sysrq_drm_fb_helper_restore_op); 549 } 550 } 551 552 drm_fb_helper_crtc_free(fb_helper); 553 554 } 555 EXPORT_SYMBOL(drm_fb_helper_fini); 556 557 static int setcolreg(struct drm_crtc *crtc, u16 red, u16 green, 558 u16 blue, u16 regno, struct fb_info *info) 559 { 560 struct drm_fb_helper *fb_helper = info->par; 561 struct drm_framebuffer *fb = fb_helper->fb; 562 int pindex; 563 564 if (info->fix.visual == FB_VISUAL_TRUECOLOR) { 565 u32 *palette; 566 u32 value; 567 /* place color in psuedopalette */ 568 if (regno > 16) 569 return -EINVAL; 570 palette = (u32 *)info->pseudo_palette; 571 red >>= (16 - info->var.red.length); 572 green >>= (16 - info->var.green.length); 573 blue >>= (16 - info->var.blue.length); 574 value = (red << info->var.red.offset) | 575 (green << info->var.green.offset) | 576 (blue << info->var.blue.offset); 577 if (info->var.transp.length > 0) { 578 u32 mask = (1 << info->var.transp.length) - 1; 579 mask <<= info->var.transp.offset; 580 value |= mask; 581 } 582 palette[regno] = value; 583 return 0; 584 } 585 586 pindex = regno; 587 588 if (fb->bits_per_pixel == 16) { 589 pindex = regno << 3; 590 591 if (fb->depth == 16 && regno > 63) 592 return -EINVAL; 593 if (fb->depth == 15 && regno > 31) 594 return -EINVAL; 595 596 if (fb->depth == 16) { 597 u16 r, g, b; 598 int i; 599 if (regno < 32) { 600 for (i = 0; i < 8; i++) 601 fb_helper->funcs->gamma_set(crtc, red, 602 green, blue, pindex + i); 603 } 604 605 fb_helper->funcs->gamma_get(crtc, &r, 606 &g, &b, 607 pindex >> 1); 608 609 for (i = 0; i < 4; i++) 610 fb_helper->funcs->gamma_set(crtc, r, 611 green, b, 612 (pindex >> 1) + i); 613 } 614 } 615 616 if (fb->depth != 16) 617 fb_helper->funcs->gamma_set(crtc, red, green, blue, pindex); 618 return 0; 619 } 620 621 /** 622 * drm_fb_helper_setcmap - implementation for ->fb_setcmap 623 * @cmap: cmap to set 624 * @info: fbdev registered by the helper 625 */ 626 int drm_fb_helper_setcmap(struct fb_cmap *cmap, struct fb_info *info) 627 { 628 struct drm_fb_helper *fb_helper = info->par; 629 struct drm_crtc_helper_funcs *crtc_funcs; 630 u16 *red, *green, *blue, *transp; 631 struct drm_crtc *crtc; 632 int i, j, rc = 0; 633 int start; 634 635 for (i = 0; i < fb_helper->crtc_count; i++) { 636 crtc = fb_helper->crtc_info[i].mode_set.crtc; 637 crtc_funcs = crtc->helper_private; 638 639 red = cmap->red; 640 green = cmap->green; 641 blue = cmap->blue; 642 transp = cmap->transp; 643 start = cmap->start; 644 645 for (j = 0; j < cmap->len; j++) { 646 u16 hred, hgreen, hblue, htransp = 0xffff; 647 648 hred = *red++; 649 hgreen = *green++; 650 hblue = *blue++; 651 652 if (transp) 653 htransp = *transp++; 654 655 rc = setcolreg(crtc, hred, hgreen, hblue, start++, info); 656 if (rc) 657 return rc; 658 } 659 crtc_funcs->load_lut(crtc); 660 } 661 return rc; 662 } 663 EXPORT_SYMBOL(drm_fb_helper_setcmap); 664 665 /** 666 * drm_fb_helper_check_var - implementation for ->fb_check_var 667 * @var: screeninfo to check 668 * @info: fbdev registered by the helper 669 */ 670 int drm_fb_helper_check_var(struct fb_var_screeninfo *var, 671 struct fb_info *info) 672 { 673 struct drm_fb_helper *fb_helper = info->par; 674 struct drm_framebuffer *fb = fb_helper->fb; 675 int depth; 676 677 if (var->pixclock != 0 || in_dbg_master()) 678 return -EINVAL; 679 680 /* Need to resize the fb object !!! */ 681 if (var->bits_per_pixel > fb->bits_per_pixel || 682 var->xres > fb->width || var->yres > fb->height || 683 var->xres_virtual > fb->width || var->yres_virtual > fb->height) { 684 DRM_DEBUG("fb userspace requested width/height/bpp is greater than current fb " 685 "request %dx%d-%d (virtual %dx%d) > %dx%d-%d\n", 686 var->xres, var->yres, var->bits_per_pixel, 687 var->xres_virtual, var->yres_virtual, 688 fb->width, fb->height, fb->bits_per_pixel); 689 return -EINVAL; 690 } 691 692 switch (var->bits_per_pixel) { 693 case 16: 694 depth = (var->green.length == 6) ? 16 : 15; 695 break; 696 case 32: 697 depth = (var->transp.length > 0) ? 32 : 24; 698 break; 699 default: 700 depth = var->bits_per_pixel; 701 break; 702 } 703 704 switch (depth) { 705 case 8: 706 var->red.offset = 0; 707 var->green.offset = 0; 708 var->blue.offset = 0; 709 var->red.length = 8; 710 var->green.length = 8; 711 var->blue.length = 8; 712 var->transp.length = 0; 713 var->transp.offset = 0; 714 break; 715 case 15: 716 var->red.offset = 10; 717 var->green.offset = 5; 718 var->blue.offset = 0; 719 var->red.length = 5; 720 var->green.length = 5; 721 var->blue.length = 5; 722 var->transp.length = 1; 723 var->transp.offset = 15; 724 break; 725 case 16: 726 var->red.offset = 11; 727 var->green.offset = 5; 728 var->blue.offset = 0; 729 var->red.length = 5; 730 var->green.length = 6; 731 var->blue.length = 5; 732 var->transp.length = 0; 733 var->transp.offset = 0; 734 break; 735 case 24: 736 var->red.offset = 16; 737 var->green.offset = 8; 738 var->blue.offset = 0; 739 var->red.length = 8; 740 var->green.length = 8; 741 var->blue.length = 8; 742 var->transp.length = 0; 743 var->transp.offset = 0; 744 break; 745 case 32: 746 var->red.offset = 16; 747 var->green.offset = 8; 748 var->blue.offset = 0; 749 var->red.length = 8; 750 var->green.length = 8; 751 var->blue.length = 8; 752 var->transp.length = 8; 753 var->transp.offset = 24; 754 break; 755 default: 756 return -EINVAL; 757 } 758 return 0; 759 } 760 EXPORT_SYMBOL(drm_fb_helper_check_var); 761 762 /** 763 * drm_fb_helper_set_par - implementation for ->fb_set_par 764 * @info: fbdev registered by the helper 765 * 766 * This will let fbcon do the mode init and is called at initialization time by 767 * the fbdev core when registering the driver, and later on through the hotplug 768 * callback. 769 */ 770 int drm_fb_helper_set_par(struct fb_info *info) 771 { 772 struct drm_fb_helper *fb_helper = info->par; 773 struct drm_device *dev = fb_helper->dev; 774 struct fb_var_screeninfo *var = &info->var; 775 int ret; 776 int i; 777 778 if (var->pixclock != 0) { 779 DRM_ERROR("PIXEL CLOCK SET\n"); 780 return -EINVAL; 781 } 782 783 drm_modeset_lock_all(dev); 784 for (i = 0; i < fb_helper->crtc_count; i++) { 785 ret = drm_mode_set_config_internal(&fb_helper->crtc_info[i].mode_set); 786 if (ret) { 787 drm_modeset_unlock_all(dev); 788 return ret; 789 } 790 } 791 drm_modeset_unlock_all(dev); 792 793 if (fb_helper->delayed_hotplug) { 794 fb_helper->delayed_hotplug = false; 795 drm_fb_helper_hotplug_event(fb_helper); 796 } 797 return 0; 798 } 799 EXPORT_SYMBOL(drm_fb_helper_set_par); 800 801 /** 802 * drm_fb_helper_pan_display - implementation for ->fb_pan_display 803 * @var: updated screen information 804 * @info: fbdev registered by the helper 805 */ 806 int drm_fb_helper_pan_display(struct fb_var_screeninfo *var, 807 struct fb_info *info) 808 { 809 struct drm_fb_helper *fb_helper = info->par; 810 struct drm_device *dev = fb_helper->dev; 811 struct drm_mode_set *modeset; 812 struct drm_crtc *crtc; 813 int ret = 0; 814 int i; 815 816 drm_modeset_lock_all(dev); 817 if (!drm_fb_helper_is_bound(fb_helper)) { 818 drm_modeset_unlock_all(dev); 819 return -EBUSY; 820 } 821 822 for (i = 0; i < fb_helper->crtc_count; i++) { 823 crtc = fb_helper->crtc_info[i].mode_set.crtc; 824 825 modeset = &fb_helper->crtc_info[i].mode_set; 826 827 modeset->x = var->xoffset; 828 modeset->y = var->yoffset; 829 830 if (modeset->num_connectors) { 831 ret = drm_mode_set_config_internal(modeset); 832 if (!ret) { 833 info->var.xoffset = var->xoffset; 834 info->var.yoffset = var->yoffset; 835 } 836 } 837 } 838 drm_modeset_unlock_all(dev); 839 return ret; 840 } 841 EXPORT_SYMBOL(drm_fb_helper_pan_display); 842 843 /* 844 * Allocates the backing storage and sets up the fbdev info structure through 845 * the ->fb_probe callback and then registers the fbdev and sets up the panic 846 * notifier. 847 */ 848 static int drm_fb_helper_single_fb_probe(struct drm_fb_helper *fb_helper, 849 int preferred_bpp) 850 { 851 int ret = 0; 852 int crtc_count = 0; 853 int i; 854 struct fb_info *info; 855 struct drm_fb_helper_surface_size sizes; 856 int gamma_size = 0; 857 858 memset(&sizes, 0, sizeof(struct drm_fb_helper_surface_size)); 859 sizes.surface_depth = 24; 860 sizes.surface_bpp = 32; 861 sizes.fb_width = (unsigned)-1; 862 sizes.fb_height = (unsigned)-1; 863 864 /* if driver picks 8 or 16 by default use that 865 for both depth/bpp */ 866 if (preferred_bpp != sizes.surface_bpp) 867 sizes.surface_depth = sizes.surface_bpp = preferred_bpp; 868 869 /* first up get a count of crtcs now in use and new min/maxes width/heights */ 870 for (i = 0; i < fb_helper->connector_count; i++) { 871 struct drm_fb_helper_connector *fb_helper_conn = fb_helper->connector_info[i]; 872 struct drm_cmdline_mode *cmdline_mode; 873 874 cmdline_mode = &fb_helper_conn->cmdline_mode; 875 876 if (cmdline_mode->bpp_specified) { 877 switch (cmdline_mode->bpp) { 878 case 8: 879 sizes.surface_depth = sizes.surface_bpp = 8; 880 break; 881 case 15: 882 sizes.surface_depth = 15; 883 sizes.surface_bpp = 16; 884 break; 885 case 16: 886 sizes.surface_depth = sizes.surface_bpp = 16; 887 break; 888 case 24: 889 sizes.surface_depth = sizes.surface_bpp = 24; 890 break; 891 case 32: 892 sizes.surface_depth = 24; 893 sizes.surface_bpp = 32; 894 break; 895 } 896 break; 897 } 898 } 899 900 crtc_count = 0; 901 for (i = 0; i < fb_helper->crtc_count; i++) { 902 struct drm_display_mode *desired_mode; 903 desired_mode = fb_helper->crtc_info[i].desired_mode; 904 905 if (desired_mode) { 906 if (gamma_size == 0) 907 gamma_size = fb_helper->crtc_info[i].mode_set.crtc->gamma_size; 908 if (desired_mode->hdisplay < sizes.fb_width) 909 sizes.fb_width = desired_mode->hdisplay; 910 if (desired_mode->vdisplay < sizes.fb_height) 911 sizes.fb_height = desired_mode->vdisplay; 912 if (desired_mode->hdisplay > sizes.surface_width) 913 sizes.surface_width = desired_mode->hdisplay; 914 if (desired_mode->vdisplay > sizes.surface_height) 915 sizes.surface_height = desired_mode->vdisplay; 916 crtc_count++; 917 } 918 } 919 920 if (crtc_count == 0 || sizes.fb_width == -1 || sizes.fb_height == -1) { 921 /* hmm everyone went away - assume VGA cable just fell out 922 and will come back later. */ 923 DRM_INFO("Cannot find any crtc or sizes - going 1024x768\n"); 924 sizes.fb_width = sizes.surface_width = 1024; 925 sizes.fb_height = sizes.surface_height = 768; 926 } 927 928 /* push down into drivers */ 929 ret = (*fb_helper->funcs->fb_probe)(fb_helper, &sizes); 930 if (ret < 0) 931 return ret; 932 933 info = fb_helper->fbdev; 934 935 /* 936 * Set the fb pointer - usually drm_setup_crtcs does this for hotplug 937 * events, but at init time drm_setup_crtcs needs to be called before 938 * the fb is allocated (since we need to figure out the desired size of 939 * the fb before we can allocate it ...). Hence we need to fix things up 940 * here again. 941 */ 942 for (i = 0; i < fb_helper->crtc_count; i++) 943 if (fb_helper->crtc_info[i].mode_set.num_connectors) 944 fb_helper->crtc_info[i].mode_set.fb = fb_helper->fb; 945 946 947 info->var.pixclock = 0; 948 if (register_framebuffer(info) < 0) 949 return -EINVAL; 950 951 dev_info(fb_helper->dev->dev, "fb%d: %s frame buffer device\n", 952 info->node, info->fix.id); 953 954 /* Switch back to kernel console on panic */ 955 /* multi card linked list maybe */ 956 if (list_empty(&kernel_fb_helper_list)) { 957 dev_info(fb_helper->dev->dev, "registered panic notifier\n"); 958 atomic_notifier_chain_register(&panic_notifier_list, 959 &paniced); 960 register_sysrq_key('v', &sysrq_drm_fb_helper_restore_op); 961 } 962 963 list_add(&fb_helper->kernel_fb_list, &kernel_fb_helper_list); 964 965 return 0; 966 } 967 968 /** 969 * drm_fb_helper_fill_fix - initializes fixed fbdev information 970 * @info: fbdev registered by the helper 971 * @pitch: desired pitch 972 * @depth: desired depth 973 * 974 * Helper to fill in the fixed fbdev information useful for a non-accelerated 975 * fbdev emulations. Drivers which support acceleration methods which impose 976 * additional constraints need to set up their own limits. 977 * 978 * Drivers should call this (or their equivalent setup code) from their 979 * ->fb_probe callback. 980 */ 981 void drm_fb_helper_fill_fix(struct fb_info *info, uint32_t pitch, 982 uint32_t depth) 983 { 984 info->fix.type = FB_TYPE_PACKED_PIXELS; 985 info->fix.visual = depth == 8 ? FB_VISUAL_PSEUDOCOLOR : 986 FB_VISUAL_TRUECOLOR; 987 info->fix.mmio_start = 0; 988 info->fix.mmio_len = 0; 989 info->fix.type_aux = 0; 990 info->fix.xpanstep = 1; /* doing it in hw */ 991 info->fix.ypanstep = 1; /* doing it in hw */ 992 info->fix.ywrapstep = 0; 993 info->fix.accel = FB_ACCEL_NONE; 994 info->fix.type_aux = 0; 995 996 info->fix.line_length = pitch; 997 return; 998 } 999 EXPORT_SYMBOL(drm_fb_helper_fill_fix); 1000 1001 /** 1002 * drm_fb_helper_fill_var - initalizes variable fbdev information 1003 * @info: fbdev instance to set up 1004 * @fb_helper: fb helper instance to use as template 1005 * @fb_width: desired fb width 1006 * @fb_height: desired fb height 1007 * 1008 * Sets up the variable fbdev metainformation from the given fb helper instance 1009 * and the drm framebuffer allocated in fb_helper->fb. 1010 * 1011 * Drivers should call this (or their equivalent setup code) from their 1012 * ->fb_probe callback after having allocated the fbdev backing 1013 * storage framebuffer. 1014 */ 1015 void drm_fb_helper_fill_var(struct fb_info *info, struct drm_fb_helper *fb_helper, 1016 uint32_t fb_width, uint32_t fb_height) 1017 { 1018 struct drm_framebuffer *fb = fb_helper->fb; 1019 info->pseudo_palette = fb_helper->pseudo_palette; 1020 info->var.xres_virtual = fb->width; 1021 info->var.yres_virtual = fb->height; 1022 info->var.bits_per_pixel = fb->bits_per_pixel; 1023 info->var.accel_flags = FB_ACCELF_TEXT; 1024 info->var.xoffset = 0; 1025 info->var.yoffset = 0; 1026 info->var.activate = FB_ACTIVATE_NOW; 1027 info->var.height = -1; 1028 info->var.width = -1; 1029 1030 switch (fb->depth) { 1031 case 8: 1032 info->var.red.offset = 0; 1033 info->var.green.offset = 0; 1034 info->var.blue.offset = 0; 1035 info->var.red.length = 8; /* 8bit DAC */ 1036 info->var.green.length = 8; 1037 info->var.blue.length = 8; 1038 info->var.transp.offset = 0; 1039 info->var.transp.length = 0; 1040 break; 1041 case 15: 1042 info->var.red.offset = 10; 1043 info->var.green.offset = 5; 1044 info->var.blue.offset = 0; 1045 info->var.red.length = 5; 1046 info->var.green.length = 5; 1047 info->var.blue.length = 5; 1048 info->var.transp.offset = 15; 1049 info->var.transp.length = 1; 1050 break; 1051 case 16: 1052 info->var.red.offset = 11; 1053 info->var.green.offset = 5; 1054 info->var.blue.offset = 0; 1055 info->var.red.length = 5; 1056 info->var.green.length = 6; 1057 info->var.blue.length = 5; 1058 info->var.transp.offset = 0; 1059 break; 1060 case 24: 1061 info->var.red.offset = 16; 1062 info->var.green.offset = 8; 1063 info->var.blue.offset = 0; 1064 info->var.red.length = 8; 1065 info->var.green.length = 8; 1066 info->var.blue.length = 8; 1067 info->var.transp.offset = 0; 1068 info->var.transp.length = 0; 1069 break; 1070 case 32: 1071 info->var.red.offset = 16; 1072 info->var.green.offset = 8; 1073 info->var.blue.offset = 0; 1074 info->var.red.length = 8; 1075 info->var.green.length = 8; 1076 info->var.blue.length = 8; 1077 info->var.transp.offset = 24; 1078 info->var.transp.length = 8; 1079 break; 1080 default: 1081 break; 1082 } 1083 1084 info->var.xres = fb_width; 1085 info->var.yres = fb_height; 1086 } 1087 EXPORT_SYMBOL(drm_fb_helper_fill_var); 1088 1089 static int drm_fb_helper_probe_connector_modes(struct drm_fb_helper *fb_helper, 1090 uint32_t maxX, 1091 uint32_t maxY) 1092 { 1093 struct drm_connector *connector; 1094 int count = 0; 1095 int i; 1096 1097 for (i = 0; i < fb_helper->connector_count; i++) { 1098 connector = fb_helper->connector_info[i]->connector; 1099 count += connector->funcs->fill_modes(connector, maxX, maxY); 1100 } 1101 1102 return count; 1103 } 1104 1105 static struct drm_display_mode *drm_has_preferred_mode(struct drm_fb_helper_connector *fb_connector, int width, int height) 1106 { 1107 struct drm_display_mode *mode; 1108 1109 list_for_each_entry(mode, &fb_connector->connector->modes, head) { 1110 if (drm_mode_width(mode) > width || 1111 drm_mode_height(mode) > height) 1112 continue; 1113 if (mode->type & DRM_MODE_TYPE_PREFERRED) 1114 return mode; 1115 } 1116 return NULL; 1117 } 1118 1119 static bool drm_has_cmdline_mode(struct drm_fb_helper_connector *fb_connector) 1120 { 1121 struct drm_cmdline_mode *cmdline_mode; 1122 cmdline_mode = &fb_connector->cmdline_mode; 1123 return cmdline_mode->specified; 1124 } 1125 1126 static struct drm_display_mode *drm_pick_cmdline_mode(struct drm_fb_helper_connector *fb_helper_conn, 1127 int width, int height) 1128 { 1129 struct drm_cmdline_mode *cmdline_mode; 1130 struct drm_display_mode *mode = NULL; 1131 1132 cmdline_mode = &fb_helper_conn->cmdline_mode; 1133 if (cmdline_mode->specified == false) 1134 return mode; 1135 1136 /* attempt to find a matching mode in the list of modes 1137 * we have gotten so far, if not add a CVT mode that conforms 1138 */ 1139 if (cmdline_mode->rb || cmdline_mode->margins) 1140 goto create_mode; 1141 1142 list_for_each_entry(mode, &fb_helper_conn->connector->modes, head) { 1143 /* check width/height */ 1144 if (mode->hdisplay != cmdline_mode->xres || 1145 mode->vdisplay != cmdline_mode->yres) 1146 continue; 1147 1148 if (cmdline_mode->refresh_specified) { 1149 if (mode->vrefresh != cmdline_mode->refresh) 1150 continue; 1151 } 1152 1153 if (cmdline_mode->interlace) { 1154 if (!(mode->flags & DRM_MODE_FLAG_INTERLACE)) 1155 continue; 1156 } 1157 return mode; 1158 } 1159 1160 create_mode: 1161 mode = drm_mode_create_from_cmdline_mode(fb_helper_conn->connector->dev, 1162 cmdline_mode); 1163 list_add(&mode->head, &fb_helper_conn->connector->modes); 1164 return mode; 1165 } 1166 1167 static bool drm_connector_enabled(struct drm_connector *connector, bool strict) 1168 { 1169 bool enable; 1170 1171 if (strict) 1172 enable = connector->status == connector_status_connected; 1173 else 1174 enable = connector->status != connector_status_disconnected; 1175 1176 return enable; 1177 } 1178 1179 static void drm_enable_connectors(struct drm_fb_helper *fb_helper, 1180 bool *enabled) 1181 { 1182 bool any_enabled = false; 1183 struct drm_connector *connector; 1184 int i = 0; 1185 1186 for (i = 0; i < fb_helper->connector_count; i++) { 1187 connector = fb_helper->connector_info[i]->connector; 1188 enabled[i] = drm_connector_enabled(connector, true); 1189 DRM_DEBUG_KMS("connector %d enabled? %s\n", connector->base.id, 1190 enabled[i] ? "yes" : "no"); 1191 any_enabled |= enabled[i]; 1192 } 1193 1194 if (any_enabled) 1195 return; 1196 1197 for (i = 0; i < fb_helper->connector_count; i++) { 1198 connector = fb_helper->connector_info[i]->connector; 1199 enabled[i] = drm_connector_enabled(connector, false); 1200 } 1201 } 1202 1203 static bool drm_target_cloned(struct drm_fb_helper *fb_helper, 1204 struct drm_display_mode **modes, 1205 bool *enabled, int width, int height) 1206 { 1207 int count, i, j; 1208 bool can_clone = false; 1209 struct drm_fb_helper_connector *fb_helper_conn; 1210 struct drm_display_mode *dmt_mode, *mode; 1211 1212 /* only contemplate cloning in the single crtc case */ 1213 if (fb_helper->crtc_count > 1) 1214 return false; 1215 1216 count = 0; 1217 for (i = 0; i < fb_helper->connector_count; i++) { 1218 if (enabled[i]) 1219 count++; 1220 } 1221 1222 /* only contemplate cloning if more than one connector is enabled */ 1223 if (count <= 1) 1224 return false; 1225 1226 /* check the command line or if nothing common pick 1024x768 */ 1227 can_clone = true; 1228 for (i = 0; i < fb_helper->connector_count; i++) { 1229 if (!enabled[i]) 1230 continue; 1231 fb_helper_conn = fb_helper->connector_info[i]; 1232 modes[i] = drm_pick_cmdline_mode(fb_helper_conn, width, height); 1233 if (!modes[i]) { 1234 can_clone = false; 1235 break; 1236 } 1237 for (j = 0; j < i; j++) { 1238 if (!enabled[j]) 1239 continue; 1240 if (!drm_mode_equal(modes[j], modes[i])) 1241 can_clone = false; 1242 } 1243 } 1244 1245 if (can_clone) { 1246 DRM_DEBUG_KMS("can clone using command line\n"); 1247 return true; 1248 } 1249 1250 /* try and find a 1024x768 mode on each connector */ 1251 can_clone = true; 1252 dmt_mode = drm_mode_find_dmt(fb_helper->dev, 1024, 768, 60, false); 1253 1254 for (i = 0; i < fb_helper->connector_count; i++) { 1255 1256 if (!enabled[i]) 1257 continue; 1258 1259 fb_helper_conn = fb_helper->connector_info[i]; 1260 list_for_each_entry(mode, &fb_helper_conn->connector->modes, head) { 1261 if (drm_mode_equal(mode, dmt_mode)) 1262 modes[i] = mode; 1263 } 1264 if (!modes[i]) 1265 can_clone = false; 1266 } 1267 1268 if (can_clone) { 1269 DRM_DEBUG_KMS("can clone using 1024x768\n"); 1270 return true; 1271 } 1272 DRM_INFO("kms: can't enable cloning when we probably wanted to.\n"); 1273 return false; 1274 } 1275 1276 static bool drm_target_preferred(struct drm_fb_helper *fb_helper, 1277 struct drm_display_mode **modes, 1278 bool *enabled, int width, int height) 1279 { 1280 struct drm_fb_helper_connector *fb_helper_conn; 1281 int i; 1282 1283 for (i = 0; i < fb_helper->connector_count; i++) { 1284 fb_helper_conn = fb_helper->connector_info[i]; 1285 1286 if (enabled[i] == false) 1287 continue; 1288 1289 DRM_DEBUG_KMS("looking for cmdline mode on connector %d\n", 1290 fb_helper_conn->connector->base.id); 1291 1292 /* got for command line mode first */ 1293 modes[i] = drm_pick_cmdline_mode(fb_helper_conn, width, height); 1294 if (!modes[i]) { 1295 DRM_DEBUG_KMS("looking for preferred mode on connector %d\n", 1296 fb_helper_conn->connector->base.id); 1297 modes[i] = drm_has_preferred_mode(fb_helper_conn, width, height); 1298 } 1299 /* No preferred modes, pick one off the list */ 1300 if (!modes[i] && !list_empty(&fb_helper_conn->connector->modes)) { 1301 list_for_each_entry(modes[i], &fb_helper_conn->connector->modes, head) 1302 break; 1303 } 1304 DRM_DEBUG_KMS("found mode %s\n", modes[i] ? modes[i]->name : 1305 "none"); 1306 } 1307 return true; 1308 } 1309 1310 static int drm_pick_crtcs(struct drm_fb_helper *fb_helper, 1311 struct drm_fb_helper_crtc **best_crtcs, 1312 struct drm_display_mode **modes, 1313 int n, int width, int height) 1314 { 1315 int c, o; 1316 struct drm_device *dev = fb_helper->dev; 1317 struct drm_connector *connector; 1318 struct drm_connector_helper_funcs *connector_funcs; 1319 struct drm_encoder *encoder; 1320 struct drm_fb_helper_crtc *best_crtc; 1321 int my_score, best_score, score; 1322 struct drm_fb_helper_crtc **crtcs, *crtc; 1323 struct drm_fb_helper_connector *fb_helper_conn; 1324 1325 if (n == fb_helper->connector_count) 1326 return 0; 1327 1328 fb_helper_conn = fb_helper->connector_info[n]; 1329 connector = fb_helper_conn->connector; 1330 1331 best_crtcs[n] = NULL; 1332 best_crtc = NULL; 1333 best_score = drm_pick_crtcs(fb_helper, best_crtcs, modes, n+1, width, height); 1334 if (modes[n] == NULL) 1335 return best_score; 1336 1337 crtcs = kzalloc(dev->mode_config.num_connector * 1338 sizeof(struct drm_fb_helper_crtc *), GFP_KERNEL); 1339 if (!crtcs) 1340 return best_score; 1341 1342 my_score = 1; 1343 if (connector->status == connector_status_connected) 1344 my_score++; 1345 if (drm_has_cmdline_mode(fb_helper_conn)) 1346 my_score++; 1347 if (drm_has_preferred_mode(fb_helper_conn, width, height)) 1348 my_score++; 1349 1350 connector_funcs = connector->helper_private; 1351 encoder = connector_funcs->best_encoder(connector); 1352 if (!encoder) 1353 goto out; 1354 1355 /* select a crtc for this connector and then attempt to configure 1356 remaining connectors */ 1357 for (c = 0; c < fb_helper->crtc_count; c++) { 1358 crtc = &fb_helper->crtc_info[c]; 1359 1360 if ((encoder->possible_crtcs & (1 << c)) == 0) 1361 continue; 1362 1363 for (o = 0; o < n; o++) 1364 if (best_crtcs[o] == crtc) 1365 break; 1366 1367 if (o < n) { 1368 /* ignore cloning unless only a single crtc */ 1369 if (fb_helper->crtc_count > 1) 1370 continue; 1371 1372 if (!drm_mode_equal(modes[o], modes[n])) 1373 continue; 1374 } 1375 1376 crtcs[n] = crtc; 1377 memcpy(crtcs, best_crtcs, n * sizeof(struct drm_fb_helper_crtc *)); 1378 score = my_score + drm_pick_crtcs(fb_helper, crtcs, modes, n + 1, 1379 width, height); 1380 if (score > best_score) { 1381 best_crtc = crtc; 1382 best_score = score; 1383 memcpy(best_crtcs, crtcs, 1384 dev->mode_config.num_connector * 1385 sizeof(struct drm_fb_helper_crtc *)); 1386 } 1387 } 1388 out: 1389 kfree(crtcs); 1390 return best_score; 1391 } 1392 1393 static void drm_setup_crtcs(struct drm_fb_helper *fb_helper) 1394 { 1395 struct drm_device *dev = fb_helper->dev; 1396 struct drm_fb_helper_crtc **crtcs; 1397 struct drm_display_mode **modes; 1398 struct drm_mode_set *modeset; 1399 bool *enabled; 1400 int width, height; 1401 int i; 1402 1403 DRM_DEBUG_KMS("\n"); 1404 1405 width = dev->mode_config.max_width; 1406 height = dev->mode_config.max_height; 1407 1408 crtcs = kcalloc(dev->mode_config.num_connector, 1409 sizeof(struct drm_fb_helper_crtc *), GFP_KERNEL); 1410 modes = kcalloc(dev->mode_config.num_connector, 1411 sizeof(struct drm_display_mode *), GFP_KERNEL); 1412 enabled = kcalloc(dev->mode_config.num_connector, 1413 sizeof(bool), GFP_KERNEL); 1414 if (!crtcs || !modes || !enabled) { 1415 DRM_ERROR("Memory allocation failed\n"); 1416 goto out; 1417 } 1418 1419 1420 drm_enable_connectors(fb_helper, enabled); 1421 1422 if (!(fb_helper->funcs->initial_config && 1423 fb_helper->funcs->initial_config(fb_helper, crtcs, modes, 1424 enabled, width, height))) { 1425 memset(modes, 0, dev->mode_config.num_connector*sizeof(modes[0])); 1426 memset(crtcs, 0, dev->mode_config.num_connector*sizeof(crtcs[0])); 1427 1428 if (!drm_target_cloned(fb_helper, 1429 modes, enabled, width, height) && 1430 !drm_target_preferred(fb_helper, 1431 modes, enabled, width, height)) 1432 DRM_ERROR("Unable to find initial modes\n"); 1433 1434 DRM_DEBUG_KMS("picking CRTCs for %dx%d config\n", 1435 width, height); 1436 1437 drm_pick_crtcs(fb_helper, crtcs, modes, 0, width, height); 1438 } 1439 1440 /* need to set the modesets up here for use later */ 1441 /* fill out the connector<->crtc mappings into the modesets */ 1442 for (i = 0; i < fb_helper->crtc_count; i++) { 1443 modeset = &fb_helper->crtc_info[i].mode_set; 1444 modeset->num_connectors = 0; 1445 modeset->fb = NULL; 1446 } 1447 1448 for (i = 0; i < fb_helper->connector_count; i++) { 1449 struct drm_display_mode *mode = modes[i]; 1450 struct drm_fb_helper_crtc *fb_crtc = crtcs[i]; 1451 modeset = &fb_crtc->mode_set; 1452 1453 if (mode && fb_crtc) { 1454 DRM_DEBUG_KMS("desired mode %s set on crtc %d\n", 1455 mode->name, fb_crtc->mode_set.crtc->base.id); 1456 fb_crtc->desired_mode = mode; 1457 if (modeset->mode) 1458 drm_mode_destroy(dev, modeset->mode); 1459 modeset->mode = drm_mode_duplicate(dev, 1460 fb_crtc->desired_mode); 1461 modeset->connectors[modeset->num_connectors++] = fb_helper->connector_info[i]->connector; 1462 modeset->fb = fb_helper->fb; 1463 } 1464 } 1465 1466 /* Clear out any old modes if there are no more connected outputs. */ 1467 for (i = 0; i < fb_helper->crtc_count; i++) { 1468 modeset = &fb_helper->crtc_info[i].mode_set; 1469 if (modeset->num_connectors == 0) { 1470 BUG_ON(modeset->fb); 1471 BUG_ON(modeset->num_connectors); 1472 if (modeset->mode) 1473 drm_mode_destroy(dev, modeset->mode); 1474 modeset->mode = NULL; 1475 } 1476 } 1477 out: 1478 kfree(crtcs); 1479 kfree(modes); 1480 kfree(enabled); 1481 } 1482 1483 /** 1484 * drm_fb_helper_initial_config - setup a sane initial connector configuration 1485 * @fb_helper: fb_helper device struct 1486 * @bpp_sel: bpp value to use for the framebuffer configuration 1487 * 1488 * Scans the CRTCs and connectors and tries to put together an initial setup. 1489 * At the moment, this is a cloned configuration across all heads with 1490 * a new framebuffer object as the backing store. 1491 * 1492 * Note that this also registers the fbdev and so allows userspace to call into 1493 * the driver through the fbdev interfaces. 1494 * 1495 * This function will call down into the ->fb_probe callback to let 1496 * the driver allocate and initialize the fbdev info structure and the drm 1497 * framebuffer used to back the fbdev. drm_fb_helper_fill_var() and 1498 * drm_fb_helper_fill_fix() are provided as helpers to setup simple default 1499 * values for the fbdev info structure. 1500 * 1501 * RETURNS: 1502 * Zero if everything went ok, nonzero otherwise. 1503 */ 1504 bool drm_fb_helper_initial_config(struct drm_fb_helper *fb_helper, int bpp_sel) 1505 { 1506 struct drm_device *dev = fb_helper->dev; 1507 int count = 0; 1508 1509 drm_fb_helper_parse_command_line(fb_helper); 1510 1511 count = drm_fb_helper_probe_connector_modes(fb_helper, 1512 dev->mode_config.max_width, 1513 dev->mode_config.max_height); 1514 /* 1515 * we shouldn't end up with no modes here. 1516 */ 1517 if (count == 0) 1518 dev_info(fb_helper->dev->dev, "No connectors reported connected with modes\n"); 1519 1520 drm_setup_crtcs(fb_helper); 1521 1522 return drm_fb_helper_single_fb_probe(fb_helper, bpp_sel); 1523 } 1524 EXPORT_SYMBOL(drm_fb_helper_initial_config); 1525 1526 /** 1527 * drm_fb_helper_hotplug_event - respond to a hotplug notification by 1528 * probing all the outputs attached to the fb 1529 * @fb_helper: the drm_fb_helper 1530 * 1531 * Scan the connectors attached to the fb_helper and try to put together a 1532 * setup after *notification of a change in output configuration. 1533 * 1534 * Called at runtime, takes the mode config locks to be able to check/change the 1535 * modeset configuration. Must be run from process context (which usually means 1536 * either the output polling work or a work item launched from the driver's 1537 * hotplug interrupt). 1538 * 1539 * Note that the driver must ensure that this is only called _after_ the fb has 1540 * been fully set up, i.e. after the call to drm_fb_helper_initial_config. 1541 * 1542 * RETURNS: 1543 * 0 on success and a non-zero error code otherwise. 1544 */ 1545 int drm_fb_helper_hotplug_event(struct drm_fb_helper *fb_helper) 1546 { 1547 struct drm_device *dev = fb_helper->dev; 1548 int count = 0; 1549 u32 max_width, max_height, bpp_sel; 1550 1551 if (!fb_helper->fb) 1552 return 0; 1553 1554 mutex_lock(&fb_helper->dev->mode_config.mutex); 1555 if (!drm_fb_helper_is_bound(fb_helper)) { 1556 fb_helper->delayed_hotplug = true; 1557 mutex_unlock(&fb_helper->dev->mode_config.mutex); 1558 return 0; 1559 } 1560 DRM_DEBUG_KMS("\n"); 1561 1562 max_width = fb_helper->fb->width; 1563 max_height = fb_helper->fb->height; 1564 bpp_sel = fb_helper->fb->bits_per_pixel; 1565 1566 count = drm_fb_helper_probe_connector_modes(fb_helper, max_width, 1567 max_height); 1568 mutex_unlock(&fb_helper->dev->mode_config.mutex); 1569 1570 drm_modeset_lock_all(dev); 1571 drm_setup_crtcs(fb_helper); 1572 drm_modeset_unlock_all(dev); 1573 drm_fb_helper_set_par(fb_helper->fbdev); 1574 1575 return 0; 1576 } 1577 EXPORT_SYMBOL(drm_fb_helper_hotplug_event); 1578 1579 /* The Kconfig DRM_KMS_HELPER selects FRAMEBUFFER_CONSOLE (if !EXPERT) 1580 * but the module doesn't depend on any fb console symbols. At least 1581 * attempt to load fbcon to avoid leaving the system without a usable console. 1582 */ 1583 #if defined(CONFIG_FRAMEBUFFER_CONSOLE_MODULE) && !defined(CONFIG_EXPERT) 1584 static int __init drm_fb_helper_modinit(void) 1585 { 1586 const char *name = "fbcon"; 1587 struct module *fbcon; 1588 1589 mutex_lock(&module_mutex); 1590 fbcon = find_module(name); 1591 mutex_unlock(&module_mutex); 1592 1593 if (!fbcon) 1594 request_module_nowait(name); 1595 return 0; 1596 } 1597 1598 module_init(drm_fb_helper_modinit); 1599 #endif 1600