drivers/gpu/drm/vmwgfx/vmwgfx_kms.c

   1 /**************************************************************************
   2  *
   3  * Copyright © 2009 VMware, Inc., Palo Alto, CA., USA
   4  * All Rights Reserved.
   5  *
   6  * Permission is hereby granted, free of charge, to any person obtaining a
   7  * copy of this software and associated documentation files (the
   8  * "Software"), to deal in the Software without restriction, including
   9  * without limitation the rights to use, copy, modify, merge, publish,
  10  * distribute, sub license, and/or sell copies of the Software, and to
  11  * permit persons to whom the Software is furnished to do so, subject to
  12  * the following conditions:
  13  *
  14  * The above copyright notice and this permission notice (including the
  15  * next paragraph) shall be included in all copies or substantial portions
  16  * of the Software.
  17  *
  18  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  19  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  20  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
  21  * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
  22  * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
  23  * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
  24  * USE OR OTHER DEALINGS IN THE SOFTWARE.
  25  *
  26  **************************************************************************/
  27
  28 #include "vmwgfx_kms.h"
  29
  30 /* Might need a hrtimer here? */
  31 #define VMWGFX_PRESENT_RATE ((HZ / 60 > 0) ? HZ / 60 : 1)
  32
  33 static int vmw_surface_dmabuf_pin(struct vmw_framebuffer *vfb);
  34 static int vmw_surface_dmabuf_unpin(struct vmw_framebuffer *vfb);
  35
  36 void vmw_display_unit_cleanup(struct vmw_display_unit *du)
  37 {
  38         if (du->cursor_surface)
  39                 vmw_surface_unreference(&du->cursor_surface);
  40         if (du->cursor_dmabuf)
  41                 vmw_dmabuf_unreference(&du->cursor_dmabuf);
  42         drm_crtc_cleanup(&du->crtc);
  43         drm_encoder_cleanup(&du->encoder);
  44         drm_connector_cleanup(&du->connector);
  45 }
  46
  47 /*
  48  * Display Unit Cursor functions
  49  */
  50
  51 int vmw_cursor_update_image(struct vmw_private *dev_priv,
  52                             u32 *image, u32 width, u32 height,
  53                             u32 hotspotX, u32 hotspotY)
  54 {
  55         struct {
  56                 u32 cmd;
  57                 SVGAFifoCmdDefineAlphaCursor cursor;
  58         } *cmd;
  59         u32 image_size = width * height * 4;
  60         u32 cmd_size = sizeof(*cmd) + image_size;
  61
  62         if (!image)
  63                 return -EINVAL;
  64
  65         cmd = vmw_fifo_reserve(dev_priv, cmd_size);
  66         if (unlikely(cmd == NULL)) {
  67                 DRM_ERROR("Fifo reserve failed.\n");
  68                 return -ENOMEM;
  69         }
  70
  71         memset(cmd, 0, sizeof(*cmd));
  72
  73         memcpy(&cmd[1], image, image_size);
  74
  75         cmd->cmd = cpu_to_le32(SVGA_CMD_DEFINE_ALPHA_CURSOR);
  76         cmd->cursor.id = cpu_to_le32(0);
  77         cmd->cursor.width = cpu_to_le32(width);
  78         cmd->cursor.height = cpu_to_le32(height);
  79         cmd->cursor.hotspotX = cpu_to_le32(hotspotX);
  80         cmd->cursor.hotspotY = cpu_to_le32(hotspotY);
  81
  82         vmw_fifo_commit(dev_priv, cmd_size);
  83
  84         return 0;
  85 }
  86
  87 void vmw_cursor_update_position(struct vmw_private *dev_priv,
  88                                 bool show, int x, int y)
  89 {
  90         __le32 __iomem *fifo_mem = dev_priv->mmio_virt;
  91         uint32_t count;
  92
  93         iowrite32(show ? 1 : 0, fifo_mem + SVGA_FIFO_CURSOR_ON);
  94         iowrite32(x, fifo_mem + SVGA_FIFO_CURSOR_X);
  95         iowrite32(y, fifo_mem + SVGA_FIFO_CURSOR_Y);
  96         count = ioread32(fifo_mem + SVGA_FIFO_CURSOR_COUNT);
  97         iowrite32(++count, fifo_mem + SVGA_FIFO_CURSOR_COUNT);
  98 }
  99
 100 int vmw_du_crtc_cursor_set(struct drm_crtc *crtc, struct drm_file *file_priv,
 101                            uint32_t handle, uint32_t width, uint32_t height)
 102 {
 103         struct vmw_private *dev_priv = vmw_priv(crtc->dev);
 104         struct ttm_object_file *tfile = vmw_fpriv(file_priv)->tfile;
 105         struct vmw_display_unit *du = vmw_crtc_to_du(crtc);
 106         struct vmw_surface *surface = NULL;
 107         struct vmw_dma_buffer *dmabuf = NULL;
 108         int ret;
 109
 110         if (handle) {
 111                 ret = vmw_user_surface_lookup_handle(dev_priv, tfile,
 112                                                      handle, &surface);
 113                 if (!ret) {
 114                         if (!surface->snooper.image) {
 115                                 DRM_ERROR("surface not suitable for cursor\n");
 116                                 return -EINVAL;
 117                         }
 118                 } else {
 119                         ret = vmw_user_dmabuf_lookup(tfile,
 120                                                      handle, &dmabuf);
 121                         if (ret) {
 122                                 DRM_ERROR("failed to find surface or dmabuf: %i\n", ret);
 123                                 return -EINVAL;
 124                         }
 125                 }
 126         }
 127
 128         /* takedown old cursor */
 129         if (du->cursor_surface) {
 130                 du->cursor_surface->snooper.crtc = NULL;
 131                 vmw_surface_unreference(&du->cursor_surface);
 132         }
 133         if (du->cursor_dmabuf)
 134                 vmw_dmabuf_unreference(&du->cursor_dmabuf);
 135
 136         /* setup new image */
 137         if (surface) {
 138                 /* vmw_user_surface_lookup takes one reference */
 139                 du->cursor_surface = surface;
 140
 141                 du->cursor_surface->snooper.crtc = crtc;
 142                 du->cursor_age = du->cursor_surface->snooper.age;
 143                 vmw_cursor_update_image(dev_priv, surface->snooper.image,
 144                                         64, 64, du->hotspot_x, du->hotspot_y);
 145         } else if (dmabuf) {
 146                 struct ttm_bo_kmap_obj map;
 147                 unsigned long kmap_offset;
 148                 unsigned long kmap_num;
 149                 void *virtual;
 150                 bool dummy;
 151
 152                 /* vmw_user_surface_lookup takes one reference */
 153                 du->cursor_dmabuf = dmabuf;
 154
 155                 kmap_offset = 0;
 156                 kmap_num = (64*64*4) >> PAGE_SHIFT;
 157
 158                 ret = ttm_bo_reserve(&dmabuf->base, true, false, false, 0);
 159                 if (unlikely(ret != 0)) {
 160                         DRM_ERROR("reserve failed\n");
 161                         return -EINVAL;
 162                 }
 163
 164                 ret = ttm_bo_kmap(&dmabuf->base, kmap_offset, kmap_num, &map);
 165                 if (unlikely(ret != 0))
 166                         goto err_unreserve;
 167
 168                 virtual = ttm_kmap_obj_virtual(&map, &dummy);
 169                 vmw_cursor_update_image(dev_priv, virtual, 64, 64,
 170                                         du->hotspot_x, du->hotspot_y);
 171
 172                 ttm_bo_kunmap(&map);
 173 err_unreserve:
 174                 ttm_bo_unreserve(&dmabuf->base);
 175
 176         } else {
 177                 vmw_cursor_update_position(dev_priv, false, 0, 0);
 178                 return 0;
 179         }
 180
 181         vmw_cursor_update_position(dev_priv, true, du->cursor_x, du->cursor_y);
 182
 183         return 0;
 184 }
 185
 186 int vmw_du_crtc_cursor_move(struct drm_crtc *crtc, int x, int y)
 187 {
 188         struct vmw_private *dev_priv = vmw_priv(crtc->dev);
 189         struct vmw_display_unit *du = vmw_crtc_to_du(crtc);
 190         bool shown = du->cursor_surface || du->cursor_dmabuf ? true : false;
 191
 192         du->cursor_x = x + crtc->x;
 193         du->cursor_y = y + crtc->y;
 194
 195         vmw_cursor_update_position(dev_priv, shown,
 196                                    du->cursor_x, du->cursor_y);
 197
 198         return 0;
 199 }
 200
 201 void vmw_kms_cursor_snoop(struct vmw_surface *srf,
 202                           struct ttm_object_file *tfile,
 203                           struct ttm_buffer_object *bo,
 204                           SVGA3dCmdHeader *header)
 205 {
 206         struct ttm_bo_kmap_obj map;
 207         unsigned long kmap_offset;
 208         unsigned long kmap_num;
 209         SVGA3dCopyBox *box;
 210         unsigned box_count;
 211         void *virtual;
 212         bool dummy;
 213         struct vmw_dma_cmd {
 214                 SVGA3dCmdHeader header;
 215                 SVGA3dCmdSurfaceDMA dma;
 216         } *cmd;
 217         int ret;
 218
 219         cmd = container_of(header, struct vmw_dma_cmd, header);
 220
 221         /* No snooper installed */
 222         if (!srf->snooper.image)
 223                 return;
 224
 225         if (cmd->dma.host.face != 0 || cmd->dma.host.mipmap != 0) {
 226                 DRM_ERROR("face and mipmap for cursors should never != 0\n");
 227                 return;
 228         }
 229
 230         if (cmd->header.size < 64) {
 231                 DRM_ERROR("at least one full copy box must be given\n");
 232                 return;
 233         }
 234
 235         box = (SVGA3dCopyBox *)&cmd[1];
 236         box_count = (cmd->header.size - sizeof(SVGA3dCmdSurfaceDMA)) /
 237                         sizeof(SVGA3dCopyBox);
 238
 239         if (cmd->dma.guest.pitch != (64 * 4) ||
 240             cmd->dma.guest.ptr.offset % PAGE_SIZE ||
 241             box->x != 0    || box->y != 0    || box->z != 0    ||
 242             box->srcx != 0 || box->srcy != 0 || box->srcz != 0 ||
 243             box->w != 64   || box->h != 64   || box->d != 1    ||
 244             box_count != 1) {
 245                 /* TODO handle none page aligned offsets */
 246                 /* TODO handle partial uploads and pitch != 256 */
 247                 /* TODO handle more then one copy (size != 64) */
 248                 DRM_ERROR("lazy programer, cant handle wierd stuff\n");
 249                 return;
 250         }
 251
 252         kmap_offset = cmd->dma.guest.ptr.offset >> PAGE_SHIFT;
 253         kmap_num = (64*64*4) >> PAGE_SHIFT;
 254
 255         ret = ttm_bo_reserve(bo, true, false, false, 0);
 256         if (unlikely(ret != 0)) {
 257                 DRM_ERROR("reserve failed\n");
 258                 return;
 259         }
 260
 261         ret = ttm_bo_kmap(bo, kmap_offset, kmap_num, &map);
 262         if (unlikely(ret != 0))
 263                 goto err_unreserve;
 264
 265         virtual = ttm_kmap_obj_virtual(&map, &dummy);
 266
 267         memcpy(srf->snooper.image, virtual, 64*64*4);
 268         srf->snooper.age++;
 269
 270         /* we can't call this function from this function since execbuf has
 271          * reserved fifo space.
 272          *
 273          * if (srf->snooper.crtc)
 274          *      vmw_ldu_crtc_cursor_update_image(dev_priv,
 275          *                                       srf->snooper.image, 64, 64,
 276          *                                       du->hotspot_x, du->hotspot_y);
 277          */
 278
 279         ttm_bo_kunmap(&map);
 280 err_unreserve:
 281         ttm_bo_unreserve(bo);
 282 }
 283
 284 void vmw_kms_cursor_post_execbuf(struct vmw_private *dev_priv)
 285 {
 286         struct drm_device *dev = dev_priv->dev;
 287         struct vmw_display_unit *du;
 288         struct drm_crtc *crtc;
 289
 290         mutex_lock(&dev->mode_config.mutex);
 291
 292         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 293                 du = vmw_crtc_to_du(crtc);
 294                 if (!du->cursor_surface ||
 295                     du->cursor_age == du->cursor_surface->snooper.age)
 296                         continue;
 297
 298                 du->cursor_age = du->cursor_surface->snooper.age;
 299                 vmw_cursor_update_image(dev_priv,
 300                                         du->cursor_surface->snooper.image,
 301                                         64, 64, du->hotspot_x, du->hotspot_y);
 302         }
 303
 304         mutex_unlock(&dev->mode_config.mutex);
 305 }
 306
 307 /*
 308  * Generic framebuffer code
 309  */
 310
 311 int vmw_framebuffer_create_handle(struct drm_framebuffer *fb,
 312                                   struct drm_file *file_priv,
 313                                   unsigned int *handle)
 314 {
 315         if (handle)
 316                 handle = 0;
 317
 318         return 0;
 319 }
 320
 321 /*
 322  * Surface framebuffer code
 323  */
 324
 325 #define vmw_framebuffer_to_vfbs(x) \
 326         container_of(x, struct vmw_framebuffer_surface, base.base)
 327
 328 struct vmw_framebuffer_surface {
 329         struct vmw_framebuffer base;
 330         struct vmw_surface *surface;
 331         struct vmw_dma_buffer *buffer;
 332         struct delayed_work d_work;
 333         struct mutex work_lock;
 334         bool present_fs;
 335         struct list_head head;
 336         struct drm_master *master;
 337 };
 338
 339 /**
 340  * vmw_kms_idle_workqueues - Flush workqueues on this master
 341  *
 342  * @vmaster - Pointer identifying the master, for the surfaces of which
 343  * we idle the dirty work queues.
 344  *
 345  * This function should be called with the ttm lock held in exclusive mode
 346  * to idle all dirty work queues before the fifo is taken down.
 347  *
 348  * The work task may actually requeue itself, but after the flush returns we're
 349  * sure that there's nothing to present, since the ttm lock is held in
 350  * exclusive mode, so the fifo will never get used.
 351  */
 352
 353 void vmw_kms_idle_workqueues(struct vmw_master *vmaster)
 354 {
 355         struct vmw_framebuffer_surface *entry;
 356
 357         mutex_lock(&vmaster->fb_surf_mutex);
 358         list_for_each_entry(entry, &vmaster->fb_surf, head) {
 359                 if (cancel_delayed_work_sync(&entry->d_work))
 360                         (void) entry->d_work.work.func(&entry->d_work.work);
 361
 362                 (void) cancel_delayed_work_sync(&entry->d_work);
 363         }
 364         mutex_unlock(&vmaster->fb_surf_mutex);
 365 }
 366
 367 void vmw_framebuffer_surface_destroy(struct drm_framebuffer *framebuffer)
 368 {
 369         struct vmw_framebuffer_surface *vfbs =
 370                 vmw_framebuffer_to_vfbs(framebuffer);
 371         struct vmw_master *vmaster = vmw_master(vfbs->master);
 372
 373
 374         mutex_lock(&vmaster->fb_surf_mutex);
 375         list_del(&vfbs->head);
 376         mutex_unlock(&vmaster->fb_surf_mutex);
 377
 378         cancel_delayed_work_sync(&vfbs->d_work);
 379         drm_master_put(&vfbs->master);
 380         drm_framebuffer_cleanup(framebuffer);
 381         vmw_surface_unreference(&vfbs->surface);
 382
 383         kfree(vfbs);
 384 }
 385
 386 static void vmw_framebuffer_present_fs_callback(struct work_struct *work)
 387 {
 388         struct delayed_work *d_work =
 389                 container_of(work, struct delayed_work, work);
 390         struct vmw_framebuffer_surface *vfbs =
 391                 container_of(d_work, struct vmw_framebuffer_surface, d_work);
 392         struct vmw_surface *surf = vfbs->surface;
 393         struct drm_framebuffer *framebuffer = &vfbs->base.base;
 394         struct vmw_private *dev_priv = vmw_priv(framebuffer->dev);
 395
 396         struct {
 397                 SVGA3dCmdHeader header;
 398                 SVGA3dCmdPresent body;
 399                 SVGA3dCopyRect cr;
 400         } *cmd;
 401
 402         /**
 403          * Strictly we should take the ttm_lock in read mode before accessing
 404          * the fifo, to make sure the fifo is present and up. However,
 405          * instead we flush all workqueues under the ttm lock in exclusive mode
 406          * before taking down the fifo.
 407          */
 408         mutex_lock(&vfbs->work_lock);
 409         if (!vfbs->present_fs)
 410                 goto out_unlock;
 411
 412         cmd = vmw_fifo_reserve(dev_priv, sizeof(*cmd));
 413         if (unlikely(cmd == NULL))
 414                 goto out_resched;
 415
 416         cmd->header.id = cpu_to_le32(SVGA_3D_CMD_PRESENT);
 417         cmd->header.size = cpu_to_le32(sizeof(cmd->body) + sizeof(cmd->cr));
 418         cmd->body.sid = cpu_to_le32(surf->res.id);
 419         cmd->cr.x = cpu_to_le32(0);
 420         cmd->cr.y = cpu_to_le32(0);
 421         cmd->cr.srcx = cmd->cr.x;
 422         cmd->cr.srcy = cmd->cr.y;
 423         cmd->cr.w = cpu_to_le32(framebuffer->width);
 424         cmd->cr.h = cpu_to_le32(framebuffer->height);
 425         vfbs->present_fs = false;
 426         vmw_fifo_commit(dev_priv, sizeof(*cmd));
 427 out_resched:
 428         /**
 429          * Will not re-add if already pending.
 430          */
 431         schedule_delayed_work(&vfbs->d_work, VMWGFX_PRESENT_RATE);
 432 out_unlock:
 433         mutex_unlock(&vfbs->work_lock);
 434 }
 435
 436
 437 int vmw_framebuffer_surface_dirty(struct drm_framebuffer *framebuffer,
 438                                   struct drm_file *file_priv,
 439                                   unsigned flags, unsigned color,
 440                                   struct drm_clip_rect *clips,
 441                                   unsigned num_clips)
 442 {
 443         struct vmw_private *dev_priv = vmw_priv(framebuffer->dev);
 444         struct vmw_master *vmaster = vmw_master(file_priv->master);
 445         struct vmw_framebuffer_surface *vfbs =
 446                 vmw_framebuffer_to_vfbs(framebuffer);
 447         struct vmw_surface *surf = vfbs->surface;
 448         struct drm_clip_rect norect;
 449         SVGA3dCopyRect *cr;
 450         int i, inc = 1;
 451         int ret;
 452
 453         struct {
 454                 SVGA3dCmdHeader header;
 455                 SVGA3dCmdPresent body;
 456                 SVGA3dCopyRect cr;
 457         } *cmd;
 458
 459         if (unlikely(vfbs->master != file_priv->master))
 460                 return -EINVAL;
 461
 462         ret = ttm_read_lock(&vmaster->lock, true);
 463         if (unlikely(ret != 0))
 464                 return ret;
 465
 466         if (!num_clips ||
 467             !(dev_priv->fifo.capabilities &
 468               SVGA_FIFO_CAP_SCREEN_OBJECT)) {
 469                 int ret;
 470
 471                 mutex_lock(&vfbs->work_lock);
 472                 vfbs->present_fs = true;
 473                 ret = schedule_delayed_work(&vfbs->d_work, VMWGFX_PRESENT_RATE);
 474                 mutex_unlock(&vfbs->work_lock);
 475                 if (ret) {
 476                         /**
 477                          * No work pending, Force immediate present.
 478                          */
 479                         vmw_framebuffer_present_fs_callback(&vfbs->d_work.work);
 480                 }
 481                 ttm_read_unlock(&vmaster->lock);
 482                 return 0;
 483         }
 484
 485         if (!num_clips) {
 486                 num_clips = 1;
 487                 clips = &norect;
 488                 norect.x1 = norect.y1 = 0;
 489                 norect.x2 = framebuffer->width;
 490                 norect.y2 = framebuffer->height;
 491         } else if (flags & DRM_MODE_FB_DIRTY_ANNOTATE_COPY) {
 492                 num_clips /= 2;
 493                 inc = 2; /* skip source rects */
 494         }
 495
 496         cmd = vmw_fifo_reserve(dev_priv, sizeof(*cmd) + (num_clips - 1) * sizeof(cmd->cr));
 497         if (unlikely(cmd == NULL)) {
 498                 DRM_ERROR("Fifo reserve failed.\n");
 499                 ttm_read_unlock(&vmaster->lock);
 500                 return -ENOMEM;
 501         }
 502
 503         memset(cmd, 0, sizeof(*cmd));
 504
 505         cmd->header.id = cpu_to_le32(SVGA_3D_CMD_PRESENT);
 506         cmd->header.size = cpu_to_le32(sizeof(cmd->body) + num_clips * sizeof(cmd->cr));
 507         cmd->body.sid = cpu_to_le32(surf->res.id);
 508
 509         for (i = 0, cr = &cmd->cr; i < num_clips; i++, cr++, clips += inc) {
 510                 cr->x = cpu_to_le16(clips->x1);
 511                 cr->y = cpu_to_le16(clips->y1);
 512                 cr->srcx = cr->x;
 513                 cr->srcy = cr->y;
 514                 cr->w = cpu_to_le16(clips->x2 - clips->x1);
 515                 cr->h = cpu_to_le16(clips->y2 - clips->y1);
 516         }
 517
 518         vmw_fifo_commit(dev_priv, sizeof(*cmd) + (num_clips - 1) * sizeof(cmd->cr));
 519         ttm_read_unlock(&vmaster->lock);
 520         return 0;
 521 }
 522
 523 static struct drm_framebuffer_funcs vmw_framebuffer_surface_funcs = {
 524         .destroy = vmw_framebuffer_surface_destroy,
 525         .dirty = vmw_framebuffer_surface_dirty,
 526         .create_handle = vmw_framebuffer_create_handle,
 527 };
 528
 529 static int vmw_kms_new_framebuffer_surface(struct vmw_private *dev_priv,
 530                                            struct drm_file *file_priv,
 531                                            struct vmw_surface *surface,
 532                                            struct vmw_framebuffer **out,
 533                                            const struct drm_mode_fb_cmd
 534                                            *mode_cmd)
 535
 536 {
 537         struct drm_device *dev = dev_priv->dev;
 538         struct vmw_framebuffer_surface *vfbs;
 539         enum SVGA3dSurfaceFormat format;
 540         struct vmw_master *vmaster = vmw_master(file_priv->master);
 541         int ret;
 542
 543         /*
 544          * Sanity checks.
 545          */
 546
 547         if (unlikely(surface->mip_levels[0] != 1 ||
 548                      surface->num_sizes != 1 ||
 549                      surface->sizes[0].width < mode_cmd->width ||
 550                      surface->sizes[0].height < mode_cmd->height ||
 551                      surface->sizes[0].depth != 1)) {
 552                 DRM_ERROR("Incompatible surface dimensions "
 553                           "for requested mode.\n");
 554                 return -EINVAL;
 555         }
 556
 557         switch (mode_cmd->depth) {
 558         case 32:
 559                 format = SVGA3D_A8R8G8B8;
 560                 break;
 561         case 24:
 562                 format = SVGA3D_X8R8G8B8;
 563                 break;
 564         case 16:
 565                 format = SVGA3D_R5G6B5;
 566                 break;
 567         case 15:
 568                 format = SVGA3D_A1R5G5B5;
 569                 break;
 570         default:
 571                 DRM_ERROR("Invalid color depth: %d\n", mode_cmd->depth);
 572                 return -EINVAL;
 573         }
 574
 575         if (unlikely(format != surface->format)) {
 576                 DRM_ERROR("Invalid surface format for requested mode.\n");
 577                 return -EINVAL;
 578         }
 579
 580         vfbs = kzalloc(sizeof(*vfbs), GFP_KERNEL);
 581         if (!vfbs) {
 582                 ret = -ENOMEM;
 583                 goto out_err1;
 584         }
 585
 586         ret = drm_framebuffer_init(dev, &vfbs->base.base,
 587                                    &vmw_framebuffer_surface_funcs);
 588         if (ret)
 589                 goto out_err2;
 590
 591         if (!vmw_surface_reference(surface)) {
 592                 DRM_ERROR("failed to reference surface %p\n", surface);
 593                 goto out_err3;
 594         }
 595
 596         /* XXX get the first 3 from the surface info */
 597         vfbs->base.base.bits_per_pixel = mode_cmd->bpp;
 598         vfbs->base.base.pitch = mode_cmd->pitch;
 599         vfbs->base.base.depth = mode_cmd->depth;
 600         vfbs->base.base.width = mode_cmd->width;
 601         vfbs->base.base.height = mode_cmd->height;
 602         vfbs->base.pin = &vmw_surface_dmabuf_pin;
 603         vfbs->base.unpin = &vmw_surface_dmabuf_unpin;
 604         vfbs->surface = surface;
 605         vfbs->master = drm_master_get(file_priv->master);
 606         mutex_init(&vfbs->work_lock);
 607
 608         mutex_lock(&vmaster->fb_surf_mutex);
 609         INIT_DELAYED_WORK(&vfbs->d_work, &vmw_framebuffer_present_fs_callback);
 610         list_add_tail(&vfbs->head, &vmaster->fb_surf);
 611         mutex_unlock(&vmaster->fb_surf_mutex);
 612
 613         *out = &vfbs->base;
 614
 615         return 0;
 616
 617 out_err3:
 618         drm_framebuffer_cleanup(&vfbs->base.base);
 619 out_err2:
 620         kfree(vfbs);
 621 out_err1:
 622         return ret;
 623 }
 624
 625 /*
 626  * Dmabuf framebuffer code
 627  */
 628
 629 #define vmw_framebuffer_to_vfbd(x) \
 630         container_of(x, struct vmw_framebuffer_dmabuf, base.base)
 631
 632 struct vmw_framebuffer_dmabuf {
 633         struct vmw_framebuffer base;
 634         struct vmw_dma_buffer *buffer;
 635 };
 636
 637 void vmw_framebuffer_dmabuf_destroy(struct drm_framebuffer *framebuffer)
 638 {
 639         struct vmw_framebuffer_dmabuf *vfbd =
 640                 vmw_framebuffer_to_vfbd(framebuffer);
 641
 642         drm_framebuffer_cleanup(framebuffer);
 643         vmw_dmabuf_unreference(&vfbd->buffer);
 644
 645         kfree(vfbd);
 646 }
 647
 648 int vmw_framebuffer_dmabuf_dirty(struct drm_framebuffer *framebuffer,
 649                                  struct drm_file *file_priv,
 650                                  unsigned flags, unsigned color,
 651                                  struct drm_clip_rect *clips,
 652                                  unsigned num_clips)
 653 {
 654         struct vmw_private *dev_priv = vmw_priv(framebuffer->dev);
 655         struct vmw_master *vmaster = vmw_master(file_priv->master);
 656         struct drm_clip_rect norect;
 657         int ret;
 658         struct {
 659                 uint32_t header;
 660                 SVGAFifoCmdUpdate body;
 661         } *cmd;
 662         int i, increment = 1;
 663
 664         ret = ttm_read_lock(&vmaster->lock, true);
 665         if (unlikely(ret != 0))
 666                 return ret;
 667
 668         if (!num_clips) {
 669                 num_clips = 1;
 670                 clips = &norect;
 671                 norect.x1 = norect.y1 = 0;
 672                 norect.x2 = framebuffer->width;
 673                 norect.y2 = framebuffer->height;
 674         } else if (flags & DRM_MODE_FB_DIRTY_ANNOTATE_COPY) {
 675                 num_clips /= 2;
 676                 increment = 2;
 677         }
 678
 679         cmd = vmw_fifo_reserve(dev_priv, sizeof(*cmd) * num_clips);
 680         if (unlikely(cmd == NULL)) {
 681                 DRM_ERROR("Fifo reserve failed.\n");
 682                 ttm_read_unlock(&vmaster->lock);
 683                 return -ENOMEM;
 684         }
 685
 686         for (i = 0; i < num_clips; i++, clips += increment) {
 687                 cmd[i].header = cpu_to_le32(SVGA_CMD_UPDATE);
 688                 cmd[i].body.x = cpu_to_le32(clips->x1);
 689                 cmd[i].body.y = cpu_to_le32(clips->y1);
 690                 cmd[i].body.width = cpu_to_le32(clips->x2 - clips->x1);
 691                 cmd[i].body.height = cpu_to_le32(clips->y2 - clips->y1);
 692         }
 693
 694         vmw_fifo_commit(dev_priv, sizeof(*cmd) * num_clips);
 695         ttm_read_unlock(&vmaster->lock);
 696
 697         return 0;
 698 }
 699
 700 static struct drm_framebuffer_funcs vmw_framebuffer_dmabuf_funcs = {
 701         .destroy = vmw_framebuffer_dmabuf_destroy,
 702         .dirty = vmw_framebuffer_dmabuf_dirty,
 703         .create_handle = vmw_framebuffer_create_handle,
 704 };
 705
 706 static int vmw_surface_dmabuf_pin(struct vmw_framebuffer *vfb)
 707 {
 708         struct vmw_private *dev_priv = vmw_priv(vfb->base.dev);
 709         struct vmw_framebuffer_surface *vfbs =
 710                 vmw_framebuffer_to_vfbs(&vfb->base);
 711         unsigned long size = vfbs->base.base.pitch * vfbs->base.base.height;
 712         int ret;
 713
 714         vfbs->buffer = kzalloc(sizeof(*vfbs->buffer), GFP_KERNEL);
 715         if (unlikely(vfbs->buffer == NULL))
 716                 return -ENOMEM;
 717
 718         vmw_overlay_pause_all(dev_priv);
 719         ret = vmw_dmabuf_init(dev_priv, vfbs->buffer, size,
 720                                &vmw_vram_ne_placement,
 721                                false, &vmw_dmabuf_bo_free);
 722         vmw_overlay_resume_all(dev_priv);
 723
 724         return ret;
 725 }
 726
 727 static int vmw_surface_dmabuf_unpin(struct vmw_framebuffer *vfb)
 728 {
 729         struct ttm_buffer_object *bo;
 730         struct vmw_framebuffer_surface *vfbs =
 731                 vmw_framebuffer_to_vfbs(&vfb->base);
 732
 733         bo = &vfbs->buffer->base;
 734         ttm_bo_unref(&bo);
 735         vfbs->buffer = NULL;
 736
 737         return 0;
 738 }
 739
 740 static int vmw_framebuffer_dmabuf_pin(struct vmw_framebuffer *vfb)
 741 {
 742         struct vmw_private *dev_priv = vmw_priv(vfb->base.dev);
 743         struct vmw_framebuffer_dmabuf *vfbd =
 744                 vmw_framebuffer_to_vfbd(&vfb->base);
 745         int ret;
 746
 747
 748         vmw_overlay_pause_all(dev_priv);
 749
 750         ret = vmw_dmabuf_to_start_of_vram(dev_priv, vfbd->buffer);
 751
 752         vmw_overlay_resume_all(dev_priv);
 753
 754         WARN_ON(ret != 0);
 755
 756         return 0;
 757 }
 758
 759 static int vmw_framebuffer_dmabuf_unpin(struct vmw_framebuffer *vfb)
 760 {
 761         struct vmw_private *dev_priv = vmw_priv(vfb->base.dev);
 762         struct vmw_framebuffer_dmabuf *vfbd =
 763                 vmw_framebuffer_to_vfbd(&vfb->base);
 764
 765         if (!vfbd->buffer) {
 766                 WARN_ON(!vfbd->buffer);
 767                 return 0;
 768         }
 769
 770         return vmw_dmabuf_from_vram(dev_priv, vfbd->buffer);
 771 }
 772
 773 static int vmw_kms_new_framebuffer_dmabuf(struct vmw_private *dev_priv,
 774                                           struct vmw_dma_buffer *dmabuf,
 775                                           struct vmw_framebuffer **out,
 776                                           const struct drm_mode_fb_cmd
 777                                           *mode_cmd)
 778
 779 {
 780         struct drm_device *dev = dev_priv->dev;
 781         struct vmw_framebuffer_dmabuf *vfbd;
 782         unsigned int requested_size;
 783         int ret;
 784
 785         requested_size = mode_cmd->height * mode_cmd->pitch;
 786         if (unlikely(requested_size > dmabuf->base.num_pages * PAGE_SIZE)) {
 787                 DRM_ERROR("Screen buffer object size is too small "
 788                           "for requested mode.\n");
 789                 return -EINVAL;
 790         }
 791
 792         vfbd = kzalloc(sizeof(*vfbd), GFP_KERNEL);
 793         if (!vfbd) {
 794                 ret = -ENOMEM;
 795                 goto out_err1;
 796         }
 797
 798         ret = drm_framebuffer_init(dev, &vfbd->base.base,
 799                                    &vmw_framebuffer_dmabuf_funcs);
 800         if (ret)
 801                 goto out_err2;
 802
 803         if (!vmw_dmabuf_reference(dmabuf)) {
 804                 DRM_ERROR("failed to reference dmabuf %p\n", dmabuf);
 805                 goto out_err3;
 806         }
 807
 808         vfbd->base.base.bits_per_pixel = mode_cmd->bpp;
 809         vfbd->base.base.pitch = mode_cmd->pitch;
 810         vfbd->base.base.depth = mode_cmd->depth;
 811         vfbd->base.base.width = mode_cmd->width;
 812         vfbd->base.base.height = mode_cmd->height;
 813         vfbd->base.pin = vmw_framebuffer_dmabuf_pin;
 814         vfbd->base.unpin = vmw_framebuffer_dmabuf_unpin;
 815         vfbd->buffer = dmabuf;
 816         *out = &vfbd->base;
 817
 818         return 0;
 819
 820 out_err3:
 821         drm_framebuffer_cleanup(&vfbd->base.base);
 822 out_err2:
 823         kfree(vfbd);
 824 out_err1:
 825         return ret;
 826 }
 827
 828 /*
 829  * Generic Kernel modesetting functions
 830  */
 831
 832 static struct drm_framebuffer *vmw_kms_fb_create(struct drm_device *dev,
 833                                                  struct drm_file *file_priv,
 834                                                  struct drm_mode_fb_cmd *mode_cmd)
 835 {
 836         struct vmw_private *dev_priv = vmw_priv(dev);
 837         struct ttm_object_file *tfile = vmw_fpriv(file_priv)->tfile;
 838         struct vmw_framebuffer *vfb = NULL;
 839         struct vmw_surface *surface = NULL;
 840         struct vmw_dma_buffer *bo = NULL;
 841         unsigned int required_size;
 842         int ret;
 843
 844         /**
 845          * This code should be conditioned on Screen Objects not being used.
 846          * If screen objects are used, we can allocate a GMR to hold the
 847          * requested framebuffer.
 848          */
 849
 850         required_size = mode_cmd->pitch * mode_cmd->height;
 851         if (unlikely(required_size > dev_priv->vram_size)) {
 852                 DRM_ERROR("VRAM size is too small for requested mode.\n");
 853                 return NULL;
 854         }
 855
 856         /**
 857          * End conditioned code.
 858          */
 859
 860         ret = vmw_user_surface_lookup_handle(dev_priv, tfile,
 861                                              mode_cmd->handle, &surface);
 862         if (ret)
 863                 goto try_dmabuf;
 864
 865         if (!surface->scanout)
 866                 goto err_not_scanout;
 867
 868         ret = vmw_kms_new_framebuffer_surface(dev_priv, file_priv, surface,
 869                                               &vfb, mode_cmd);
 870
 871         /* vmw_user_surface_lookup takes one ref so does new_fb */
 872         vmw_surface_unreference(&surface);
 873
 874         if (ret) {
 875                 DRM_ERROR("failed to create vmw_framebuffer: %i\n", ret);
 876                 return ERR_PTR(ret);
 877         }
 878         return &vfb->base;
 879
 880 try_dmabuf:
 881         DRM_INFO("%s: trying buffer\n", __func__);
 882
 883         ret = vmw_user_dmabuf_lookup(tfile, mode_cmd->handle, &bo);
 884         if (ret) {
 885                 DRM_ERROR("failed to find buffer: %i\n", ret);
 886                 return ERR_PTR(-ENOENT);
 887         }
 888
 889         ret = vmw_kms_new_framebuffer_dmabuf(dev_priv, bo, &vfb,
 890                                              mode_cmd);
 891
 892         /* vmw_user_dmabuf_lookup takes one ref so does new_fb */
 893         vmw_dmabuf_unreference(&bo);
 894
 895         if (ret) {
 896                 DRM_ERROR("failed to create vmw_framebuffer: %i\n", ret);
 897                 return ERR_PTR(ret);
 898         }
 899
 900         return &vfb->base;
 901
 902 err_not_scanout:
 903         DRM_ERROR("surface not marked as scanout\n");
 904         /* vmw_user_surface_lookup takes one ref */
 905         vmw_surface_unreference(&surface);
 906
 907         return ERR_PTR(-EINVAL);
 908 }
 909
 910 static struct drm_mode_config_funcs vmw_kms_funcs = {
 911         .fb_create = vmw_kms_fb_create,
 912 };
 913
 914 int vmw_kms_init(struct vmw_private *dev_priv)
 915 {
 916         struct drm_device *dev = dev_priv->dev;
 917         int ret;
 918
 919         drm_mode_config_init(dev);
 920         dev->mode_config.funcs = &vmw_kms_funcs;
 921         dev->mode_config.min_width = 1;
 922         dev->mode_config.min_height = 1;
 923         /* assumed largest fb size */
 924         dev->mode_config.max_width = 8192;
 925         dev->mode_config.max_height = 8192;
 926
 927         ret = vmw_kms_init_legacy_display_system(dev_priv);
 928
 929         return 0;
 930 }
 931
 932 int vmw_kms_close(struct vmw_private *dev_priv)
 933 {
 934         /*
 935          * Docs says we should take the lock before calling this function
 936          * but since it destroys encoders and our destructor calls
 937          * drm_encoder_cleanup which takes the lock we deadlock.
 938          */
 939         drm_mode_config_cleanup(dev_priv->dev);
 940         vmw_kms_close_legacy_display_system(dev_priv);
 941         return 0;
 942 }
 943
 944 int vmw_kms_cursor_bypass_ioctl(struct drm_device *dev, void *data,
 945                                 struct drm_file *file_priv)
 946 {
 947         struct drm_vmw_cursor_bypass_arg *arg = data;
 948         struct vmw_display_unit *du;
 949         struct drm_mode_object *obj;
 950         struct drm_crtc *crtc;
 951         int ret = 0;
 952
 953
 954         mutex_lock(&dev->mode_config.mutex);
 955         if (arg->flags & DRM_VMW_CURSOR_BYPASS_ALL) {
 956
 957                 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 958                         du = vmw_crtc_to_du(crtc);
 959                         du->hotspot_x = arg->xhot;
 960                         du->hotspot_y = arg->yhot;
 961                 }
 962
 963                 mutex_unlock(&dev->mode_config.mutex);
 964                 return 0;
 965         }
 966
 967         obj = drm_mode_object_find(dev, arg->crtc_id, DRM_MODE_OBJECT_CRTC);
 968         if (!obj) {
 969                 ret = -EINVAL;
 970                 goto out;
 971         }
 972
 973         crtc = obj_to_crtc(obj);
 974         du = vmw_crtc_to_du(crtc);
 975
 976         du->hotspot_x = arg->xhot;
 977         du->hotspot_y = arg->yhot;
 978
 979 out:
 980         mutex_unlock(&dev->mode_config.mutex);
 981
 982         return ret;
 983 }
 984
 985 void vmw_kms_write_svga(struct vmw_private *vmw_priv,
 986                         unsigned width, unsigned height, unsigned pitch,
 987                         unsigned bbp, unsigned depth)
 988 {
 989         if (vmw_priv->capabilities & SVGA_CAP_PITCHLOCK)
 990                 vmw_write(vmw_priv, SVGA_REG_PITCHLOCK, pitch);
 991         else if (vmw_fifo_have_pitchlock(vmw_priv))
 992                 iowrite32(pitch, vmw_priv->mmio_virt + SVGA_FIFO_PITCHLOCK);
 993         vmw_write(vmw_priv, SVGA_REG_WIDTH, width);
 994         vmw_write(vmw_priv, SVGA_REG_HEIGHT, height);
 995         vmw_write(vmw_priv, SVGA_REG_BITS_PER_PIXEL, bbp);
 996         vmw_write(vmw_priv, SVGA_REG_DEPTH, depth);
 997         vmw_write(vmw_priv, SVGA_REG_RED_MASK, 0x00ff0000);
 998         vmw_write(vmw_priv, SVGA_REG_GREEN_MASK, 0x0000ff00);
 999         vmw_write(vmw_priv, SVGA_REG_BLUE_MASK, 0x000000ff);
1000 }
1001
1002 int vmw_kms_save_vga(struct vmw_private *vmw_priv)
1003 {
1004         struct vmw_vga_topology_state *save;
1005         uint32_t i;
1006
1007         vmw_priv->vga_width = vmw_read(vmw_priv, SVGA_REG_WIDTH);
1008         vmw_priv->vga_height = vmw_read(vmw_priv, SVGA_REG_HEIGHT);
1009         vmw_priv->vga_depth = vmw_read(vmw_priv, SVGA_REG_DEPTH);
1010         vmw_priv->vga_bpp = vmw_read(vmw_priv, SVGA_REG_BITS_PER_PIXEL);
1011         vmw_priv->vga_pseudo = vmw_read(vmw_priv, SVGA_REG_PSEUDOCOLOR);
1012         vmw_priv->vga_red_mask = vmw_read(vmw_priv, SVGA_REG_RED_MASK);
1013         vmw_priv->vga_blue_mask = vmw_read(vmw_priv, SVGA_REG_BLUE_MASK);
1014         vmw_priv->vga_green_mask = vmw_read(vmw_priv, SVGA_REG_GREEN_MASK);
1015         if (vmw_priv->capabilities & SVGA_CAP_PITCHLOCK)
1016                 vmw_priv->vga_pitchlock =
1017                   vmw_read(vmw_priv, SVGA_REG_PITCHLOCK);
1018         else if (vmw_fifo_have_pitchlock(vmw_priv))
1019                 vmw_priv->vga_pitchlock = ioread32(vmw_priv->mmio_virt +
1020                                                        SVGA_FIFO_PITCHLOCK);
1021
1022         if (!(vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY))
1023                 return 0;
1024
1025         vmw_priv->num_displays = vmw_read(vmw_priv,
1026                                           SVGA_REG_NUM_GUEST_DISPLAYS);
1027
1028         for (i = 0; i < vmw_priv->num_displays; ++i) {
1029                 save = &vmw_priv->vga_save[i];
1030                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, i);
1031                 save->primary = vmw_read(vmw_priv, SVGA_REG_DISPLAY_IS_PRIMARY);
1032                 save->pos_x = vmw_read(vmw_priv, SVGA_REG_DISPLAY_POSITION_X);
1033                 save->pos_y = vmw_read(vmw_priv, SVGA_REG_DISPLAY_POSITION_Y);
1034                 save->width = vmw_read(vmw_priv, SVGA_REG_DISPLAY_WIDTH);
1035                 save->height = vmw_read(vmw_priv, SVGA_REG_DISPLAY_HEIGHT);
1036                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, SVGA_ID_INVALID);
1037                 if (i == 0 && vmw_priv->num_displays == 1 &&
1038                     save->width == 0 && save->height == 0) {
1039
1040                         /*
1041                          * It should be fairly safe to assume that these
1042                          * values are uninitialized.
1043                          */
1044
1045                         save->width = vmw_priv->vga_width - save->pos_x;
1046                         save->height = vmw_priv->vga_height - save->pos_y;
1047                 }
1048         }
1049
1050         return 0;
1051 }
1052
1053 int vmw_kms_restore_vga(struct vmw_private *vmw_priv)
1054 {
1055         struct vmw_vga_topology_state *save;
1056         uint32_t i;
1057
1058         vmw_write(vmw_priv, SVGA_REG_WIDTH, vmw_priv->vga_width);
1059         vmw_write(vmw_priv, SVGA_REG_HEIGHT, vmw_priv->vga_height);
1060         vmw_write(vmw_priv, SVGA_REG_DEPTH, vmw_priv->vga_depth);
1061         vmw_write(vmw_priv, SVGA_REG_BITS_PER_PIXEL, vmw_priv->vga_bpp);
1062         vmw_write(vmw_priv, SVGA_REG_PSEUDOCOLOR, vmw_priv->vga_pseudo);
1063         vmw_write(vmw_priv, SVGA_REG_RED_MASK, vmw_priv->vga_red_mask);
1064         vmw_write(vmw_priv, SVGA_REG_GREEN_MASK, vmw_priv->vga_green_mask);
1065         vmw_write(vmw_priv, SVGA_REG_BLUE_MASK, vmw_priv->vga_blue_mask);
1066         if (vmw_priv->capabilities & SVGA_CAP_PITCHLOCK)
1067                 vmw_write(vmw_priv, SVGA_REG_PITCHLOCK,
1068                           vmw_priv->vga_pitchlock);
1069         else if (vmw_fifo_have_pitchlock(vmw_priv))
1070                 iowrite32(vmw_priv->vga_pitchlock,
1071                           vmw_priv->mmio_virt + SVGA_FIFO_PITCHLOCK);
1072
1073         if (!(vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY))
1074                 return 0;
1075
1076         for (i = 0; i < vmw_priv->num_displays; ++i) {
1077                 save = &vmw_priv->vga_save[i];
1078                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, i);
1079                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_IS_PRIMARY, save->primary);
1080                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_X, save->pos_x);
1081                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_Y, save->pos_y);
1082                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_WIDTH, save->width);
1083                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_HEIGHT, save->height);
1084                 vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, SVGA_ID_INVALID);
1085         }
1086
1087         return 0;
1088 }
1089
1090 int vmw_kms_update_layout_ioctl(struct drm_device *dev, void *data,
1091                                 struct drm_file *file_priv)
1092 {
1093         struct vmw_private *dev_priv = vmw_priv(dev);
1094         struct drm_vmw_update_layout_arg *arg =
1095                 (struct drm_vmw_update_layout_arg *)data;
1096         struct vmw_master *vmaster = vmw_master(file_priv->master);
1097         void __user *user_rects;
1098         struct drm_vmw_rect *rects;
1099         unsigned rects_size;
1100         int ret;
1101
1102         ret = ttm_read_lock(&vmaster->lock, true);
1103         if (unlikely(ret != 0))
1104                 return ret;
1105
1106         if (!arg->num_outputs) {
1107                 struct drm_vmw_rect def_rect = {0, 0, 800, 600};
1108                 vmw_kms_ldu_update_layout(dev_priv, 1, &def_rect);
1109                 goto out_unlock;
1110         }
1111
1112         rects_size = arg->num_outputs * sizeof(struct drm_vmw_rect);
1113         rects = kzalloc(rects_size, GFP_KERNEL);
1114         if (unlikely(!rects)) {
1115                 ret = -ENOMEM;
1116                 goto out_unlock;
1117         }
1118
1119         user_rects = (void __user *)(unsigned long)arg->rects;
1120         ret = copy_from_user(rects, user_rects, rects_size);
1121         if (unlikely(ret != 0)) {
1122                 DRM_ERROR("Failed to get rects.\n");
1123                 ret = -EFAULT;
1124                 goto out_free;
1125         }
1126
1127         vmw_kms_ldu_update_layout(dev_priv, arg->num_outputs, rects);
1128
1129 out_free:
1130         kfree(rects);
1131 out_unlock:
1132         ttm_read_unlock(&vmaster->lock);
1133         return ret;
1134 }
1135
1136 u32 vmw_get_vblank_counter(struct drm_device *dev, int crtc)
1137 {
1138         return 0;
1139 }