drivers/staging/vboxvideo/vbox_main.c

   1 /*
   2  * Copyright (C) 2013-2017 Oracle Corporation
   3  * This file is based on ast_main.c
   4  * Copyright 2012 Red Hat Inc.
   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 SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
  17  * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
  18  * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
  19  * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
  20  * USE OR OTHER DEALINGS IN THE SOFTWARE.
  21  *
  22  * The above copyright notice and this permission notice (including the
  23  * next paragraph) shall be included in all copies or substantial portions
  24  * of the Software.
  25  *
  26  * Authors: Dave Airlie <[email protected]>,
  27  *          Michael Thayer <[email protected],
  28  *          Hans de Goede <[email protected]>
  29  */
  30 #include <drm/drm_fb_helper.h>
  31 #include <drm/drm_crtc_helper.h>
  32
  33 #include "vbox_drv.h"
  34 #include "vbox_err.h"
  35 #include "vboxvideo_guest.h"
  36 #include "vboxvideo_vbe.h"
  37
  38 static void vbox_user_framebuffer_destroy(struct drm_framebuffer *fb)
  39 {
  40         struct vbox_framebuffer *vbox_fb = to_vbox_framebuffer(fb);
  41
  42         if (vbox_fb->obj)
  43                 drm_gem_object_put_unlocked(vbox_fb->obj);
  44
  45         drm_framebuffer_cleanup(fb);
  46         kfree(fb);
  47 }
  48
  49 void vbox_enable_accel(struct vbox_private *vbox)
  50 {
  51         unsigned int i;
  52         struct vbva_buffer *vbva;
  53
  54         if (!vbox->vbva_info || !vbox->vbva_buffers) {
  55                 /* Should never happen... */
  56                 DRM_ERROR("vboxvideo: failed to set up VBVA.\n");
  57                 return;
  58         }
  59
  60         for (i = 0; i < vbox->num_crtcs; ++i) {
  61                 if (vbox->vbva_info[i].vbva)
  62                         continue;
  63
  64                 vbva = (void __force *)vbox->vbva_buffers +
  65                         i * VBVA_MIN_BUFFER_SIZE;
  66                 if (!vbva_enable(&vbox->vbva_info[i],
  67                                  vbox->guest_pool, vbva, i)) {
  68                         /* very old host or driver error. */
  69                         DRM_ERROR("vboxvideo: vbva_enable failed\n");
  70                         return;
  71                 }
  72         }
  73 }
  74
  75 void vbox_disable_accel(struct vbox_private *vbox)
  76 {
  77         unsigned int i;
  78
  79         for (i = 0; i < vbox->num_crtcs; ++i)
  80                 vbva_disable(&vbox->vbva_info[i], vbox->guest_pool, i);
  81 }
  82
  83 void vbox_report_caps(struct vbox_private *vbox)
  84 {
  85         u32 caps = VBVACAPS_DISABLE_CURSOR_INTEGRATION |
  86                    VBVACAPS_IRQ | VBVACAPS_USE_VBVA_ONLY;
  87
  88         if (vbox->initial_mode_queried)
  89                 caps |= VBVACAPS_VIDEO_MODE_HINTS;
  90
  91         hgsmi_send_caps_info(vbox->guest_pool, caps);
  92 }
  93
  94 /**
  95  * Send information about dirty rectangles to VBVA.  If necessary we enable
  96  * VBVA first, as this is normally disabled after a change of master in case
  97  * the new master does not send dirty rectangle information (is this even
  98  * allowed?)
  99  */
 100 void vbox_framebuffer_dirty_rectangles(struct drm_framebuffer *fb,
 101                                        struct drm_clip_rect *rects,
 102                                        unsigned int num_rects)
 103 {
 104         struct vbox_private *vbox = fb->dev->dev_private;
 105         struct drm_crtc *crtc;
 106         unsigned int i;
 107
 108         mutex_lock(&vbox->hw_mutex);
 109         list_for_each_entry(crtc, &fb->dev->mode_config.crtc_list, head) {
 110                 if (CRTC_FB(crtc) != fb)
 111                         continue;
 112
 113                 vbox_enable_accel(vbox);
 114
 115                 for (i = 0; i < num_rects; ++i) {
 116                         struct vbva_cmd_hdr cmd_hdr;
 117                         unsigned int crtc_id = to_vbox_crtc(crtc)->crtc_id;
 118
 119                         if ((rects[i].x1 > crtc->x + crtc->hwmode.hdisplay) ||
 120                             (rects[i].y1 > crtc->y + crtc->hwmode.vdisplay) ||
 121                             (rects[i].x2 < crtc->x) ||
 122                             (rects[i].y2 < crtc->y))
 123                                 continue;
 124
 125                         cmd_hdr.x = (s16)rects[i].x1;
 126                         cmd_hdr.y = (s16)rects[i].y1;
 127                         cmd_hdr.w = (u16)rects[i].x2 - rects[i].x1;
 128                         cmd_hdr.h = (u16)rects[i].y2 - rects[i].y1;
 129
 130                         if (!vbva_buffer_begin_update(&vbox->vbva_info[crtc_id],
 131                                                       vbox->guest_pool))
 132                                 continue;
 133
 134                         vbva_write(&vbox->vbva_info[crtc_id], vbox->guest_pool,
 135                                    &cmd_hdr, sizeof(cmd_hdr));
 136                         vbva_buffer_end_update(&vbox->vbva_info[crtc_id]);
 137                 }
 138         }
 139         mutex_unlock(&vbox->hw_mutex);
 140 }
 141
 142 static int vbox_user_framebuffer_dirty(struct drm_framebuffer *fb,
 143                                        struct drm_file *file_priv,
 144                                        unsigned int flags, unsigned int color,
 145                                        struct drm_clip_rect *rects,
 146                                        unsigned int num_rects)
 147 {
 148         vbox_framebuffer_dirty_rectangles(fb, rects, num_rects);
 149
 150         return 0;
 151 }
 152
 153 static const struct drm_framebuffer_funcs vbox_fb_funcs = {
 154         .destroy = vbox_user_framebuffer_destroy,
 155         .dirty = vbox_user_framebuffer_dirty,
 156 };
 157
 158 int vbox_framebuffer_init(struct drm_device *dev,
 159                           struct vbox_framebuffer *vbox_fb,
 160                           const struct DRM_MODE_FB_CMD *mode_cmd,
 161                           struct drm_gem_object *obj)
 162 {
 163         int ret;
 164
 165         drm_helper_mode_fill_fb_struct(dev, &vbox_fb->base, mode_cmd);
 166         vbox_fb->obj = obj;
 167         ret = drm_framebuffer_init(dev, &vbox_fb->base, &vbox_fb_funcs);
 168         if (ret) {
 169                 DRM_ERROR("framebuffer init failed %d\n", ret);
 170                 return ret;
 171         }
 172
 173         return 0;
 174 }
 175
 176 static struct drm_framebuffer *vbox_user_framebuffer_create(
 177                 struct drm_device *dev,
 178                 struct drm_file *filp,
 179                 const struct drm_mode_fb_cmd2 *mode_cmd)
 180 {
 181         struct drm_gem_object *obj;
 182         struct vbox_framebuffer *vbox_fb;
 183         int ret = -ENOMEM;
 184
 185         obj = drm_gem_object_lookup(filp, mode_cmd->handles[0]);
 186         if (!obj)
 187                 return ERR_PTR(-ENOENT);
 188
 189         vbox_fb = kzalloc(sizeof(*vbox_fb), GFP_KERNEL);
 190         if (!vbox_fb)
 191                 goto err_unref_obj;
 192
 193         ret = vbox_framebuffer_init(dev, vbox_fb, mode_cmd, obj);
 194         if (ret)
 195                 goto err_free_vbox_fb;
 196
 197         return &vbox_fb->base;
 198
 199 err_free_vbox_fb:
 200         kfree(vbox_fb);
 201 err_unref_obj:
 202         drm_gem_object_put_unlocked(obj);
 203         return ERR_PTR(ret);
 204 }
 205
 206 static const struct drm_mode_config_funcs vbox_mode_funcs = {
 207         .fb_create = vbox_user_framebuffer_create,
 208 };
 209
 210 static int vbox_accel_init(struct vbox_private *vbox)
 211 {
 212         unsigned int i;
 213
 214         vbox->vbva_info = devm_kcalloc(vbox->dev->dev, vbox->num_crtcs,
 215                                        sizeof(*vbox->vbva_info), GFP_KERNEL);
 216         if (!vbox->vbva_info)
 217                 return -ENOMEM;
 218
 219         /* Take a command buffer for each screen from the end of usable VRAM. */
 220         vbox->available_vram_size -= vbox->num_crtcs * VBVA_MIN_BUFFER_SIZE;
 221
 222         vbox->vbva_buffers = pci_iomap_range(vbox->dev->pdev, 0,
 223                                              vbox->available_vram_size,
 224                                              vbox->num_crtcs *
 225                                              VBVA_MIN_BUFFER_SIZE);
 226         if (!vbox->vbva_buffers)
 227                 return -ENOMEM;
 228
 229         for (i = 0; i < vbox->num_crtcs; ++i)
 230                 vbva_setup_buffer_context(&vbox->vbva_info[i],
 231                                           vbox->available_vram_size +
 232                                           i * VBVA_MIN_BUFFER_SIZE,
 233                                           VBVA_MIN_BUFFER_SIZE);
 234
 235         return 0;
 236 }
 237
 238 static void vbox_accel_fini(struct vbox_private *vbox)
 239 {
 240         vbox_disable_accel(vbox);
 241         pci_iounmap(vbox->dev->pdev, vbox->vbva_buffers);
 242 }
 243
 244 /** Do we support the 4.3 plus mode hint reporting interface? */
 245 static bool have_hgsmi_mode_hints(struct vbox_private *vbox)
 246 {
 247         u32 have_hints, have_cursor;
 248         int ret;
 249
 250         ret = hgsmi_query_conf(vbox->guest_pool,
 251                                VBOX_VBVA_CONF32_MODE_HINT_REPORTING,
 252                                &have_hints);
 253         if (ret)
 254                 return false;
 255
 256         ret = hgsmi_query_conf(vbox->guest_pool,
 257                                VBOX_VBVA_CONF32_GUEST_CURSOR_REPORTING,
 258                                &have_cursor);
 259         if (ret)
 260                 return false;
 261
 262         return have_hints == VINF_SUCCESS && have_cursor == VINF_SUCCESS;
 263 }
 264
 265 static bool vbox_check_supported(u16 id)
 266 {
 267         u16 dispi_id;
 268
 269         vbox_write_ioport(VBE_DISPI_INDEX_ID, id);
 270         dispi_id = inw(VBE_DISPI_IOPORT_DATA);
 271
 272         return dispi_id == id;
 273 }
 274
 275 /**
 276  * Set up our heaps and data exchange buffers in VRAM before handing the rest
 277  * to the memory manager.
 278  */
 279 static int vbox_hw_init(struct vbox_private *vbox)
 280 {
 281         int ret = -ENOMEM;
 282
 283         vbox->full_vram_size = inl(VBE_DISPI_IOPORT_DATA);
 284         vbox->any_pitch = vbox_check_supported(VBE_DISPI_ID_ANYX);
 285
 286         DRM_INFO("VRAM %08x\n", vbox->full_vram_size);
 287
 288         /* Map guest-heap at end of vram */
 289         vbox->guest_heap =
 290             pci_iomap_range(vbox->dev->pdev, 0, GUEST_HEAP_OFFSET(vbox),
 291                             GUEST_HEAP_SIZE);
 292         if (!vbox->guest_heap)
 293                 return -ENOMEM;
 294
 295         /* Create guest-heap mem-pool use 2^4 = 16 byte chunks */
 296         vbox->guest_pool = gen_pool_create(4, -1);
 297         if (!vbox->guest_pool)
 298                 goto err_unmap_guest_heap;
 299
 300         ret = gen_pool_add_virt(vbox->guest_pool,
 301                                 (unsigned long)vbox->guest_heap,
 302                                 GUEST_HEAP_OFFSET(vbox),
 303                                 GUEST_HEAP_USABLE_SIZE, -1);
 304         if (ret)
 305                 goto err_destroy_guest_pool;
 306
 307         ret = hgsmi_test_query_conf(vbox->guest_pool);
 308         if (ret) {
 309                 DRM_ERROR("vboxvideo: hgsmi_test_query_conf failed\n");
 310                 goto err_destroy_guest_pool;
 311         }
 312
 313         /* Reduce available VRAM size to reflect the guest heap. */
 314         vbox->available_vram_size = GUEST_HEAP_OFFSET(vbox);
 315         /* Linux drm represents monitors as a 32-bit array. */
 316         hgsmi_query_conf(vbox->guest_pool, VBOX_VBVA_CONF32_MONITOR_COUNT,
 317                          &vbox->num_crtcs);
 318         vbox->num_crtcs = clamp_t(u32, vbox->num_crtcs, 1, VBOX_MAX_SCREENS);
 319
 320         if (!have_hgsmi_mode_hints(vbox)) {
 321                 ret = -ENOTSUPP;
 322                 goto err_destroy_guest_pool;
 323         }
 324
 325         vbox->last_mode_hints = devm_kcalloc(vbox->dev->dev, vbox->num_crtcs,
 326                                              sizeof(struct vbva_modehint),
 327                                              GFP_KERNEL);
 328         if (!vbox->last_mode_hints) {
 329                 ret = -ENOMEM;
 330                 goto err_destroy_guest_pool;
 331         }
 332
 333         ret = vbox_accel_init(vbox);
 334         if (ret)
 335                 goto err_destroy_guest_pool;
 336
 337         return 0;
 338
 339 err_destroy_guest_pool:
 340         gen_pool_destroy(vbox->guest_pool);
 341 err_unmap_guest_heap:
 342         pci_iounmap(vbox->dev->pdev, vbox->guest_heap);
 343         return ret;
 344 }
 345
 346 static void vbox_hw_fini(struct vbox_private *vbox)
 347 {
 348         vbox_accel_fini(vbox);
 349         gen_pool_destroy(vbox->guest_pool);
 350         pci_iounmap(vbox->dev->pdev, vbox->guest_heap);
 351 }
 352
 353 int vbox_driver_load(struct drm_device *dev, unsigned long flags)
 354 {
 355         struct vbox_private *vbox;
 356         int ret = 0;
 357
 358         if (!vbox_check_supported(VBE_DISPI_ID_HGSMI))
 359                 return -ENODEV;
 360
 361         vbox = devm_kzalloc(dev->dev, sizeof(*vbox), GFP_KERNEL);
 362         if (!vbox)
 363                 return -ENOMEM;
 364
 365         dev->dev_private = vbox;
 366         vbox->dev = dev;
 367
 368         mutex_init(&vbox->hw_mutex);
 369
 370         ret = vbox_hw_init(vbox);
 371         if (ret)
 372                 return ret;
 373
 374         ret = vbox_mm_init(vbox);
 375         if (ret)
 376                 goto err_hw_fini;
 377
 378         drm_mode_config_init(dev);
 379
 380         dev->mode_config.funcs = (void *)&vbox_mode_funcs;
 381         dev->mode_config.min_width = 64;
 382         dev->mode_config.min_height = 64;
 383         dev->mode_config.preferred_depth = 24;
 384         dev->mode_config.max_width = VBE_DISPI_MAX_XRES;
 385         dev->mode_config.max_height = VBE_DISPI_MAX_YRES;
 386
 387         ret = vbox_mode_init(dev);
 388         if (ret)
 389                 goto err_drm_mode_cleanup;
 390
 391         ret = vbox_irq_init(vbox);
 392         if (ret)
 393                 goto err_mode_fini;
 394
 395         ret = vbox_fbdev_init(dev);
 396         if (ret)
 397                 goto err_irq_fini;
 398
 399         return 0;
 400
 401 err_irq_fini:
 402         vbox_irq_fini(vbox);
 403 err_mode_fini:
 404         vbox_mode_fini(dev);
 405 err_drm_mode_cleanup:
 406         drm_mode_config_cleanup(dev);
 407         vbox_mm_fini(vbox);
 408 err_hw_fini:
 409         vbox_hw_fini(vbox);
 410         return ret;
 411 }
 412
 413 void vbox_driver_unload(struct drm_device *dev)
 414 {
 415         struct vbox_private *vbox = dev->dev_private;
 416
 417         vbox_fbdev_fini(dev);
 418         vbox_irq_fini(vbox);
 419         vbox_mode_fini(dev);
 420         drm_mode_config_cleanup(dev);
 421         vbox_mm_fini(vbox);
 422         vbox_hw_fini(vbox);
 423 }
 424
 425 /**
 426  * @note this is described in the DRM framework documentation.  AST does not
 427  * have it, but we get an oops on driver unload if it is not present.
 428  */
 429 void vbox_driver_lastclose(struct drm_device *dev)
 430 {
 431         struct vbox_private *vbox = dev->dev_private;
 432
 433         if (vbox->fbdev)
 434                 drm_fb_helper_restore_fbdev_mode_unlocked(&vbox->fbdev->helper);
 435 }
 436
 437 int vbox_gem_create(struct drm_device *dev,
 438                     u32 size, bool iskernel, struct drm_gem_object **obj)
 439 {
 440         struct vbox_bo *vboxbo;
 441         int ret;
 442
 443         *obj = NULL;
 444
 445         size = roundup(size, PAGE_SIZE);
 446         if (size == 0)
 447                 return -EINVAL;
 448
 449         ret = vbox_bo_create(dev, size, 0, 0, &vboxbo);
 450         if (ret) {
 451                 if (ret != -ERESTARTSYS)
 452                         DRM_ERROR("failed to allocate GEM object\n");
 453                 return ret;
 454         }
 455
 456         *obj = &vboxbo->gem;
 457
 458         return 0;
 459 }
 460
 461 int vbox_dumb_create(struct drm_file *file,
 462                      struct drm_device *dev, struct drm_mode_create_dumb *args)
 463 {
 464         int ret;
 465         struct drm_gem_object *gobj;
 466         u32 handle;
 467
 468         args->pitch = args->width * ((args->bpp + 7) / 8);
 469         args->size = args->pitch * args->height;
 470
 471         ret = vbox_gem_create(dev, args->size, false, &gobj);
 472         if (ret)
 473                 return ret;
 474
 475         ret = drm_gem_handle_create(file, gobj, &handle);
 476         drm_gem_object_put_unlocked(gobj);
 477         if (ret)
 478                 return ret;
 479
 480         args->handle = handle;
 481
 482         return 0;
 483 }
 484
 485 static void vbox_bo_unref(struct vbox_bo **bo)
 486 {
 487         struct ttm_buffer_object *tbo;
 488
 489         if ((*bo) == NULL)
 490                 return;
 491
 492         tbo = &((*bo)->bo);
 493         ttm_bo_unref(&tbo);
 494         if (!tbo)
 495                 *bo = NULL;
 496 }
 497
 498 void vbox_gem_free_object(struct drm_gem_object *obj)
 499 {
 500         struct vbox_bo *vbox_bo = gem_to_vbox_bo(obj);
 501
 502         vbox_bo_unref(&vbox_bo);
 503 }
 504
 505 static inline u64 vbox_bo_mmap_offset(struct vbox_bo *bo)
 506 {
 507         return drm_vma_node_offset_addr(&bo->bo.vma_node);
 508 }
 509
 510 int
 511 vbox_dumb_mmap_offset(struct drm_file *file,
 512                       struct drm_device *dev,
 513                       u32 handle, u64 *offset)
 514 {
 515         struct drm_gem_object *obj;
 516         int ret;
 517         struct vbox_bo *bo;
 518
 519         mutex_lock(&dev->struct_mutex);
 520         obj = drm_gem_object_lookup(file, handle);
 521         if (!obj) {
 522                 ret = -ENOENT;
 523                 goto out_unlock;
 524         }
 525
 526         bo = gem_to_vbox_bo(obj);
 527         *offset = vbox_bo_mmap_offset(bo);
 528
 529         drm_gem_object_put(obj);
 530         ret = 0;
 531
 532 out_unlock:
 533         mutex_unlock(&dev->struct_mutex);
 534         return ret;
 535 }