From 970b0af84a93a361468e9b88d92029e67211fe4d Mon Sep 17 00:00:00 2001 From: SooChan Lim Date: Mon, 19 Mar 2018 19:28:23 +0900 Subject: [PATCH] re-arrange the static functions. Change-Id: I4041bfde1dc4c29bacf74340442008086c95f6dc --- src/tbm_bufmgr_sprd.c | 1368 ++++++++++++++++++++++++------------------------- 1 file changed, 683 insertions(+), 685 deletions(-) diff --git a/src/tbm_bufmgr_sprd.c b/src/tbm_bufmgr_sprd.c index 997e4d2..437d6eb 100644 --- a/src/tbm_bufmgr_sprd.c +++ b/src/tbm_bufmgr_sprd.c @@ -488,8 +488,6 @@ _tbm_sprd_open_drm(void) close(fd); return -1; } -#else - TBM_SPRD_ERROR("warning fail to open drm\n"); #endif return fd; @@ -864,215 +862,323 @@ _sprd_bo_handle(tbm_bo_sprd bo_sprd, int device) return bo_handle; } -static int -tbm_sprd_bo_get_size(tbm_backend_bo_data *bo_data, tbm_error_e *error) +static tbm_bufmgr_capability +tbm_sprd_bufmgr_get_capabilities(tbm_backend_bufmgr_data *bufmgr_data, tbm_error_e *error) { - tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + tbm_bufmgr_capability capabilities = TBM_BUFMGR_CAPABILITY_NONE; - if (!bo_sprd) { - if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return 0; - } + capabilities = TBM_BUFMGR_CAPABILITY_SHARE_KEY|TBM_BUFMGR_CAPABILITY_SHARE_FD; if (error) *error = TBM_ERROR_NONE; - return bo_sprd->size; + return capabilities; } -static tbm_backend_bo_data * -tbm_sprd_bufmgr_alloc_bo(tbm_backend_bufmgr_data *bufmgr_data, int size, tbm_bo_memory_type flags, tbm_error_e *error) +static tbm_error_e +tbm_sprd_bufmgr_bind_native_display(tbm_backend_bufmgr_data *bufmgr_data, tbm_native_display *native_display) { tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; - tbm_bo_sprd bo_sprd; - unsigned int sprd_flags; - - if (bufmgr_sprd == NULL) { - TBM_SPRD_ERROR("bufmgr_data is null\n"); - if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return NULL; - } - - bo_sprd = calloc(1, sizeof(struct _tbm_bo_sprd)); - if (!bo_sprd) { - TBM_SPRD_ERROR("error fail to allocate the bo_sprd\n"); - if (error) - *error = TBM_ERROR_OUT_OF_MEMORY; - return NULL; - } - bo_sprd->bufmgr_sprd = bufmgr_sprd; - -#ifdef USE_CONTIG_ONLY - flags = TBM_BO_SCANOUT; - sprd_flags = SPRD_BO_CONTIG; -#else - sprd_flags = _get_sprd_flag_from_tbm(flags); - if ((flags & TBM_BO_SCANOUT) && (size <= 4 * 1024)) - sprd_flags |= SPRD_BO_NONCONTIG; -#endif // USE_CONTIG_ONLY - - struct drm_sprd_gem_create arg = {0, }; - - arg.size = (uint64_t)size; - arg.flags = sprd_flags; - if (drmCommandWriteRead(bufmgr_sprd->fd, DRM_SPRD_GEM_CREATE, &arg, - sizeof(arg))) { - TBM_SPRD_ERROR("error Cannot create bo_sprd(flag:%x, size:%d)\n", - arg.flags, (unsigned int)arg.size); - free(bo_sprd); - if (error) - *error = TBM_ERROR_OPERATION_FAILED; - return NULL; - } - - bo_sprd->fd = bufmgr_sprd->fd; - bo_sprd->gem = arg.handle; - bo_sprd->size = size; - bo_sprd->flags_tbm = flags; - bo_sprd->flags_sprd = sprd_flags; - bo_sprd->name = _get_name(bo_sprd->fd, bo_sprd->gem); - - if (!_bo_init_cache_state(bufmgr_sprd, bo_sprd, 0)) { - TBM_SPRD_ERROR("error fail init cache state(%d)\n", bo_sprd->name); - free(bo_sprd); - if (error) - *error = TBM_ERROR_OPERATION_FAILED; - return NULL; - } - - pthread_mutex_init(&bo_sprd->mutex, NULL); - - if (bufmgr_sprd->use_dma_fence && !bo_sprd->dmabuf) { - struct drm_prime_handle arg = {0, }; + SPRD_RETURN_VAL_IF_FAIL(bufmgr_sprd != NULL, TBM_ERROR_INVALID_PARAMETER); - arg.handle = bo_sprd->gem; - if (drmIoctl(bo_sprd->fd, DRM_IOCTL_PRIME_HANDLE_TO_FD, &arg)) { - TBM_SPRD_ERROR("error Cannot dmabuf=%d\n", bo_sprd->gem); - free(bo_sprd); - if (error) - *error = TBM_ERROR_OPERATION_FAILED; - return NULL; - } - bo_sprd->dmabuf = arg.fd; + if (!tbm_drm_helper_wl_auth_server_init(native_display, bufmgr_sprd->fd, + bufmgr_sprd->device_name, 0)) { + TBM_SPRD_ERROR("fail to tbm_drm_helper_wl_server_init\n"); + return TBM_ERROR_OPERATION_FAILED; } - /* add bo_sprd to hash */ - if (drmHashInsert(bufmgr_sprd->hashBos, bo_sprd->name, (void *)bo_sprd) < 0) - TBM_SPRD_ERROR("Cannot insert bo_sprd to Hash(%d)\n", bo_sprd->name); - - TBM_SPRD_DEBUG("%s size:%d, gem:%d(%d), flags:%d(%d)\n", - __FUNCTION__, bo_sprd->size, - bo_sprd->gem, bo_sprd->name, - flags, sprd_flags); - - if (error) - *error = TBM_ERROR_NONE; + bufmgr_sprd->bind_display = native_display; - return (tbm_backend_bo_data *)bo_sprd; + return TBM_ERROR_NONE; } -static void -tbm_sprd_bo_free(tbm_backend_bo_data *bo_data) +static tbm_error_e +tbm_sprd_bufmgr_get_supported_formats(tbm_backend_bufmgr_data *bufmgr_data, + uint32_t **formats, uint32_t *num) { - tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; - tbm_bo_sprd temp; - tbm_bufmgr_sprd bufmgr_sprd; - char buf[STRERR_BUFSIZE]; - int ret; - - if (!bo_data) - return; - - bufmgr_sprd = bo_sprd->bufmgr_sprd; - if (!bufmgr_sprd) - return; - - TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, size:%d\n", - bo_sprd, - bo_sprd->gem, bo_sprd->name, - bo_sprd->dmabuf, - bo_sprd->size); - - if (bo_sprd->pBase) { - if (munmap(bo_sprd->pBase, bo_sprd->size) == -1) { - TBM_SPRD_ERROR("bo_sprd:%p fail to munmap(%s)\n", - bo_sprd, strerror_r(errno, buf, STRERR_BUFSIZE)); - } - } + tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; + uint32_t *color_formats; - /* close dmabuf */ - if (bo_sprd->dmabuf) { - close(bo_sprd->dmabuf); - bo_sprd->dmabuf = 0; - } + SPRD_RETURN_VAL_IF_FAIL(bufmgr_sprd != NULL, TBM_ERROR_INVALID_PARAMETER); - /* delete bo from hash */ - ret = drmHashLookup(bufmgr_sprd->hashBos, bo_sprd->name, - (void **)&temp); - if (ret == 0) - drmHashDelete(bufmgr_sprd->hashBos, bo_sprd->name); - else - TBM_SPRD_ERROR("Cannot find bo_sprd to Hash(%d), ret=%d\n", bo_sprd->name, ret); + color_formats = (uint32_t *)calloc(1, sizeof(uint32_t) * TBM_COLOR_FORMAT_COUNT); + if (color_formats == NULL) + return TBM_ERROR_OUT_OF_MEMORY; - if (temp != bo_sprd) - TBM_SPRD_ERROR("hashBos probably has several BOs with same name!!!\n"); + memcpy(color_formats, tbm_sprd_color_format_list, sizeof(uint32_t)*TBM_COLOR_FORMAT_COUNT); - _bo_destroy_cache_state(bufmgr_sprd, bo_sprd); + *formats = color_formats; + *num = TBM_COLOR_FORMAT_COUNT; - /* Free gem handle */ - struct drm_gem_close arg = {0, }; + TBM_SPRD_DEBUG("supported format count = %d\n", *num); - memset(&arg, 0, sizeof(arg)); - arg.handle = bo_sprd->gem; - if (drmIoctl(bo_sprd->fd, DRM_IOCTL_GEM_CLOSE, &arg)) - TBM_SPRD_ERROR("bo_sprd:%p fail to gem close.(%s)\n", - bo_sprd, strerror_r(errno, buf, STRERR_BUFSIZE)); - free(bo_sprd); + return TBM_ERROR_NONE; } -static tbm_backend_bo_data * -tbm_sprd_bufmgr_import(tbm_backend_bufmgr_data *bufmgr_data, tbm_key key, tbm_error_e *error) +static tbm_error_e +tbm_sprd_bufmgr_get_plane_data(tbm_backend_bufmgr_data *bufmgr_data, + tbm_format format, int plane_idx, int width, + int height, uint32_t *size, uint32_t *offset, + uint32_t *pitch, int *bo_idx) { tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; - tbm_bo_sprd bo_sprd; - int ret; - - if (bufmgr_sprd == NULL) { - TBM_SPRD_ERROR("bufmgr_data is null\n"); - if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return NULL; - } + int bpp; + int _offset = 0; + int _pitch = 0; + int _size = 0; + int _bo_idx = 0; + int _align_height = 0; - ret = drmHashLookup(bufmgr_sprd->hashBos, key, (void **)&bo_sprd); - if (ret == 0) { - if (error) - *error = TBM_ERROR_NONE; - return (tbm_backend_bo_data *)bo_sprd; - } + SPRD_RETURN_VAL_IF_FAIL(bufmgr_sprd != NULL, TBM_ERROR_INVALID_PARAMETER); - struct drm_gem_open arg = {0, }; - struct drm_sprd_gem_info info = {0, }; + switch (format) { + /* 16 bpp RGB */ + case TBM_FORMAT_XRGB4444: + case TBM_FORMAT_XBGR4444: + case TBM_FORMAT_RGBX4444: + case TBM_FORMAT_BGRX4444: + case TBM_FORMAT_ARGB4444: + case TBM_FORMAT_ABGR4444: + case TBM_FORMAT_RGBA4444: + case TBM_FORMAT_BGRA4444: + case TBM_FORMAT_XRGB1555: + case TBM_FORMAT_XBGR1555: + case TBM_FORMAT_RGBX5551: + case TBM_FORMAT_BGRX5551: + case TBM_FORMAT_ARGB1555: + case TBM_FORMAT_ABGR1555: + case TBM_FORMAT_RGBA5551: + case TBM_FORMAT_BGRA5551: + case TBM_FORMAT_RGB565: + bpp = 16; + _offset = 0; + _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_RGB); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + break; + /* 24 bpp RGB */ + case TBM_FORMAT_RGB888: + case TBM_FORMAT_BGR888: + bpp = 24; + _offset = 0; + _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_RGB); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + break; + /* 32 bpp RGB */ + case TBM_FORMAT_XRGB8888: + case TBM_FORMAT_XBGR8888: + case TBM_FORMAT_RGBX8888: + case TBM_FORMAT_BGRX8888: + case TBM_FORMAT_ARGB8888: + case TBM_FORMAT_ABGR8888: + case TBM_FORMAT_RGBA8888: + case TBM_FORMAT_BGRA8888: + bpp = 32; + _offset = 0; + _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_RGB); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + break; - arg.name = key; - if (drmIoctl(bufmgr_sprd->fd, DRM_IOCTL_GEM_OPEN, &arg)) { - TBM_SPRD_ERROR("error Cannot open gem name=%d\n", key); - if (error) - *error = TBM_ERROR_OPERATION_FAILED; - return NULL; + /* packed YCbCr */ + case TBM_FORMAT_YUYV: + case TBM_FORMAT_YVYU: + case TBM_FORMAT_UYVY: + case TBM_FORMAT_VYUY: + case TBM_FORMAT_AYUV: + bpp = 32; + _offset = 0; + _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + break; + + /* + * 2 plane YCbCr + * index 0 = Y plane, [7:0] Y + * index 1 = Cr:Cb plane, [15:0] Cr:Cb little endian + * or + * index 1 = Cb:Cr plane, [15:0] Cb:Cr little endian + */ + case TBM_FORMAT_NV12: + case TBM_FORMAT_NV21: + bpp = 12; +// if (plane_idx == 0) + { + _offset = 0; + _pitch = SIZE_ALIGN(width , TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _align_height = SIZE_ALIGN(height, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 0) + break; + } +// else if (plane_idx == 1) + { + _offset = _size; + _pitch = SIZE_ALIGN(width , TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); + _align_height = SIZE_ALIGN(height / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + } + break; + + case TBM_FORMAT_NV16: + case TBM_FORMAT_NV61: + bpp = 16; + //if(plane_idx == 0) + { + _offset = 0; + _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 0) + break; + } + //else if( plane_idx ==1 ) + { + _offset += _size; + _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + } + break; + + /* + * 3 plane YCbCr + * index 0: Y plane, [7:0] Y + * index 1: Cb plane, [7:0] Cb + * index 2: Cr plane, [7:0] Cr + * or + * index 1: Cr plane, [7:0] Cr + * index 2: Cb plane, [7:0] Cb + */ + /* + NATIVE_BUFFER_FORMAT_YV12 + NATIVE_BUFFER_FORMAT_I420 + */ + case TBM_FORMAT_YUV410: + case TBM_FORMAT_YVU410: + bpp = 9; + break; + case TBM_FORMAT_YUV411: + case TBM_FORMAT_YVU411: + case TBM_FORMAT_YUV420: + case TBM_FORMAT_YVU420: + bpp = 12; + //if(plane_idx == 0) + { + _offset = 0; + _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _align_height = SIZE_ALIGN(height, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 0) + break; + } + //else if( plane_idx == 1 ) + { + _offset += _size; + _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); + _align_height = SIZE_ALIGN(height / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 1) + break; + } + //else if (plane_idx == 2 ) + { + _offset += _size; + _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); + _align_height = SIZE_ALIGN(height / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + } + break; + case TBM_FORMAT_YUV422: + case TBM_FORMAT_YVU422: + bpp = 16; + //if(plane_idx == 0) + { + _offset = 0; + _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 0) + break; + } + //else if( plane_idx == 1 ) + { + _offset += _size; + _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); + _size = SIZE_ALIGN(_pitch * (height), TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 1) + break; + } + //else if (plane_idx == 2 ) + { + _offset += _size; + _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); + _size = SIZE_ALIGN(_pitch * (height), TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + } + break; + case TBM_FORMAT_YUV444: + case TBM_FORMAT_YVU444: + bpp = 24; + //if(plane_idx == 0) + { + _offset = 0; + _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 0) + break; + } + //else if( plane_idx == 1 ) + { + _offset += _size; + _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + if (plane_idx == 1) + break; + } + //else if (plane_idx == 2 ) + { + _offset += _size; + _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); + _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); + _bo_idx = 0; + } + break; + default: + bpp = 0; + break; } - info.handle = arg.handle; - if (drmCommandWriteRead(bufmgr_sprd->fd, - DRM_SPRD_GEM_GET, - &info, - sizeof(struct drm_sprd_gem_info))) { - TBM_SPRD_ERROR("error Cannot get gem info=%d\n", key); + *size = _size; + *offset = _offset; + *pitch = _pitch; + *bo_idx = _bo_idx; + + return TBM_ERROR_NONE; +} + +static tbm_backend_bo_data * +tbm_sprd_bufmgr_alloc_bo(tbm_backend_bufmgr_data *bufmgr_data, int size, tbm_bo_memory_type flags, tbm_error_e *error) +{ + tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; + tbm_bo_sprd bo_sprd; + unsigned int sprd_flags; + + if (bufmgr_sprd == NULL) { + TBM_SPRD_ERROR("bufmgr_data is null\n"); if (error) - *error = TBM_ERROR_OPERATION_FAILED; - goto fail_get_gem; + *error = TBM_ERROR_INVALID_PARAMETER; + return NULL; } bo_sprd = calloc(1, sizeof(struct _tbm_bo_sprd)); @@ -1080,38 +1186,60 @@ tbm_sprd_bufmgr_import(tbm_backend_bufmgr_data *bufmgr_data, tbm_key key, tbm_er TBM_SPRD_ERROR("error fail to allocate the bo_sprd\n"); if (error) *error = TBM_ERROR_OUT_OF_MEMORY; - goto fail_alloc_bo; + return NULL; } bo_sprd->bufmgr_sprd = bufmgr_sprd; - bo_sprd->fd = bufmgr_sprd->fd; - bo_sprd->gem = arg.handle; - bo_sprd->size = arg.size; - bo_sprd->flags_sprd = info.flags; - bo_sprd->name = key; #ifdef USE_CONTIG_ONLY - bo_sprd->flags_sprd = SPRD_BO_CONTIG; - bo_sprd->flags_tbm |= TBM_BO_SCANOUT; + flags = TBM_BO_SCANOUT; + sprd_flags = SPRD_BO_CONTIG; #else - bo_sprd->flags_tbm = _get_tbm_flag_from_sprd(bo_sprd->flags_sprd); -#endif + sprd_flags = _get_sprd_flag_from_tbm(flags); + if ((flags & TBM_BO_SCANOUT) && (size <= 4 * 1024)) + sprd_flags |= SPRD_BO_NONCONTIG; +#endif // USE_CONTIG_ONLY - if (!_bo_init_cache_state(bufmgr_sprd, bo_sprd, 1)) { + struct drm_sprd_gem_create arg = {0, }; + + arg.size = (uint64_t)size; + arg.flags = sprd_flags; + if (drmCommandWriteRead(bufmgr_sprd->fd, DRM_SPRD_GEM_CREATE, &arg, + sizeof(arg))) { + TBM_SPRD_ERROR("error Cannot create bo_sprd(flag:%x, size:%d)\n", + arg.flags, (unsigned int)arg.size); + free(bo_sprd); + if (error) + *error = TBM_ERROR_OPERATION_FAILED; + return NULL; + } + + bo_sprd->fd = bufmgr_sprd->fd; + bo_sprd->gem = arg.handle; + bo_sprd->size = size; + bo_sprd->flags_tbm = flags; + bo_sprd->flags_sprd = sprd_flags; + bo_sprd->name = _get_name(bo_sprd->fd, bo_sprd->gem); + + if (!_bo_init_cache_state(bufmgr_sprd, bo_sprd, 0)) { TBM_SPRD_ERROR("error fail init cache state(%d)\n", bo_sprd->name); + free(bo_sprd); if (error) *error = TBM_ERROR_OPERATION_FAILED; - goto fail_init_cache; + return NULL; } - if (!bo_sprd->dmabuf) { + pthread_mutex_init(&bo_sprd->mutex, NULL); + + if (bufmgr_sprd->use_dma_fence && !bo_sprd->dmabuf) { struct drm_prime_handle arg = {0, }; arg.handle = bo_sprd->gem; if (drmIoctl(bo_sprd->fd, DRM_IOCTL_PRIME_HANDLE_TO_FD, &arg)) { TBM_SPRD_ERROR("error Cannot dmabuf=%d\n", bo_sprd->gem); + free(bo_sprd); if (error) *error = TBM_ERROR_OPERATION_FAILED; - goto fail_prime_handle_to_fd; + return NULL; } bo_sprd->dmabuf = arg.fd; } @@ -1120,29 +1248,15 @@ tbm_sprd_bufmgr_import(tbm_backend_bufmgr_data *bufmgr_data, tbm_key key, tbm_er if (drmHashInsert(bufmgr_sprd->hashBos, bo_sprd->name, (void *)bo_sprd) < 0) TBM_SPRD_ERROR("Cannot insert bo_sprd to Hash(%d)\n", bo_sprd->name); - TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, flags:%d(%d), size:%d\n", - bo_sprd, - bo_sprd->gem, bo_sprd->name, - bo_sprd->dmabuf, - bo_sprd->flags_tbm, bo_sprd->flags_sprd, - bo_sprd->size); + TBM_SPRD_DEBUG("%s size:%d, gem:%d(%d), flags:%d(%d)\n", + __FUNCTION__, bo_sprd->size, + bo_sprd->gem, bo_sprd->name, + flags, sprd_flags); if (error) *error = TBM_ERROR_NONE; return (tbm_backend_bo_data *)bo_sprd; - -fail_prime_handle_to_fd: - _bo_destroy_cache_state(bufmgr_sprd, bo_sprd); -fail_init_cache: - free(bo_sprd); -fail_alloc_bo: -fail_get_gem: - { - struct drm_gem_close gem_close_arg = {arg.handle, 0}; - drmIoctl(bufmgr_sprd->fd, DRM_IOCTL_GEM_CLOSE, &gem_close_arg); - } - return NULL; } static tbm_backend_bo_data * @@ -1266,523 +1380,193 @@ fail_init_cache: return NULL; } -static tbm_key -tbm_sprd_bo_export_key(tbm_backend_bo_data *bo_data, tbm_error_e *error) +static tbm_backend_bo_data * +tbm_sprd_bufmgr_import_key(tbm_backend_bufmgr_data *bufmgr_data, tbm_key key, tbm_error_e *error) { - tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; + tbm_bo_sprd bo_sprd; + int ret; - if (!bo_sprd) { + if (bufmgr_sprd == NULL) { + TBM_SPRD_ERROR("bufmgr_data is null\n"); if (error) *error = TBM_ERROR_INVALID_PARAMETER; - return 0; + return NULL; } - if (!bo_sprd->name) { - bo_sprd->name = _get_name(bo_sprd->fd, bo_sprd->gem); - if (!bo_sprd->name) { - TBM_SPRD_ERROR("error Cannot get name\n"); - if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return 0; - } + ret = drmHashLookup(bufmgr_sprd->hashBos, key, (void **)&bo_sprd); + if (ret == 0) { + if (error) + *error = TBM_ERROR_NONE; + return (tbm_backend_bo_data *)bo_sprd; } - TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, flags:%d(%d), size:%d\n", - bo_sprd, - bo_sprd->gem, bo_sprd->name, - bo_sprd->dmabuf, - bo_sprd->flags_tbm, bo_sprd->flags_sprd, - bo_sprd->size); - - if (error) - *error = TBM_ERROR_NONE; - - return (tbm_key)bo_sprd->name; -} - -static tbm_fd -tbm_sprd_bo_export_fd(tbm_backend_bo_data *bo_data, tbm_error_e *error) -{ - tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; - struct drm_prime_handle arg = {0, }; - int ret; - char buf[STRERR_BUFSIZE]; + struct drm_gem_open arg = {0, }; + struct drm_sprd_gem_info info = {0, }; - if (!bo_sprd) { + arg.name = key; + if (drmIoctl(bufmgr_sprd->fd, DRM_IOCTL_GEM_OPEN, &arg)) { + TBM_SPRD_ERROR("error Cannot open gem name=%d\n", key); if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return -1; + *error = TBM_ERROR_OPERATION_FAILED; + return NULL; } - arg.handle = bo_sprd->gem; - ret = drmIoctl(bo_sprd->fd, DRM_IOCTL_PRIME_HANDLE_TO_FD, &arg); - if (ret) { - TBM_SPRD_ERROR("bo_sprd:%p Cannot dmabuf=%d (%s)\n", - bo_sprd, bo_sprd->gem, strerror_r(errno, buf, STRERR_BUFSIZE)); + info.handle = arg.handle; + if (drmCommandWriteRead(bufmgr_sprd->fd, + DRM_SPRD_GEM_GET, + &info, + sizeof(struct drm_sprd_gem_info))) { + TBM_SPRD_ERROR("error Cannot get gem info=%d\n", key); if (error) *error = TBM_ERROR_OPERATION_FAILED; - return (tbm_fd) ret; + goto fail_get_gem; } - TBM_SPRD_DEBUG("bo_sprd:%p, gem:%d(%d), fd:%d, key_fd:%d, flags:%d(%d), size:%d\n", - bo_sprd, - bo_sprd->gem, bo_sprd->name, - bo_sprd->dmabuf, - arg.fd, - bo_sprd->flags_tbm, bo_sprd->flags_sprd, - bo_sprd->size); - - if (error) - *error = TBM_ERROR_NONE; - - return (tbm_fd)arg.fd; -} - -static tbm_bo_handle -tbm_sprd_bo_get_handle(tbm_backend_bo_data *bo_data, tbm_bo_device_type device, tbm_error_e *error) -{ - tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; - tbm_bo_handle bo_handle; - + bo_sprd = calloc(1, sizeof(struct _tbm_bo_sprd)); if (!bo_sprd) { + TBM_SPRD_ERROR("error fail to allocate the bo_sprd\n"); if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return (tbm_bo_handle) NULL; + *error = TBM_ERROR_OUT_OF_MEMORY; + goto fail_alloc_bo; } + bo_sprd->bufmgr_sprd = bufmgr_sprd; - if (!bo_sprd->gem) { - TBM_SPRD_ERROR("Cannot map gem=%d\n", bo_sprd->gem); + bo_sprd->fd = bufmgr_sprd->fd; + bo_sprd->gem = arg.handle; + bo_sprd->size = arg.size; + bo_sprd->flags_sprd = info.flags; + bo_sprd->name = key; +#ifdef USE_CONTIG_ONLY + bo_sprd->flags_sprd = SPRD_BO_CONTIG; + bo_sprd->flags_tbm |= TBM_BO_SCANOUT; +#else + bo_sprd->flags_tbm = _get_tbm_flag_from_sprd(bo_sprd->flags_sprd); +#endif + + if (!_bo_init_cache_state(bufmgr_sprd, bo_sprd, 1)) { + TBM_SPRD_ERROR("error fail init cache state(%d)\n", bo_sprd->name); if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return (tbm_bo_handle) NULL; + *error = TBM_ERROR_OPERATION_FAILED; + goto fail_init_cache; } - TBM_SPRD_DEBUG("bo_sprd:%p, gem:%d(%d), fd:%d, flags:%d(%d), size:%d, %s\n", + if (!bo_sprd->dmabuf) { + struct drm_prime_handle arg = {0, }; + + arg.handle = bo_sprd->gem; + if (drmIoctl(bo_sprd->fd, DRM_IOCTL_PRIME_HANDLE_TO_FD, &arg)) { + TBM_SPRD_ERROR("error Cannot dmabuf=%d\n", bo_sprd->gem); + if (error) + *error = TBM_ERROR_OPERATION_FAILED; + goto fail_prime_handle_to_fd; + } + bo_sprd->dmabuf = arg.fd; + } + + /* add bo_sprd to hash */ + if (drmHashInsert(bufmgr_sprd->hashBos, bo_sprd->name, (void *)bo_sprd) < 0) + TBM_SPRD_ERROR("Cannot insert bo_sprd to Hash(%d)\n", bo_sprd->name); + + TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, flags:%d(%d), size:%d\n", bo_sprd, bo_sprd->gem, bo_sprd->name, bo_sprd->dmabuf, bo_sprd->flags_tbm, bo_sprd->flags_sprd, - bo_sprd->size, - STR_DEVICE[device]); - - /*Get mapped bo_handle*/ - bo_handle = _sprd_bo_handle(bo_sprd, device); - if (bo_handle.ptr == NULL) { - TBM_SPRD_ERROR("Cannot get handle: gem:%d, device:%d\n", - bo_sprd->gem, device); - if (error) - *error = TBM_ERROR_OPERATION_FAILED; - return (tbm_bo_handle) NULL; - } + bo_sprd->size); if (error) *error = TBM_ERROR_NONE; - return bo_handle; + return (tbm_backend_bo_data *)bo_sprd; + +fail_prime_handle_to_fd: + _bo_destroy_cache_state(bufmgr_sprd, bo_sprd); +fail_init_cache: + free(bo_sprd); +fail_alloc_bo: +fail_get_gem: + { + struct drm_gem_close gem_close_arg = {arg.handle, 0}; + drmIoctl(bufmgr_sprd->fd, DRM_IOCTL_GEM_CLOSE, &gem_close_arg); + } + return NULL; } -static tbm_bo_handle -tbm_sprd_bo_map(tbm_backend_bo_data *bo_data, tbm_bo_device_type device, - tbm_bo_access_option opt, tbm_error_e *error) +static void +tbm_sprd_bo_free(tbm_backend_bo_data *bo_data) { tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; - tbm_bo_handle bo_handle; + tbm_bo_sprd temp; tbm_bufmgr_sprd bufmgr_sprd; + char buf[STRERR_BUFSIZE]; + int ret; - if (!bo_sprd) { - if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return (tbm_bo_handle) NULL; - } + if (!bo_data) + return; bufmgr_sprd = bo_sprd->bufmgr_sprd; - if (!bufmgr_sprd) { - if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return (tbm_bo_handle) NULL; - } - - if (!bo_sprd->gem) { - TBM_SPRD_ERROR("Cannot map gem=%d\n", bo_sprd->gem); - if (error) - *error = TBM_ERROR_INVALID_PARAMETER; - return (tbm_bo_handle) NULL; - } + if (!bufmgr_sprd) + return; - TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, %s, %s\n", + TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, size:%d\n", bo_sprd, bo_sprd->gem, bo_sprd->name, bo_sprd->dmabuf, - STR_DEVICE[device], - STR_OPT[opt]); + bo_sprd->size); - /*Get mapped bo_handle*/ - bo_handle = _sprd_bo_handle(bo_sprd, device); - if (bo_handle.ptr == NULL) { - TBM_SPRD_ERROR("Cannot get handle: gem:%d, device:%d, opt:%d\n", - bo_sprd->gem, device, opt); - if (error) - *error = TBM_ERROR_OPERATION_FAILED; - return (tbm_bo_handle) NULL; + if (bo_sprd->pBase) { + if (munmap(bo_sprd->pBase, bo_sprd->size) == -1) { + TBM_SPRD_ERROR("bo_sprd:%p fail to munmap(%s)\n", + bo_sprd, strerror_r(errno, buf, STRERR_BUFSIZE)); + } } - if (bo_sprd->map_cnt == 0) - _bo_set_cache_state(bufmgr_sprd, bo_sprd, device, opt); + /* close dmabuf */ + if (bo_sprd->dmabuf) { + close(bo_sprd->dmabuf); + bo_sprd->dmabuf = 0; + } - bo_sprd->map_cnt++; + /* delete bo from hash */ + ret = drmHashLookup(bufmgr_sprd->hashBos, bo_sprd->name, + (void **)&temp); + if (ret == 0) + drmHashDelete(bufmgr_sprd->hashBos, bo_sprd->name); + else + TBM_SPRD_ERROR("Cannot find bo_sprd to Hash(%d), ret=%d\n", bo_sprd->name, ret); - if (error) - *error = TBM_ERROR_NONE; + if (temp != bo_sprd) + TBM_SPRD_ERROR("hashBos probably has several BOs with same name!!!\n"); - return bo_handle; -} + _bo_destroy_cache_state(bufmgr_sprd, bo_sprd); -static tbm_error_e -tbm_sprd_bo_unmap(tbm_backend_bo_data *bo_data) -{ - tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; - tbm_bufmgr_sprd bufmgr_sprd; - - if (!bo_sprd) - return TBM_ERROR_INVALID_PARAMETER; - - bufmgr_sprd = bo_sprd->bufmgr_sprd; - if (!bufmgr_sprd) - return TBM_ERROR_INVALID_PARAMETER; - - if (!bo_sprd->gem) - return TBM_ERROR_INVALID_PARAMETER; - - bo_sprd->map_cnt--; - - if (bo_sprd->map_cnt == 0) - _bo_save_cache_state(bufmgr_sprd, bo_sprd); - - TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d\n", - bo_sprd, - bo_sprd->gem, bo_sprd->name, - bo_sprd->dmabuf); - - return TBM_ERROR_NONE; -} - -static void -tbm_sprd_deinit(tbm_backend_bufmgr_data *bufmgr_data) -{ - tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; - tbm_bufmgr bufmgr; - tbm_error_e error; - unsigned long key; - void *value; - - SPRD_RETURN_IF_FAIL(bufmgr_sprd != NULL); - - bufmgr = bufmgr_sprd->bufmgr; - - tbm_backend_bufmgr_free_bufmgr_func(bufmgr, bufmgr_sprd->bufmgr_func); - tbm_backend_bufmgr_free_bo_func(bufmgr, bufmgr_sprd->bo_func); - - if (bufmgr_sprd->hashBos) { - while (drmHashFirst(bufmgr_sprd->hashBos, &key, &value) > 0) { - free(value); - drmHashDelete(bufmgr_sprd->hashBos, key); - } - - drmHashDestroy(bufmgr_sprd->hashBos); - bufmgr_sprd->hashBos = NULL; - } - - if (bufmgr_sprd->bind_display) - tbm_drm_helper_wl_auth_server_deinit(); - - if (tbm_backend_bufmgr_query_display_server(bufmgr, &error)) - tbm_drm_helper_unset_tbm_master_fd(); - - tbm_drm_helper_unset_fd(); - - if (bufmgr_sprd->device_name) - free(bufmgr_sprd->device_name); - - _bufmgr_deinit_cache_state(bufmgr_sprd); - - close(bufmgr_sprd->fd); - - free(bufmgr_sprd); -} - -static tbm_error_e -tbm_sprd_bufmgr_get_supported_formats(tbm_backend_bufmgr_data *bufmgr_data, - uint32_t **formats, uint32_t *num) -{ - tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; - uint32_t *color_formats; - - SPRD_RETURN_VAL_IF_FAIL(bufmgr_sprd != NULL, TBM_ERROR_INVALID_PARAMETER); - - color_formats = (uint32_t *)calloc(1, sizeof(uint32_t) * TBM_COLOR_FORMAT_COUNT); - if (color_formats == NULL) - return TBM_ERROR_OUT_OF_MEMORY; - - memcpy(color_formats, tbm_sprd_color_format_list, sizeof(uint32_t)*TBM_COLOR_FORMAT_COUNT); - - *formats = color_formats; - *num = TBM_COLOR_FORMAT_COUNT; - - TBM_SPRD_DEBUG("supported format count = %d\n", *num); + /* Free gem handle */ + struct drm_gem_close arg = {0, }; - return TBM_ERROR_NONE; + memset(&arg, 0, sizeof(arg)); + arg.handle = bo_sprd->gem; + if (drmIoctl(bo_sprd->fd, DRM_IOCTL_GEM_CLOSE, &arg)) + TBM_SPRD_ERROR("bo_sprd:%p fail to gem close.(%s)\n", + bo_sprd, strerror_r(errno, buf, STRERR_BUFSIZE)); + free(bo_sprd); } -static tbm_error_e -tbm_sprd_bufmgr_get_plane_data(tbm_backend_bufmgr_data *bufmgr_data, - tbm_format format, int plane_idx, int width, - int height, uint32_t *size, uint32_t *offset, - uint32_t *pitch, int *bo_idx) -{ - tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; - int bpp; - int _offset = 0; - int _pitch = 0; - int _size = 0; - int _bo_idx = 0; - int _align_height = 0; - - SPRD_RETURN_VAL_IF_FAIL(bufmgr_sprd != NULL, TBM_ERROR_INVALID_PARAMETER); - - switch (format) { - /* 16 bpp RGB */ - case TBM_FORMAT_XRGB4444: - case TBM_FORMAT_XBGR4444: - case TBM_FORMAT_RGBX4444: - case TBM_FORMAT_BGRX4444: - case TBM_FORMAT_ARGB4444: - case TBM_FORMAT_ABGR4444: - case TBM_FORMAT_RGBA4444: - case TBM_FORMAT_BGRA4444: - case TBM_FORMAT_XRGB1555: - case TBM_FORMAT_XBGR1555: - case TBM_FORMAT_RGBX5551: - case TBM_FORMAT_BGRX5551: - case TBM_FORMAT_ARGB1555: - case TBM_FORMAT_ABGR1555: - case TBM_FORMAT_RGBA5551: - case TBM_FORMAT_BGRA5551: - case TBM_FORMAT_RGB565: - bpp = 16; - _offset = 0; - _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_RGB); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - break; - /* 24 bpp RGB */ - case TBM_FORMAT_RGB888: - case TBM_FORMAT_BGR888: - bpp = 24; - _offset = 0; - _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_RGB); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - break; - /* 32 bpp RGB */ - case TBM_FORMAT_XRGB8888: - case TBM_FORMAT_XBGR8888: - case TBM_FORMAT_RGBX8888: - case TBM_FORMAT_BGRX8888: - case TBM_FORMAT_ARGB8888: - case TBM_FORMAT_ABGR8888: - case TBM_FORMAT_RGBA8888: - case TBM_FORMAT_BGRA8888: - bpp = 32; - _offset = 0; - _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_RGB); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - break; - - /* packed YCbCr */ - case TBM_FORMAT_YUYV: - case TBM_FORMAT_YVYU: - case TBM_FORMAT_UYVY: - case TBM_FORMAT_VYUY: - case TBM_FORMAT_AYUV: - bpp = 32; - _offset = 0; - _pitch = SIZE_ALIGN((width * bpp) >> 3, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - break; - - /* - * 2 plane YCbCr - * index 0 = Y plane, [7:0] Y - * index 1 = Cr:Cb plane, [15:0] Cr:Cb little endian - * or - * index 1 = Cb:Cr plane, [15:0] Cb:Cr little endian - */ - case TBM_FORMAT_NV12: - case TBM_FORMAT_NV21: - bpp = 12; -// if (plane_idx == 0) - { - _offset = 0; - _pitch = SIZE_ALIGN(width , TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _align_height = SIZE_ALIGN(height, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 0) - break; - } -// else if (plane_idx == 1) - { - _offset = _size; - _pitch = SIZE_ALIGN(width , TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); - _align_height = SIZE_ALIGN(height / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - } - break; - - case TBM_FORMAT_NV16: - case TBM_FORMAT_NV61: - bpp = 16; - //if(plane_idx == 0) - { - _offset = 0; - _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 0) - break; - } - //else if( plane_idx ==1 ) - { - _offset += _size; - _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - } - break; - - /* - * 3 plane YCbCr - * index 0: Y plane, [7:0] Y - * index 1: Cb plane, [7:0] Cb - * index 2: Cr plane, [7:0] Cr - * or - * index 1: Cr plane, [7:0] Cr - * index 2: Cb plane, [7:0] Cb - */ - /* - NATIVE_BUFFER_FORMAT_YV12 - NATIVE_BUFFER_FORMAT_I420 - */ - case TBM_FORMAT_YUV410: - case TBM_FORMAT_YVU410: - bpp = 9; - break; - case TBM_FORMAT_YUV411: - case TBM_FORMAT_YVU411: - case TBM_FORMAT_YUV420: - case TBM_FORMAT_YVU420: - bpp = 12; - //if(plane_idx == 0) - { - _offset = 0; - _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _align_height = SIZE_ALIGN(height, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 0) - break; - } - //else if( plane_idx == 1 ) - { - _offset += _size; - _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); - _align_height = SIZE_ALIGN(height / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 1) - break; - } - //else if (plane_idx == 2 ) - { - _offset += _size; - _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); - _align_height = SIZE_ALIGN(height / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * _align_height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - } - break; - case TBM_FORMAT_YUV422: - case TBM_FORMAT_YVU422: - bpp = 16; - //if(plane_idx == 0) - { - _offset = 0; - _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 0) - break; - } - //else if( plane_idx == 1 ) - { - _offset += _size; - _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); - _size = SIZE_ALIGN(_pitch * (height), TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 1) - break; - } - //else if (plane_idx == 2 ) - { - _offset += _size; - _pitch = SIZE_ALIGN(width / 2, TBM_SURFACE_ALIGNMENT_PITCH_YUV / 2); - _size = SIZE_ALIGN(_pitch * (height), TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - } - break; - case TBM_FORMAT_YUV444: - case TBM_FORMAT_YVU444: - bpp = 24; - //if(plane_idx == 0) - { - _offset = 0; - _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 0) - break; - } - //else if( plane_idx == 1 ) - { - _offset += _size; - _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - if (plane_idx == 1) - break; - } - //else if (plane_idx == 2 ) - { - _offset += _size; - _pitch = SIZE_ALIGN(width, TBM_SURFACE_ALIGNMENT_PITCH_YUV); - _size = SIZE_ALIGN(_pitch * height, TBM_SURFACE_ALIGNMENT_PLANE); - _bo_idx = 0; - } - break; - default: - bpp = 0; - break; +static int +tbm_sprd_bo_get_size(tbm_backend_bo_data *bo_data, tbm_error_e *error) +{ + tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + + if (!bo_sprd) { + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return 0; } - *size = _size; - *offset = _offset; - *pitch = _pitch; - *bo_idx = _bo_idx; + if (error) + *error = TBM_ERROR_NONE; - return TBM_ERROR_NONE; + return bo_sprd->size; } static tbm_bo_memory_type @@ -1802,34 +1586,248 @@ tbm_sprd_bo_get_memory_type(tbm_backend_bo_data *bo_data, tbm_error_e *error) return bo_sprd->flags_tbm; } -static tbm_bufmgr_capability -tbm_sprd_bufmgr_get_capabilities(tbm_backend_bufmgr_data *bufmgr_data, tbm_error_e *error) +static tbm_bo_handle +tbm_sprd_bo_get_handle(tbm_backend_bo_data *bo_data, tbm_bo_device_type device, tbm_error_e *error) { - tbm_bufmgr_capability capabilities = TBM_BUFMGR_CAPABILITY_NONE; + tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + tbm_bo_handle bo_handle; - capabilities = TBM_BUFMGR_CAPABILITY_SHARE_KEY|TBM_BUFMGR_CAPABILITY_SHARE_FD; + if (!bo_sprd) { + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return (tbm_bo_handle) NULL; + } + + if (!bo_sprd->gem) { + TBM_SPRD_ERROR("Cannot map gem=%d\n", bo_sprd->gem); + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return (tbm_bo_handle) NULL; + } + + TBM_SPRD_DEBUG("bo_sprd:%p, gem:%d(%d), fd:%d, flags:%d(%d), size:%d, %s\n", + bo_sprd, + bo_sprd->gem, bo_sprd->name, + bo_sprd->dmabuf, + bo_sprd->flags_tbm, bo_sprd->flags_sprd, + bo_sprd->size, + STR_DEVICE[device]); + + /*Get mapped bo_handle*/ + bo_handle = _sprd_bo_handle(bo_sprd, device); + if (bo_handle.ptr == NULL) { + TBM_SPRD_ERROR("Cannot get handle: gem:%d, device:%d\n", + bo_sprd->gem, device); + if (error) + *error = TBM_ERROR_OPERATION_FAILED; + return (tbm_bo_handle) NULL; + } if (error) *error = TBM_ERROR_NONE; - return capabilities; + return bo_handle; +} + +static tbm_bo_handle +tbm_sprd_bo_map(tbm_backend_bo_data *bo_data, tbm_bo_device_type device, + tbm_bo_access_option opt, tbm_error_e *error) +{ + tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + tbm_bo_handle bo_handle; + tbm_bufmgr_sprd bufmgr_sprd; + + if (!bo_sprd) { + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return (tbm_bo_handle) NULL; + } + + bufmgr_sprd = bo_sprd->bufmgr_sprd; + if (!bufmgr_sprd) { + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return (tbm_bo_handle) NULL; + } + + if (!bo_sprd->gem) { + TBM_SPRD_ERROR("Cannot map gem=%d\n", bo_sprd->gem); + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return (tbm_bo_handle) NULL; + } + + TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, %s, %s\n", + bo_sprd, + bo_sprd->gem, bo_sprd->name, + bo_sprd->dmabuf, + STR_DEVICE[device], + STR_OPT[opt]); + + /*Get mapped bo_handle*/ + bo_handle = _sprd_bo_handle(bo_sprd, device); + if (bo_handle.ptr == NULL) { + TBM_SPRD_ERROR("Cannot get handle: gem:%d, device:%d, opt:%d\n", + bo_sprd->gem, device, opt); + if (error) + *error = TBM_ERROR_OPERATION_FAILED; + return (tbm_bo_handle) NULL; + } + + if (bo_sprd->map_cnt == 0) + _bo_set_cache_state(bufmgr_sprd, bo_sprd, device, opt); + + bo_sprd->map_cnt++; + + if (error) + *error = TBM_ERROR_NONE; + + return bo_handle; } static tbm_error_e -tbm_sprd_bufmgr_bind_native_display(tbm_backend_bufmgr_data *bufmgr_data, tbm_native_display *native_display) +tbm_sprd_bo_unmap(tbm_backend_bo_data *bo_data) +{ + tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + tbm_bufmgr_sprd bufmgr_sprd; + + if (!bo_sprd) + return TBM_ERROR_INVALID_PARAMETER; + + bufmgr_sprd = bo_sprd->bufmgr_sprd; + if (!bufmgr_sprd) + return TBM_ERROR_INVALID_PARAMETER; + + if (!bo_sprd->gem) + return TBM_ERROR_INVALID_PARAMETER; + + bo_sprd->map_cnt--; + + if (bo_sprd->map_cnt == 0) + _bo_save_cache_state(bufmgr_sprd, bo_sprd); + + TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d\n", + bo_sprd, + bo_sprd->gem, bo_sprd->name, + bo_sprd->dmabuf); + + return TBM_ERROR_NONE; +} + +static tbm_fd +tbm_sprd_bo_export_fd(tbm_backend_bo_data *bo_data, tbm_error_e *error) +{ + tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + struct drm_prime_handle arg = {0, }; + int ret; + char buf[STRERR_BUFSIZE]; + + if (!bo_sprd) { + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return -1; + } + + arg.handle = bo_sprd->gem; + ret = drmIoctl(bo_sprd->fd, DRM_IOCTL_PRIME_HANDLE_TO_FD, &arg); + if (ret) { + TBM_SPRD_ERROR("bo_sprd:%p Cannot dmabuf=%d (%s)\n", + bo_sprd, bo_sprd->gem, strerror_r(errno, buf, STRERR_BUFSIZE)); + if (error) + *error = TBM_ERROR_OPERATION_FAILED; + return (tbm_fd) ret; + } + + TBM_SPRD_DEBUG("bo_sprd:%p, gem:%d(%d), fd:%d, key_fd:%d, flags:%d(%d), size:%d\n", + bo_sprd, + bo_sprd->gem, bo_sprd->name, + bo_sprd->dmabuf, + arg.fd, + bo_sprd->flags_tbm, bo_sprd->flags_sprd, + bo_sprd->size); + + if (error) + *error = TBM_ERROR_NONE; + + return (tbm_fd)arg.fd; +} + +static tbm_key +tbm_sprd_bo_export_key(tbm_backend_bo_data *bo_data, tbm_error_e *error) +{ + tbm_bo_sprd bo_sprd = (tbm_bo_sprd)bo_data; + + if (!bo_sprd) { + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return 0; + } + + if (!bo_sprd->name) { + bo_sprd->name = _get_name(bo_sprd->fd, bo_sprd->gem); + if (!bo_sprd->name) { + TBM_SPRD_ERROR("error Cannot get name\n"); + if (error) + *error = TBM_ERROR_INVALID_PARAMETER; + return 0; + } + } + + TBM_SPRD_DEBUG(" bo_sprd:%p, gem:%d(%d), fd:%d, flags:%d(%d), size:%d\n", + bo_sprd, + bo_sprd->gem, bo_sprd->name, + bo_sprd->dmabuf, + bo_sprd->flags_tbm, bo_sprd->flags_sprd, + bo_sprd->size); + + if (error) + *error = TBM_ERROR_NONE; + + return (tbm_key)bo_sprd->name; +} + +static void +tbm_sprd_deinit(tbm_backend_bufmgr_data *bufmgr_data) { tbm_bufmgr_sprd bufmgr_sprd = (tbm_bufmgr_sprd)bufmgr_data; - SPRD_RETURN_VAL_IF_FAIL(bufmgr_sprd != NULL, TBM_ERROR_INVALID_PARAMETER); + tbm_bufmgr bufmgr; + tbm_error_e error; + unsigned long key; + void *value; - if (!tbm_drm_helper_wl_auth_server_init(native_display, bufmgr_sprd->fd, - bufmgr_sprd->device_name, 0)) { - TBM_SPRD_ERROR("fail to tbm_drm_helper_wl_server_init\n"); - return TBM_ERROR_OPERATION_FAILED; + SPRD_RETURN_IF_FAIL(bufmgr_sprd != NULL); + + bufmgr = bufmgr_sprd->bufmgr; + + tbm_backend_bufmgr_free_bufmgr_func(bufmgr, bufmgr_sprd->bufmgr_func); + tbm_backend_bufmgr_free_bo_func(bufmgr, bufmgr_sprd->bo_func); + + if (bufmgr_sprd->hashBos) { + while (drmHashFirst(bufmgr_sprd->hashBos, &key, &value) > 0) { + free(value); + drmHashDelete(bufmgr_sprd->hashBos, key); + } + + drmHashDestroy(bufmgr_sprd->hashBos); + bufmgr_sprd->hashBos = NULL; } - bufmgr_sprd->bind_display = native_display; + if (bufmgr_sprd->bind_display) + tbm_drm_helper_wl_auth_server_deinit(); - return TBM_ERROR_NONE; + if (tbm_backend_bufmgr_query_display_server(bufmgr, &error)) + tbm_drm_helper_unset_tbm_master_fd(); + + tbm_drm_helper_unset_fd(); + + if (bufmgr_sprd->device_name) + free(bufmgr_sprd->device_name); + + _bufmgr_deinit_cache_state(bufmgr_sprd); + + close(bufmgr_sprd->fd); + + free(bufmgr_sprd); } static tbm_backend_bufmgr_data * @@ -1927,7 +1925,7 @@ tbm_sprd_init(tbm_bufmgr bufmgr, tbm_error_e *error) bufmgr_func->bufmgr_alloc_bo = tbm_sprd_bufmgr_alloc_bo; bufmgr_func->bufmgr_alloc_bo_with_format = NULL; bufmgr_func->bufmgr_import_fd = tbm_sprd_bufmgr_import_fd; - bufmgr_func->bufmgr_import_key = tbm_sprd_bufmgr_import; + bufmgr_func->bufmgr_import_key = tbm_sprd_bufmgr_import_key; err = tbm_backend_bufmgr_register_bufmgr_func(bufmgr, bufmgr_func); if (err != TBM_ERROR_NONE) { -- 2.7.4