sys/dev/drm2/i915/i915_dma.c

   1 /* i915_dma.c -- DMA support for the I915 -*- linux-c -*-
   2  */
   3 /*-
   4  * Copyright 2003 Tungsten Graphics, Inc., Cedar Park, Texas.
   5  * All Rights Reserved.
   6  *
   7  * Permission is hereby granted, free of charge, to any person obtaining a
   8  * copy of this software and associated documentation files (the
   9  * "Software"), to deal in the Software without restriction, including
  10  * without limitation the rights to use, copy, modify, merge, publish,
  11  * distribute, sub license, and/or sell copies of the Software, and to
  12  * permit persons to whom the Software is furnished to do so, subject to
  13  * the following conditions:
  14  *
  15  * The above copyright notice and this permission notice (including the
  16  * next paragraph) shall be included in all copies or substantial portions
  17  * of the Software.
  18  *
  19  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  20  * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  21  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
  22  * IN NO EVENT SHALL TUNGSTEN GRAPHICS AND/OR ITS SUPPLIERS BE LIABLE FOR
  23  * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
  24  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
  25  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  26  *
  27  */
  28
  29 #include <sys/cdefs.h>
  30 __FBSDID("$FreeBSD$");
  31
  32 #include <dev/drm2/drmP.h>
  33 #include <dev/drm2/drm.h>
  34 #include <dev/drm2/i915/i915_drm.h>
  35 #include <dev/drm2/i915/i915_drv.h>
  36 #include <dev/drm2/i915/intel_drv.h>
  37 #include <dev/drm2/i915/intel_ringbuffer.h>
  38
  39 static struct drm_i915_private *i915_mch_dev;
  40 /*
  41  * Lock protecting IPS related data structures
  42  *   - i915_mch_dev
  43  *   - dev_priv->max_delay
  44  *   - dev_priv->min_delay
  45  *   - dev_priv->fmax
  46  *   - dev_priv->gpu_busy
  47  */
  48 static struct mtx mchdev_lock;
  49 MTX_SYSINIT(mchdev, &mchdev_lock, "mchdev", MTX_DEF);
  50
  51 static void i915_pineview_get_mem_freq(struct drm_device *dev);
  52 static void i915_ironlake_get_mem_freq(struct drm_device *dev);
  53 static int i915_driver_unload_int(struct drm_device *dev, bool locked);
  54
  55 static void i915_write_hws_pga(struct drm_device *dev)
  56 {
  57         drm_i915_private_t *dev_priv = dev->dev_private;
  58         u32 addr;
  59
  60         addr = dev_priv->status_page_dmah->busaddr;
  61         if (INTEL_INFO(dev)->gen >= 4)
  62                 addr |= (dev_priv->status_page_dmah->busaddr >> 28) & 0xf0;
  63         I915_WRITE(HWS_PGA, addr);
  64 }
  65
  66 /**
  67  * Sets up the hardware status page for devices that need a physical address
  68  * in the register.
  69  */
  70 static int i915_init_phys_hws(struct drm_device *dev)
  71 {
  72         drm_i915_private_t *dev_priv = dev->dev_private;
  73         struct intel_ring_buffer *ring = LP_RING(dev_priv);
  74
  75         /*
  76          * Program Hardware Status Page
  77          * XXXKIB Keep 4GB limit for allocation for now.  This method
  78          * of allocation is used on <= 965 hardware, that has several
  79          * erratas regarding the use of physical memory > 4 GB.
  80          */
  81         DRM_UNLOCK(dev);
  82         dev_priv->status_page_dmah =
  83                 drm_pci_alloc(dev, PAGE_SIZE, PAGE_SIZE, 0xffffffff);
  84         DRM_LOCK(dev);
  85         if (!dev_priv->status_page_dmah) {
  86                 DRM_ERROR("Can not allocate hardware status page\n");
  87                 return -ENOMEM;
  88         }
  89         ring->status_page.page_addr = dev_priv->hw_status_page =
  90             dev_priv->status_page_dmah->vaddr;
  91         dev_priv->dma_status_page = dev_priv->status_page_dmah->busaddr;
  92
  93         memset(dev_priv->hw_status_page, 0, PAGE_SIZE);
  94
  95         i915_write_hws_pga(dev);
  96         DRM_DEBUG("Enabled hardware status page, phys %jx\n",
  97             (uintmax_t)dev_priv->dma_status_page);
  98         return 0;
  99 }
 100
 101 /**
 102  * Frees the hardware status page, whether it's a physical address or a virtual
 103  * address set up by the X Server.
 104  */
 105 static void i915_free_hws(struct drm_device *dev)
 106 {
 107         drm_i915_private_t *dev_priv = dev->dev_private;
 108         struct intel_ring_buffer *ring = LP_RING(dev_priv);
 109
 110         if (dev_priv->status_page_dmah) {
 111                 drm_pci_free(dev, dev_priv->status_page_dmah);
 112                 dev_priv->status_page_dmah = NULL;
 113         }
 114
 115         if (dev_priv->status_gfx_addr) {
 116                 dev_priv->status_gfx_addr = 0;
 117                 ring->status_page.gfx_addr = 0;
 118                 drm_core_ioremapfree(&dev_priv->hws_map, dev);
 119         }
 120
 121         /* Need to rewrite hardware status page */
 122         I915_WRITE(HWS_PGA, 0x1ffff000);
 123 }
 124
 125 void i915_kernel_lost_context(struct drm_device * dev)
 126 {
 127         drm_i915_private_t *dev_priv = dev->dev_private;
 128         struct intel_ring_buffer *ring = LP_RING(dev_priv);
 129
 130         /*
 131          * We should never lose context on the ring with modesetting
 132          * as we don't expose it to userspace
 133          */
 134         if (drm_core_check_feature(dev, DRIVER_MODESET))
 135                 return;
 136
 137         ring->head = I915_READ_HEAD(ring) & HEAD_ADDR;
 138         ring->tail = I915_READ_TAIL(ring) & TAIL_ADDR;
 139         ring->space = ring->head - (ring->tail + 8);
 140         if (ring->space < 0)
 141                 ring->space += ring->size;
 142
 143 #if 1
 144         KIB_NOTYET();
 145 #else
 146         if (!dev->primary->master)
 147                 return;
 148 #endif
 149
 150         if (ring->head == ring->tail && dev_priv->sarea_priv)
 151                 dev_priv->sarea_priv->perf_boxes |= I915_BOX_RING_EMPTY;
 152 }
 153
 154 static int i915_dma_cleanup(struct drm_device * dev)
 155 {
 156         drm_i915_private_t *dev_priv = dev->dev_private;
 157         int i;
 158
 159
 160         /* Make sure interrupts are disabled here because the uninstall ioctl
 161          * may not have been called from userspace and after dev_private
 162          * is freed, it's too late.
 163          */
 164         if (dev->irq_enabled)
 165                 drm_irq_uninstall(dev);
 166
 167         for (i = 0; i < I915_NUM_RINGS; i++)
 168                 intel_cleanup_ring_buffer(&dev_priv->rings[i]);
 169
 170         /* Clear the HWS virtual address at teardown */
 171         if (I915_NEED_GFX_HWS(dev))
 172                 i915_free_hws(dev);
 173
 174         return 0;
 175 }
 176
 177 static int i915_initialize(struct drm_device * dev, drm_i915_init_t * init)
 178 {
 179         drm_i915_private_t *dev_priv = dev->dev_private;
 180         int ret;
 181
 182         dev_priv->sarea = drm_getsarea(dev);
 183         if (!dev_priv->sarea) {
 184                 DRM_ERROR("can not find sarea!\n");
 185                 i915_dma_cleanup(dev);
 186                 return -EINVAL;
 187         }
 188
 189         dev_priv->sarea_priv = (drm_i915_sarea_t *)
 190             ((u8 *) dev_priv->sarea->virtual + init->sarea_priv_offset);
 191
 192         if (init->ring_size != 0) {
 193                 if (LP_RING(dev_priv)->obj != NULL) {
 194                         i915_dma_cleanup(dev);
 195                         DRM_ERROR("Client tried to initialize ringbuffer in "
 196                                   "GEM mode\n");
 197                         return -EINVAL;
 198                 }
 199
 200                 ret = intel_render_ring_init_dri(dev,
 201                                                  init->ring_start,
 202                                                  init->ring_size);
 203                 if (ret) {
 204                         i915_dma_cleanup(dev);
 205                         return ret;
 206                 }
 207         }
 208
 209         dev_priv->cpp = init->cpp;
 210         dev_priv->back_offset = init->back_offset;
 211         dev_priv->front_offset = init->front_offset;
 212         dev_priv->current_page = 0;
 213         dev_priv->sarea_priv->pf_current_page = 0;
 214
 215         /* Allow hardware batchbuffers unless told otherwise.
 216          */
 217         dev_priv->allow_batchbuffer = 1;
 218
 219         return 0;
 220 }
 221
 222 static int i915_dma_resume(struct drm_device * dev)
 223 {
 224         drm_i915_private_t *dev_priv = (drm_i915_private_t *) dev->dev_private;
 225         struct intel_ring_buffer *ring = LP_RING(dev_priv);
 226
 227         DRM_DEBUG("\n");
 228
 229         if (ring->map.handle == NULL) {
 230                 DRM_ERROR("can not ioremap virtual address for"
 231                           " ring buffer\n");
 232                 return -ENOMEM;
 233         }
 234
 235         /* Program Hardware Status Page */
 236         if (!ring->status_page.page_addr) {
 237                 DRM_ERROR("Can not find hardware status page\n");
 238                 return -EINVAL;
 239         }
 240         DRM_DEBUG("hw status page @ %p\n", ring->status_page.page_addr);
 241         if (ring->status_page.gfx_addr != 0)
 242                 intel_ring_setup_status_page(ring);
 243         else
 244                 i915_write_hws_pga(dev);
 245
 246         DRM_DEBUG("Enabled hardware status page\n");
 247
 248         return 0;
 249 }
 250
 251 static int i915_dma_init(struct drm_device *dev, void *data,
 252                          struct drm_file *file_priv)
 253 {
 254         drm_i915_init_t *init = data;
 255         int retcode = 0;
 256
 257         switch (init->func) {
 258         case I915_INIT_DMA:
 259                 retcode = i915_initialize(dev, init);
 260                 break;
 261         case I915_CLEANUP_DMA:
 262                 retcode = i915_dma_cleanup(dev);
 263                 break;
 264         case I915_RESUME_DMA:
 265                 retcode = i915_dma_resume(dev);
 266                 break;
 267         default:
 268                 retcode = -EINVAL;
 269                 break;
 270         }
 271
 272         return retcode;
 273 }
 274
 275 /* Implement basically the same security restrictions as hardware does
 276  * for MI_BATCH_NON_SECURE.  These can be made stricter at any time.
 277  *
 278  * Most of the calculations below involve calculating the size of a
 279  * particular instruction.  It's important to get the size right as
 280  * that tells us where the next instruction to check is.  Any illegal
 281  * instruction detected will be given a size of zero, which is a
 282  * signal to abort the rest of the buffer.
 283  */
 284 static int do_validate_cmd(int cmd)
 285 {
 286         switch (((cmd >> 29) & 0x7)) {
 287         case 0x0:
 288                 switch ((cmd >> 23) & 0x3f) {
 289                 case 0x0:
 290                         return 1;       /* MI_NOOP */
 291                 case 0x4:
 292                         return 1;       /* MI_FLUSH */
 293                 default:
 294                         return 0;       /* disallow everything else */
 295                 }
 296                 break;
 297         case 0x1:
 298                 return 0;       /* reserved */
 299         case 0x2:
 300                 return (cmd & 0xff) + 2;        /* 2d commands */
 301         case 0x3:
 302                 if (((cmd >> 24) & 0x1f) <= 0x18)
 303                         return 1;
 304
 305                 switch ((cmd >> 24) & 0x1f) {
 306                 case 0x1c:
 307                         return 1;
 308                 case 0x1d:
 309                         switch ((cmd >> 16) & 0xff) {
 310                         case 0x3:
 311                                 return (cmd & 0x1f) + 2;
 312                         case 0x4:
 313                                 return (cmd & 0xf) + 2;
 314                         default:
 315                                 return (cmd & 0xffff) + 2;
 316                         }
 317                 case 0x1e:
 318                         if (cmd & (1 << 23))
 319                                 return (cmd & 0xffff) + 1;
 320                         else
 321                                 return 1;
 322                 case 0x1f:
 323                         if ((cmd & (1 << 23)) == 0)     /* inline vertices */
 324                                 return (cmd & 0x1ffff) + 2;
 325                         else if (cmd & (1 << 17))       /* indirect random */
 326                                 if ((cmd & 0xffff) == 0)
 327                                         return 0;       /* unknown length, too hard */
 328                                 else
 329                                         return (((cmd & 0xffff) + 1) / 2) + 1;
 330                         else
 331                                 return 2;       /* indirect sequential */
 332                 default:
 333                         return 0;
 334                 }
 335         default:
 336                 return 0;
 337         }
 338
 339         return 0;
 340 }
 341
 342 static int validate_cmd(int cmd)
 343 {
 344         int ret = do_validate_cmd(cmd);
 345
 346 /*      printk("validate_cmd( %x ): %d\n", cmd, ret); */
 347
 348         return ret;
 349 }
 350
 351 static int i915_emit_cmds(struct drm_device *dev, int __user *buffer,
 352                           int dwords)
 353 {
 354         drm_i915_private_t *dev_priv = dev->dev_private;
 355         int i;
 356
 357         if ((dwords+1) * sizeof(int) >= LP_RING(dev_priv)->size - 8)
 358                 return -EINVAL;
 359
 360         BEGIN_LP_RING((dwords+1)&~1);
 361
 362         for (i = 0; i < dwords;) {
 363                 int cmd, sz;
 364
 365                 if (DRM_COPY_FROM_USER_UNCHECKED(&cmd, &buffer[i], sizeof(cmd)))
 366                         return -EINVAL;
 367
 368                 if ((sz = validate_cmd(cmd)) == 0 || i + sz > dwords)
 369                         return -EINVAL;
 370
 371                 OUT_RING(cmd);
 372
 373                 while (++i, --sz) {
 374                         if (DRM_COPY_FROM_USER_UNCHECKED(&cmd, &buffer[i],
 375                                                          sizeof(cmd))) {
 376                                 return -EINVAL;
 377                         }
 378                         OUT_RING(cmd);
 379                 }
 380         }
 381
 382         if (dwords & 1)
 383                 OUT_RING(0);
 384
 385         ADVANCE_LP_RING();
 386
 387         return 0;
 388 }
 389
 390 int i915_emit_box(struct drm_device * dev,
 391                   struct drm_clip_rect *boxes,
 392                   int i, int DR1, int DR4)
 393 {
 394         struct drm_clip_rect box;
 395
 396         if (DRM_COPY_FROM_USER_UNCHECKED(&box, &boxes[i], sizeof(box))) {
 397                 return -EFAULT;
 398         }
 399
 400         return (i915_emit_box_p(dev, &box, DR1, DR4));
 401 }
 402
 403 int
 404 i915_emit_box_p(struct drm_device *dev, struct drm_clip_rect *box,
 405     int DR1, int DR4)
 406 {
 407         drm_i915_private_t *dev_priv = dev->dev_private;
 408         int ret;
 409
 410         if (box->y2 <= box->y1 || box->x2 <= box->x1 || box->y2 <= 0 ||
 411             box->x2 <= 0) {
 412                 DRM_ERROR("Bad box %d,%d..%d,%d\n",
 413                           box->x1, box->y1, box->x2, box->y2);
 414                 return -EINVAL;
 415         }
 416
 417         if (INTEL_INFO(dev)->gen >= 4) {
 418                 ret = BEGIN_LP_RING(4);
 419                 if (ret != 0)
 420                         return (ret);
 421
 422                 OUT_RING(GFX_OP_DRAWRECT_INFO_I965);
 423                 OUT_RING((box->x1 & 0xffff) | (box->y1 << 16));
 424                 OUT_RING(((box->x2 - 1) & 0xffff) | ((box->y2 - 1) << 16));
 425                 OUT_RING(DR4);
 426         } else {
 427                 ret = BEGIN_LP_RING(6);
 428                 if (ret != 0)
 429                         return (ret);
 430
 431                 OUT_RING(GFX_OP_DRAWRECT_INFO);
 432                 OUT_RING(DR1);
 433                 OUT_RING((box->x1 & 0xffff) | (box->y1 << 16));
 434                 OUT_RING(((box->x2 - 1) & 0xffff) | ((box->y2 - 1) << 16));
 435                 OUT_RING(DR4);
 436                 OUT_RING(0);
 437         }
 438         ADVANCE_LP_RING();
 439
 440         return 0;
 441 }
 442
 443 /* XXX: Emitting the counter should really be moved to part of the IRQ
 444  * emit. For now, do it in both places:
 445  */
 446
 447 static void i915_emit_breadcrumb(struct drm_device *dev)
 448 {
 449         drm_i915_private_t *dev_priv = dev->dev_private;
 450
 451         if (++dev_priv->counter > 0x7FFFFFFFUL)
 452                 dev_priv->counter = 0;
 453         if (dev_priv->sarea_priv)
 454                 dev_priv->sarea_priv->last_enqueue = dev_priv->counter;
 455
 456         if (BEGIN_LP_RING(4) == 0) {
 457                 OUT_RING(MI_STORE_DWORD_INDEX);
 458                 OUT_RING(I915_BREADCRUMB_INDEX << MI_STORE_DWORD_INDEX_SHIFT);
 459                 OUT_RING(dev_priv->counter);
 460                 OUT_RING(0);
 461                 ADVANCE_LP_RING();
 462         }
 463 }
 464
 465 static int i915_dispatch_cmdbuffer(struct drm_device * dev,
 466     drm_i915_cmdbuffer_t * cmd, struct drm_clip_rect *cliprects, void *cmdbuf)
 467 {
 468         int nbox = cmd->num_cliprects;
 469         int i = 0, count, ret;
 470
 471         if (cmd->sz & 0x3) {
 472                 DRM_ERROR("alignment\n");
 473                 return -EINVAL;
 474         }
 475
 476         i915_kernel_lost_context(dev);
 477
 478         count = nbox ? nbox : 1;
 479
 480         for (i = 0; i < count; i++) {
 481                 if (i < nbox) {
 482                         ret = i915_emit_box_p(dev, &cmd->cliprects[i],
 483                             cmd->DR1, cmd->DR4);
 484                         if (ret)
 485                                 return ret;
 486                 }
 487
 488                 ret = i915_emit_cmds(dev, cmdbuf, cmd->sz / 4);
 489                 if (ret)
 490                         return ret;
 491         }
 492
 493         i915_emit_breadcrumb(dev);
 494         return 0;
 495 }
 496
 497 static int
 498 i915_dispatch_batchbuffer(struct drm_device * dev,
 499     drm_i915_batchbuffer_t * batch, struct drm_clip_rect *cliprects)
 500 {
 501         drm_i915_private_t *dev_priv = dev->dev_private;
 502         int nbox = batch->num_cliprects;
 503         int i, count, ret;
 504
 505         if ((batch->start | batch->used) & 0x7) {
 506                 DRM_ERROR("alignment\n");
 507                 return -EINVAL;
 508         }
 509
 510         i915_kernel_lost_context(dev);
 511
 512         count = nbox ? nbox : 1;
 513
 514         for (i = 0; i < count; i++) {
 515                 if (i < nbox) {
 516                         int ret = i915_emit_box_p(dev, &cliprects[i],
 517                             batch->DR1, batch->DR4);
 518                         if (ret)
 519                                 return ret;
 520                 }
 521
 522                 if (!IS_I830(dev) && !IS_845G(dev)) {
 523                         ret = BEGIN_LP_RING(2);
 524                         if (ret != 0)
 525                                 return (ret);
 526
 527                         if (INTEL_INFO(dev)->gen >= 4) {
 528                                 OUT_RING(MI_BATCH_BUFFER_START | (2 << 6) |
 529                                     MI_BATCH_NON_SECURE_I965);
 530                                 OUT_RING(batch->start);
 531                         } else {
 532                                 OUT_RING(MI_BATCH_BUFFER_START | (2 << 6));
 533                                 OUT_RING(batch->start | MI_BATCH_NON_SECURE);
 534                         }
 535                 } else {
 536                         ret = BEGIN_LP_RING(4);
 537                         if (ret != 0)
 538                                 return (ret);
 539
 540                         OUT_RING(MI_BATCH_BUFFER);
 541                         OUT_RING(batch->start | MI_BATCH_NON_SECURE);
 542                         OUT_RING(batch->start + batch->used - 4);
 543                         OUT_RING(0);
 544                 }
 545                 ADVANCE_LP_RING();
 546         }
 547
 548         i915_emit_breadcrumb(dev);
 549
 550         return 0;
 551 }
 552
 553 static int i915_dispatch_flip(struct drm_device * dev)
 554 {
 555         drm_i915_private_t *dev_priv = dev->dev_private;
 556         int ret;
 557
 558         if (!dev_priv->sarea_priv)
 559                 return -EINVAL;
 560
 561         DRM_DEBUG("%s: page=%d pfCurrentPage=%d\n",
 562                   __func__,
 563                   dev_priv->current_page,
 564                   dev_priv->sarea_priv->pf_current_page);
 565
 566         i915_kernel_lost_context(dev);
 567
 568         ret = BEGIN_LP_RING(10);
 569         if (ret)
 570                 return ret;
 571         OUT_RING(MI_FLUSH | MI_READ_FLUSH);
 572         OUT_RING(0);
 573
 574         OUT_RING(CMD_OP_DISPLAYBUFFER_INFO | ASYNC_FLIP);
 575         OUT_RING(0);
 576         if (dev_priv->current_page == 0) {
 577                 OUT_RING(dev_priv->back_offset);
 578                 dev_priv->current_page = 1;
 579         } else {
 580                 OUT_RING(dev_priv->front_offset);
 581                 dev_priv->current_page = 0;
 582         }
 583         OUT_RING(0);
 584
 585         OUT_RING(MI_WAIT_FOR_EVENT | MI_WAIT_FOR_PLANE_A_FLIP);
 586         OUT_RING(0);
 587
 588         ADVANCE_LP_RING();
 589
 590         if (++dev_priv->counter > 0x7FFFFFFFUL)
 591                 dev_priv->counter = 0;
 592         if (dev_priv->sarea_priv)
 593                 dev_priv->sarea_priv->last_enqueue = dev_priv->counter;
 594
 595         if (BEGIN_LP_RING(4) == 0) {
 596                 OUT_RING(MI_STORE_DWORD_INDEX);
 597                 OUT_RING(I915_BREADCRUMB_INDEX << MI_STORE_DWORD_INDEX_SHIFT);
 598                 OUT_RING(dev_priv->counter);
 599                 OUT_RING(0);
 600                 ADVANCE_LP_RING();
 601         }
 602
 603         dev_priv->sarea_priv->pf_current_page = dev_priv->current_page;
 604         return 0;
 605 }
 606
 607 static int
 608 i915_quiescent(struct drm_device *dev)
 609 {
 610         struct intel_ring_buffer *ring = LP_RING(dev->dev_private);
 611
 612         i915_kernel_lost_context(dev);
 613         return (intel_wait_ring_idle(ring));
 614 }
 615
 616 static int
 617 i915_flush_ioctl(struct drm_device *dev, void *data, struct drm_file *file_priv)
 618 {
 619         int ret;
 620
 621         RING_LOCK_TEST_WITH_RETURN(dev, file_priv);
 622
 623         DRM_LOCK(dev);
 624         ret = i915_quiescent(dev);
 625         DRM_UNLOCK(dev);
 626
 627         return (ret);
 628 }
 629
 630 int i915_batchbuffer(struct drm_device *dev, void *data,
 631                             struct drm_file *file_priv)
 632 {
 633         drm_i915_private_t *dev_priv = (drm_i915_private_t *) dev->dev_private;
 634         drm_i915_sarea_t *sarea_priv;
 635         drm_i915_batchbuffer_t *batch = data;
 636         struct drm_clip_rect *cliprects;
 637         size_t cliplen;
 638         int ret;
 639
 640         if (!dev_priv->allow_batchbuffer) {
 641                 DRM_ERROR("Batchbuffer ioctl disabled\n");
 642                 return -EINVAL;
 643         }
 644         DRM_UNLOCK(dev);
 645
 646         DRM_DEBUG("i915 batchbuffer, start %x used %d cliprects %d\n",
 647                   batch->start, batch->used, batch->num_cliprects);
 648
 649         cliplen = batch->num_cliprects * sizeof(struct drm_clip_rect);
 650         if (batch->num_cliprects < 0)
 651                 return -EFAULT;
 652         if (batch->num_cliprects != 0) {
 653                 cliprects = malloc(batch->num_cliprects *
 654                     sizeof(struct drm_clip_rect), DRM_MEM_DMA,
 655                     M_WAITOK | M_ZERO);
 656
 657                 ret = -copyin(batch->cliprects, cliprects,
 658                     batch->num_cliprects * sizeof(struct drm_clip_rect));
 659                 if (ret != 0) {
 660                         DRM_LOCK(dev);
 661                         goto fail_free;
 662                 }
 663         } else
 664                 cliprects = NULL;
 665
 666         DRM_LOCK(dev);
 667         RING_LOCK_TEST_WITH_RETURN(dev, file_priv);
 668         ret = i915_dispatch_batchbuffer(dev, batch, cliprects);
 669
 670         sarea_priv = (drm_i915_sarea_t *)dev_priv->sarea_priv;
 671         if (sarea_priv)
 672                 sarea_priv->last_dispatch = READ_BREADCRUMB(dev_priv);
 673
 674 fail_free:
 675         free(cliprects, DRM_MEM_DMA);
 676         return ret;
 677 }
 678
 679 int i915_cmdbuffer(struct drm_device *dev, void *data,
 680                           struct drm_file *file_priv)
 681 {
 682         drm_i915_private_t *dev_priv = (drm_i915_private_t *) dev->dev_private;
 683         drm_i915_sarea_t *sarea_priv;
 684         drm_i915_cmdbuffer_t *cmdbuf = data;
 685         struct drm_clip_rect *cliprects = NULL;
 686         void *batch_data;
 687         int ret;
 688
 689         DRM_DEBUG("i915 cmdbuffer, buf %p sz %d cliprects %d\n",
 690                   cmdbuf->buf, cmdbuf->sz, cmdbuf->num_cliprects);
 691
 692         if (cmdbuf->num_cliprects < 0)
 693                 return -EINVAL;
 694
 695         DRM_UNLOCK(dev);
 696
 697         batch_data = malloc(cmdbuf->sz, DRM_MEM_DMA, M_WAITOK);
 698
 699         ret = -copyin(cmdbuf->buf, batch_data, cmdbuf->sz);
 700         if (ret != 0) {
 701                 DRM_LOCK(dev);
 702                 goto fail_batch_free;
 703         }
 704
 705         if (cmdbuf->num_cliprects) {
 706                 cliprects = malloc(cmdbuf->num_cliprects *
 707                     sizeof(struct drm_clip_rect), DRM_MEM_DMA,
 708                     M_WAITOK | M_ZERO);
 709                 ret = -copyin(cmdbuf->cliprects, cliprects,
 710                     cmdbuf->num_cliprects * sizeof(struct drm_clip_rect));
 711                 if (ret != 0) {
 712                         DRM_LOCK(dev);
 713                         goto fail_clip_free;
 714                 }
 715         }
 716
 717         DRM_LOCK(dev);
 718         RING_LOCK_TEST_WITH_RETURN(dev, file_priv);
 719         ret = i915_dispatch_cmdbuffer(dev, cmdbuf, cliprects, batch_data);
 720         if (ret) {
 721                 DRM_ERROR("i915_dispatch_cmdbuffer failed\n");
 722                 goto fail_clip_free;
 723         }
 724
 725         sarea_priv = (drm_i915_sarea_t *)dev_priv->sarea_priv;
 726         if (sarea_priv)
 727                 sarea_priv->last_dispatch = READ_BREADCRUMB(dev_priv);
 728
 729 fail_clip_free:
 730         free(cliprects, DRM_MEM_DMA);
 731 fail_batch_free:
 732         free(batch_data, DRM_MEM_DMA);
 733         return ret;
 734 }
 735
 736 static int i915_flip_bufs(struct drm_device *dev, void *data,
 737                           struct drm_file *file_priv)
 738 {
 739         int ret;
 740
 741         DRM_DEBUG("%s\n", __func__);
 742
 743         RING_LOCK_TEST_WITH_RETURN(dev, file_priv);
 744
 745         ret = i915_dispatch_flip(dev);
 746
 747         return ret;
 748 }
 749
 750 int i915_getparam(struct drm_device *dev, void *data,
 751                          struct drm_file *file_priv)
 752 {
 753         drm_i915_private_t *dev_priv = dev->dev_private;
 754         drm_i915_getparam_t *param = data;
 755         int value;
 756
 757         if (!dev_priv) {
 758                 DRM_ERROR("called with no initialization\n");
 759                 return -EINVAL;
 760         }
 761
 762         switch (param->param) {
 763         case I915_PARAM_IRQ_ACTIVE:
 764                 value = dev->irq_enabled ? 1 : 0;
 765                 break;
 766         case I915_PARAM_ALLOW_BATCHBUFFER:
 767                 value = dev_priv->allow_batchbuffer ? 1 : 0;
 768                 break;
 769         case I915_PARAM_LAST_DISPATCH:
 770                 value = READ_BREADCRUMB(dev_priv);
 771                 break;
 772         case I915_PARAM_CHIPSET_ID:
 773                 value = dev->pci_device;
 774                 break;
 775         case I915_PARAM_HAS_GEM:
 776                 value = 1;
 777                 break;
 778         case I915_PARAM_NUM_FENCES_AVAIL:
 779                 value = dev_priv->num_fence_regs - dev_priv->fence_reg_start;
 780                 break;
 781         case I915_PARAM_HAS_OVERLAY:
 782                 value = dev_priv->overlay ? 1 : 0;
 783                 break;
 784         case I915_PARAM_HAS_PAGEFLIPPING:
 785                 value = 1;
 786                 break;
 787         case I915_PARAM_HAS_EXECBUF2:
 788                 value = 1;
 789                 break;
 790         case I915_PARAM_HAS_BSD:
 791                 value = HAS_BSD(dev);
 792                 break;
 793         case I915_PARAM_HAS_BLT:
 794                 value = HAS_BLT(dev);
 795                 break;
 796         case I915_PARAM_HAS_RELAXED_FENCING:
 797                 value = 1;
 798                 break;
 799         case I915_PARAM_HAS_COHERENT_RINGS:
 800                 value = 1;
 801                 break;
 802         case I915_PARAM_HAS_EXEC_CONSTANTS:
 803                 value = INTEL_INFO(dev)->gen >= 4;
 804                 break;
 805         case I915_PARAM_HAS_RELAXED_DELTA:
 806                 value = 1;
 807                 break;
 808         case I915_PARAM_HAS_GEN7_SOL_RESET:
 809                 value = 1;
 810                 break;
 811         case I915_PARAM_HAS_LLC:
 812                 value = HAS_LLC(dev);
 813                 break;
 814         default:
 815                 DRM_DEBUG_DRIVER("Unknown parameter %d\n",
 816                                  param->param);
 817                 return -EINVAL;
 818         }
 819
 820         if (DRM_COPY_TO_USER(param->value, &value, sizeof(int))) {
 821                 DRM_ERROR("DRM_COPY_TO_USER failed\n");
 822                 return -EFAULT;
 823         }
 824
 825         return 0;
 826 }
 827
 828 static int i915_setparam(struct drm_device *dev, void *data,
 829                          struct drm_file *file_priv)
 830 {
 831         drm_i915_private_t *dev_priv = dev->dev_private;
 832         drm_i915_setparam_t *param = data;
 833
 834         if (!dev_priv) {
 835                 DRM_ERROR("called with no initialization\n");
 836                 return -EINVAL;
 837         }
 838
 839         switch (param->param) {
 840         case I915_SETPARAM_USE_MI_BATCHBUFFER_START:
 841                 break;
 842         case I915_SETPARAM_TEX_LRU_LOG_GRANULARITY:
 843                 dev_priv->tex_lru_log_granularity = param->value;
 844                 break;
 845         case I915_SETPARAM_ALLOW_BATCHBUFFER:
 846                 dev_priv->allow_batchbuffer = param->value;
 847                 break;
 848         case I915_SETPARAM_NUM_USED_FENCES:
 849                 if (param->value > dev_priv->num_fence_regs ||
 850                     param->value < 0)
 851                         return -EINVAL;
 852                 /* Userspace can use first N regs */
 853                 dev_priv->fence_reg_start = param->value;
 854                 break;
 855         default:
 856                 DRM_DEBUG("unknown parameter %d\n", param->param);
 857                 return -EINVAL;
 858         }
 859
 860         return 0;
 861 }
 862
 863 static int i915_set_status_page(struct drm_device *dev, void *data,
 864                                 struct drm_file *file_priv)
 865 {
 866         drm_i915_private_t *dev_priv = dev->dev_private;
 867         drm_i915_hws_addr_t *hws = data;
 868         struct intel_ring_buffer *ring = LP_RING(dev_priv);
 869
 870         if (!I915_NEED_GFX_HWS(dev))
 871                 return -EINVAL;
 872
 873         if (!dev_priv) {
 874                 DRM_ERROR("called with no initialization\n");
 875                 return -EINVAL;
 876         }
 877
 878         DRM_DEBUG("set status page addr 0x%08x\n", (u32)hws->addr);
 879         if (drm_core_check_feature(dev, DRIVER_MODESET)) {
 880                 DRM_ERROR("tried to set status page when mode setting active\n");
 881                 return 0;
 882         }
 883
 884         ring->status_page.gfx_addr = dev_priv->status_gfx_addr =
 885             hws->addr & (0x1ffff<<12);
 886
 887         dev_priv->hws_map.offset = dev->agp->base + hws->addr;
 888         dev_priv->hws_map.size = 4*1024;
 889         dev_priv->hws_map.type = 0;
 890         dev_priv->hws_map.flags = 0;
 891         dev_priv->hws_map.mtrr = 0;
 892
 893         drm_core_ioremap_wc(&dev_priv->hws_map, dev);
 894         if (dev_priv->hws_map.virtual == NULL) {
 895                 i915_dma_cleanup(dev);
 896                 ring->status_page.gfx_addr = dev_priv->status_gfx_addr = 0;
 897                 DRM_ERROR("can not ioremap virtual address for"
 898                                 " G33 hw status page\n");
 899                 return -ENOMEM;
 900         }
 901         ring->status_page.page_addr = dev_priv->hw_status_page =
 902             dev_priv->hws_map.virtual;
 903
 904         memset(dev_priv->hw_status_page, 0, PAGE_SIZE);
 905         I915_WRITE(HWS_PGA, dev_priv->status_gfx_addr);
 906         DRM_DEBUG("load hws HWS_PGA with gfx mem 0x%x\n",
 907                         dev_priv->status_gfx_addr);
 908         DRM_DEBUG("load hws at %p\n", dev_priv->hw_status_page);
 909         return 0;
 910 }
 911
 912 static bool
 913 intel_enable_ppgtt(struct drm_device *dev)
 914 {
 915         if (i915_enable_ppgtt >= 0)
 916                 return i915_enable_ppgtt;
 917
 918         /* Disable ppgtt on SNB if VT-d is on. */
 919         if (INTEL_INFO(dev)->gen == 6 && intel_iommu_enabled)
 920                 return false;
 921
 922         return true;
 923 }
 924
 925 static int
 926 i915_load_gem_init(struct drm_device *dev)
 927 {
 928         struct drm_i915_private *dev_priv = dev->dev_private;
 929         unsigned long prealloc_size, gtt_size, mappable_size;
 930         int ret;
 931
 932         prealloc_size = dev_priv->mm.gtt.stolen_size;
 933         gtt_size = dev_priv->mm.gtt.gtt_total_entries << PAGE_SHIFT;
 934         mappable_size = dev_priv->mm.gtt.gtt_mappable_entries << PAGE_SHIFT;
 935
 936         /* Basic memrange allocator for stolen space */
 937         drm_mm_init(&dev_priv->mm.stolen, 0, prealloc_size);
 938
 939         DRM_LOCK(dev);
 940         if (intel_enable_ppgtt(dev) && HAS_ALIASING_PPGTT(dev)) {
 941                 /* PPGTT pdes are stolen from global gtt ptes, so shrink the
 942                  * aperture accordingly when using aliasing ppgtt. */
 943                 gtt_size -= I915_PPGTT_PD_ENTRIES*PAGE_SIZE;
 944                 /* For paranoia keep the guard page in between. */
 945                 gtt_size -= PAGE_SIZE;
 946
 947                 i915_gem_do_init(dev, 0, mappable_size, gtt_size);
 948
 949                 ret = i915_gem_init_aliasing_ppgtt(dev);
 950                 if (ret) {
 951                         DRM_UNLOCK(dev);
 952                         return ret;
 953                 }
 954         } else {
 955                 /* Let GEM Manage all of the aperture.
 956                  *
 957                  * However, leave one page at the end still bound to the scratch
 958                  * page.  There are a number of places where the hardware
 959                  * apparently prefetches past the end of the object, and we've
 960                  * seen multiple hangs with the GPU head pointer stuck in a
 961                  * batchbuffer bound at the last page of the aperture.  One page
 962                  * should be enough to keep any prefetching inside of the
 963                  * aperture.
 964                  */
 965                 i915_gem_do_init(dev, 0, mappable_size, gtt_size - PAGE_SIZE);
 966         }
 967
 968         ret = i915_gem_init_hw(dev);
 969         DRM_UNLOCK(dev);
 970         if (ret != 0) {
 971                 i915_gem_cleanup_aliasing_ppgtt(dev);
 972                 return (ret);
 973         }
 974
 975 #if 0
 976         /* Try to set up FBC with a reasonable compressed buffer size */
 977         if (I915_HAS_FBC(dev) && i915_powersave) {
 978                 int cfb_size;
 979
 980                 /* Leave 1M for line length buffer & misc. */
 981
 982                 /* Try to get a 32M buffer... */
 983                 if (prealloc_size > (36*1024*1024))
 984                         cfb_size = 32*1024*1024;
 985                 else /* fall back to 7/8 of the stolen space */
 986                         cfb_size = prealloc_size * 7 / 8;
 987                 i915_setup_compression(dev, cfb_size);
 988         }
 989 #endif
 990
 991         /* Allow hardware batchbuffers unless told otherwise. */
 992         dev_priv->allow_batchbuffer = 1;
 993         return 0;
 994 }
 995
 996 static int
 997 i915_load_modeset_init(struct drm_device *dev)
 998 {
 999         struct drm_i915_private *dev_priv = dev->dev_private;
1000         int ret;
1001
1002         ret = intel_parse_bios(dev);
1003         if (ret)
1004                 DRM_INFO("failed to find VBIOS tables\n");
1005
1006 #if 0
1007         intel_register_dsm_handler();
1008 #endif
1009
1010         /* IIR "flip pending" bit means done if this bit is set */
1011         if (IS_GEN3(dev) && (I915_READ(ECOSKPD) & ECO_FLIP_DONE))
1012                 dev_priv->flip_pending_is_done = true;
1013
1014         intel_modeset_init(dev);
1015
1016         ret = i915_load_gem_init(dev);
1017         if (ret != 0)
1018                 goto cleanup_gem;
1019
1020         intel_modeset_gem_init(dev);
1021
1022         ret = drm_irq_install(dev);
1023         if (ret)
1024                 goto cleanup_gem;
1025
1026         dev->vblank_disable_allowed = 1;
1027
1028         ret = intel_fbdev_init(dev);
1029         if (ret)
1030                 goto cleanup_gem;
1031
1032         drm_kms_helper_poll_init(dev);
1033
1034         /* We're off and running w/KMS */
1035         dev_priv->mm.suspended = 0;
1036
1037         return (0);
1038
1039 cleanup_gem:
1040         DRM_LOCK(dev);
1041         i915_gem_cleanup_ringbuffer(dev);
1042         DRM_UNLOCK(dev);
1043         i915_gem_cleanup_aliasing_ppgtt(dev);
1044         return (ret);
1045 }
1046
1047 static int
1048 i915_get_bridge_dev(struct drm_device *dev)
1049 {
1050         struct drm_i915_private *dev_priv;
1051
1052         dev_priv = dev->dev_private;
1053
1054         dev_priv->bridge_dev = intel_gtt_get_bridge_device();
1055         if (dev_priv->bridge_dev == NULL) {
1056                 DRM_ERROR("bridge device not found\n");
1057                 return (-1);
1058         }
1059         return (0);
1060 }
1061
1062 #define MCHBAR_I915 0x44
1063 #define MCHBAR_I965 0x48
1064 #define MCHBAR_SIZE (4*4096)
1065
1066 #define DEVEN_REG 0x54
1067 #define   DEVEN_MCHBAR_EN (1 << 28)
1068
1069 /* Allocate space for the MCH regs if needed, return nonzero on error */
1070 static int
1071 intel_alloc_mchbar_resource(struct drm_device *dev)
1072 {
1073         drm_i915_private_t *dev_priv;
1074         device_t vga;
1075         int reg;
1076         u32 temp_lo, temp_hi;
1077         u64 mchbar_addr, temp;
1078
1079         dev_priv = dev->dev_private;
1080         reg = INTEL_INFO(dev)->gen >= 4 ? MCHBAR_I965 : MCHBAR_I915;
1081
1082         if (INTEL_INFO(dev)->gen >= 4)
1083                 temp_hi = pci_read_config(dev_priv->bridge_dev, reg + 4, 4);
1084         else
1085                 temp_hi = 0;
1086         temp_lo = pci_read_config(dev_priv->bridge_dev, reg, 4);
1087         mchbar_addr = ((u64)temp_hi << 32) | temp_lo;
1088
1089         /* If ACPI doesn't have it, assume we need to allocate it ourselves */
1090 #ifdef XXX_CONFIG_PNP
1091         if (mchbar_addr &&
1092             pnp_range_reserved(mchbar_addr, mchbar_addr + MCHBAR_SIZE))
1093                 return 0;
1094 #endif
1095
1096         /* Get some space for it */
1097         vga = device_get_parent(dev->device);
1098         dev_priv->mch_res_rid = 0x100;
1099         dev_priv->mch_res = BUS_ALLOC_RESOURCE(device_get_parent(vga),
1100             dev->device, SYS_RES_MEMORY, &dev_priv->mch_res_rid, 0, ~0UL,
1101             MCHBAR_SIZE, RF_ACTIVE | RF_SHAREABLE);
1102         if (dev_priv->mch_res == NULL) {
1103                 DRM_ERROR("failed mchbar resource alloc\n");
1104                 return (-ENOMEM);
1105         }
1106
1107         if (INTEL_INFO(dev)->gen >= 4) {
1108                 temp = rman_get_start(dev_priv->mch_res);
1109                 temp >>= 32;
1110                 pci_write_config(dev_priv->bridge_dev, reg + 4, temp, 4);
1111         }
1112         pci_write_config(dev_priv->bridge_dev, reg,
1113             rman_get_start(dev_priv->mch_res) & UINT32_MAX, 4);
1114         return (0);
1115 }
1116
1117 static void
1118 intel_setup_mchbar(struct drm_device *dev)
1119 {
1120         drm_i915_private_t *dev_priv;
1121         int mchbar_reg;
1122         u32 temp;
1123         bool enabled;
1124
1125         dev_priv = dev->dev_private;
1126         mchbar_reg = INTEL_INFO(dev)->gen >= 4 ? MCHBAR_I965 : MCHBAR_I915;
1127
1128         dev_priv->mchbar_need_disable = false;
1129
1130         if (IS_I915G(dev) || IS_I915GM(dev)) {
1131                 temp = pci_read_config(dev_priv->bridge_dev, DEVEN_REG, 4);
1132                 enabled = (temp & DEVEN_MCHBAR_EN) != 0;
1133         } else {
1134                 temp = pci_read_config(dev_priv->bridge_dev, mchbar_reg, 4);
1135                 enabled = temp & 1;
1136         }
1137
1138         /* If it's already enabled, don't have to do anything */
1139         if (enabled) {
1140                 DRM_DEBUG("mchbar already enabled\n");
1141                 return;
1142         }
1143
1144         if (intel_alloc_mchbar_resource(dev))
1145                 return;
1146
1147         dev_priv->mchbar_need_disable = true;
1148
1149         /* Space is allocated or reserved, so enable it. */
1150         if (IS_I915G(dev) || IS_I915GM(dev)) {
1151                 pci_write_config(dev_priv->bridge_dev, DEVEN_REG,
1152                     temp | DEVEN_MCHBAR_EN, 4);
1153         } else {
1154                 temp = pci_read_config(dev_priv->bridge_dev, mchbar_reg, 4);
1155                 pci_write_config(dev_priv->bridge_dev, mchbar_reg, temp | 1, 4);
1156         }
1157 }
1158
1159 static void
1160 intel_teardown_mchbar(struct drm_device *dev)
1161 {
1162         drm_i915_private_t *dev_priv;
1163         device_t vga;
1164         int mchbar_reg;
1165         u32 temp;
1166
1167         dev_priv = dev->dev_private;
1168         mchbar_reg = INTEL_INFO(dev)->gen >= 4 ? MCHBAR_I965 : MCHBAR_I915;
1169
1170         if (dev_priv->mchbar_need_disable) {
1171                 if (IS_I915G(dev) || IS_I915GM(dev)) {
1172                         temp = pci_read_config(dev_priv->bridge_dev,
1173                             DEVEN_REG, 4);
1174                         temp &= ~DEVEN_MCHBAR_EN;
1175                         pci_write_config(dev_priv->bridge_dev, DEVEN_REG,
1176                             temp, 4);
1177                 } else {
1178                         temp = pci_read_config(dev_priv->bridge_dev,
1179                             mchbar_reg, 4);
1180                         temp &= ~1;
1181                         pci_write_config(dev_priv->bridge_dev, mchbar_reg,
1182                             temp, 4);
1183                 }
1184         }
1185
1186         if (dev_priv->mch_res != NULL) {
1187                 vga = device_get_parent(dev->device);
1188                 BUS_DEACTIVATE_RESOURCE(device_get_parent(vga), dev->device,
1189                     SYS_RES_MEMORY, dev_priv->mch_res_rid, dev_priv->mch_res);
1190                 BUS_RELEASE_RESOURCE(device_get_parent(vga), dev->device,
1191                     SYS_RES_MEMORY, dev_priv->mch_res_rid, dev_priv->mch_res);
1192                 dev_priv->mch_res = NULL;
1193         }
1194 }
1195
1196 int
1197 i915_driver_load(struct drm_device *dev, unsigned long flags)
1198 {
1199         struct drm_i915_private *dev_priv = dev->dev_private;
1200         unsigned long base, size;
1201         int mmio_bar, ret;
1202
1203         ret = 0;
1204
1205         /* i915 has 4 more counters */
1206         dev->counters += 4;
1207         dev->types[6] = _DRM_STAT_IRQ;
1208         dev->types[7] = _DRM_STAT_PRIMARY;
1209         dev->types[8] = _DRM_STAT_SECONDARY;
1210         dev->types[9] = _DRM_STAT_DMA;
1211
1212         dev_priv = malloc(sizeof(drm_i915_private_t), DRM_MEM_DRIVER,
1213             M_ZERO | M_WAITOK);
1214         if (dev_priv == NULL)
1215                 return -ENOMEM;
1216
1217         dev->dev_private = (void *)dev_priv;
1218         dev_priv->dev = dev;
1219         dev_priv->info = i915_get_device_id(dev->pci_device);
1220
1221         if (i915_get_bridge_dev(dev)) {
1222                 free(dev_priv, DRM_MEM_DRIVER);
1223                 return (-EIO);
1224         }
1225         dev_priv->mm.gtt = intel_gtt_get();
1226
1227         /* Add register map (needed for suspend/resume) */
1228         mmio_bar = IS_GEN2(dev) ? 1 : 0;
1229         base = drm_get_resource_start(dev, mmio_bar);
1230         size = drm_get_resource_len(dev, mmio_bar);
1231
1232         ret = drm_addmap(dev, base, size, _DRM_REGISTERS,
1233             _DRM_KERNEL | _DRM_DRIVER, &dev_priv->mmio_map);
1234
1235         dev_priv->tq = taskqueue_create("915", M_WAITOK,
1236             taskqueue_thread_enqueue, &dev_priv->tq);
1237         taskqueue_start_threads(&dev_priv->tq, 1, PWAIT, "i915 taskq");
1238         mtx_init(&dev_priv->gt_lock, "915gt", NULL, MTX_DEF);
1239         mtx_init(&dev_priv->error_lock, "915err", NULL, MTX_DEF);
1240         mtx_init(&dev_priv->error_completion_lock, "915cmp", NULL, MTX_DEF);
1241         mtx_init(&dev_priv->rps_lock, "915rps", NULL, MTX_DEF);
1242
1243         dev_priv->has_gem = 1;
1244         intel_irq_init(dev);
1245
1246         intel_setup_mchbar(dev);
1247         intel_setup_gmbus(dev);
1248         intel_opregion_setup(dev);
1249
1250         intel_setup_bios(dev);
1251
1252         i915_gem_load(dev);
1253
1254         /* Init HWS */
1255         if (!I915_NEED_GFX_HWS(dev)) {
1256                 ret = i915_init_phys_hws(dev);
1257                 if (ret != 0) {
1258                         drm_rmmap(dev, dev_priv->mmio_map);
1259                         drm_free(dev_priv, sizeof(struct drm_i915_private),
1260                             DRM_MEM_DRIVER);
1261                         return ret;
1262                 }
1263         }
1264
1265         if (IS_PINEVIEW(dev))
1266                 i915_pineview_get_mem_freq(dev);
1267         else if (IS_GEN5(dev))
1268                 i915_ironlake_get_mem_freq(dev);
1269
1270         mtx_init(&dev_priv->irq_lock, "userirq", NULL, MTX_DEF);
1271
1272         if (IS_IVYBRIDGE(dev))
1273                 dev_priv->num_pipe = 3;
1274         else if (IS_MOBILE(dev) || !IS_GEN2(dev))
1275                 dev_priv->num_pipe = 2;
1276         else
1277                 dev_priv->num_pipe = 1;
1278
1279         ret = drm_vblank_init(dev, dev_priv->num_pipe);
1280         if (ret)
1281                 goto out_gem_unload;
1282
1283         /* Start out suspended */
1284         dev_priv->mm.suspended = 1;
1285
1286         intel_detect_pch(dev);
1287
1288         if (drm_core_check_feature(dev, DRIVER_MODESET)) {
1289                 DRM_UNLOCK(dev);
1290                 ret = i915_load_modeset_init(dev);
1291                 DRM_LOCK(dev);
1292                 if (ret < 0) {
1293                         DRM_ERROR("failed to init modeset\n");
1294                         goto out_gem_unload;
1295                 }
1296         }
1297
1298         intel_opregion_init(dev);
1299
1300         callout_init(&dev_priv->hangcheck_timer, 1);
1301         callout_reset(&dev_priv->hangcheck_timer, DRM_I915_HANGCHECK_PERIOD,
1302             i915_hangcheck_elapsed, dev);
1303
1304         if (IS_GEN5(dev)) {
1305                 mtx_lock(&mchdev_lock);
1306                 i915_mch_dev = dev_priv;
1307                 dev_priv->mchdev_lock = &mchdev_lock;
1308                 mtx_unlock(&mchdev_lock);
1309         }
1310
1311         return (0);
1312
1313 out_gem_unload:
1314         /* XXXKIB */
1315         (void) i915_driver_unload_int(dev, true);
1316         return (ret);
1317 }
1318
1319 static int
1320 i915_driver_unload_int(struct drm_device *dev, bool locked)
1321 {
1322         struct drm_i915_private *dev_priv = dev->dev_private;
1323         int ret;
1324
1325         if (!locked)
1326                 DRM_LOCK(dev);
1327         ret = i915_gpu_idle(dev, true);
1328         if (ret)
1329                 DRM_ERROR("failed to idle hardware: %d\n", ret);
1330         if (!locked)
1331                 DRM_UNLOCK(dev);
1332
1333         i915_free_hws(dev);
1334
1335         intel_teardown_mchbar(dev);
1336
1337         if (locked)
1338                 DRM_UNLOCK(dev);
1339         if (drm_core_check_feature(dev, DRIVER_MODESET)) {
1340                 intel_fbdev_fini(dev);
1341                 intel_modeset_cleanup(dev);
1342         }
1343
1344         /* Free error state after interrupts are fully disabled. */
1345         callout_stop(&dev_priv->hangcheck_timer);
1346         callout_drain(&dev_priv->hangcheck_timer);
1347
1348         i915_destroy_error_state(dev);
1349
1350         intel_opregion_fini(dev);
1351
1352         if (locked)
1353                 DRM_LOCK(dev);
1354
1355         if (drm_core_check_feature(dev, DRIVER_MODESET)) {
1356                 if (!locked)
1357                         DRM_LOCK(dev);
1358                 i915_gem_free_all_phys_object(dev);
1359                 i915_gem_cleanup_ringbuffer(dev);
1360                 i915_gem_context_fini(dev);
1361                 if (!locked)
1362                         DRM_UNLOCK(dev);
1363                 i915_gem_cleanup_aliasing_ppgtt(dev);
1364 #if 1
1365                 KIB_NOTYET();
1366 #else
1367                 if (I915_HAS_FBC(dev) && i915_powersave)
1368                         i915_cleanup_compression(dev);
1369 #endif
1370                 drm_mm_takedown(&dev_priv->mm.stolen);
1371
1372                 intel_cleanup_overlay(dev);
1373
1374                 if (!I915_NEED_GFX_HWS(dev))
1375                         i915_free_hws(dev);
1376         }
1377
1378         i915_gem_unload(dev);
1379
1380         mtx_destroy(&dev_priv->irq_lock);
1381
1382         if (dev_priv->tq != NULL)
1383                 taskqueue_free(dev_priv->tq);
1384
1385         bus_generic_detach(dev->device);
1386         drm_rmmap(dev, dev_priv->mmio_map);
1387         intel_teardown_gmbus(dev);
1388
1389         mtx_destroy(&dev_priv->error_lock);
1390         mtx_destroy(&dev_priv->error_completion_lock);
1391         mtx_destroy(&dev_priv->rps_lock);
1392         drm_free(dev->dev_private, sizeof(drm_i915_private_t),
1393             DRM_MEM_DRIVER);
1394
1395         return (0);
1396 }
1397
1398 int
1399 i915_driver_unload(struct drm_device *dev)
1400 {
1401
1402         return (i915_driver_unload_int(dev, true));
1403 }
1404
1405 int
1406 i915_driver_open(struct drm_device *dev, struct drm_file *file_priv)
1407 {
1408         struct drm_i915_file_private *i915_file_priv;
1409
1410         i915_file_priv = malloc(sizeof(*i915_file_priv), DRM_MEM_FILES,
1411             M_WAITOK | M_ZERO);
1412
1413         mtx_init(&i915_file_priv->mm.lck, "915fp", NULL, MTX_DEF);
1414         INIT_LIST_HEAD(&i915_file_priv->mm.request_list);
1415         file_priv->driver_priv = i915_file_priv;
1416
1417         drm_gem_names_init(&i915_file_priv->context_idr);
1418
1419         return (0);
1420 }
1421
1422 void
1423 i915_driver_lastclose(struct drm_device * dev)
1424 {
1425         drm_i915_private_t *dev_priv = dev->dev_private;
1426
1427         if (!dev_priv || drm_core_check_feature(dev, DRIVER_MODESET)) {
1428 #if 1
1429                 KIB_NOTYET();
1430 #else
1431                 drm_fb_helper_restore();
1432                 vga_switcheroo_process_delayed_switch();
1433 #endif
1434                 return;
1435         }
1436         i915_gem_lastclose(dev);
1437         i915_dma_cleanup(dev);
1438 }
1439
1440 void i915_driver_preclose(struct drm_device * dev, struct drm_file *file_priv)
1441 {
1442
1443         i915_gem_context_close(dev, file_priv);
1444         i915_gem_release(dev, file_priv);
1445 }
1446
1447 void i915_driver_postclose(struct drm_device *dev, struct drm_file *file_priv)
1448 {
1449         struct drm_i915_file_private *i915_file_priv = file_priv->driver_priv;
1450
1451         mtx_destroy(&i915_file_priv->mm.lck);
1452         drm_free(i915_file_priv, sizeof(*i915_file_priv), DRM_MEM_FILES);
1453 }
1454
1455 struct drm_ioctl_desc i915_ioctls[] = {
1456         DRM_IOCTL_DEF(DRM_I915_INIT, i915_dma_init, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
1457         DRM_IOCTL_DEF(DRM_I915_FLUSH, i915_flush_ioctl, DRM_AUTH),
1458         DRM_IOCTL_DEF(DRM_I915_FLIP, i915_flip_bufs, DRM_AUTH),
1459         DRM_IOCTL_DEF(DRM_I915_BATCHBUFFER, i915_batchbuffer, DRM_AUTH),
1460         DRM_IOCTL_DEF(DRM_I915_IRQ_EMIT, i915_irq_emit, DRM_AUTH),
1461         DRM_IOCTL_DEF(DRM_I915_IRQ_WAIT, i915_irq_wait, DRM_AUTH),
1462         DRM_IOCTL_DEF(DRM_I915_GETPARAM, i915_getparam, DRM_AUTH),
1463         DRM_IOCTL_DEF(DRM_I915_SETPARAM, i915_setparam, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
1464         DRM_IOCTL_DEF(DRM_I915_ALLOC, drm_noop, DRM_AUTH),
1465         DRM_IOCTL_DEF(DRM_I915_FREE, drm_noop, DRM_AUTH),
1466         DRM_IOCTL_DEF(DRM_I915_INIT_HEAP, drm_noop, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
1467         DRM_IOCTL_DEF(DRM_I915_CMDBUFFER, i915_cmdbuffer, DRM_AUTH),
1468         DRM_IOCTL_DEF(DRM_I915_DESTROY_HEAP,  drm_noop, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY ),
1469         DRM_IOCTL_DEF(DRM_I915_SET_VBLANK_PIPE,  i915_vblank_pipe_set, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY ),
1470         DRM_IOCTL_DEF(DRM_I915_GET_VBLANK_PIPE,  i915_vblank_pipe_get, DRM_AUTH ),
1471         DRM_IOCTL_DEF(DRM_I915_VBLANK_SWAP, i915_vblank_swap, DRM_AUTH),
1472         DRM_IOCTL_DEF(DRM_I915_HWS_ADDR, i915_set_status_page, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
1473         DRM_IOCTL_DEF(DRM_I915_GEM_INIT, i915_gem_init_ioctl, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
1474         DRM_IOCTL_DEF(DRM_I915_GEM_EXECBUFFER, i915_gem_execbuffer, DRM_AUTH | DRM_UNLOCKED),
1475         DRM_IOCTL_DEF(DRM_I915_GEM_EXECBUFFER2, i915_gem_execbuffer2, DRM_AUTH | DRM_UNLOCKED),
1476         DRM_IOCTL_DEF(DRM_I915_GEM_PIN, i915_gem_pin_ioctl, DRM_AUTH|DRM_ROOT_ONLY|DRM_UNLOCKED),
1477         DRM_IOCTL_DEF(DRM_I915_GEM_UNPIN, i915_gem_unpin_ioctl, DRM_AUTH|DRM_ROOT_ONLY|DRM_UNLOCKED),
1478         DRM_IOCTL_DEF(DRM_I915_GEM_BUSY, i915_gem_busy_ioctl, DRM_AUTH|DRM_UNLOCKED),
1479         DRM_IOCTL_DEF(DRM_I915_GEM_THROTTLE, i915_gem_throttle_ioctl, DRM_AUTH),
1480         DRM_IOCTL_DEF(DRM_I915_GEM_ENTERVT, i915_gem_entervt_ioctl, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
1481         DRM_IOCTL_DEF(DRM_I915_GEM_LEAVEVT, i915_gem_leavevt_ioctl, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
1482         DRM_IOCTL_DEF(DRM_I915_GEM_CREATE, i915_gem_create_ioctl, 0),
1483         DRM_IOCTL_DEF(DRM_I915_GEM_PREAD, i915_gem_pread_ioctl, DRM_UNLOCKED),
1484         DRM_IOCTL_DEF(DRM_I915_GEM_PWRITE, i915_gem_pwrite_ioctl, DRM_UNLOCKED),
1485         DRM_IOCTL_DEF(DRM_I915_GEM_MMAP, i915_gem_mmap_ioctl, 0),
1486         DRM_IOCTL_DEF(DRM_I915_GEM_MMAP_GTT, i915_gem_mmap_gtt_ioctl, DRM_UNLOCKED),
1487         DRM_IOCTL_DEF(DRM_I915_GEM_SET_DOMAIN, i915_gem_set_domain_ioctl, DRM_UNLOCKED),
1488         DRM_IOCTL_DEF(DRM_I915_GEM_SW_FINISH, i915_gem_sw_finish_ioctl, DRM_UNLOCKED),
1489         DRM_IOCTL_DEF(DRM_I915_GEM_SET_TILING, i915_gem_set_tiling, 0),
1490         DRM_IOCTL_DEF(DRM_I915_GEM_GET_TILING, i915_gem_get_tiling, 0),
1491         DRM_IOCTL_DEF(DRM_I915_GEM_GET_APERTURE, i915_gem_get_aperture_ioctl, DRM_UNLOCKED),
1492         DRM_IOCTL_DEF(DRM_I915_GET_PIPE_FROM_CRTC_ID, intel_get_pipe_from_crtc_id, DRM_UNLOCKED),
1493         DRM_IOCTL_DEF(DRM_I915_GEM_MADVISE, i915_gem_madvise_ioctl, DRM_UNLOCKED),
1494         DRM_IOCTL_DEF(DRM_I915_OVERLAY_PUT_IMAGE, intel_overlay_put_image, DRM_MASTER|DRM_CONTROL_ALLOW|DRM_UNLOCKED),
1495         DRM_IOCTL_DEF(DRM_I915_OVERLAY_ATTRS, intel_overlay_attrs, DRM_MASTER|DRM_CONTROL_ALLOW|DRM_UNLOCKED),
1496         DRM_IOCTL_DEF(DRM_I915_SET_SPRITE_COLORKEY, intel_sprite_set_colorkey, DRM_MASTER|DRM_CONTROL_ALLOW|DRM_UNLOCKED),
1497         DRM_IOCTL_DEF(DRM_I915_GET_SPRITE_COLORKEY, intel_sprite_get_colorkey, DRM_MASTER|DRM_CONTROL_ALLOW|DRM_UNLOCKED),
1498         DRM_IOCTL_DEF(DRM_I915_GEM_CONTEXT_CREATE, i915_gem_context_create_ioctl, DRM_UNLOCKED),
1499         DRM_IOCTL_DEF(DRM_I915_GEM_CONTEXT_DESTROY, i915_gem_context_destroy_ioctl, DRM_UNLOCKED),
1500 };
1501
1502 #ifdef COMPAT_FREEBSD32
1503 extern drm_ioctl_desc_t i915_compat_ioctls[];
1504 extern int i915_compat_ioctls_nr;
1505 #endif
1506
1507 struct drm_driver_info i915_driver_info = {
1508         .driver_features =   DRIVER_USE_AGP | DRIVER_REQUIRE_AGP |
1509             DRIVER_USE_MTRR | DRIVER_HAVE_IRQ | DRIVER_LOCKLESS_IRQ |
1510             DRIVER_GEM /*| DRIVER_MODESET*/,
1511
1512         .buf_priv_size  = sizeof(drm_i915_private_t),
1513         .load           = i915_driver_load,
1514         .open           = i915_driver_open,
1515         .unload         = i915_driver_unload,
1516         .preclose       = i915_driver_preclose,
1517         .lastclose      = i915_driver_lastclose,
1518         .postclose      = i915_driver_postclose,
1519         .device_is_agp  = i915_driver_device_is_agp,
1520         .gem_init_object = i915_gem_init_object,
1521         .gem_free_object = i915_gem_free_object,
1522         .gem_pager_ops  = &i915_gem_pager_ops,
1523         .dumb_create    = i915_gem_dumb_create,
1524         .dumb_map_offset = i915_gem_mmap_gtt,
1525         .dumb_destroy   = i915_gem_dumb_destroy,
1526         .sysctl_init    = i915_sysctl_init,
1527         .sysctl_cleanup = i915_sysctl_cleanup,
1528
1529         .ioctls         = i915_ioctls,
1530 #ifdef COMPAT_FREEBSD32
1531         .compat_ioctls  = i915_compat_ioctls,
1532         .compat_ioctls_nr = &i915_compat_ioctls_nr,
1533 #endif
1534         .max_ioctl      = DRM_ARRAY_SIZE(i915_ioctls),
1535
1536         .name           = DRIVER_NAME,
1537         .desc           = DRIVER_DESC,
1538         .date           = DRIVER_DATE,
1539         .major          = DRIVER_MAJOR,
1540         .minor          = DRIVER_MINOR,
1541         .patchlevel     = DRIVER_PATCHLEVEL,
1542 };
1543
1544 /**
1545  * Determine if the device really is AGP or not.
1546  *
1547  * All Intel graphics chipsets are treated as AGP, even if they are really
1548  * built-in.
1549  *
1550  * \param dev   The device to be tested.
1551  *
1552  * \returns
1553  * A value of 1 is always retured to indictate every i9x5 is AGP.
1554  */
1555 int i915_driver_device_is_agp(struct drm_device * dev)
1556 {
1557         return 1;
1558 }
1559
1560 static void i915_pineview_get_mem_freq(struct drm_device *dev)
1561 {
1562         drm_i915_private_t *dev_priv = dev->dev_private;
1563         u32 tmp;
1564
1565         tmp = I915_READ(CLKCFG);
1566
1567         switch (tmp & CLKCFG_FSB_MASK) {
1568         case CLKCFG_FSB_533:
1569                 dev_priv->fsb_freq = 533; /* 133*4 */
1570                 break;
1571         case CLKCFG_FSB_800:
1572                 dev_priv->fsb_freq = 800; /* 200*4 */
1573                 break;
1574         case CLKCFG_FSB_667:
1575                 dev_priv->fsb_freq =  667; /* 167*4 */
1576                 break;
1577         case CLKCFG_FSB_400:
1578                 dev_priv->fsb_freq = 400; /* 100*4 */
1579                 break;
1580         }
1581
1582         switch (tmp & CLKCFG_MEM_MASK) {
1583         case CLKCFG_MEM_533:
1584                 dev_priv->mem_freq = 533;
1585                 break;
1586         case CLKCFG_MEM_667:
1587                 dev_priv->mem_freq = 667;
1588                 break;
1589         case CLKCFG_MEM_800:
1590                 dev_priv->mem_freq = 800;
1591                 break;
1592         }
1593
1594         /* detect pineview DDR3 setting */
1595         tmp = I915_READ(CSHRDDR3CTL);
1596         dev_priv->is_ddr3 = (tmp & CSHRDDR3CTL_DDR3) ? 1 : 0;
1597 }
1598
1599 static void i915_ironlake_get_mem_freq(struct drm_device *dev)
1600 {
1601         drm_i915_private_t *dev_priv = dev->dev_private;
1602         u16 ddrpll, csipll;
1603
1604         ddrpll = I915_READ16(DDRMPLL1);
1605         csipll = I915_READ16(CSIPLL0);
1606
1607         switch (ddrpll & 0xff) {
1608         case 0xc:
1609                 dev_priv->mem_freq = 800;
1610                 break;
1611         case 0x10:
1612                 dev_priv->mem_freq = 1066;
1613                 break;
1614         case 0x14:
1615                 dev_priv->mem_freq = 1333;
1616                 break;
1617         case 0x18:
1618                 dev_priv->mem_freq = 1600;
1619                 break;
1620         default:
1621                 DRM_DEBUG("unknown memory frequency 0x%02x\n",
1622                                  ddrpll & 0xff);
1623                 dev_priv->mem_freq = 0;
1624                 break;
1625         }
1626
1627         dev_priv->r_t = dev_priv->mem_freq;
1628
1629         switch (csipll & 0x3ff) {
1630         case 0x00c:
1631                 dev_priv->fsb_freq = 3200;
1632                 break;
1633         case 0x00e:
1634                 dev_priv->fsb_freq = 3733;
1635                 break;
1636         case 0x010:
1637                 dev_priv->fsb_freq = 4266;
1638                 break;
1639         case 0x012:
1640                 dev_priv->fsb_freq = 4800;
1641                 break;
1642         case 0x014:
1643                 dev_priv->fsb_freq = 5333;
1644                 break;
1645         case 0x016:
1646                 dev_priv->fsb_freq = 5866;
1647                 break;
1648         case 0x018:
1649                 dev_priv->fsb_freq = 6400;
1650                 break;
1651         default:
1652                 DRM_DEBUG("unknown fsb frequency 0x%04x\n",
1653                                  csipll & 0x3ff);
1654                 dev_priv->fsb_freq = 0;
1655                 break;
1656         }
1657
1658         if (dev_priv->fsb_freq == 3200) {
1659                 dev_priv->c_m = 0;
1660         } else if (dev_priv->fsb_freq > 3200 && dev_priv->fsb_freq <= 4800) {
1661                 dev_priv->c_m = 1;
1662         } else {
1663                 dev_priv->c_m = 2;
1664         }
1665 }
1666
1667 static const struct cparams {
1668         u16 i;
1669         u16 t;
1670         u16 m;
1671         u16 c;
1672 } cparams[] = {
1673         { 1, 1333, 301, 28664 },
1674         { 1, 1066, 294, 24460 },
1675         { 1, 800, 294, 25192 },
1676         { 0, 1333, 276, 27605 },
1677         { 0, 1066, 276, 27605 },
1678         { 0, 800, 231, 23784 },
1679 };
1680
1681 unsigned long i915_chipset_val(struct drm_i915_private *dev_priv)
1682 {
1683         u64 total_count, diff, ret;
1684         u32 count1, count2, count3, m = 0, c = 0;
1685         unsigned long now = jiffies_to_msecs(jiffies), diff1;
1686         int i;
1687
1688         diff1 = now - dev_priv->last_time1;
1689         /*
1690          * sysctl(8) reads the value of sysctl twice in rapid
1691          * succession.  There is high chance that it happens in the
1692          * same timer tick.  Use the cached value to not divide by
1693          * zero and give the hw a chance to gather more samples.
1694          */
1695         if (diff1 <= 10)
1696                 return (dev_priv->chipset_power);
1697
1698         count1 = I915_READ(DMIEC);
1699         count2 = I915_READ(DDREC);
1700         count3 = I915_READ(CSIEC);
1701
1702         total_count = count1 + count2 + count3;
1703
1704         /* FIXME: handle per-counter overflow */
1705         if (total_count < dev_priv->last_count1) {
1706                 diff = ~0UL - dev_priv->last_count1;
1707                 diff += total_count;
1708         } else {
1709                 diff = total_count - dev_priv->last_count1;
1710         }
1711
1712         for (i = 0; i < DRM_ARRAY_SIZE(cparams); i++) {
1713                 if (cparams[i].i == dev_priv->c_m &&
1714                     cparams[i].t == dev_priv->r_t) {
1715                         m = cparams[i].m;
1716                         c = cparams[i].c;
1717                         break;
1718                 }
1719         }
1720
1721         diff = diff / diff1;
1722         ret = ((m * diff) + c);
1723         ret = ret / 10;
1724
1725         dev_priv->last_count1 = total_count;
1726         dev_priv->last_time1 = now;
1727
1728         dev_priv->chipset_power = ret;
1729         return (ret);
1730 }
1731
1732 unsigned long i915_mch_val(struct drm_i915_private *dev_priv)
1733 {
1734         unsigned long m, x, b;
1735         u32 tsfs;
1736
1737         tsfs = I915_READ(TSFS);
1738
1739         m = ((tsfs & TSFS_SLOPE_MASK) >> TSFS_SLOPE_SHIFT);
1740         x = I915_READ8(I915_TR1);
1741
1742         b = tsfs & TSFS_INTR_MASK;
1743
1744         return ((m * x) / 127) - b;
1745 }
1746
1747 static u16 pvid_to_extvid(struct drm_i915_private *dev_priv, u8 pxvid)
1748 {
1749         static const struct v_table {
1750                 u16 vd; /* in .1 mil */
1751                 u16 vm; /* in .1 mil */
1752         } v_table[] = {
1753                 { 0, 0, },
1754                 { 375, 0, },
1755                 { 500, 0, },
1756                 { 625, 0, },
1757                 { 750, 0, },
1758                 { 875, 0, },
1759                 { 1000, 0, },
1760                 { 1125, 0, },
1761                 { 4125, 3000, },
1762                 { 4125, 3000, },
1763                 { 4125, 3000, },
1764                 { 4125, 3000, },
1765                 { 4125, 3000, },
1766                 { 4125, 3000, },
1767                 { 4125, 3000, },
1768                 { 4125, 3000, },
1769                 { 4125, 3000, },
1770                 { 4125, 3000, },
1771                 { 4125, 3000, },
1772                 { 4125, 3000, },
1773                 { 4125, 3000, },
1774                 { 4125, 3000, },
1775                 { 4125, 3000, },
1776                 { 4125, 3000, },
1777                 { 4125, 3000, },
1778                 { 4125, 3000, },
1779                 { 4125, 3000, },
1780                 { 4125, 3000, },
1781                 { 4125, 3000, },
1782                 { 4125, 3000, },
1783                 { 4125, 3000, },
1784                 { 4125, 3000, },
1785                 { 4250, 3125, },
1786                 { 4375, 3250, },
1787                 { 4500, 3375, },
1788                 { 4625, 3500, },
1789                 { 4750, 3625, },
1790                 { 4875, 3750, },
1791                 { 5000, 3875, },
1792                 { 5125, 4000, },
1793                 { 5250, 4125, },
1794                 { 5375, 4250, },
1795                 { 5500, 4375, },
1796                 { 5625, 4500, },
1797                 { 5750, 4625, },
1798                 { 5875, 4750, },
1799                 { 6000, 4875, },
1800                 { 6125, 5000, },
1801                 { 6250, 5125, },
1802                 { 6375, 5250, },
1803                 { 6500, 5375, },
1804                 { 6625, 5500, },
1805                 { 6750, 5625, },
1806                 { 6875, 5750, },
1807                 { 7000, 5875, },
1808                 { 7125, 6000, },
1809                 { 7250, 6125, },
1810                 { 7375, 6250, },
1811                 { 7500, 6375, },
1812                 { 7625, 6500, },
1813                 { 7750, 6625, },
1814                 { 7875, 6750, },
1815                 { 8000, 6875, },
1816                 { 8125, 7000, },
1817                 { 8250, 7125, },
1818                 { 8375, 7250, },
1819                 { 8500, 7375, },
1820                 { 8625, 7500, },
1821                 { 8750, 7625, },
1822                 { 8875, 7750, },
1823                 { 9000, 7875, },
1824                 { 9125, 8000, },
1825                 { 9250, 8125, },
1826                 { 9375, 8250, },
1827                 { 9500, 8375, },
1828                 { 9625, 8500, },
1829                 { 9750, 8625, },
1830                 { 9875, 8750, },
1831                 { 10000, 8875, },
1832                 { 10125, 9000, },
1833                 { 10250, 9125, },
1834                 { 10375, 9250, },
1835                 { 10500, 9375, },
1836                 { 10625, 9500, },
1837                 { 10750, 9625, },
1838                 { 10875, 9750, },
1839                 { 11000, 9875, },
1840                 { 11125, 10000, },
1841                 { 11250, 10125, },
1842                 { 11375, 10250, },
1843                 { 11500, 10375, },
1844                 { 11625, 10500, },
1845                 { 11750, 10625, },
1846                 { 11875, 10750, },
1847                 { 12000, 10875, },
1848                 { 12125, 11000, },
1849                 { 12250, 11125, },
1850                 { 12375, 11250, },
1851                 { 12500, 11375, },
1852                 { 12625, 11500, },
1853                 { 12750, 11625, },
1854                 { 12875, 11750, },
1855                 { 13000, 11875, },
1856                 { 13125, 12000, },
1857                 { 13250, 12125, },
1858                 { 13375, 12250, },
1859                 { 13500, 12375, },
1860                 { 13625, 12500, },
1861                 { 13750, 12625, },
1862                 { 13875, 12750, },
1863                 { 14000, 12875, },
1864                 { 14125, 13000, },
1865                 { 14250, 13125, },
1866                 { 14375, 13250, },
1867                 { 14500, 13375, },
1868                 { 14625, 13500, },
1869                 { 14750, 13625, },
1870                 { 14875, 13750, },
1871                 { 15000, 13875, },
1872                 { 15125, 14000, },
1873                 { 15250, 14125, },
1874                 { 15375, 14250, },
1875                 { 15500, 14375, },
1876                 { 15625, 14500, },
1877                 { 15750, 14625, },
1878                 { 15875, 14750, },
1879                 { 16000, 14875, },
1880                 { 16125, 15000, },
1881         };
1882         if (dev_priv->info->is_mobile)
1883                 return v_table[pxvid].vm;
1884         else
1885                 return v_table[pxvid].vd;
1886 }
1887
1888 void i915_update_gfx_val(struct drm_i915_private *dev_priv)
1889 {
1890         struct timespec now, diff1;
1891         u64 diff;
1892         unsigned long diffms;
1893         u32 count;
1894
1895         if (dev_priv->info->gen != 5)
1896                 return;
1897
1898         nanotime(&now);
1899         diff1 = now;
1900         timespecsub(&diff1, &dev_priv->last_time2);
1901
1902         /* Don't divide by 0 */
1903         diffms = diff1.tv_sec * 1000 + diff1.tv_nsec / 1000000;
1904         if (!diffms)
1905                 return;
1906
1907         count = I915_READ(GFXEC);
1908
1909         if (count < dev_priv->last_count2) {
1910                 diff = ~0UL - dev_priv->last_count2;
1911                 diff += count;
1912         } else {
1913                 diff = count - dev_priv->last_count2;
1914         }
1915
1916         dev_priv->last_count2 = count;
1917         dev_priv->last_time2 = now;
1918
1919         /* More magic constants... */
1920         diff = diff * 1181;
1921         diff = diff / (diffms * 10);
1922         dev_priv->gfx_power = diff;
1923 }
1924
1925 unsigned long i915_gfx_val(struct drm_i915_private *dev_priv)
1926 {
1927         unsigned long t, corr, state1, corr2, state2;
1928         u32 pxvid, ext_v;
1929
1930         pxvid = I915_READ(PXVFREQ_BASE + (dev_priv->cur_delay * 4));
1931         pxvid = (pxvid >> 24) & 0x7f;
1932         ext_v = pvid_to_extvid(dev_priv, pxvid);
1933
1934         state1 = ext_v;
1935
1936         t = i915_mch_val(dev_priv);
1937
1938         /* Revel in the empirically derived constants */
1939
1940         /* Correction factor in 1/100000 units */
1941         if (t > 80)
1942                 corr = ((t * 2349) + 135940);
1943         else if (t >= 50)
1944                 corr = ((t * 964) + 29317);
1945         else /* < 50 */
1946                 corr = ((t * 301) + 1004);
1947
1948         corr = corr * ((150142 * state1) / 10000 - 78642);
1949         corr /= 100000;
1950         corr2 = (corr * dev_priv->corr);
1951
1952         state2 = (corr2 * state1) / 10000;
1953         state2 /= 100; /* convert to mW */
1954
1955         i915_update_gfx_val(dev_priv);
1956
1957         return dev_priv->gfx_power + state2;
1958 }
1959
1960 /**
1961  * i915_read_mch_val - return value for IPS use
1962  *
1963  * Calculate and return a value for the IPS driver to use when deciding whether
1964  * we have thermal and power headroom to increase CPU or GPU power budget.
1965  */
1966 unsigned long i915_read_mch_val(void)
1967 {
1968         struct drm_i915_private *dev_priv;
1969         unsigned long chipset_val, graphics_val, ret = 0;
1970
1971         mtx_lock(&mchdev_lock);
1972         if (!i915_mch_dev)
1973                 goto out_unlock;
1974         dev_priv = i915_mch_dev;
1975
1976         chipset_val = i915_chipset_val(dev_priv);
1977         graphics_val = i915_gfx_val(dev_priv);
1978
1979         ret = chipset_val + graphics_val;
1980
1981 out_unlock:
1982         mtx_unlock(&mchdev_lock);
1983
1984         return ret;
1985 }
1986
1987 /**
1988  * i915_gpu_raise - raise GPU frequency limit
1989  *
1990  * Raise the limit; IPS indicates we have thermal headroom.
1991  */
1992 bool i915_gpu_raise(void)
1993 {
1994         struct drm_i915_private *dev_priv;
1995         bool ret = true;
1996
1997         mtx_lock(&mchdev_lock);
1998         if (!i915_mch_dev) {
1999                 ret = false;
2000                 goto out_unlock;
2001         }
2002         dev_priv = i915_mch_dev;
2003
2004         if (dev_priv->max_delay > dev_priv->fmax)
2005                 dev_priv->max_delay--;
2006
2007 out_unlock:
2008         mtx_unlock(&mchdev_lock);
2009
2010         return ret;
2011 }
2012
2013 /**
2014  * i915_gpu_lower - lower GPU frequency limit
2015  *
2016  * IPS indicates we're close to a thermal limit, so throttle back the GPU
2017  * frequency maximum.
2018  */
2019 bool i915_gpu_lower(void)
2020 {
2021         struct drm_i915_private *dev_priv;
2022         bool ret = true;
2023
2024         mtx_lock(&mchdev_lock);
2025         if (!i915_mch_dev) {
2026                 ret = false;
2027                 goto out_unlock;
2028         }
2029         dev_priv = i915_mch_dev;
2030
2031         if (dev_priv->max_delay < dev_priv->min_delay)
2032                 dev_priv->max_delay++;
2033
2034 out_unlock:
2035         mtx_unlock(&mchdev_lock);
2036
2037         return ret;
2038 }
2039
2040 /**
2041  * i915_gpu_busy - indicate GPU business to IPS
2042  *
2043  * Tell the IPS driver whether or not the GPU is busy.
2044  */
2045 bool i915_gpu_busy(void)
2046 {
2047         struct drm_i915_private *dev_priv;
2048         bool ret = false;
2049
2050         mtx_lock(&mchdev_lock);
2051         if (!i915_mch_dev)
2052                 goto out_unlock;
2053         dev_priv = i915_mch_dev;
2054
2055         ret = dev_priv->busy;
2056
2057 out_unlock:
2058         mtx_unlock(&mchdev_lock);
2059
2060         return ret;
2061 }
2062
2063 /**
2064  * i915_gpu_turbo_disable - disable graphics turbo
2065  *
2066  * Disable graphics turbo by resetting the max frequency and setting the
2067  * current frequency to the default.
2068  */
2069 bool i915_gpu_turbo_disable(void)
2070 {
2071         struct drm_i915_private *dev_priv;
2072         bool ret = true;
2073
2074         mtx_lock(&mchdev_lock);
2075         if (!i915_mch_dev) {
2076                 ret = false;
2077                 goto out_unlock;
2078         }
2079         dev_priv = i915_mch_dev;
2080
2081         dev_priv->max_delay = dev_priv->fstart;
2082
2083         if (!ironlake_set_drps(dev_priv->dev, dev_priv->fstart))
2084                 ret = false;
2085
2086 out_unlock:
2087         mtx_unlock(&mchdev_lock);
2088
2089         return ret;
2090 }