rockchip.c

   1 /*
   2  * Copyright 2014 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 #ifdef DRV_ROCKCHIP
   8
   9 #include <errno.h>
  10 #include <rockchip_drm.h>
  11 #include <stdbool.h>
  12 #include <stdio.h>
  13 #include <string.h>
  14 #include <sys/mman.h>
  15 #include <xf86drm.h>
  16
  17 #include "drv_priv.h"
  18 #include "helpers.h"
  19 #include "util.h"
  20
  21 struct rockchip_private_map_data {
  22         void *cached_addr;
  23         void *gem_addr;
  24 };
  25
  26 static const uint32_t render_target_formats[] = { DRM_FORMAT_ABGR8888, DRM_FORMAT_ARGB8888,
  27                                                   DRM_FORMAT_RGB565, DRM_FORMAT_XBGR8888,
  28                                                   DRM_FORMAT_XRGB8888 };
  29
  30 static const uint32_t texture_source_formats[] = { DRM_FORMAT_R8, DRM_FORMAT_NV12,
  31                                                    DRM_FORMAT_YVU420, DRM_FORMAT_YVU420_ANDROID };
  32
  33 static int afbc_bo_from_format(struct bo *bo, uint32_t width, uint32_t height, uint32_t format)
  34 {
  35         /* We've restricted ourselves to four bytes per pixel. */
  36         const uint32_t pixel_size = 4;
  37
  38         const uint32_t clump_width = 4;
  39         const uint32_t clump_height = 4;
  40
  41 #define AFBC_NARROW 1
  42 #if AFBC_NARROW == 1
  43         const uint32_t block_width = 4 * clump_width;
  44         const uint32_t block_height = 4 * clump_height;
  45 #else
  46         const uint32_t block_width = 8 * clump_width;
  47         const uint32_t block_height = 2 * clump_height;
  48 #endif
  49
  50         const uint32_t header_block_size = 16;
  51         const uint32_t body_block_size = block_width * block_height * pixel_size;
  52         const uint32_t width_in_blocks = DIV_ROUND_UP(width, block_width);
  53         const uint32_t height_in_blocks = DIV_ROUND_UP(height, block_height);
  54         const uint32_t total_blocks = width_in_blocks * height_in_blocks;
  55
  56         const uint32_t header_plane_size = total_blocks * header_block_size;
  57         const uint32_t body_plane_size = total_blocks * body_block_size;
  58
  59         /* GPU requires 64 bytes, but EGL import code expects 1024 byte
  60          * alignement for the body plane. */
  61         const uint32_t body_plane_alignment = 1024;
  62
  63         const uint32_t body_plane_offset = ALIGN(header_plane_size, body_plane_alignment);
  64         const uint32_t total_size = body_plane_offset + body_plane_size;
  65
  66         bo->strides[0] = width_in_blocks * block_width * pixel_size;
  67         bo->sizes[0] = total_size;
  68         bo->offsets[0] = 0;
  69
  70         bo->total_size = total_size;
  71
  72         bo->format_modifiers[0] = DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC;
  73
  74         return 0;
  75 }
  76
  77 static int rockchip_add_kms_item(struct driver *drv, const struct kms_item *item)
  78 {
  79         int ret;
  80         uint32_t i, j;
  81         uint64_t use_flags;
  82         struct combination *combo;
  83         struct format_metadata metadata;
  84
  85         for (i = 0; i < drv->combos.size; i++) {
  86                 combo = &drv->combos.data[i];
  87                 if (combo->format == item->format) {
  88                         if (item->modifier == DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC) {
  89                                 use_flags = BO_USE_RENDERING | BO_USE_SCANOUT | BO_USE_TEXTURE;
  90                                 metadata.modifier = item->modifier;
  91                                 metadata.tiling = 0;
  92                                 metadata.priority = 2;
  93
  94                                 for (j = 0; j < ARRAY_SIZE(texture_source_formats); j++) {
  95                                         if (item->format == texture_source_formats[j])
  96                                                 use_flags &= ~BO_USE_RENDERING;
  97                                 }
  98
  99                                 ret =
 100                                     drv_add_combination(drv, item[i].format, &metadata, use_flags);
 101                                 if (ret)
 102                                         return ret;
 103                         } else {
 104                                 combo->use_flags |= item->use_flags;
 105                         }
 106                 }
 107         }
 108
 109         return 0;
 110 }
 111
 112 static int rockchip_init(struct driver *drv)
 113 {
 114         int ret;
 115         uint32_t i, num_items;
 116         struct kms_item *items;
 117         struct format_metadata metadata;
 118
 119         metadata.tiling = 0;
 120         metadata.priority = 1;
 121         metadata.modifier = DRM_FORMAT_MOD_LINEAR;
 122
 123         ret = drv_add_combinations(drv, render_target_formats, ARRAY_SIZE(render_target_formats),
 124                                    &metadata, BO_USE_RENDER_MASK);
 125         if (ret)
 126                 return ret;
 127
 128         ret = drv_add_combinations(drv, texture_source_formats, ARRAY_SIZE(texture_source_formats),
 129                                    &metadata, BO_USE_TEXTURE_MASK);
 130         if (ret)
 131                 return ret;
 132
 133         drv_modify_combination(drv, DRM_FORMAT_XRGB8888, &metadata, BO_USE_CURSOR | BO_USE_SCANOUT);
 134         drv_modify_combination(drv, DRM_FORMAT_ARGB8888, &metadata, BO_USE_CURSOR | BO_USE_SCANOUT);
 135
 136         /* Camera ISP supports only NV12 output. */
 137         drv_modify_combination(drv, DRM_FORMAT_NV12, &metadata,
 138                                BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE);
 139         /*
 140          * R8 format is used for Android's HAL_PIXEL_FORMAT_BLOB and is used for JPEG snapshots
 141          * from camera.
 142          */
 143         drv_modify_combination(drv, DRM_FORMAT_R8, &metadata,
 144                                BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE);
 145
 146         items = drv_query_kms(drv, &num_items);
 147         if (!items || !num_items)
 148                 return 0;
 149
 150         for (i = 0; i < num_items; i++) {
 151                 ret = rockchip_add_kms_item(drv, &items[i]);
 152                 if (ret) {
 153                         free(items);
 154                         return ret;
 155                 }
 156         }
 157
 158         free(items);
 159         return 0;
 160 }
 161
 162 static bool has_modifier(const uint64_t *list, uint32_t count, uint64_t modifier)
 163 {
 164         uint32_t i;
 165         for (i = 0; i < count; i++)
 166                 if (list[i] == modifier)
 167                         return true;
 168
 169         return false;
 170 }
 171
 172 static int rockchip_bo_create_with_modifiers(struct bo *bo, uint32_t width, uint32_t height,
 173                                              uint32_t format, const uint64_t *modifiers,
 174                                              uint32_t count)
 175 {
 176         int ret;
 177         size_t plane;
 178         struct drm_rockchip_gem_create gem_create;
 179
 180         if (format == DRM_FORMAT_NV12) {
 181                 uint32_t w_mbs = DIV_ROUND_UP(ALIGN(width, 16), 16);
 182                 uint32_t h_mbs = DIV_ROUND_UP(ALIGN(height, 16), 16);
 183
 184                 uint32_t aligned_width = w_mbs * 16;
 185                 uint32_t aligned_height = DIV_ROUND_UP(h_mbs * 16 * 3, 2);
 186
 187                 drv_bo_from_format(bo, aligned_width, height, format);
 188                 bo->total_size = bo->strides[0] * aligned_height + w_mbs * h_mbs * 128;
 189         } else if (width <= 2560 &&
 190                    has_modifier(modifiers, count, DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC)) {
 191                 /* If the caller has decided they can use AFBC, always
 192                  * pick that */
 193                 afbc_bo_from_format(bo, width, height, format);
 194         } else {
 195                 if (!has_modifier(modifiers, count, DRM_FORMAT_MOD_LINEAR)) {
 196                         errno = EINVAL;
 197                         fprintf(stderr, "no usable modifier found\n");
 198                         return -1;
 199                 }
 200
 201                 uint32_t stride;
 202                 /*
 203                  * Since the ARM L1 cache line size is 64 bytes, align to that
 204                  * as a performance optimization. For YV12, the Mali cmem allocator
 205                  * requires that chroma planes are aligned to 64-bytes, so align the
 206                  * luma plane to 128 bytes.
 207                  */
 208                 stride = drv_stride_from_format(format, width, 0);
 209                 if (format == DRM_FORMAT_YVU420 || format == DRM_FORMAT_YVU420_ANDROID)
 210                         stride = ALIGN(stride, 128);
 211                 else
 212                         stride = ALIGN(stride, 64);
 213
 214                 drv_bo_from_format(bo, stride, height, format);
 215         }
 216
 217         memset(&gem_create, 0, sizeof(gem_create));
 218         gem_create.size = bo->total_size;
 219
 220         ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_CREATE, &gem_create);
 221
 222         if (ret) {
 223                 fprintf(stderr, "drv: DRM_IOCTL_ROCKCHIP_GEM_CREATE failed (size=%llu)\n",
 224                         gem_create.size);
 225                 return ret;
 226         }
 227
 228         for (plane = 0; plane < bo->num_planes; plane++)
 229                 bo->handles[plane].u32 = gem_create.handle;
 230
 231         return 0;
 232 }
 233
 234 static int rockchip_bo_create(struct bo *bo, uint32_t width, uint32_t height, uint32_t format,
 235                               uint64_t use_flags)
 236 {
 237         uint64_t modifiers[] = { DRM_FORMAT_MOD_LINEAR };
 238         return rockchip_bo_create_with_modifiers(bo, width, height, format, modifiers,
 239                                                  ARRAY_SIZE(modifiers));
 240 }
 241
 242 static void *rockchip_bo_map(struct bo *bo, struct map_info *data, size_t plane, uint32_t map_flags)
 243 {
 244         int ret;
 245         struct drm_rockchip_gem_map_off gem_map;
 246         struct rockchip_private_map_data *priv;
 247
 248         /* We can only map buffers created with SW access flags, which should
 249          * have no modifiers (ie, not AFBC). */
 250         if (bo->format_modifiers[0] == DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC)
 251                 return MAP_FAILED;
 252
 253         memset(&gem_map, 0, sizeof(gem_map));
 254         gem_map.handle = bo->handles[0].u32;
 255
 256         ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET, &gem_map);
 257         if (ret) {
 258                 fprintf(stderr, "drv: DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET failed\n");
 259                 return MAP_FAILED;
 260         }
 261
 262         void *addr = mmap(0, bo->total_size, drv_get_prot(map_flags), MAP_SHARED, bo->drv->fd,
 263                           gem_map.offset);
 264
 265         data->length = bo->total_size;
 266
 267         if (bo->use_flags & BO_USE_RENDERSCRIPT) {
 268                 priv = calloc(1, sizeof(*priv));
 269                 priv->cached_addr = calloc(1, bo->total_size);
 270                 priv->gem_addr = addr;
 271                 memcpy(priv->cached_addr, priv->gem_addr, bo->total_size);
 272                 data->priv = priv;
 273                 addr = priv->cached_addr;
 274         }
 275
 276         return addr;
 277 }
 278
 279 static int rockchip_bo_unmap(struct bo *bo, struct map_info *data)
 280 {
 281         if (data->priv) {
 282                 struct rockchip_private_map_data *priv = data->priv;
 283                 data->addr = priv->gem_addr;
 284                 free(priv->cached_addr);
 285                 free(priv);
 286                 data->priv = NULL;
 287         }
 288
 289         return munmap(data->addr, data->length);
 290 }
 291
 292 static int rockchip_bo_flush(struct bo *bo, struct map_info *data)
 293 {
 294         struct rockchip_private_map_data *priv = data->priv;
 295         if (priv && (data->map_flags & BO_MAP_WRITE))
 296                 memcpy(priv->gem_addr, priv->cached_addr, bo->total_size);
 297
 298         return 0;
 299 }
 300
 301 static uint32_t rockchip_resolve_format(uint32_t format, uint64_t use_flags)
 302 {
 303         switch (format) {
 304         case DRM_FORMAT_FLEX_IMPLEMENTATION_DEFINED:
 305                 /* Camera subsystem requires NV12. */
 306                 if (use_flags & (BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE))
 307                         return DRM_FORMAT_NV12;
 308                 /*HACK: See b/28671744 */
 309                 return DRM_FORMAT_XBGR8888;
 310         case DRM_FORMAT_FLEX_YCbCr_420_888:
 311                 return DRM_FORMAT_NV12;
 312         default:
 313                 return format;
 314         }
 315 }
 316
 317 struct backend backend_rockchip = {
 318         .name = "rockchip",
 319         .init = rockchip_init,
 320         .bo_create = rockchip_bo_create,
 321         .bo_create_with_modifiers = rockchip_bo_create_with_modifiers,
 322         .bo_destroy = drv_gem_bo_destroy,
 323         .bo_import = drv_prime_bo_import,
 324         .bo_map = rockchip_bo_map,
 325         .bo_unmap = rockchip_bo_unmap,
 326         .bo_flush = rockchip_bo_flush,
 327         .resolve_format = rockchip_resolve_format,
 328 };
 329
 330 #endif