drivers/gpu/drm/cirrus/cirrus_mode.c

   1
   2 /*
   3  * Copyright 2012 Red Hat
   4  *
   5  * This file is subject to the terms and conditions of the GNU General
   6  * Public License version 2. See the file COPYING in the main
   7  * directory of this archive for more details.
   8  *
   9  * Authors: Matthew Garrett
  10  *          Dave Airlie
  11  *
  12  * Portions of this code derived from cirrusfb.c:
  13  * drivers/video/cirrusfb.c - driver for Cirrus Logic chipsets
  14  *
  15  * Copyright 1999-2001 Jeff Garzik <jgarzik@pobox.com>
  16  */
  17 #include <drm/drmP.h>
  18 #include <drm/drm_crtc_helper.h>
  19
  20 #include <video/cirrus.h>
  21
  22 #include "cirrus_drv.h"
  23
  24 #define CIRRUS_LUT_SIZE 256
  25
  26 #define PALETTE_INDEX 0x8
  27 #define PALETTE_DATA 0x9
  28
  29 /*
  30  * This file contains setup code for the CRTC.
  31  */
  32
  33 static void cirrus_crtc_load_lut(struct drm_crtc *crtc)
  34 {
  35         struct cirrus_crtc *cirrus_crtc = to_cirrus_crtc(crtc);
  36         struct drm_device *dev = crtc->dev;
  37         struct cirrus_device *cdev = dev->dev_private;
  38         int i;
  39
  40         if (!crtc->enabled)
  41                 return;
  42
  43         for (i = 0; i < CIRRUS_LUT_SIZE; i++) {
  44                 /* VGA registers */
  45                 WREG8(PALETTE_INDEX, i);
  46                 WREG8(PALETTE_DATA, cirrus_crtc->lut_r[i]);
  47                 WREG8(PALETTE_DATA, cirrus_crtc->lut_g[i]);
  48                 WREG8(PALETTE_DATA, cirrus_crtc->lut_b[i]);
  49         }
  50 }
  51
  52 /*
  53  * The DRM core requires DPMS functions, but they make little sense in our
  54  * case and so are just stubs
  55  */
  56
  57 static void cirrus_crtc_dpms(struct drm_crtc *crtc, int mode)
  58 {
  59         struct drm_device *dev = crtc->dev;
  60         struct cirrus_device *cdev = dev->dev_private;
  61         u8 sr01, gr0e;
  62
  63         switch (mode) {
  64         case DRM_MODE_DPMS_ON:
  65                 sr01 = 0x00;
  66                 gr0e = 0x00;
  67                 break;
  68         case DRM_MODE_DPMS_STANDBY:
  69                 sr01 = 0x20;
  70                 gr0e = 0x02;
  71                 break;
  72         case DRM_MODE_DPMS_SUSPEND:
  73                 sr01 = 0x20;
  74                 gr0e = 0x04;
  75                 break;
  76         case DRM_MODE_DPMS_OFF:
  77                 sr01 = 0x20;
  78                 gr0e = 0x06;
  79                 break;
  80         default:
  81                 return;
  82         }
  83
  84         WREG8(SEQ_INDEX, 0x1);
  85         sr01 |= RREG8(SEQ_DATA) & ~0x20;
  86         WREG_SEQ(0x1, sr01);
  87
  88         WREG8(GFX_INDEX, 0xe);
  89         gr0e |= RREG8(GFX_DATA) & ~0x06;
  90         WREG_GFX(0xe, gr0e);
  91 }
  92
  93 /*
  94  * The core passes the desired mode to the CRTC code to see whether any
  95  * CRTC-specific modifications need to be made to it. We're in a position
  96  * to just pass that straight through, so this does nothing
  97  */
  98 static bool cirrus_crtc_mode_fixup(struct drm_crtc *crtc,
  99                                    const struct drm_display_mode *mode,
 100                                    struct drm_display_mode *adjusted_mode)
 101 {
 102         return true;
 103 }
 104
 105 void cirrus_set_start_address(struct drm_crtc *crtc, unsigned offset)
 106 {
 107         struct cirrus_device *cdev = crtc->dev->dev_private;
 108         u32 addr;
 109         u8 tmp;
 110
 111         addr = offset >> 2;
 112         WREG_CRT(0x0c, (u8)((addr >> 8) & 0xff));
 113         WREG_CRT(0x0d, (u8)(addr & 0xff));
 114
 115         WREG8(CRT_INDEX, 0x1b);
 116         tmp = RREG8(CRT_DATA);
 117         tmp &= 0xf2;
 118         tmp |= (addr >> 16) & 0x01;
 119         tmp |= (addr >> 15) & 0x0c;
 120         WREG_CRT(0x1b, tmp);
 121         WREG8(CRT_INDEX, 0x1d);
 122         tmp = RREG8(CRT_DATA);
 123         tmp &= 0x7f;
 124         tmp |= (addr >> 12) & 0x80;
 125         WREG_CRT(0x1d, tmp);
 126 }
 127
 128 /* cirrus is different - we will force move buffers out of VRAM */
 129 static int cirrus_crtc_do_set_base(struct drm_crtc *crtc,
 130                                 struct drm_framebuffer *fb,
 131                                 int x, int y, int atomic)
 132 {
 133         struct cirrus_device *cdev = crtc->dev->dev_private;
 134         struct drm_gem_object *obj;
 135         struct cirrus_framebuffer *cirrus_fb;
 136         struct cirrus_bo *bo;
 137         int ret;
 138         u64 gpu_addr;
 139
 140         /* push the previous fb to system ram */
 141         if (!atomic && fb) {
 142                 cirrus_fb = to_cirrus_framebuffer(fb);
 143                 obj = cirrus_fb->obj;
 144                 bo = gem_to_cirrus_bo(obj);
 145                 ret = cirrus_bo_reserve(bo, false);
 146                 if (ret)
 147                         return ret;
 148                 cirrus_bo_push_sysram(bo);
 149                 cirrus_bo_unreserve(bo);
 150         }
 151
 152         cirrus_fb = to_cirrus_framebuffer(crtc->fb);
 153         obj = cirrus_fb->obj;
 154         bo = gem_to_cirrus_bo(obj);
 155
 156         ret = cirrus_bo_reserve(bo, false);
 157         if (ret)
 158                 return ret;
 159
 160         ret = cirrus_bo_pin(bo, TTM_PL_FLAG_VRAM, &gpu_addr);
 161         if (ret) {
 162                 cirrus_bo_unreserve(bo);
 163                 return ret;
 164         }
 165
 166         if (&cdev->mode_info.gfbdev->gfb == cirrus_fb) {
 167                 /* if pushing console in kmap it */
 168                 ret = ttm_bo_kmap(&bo->bo, 0, bo->bo.num_pages, &bo->kmap);
 169                 if (ret)
 170                         DRM_ERROR("failed to kmap fbcon\n");
 171         }
 172         cirrus_bo_unreserve(bo);
 173
 174         cirrus_set_start_address(crtc, (u32)gpu_addr);
 175         return 0;
 176 }
 177
 178 static int cirrus_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
 179                              struct drm_framebuffer *old_fb)
 180 {
 181         return cirrus_crtc_do_set_base(crtc, old_fb, x, y, 0);
 182 }
 183
 184 /*
 185  * The meat of this driver. The core passes us a mode and we have to program
 186  * it. The modesetting here is the bare minimum required to satisfy the qemu
 187  * emulation of this hardware, and running this against a real device is
 188  * likely to result in an inadequately programmed mode. We've already had
 189  * the opportunity to modify the mode, so whatever we receive here should
 190  * be something that can be correctly programmed and displayed
 191  */
 192 static int cirrus_crtc_mode_set(struct drm_crtc *crtc,
 193                                 struct drm_display_mode *mode,
 194                                 struct drm_display_mode *adjusted_mode,
 195                                 int x, int y, struct drm_framebuffer *old_fb)
 196 {
 197         struct drm_device *dev = crtc->dev;
 198         struct cirrus_device *cdev = dev->dev_private;
 199         int hsyncstart, hsyncend, htotal, hdispend;
 200         int vtotal, vdispend;
 201         int tmp;
 202         int sr07 = 0, hdr = 0;
 203
 204         htotal = mode->htotal / 8;
 205         hsyncend = mode->hsync_end / 8;
 206         hsyncstart = mode->hsync_start / 8;
 207         hdispend = mode->hdisplay / 8;
 208
 209         vtotal = mode->vtotal;
 210         vdispend = mode->vdisplay;
 211
 212         vdispend -= 1;
 213         vtotal -= 2;
 214
 215         htotal -= 5;
 216         hdispend -= 1;
 217         hsyncstart += 1;
 218         hsyncend += 1;
 219
 220         WREG_CRT(VGA_CRTC_V_SYNC_END, 0x20);
 221         WREG_CRT(VGA_CRTC_H_TOTAL, htotal);
 222         WREG_CRT(VGA_CRTC_H_DISP, hdispend);
 223         WREG_CRT(VGA_CRTC_H_SYNC_START, hsyncstart);
 224         WREG_CRT(VGA_CRTC_H_SYNC_END, hsyncend);
 225         WREG_CRT(VGA_CRTC_V_TOTAL, vtotal & 0xff);
 226         WREG_CRT(VGA_CRTC_V_DISP_END, vdispend & 0xff);
 227
 228         tmp = 0x40;
 229         if ((vdispend + 1) & 512)
 230                 tmp |= 0x20;
 231         WREG_CRT(VGA_CRTC_MAX_SCAN, tmp);
 232
 233         /*
 234          * Overflow bits for values that don't fit in the standard registers
 235          */
 236         tmp = 16;
 237         if (vtotal & 256)
 238                 tmp |= 1;
 239         if (vdispend & 256)
 240                 tmp |= 2;
 241         if ((vdispend + 1) & 256)
 242                 tmp |= 8;
 243         if (vtotal & 512)
 244                 tmp |= 32;
 245         if (vdispend & 512)
 246                 tmp |= 64;
 247         WREG_CRT(VGA_CRTC_OVERFLOW, tmp);
 248
 249         tmp = 0;
 250
 251         /* More overflow bits */
 252
 253         if ((htotal + 5) & 64)
 254                 tmp |= 16;
 255         if ((htotal + 5) & 128)
 256                 tmp |= 32;
 257         if (vtotal & 256)
 258                 tmp |= 64;
 259         if (vtotal & 512)
 260                 tmp |= 128;
 261
 262         WREG_CRT(CL_CRT1A, tmp);
 263
 264         /* Disable Hercules/CGA compatibility */
 265         WREG_CRT(VGA_CRTC_MODE, 0x03);
 266
 267         WREG8(SEQ_INDEX, 0x7);
 268         sr07 = RREG8(SEQ_DATA);
 269         sr07 &= 0xe0;
 270         hdr = 0;
 271         switch (crtc->fb->bits_per_pixel) {
 272         case 8:
 273                 sr07 |= 0x11;
 274                 break;
 275         case 16:
 276                 sr07 |= 0xc1;
 277                 hdr = 0xc0;
 278                 break;
 279         case 24:
 280                 sr07 |= 0x15;
 281                 hdr = 0xc5;
 282                 break;
 283         case 32:
 284                 sr07 |= 0x19;
 285                 hdr = 0xc5;
 286                 break;
 287         default:
 288                 return -1;
 289         }
 290
 291         WREG_SEQ(0x7, sr07);
 292
 293         /* Program the pitch */
 294         tmp = crtc->fb->pitches[0] / 8;
 295         WREG_CRT(VGA_CRTC_OFFSET, tmp);
 296
 297         /* Enable extended blanking and pitch bits, and enable full memory */
 298         tmp = 0x22;
 299         tmp |= (crtc->fb->pitches[0] >> 7) & 0x10;
 300         tmp |= (crtc->fb->pitches[0] >> 6) & 0x40;
 301         WREG_CRT(0x1b, tmp);
 302
 303         /* Enable high-colour modes */
 304         WREG_GFX(VGA_GFX_MODE, 0x40);
 305
 306         /* And set graphics mode */
 307         WREG_GFX(VGA_GFX_MISC, 0x01);
 308
 309         WREG_HDR(hdr);
 310         cirrus_crtc_do_set_base(crtc, old_fb, x, y, 0);
 311         return 0;
 312 }
 313
 314 /*
 315  * This is called before a mode is programmed. A typical use might be to
 316  * enable DPMS during the programming to avoid seeing intermediate stages,
 317  * but that's not relevant to us
 318  */
 319 static void cirrus_crtc_prepare(struct drm_crtc *crtc)
 320 {
 321 }
 322
 323 /*
 324  * This is called after a mode is programmed. It should reverse anything done
 325  * by the prepare function
 326  */
 327 static void cirrus_crtc_commit(struct drm_crtc *crtc)
 328 {
 329 }
 330
 331 /*
 332  * The core can pass us a set of gamma values to program. We actually only
 333  * use this for 8-bit mode so can't perform smooth fades on deeper modes,
 334  * but it's a requirement that we provide the function
 335  */
 336 static void cirrus_crtc_gamma_set(struct drm_crtc *crtc, u16 *red, u16 *green,
 337                                   u16 *blue, uint32_t start, uint32_t size)
 338 {
 339         struct cirrus_crtc *cirrus_crtc = to_cirrus_crtc(crtc);
 340         int i;
 341
 342         if (size != CIRRUS_LUT_SIZE)
 343                 return;
 344
 345         for (i = 0; i < CIRRUS_LUT_SIZE; i++) {
 346                 cirrus_crtc->lut_r[i] = red[i];
 347                 cirrus_crtc->lut_g[i] = green[i];
 348                 cirrus_crtc->lut_b[i] = blue[i];
 349         }
 350         cirrus_crtc_load_lut(crtc);
 351 }
 352
 353 /* Simple cleanup function */
 354 static void cirrus_crtc_destroy(struct drm_crtc *crtc)
 355 {
 356         struct cirrus_crtc *cirrus_crtc = to_cirrus_crtc(crtc);
 357
 358         drm_crtc_cleanup(crtc);
 359         kfree(cirrus_crtc);
 360 }
 361
 362 /* These provide the minimum set of functions required to handle a CRTC */
 363 static const struct drm_crtc_funcs cirrus_crtc_funcs = {
 364         .gamma_set = cirrus_crtc_gamma_set,
 365         .set_config = drm_crtc_helper_set_config,
 366         .destroy = cirrus_crtc_destroy,
 367 };
 368
 369 static const struct drm_crtc_helper_funcs cirrus_helper_funcs = {
 370         .dpms = cirrus_crtc_dpms,
 371         .mode_fixup = cirrus_crtc_mode_fixup,
 372         .mode_set = cirrus_crtc_mode_set,
 373         .mode_set_base = cirrus_crtc_mode_set_base,
 374         .prepare = cirrus_crtc_prepare,
 375         .commit = cirrus_crtc_commit,
 376         .load_lut = cirrus_crtc_load_lut,
 377 };
 378
 379 /* CRTC setup */
 380 static void cirrus_crtc_init(struct drm_device *dev)
 381 {
 382         struct cirrus_device *cdev = dev->dev_private;
 383         struct cirrus_crtc *cirrus_crtc;
 384         int i;
 385
 386         cirrus_crtc = kzalloc(sizeof(struct cirrus_crtc) +
 387                               (CIRRUSFB_CONN_LIMIT * sizeof(struct drm_connector *)),
 388                               GFP_KERNEL);
 389
 390         if (cirrus_crtc == NULL)
 391                 return;
 392
 393         drm_crtc_init(dev, &cirrus_crtc->base, &cirrus_crtc_funcs);
 394
 395         drm_mode_crtc_set_gamma_size(&cirrus_crtc->base, CIRRUS_LUT_SIZE);
 396         cdev->mode_info.crtc = cirrus_crtc;
 397
 398         for (i = 0; i < CIRRUS_LUT_SIZE; i++) {
 399                 cirrus_crtc->lut_r[i] = i;
 400                 cirrus_crtc->lut_g[i] = i;
 401                 cirrus_crtc->lut_b[i] = i;
 402         }
 403
 404         drm_crtc_helper_add(&cirrus_crtc->base, &cirrus_helper_funcs);
 405 }
 406
 407 /** Sets the color ramps on behalf of fbcon */
 408 void cirrus_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,
 409                               u16 blue, int regno)
 410 {
 411         struct cirrus_crtc *cirrus_crtc = to_cirrus_crtc(crtc);
 412
 413         cirrus_crtc->lut_r[regno] = red;
 414         cirrus_crtc->lut_g[regno] = green;
 415         cirrus_crtc->lut_b[regno] = blue;
 416 }
 417
 418 /** Gets the color ramps on behalf of fbcon */
 419 void cirrus_crtc_fb_gamma_get(struct drm_crtc *crtc, u16 *red, u16 *green,
 420                               u16 *blue, int regno)
 421 {
 422         struct cirrus_crtc *cirrus_crtc = to_cirrus_crtc(crtc);
 423
 424         *red = cirrus_crtc->lut_r[regno];
 425         *green = cirrus_crtc->lut_g[regno];
 426         *blue = cirrus_crtc->lut_b[regno];
 427 }
 428
 429
 430 static bool cirrus_encoder_mode_fixup(struct drm_encoder *encoder,
 431                                       const struct drm_display_mode *mode,
 432                                       struct drm_display_mode *adjusted_mode)
 433 {
 434         return true;
 435 }
 436
 437 static void cirrus_encoder_mode_set(struct drm_encoder *encoder,
 438                                 struct drm_display_mode *mode,
 439                                 struct drm_display_mode *adjusted_mode)
 440 {
 441 }
 442
 443 static void cirrus_encoder_dpms(struct drm_encoder *encoder, int state)
 444 {
 445         return;
 446 }
 447
 448 static void cirrus_encoder_prepare(struct drm_encoder *encoder)
 449 {
 450 }
 451
 452 static void cirrus_encoder_commit(struct drm_encoder *encoder)
 453 {
 454 }
 455
 456 void cirrus_encoder_destroy(struct drm_encoder *encoder)
 457 {
 458         struct cirrus_encoder *cirrus_encoder = to_cirrus_encoder(encoder);
 459         drm_encoder_cleanup(encoder);
 460         kfree(cirrus_encoder);
 461 }
 462
 463 static const struct drm_encoder_helper_funcs cirrus_encoder_helper_funcs = {
 464         .dpms = cirrus_encoder_dpms,
 465         .mode_fixup = cirrus_encoder_mode_fixup,
 466         .mode_set = cirrus_encoder_mode_set,
 467         .prepare = cirrus_encoder_prepare,
 468         .commit = cirrus_encoder_commit,
 469 };
 470
 471 static const struct drm_encoder_funcs cirrus_encoder_encoder_funcs = {
 472         .destroy = cirrus_encoder_destroy,
 473 };
 474
 475 static struct drm_encoder *cirrus_encoder_init(struct drm_device *dev)
 476 {
 477         struct drm_encoder *encoder;
 478         struct cirrus_encoder *cirrus_encoder;
 479
 480         cirrus_encoder = kzalloc(sizeof(struct cirrus_encoder), GFP_KERNEL);
 481         if (!cirrus_encoder)
 482                 return NULL;
 483
 484         encoder = &cirrus_encoder->base;
 485         encoder->possible_crtcs = 0x1;
 486
 487         drm_encoder_init(dev, encoder, &cirrus_encoder_encoder_funcs,
 488                          DRM_MODE_ENCODER_DAC);
 489         drm_encoder_helper_add(encoder, &cirrus_encoder_helper_funcs);
 490
 491         return encoder;
 492 }
 493
 494
 495 int cirrus_vga_get_modes(struct drm_connector *connector)
 496 {
 497         int count;
 498
 499         /* Just add a static list of modes */
 500         count = drm_add_modes_noedid(connector, 1280, 1024);
 501         drm_set_preferred_mode(connector, 1024, 768);
 502         return count;
 503 }
 504
 505 static int cirrus_vga_mode_valid(struct drm_connector *connector,
 506                                  struct drm_display_mode *mode)
 507 {
 508         /* Any mode we've added is valid */
 509         return MODE_OK;
 510 }
 511
 512 struct drm_encoder *cirrus_connector_best_encoder(struct drm_connector
 513                                                   *connector)
 514 {
 515         int enc_id = connector->encoder_ids[0];
 516         struct drm_mode_object *obj;
 517         struct drm_encoder *encoder;
 518
 519         /* pick the encoder ids */
 520         if (enc_id) {
 521                 obj =
 522                     drm_mode_object_find(connector->dev, enc_id,
 523                                          DRM_MODE_OBJECT_ENCODER);
 524                 if (!obj)
 525                         return NULL;
 526                 encoder = obj_to_encoder(obj);
 527                 return encoder;
 528         }
 529         return NULL;
 530 }
 531
 532 static enum drm_connector_status cirrus_vga_detect(struct drm_connector
 533                                                    *connector, bool force)
 534 {
 535         return connector_status_connected;
 536 }
 537
 538 static void cirrus_connector_destroy(struct drm_connector *connector)
 539 {
 540         drm_connector_cleanup(connector);
 541         kfree(connector);
 542 }
 543
 544 struct drm_connector_helper_funcs cirrus_vga_connector_helper_funcs = {
 545         .get_modes = cirrus_vga_get_modes,
 546         .mode_valid = cirrus_vga_mode_valid,
 547         .best_encoder = cirrus_connector_best_encoder,
 548 };
 549
 550 struct drm_connector_funcs cirrus_vga_connector_funcs = {
 551         .dpms = drm_helper_connector_dpms,
 552         .detect = cirrus_vga_detect,
 553         .fill_modes = drm_helper_probe_single_connector_modes,
 554         .destroy = cirrus_connector_destroy,
 555 };
 556
 557 static struct drm_connector *cirrus_vga_init(struct drm_device *dev)
 558 {
 559         struct drm_connector *connector;
 560         struct cirrus_connector *cirrus_connector;
 561
 562         cirrus_connector = kzalloc(sizeof(struct cirrus_connector), GFP_KERNEL);
 563         if (!cirrus_connector)
 564                 return NULL;
 565
 566         connector = &cirrus_connector->base;
 567
 568         drm_connector_init(dev, connector,
 569                            &cirrus_vga_connector_funcs, DRM_MODE_CONNECTOR_VGA);
 570
 571         drm_connector_helper_add(connector, &cirrus_vga_connector_helper_funcs);
 572
 573         return connector;
 574 }
 575
 576
 577 int cirrus_modeset_init(struct cirrus_device *cdev)
 578 {
 579         struct drm_encoder *encoder;
 580         struct drm_connector *connector;
 581         int ret;
 582
 583         drm_mode_config_init(cdev->dev);
 584         cdev->mode_info.mode_config_initialized = true;
 585
 586         cdev->dev->mode_config.max_width = CIRRUS_MAX_FB_WIDTH;
 587         cdev->dev->mode_config.max_height = CIRRUS_MAX_FB_HEIGHT;
 588
 589         cdev->dev->mode_config.fb_base = cdev->mc.vram_base;
 590         cdev->dev->mode_config.preferred_depth = 24;
 591         /* don't prefer a shadow on virt GPU */
 592         cdev->dev->mode_config.prefer_shadow = 0;
 593
 594         cirrus_crtc_init(cdev->dev);
 595
 596         encoder = cirrus_encoder_init(cdev->dev);
 597         if (!encoder) {
 598                 DRM_ERROR("cirrus_encoder_init failed\n");
 599                 return -1;
 600         }
 601
 602         connector = cirrus_vga_init(cdev->dev);
 603         if (!connector) {
 604                 DRM_ERROR("cirrus_vga_init failed\n");
 605                 return -1;
 606         }
 607
 608         drm_mode_connector_attach_encoder(connector, encoder);
 609
 610         ret = cirrus_fbdev_init(cdev);
 611         if (ret) {
 612                 DRM_ERROR("cirrus_fbdev_init failed\n");
 613                 return ret;
 614         }
 615
 616         return 0;
 617 }
 618
 619 void cirrus_modeset_fini(struct cirrus_device *cdev)
 620 {
 621         cirrus_fbdev_fini(cdev);
 622
 623         if (cdev->mode_info.mode_config_initialized) {
 624                 drm_mode_config_cleanup(cdev->dev);
 625                 cdev->mode_info.mode_config_initialized = false;
 626         }
 627 }