cros_gralloc/cros_gralloc_driver.cc

   1 /*
   2  * Copyright 2017 The Chromium OS Authors. All rights reserved.
   3  * Use of this source code is governed by a BSD-style license that can be
   4  * found in the LICENSE file.
   5  */
   6
   7 #include "cros_gralloc_driver.h"
   8 #include "../util.h"
   9
  10 #include <cstdlib>
  11 #include <fcntl.h>
  12 #include <xf86drm.h>
  13
  14 cros_gralloc_driver::cros_gralloc_driver() : drv_(nullptr)
  15 {
  16 }
  17
  18 cros_gralloc_driver::~cros_gralloc_driver()
  19 {
  20         buffers_.clear();
  21         handles_.clear();
  22
  23         if (drv_) {
  24                 drv_destroy(drv_);
  25                 drv_ = nullptr;
  26         }
  27 }
  28
  29 int32_t cros_gralloc_driver::init()
  30 {
  31         /*
  32          * Create a driver from rendernode while filtering out
  33          * the specified undesired driver.
  34          *
  35          * TODO(gsingh): Enable render nodes on udl/evdi.
  36          */
  37
  38         int fd;
  39         drmVersionPtr version;
  40         char const *str = "%s/renderD%d";
  41         const char *undesired[2] = { "vgem", nullptr };
  42         uint32_t num_nodes = 63;
  43         uint32_t min_node = 128;
  44         uint32_t max_node = (min_node + num_nodes);
  45
  46         for (uint32_t i = 0; i < ARRAY_SIZE(undesired); i++) {
  47                 for (uint32_t j = min_node; j < max_node; j++) {
  48                         char *node;
  49                         if (asprintf(&node, str, DRM_DIR_NAME, j) < 0)
  50                                 continue;
  51
  52                         fd = open(node, O_RDWR, 0);
  53                         free(node);
  54
  55                         if (fd < 0)
  56                                 continue;
  57
  58                         version = drmGetVersion(fd);
  59                         if (!version)
  60                                 continue;
  61
  62                         if (undesired[i] && !strcmp(version->name, undesired[i])) {
  63                                 drmFreeVersion(version);
  64                                 continue;
  65                         }
  66
  67                         drmFreeVersion(version);
  68                         drv_ = drv_create(fd);
  69                         if (drv_)
  70                                 return 0;
  71                 }
  72         }
  73
  74         return -ENODEV;
  75 }
  76
  77 bool cros_gralloc_driver::is_supported(const struct cros_gralloc_buffer_descriptor *descriptor)
  78 {
  79         struct combination *combo;
  80         uint32_t resolved_format;
  81         resolved_format = drv_resolve_format(drv_, descriptor->drm_format, descriptor->drv_usage);
  82         combo = drv_get_combination(drv_, resolved_format, descriptor->drv_usage);
  83         return (combo != nullptr);
  84 }
  85
  86 int32_t cros_gralloc_driver::allocate(const struct cros_gralloc_buffer_descriptor *descriptor,
  87                                       buffer_handle_t *out_handle)
  88 {
  89         uint32_t id;
  90         uint64_t mod;
  91         size_t num_planes;
  92         uint32_t resolved_format;
  93
  94         struct bo *bo;
  95         struct cros_gralloc_handle *hnd;
  96
  97         resolved_format = drv_resolve_format(drv_, descriptor->drm_format, descriptor->drv_usage);
  98         bo = drv_bo_create(drv_, descriptor->width, descriptor->height, resolved_format,
  99                            descriptor->drv_usage);
 100         if (!bo) {
 101                 cros_gralloc_error("Failed to create bo.");
 102                 return -ENOMEM;
 103         }
 104
 105         /*
 106          * If there is a desire for more than one kernel buffer, this can be
 107          * removed once the ArcCodec and Wayland service have the ability to
 108          * send more than one fd. GL/Vulkan drivers may also have to modified.
 109          */
 110         if (drv_num_buffers_per_bo(bo) != 1) {
 111                 drv_bo_destroy(bo);
 112                 cros_gralloc_error("Can only support one buffer per bo.");
 113                 return -EINVAL;
 114         }
 115
 116         hnd = new cros_gralloc_handle();
 117         num_planes = drv_bo_get_num_planes(bo);
 118
 119         hnd->base.version = sizeof(hnd->base);
 120         hnd->base.numFds = num_planes;
 121         hnd->base.numInts = handle_data_size - num_planes;
 122
 123         for (size_t plane = 0; plane < num_planes; plane++) {
 124                 hnd->fds[plane] = drv_bo_get_plane_fd(bo, plane);
 125                 hnd->strides[plane] = drv_bo_get_plane_stride(bo, plane);
 126                 hnd->offsets[plane] = drv_bo_get_plane_offset(bo, plane);
 127                 hnd->sizes[plane] = drv_bo_get_plane_size(bo, plane);
 128
 129                 mod = drv_bo_get_plane_format_modifier(bo, plane);
 130                 hnd->format_modifiers[2 * plane] = static_cast<uint32_t>(mod >> 32);
 131                 hnd->format_modifiers[2 * plane + 1] = static_cast<uint32_t>(mod);
 132         }
 133
 134         hnd->width = drv_bo_get_width(bo);
 135         hnd->height = drv_bo_get_height(bo);
 136         hnd->format = drv_bo_get_format(bo);
 137         hnd->pixel_stride = drv_bo_get_stride_in_pixels(bo);
 138         hnd->magic = cros_gralloc_magic;
 139         hnd->droid_format = descriptor->droid_format;
 140         hnd->usage = descriptor->producer_usage;
 141
 142         id = drv_bo_get_plane_handle(bo, 0).u32;
 143         auto buffer = new cros_gralloc_buffer(id, bo, hnd);
 144
 145         std::lock_guard<std::mutex> lock(mutex_);
 146         buffers_.emplace(id, buffer);
 147         handles_.emplace(hnd, std::make_pair(buffer, 1));
 148         *out_handle = &hnd->base;
 149         return 0;
 150 }
 151
 152 int32_t cros_gralloc_driver::retain(buffer_handle_t handle)
 153 {
 154         uint32_t id;
 155         std::lock_guard<std::mutex> lock(mutex_);
 156
 157         auto hnd = cros_gralloc_convert_handle(handle);
 158         if (!hnd) {
 159                 cros_gralloc_error("Invalid handle.");
 160                 return -EINVAL;
 161         }
 162
 163         auto buffer = get_buffer(hnd);
 164         if (buffer) {
 165                 handles_[hnd].second++;
 166                 buffer->increase_refcount();
 167                 return 0;
 168         }
 169
 170         if (drmPrimeFDToHandle(drv_get_fd(drv_), hnd->fds[0], &id)) {
 171                 cros_gralloc_error("drmPrimeFDToHandle failed.");
 172                 return -errno;
 173         }
 174
 175         if (buffers_.count(id)) {
 176                 buffer = buffers_[id];
 177                 buffer->increase_refcount();
 178         } else {
 179                 struct bo *bo;
 180                 struct drv_import_fd_data data;
 181                 data.format = hnd->format;
 182                 data.width = hnd->width;
 183                 data.height = hnd->height;
 184
 185                 memcpy(data.fds, hnd->fds, sizeof(data.fds));
 186                 memcpy(data.strides, hnd->strides, sizeof(data.strides));
 187                 memcpy(data.offsets, hnd->offsets, sizeof(data.offsets));
 188                 memcpy(data.sizes, hnd->sizes, sizeof(data.sizes));
 189                 for (uint32_t plane = 0; plane < DRV_MAX_PLANES; plane++) {
 190                         data.format_modifiers[plane] =
 191                             static_cast<uint64_t>(hnd->format_modifiers[2 * plane]) << 32;
 192                         data.format_modifiers[plane] |= hnd->format_modifiers[2 * plane + 1];
 193                 }
 194
 195                 bo = drv_bo_import(drv_, &data);
 196                 if (!bo)
 197                         return -EFAULT;
 198
 199                 id = drv_bo_get_plane_handle(bo, 0).u32;
 200
 201                 buffer = new cros_gralloc_buffer(id, bo, nullptr);
 202                 buffers_.emplace(id, buffer);
 203         }
 204
 205         handles_.emplace(hnd, std::make_pair(buffer, 1));
 206         return 0;
 207 }
 208
 209 int32_t cros_gralloc_driver::release(buffer_handle_t handle)
 210 {
 211         std::lock_guard<std::mutex> lock(mutex_);
 212
 213         auto hnd = cros_gralloc_convert_handle(handle);
 214         if (!hnd) {
 215                 cros_gralloc_error("Invalid handle.");
 216                 return -EINVAL;
 217         }
 218
 219         auto buffer = get_buffer(hnd);
 220         if (!buffer) {
 221                 cros_gralloc_error("Invalid Reference.");
 222                 return -EINVAL;
 223         }
 224
 225         if (!--handles_[hnd].second)
 226                 handles_.erase(hnd);
 227
 228         if (buffer->decrease_refcount() == 0) {
 229                 buffers_.erase(buffer->get_id());
 230                 delete buffer;
 231         }
 232
 233         return 0;
 234 }
 235
 236 int32_t cros_gralloc_driver::lock(buffer_handle_t handle, int32_t acquire_fence, uint64_t flags,
 237                                   uint8_t *addr[DRV_MAX_PLANES])
 238 {
 239         int32_t ret = cros_gralloc_sync_wait(acquire_fence);
 240         if (ret)
 241                 return ret;
 242
 243         std::lock_guard<std::mutex> lock(mutex_);
 244         auto hnd = cros_gralloc_convert_handle(handle);
 245         if (!hnd) {
 246                 cros_gralloc_error("Invalid handle.");
 247                 return -EINVAL;
 248         }
 249
 250         auto buffer = get_buffer(hnd);
 251         if (!buffer) {
 252                 cros_gralloc_error("Invalid Reference.");
 253                 return -EINVAL;
 254         }
 255
 256         return buffer->lock(flags, addr);
 257 }
 258
 259 int32_t cros_gralloc_driver::unlock(buffer_handle_t handle, int32_t *release_fence)
 260 {
 261         std::lock_guard<std::mutex> lock(mutex_);
 262
 263         auto hnd = cros_gralloc_convert_handle(handle);
 264         if (!hnd) {
 265                 cros_gralloc_error("Invalid handle.");
 266                 return -EINVAL;
 267         }
 268
 269         auto buffer = get_buffer(hnd);
 270         if (!buffer) {
 271                 cros_gralloc_error("Invalid Reference.");
 272                 return -EINVAL;
 273         }
 274
 275         /*
 276          * From the ANativeWindow::dequeueBuffer documentation:
 277          *
 278          * "A value of -1 indicates that the caller may access the buffer immediately without
 279          * waiting on a fence."
 280          */
 281         *release_fence = -1;
 282         return buffer->unlock();
 283 }
 284
 285 int32_t cros_gralloc_driver::get_backing_store(buffer_handle_t handle, uint64_t *out_store)
 286 {
 287         std::lock_guard<std::mutex> lock(mutex_);
 288
 289         auto hnd = cros_gralloc_convert_handle(handle);
 290         if (!hnd) {
 291                 cros_gralloc_error("Invalid handle.");
 292                 return -EINVAL;
 293         }
 294
 295         auto buffer = get_buffer(hnd);
 296         if (!buffer) {
 297                 cros_gralloc_error("Invalid Reference.");
 298                 return -EINVAL;
 299         }
 300
 301         *out_store = static_cast<uint64_t>(buffer->get_id());
 302         return 0;
 303 }
 304
 305 cros_gralloc_buffer *cros_gralloc_driver::get_buffer(cros_gralloc_handle_t hnd)
 306 {
 307         /* Assumes driver mutex is held. */
 308         if (handles_.count(hnd))
 309                 return handles_[hnd].first;
 310
 311         return nullptr;
 312 }