src/gallium/drivers/vc5/vc5_bufmgr.c

   1 /*
   2  * Copyright © 2014-2017 Broadcom
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice (including the next
  12  * paragraph) shall be included in all copies or substantial portions of the
  13  * Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  20  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
  21  * IN THE SOFTWARE.
  22  */
  23
  24 #include <errno.h>
  25 #include <err.h>
  26 #include <sys/mman.h>
  27 #include <fcntl.h>
  28 #include <xf86drm.h>
  29 #include <xf86drmMode.h>
  30
  31 #include "util/u_hash_table.h"
  32 #include "util/u_memory.h"
  33 #include "util/ralloc.h"
  34
  35 #include "vc5_context.h"
  36 #include "vc5_screen.h"
  37
  38 #ifdef HAVE_VALGRIND
  39 #include <valgrind.h>
  40 #include <memcheck.h>
  41 #define VG(x) x
  42 #else
  43 #define VG(x)
  44 #endif
  45
  46 static bool dump_stats = false;
  47
  48 static void
  49 vc5_bo_cache_free_all(struct vc5_bo_cache *cache);
  50
  51 static void
  52 vc5_bo_dump_stats(struct vc5_screen *screen)
  53 {
  54         struct vc5_bo_cache *cache = &screen->bo_cache;
  55
  56         fprintf(stderr, "  BOs allocated:   %d\n", screen->bo_count);
  57         fprintf(stderr, "  BOs size:        %dkb\n", screen->bo_size / 1024);
  58         fprintf(stderr, "  BOs cached:      %d\n", cache->bo_count);
  59         fprintf(stderr, "  BOs cached size: %dkb\n", cache->bo_size / 1024);
  60
  61         if (!list_empty(&cache->time_list)) {
  62                 struct vc5_bo *first = LIST_ENTRY(struct vc5_bo,
  63                                                   cache->time_list.next,
  64                                                   time_list);
  65                 struct vc5_bo *last = LIST_ENTRY(struct vc5_bo,
  66                                                   cache->time_list.prev,
  67                                                   time_list);
  68
  69                 fprintf(stderr, "  oldest cache time: %ld\n",
  70                         (long)first->free_time);
  71                 fprintf(stderr, "  newest cache time: %ld\n",
  72                         (long)last->free_time);
  73
  74                 struct timespec time;
  75                 clock_gettime(CLOCK_MONOTONIC, &time);
  76                 fprintf(stderr, "  now:               %ld\n",
  77                         time.tv_sec);
  78         }
  79 }
  80
  81 static void
  82 vc5_bo_remove_from_cache(struct vc5_bo_cache *cache, struct vc5_bo *bo)
  83 {
  84         list_del(&bo->time_list);
  85         list_del(&bo->size_list);
  86         cache->bo_count--;
  87         cache->bo_size -= bo->size;
  88 }
  89
  90 static struct vc5_bo *
  91 vc5_bo_from_cache(struct vc5_screen *screen, uint32_t size, const char *name)
  92 {
  93         struct vc5_bo_cache *cache = &screen->bo_cache;
  94         uint32_t page_index = size / 4096 - 1;
  95
  96         if (cache->size_list_size <= page_index)
  97                 return NULL;
  98
  99         struct vc5_bo *bo = NULL;
 100         mtx_lock(&cache->lock);
 101         if (!list_empty(&cache->size_list[page_index])) {
 102                 bo = LIST_ENTRY(struct vc5_bo, cache->size_list[page_index].next,
 103                                 size_list);
 104
 105                 /* Check that the BO has gone idle.  If not, then we want to
 106                  * allocate something new instead, since we assume that the
 107                  * user will proceed to CPU map it and fill it with stuff.
 108                  */
 109                 if (!vc5_bo_wait(bo, 0, NULL)) {
 110                         mtx_unlock(&cache->lock);
 111                         return NULL;
 112                 }
 113
 114                 pipe_reference_init(&bo->reference, 1);
 115                 vc5_bo_remove_from_cache(cache, bo);
 116
 117                 bo->name = name;
 118         }
 119         mtx_unlock(&cache->lock);
 120         return bo;
 121 }
 122
 123 struct vc5_bo *
 124 vc5_bo_alloc(struct vc5_screen *screen, uint32_t size, const char *name)
 125 {
 126         struct vc5_bo *bo;
 127         int ret;
 128
 129         size = align(size, 4096);
 130
 131         bo = vc5_bo_from_cache(screen, size, name);
 132         if (bo) {
 133                 if (dump_stats) {
 134                         fprintf(stderr, "Allocated %s %dkb from cache:\n",
 135                                 name, size / 1024);
 136                         vc5_bo_dump_stats(screen);
 137                 }
 138                 return bo;
 139         }
 140
 141         bo = CALLOC_STRUCT(vc5_bo);
 142         if (!bo)
 143                 return NULL;
 144
 145         pipe_reference_init(&bo->reference, 1);
 146         bo->screen = screen;
 147         bo->size = size;
 148         bo->name = name;
 149         bo->private = true;
 150
 151  retry:
 152         ;
 153
 154         bool cleared_and_retried = false;
 155         struct drm_vc5_create_bo create = {
 156                 .size = size
 157         };
 158
 159         ret = vc5_ioctl(screen->fd, DRM_IOCTL_VC5_CREATE_BO, &create);
 160         bo->handle = create.handle;
 161         bo->offset = create.offset;
 162
 163         if (ret != 0) {
 164                 if (!list_empty(&screen->bo_cache.time_list) &&
 165                     !cleared_and_retried) {
 166                         cleared_and_retried = true;
 167                         vc5_bo_cache_free_all(&screen->bo_cache);
 168                         goto retry;
 169                 }
 170
 171                 free(bo);
 172                 return NULL;
 173         }
 174
 175         screen->bo_count++;
 176         screen->bo_size += bo->size;
 177         if (dump_stats) {
 178                 fprintf(stderr, "Allocated %s %dkb:\n", name, size / 1024);
 179                 vc5_bo_dump_stats(screen);
 180         }
 181
 182         return bo;
 183 }
 184
 185 void
 186 vc5_bo_last_unreference(struct vc5_bo *bo)
 187 {
 188         struct vc5_screen *screen = bo->screen;
 189
 190         struct timespec time;
 191         clock_gettime(CLOCK_MONOTONIC, &time);
 192         mtx_lock(&screen->bo_cache.lock);
 193         vc5_bo_last_unreference_locked_timed(bo, time.tv_sec);
 194         mtx_unlock(&screen->bo_cache.lock);
 195 }
 196
 197 static void
 198 vc5_bo_free(struct vc5_bo *bo)
 199 {
 200         struct vc5_screen *screen = bo->screen;
 201
 202         if (bo->map) {
 203                 if (using_vc5_simulator && bo->name &&
 204                     strcmp(bo->name, "winsys") == 0) {
 205                         free(bo->map);
 206                 } else {
 207                         munmap(bo->map, bo->size);
 208                         VG(VALGRIND_FREELIKE_BLOCK(bo->map, 0));
 209                 }
 210         }
 211
 212         struct drm_gem_close c;
 213         memset(&c, 0, sizeof(c));
 214         c.handle = bo->handle;
 215         int ret = vc5_ioctl(screen->fd, DRM_IOCTL_GEM_CLOSE, &c);
 216         if (ret != 0)
 217                 fprintf(stderr, "close object %d: %s\n", bo->handle, strerror(errno));
 218
 219         screen->bo_count--;
 220         screen->bo_size -= bo->size;
 221
 222         if (dump_stats) {
 223                 fprintf(stderr, "Freed %s%s%dkb:\n",
 224                         bo->name ? bo->name : "",
 225                         bo->name ? " " : "",
 226                         bo->size / 1024);
 227                 vc5_bo_dump_stats(screen);
 228         }
 229
 230         free(bo);
 231 }
 232
 233 static void
 234 free_stale_bos(struct vc5_screen *screen, time_t time)
 235 {
 236         struct vc5_bo_cache *cache = &screen->bo_cache;
 237         bool freed_any = false;
 238
 239         list_for_each_entry_safe(struct vc5_bo, bo, &cache->time_list,
 240                                  time_list) {
 241                 if (dump_stats && !freed_any) {
 242                         fprintf(stderr, "Freeing stale BOs:\n");
 243                         vc5_bo_dump_stats(screen);
 244                         freed_any = true;
 245                 }
 246
 247                 /* If it's more than a second old, free it. */
 248                 if (time - bo->free_time > 2) {
 249                         vc5_bo_remove_from_cache(cache, bo);
 250                         vc5_bo_free(bo);
 251                 } else {
 252                         break;
 253                 }
 254         }
 255
 256         if (dump_stats && freed_any) {
 257                 fprintf(stderr, "Freed stale BOs:\n");
 258                 vc5_bo_dump_stats(screen);
 259         }
 260 }
 261
 262 static void
 263 vc5_bo_cache_free_all(struct vc5_bo_cache *cache)
 264 {
 265         mtx_lock(&cache->lock);
 266         list_for_each_entry_safe(struct vc5_bo, bo, &cache->time_list,
 267                                  time_list) {
 268                 vc5_bo_remove_from_cache(cache, bo);
 269                 vc5_bo_free(bo);
 270         }
 271         mtx_unlock(&cache->lock);
 272 }
 273
 274 void
 275 vc5_bo_last_unreference_locked_timed(struct vc5_bo *bo, time_t time)
 276 {
 277         struct vc5_screen *screen = bo->screen;
 278         struct vc5_bo_cache *cache = &screen->bo_cache;
 279         uint32_t page_index = bo->size / 4096 - 1;
 280
 281         if (!bo->private) {
 282                 vc5_bo_free(bo);
 283                 return;
 284         }
 285
 286         if (cache->size_list_size <= page_index) {
 287                 struct list_head *new_list =
 288                         ralloc_array(screen, struct list_head, page_index + 1);
 289
 290                 /* Move old list contents over (since the array has moved, and
 291                  * therefore the pointers to the list heads have to change).
 292                  */
 293                 for (int i = 0; i < cache->size_list_size; i++) {
 294                         struct list_head *old_head = &cache->size_list[i];
 295                         if (list_empty(old_head))
 296                                 list_inithead(&new_list[i]);
 297                         else {
 298                                 new_list[i].next = old_head->next;
 299                                 new_list[i].prev = old_head->prev;
 300                                 new_list[i].next->prev = &new_list[i];
 301                                 new_list[i].prev->next = &new_list[i];
 302                         }
 303                 }
 304                 for (int i = cache->size_list_size; i < page_index + 1; i++)
 305                         list_inithead(&new_list[i]);
 306
 307                 cache->size_list = new_list;
 308                 cache->size_list_size = page_index + 1;
 309         }
 310
 311         bo->free_time = time;
 312         list_addtail(&bo->size_list, &cache->size_list[page_index]);
 313         list_addtail(&bo->time_list, &cache->time_list);
 314         cache->bo_count++;
 315         cache->bo_size += bo->size;
 316         if (dump_stats) {
 317                 fprintf(stderr, "Freed %s %dkb to cache:\n",
 318                         bo->name, bo->size / 1024);
 319                 vc5_bo_dump_stats(screen);
 320         }
 321         bo->name = NULL;
 322
 323         free_stale_bos(screen, time);
 324 }
 325
 326 static struct vc5_bo *
 327 vc5_bo_open_handle(struct vc5_screen *screen,
 328                    uint32_t winsys_stride,
 329                    uint32_t handle, uint32_t size)
 330 {
 331         struct vc5_bo *bo;
 332
 333         assert(size);
 334
 335         mtx_lock(&screen->bo_handles_mutex);
 336
 337         bo = util_hash_table_get(screen->bo_handles, (void*)(uintptr_t)handle);
 338         if (bo) {
 339                 pipe_reference(NULL, &bo->reference);
 340                 goto done;
 341         }
 342
 343         bo = CALLOC_STRUCT(vc5_bo);
 344         pipe_reference_init(&bo->reference, 1);
 345         bo->screen = screen;
 346         bo->handle = handle;
 347         bo->size = size;
 348         bo->name = "winsys";
 349         bo->private = false;
 350
 351         struct drm_vc5_get_bo_offset get = {
 352                 .handle = handle,
 353         };
 354         int ret = vc5_ioctl(screen->fd, DRM_IOCTL_VC5_GET_BO_OFFSET, &get);
 355         if (ret) {
 356                 fprintf(stderr, "Failed to get BO offset: %s\n",
 357                         strerror(errno));
 358                 free(bo);
 359                 return NULL;
 360         }
 361         bo->offset = get.offset;
 362
 363 #ifdef USE_VC5_SIMULATOR
 364         vc5_simulator_open_from_handle(screen->fd, winsys_stride,
 365                                        bo->handle, bo->size);
 366         bo->map = malloc(bo->size);
 367 #endif
 368
 369         util_hash_table_set(screen->bo_handles, (void *)(uintptr_t)handle, bo);
 370
 371 done:
 372         mtx_unlock(&screen->bo_handles_mutex);
 373         return bo;
 374 }
 375
 376 struct vc5_bo *
 377 vc5_bo_open_name(struct vc5_screen *screen, uint32_t name,
 378                  uint32_t winsys_stride)
 379 {
 380         struct drm_gem_open o = {
 381                 .name = name
 382         };
 383         int ret = vc5_ioctl(screen->fd, DRM_IOCTL_GEM_OPEN, &o);
 384         if (ret) {
 385                 fprintf(stderr, "Failed to open bo %d: %s\n",
 386                         name, strerror(errno));
 387                 return NULL;
 388         }
 389
 390         return vc5_bo_open_handle(screen, winsys_stride, o.handle, o.size);
 391 }
 392
 393 struct vc5_bo *
 394 vc5_bo_open_dmabuf(struct vc5_screen *screen, int fd, uint32_t winsys_stride)
 395 {
 396         uint32_t handle;
 397         int ret = drmPrimeFDToHandle(screen->fd, fd, &handle);
 398         int size;
 399         if (ret) {
 400                 fprintf(stderr, "Failed to get vc5 handle for dmabuf %d\n", fd);
 401                 return NULL;
 402         }
 403
 404         /* Determine the size of the bo we were handed. */
 405         size = lseek(fd, 0, SEEK_END);
 406         if (size == -1) {
 407                 fprintf(stderr, "Couldn't get size of dmabuf fd %d.\n", fd);
 408                 return NULL;
 409         }
 410
 411         return vc5_bo_open_handle(screen, winsys_stride, handle, size);
 412 }
 413
 414 int
 415 vc5_bo_get_dmabuf(struct vc5_bo *bo)
 416 {
 417         int fd;
 418         int ret = drmPrimeHandleToFD(bo->screen->fd, bo->handle,
 419                                      O_CLOEXEC, &fd);
 420         if (ret != 0) {
 421                 fprintf(stderr, "Failed to export gem bo %d to dmabuf\n",
 422                         bo->handle);
 423                 return -1;
 424         }
 425
 426         mtx_lock(&bo->screen->bo_handles_mutex);
 427         bo->private = false;
 428         util_hash_table_set(bo->screen->bo_handles, (void *)(uintptr_t)bo->handle, bo);
 429         mtx_unlock(&bo->screen->bo_handles_mutex);
 430
 431         return fd;
 432 }
 433
 434 bool
 435 vc5_bo_flink(struct vc5_bo *bo, uint32_t *name)
 436 {
 437         struct drm_gem_flink flink = {
 438                 .handle = bo->handle,
 439         };
 440         int ret = vc5_ioctl(bo->screen->fd, DRM_IOCTL_GEM_FLINK, &flink);
 441         if (ret) {
 442                 fprintf(stderr, "Failed to flink bo %d: %s\n",
 443                         bo->handle, strerror(errno));
 444                 free(bo);
 445                 return false;
 446         }
 447
 448         bo->private = false;
 449         *name = flink.name;
 450
 451         return true;
 452 }
 453
 454 static int vc5_wait_bo_ioctl(int fd, uint32_t handle, uint64_t timeout_ns)
 455 {
 456         struct drm_vc5_wait_bo wait = {
 457                 .handle = handle,
 458                 .timeout_ns = timeout_ns,
 459         };
 460         int ret = vc5_ioctl(fd, DRM_IOCTL_VC5_WAIT_BO, &wait);
 461         if (ret == -1)
 462                 return -errno;
 463         else
 464                 return 0;
 465
 466 }
 467
 468 bool
 469 vc5_bo_wait(struct vc5_bo *bo, uint64_t timeout_ns, const char *reason)
 470 {
 471         struct vc5_screen *screen = bo->screen;
 472
 473         if (unlikely(V3D_DEBUG & V3D_DEBUG_PERF) && timeout_ns && reason) {
 474                 if (vc5_wait_bo_ioctl(screen->fd, bo->handle, 0) == -ETIME) {
 475                         fprintf(stderr, "Blocking on %s BO for %s\n",
 476                                 bo->name, reason);
 477                 }
 478         }
 479
 480         int ret = vc5_wait_bo_ioctl(screen->fd, bo->handle, timeout_ns);
 481         if (ret) {
 482                 if (ret != -ETIME) {
 483                         fprintf(stderr, "wait failed: %d\n", ret);
 484                         abort();
 485                 }
 486
 487                 return false;
 488         }
 489
 490         return true;
 491 }
 492
 493 void *
 494 vc5_bo_map_unsynchronized(struct vc5_bo *bo)
 495 {
 496         uint64_t offset;
 497         int ret;
 498
 499         if (bo->map)
 500                 return bo->map;
 501
 502         struct drm_vc5_mmap_bo map;
 503         memset(&map, 0, sizeof(map));
 504         map.handle = bo->handle;
 505         ret = vc5_ioctl(bo->screen->fd, DRM_IOCTL_VC5_MMAP_BO, &map);
 506         offset = map.offset;
 507         if (ret != 0) {
 508                 fprintf(stderr, "map ioctl failure\n");
 509                 abort();
 510         }
 511
 512         bo->map = mmap(NULL, bo->size, PROT_READ | PROT_WRITE, MAP_SHARED,
 513                        bo->screen->fd, offset);
 514         if (bo->map == MAP_FAILED) {
 515                 fprintf(stderr, "mmap of bo %d (offset 0x%016llx, size %d) failed\n",
 516                         bo->handle, (long long)offset, bo->size);
 517                 abort();
 518         }
 519         VG(VALGRIND_MALLOCLIKE_BLOCK(bo->map, bo->size, 0, false));
 520
 521         return bo->map;
 522 }
 523
 524 void *
 525 vc5_bo_map(struct vc5_bo *bo)
 526 {
 527         void *map = vc5_bo_map_unsynchronized(bo);
 528
 529         bool ok = vc5_bo_wait(bo, PIPE_TIMEOUT_INFINITE, "bo map");
 530         if (!ok) {
 531                 fprintf(stderr, "BO wait for map failed\n");
 532                 abort();
 533         }
 534
 535         return map;
 536 }
 537
 538 void
 539 vc5_bufmgr_destroy(struct pipe_screen *pscreen)
 540 {
 541         struct vc5_screen *screen = vc5_screen(pscreen);
 542         struct vc5_bo_cache *cache = &screen->bo_cache;
 543
 544         vc5_bo_cache_free_all(cache);
 545
 546         if (dump_stats) {
 547                 fprintf(stderr, "BO stats after screen destroy:\n");
 548                 vc5_bo_dump_stats(screen);
 549         }
 550 }