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->use_flags);
  82         combo = drv_get_combination(drv_, resolved_format, descriptor->use_flags);
  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->use_flags);
  98         bo = drv_bo_create(drv_, descriptor->width, descriptor->height, resolved_format,
  99                            descriptor->use_flags);
 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
 128                 mod = drv_bo_get_plane_format_modifier(bo, plane);
 129                 hnd->format_modifiers[2 * plane] = static_cast<uint32_t>(mod >> 32);
 130                 hnd->format_modifiers[2 * plane + 1] = static_cast<uint32_t>(mod);
 131         }
 132
 133         hnd->width = drv_bo_get_width(bo);
 134         hnd->height = drv_bo_get_height(bo);
 135         hnd->format = drv_bo_get_format(bo);
 136         hnd->use_flags[0] = static_cast<uint32_t>(descriptor->use_flags >> 32);
 137         hnd->use_flags[1] = static_cast<uint32_t>(descriptor->use_flags);
 138         hnd->pixel_stride = drv_bo_get_stride_in_pixels(bo);
 139         hnd->magic = cros_gralloc_magic;
 140         hnd->droid_format = descriptor->droid_format;
 141         hnd->usage = descriptor->producer_usage;
 142
 143         id = drv_bo_get_plane_handle(bo, 0).u32;
 144         auto buffer = new cros_gralloc_buffer(id, bo, hnd);
 145
 146         std::lock_guard<std::mutex> lock(mutex_);
 147         buffers_.emplace(id, buffer);
 148         handles_.emplace(hnd, std::make_pair(buffer, 1));
 149         *out_handle = &hnd->base;
 150         return 0;
 151 }
 152
 153 int32_t cros_gralloc_driver::retain(buffer_handle_t handle)
 154 {
 155         uint32_t id;
 156         std::lock_guard<std::mutex> lock(mutex_);
 157
 158         auto hnd = cros_gralloc_convert_handle(handle);
 159         if (!hnd) {
 160                 cros_gralloc_error("Invalid handle.");
 161                 return -EINVAL;
 162         }
 163
 164         auto buffer = get_buffer(hnd);
 165         if (buffer) {
 166                 handles_[hnd].second++;
 167                 buffer->increase_refcount();
 168                 return 0;
 169         }
 170
 171         if (drmPrimeFDToHandle(drv_get_fd(drv_), hnd->fds[0], &id)) {
 172                 cros_gralloc_error("drmPrimeFDToHandle failed.");
 173                 return -errno;
 174         }
 175
 176         if (buffers_.count(id)) {
 177                 buffer = buffers_[id];
 178                 buffer->increase_refcount();
 179         } else {
 180                 struct bo *bo;
 181                 struct drv_import_fd_data data;
 182                 data.format = hnd->format;
 183                 data.width = hnd->width;
 184                 data.height = hnd->height;
 185                 data.use_flags = static_cast<uint64_t>(hnd->use_flags[0]) << 32;
 186                 data.use_flags |= hnd->use_flags[1];
 187
 188                 memcpy(data.fds, hnd->fds, sizeof(data.fds));
 189                 memcpy(data.strides, hnd->strides, sizeof(data.strides));
 190                 memcpy(data.offsets, hnd->offsets, sizeof(data.offsets));
 191                 for (uint32_t plane = 0; plane < DRV_MAX_PLANES; plane++) {
 192                         data.format_modifiers[plane] =
 193                             static_cast<uint64_t>(hnd->format_modifiers[2 * plane]) << 32;
 194                         data.format_modifiers[plane] |= hnd->format_modifiers[2 * plane + 1];
 195                 }
 196
 197                 bo = drv_bo_import(drv_, &data);
 198                 if (!bo)
 199                         return -EFAULT;
 200
 201                 id = drv_bo_get_plane_handle(bo, 0).u32;
 202
 203                 buffer = new cros_gralloc_buffer(id, bo, nullptr);
 204                 buffers_.emplace(id, buffer);
 205         }
 206
 207         handles_.emplace(hnd, std::make_pair(buffer, 1));
 208         return 0;
 209 }
 210
 211 int32_t cros_gralloc_driver::release(buffer_handle_t handle)
 212 {
 213         std::lock_guard<std::mutex> lock(mutex_);
 214
 215         auto hnd = cros_gralloc_convert_handle(handle);
 216         if (!hnd) {
 217                 cros_gralloc_error("Invalid handle.");
 218                 return -EINVAL;
 219         }
 220
 221         auto buffer = get_buffer(hnd);
 222         if (!buffer) {
 223                 cros_gralloc_error("Invalid Reference.");
 224                 return -EINVAL;
 225         }
 226
 227         if (!--handles_[hnd].second)
 228                 handles_.erase(hnd);
 229
 230         if (buffer->decrease_refcount() == 0) {
 231                 buffers_.erase(buffer->get_id());
 232                 delete buffer;
 233         }
 234
 235         return 0;
 236 }
 237
 238 int32_t cros_gralloc_driver::lock(buffer_handle_t handle, int32_t acquire_fence, uint32_t map_flags,
 239                                   uint8_t *addr[DRV_MAX_PLANES])
 240 {
 241         int32_t ret = cros_gralloc_sync_wait(acquire_fence);
 242         if (ret)
 243                 return ret;
 244
 245         std::lock_guard<std::mutex> lock(mutex_);
 246         auto hnd = cros_gralloc_convert_handle(handle);
 247         if (!hnd) {
 248                 cros_gralloc_error("Invalid handle.");
 249                 return -EINVAL;
 250         }
 251
 252         auto buffer = get_buffer(hnd);
 253         if (!buffer) {
 254                 cros_gralloc_error("Invalid Reference.");
 255                 return -EINVAL;
 256         }
 257
 258         return buffer->lock(map_flags, addr);
 259 }
 260
 261 int32_t cros_gralloc_driver::unlock(buffer_handle_t handle, int32_t *release_fence)
 262 {
 263         std::lock_guard<std::mutex> lock(mutex_);
 264
 265         auto hnd = cros_gralloc_convert_handle(handle);
 266         if (!hnd) {
 267                 cros_gralloc_error("Invalid handle.");
 268                 return -EINVAL;
 269         }
 270
 271         auto buffer = get_buffer(hnd);
 272         if (!buffer) {
 273                 cros_gralloc_error("Invalid Reference.");
 274                 return -EINVAL;
 275         }
 276
 277         /*
 278          * From the ANativeWindow::dequeueBuffer documentation:
 279          *
 280          * "A value of -1 indicates that the caller may access the buffer immediately without
 281          * waiting on a fence."
 282          */
 283         *release_fence = -1;
 284         return buffer->unlock();
 285 }
 286
 287 int32_t cros_gralloc_driver::get_backing_store(buffer_handle_t handle, uint64_t *out_store)
 288 {
 289         std::lock_guard<std::mutex> lock(mutex_);
 290
 291         auto hnd = cros_gralloc_convert_handle(handle);
 292         if (!hnd) {
 293                 cros_gralloc_error("Invalid handle.");
 294                 return -EINVAL;
 295         }
 296
 297         auto buffer = get_buffer(hnd);
 298         if (!buffer) {
 299                 cros_gralloc_error("Invalid Reference.");
 300                 return -EINVAL;
 301         }
 302
 303         *out_store = static_cast<uint64_t>(buffer->get_id());
 304         return 0;
 305 }
 306
 307 cros_gralloc_buffer *cros_gralloc_driver::get_buffer(cros_gralloc_handle_t hnd)
 308 {
 309         /* Assumes driver mutex is held. */
 310         if (handles_.count(hnd))
 311                 return handles_[hnd].first;
 312
 313         return nullptr;
 314 }