| /* |
| * 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 <errno.h> |
| #include <inttypes.h> |
| #include <rockchip_drm.h> |
| #include <stdio.h> |
| #include <string.h> |
| #include <sys/mman.h> |
| #include <xf86drm.h> |
| |
| #include "drv_helpers.h" |
| #include "drv_priv.h" |
| #include "util.h" |
| |
| struct rockchip_private_map_data { |
| void *cached_addr; |
| void *gem_addr; |
| }; |
| |
| static const uint32_t scanout_render_formats[] = { DRM_FORMAT_ABGR8888, DRM_FORMAT_ARGB8888, |
| DRM_FORMAT_BGR888, DRM_FORMAT_RGB565, |
| DRM_FORMAT_XBGR8888, DRM_FORMAT_XRGB8888 }; |
| |
| static const uint32_t texture_only_formats[] = { 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) |
| { |
| /* We've restricted ourselves to four bytes per pixel. */ |
| const uint32_t pixel_size = 4; |
| |
| 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->meta.strides[0] = width_in_blocks * block_width * pixel_size; |
| bo->meta.sizes[0] = total_size; |
| bo->meta.offsets[0] = 0; |
| |
| bo->meta.total_size = total_size; |
| |
| bo->meta.format_modifier = DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC; |
| |
| return 0; |
| } |
| |
| static int rockchip_init(struct driver *drv) |
| { |
| struct format_metadata metadata; |
| |
| metadata.tiling = 0; |
| metadata.priority = 1; |
| metadata.modifier = DRM_FORMAT_MOD_LINEAR; |
| |
| drv_add_combinations(drv, scanout_render_formats, ARRAY_SIZE(scanout_render_formats), |
| &metadata, BO_USE_RENDER_MASK | BO_USE_SCANOUT); |
| |
| drv_add_combinations(drv, texture_only_formats, ARRAY_SIZE(texture_only_formats), &metadata, |
| BO_USE_TEXTURE_MASK); |
| |
| /* NV12 format for camera, display, decoding and encoding. */ |
| /* Camera ISP supports only NV12 output. */ |
| drv_modify_combination(drv, DRM_FORMAT_NV12, &metadata, |
| BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE | BO_USE_SCANOUT | |
| BO_USE_HW_VIDEO_DECODER | BO_USE_HW_VIDEO_ENCODER); |
| |
| drv_modify_linear_combinations(drv); |
| /* |
| * R8 format is used for Android's HAL_PIXEL_FORMAT_BLOB and is used for JPEG snapshots |
| * from camera and input/output from hardware decoder/encoder. |
| */ |
| drv_add_combination(drv, DRM_FORMAT_R8, &metadata, |
| BO_USE_CAMERA_READ | BO_USE_CAMERA_WRITE | BO_USE_SW_MASK | |
| BO_USE_LINEAR | BO_USE_HW_VIDEO_DECODER | BO_USE_HW_VIDEO_ENCODER); |
| |
| return 0; |
| } |
| |
| 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 = { 0 }; |
| |
| if (format == DRM_FORMAT_NV12) { |
| uint32_t w_mbs = DIV_ROUND_UP(width, 16); |
| uint32_t h_mbs = DIV_ROUND_UP(height, 16); |
| |
| uint32_t aligned_width = w_mbs * 16; |
| uint32_t aligned_height = h_mbs * 16; |
| |
| drv_bo_from_format(bo, aligned_width, aligned_height, format); |
| /* |
| * drv_bo_from_format updates total_size. Add an extra data space for rockchip video |
| * driver to store motion vectors. |
| */ |
| bo->meta.total_size += w_mbs * h_mbs * 128; |
| } else if (width <= 2560 && |
| drv_has_modifier(modifiers, count, DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC) && |
| bo->drv->compression) { |
| /* If the caller has decided they can use AFBC, always |
| * pick that */ |
| afbc_bo_from_format(bo, width, height, format); |
| } else { |
| if (!drv_has_modifier(modifiers, count, DRM_FORMAT_MOD_LINEAR)) { |
| errno = EINVAL; |
| drv_log("no usable modifier found\n"); |
| return -errno; |
| } |
| |
| 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); |
| } |
| |
| gem_create.size = bo->meta.total_size; |
| ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_CREATE, &gem_create); |
| |
| if (ret) { |
| drv_log("DRM_IOCTL_ROCKCHIP_GEM_CREATE failed (size=%" PRIu64 ")\n", |
| gem_create.size); |
| return -errno; |
| } |
| |
| for (plane = 0; plane < bo->meta.num_planes; plane++) |
| bo->handles[plane].u32 = gem_create.handle; |
| |
| return 0; |
| } |
| |
| 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 vma *vma, size_t plane, uint32_t map_flags) |
| { |
| int ret; |
| struct rockchip_private_map_data *priv; |
| struct drm_rockchip_gem_map_off gem_map = { 0 }; |
| void *addr = NULL; |
| |
| /* We can only map buffers created with SW access flags, which should |
| * have no modifiers (ie, not AFBC). */ |
| if (bo->meta.format_modifier == DRM_FORMAT_MOD_CHROMEOS_ROCKCHIP_AFBC) |
| return MAP_FAILED; |
| |
| gem_map.handle = bo->handles[0].u32; |
| ret = drmIoctl(bo->drv->fd, DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET, &gem_map); |
| if (ret) { |
| drv_log("DRM_IOCTL_ROCKCHIP_GEM_MAP_OFFSET failed\n"); |
| return MAP_FAILED; |
| } |
| |
| addr = mmap(0, bo->meta.total_size, drv_get_prot(map_flags), MAP_SHARED, bo->drv->fd, |
| gem_map.offset); |
| if (addr == MAP_FAILED) |
| return MAP_FAILED; |
| |
| vma->length = bo->meta.total_size; |
| |
| if (bo->meta.use_flags & BO_USE_RENDERSCRIPT) { |
| priv = calloc(1, sizeof(*priv)); |
| if (!priv) |
| goto out_unmap_addr; |
| |
| priv->cached_addr = calloc(1, bo->meta.total_size); |
| if (!priv->cached_addr) |
| goto out_free_priv; |
| |
| priv->gem_addr = addr; |
| vma->priv = priv; |
| addr = priv->cached_addr; |
| } |
| |
| return addr; |
| |
| out_free_priv: |
| free(priv); |
| out_unmap_addr: |
| munmap(addr, bo->meta.total_size); |
| return MAP_FAILED; |
| } |
| |
| static int rockchip_bo_unmap(struct bo *bo, struct vma *vma) |
| { |
| if (vma->priv) { |
| struct rockchip_private_map_data *priv = vma->priv; |
| vma->addr = priv->gem_addr; |
| free(priv->cached_addr); |
| free(priv); |
| vma->priv = NULL; |
| } |
| |
| return munmap(vma->addr, vma->length); |
| } |
| |
| static int rockchip_bo_invalidate(struct bo *bo, struct mapping *mapping) |
| { |
| if (mapping->vma->priv) { |
| struct rockchip_private_map_data *priv = mapping->vma->priv; |
| memcpy(priv->cached_addr, priv->gem_addr, bo->meta.total_size); |
| } |
| |
| return 0; |
| } |
| |
| static int rockchip_bo_flush(struct bo *bo, struct mapping *mapping) |
| { |
| struct rockchip_private_map_data *priv = mapping->vma->priv; |
| if (priv && (mapping->vma->map_flags & BO_MAP_WRITE)) |
| memcpy(priv->gem_addr, priv->cached_addr, bo->meta.total_size); |
| |
| return 0; |
| } |
| |
| const 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_invalidate = rockchip_bo_invalidate, |
| .bo_flush = rockchip_bo_flush, |
| .resolve_format_and_use_flags = drv_resolve_format_and_use_flags_helper, |
| }; |
| |
| #endif |