drivers/gpu/drm/drm_fb_helper.c

   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 #include <linux/kernel.h>
  31 #include <linux/sysrq.h>
  32 #include <linux/slab.h>
  33 #include <linux/fb.h>
  34 #include "drmP.h"
  35 #include "drm_crtc.h"
  36 #include "drm_fb_helper.h"
  37 #include "drm_crtc_helper.h"
  38
  39 MODULE_AUTHOR("David Airlie, Jesse Barnes");
  40 MODULE_DESCRIPTION("DRM KMS helper");
  41 MODULE_LICENSE("GPL and additional rights");
  42
  43 static LIST_HEAD(kernel_fb_helper_list);
  44
  45 int drm_fb_helper_add_connector(struct drm_connector *connector)
  46 {
  47         connector->fb_helper_private = kzalloc(sizeof(struct drm_fb_helper_connector), GFP_KERNEL);
  48         if (!connector->fb_helper_private)
  49                 return -ENOMEM;
  50
  51         return 0;
  52 }
  53 EXPORT_SYMBOL(drm_fb_helper_add_connector);
  54
  55 /**
  56  * drm_fb_helper_connector_parse_command_line - parse command line for connector
  57  * @connector - connector to parse line for
  58  * @mode_option - per connector mode option
  59  *
  60  * This parses the connector specific then generic command lines for
  61  * modes and options to configure the connector.
  62  *
  63  * This uses the same parameters as the fb modedb.c, except for extra
  64  *      <xres>x<yres>[M][R][-<bpp>][@<refresh>][i][m][eDd]
  65  *
  66  * enable/enable Digital/disable bit at the end
  67  */
  68 static bool drm_fb_helper_connector_parse_command_line(struct drm_connector *connector,
  69                                                        const char *mode_option)
  70 {
  71         const char *name;
  72         unsigned int namelen;
  73         int res_specified = 0, bpp_specified = 0, refresh_specified = 0;
  74         unsigned int xres = 0, yres = 0, bpp = 32, refresh = 0;
  75         int yres_specified = 0, cvt = 0, rb = 0, interlace = 0, margins = 0;
  76         int i;
  77         enum drm_connector_force force = DRM_FORCE_UNSPECIFIED;
  78         struct drm_fb_helper_connector *fb_help_conn = connector->fb_helper_private;
  79         struct drm_fb_helper_cmdline_mode *cmdline_mode;
  80
  81         if (!fb_help_conn)
  82                 return false;
  83
  84         cmdline_mode = &fb_help_conn->cmdline_mode;
  85         if (!mode_option)
  86                 mode_option = fb_mode_option;
  87
  88         if (!mode_option) {
  89                 cmdline_mode->specified = false;
  90                 return false;
  91         }
  92
  93         name = mode_option;
  94         namelen = strlen(name);
  95         for (i = namelen-1; i >= 0; i--) {
  96                 switch (name[i]) {
  97                 case '@':
  98                         namelen = i;
  99                         if (!refresh_specified && !bpp_specified &&
 100                             !yres_specified) {
 101                                 refresh = simple_strtol(&name[i+1], NULL, 10);
 102                                 refresh_specified = 1;
 103                                 if (cvt || rb)
 104                                         cvt = 0;
 105                         } else
 106                                 goto done;
 107                         break;
 108                 case '-':
 109                         namelen = i;
 110                         if (!bpp_specified && !yres_specified) {
 111                                 bpp = simple_strtol(&name[i+1], NULL, 10);
 112                                 bpp_specified = 1;
 113                                 if (cvt || rb)
 114                                         cvt = 0;
 115                         } else
 116                                 goto done;
 117                         break;
 118                 case 'x':
 119                         if (!yres_specified) {
 120                                 yres = simple_strtol(&name[i+1], NULL, 10);
 121                                 yres_specified = 1;
 122                         } else
 123                                 goto done;
 124                 case '0' ... '9':
 125                         break;
 126                 case 'M':
 127                         if (!yres_specified)
 128                                 cvt = 1;
 129                         break;
 130                 case 'R':
 131                         if (!cvt)
 132                                 rb = 1;
 133                         break;
 134                 case 'm':
 135                         if (!cvt)
 136                                 margins = 1;
 137                         break;
 138                 case 'i':
 139                         if (!cvt)
 140                                 interlace = 1;
 141                         break;
 142                 case 'e':
 143                         force = DRM_FORCE_ON;
 144                         break;
 145                 case 'D':
 146                         if ((connector->connector_type != DRM_MODE_CONNECTOR_DVII) &&
 147                             (connector->connector_type != DRM_MODE_CONNECTOR_HDMIB))
 148                                 force = DRM_FORCE_ON;
 149                         else
 150                                 force = DRM_FORCE_ON_DIGITAL;
 151                         break;
 152                 case 'd':
 153                         force = DRM_FORCE_OFF;
 154                         break;
 155                 default:
 156                         goto done;
 157                 }
 158         }
 159         if (i < 0 && yres_specified) {
 160                 xres = simple_strtol(name, NULL, 10);
 161                 res_specified = 1;
 162         }
 163 done:
 164
 165         DRM_DEBUG_KMS("cmdline mode for connector %s %dx%d@%dHz%s%s%s\n",
 166                 drm_get_connector_name(connector), xres, yres,
 167                 (refresh) ? refresh : 60, (rb) ? " reduced blanking" :
 168                 "", (margins) ? " with margins" : "", (interlace) ?
 169                 " interlaced" : "");
 170
 171         if (force) {
 172                 const char *s;
 173                 switch (force) {
 174                 case DRM_FORCE_OFF: s = "OFF"; break;
 175                 case DRM_FORCE_ON_DIGITAL: s = "ON - dig"; break;
 176                 default:
 177                 case DRM_FORCE_ON: s = "ON"; break;
 178                 }
 179
 180                 DRM_INFO("forcing %s connector %s\n",
 181                          drm_get_connector_name(connector), s);
 182                 connector->force = force;
 183         }
 184
 185         if (res_specified) {
 186                 cmdline_mode->specified = true;
 187                 cmdline_mode->xres = xres;
 188                 cmdline_mode->yres = yres;
 189         }
 190
 191         if (refresh_specified) {
 192                 cmdline_mode->refresh_specified = true;
 193                 cmdline_mode->refresh = refresh;
 194         }
 195
 196         if (bpp_specified) {
 197                 cmdline_mode->bpp_specified = true;
 198                 cmdline_mode->bpp = bpp;
 199         }
 200         cmdline_mode->rb = rb ? true : false;
 201         cmdline_mode->cvt = cvt  ? true : false;
 202         cmdline_mode->interlace = interlace ? true : false;
 203
 204         return true;
 205 }
 206
 207 int drm_fb_helper_parse_command_line(struct drm_device *dev)
 208 {
 209         struct drm_connector *connector;
 210
 211         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 212                 char *option = NULL;
 213
 214                 /* do something on return - turn off connector maybe */
 215                 if (fb_get_options(drm_get_connector_name(connector), &option))
 216                         continue;
 217
 218                 drm_fb_helper_connector_parse_command_line(connector, option);
 219         }
 220         return 0;
 221 }
 222
 223 bool drm_fb_helper_force_kernel_mode(void)
 224 {
 225         int i = 0;
 226         bool ret, error = false;
 227         struct drm_fb_helper *helper;
 228
 229         if (list_empty(&kernel_fb_helper_list))
 230                 return false;
 231
 232         list_for_each_entry(helper, &kernel_fb_helper_list, kernel_fb_list) {
 233                 for (i = 0; i < helper->crtc_count; i++) {
 234                         struct drm_mode_set *mode_set = &helper->crtc_info[i].mode_set;
 235                         ret = drm_crtc_helper_set_config(mode_set);
 236                         if (ret)
 237                                 error = true;
 238                 }
 239         }
 240         return error;
 241 }
 242
 243 int drm_fb_helper_panic(struct notifier_block *n, unsigned long ununsed,
 244                         void *panic_str)
 245 {
 246         DRM_ERROR("panic occurred, switching back to text console\n");
 247         return drm_fb_helper_force_kernel_mode();
 248         return 0;
 249 }
 250 EXPORT_SYMBOL(drm_fb_helper_panic);
 251
 252 static struct notifier_block paniced = {
 253         .notifier_call = drm_fb_helper_panic,
 254 };
 255
 256 /**
 257  * drm_fb_helper_restore - restore the framebuffer console (kernel) config
 258  *
 259  * Restore's the kernel's fbcon mode, used for lastclose & panic paths.
 260  */
 261 void drm_fb_helper_restore(void)
 262 {
 263         bool ret;
 264         ret = drm_fb_helper_force_kernel_mode();
 265         if (ret == true)
 266                 DRM_ERROR("Failed to restore crtc configuration\n");
 267 }
 268 EXPORT_SYMBOL(drm_fb_helper_restore);
 269
 270 #ifdef CONFIG_MAGIC_SYSRQ
 271 static void drm_fb_helper_restore_work_fn(struct work_struct *ignored)
 272 {
 273         drm_fb_helper_restore();
 274 }
 275 static DECLARE_WORK(drm_fb_helper_restore_work, drm_fb_helper_restore_work_fn);
 276
 277 static void drm_fb_helper_sysrq(int dummy1, struct tty_struct *dummy3)
 278 {
 279         schedule_work(&drm_fb_helper_restore_work);
 280 }
 281
 282 static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = {
 283         .handler = drm_fb_helper_sysrq,
 284         .help_msg = "force-fb(V)",
 285         .action_msg = "Restore framebuffer console",
 286 };
 287 #else
 288 static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = { };
 289 #endif
 290
 291 static void drm_fb_helper_on(struct fb_info *info)
 292 {
 293         struct drm_fb_helper *fb_helper = info->par;
 294         struct drm_device *dev = fb_helper->dev;
 295         struct drm_crtc *crtc;
 296         struct drm_encoder *encoder;
 297         int i;
 298
 299         /*
 300          * For each CRTC in this fb, turn the crtc on then,
 301          * find all associated encoders and turn them on.
 302          */
 303         for (i = 0; i < fb_helper->crtc_count; i++) {
 304                 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 305                         struct drm_crtc_helper_funcs *crtc_funcs =
 306                                 crtc->helper_private;
 307
 308                         /* Only mess with CRTCs in this fb */
 309                         if (crtc->base.id != fb_helper->crtc_info[i].crtc_id ||
 310                             !crtc->enabled)
 311                                 continue;
 312
 313                         mutex_lock(&dev->mode_config.mutex);
 314                         crtc_funcs->dpms(crtc, DRM_MODE_DPMS_ON);
 315                         mutex_unlock(&dev->mode_config.mutex);
 316
 317                         /* Found a CRTC on this fb, now find encoders */
 318                         list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
 319                                 if (encoder->crtc == crtc) {
 320                                         struct drm_encoder_helper_funcs *encoder_funcs;
 321
 322                                         encoder_funcs = encoder->helper_private;
 323                                         mutex_lock(&dev->mode_config.mutex);
 324                                         encoder_funcs->dpms(encoder, DRM_MODE_DPMS_ON);
 325                                         mutex_unlock(&dev->mode_config.mutex);
 326                                 }
 327                         }
 328                 }
 329         }
 330 }
 331
 332 static void drm_fb_helper_off(struct fb_info *info, int dpms_mode)
 333 {
 334         struct drm_fb_helper *fb_helper = info->par;
 335         struct drm_device *dev = fb_helper->dev;
 336         struct drm_crtc *crtc;
 337         struct drm_encoder *encoder;
 338         int i;
 339
 340         /*
 341          * For each CRTC in this fb, find all associated encoders
 342          * and turn them off, then turn off the CRTC.
 343          */
 344         for (i = 0; i < fb_helper->crtc_count; i++) {
 345                 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 346                         struct drm_crtc_helper_funcs *crtc_funcs =
 347                                 crtc->helper_private;
 348
 349                         /* Only mess with CRTCs in this fb */
 350                         if (crtc->base.id != fb_helper->crtc_info[i].crtc_id ||
 351                             !crtc->enabled)
 352                                 continue;
 353
 354                         /* Found a CRTC on this fb, now find encoders */
 355                         list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
 356                                 if (encoder->crtc == crtc) {
 357                                         struct drm_encoder_helper_funcs *encoder_funcs;
 358
 359                                         encoder_funcs = encoder->helper_private;
 360                                         mutex_lock(&dev->mode_config.mutex);
 361                                         encoder_funcs->dpms(encoder, dpms_mode);
 362                                         mutex_unlock(&dev->mode_config.mutex);
 363                                 }
 364                         }
 365                         mutex_lock(&dev->mode_config.mutex);
 366                         crtc_funcs->dpms(crtc, DRM_MODE_DPMS_OFF);
 367                         mutex_unlock(&dev->mode_config.mutex);
 368                 }
 369         }
 370 }
 371
 372 int drm_fb_helper_blank(int blank, struct fb_info *info)
 373 {
 374         switch (blank) {
 375         /* Display: On; HSync: On, VSync: On */
 376         case FB_BLANK_UNBLANK:
 377                 drm_fb_helper_on(info);
 378                 break;
 379         /* Display: Off; HSync: On, VSync: On */
 380         case FB_BLANK_NORMAL:
 381                 drm_fb_helper_off(info, DRM_MODE_DPMS_STANDBY);
 382                 break;
 383         /* Display: Off; HSync: Off, VSync: On */
 384         case FB_BLANK_HSYNC_SUSPEND:
 385                 drm_fb_helper_off(info, DRM_MODE_DPMS_STANDBY);
 386                 break;
 387         /* Display: Off; HSync: On, VSync: Off */
 388         case FB_BLANK_VSYNC_SUSPEND:
 389                 drm_fb_helper_off(info, DRM_MODE_DPMS_SUSPEND);
 390                 break;
 391         /* Display: Off; HSync: Off, VSync: Off */
 392         case FB_BLANK_POWERDOWN:
 393                 drm_fb_helper_off(info, DRM_MODE_DPMS_OFF);
 394                 break;
 395         }
 396         return 0;
 397 }
 398 EXPORT_SYMBOL(drm_fb_helper_blank);
 399
 400 static void drm_fb_helper_crtc_free(struct drm_fb_helper *helper)
 401 {
 402         int i;
 403
 404         for (i = 0; i < helper->crtc_count; i++)
 405                 kfree(helper->crtc_info[i].mode_set.connectors);
 406         kfree(helper->crtc_info);
 407 }
 408
 409 int drm_fb_helper_init_crtc_count(struct drm_fb_helper *helper, int crtc_count, int max_conn_count)
 410 {
 411         struct drm_device *dev = helper->dev;
 412         struct drm_crtc *crtc;
 413         int ret = 0;
 414         int i;
 415
 416         helper->crtc_info = kcalloc(crtc_count, sizeof(struct drm_fb_helper_crtc), GFP_KERNEL);
 417         if (!helper->crtc_info)
 418                 return -ENOMEM;
 419
 420         helper->crtc_count = crtc_count;
 421
 422         for (i = 0; i < crtc_count; i++) {
 423                 helper->crtc_info[i].mode_set.connectors =
 424                         kcalloc(max_conn_count,
 425                                 sizeof(struct drm_connector *),
 426                                 GFP_KERNEL);
 427
 428                 if (!helper->crtc_info[i].mode_set.connectors) {
 429                         ret = -ENOMEM;
 430                         goto out_free;
 431                 }
 432                 helper->crtc_info[i].mode_set.num_connectors = 0;
 433         }
 434
 435         i = 0;
 436         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 437                 helper->crtc_info[i].crtc_id = crtc->base.id;
 438                 helper->crtc_info[i].mode_set.crtc = crtc;
 439                 i++;
 440         }
 441         helper->conn_limit = max_conn_count;
 442         return 0;
 443 out_free:
 444         drm_fb_helper_crtc_free(helper);
 445         return -ENOMEM;
 446 }
 447 EXPORT_SYMBOL(drm_fb_helper_init_crtc_count);
 448
 449 static int setcolreg(struct drm_crtc *crtc, u16 red, u16 green,
 450                      u16 blue, u16 regno, struct fb_info *info)
 451 {
 452         struct drm_fb_helper *fb_helper = info->par;
 453         struct drm_framebuffer *fb = fb_helper->fb;
 454         int pindex;
 455
 456         if (info->fix.visual == FB_VISUAL_TRUECOLOR) {
 457                 u32 *palette;
 458                 u32 value;
 459                 /* place color in psuedopalette */
 460                 if (regno > 16)
 461                         return -EINVAL;
 462                 palette = (u32 *)info->pseudo_palette;
 463                 red >>= (16 - info->var.red.length);
 464                 green >>= (16 - info->var.green.length);
 465                 blue >>= (16 - info->var.blue.length);
 466                 value = (red << info->var.red.offset) |
 467                         (green << info->var.green.offset) |
 468                         (blue << info->var.blue.offset);
 469                 palette[regno] = value;
 470                 return 0;
 471         }
 472
 473         pindex = regno;
 474
 475         if (fb->bits_per_pixel == 16) {
 476                 pindex = regno << 3;
 477
 478                 if (fb->depth == 16 && regno > 63)
 479                         return -EINVAL;
 480                 if (fb->depth == 15 && regno > 31)
 481                         return -EINVAL;
 482
 483                 if (fb->depth == 16) {
 484                         u16 r, g, b;
 485                         int i;
 486                         if (regno < 32) {
 487                                 for (i = 0; i < 8; i++)
 488                                         fb_helper->funcs->gamma_set(crtc, red,
 489                                                 green, blue, pindex + i);
 490                         }
 491
 492                         fb_helper->funcs->gamma_get(crtc, &r,
 493                                                     &g, &b,
 494                                                     pindex >> 1);
 495
 496                         for (i = 0; i < 4; i++)
 497                                 fb_helper->funcs->gamma_set(crtc, r,
 498                                                             green, b,
 499                                                             (pindex >> 1) + i);
 500                 }
 501         }
 502
 503         if (fb->depth != 16)
 504                 fb_helper->funcs->gamma_set(crtc, red, green, blue, pindex);
 505         return 0;
 506 }
 507
 508 int drm_fb_helper_setcmap(struct fb_cmap *cmap, struct fb_info *info)
 509 {
 510         struct drm_fb_helper *fb_helper = info->par;
 511         struct drm_device *dev = fb_helper->dev;
 512         u16 *red, *green, *blue, *transp;
 513         struct drm_crtc *crtc;
 514         int i, rc = 0;
 515         int start;
 516
 517         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 518                 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
 519                 for (i = 0; i < fb_helper->crtc_count; i++) {
 520                         if (crtc->base.id == fb_helper->crtc_info[i].crtc_id)
 521                                 break;
 522                 }
 523                 if (i == fb_helper->crtc_count)
 524                         continue;
 525
 526                 red = cmap->red;
 527                 green = cmap->green;
 528                 blue = cmap->blue;
 529                 transp = cmap->transp;
 530                 start = cmap->start;
 531
 532                 for (i = 0; i < cmap->len; i++) {
 533                         u16 hred, hgreen, hblue, htransp = 0xffff;
 534
 535                         hred = *red++;
 536                         hgreen = *green++;
 537                         hblue = *blue++;
 538
 539                         if (transp)
 540                                 htransp = *transp++;
 541
 542                         rc = setcolreg(crtc, hred, hgreen, hblue, start++, info);
 543                         if (rc)
 544                                 return rc;
 545                 }
 546                 crtc_funcs->load_lut(crtc);
 547         }
 548         return rc;
 549 }
 550 EXPORT_SYMBOL(drm_fb_helper_setcmap);
 551
 552 int drm_fb_helper_setcolreg(unsigned regno,
 553                             unsigned red,
 554                             unsigned green,
 555                             unsigned blue,
 556                             unsigned transp,
 557                             struct fb_info *info)
 558 {
 559         struct drm_fb_helper *fb_helper = info->par;
 560         struct drm_device *dev = fb_helper->dev;
 561         struct drm_crtc *crtc;
 562         int i;
 563         int ret;
 564
 565         if (regno > 255)
 566                 return 1;
 567
 568         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 569                 struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
 570                 for (i = 0; i < fb_helper->crtc_count; i++) {
 571                         if (crtc->base.id == fb_helper->crtc_info[i].crtc_id)
 572                                 break;
 573                 }
 574                 if (i == fb_helper->crtc_count)
 575                         continue;
 576
 577                 ret = setcolreg(crtc, red, green, blue, regno, info);
 578                 if (ret)
 579                         return ret;
 580
 581                 crtc_funcs->load_lut(crtc);
 582         }
 583         return 0;
 584 }
 585 EXPORT_SYMBOL(drm_fb_helper_setcolreg);
 586
 587 int drm_fb_helper_check_var(struct fb_var_screeninfo *var,
 588                             struct fb_info *info)
 589 {
 590         struct drm_fb_helper *fb_helper = info->par;
 591         struct drm_framebuffer *fb = fb_helper->fb;
 592         int depth;
 593
 594         if (var->pixclock != 0)
 595                 return -EINVAL;
 596
 597         /* Need to resize the fb object !!! */
 598         if (var->bits_per_pixel > fb->bits_per_pixel || var->xres > fb->width || var->yres > fb->height) {
 599                 DRM_DEBUG("fb userspace requested width/height/bpp is greater than current fb "
 600                           "object %dx%d-%d > %dx%d-%d\n", var->xres, var->yres, var->bits_per_pixel,
 601                           fb->width, fb->height, fb->bits_per_pixel);
 602                 return -EINVAL;
 603         }
 604
 605         switch (var->bits_per_pixel) {
 606         case 16:
 607                 depth = (var->green.length == 6) ? 16 : 15;
 608                 break;
 609         case 32:
 610                 depth = (var->transp.length > 0) ? 32 : 24;
 611                 break;
 612         default:
 613                 depth = var->bits_per_pixel;
 614                 break;
 615         }
 616
 617         switch (depth) {
 618         case 8:
 619                 var->red.offset = 0;
 620                 var->green.offset = 0;
 621                 var->blue.offset = 0;
 622                 var->red.length = 8;
 623                 var->green.length = 8;
 624                 var->blue.length = 8;
 625                 var->transp.length = 0;
 626                 var->transp.offset = 0;
 627                 break;
 628         case 15:
 629                 var->red.offset = 10;
 630                 var->green.offset = 5;
 631                 var->blue.offset = 0;
 632                 var->red.length = 5;
 633                 var->green.length = 5;
 634                 var->blue.length = 5;
 635                 var->transp.length = 1;
 636                 var->transp.offset = 15;
 637                 break;
 638         case 16:
 639                 var->red.offset = 11;
 640                 var->green.offset = 5;
 641                 var->blue.offset = 0;
 642                 var->red.length = 5;
 643                 var->green.length = 6;
 644                 var->blue.length = 5;
 645                 var->transp.length = 0;
 646                 var->transp.offset = 0;
 647                 break;
 648         case 24:
 649                 var->red.offset = 16;
 650                 var->green.offset = 8;
 651                 var->blue.offset = 0;
 652                 var->red.length = 8;
 653                 var->green.length = 8;
 654                 var->blue.length = 8;
 655                 var->transp.length = 0;
 656                 var->transp.offset = 0;
 657                 break;
 658         case 32:
 659                 var->red.offset = 16;
 660                 var->green.offset = 8;
 661                 var->blue.offset = 0;
 662                 var->red.length = 8;
 663                 var->green.length = 8;
 664                 var->blue.length = 8;
 665                 var->transp.length = 8;
 666                 var->transp.offset = 24;
 667                 break;
 668         default:
 669                 return -EINVAL;
 670         }
 671         return 0;
 672 }
 673 EXPORT_SYMBOL(drm_fb_helper_check_var);
 674
 675 /* this will let fbcon do the mode init */
 676 int drm_fb_helper_set_par(struct fb_info *info)
 677 {
 678         struct drm_fb_helper *fb_helper = info->par;
 679         struct drm_device *dev = fb_helper->dev;
 680         struct fb_var_screeninfo *var = &info->var;
 681         struct drm_crtc *crtc;
 682         int ret;
 683         int i;
 684
 685         if (var->pixclock != 0) {
 686                 DRM_ERROR("PIXEL CLOCK SET\n");
 687                 return -EINVAL;
 688         }
 689
 690         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 691
 692                 for (i = 0; i < fb_helper->crtc_count; i++) {
 693                         if (crtc->base.id == fb_helper->crtc_info[i].crtc_id)
 694                                 break;
 695                 }
 696                 if (i == fb_helper->crtc_count)
 697                         continue;
 698
 699                 if (crtc->fb == fb_helper->crtc_info[i].mode_set.fb) {
 700                         mutex_lock(&dev->mode_config.mutex);
 701                         ret = crtc->funcs->set_config(&fb_helper->crtc_info[i].mode_set);
 702                         mutex_unlock(&dev->mode_config.mutex);
 703                         if (ret)
 704                                 return ret;
 705                 }
 706         }
 707         return 0;
 708 }
 709 EXPORT_SYMBOL(drm_fb_helper_set_par);
 710
 711 int drm_fb_helper_pan_display(struct fb_var_screeninfo *var,
 712                               struct fb_info *info)
 713 {
 714         struct drm_fb_helper *fb_helper = info->par;
 715         struct drm_device *dev = fb_helper->dev;
 716         struct drm_mode_set *modeset;
 717         struct drm_crtc *crtc;
 718         int ret = 0;
 719         int i;
 720
 721         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 722                 for (i = 0; i < fb_helper->crtc_count; i++) {
 723                         if (crtc->base.id == fb_helper->crtc_info[i].crtc_id)
 724                                 break;
 725                 }
 726
 727                 if (i == fb_helper->crtc_count)
 728                         continue;
 729
 730                 modeset = &fb_helper->crtc_info[i].mode_set;
 731
 732                 modeset->x = var->xoffset;
 733                 modeset->y = var->yoffset;
 734
 735                 if (modeset->num_connectors) {
 736                         mutex_lock(&dev->mode_config.mutex);
 737                         ret = crtc->funcs->set_config(modeset);
 738                         mutex_unlock(&dev->mode_config.mutex);
 739                         if (!ret) {
 740                                 info->var.xoffset = var->xoffset;
 741                                 info->var.yoffset = var->yoffset;
 742                         }
 743                 }
 744         }
 745         return ret;
 746 }
 747 EXPORT_SYMBOL(drm_fb_helper_pan_display);
 748
 749 int drm_fb_helper_single_fb_probe(struct drm_device *dev,
 750                                   int preferred_bpp,
 751                                   int (*fb_create)(struct drm_device *dev,
 752                                                    uint32_t fb_width,
 753                                                    uint32_t fb_height,
 754                                                    uint32_t surface_width,
 755                                                    uint32_t surface_height,
 756                                                    uint32_t surface_depth,
 757                                                    uint32_t surface_bpp,
 758                                                    struct drm_framebuffer **fb_ptr))
 759 {
 760         struct drm_crtc *crtc;
 761         struct drm_connector *connector;
 762         unsigned int fb_width = (unsigned)-1, fb_height = (unsigned)-1;
 763         unsigned int surface_width = 0, surface_height = 0;
 764         int new_fb = 0;
 765         int crtc_count = 0;
 766         int ret, i, conn_count = 0;
 767         struct fb_info *info;
 768         struct drm_framebuffer *fb;
 769         struct drm_mode_set *modeset = NULL;
 770         struct drm_fb_helper *fb_helper;
 771         uint32_t surface_depth = 24, surface_bpp = 32;
 772
 773         /* if driver picks 8 or 16 by default use that
 774            for both depth/bpp */
 775         if (preferred_bpp != surface_bpp) {
 776                 surface_depth = surface_bpp = preferred_bpp;
 777         }
 778         /* first up get a count of crtcs now in use and new min/maxes width/heights */
 779         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 780                 struct drm_fb_helper_connector *fb_help_conn = connector->fb_helper_private;
 781
 782                 struct drm_fb_helper_cmdline_mode *cmdline_mode;
 783
 784                 if (!fb_help_conn)
 785                         continue;
 786
 787                 cmdline_mode = &fb_help_conn->cmdline_mode;
 788
 789                 if (cmdline_mode->bpp_specified) {
 790                         switch (cmdline_mode->bpp) {
 791                         case 8:
 792                                 surface_depth = surface_bpp = 8;
 793                                 break;
 794                         case 15:
 795                                 surface_depth = 15;
 796                                 surface_bpp = 16;
 797                                 break;
 798                         case 16:
 799                                 surface_depth = surface_bpp = 16;
 800                                 break;
 801                         case 24:
 802                                 surface_depth = surface_bpp = 24;
 803                                 break;
 804                         case 32:
 805                                 surface_depth = 24;
 806                                 surface_bpp = 32;
 807                                 break;
 808                         }
 809                         break;
 810                 }
 811         }
 812
 813         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 814                 if (drm_helper_crtc_in_use(crtc)) {
 815                         if (crtc->desired_mode) {
 816                                 if (crtc->desired_mode->hdisplay < fb_width)
 817                                         fb_width = crtc->desired_mode->hdisplay;
 818
 819                                 if (crtc->desired_mode->vdisplay < fb_height)
 820                                         fb_height = crtc->desired_mode->vdisplay;
 821
 822                                 if (crtc->desired_mode->hdisplay > surface_width)
 823                                         surface_width = crtc->desired_mode->hdisplay;
 824
 825                                 if (crtc->desired_mode->vdisplay > surface_height)
 826                                         surface_height = crtc->desired_mode->vdisplay;
 827                         }
 828                         crtc_count++;
 829                 }
 830         }
 831
 832         if (crtc_count == 0 || fb_width == -1 || fb_height == -1) {
 833                 /* hmm everyone went away - assume VGA cable just fell out
 834                    and will come back later. */
 835                 return 0;
 836         }
 837
 838         /* do we have an fb already? */
 839         if (list_empty(&dev->mode_config.fb_kernel_list)) {
 840                 ret = (*fb_create)(dev, fb_width, fb_height, surface_width,
 841                                    surface_height, surface_depth, surface_bpp,
 842                                    &fb);
 843                 if (ret)
 844                         return -EINVAL;
 845                 new_fb = 1;
 846         } else {
 847                 fb = list_first_entry(&dev->mode_config.fb_kernel_list,
 848                                       struct drm_framebuffer, filp_head);
 849
 850                 /* if someone hotplugs something bigger than we have already allocated, we are pwned.
 851                    As really we can't resize an fbdev that is in the wild currently due to fbdev
 852                    not really being designed for the lower layers moving stuff around under it.
 853                    - so in the grand style of things - punt. */
 854                 if ((fb->width < surface_width) ||
 855                     (fb->height < surface_height)) {
 856                         DRM_ERROR("Framebuffer not large enough to scale console onto.\n");
 857                         return -EINVAL;
 858                 }
 859         }
 860
 861         info = fb->fbdev;
 862         fb_helper = info->par;
 863
 864         crtc_count = 0;
 865         /* okay we need to setup new connector sets in the crtcs */
 866         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 867                 modeset = &fb_helper->crtc_info[crtc_count].mode_set;
 868                 modeset->fb = fb;
 869                 conn_count = 0;
 870                 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 871                         if (connector->encoder)
 872                                 if (connector->encoder->crtc == modeset->crtc) {
 873                                         modeset->connectors[conn_count] = connector;
 874                                         conn_count++;
 875                                         if (conn_count > fb_helper->conn_limit)
 876                                                 BUG();
 877                                 }
 878                 }
 879
 880                 for (i = conn_count; i < fb_helper->conn_limit; i++)
 881                         modeset->connectors[i] = NULL;
 882
 883                 modeset->crtc = crtc;
 884                 crtc_count++;
 885
 886                 modeset->num_connectors = conn_count;
 887                 if (modeset->crtc->desired_mode) {
 888                         if (modeset->mode)
 889                                 drm_mode_destroy(dev, modeset->mode);
 890                         modeset->mode = drm_mode_duplicate(dev,
 891                                                            modeset->crtc->desired_mode);
 892                 }
 893         }
 894         fb_helper->crtc_count = crtc_count;
 895         fb_helper->fb = fb;
 896
 897         if (new_fb) {
 898                 info->var.pixclock = 0;
 899                 ret = fb_alloc_cmap(&info->cmap, modeset->crtc->gamma_size, 0);
 900                 if (ret)
 901                         return ret;
 902                 if (register_framebuffer(info) < 0) {
 903                         fb_dealloc_cmap(&info->cmap);
 904                         return -EINVAL;
 905                 }
 906         } else {
 907                 drm_fb_helper_set_par(info);
 908         }
 909         printk(KERN_INFO "fb%d: %s frame buffer device\n", info->node,
 910                info->fix.id);
 911
 912         /* Switch back to kernel console on panic */
 913         /* multi card linked list maybe */
 914         if (list_empty(&kernel_fb_helper_list)) {
 915                 printk(KERN_INFO "registered panic notifier\n");
 916                 atomic_notifier_chain_register(&panic_notifier_list,
 917                                                &paniced);
 918                 register_sysrq_key('v', &sysrq_drm_fb_helper_restore_op);
 919         }
 920         list_add(&fb_helper->kernel_fb_list, &kernel_fb_helper_list);
 921         return 0;
 922 }
 923 EXPORT_SYMBOL(drm_fb_helper_single_fb_probe);
 924
 925 void drm_fb_helper_free(struct drm_fb_helper *helper)
 926 {
 927         list_del(&helper->kernel_fb_list);
 928         if (list_empty(&kernel_fb_helper_list)) {
 929                 printk(KERN_INFO "unregistered panic notifier\n");
 930                 atomic_notifier_chain_unregister(&panic_notifier_list,
 931                                                  &paniced);
 932                 unregister_sysrq_key('v', &sysrq_drm_fb_helper_restore_op);
 933         }
 934         drm_fb_helper_crtc_free(helper);
 935         fb_dealloc_cmap(&helper->fb->fbdev->cmap);
 936 }
 937 EXPORT_SYMBOL(drm_fb_helper_free);
 938
 939 void drm_fb_helper_fill_fix(struct fb_info *info, uint32_t pitch,
 940                             uint32_t depth)
 941 {
 942         info->fix.type = FB_TYPE_PACKED_PIXELS;
 943         info->fix.visual = depth == 8 ? FB_VISUAL_PSEUDOCOLOR :
 944                 FB_VISUAL_TRUECOLOR;
 945         info->fix.type_aux = 0;
 946         info->fix.xpanstep = 1; /* doing it in hw */
 947         info->fix.ypanstep = 1; /* doing it in hw */
 948         info->fix.ywrapstep = 0;
 949         info->fix.accel = FB_ACCEL_NONE;
 950         info->fix.type_aux = 0;
 951
 952         info->fix.line_length = pitch;
 953         return;
 954 }
 955 EXPORT_SYMBOL(drm_fb_helper_fill_fix);
 956
 957 void drm_fb_helper_fill_var(struct fb_info *info, struct drm_framebuffer *fb,
 958                             uint32_t fb_width, uint32_t fb_height)
 959 {
 960         info->pseudo_palette = fb->pseudo_palette;
 961         info->var.xres_virtual = fb->width;
 962         info->var.yres_virtual = fb->height;
 963         info->var.bits_per_pixel = fb->bits_per_pixel;
 964         info->var.xoffset = 0;
 965         info->var.yoffset = 0;
 966         info->var.activate = FB_ACTIVATE_NOW;
 967         info->var.height = -1;
 968         info->var.width = -1;
 969
 970         switch (fb->depth) {
 971         case 8:
 972                 info->var.red.offset = 0;
 973                 info->var.green.offset = 0;
 974                 info->var.blue.offset = 0;
 975                 info->var.red.length = 8; /* 8bit DAC */
 976                 info->var.green.length = 8;
 977                 info->var.blue.length = 8;
 978                 info->var.transp.offset = 0;
 979                 info->var.transp.length = 0;
 980                 break;
 981         case 15:
 982                 info->var.red.offset = 10;
 983                 info->var.green.offset = 5;
 984                 info->var.blue.offset = 0;
 985                 info->var.red.length = 5;
 986                 info->var.green.length = 5;
 987                 info->var.blue.length = 5;
 988                 info->var.transp.offset = 15;
 989                 info->var.transp.length = 1;
 990                 break;
 991         case 16:
 992                 info->var.red.offset = 11;
 993                 info->var.green.offset = 5;
 994                 info->var.blue.offset = 0;
 995                 info->var.red.length = 5;
 996                 info->var.green.length = 6;
 997                 info->var.blue.length = 5;
 998                 info->var.transp.offset = 0;
 999                 break;
1000         case 24:
1001                 info->var.red.offset = 16;
1002                 info->var.green.offset = 8;
1003                 info->var.blue.offset = 0;
1004                 info->var.red.length = 8;
1005                 info->var.green.length = 8;
1006                 info->var.blue.length = 8;
1007                 info->var.transp.offset = 0;
1008                 info->var.transp.length = 0;
1009                 break;
1010         case 32:
1011                 info->var.red.offset = 16;
1012                 info->var.green.offset = 8;
1013                 info->var.blue.offset = 0;
1014                 info->var.red.length = 8;
1015                 info->var.green.length = 8;
1016                 info->var.blue.length = 8;
1017                 info->var.transp.offset = 24;
1018                 info->var.transp.length = 8;
1019                 break;
1020         default:
1021                 break;
1022         }
1023
1024         info->var.xres = fb_width;
1025         info->var.yres = fb_height;
1026 }
1027 EXPORT_SYMBOL(drm_fb_helper_fill_var);