OSDN Git Service

gralloc0_register_buffer: initialize gralloc0 when needed
[android-x86/external-minigbm.git] / rockchip.c
index f5311c6..5fb0be4 100644 (file)
 /*
- * Copyright (c) 2014 The Chromium OS Authors. All rights reserved.
+ * Copyright 2014 The Chromium OS Authors. All rights reserved.
  * Use of this source code is governed by a BSD-style license that can be
  * found in the LICENSE file.
  */
 
 #ifdef DRV_ROCKCHIP
 
-#include <assert.h>
 #include <errno.h>
+#include <rockchip_drm.h>
+#include <stdbool.h>
 #include <stdio.h>
 #include <string.h>
 #include <sys/mman.h>
 #include <xf86drm.h>
-#include <rockchip_drm.h>
 
 #include "drv_priv.h"
 #include "helpers.h"
 #include "util.h"
 
-static int rockchip_bo_create(struct bo *bo, uint32_t width, uint32_t height,
-                             uint32_t format, uint32_t flags)
+struct rockchip_private_map_data {
+       void *cached_addr;
+       void *gem_addr;
+};
+
+static const uint32_t render_target_formats[] = { DRM_FORMAT_ABGR8888, DRM_FORMAT_ARGB8888,
+                                                 DRM_FORMAT_RGB565, DRM_FORMAT_XBGR8888,
+                                                 DRM_FORMAT_XRGB8888 };
+
+static const uint32_t texture_source_formats[] = { DRM_FORMAT_R8, DRM_FORMAT_NV12,
+                                                  DRM_FORMAT_YVU420, DRM_FORMAT_YVU420_ANDROID };
+
+static int afbc_bo_from_format(struct bo *bo, uint32_t width, uint32_t height, uint32_t format)
 {
-       size_t plane;
+       /* We've restricted ourselves to four bytes per pixel. */
+       const uint32_t pixel_size = 4;
 
-       switch (format) {
-               case DRV_FORMAT_NV12:
-                       width = ALIGN(width, 4);
-                       height = ALIGN(height, 4);
-                       bo->strides[0] = bo->strides[1] = width;
-                       bo->sizes[0] = height * bo->strides[0];
-                       bo->sizes[1] = height * bo->strides[1] / 2;
-                       bo->offsets[0] = 0;
-                       bo->offsets[1] = height * bo->strides[0];
-                       break;
-               case DRV_FORMAT_XRGB8888:
-               case DRV_FORMAT_XBGR8888:
-               case DRV_FORMAT_ARGB8888:
-               case DRV_FORMAT_ABGR8888:
-                       bo->strides[0] = drv_stride_from_format(format, width, 0);
-                       bo->sizes[0] = height * bo->strides[0];
-                       bo->offsets[0] = 0;
-                       break;
-               default:
-                       fprintf(stderr, "drv: rockchip: unsupported format %4.4s\n",
-                               (char*)&format);
-                       assert(0);
-                       return -EINVAL;
+       const uint32_t clump_width = 4;
+       const uint32_t clump_height = 4;
+
+#define AFBC_NARROW 1
+#if AFBC_NARROW == 1
+       const uint32_t block_width = 4 * clump_width;
+       const uint32_t block_height = 4 * clump_height;
+#else
+       const uint32_t block_width = 8 * clump_width;
+       const uint32_t block_height = 2 * clump_height;
+#endif
+
+       const uint32_t header_block_size = 16;
+       const uint32_t body_block_size = block_width * block_height * pixel_size;
+       const uint32_t width_in_blocks = DIV_ROUND_UP(width, block_width);
+       const uint32_t height_in_blocks = DIV_ROUND_UP(height, block_height);
+       const uint32_t total_blocks = width_in_blocks * height_in_blocks;
+
+       const uint32_t header_plane_size = total_blocks * header_block_size;
+       const uint32_t body_plane_size = total_blocks * body_block_size;
+
+       /* GPU requires 64 bytes, but EGL import code expects 1024 byte
+        * alignement for the body plane. */
+       const uint32_t body_plane_alignment = 1024;
+
+       const uint32_t body_plane_offset = ALIGN(header_plane_size, body_plane_alignment);
+       const uint32_t total_size = body_plane_offset + body_plane_size;
+
+       bo->strides[0] = width_in_blocks * block_width * pixel_size;
+       bo->sizes[0] = total_size;
+       bo->offsets[0] = 0;
+
+       bo->total_size = total_size;
+
+       bo->format_modifiers[0] = DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC;
+
+       return 0;
+}
+
+static int rockchip_add_kms_item(struct driver *drv, const struct kms_item *item)
+{
+       int ret;
+       uint32_t i, j;
+       uint64_t use_flags;
+       struct combination *combo;
+       struct format_metadata metadata;
+
+       for (i = 0; i < drv->combos.size; i++) {
+               combo = &drv->combos.data[i];
+               if (combo->format == item->format) {
+                       if (item->modifier == DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC) {
+                               use_flags = BO_USE_RENDERING | BO_USE_SCANOUT | BO_USE_TEXTURE;
+                               metadata.modifier = item->modifier;
+                               metadata.tiling = 0;
+                               metadata.priority = 2;
+
+                               for (j = 0; j < ARRAY_SIZE(texture_source_formats); j++) {
+                                       if (item->format == texture_source_formats[j])
+                                               use_flags &= ~BO_USE_RENDERING;
+                               }
+
+                               ret =
+                                   drv_add_combination(drv, item[i].format, &metadata, use_flags);
+                               if (ret)
+                                       return ret;
+                       } else {
+                               combo->use_flags |= item->use_flags;
+                       }
+               }
        }
 
+       return 0;
+}
+
+static int rockchip_init(struct driver *drv)
+{
        int ret;
-       size_t size = 0;
+       uint32_t i, num_items;
+       struct kms_item *items;
+       struct format_metadata metadata;
 
-       for (plane = 0; plane < bo->num_planes; plane++)
-               size += bo->sizes[plane];
+       metadata.tiling = 0;
+       metadata.priority = 1;
+       metadata.modifier = DRM_FORMAT_MOD_LINEAR;
+
+       ret = drv_add_combinations(drv, render_target_formats, ARRAY_SIZE(render_target_formats),
+                                  &metadata, BO_USE_RENDER_MASK);
+       if (ret)
+               return ret;
+
+       ret = drv_add_combinations(drv, texture_source_formats, ARRAY_SIZE(texture_source_formats),
+                                  &metadata, BO_USE_TEXTURE_MASK);
+       if (ret)
+               return ret;
+
+       drv_modify_combination(drv, DRM_FORMAT_XRGB8888, &metadata, BO_USE_CURSOR | BO_USE_SCANOUT);
+       drv_modify_combination(drv, DRM_FORMAT_ARGB8888, &metadata, BO_USE_CURSOR | BO_USE_SCANOUT);
+
+       /* Camera ISP supports only NV12 output. */
+       drv_modify_combination(drv, DRM_FORMAT_NV12, &metadata,
+                              BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE);
+       /*
+        * R8 format is used for Android's HAL_PIXEL_FORMAT_BLOB and is used for JPEG snapshots
+        * from camera.
+        */
+       drv_modify_combination(drv, DRM_FORMAT_R8, &metadata,
+                              BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE);
+
+       items = drv_query_kms(drv, &num_items);
+       if (!items || !num_items)
+               return 0;
+
+       for (i = 0; i < num_items; i++) {
+               ret = rockchip_add_kms_item(drv, &items[i]);
+               if (ret) {
+                       free(items);
+                       return ret;
+               }
+       }
+
+       free(items);
+       return 0;
+}
+
+static bool has_modifier(const uint64_t *list, uint32_t count, uint64_t modifier)
+{
+       uint32_t i;
+       for (i = 0; i < count; i++)
+               if (list[i] == modifier)
+                       return true;
+
+       return false;
+}
 
+static int rockchip_bo_create_with_modifiers(struct bo *bo, uint32_t width, uint32_t height,
+                                            uint32_t format, const uint64_t *modifiers,
+                                            uint32_t count)
+{
+       int ret;
+       size_t plane;
        struct drm_rockchip_gem_create gem_create;
 
+       if (format == DRM_FORMAT_NV12) {
+               uint32_t w_mbs = DIV_ROUND_UP(ALIGN(width, 16), 16);
+               uint32_t h_mbs = DIV_ROUND_UP(ALIGN(height, 16), 16);
+
+               uint32_t aligned_width = w_mbs * 16;
+               uint32_t aligned_height = DIV_ROUND_UP(h_mbs * 16 * 3, 2);
+
+               drv_bo_from_format(bo, aligned_width, height, format);
+               bo->total_size = bo->strides[0] * aligned_height + w_mbs * h_mbs * 128;
+       } else if (width <= 2560 &&
+                  has_modifier(modifiers, count, DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC)) {
+               /* If the caller has decided they can use AFBC, always
+                * pick that */
+               afbc_bo_from_format(bo, width, height, format);
+       } else {
+               if (!has_modifier(modifiers, count, DRM_FORMAT_MOD_LINEAR)) {
+                       errno = EINVAL;
+                       fprintf(stderr, "no usable modifier found\n");
+                       return -1;
+               }
+
+               uint32_t stride;
+               /*
+                * Since the ARM L1 cache line size is 64 bytes, align to that
+                * as a performance optimization. For YV12, the Mali cmem allocator
+                * requires that chroma planes are aligned to 64-bytes, so align the
+                * luma plane to 128 bytes.
+                */
+               stride = drv_stride_from_format(format, width, 0);
+               if (format == DRM_FORMAT_YVU420 || format == DRM_FORMAT_YVU420_ANDROID)
+                       stride = ALIGN(stride, 128);
+               else
+                       stride = ALIGN(stride, 64);
+
+               drv_bo_from_format(bo, stride, height, format);
+       }
+
        memset(&gem_create, 0, sizeof(gem_create));
-       gem_create.size = size;
+       gem_create.size = bo->total_size;
 
-       ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_CREATE,
-                          &gem_create);
+       ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_CREATE, &gem_create);
 
        if (ret) {
-               fprintf(stderr, "drv: DRM_IOCTL_ROCKCHIP_GEM_CREATE failed "
-                               "(size=%zu)\n", size);
-       }
-       else {
-               for (plane = 0; plane < bo->num_planes; plane++)
-                       bo->handles[plane].u32 = gem_create.handle;
+               fprintf(stderr, "drv: DRM_IOCTL_ROCKCHIP_GEM_CREATE failed (size=%llu)\n",
+                       gem_create.size);
+               return ret;
        }
 
-       return ret;
+       for (plane = 0; plane < bo->num_planes; plane++)
+               bo->handles[plane].u32 = gem_create.handle;
+
+       return 0;
 }
 
-static void *rockchip_bo_map(struct bo *bo)
+static int rockchip_bo_create(struct bo *bo, uint32_t width, uint32_t height, uint32_t format,
+                             uint64_t use_flags)
+{
+       uint64_t modifiers[] = { DRM_FORMAT_MOD_LINEAR };
+       return rockchip_bo_create_with_modifiers(bo, width, height, format, modifiers,
+                                                ARRAY_SIZE(modifiers));
+}
+
+static void *rockchip_bo_map(struct bo *bo, struct map_info *data, size_t plane, uint32_t map_flags)
 {
        int ret;
        struct drm_rockchip_gem_map_off gem_map;
+       struct rockchip_private_map_data *priv;
+
+       /* We can only map buffers created with SW access flags, which should
+        * have no modifiers (ie, not AFBC). */
+       if (bo->format_modifiers[0] == DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC)
+               return MAP_FAILED;
 
        memset(&gem_map, 0, sizeof(gem_map));
        gem_map.handle = bo->handles[0].u32;
 
-       ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET,
-                      &gem_map);
+       ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET, &gem_map);
        if (ret) {
-               fprintf(stderr,
-                       "drv: DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET failed\n");
+               fprintf(stderr, "drv: DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET failed\n");
                return MAP_FAILED;
        }
 
-       return mmap(0, bo->sizes[0], PROT_READ | PROT_WRITE, MAP_SHARED,
-                   bo->drv->fd, gem_map.offset);
+       void *addr = mmap(0, bo->total_size, drv_get_prot(map_flags), MAP_SHARED, bo->drv->fd,
+                         gem_map.offset);
+
+       data->length = bo->total_size;
+
+       if (bo->use_flags & BO_USE_RENDERSCRIPT) {
+               priv = calloc(1, sizeof(*priv));
+               priv->cached_addr = calloc(1, bo->total_size);
+               priv->gem_addr = addr;
+               memcpy(priv->cached_addr, priv->gem_addr, bo->total_size);
+               data->priv = priv;
+               addr = priv->cached_addr;
+       }
+
+       return addr;
+}
+
+static int rockchip_bo_unmap(struct bo *bo, struct map_info *data)
+{
+       if (data->priv) {
+               struct rockchip_private_map_data *priv = data->priv;
+               data->addr = priv->gem_addr;
+               free(priv->cached_addr);
+               free(priv);
+               data->priv = NULL;
+       }
+
+       return munmap(data->addr, data->length);
 }
 
-drv_format_t rockchip_resolve_format(drv_format_t format)
+static int rockchip_bo_flush(struct bo *bo, struct map_info *data)
+{
+       struct rockchip_private_map_data *priv = data->priv;
+       if (priv && (data->map_flags & BO_MAP_WRITE))
+               memcpy(priv->gem_addr, priv->cached_addr, bo->total_size);
+
+       return 0;
+}
+
+static uint32_t rockchip_resolve_format(uint32_t format, uint64_t use_flags)
 {
        switch (format) {
-       case DRV_FORMAT_FLEX_IMPLEMENTATION_DEFINED:
+       case DRM_FORMAT_FLEX_IMPLEMENTATION_DEFINED:
+               /* Camera subsystem requires NV12. */
+               if (use_flags & (BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE))
+                       return DRM_FORMAT_NV12;
                /*HACK: See b/28671744 */
-               return DRV_FORMAT_XBGR8888;
-       case DRV_FORMAT_FLEX_YCbCr_420_888:
-               return DRV_FORMAT_NV12;
+               return DRM_FORMAT_XBGR8888;
+       case DRM_FORMAT_FLEX_YCbCr_420_888:
+               return DRM_FORMAT_NV12;
        default:
                return format;
        }
 }
 
-const struct backend backend_rockchip =
-{
+struct backend backend_rockchip = {
        .name = "rockchip",
+       .init = rockchip_init,
        .bo_create = rockchip_bo_create,
+       .bo_create_with_modifiers = rockchip_bo_create_with_modifiers,
        .bo_destroy = drv_gem_bo_destroy,
+       .bo_import = drv_prime_bo_import,
        .bo_map = rockchip_bo_map,
+       .bo_unmap = rockchip_bo_unmap,
+       .bo_flush = rockchip_bo_flush,
        .resolve_format = rockchip_resolve_format,
-       .format_list = {
-               {DRV_FORMAT_XRGB8888, DRV_BO_USE_SCANOUT | DRV_BO_USE_CURSOR |
-                                     DRV_BO_USE_RENDERING | DRV_BO_USE_HW_TEXTURE |
-                                     DRV_BO_USE_HW_RENDER | DRV_BO_USE_HW_2D |
-                                     DRV_BO_USE_SW_READ_RARELY | DRV_BO_USE_SW_WRITE_RARELY},
-               {DRV_FORMAT_XRGB8888, DRV_BO_USE_SCANOUT | DRV_BO_USE_CURSOR | DRV_BO_USE_LINEAR |
-                                     DRV_BO_USE_SW_READ_OFTEN | DRV_BO_USE_SW_WRITE_OFTEN},
-               {DRV_FORMAT_XBGR8888, DRV_BO_USE_SCANOUT | DRV_BO_USE_CURSOR |
-                                     DRV_BO_USE_RENDERING | DRV_BO_USE_HW_TEXTURE |
-                                     DRV_BO_USE_HW_RENDER | DRV_BO_USE_HW_2D |
-                                     DRV_BO_USE_SW_READ_RARELY | DRV_BO_USE_SW_WRITE_RARELY},
-               {DRV_FORMAT_XBGR8888, DRV_BO_USE_SCANOUT | DRV_BO_USE_CURSOR | DRV_BO_USE_LINEAR |
-                                     DRV_BO_USE_SW_READ_OFTEN | DRV_BO_USE_SW_WRITE_OFTEN},
-               {DRV_FORMAT_ARGB8888, DRV_BO_USE_SCANOUT | DRV_BO_USE_CURSOR |
-                                     DRV_BO_USE_RENDERING | DRV_BO_USE_HW_TEXTURE |
-                                     DRV_BO_USE_HW_RENDER | DRV_BO_USE_HW_2D |
-                                     DRV_BO_USE_SW_READ_RARELY | DRV_BO_USE_SW_WRITE_RARELY},
-               {DRV_FORMAT_ARGB8888, DRV_BO_USE_SCANOUT | DRV_BO_USE_CURSOR | DRV_BO_USE_LINEAR |
-                                     DRV_BO_USE_SW_READ_OFTEN | DRV_BO_USE_SW_WRITE_OFTEN},
-               {DRV_FORMAT_ABGR8888, DRV_BO_USE_SCANOUT | DRV_BO_USE_CURSOR |
-                                     DRV_BO_USE_RENDERING | DRV_BO_USE_HW_TEXTURE |
-                                     DRV_BO_USE_HW_RENDER | DRV_BO_USE_HW_2D |
-                                     DRV_BO_USE_SW_READ_RARELY | DRV_BO_USE_SW_WRITE_RARELY},
-               {DRV_FORMAT_NV12,     DRV_BO_USE_SCANOUT | DRV_BO_USE_RENDERING |
-                                     DRV_BO_USE_HW_TEXTURE | DRV_BO_USE_HW_RENDER |
-                                     DRV_BO_USE_HW_2D | DRV_BO_USE_SW_READ_RARELY |
-                                     DRV_BO_USE_SW_WRITE_RARELY},
-               {DRV_FORMAT_NV12,     DRV_BO_USE_SCANOUT | DRV_BO_USE_LINEAR |
-                                     DRV_BO_USE_SW_READ_OFTEN | DRV_BO_USE_SW_WRITE_OFTEN},
-       }
 };
 
 #endif