android13/hardware/rockchip/camera/psl/RgaCropScale.cpp

218 lines
6.6 KiB
C++
Executable File

/*
* Copyright (c) 2018, Fuzhou Rockchip Electronics Co., Ltd
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include "RgaCropScale.h"
#include "LogHelper.h"
#include <utils/Singleton.h>
#include <RockchipRga.h>
#if defined(ANDROID_VERSION_ABOVE_12_X)
#include <hardware/hardware_rockchip.h>
#endif
namespace android {
namespace camera2 {
#if defined(TARGET_RK312X)
#define RGA_VER (1.0)
#define RGA_ACTIVE_W (2048)
#define RGA_VIRTUAL_W (4096)
#define RGA_ACTIVE_H (2048)
#define RGA_VIRTUAL_H (2048)
#else
#if defined(TARGET_RK3588)
#define RGA_VER (3.0)
#define RGA_ACTIVE_W (8128)
#define RGA_VIRTUAL_W (8128)
#define RGA_ACTIVE_H (8128)
#define RGA_VIRTUAL_H (8128)
#else
#define RGA_VER (2.0)
#define RGA_ACTIVE_W (4096)
#define RGA_VIRTUAL_W (4096)
#define RGA_ACTIVE_H (4096)
#define RGA_VIRTUAL_H (4096)
#endif
#endif
#if defined(TARGET_RK3588)
#include <im2d_api/im2d.h>
#endif
int RgaCropScale::CropScaleNV12Or21(struct Params* in, struct Params* out)
{
rga_info_t src, dst;
#if defined(TARGET_RK3588)
rga_buffer_handle_t src_handle;
rga_buffer_handle_t dst_handle;
im_handle_param_t param;
memset(&param, 0, sizeof(im_handle_param_t));
memset(&src_handle, 0, sizeof(rga_buffer_handle_t));
memset(&dst_handle, 0, sizeof(rga_buffer_handle_t));
#endif
memset(&src, 0, sizeof(rga_info_t));
memset(&dst, 0, sizeof(rga_info_t));
if (!in || !out)
return -1;
if((out->width > RGA_VIRTUAL_W) || (out->height > RGA_VIRTUAL_H)){
ALOGE("%s(%d): out wxh %dx%d beyond rga capability",
__FUNCTION__, __LINE__,
out->width, out->height);
return -1;
}
if ((in->fmt != HAL_PIXEL_FORMAT_YCrCb_NV12 &&
in->fmt != HAL_PIXEL_FORMAT_YCrCb_420_SP &&
in->fmt != HAL_PIXEL_FORMAT_RGBA_8888) ||
(out->fmt != HAL_PIXEL_FORMAT_YCrCb_NV12 &&
out->fmt != HAL_PIXEL_FORMAT_YCrCb_420_SP &&
out->fmt != HAL_PIXEL_FORMAT_RGBA_8888)) {
ALOGE("%s(%d): only accept NV12 or NV21 now. in fmt %d, out fmt %d",
__FUNCTION__, __LINE__,
in->fmt, out->fmt);
return -1;
}
RockchipRga& rkRga(RockchipRga::get());
#if defined(TARGET_RK3588)
param.width = in->width;
param.height = in->height;
param.format = in->fmt;
#endif
if (in->fd == -1) {
src.fd = -1;
src.virAddr = (void*)in->vir_addr;
#if defined(TARGET_RK3588)
LOGD("@%s,src virtual:%p",__FUNCTION__,src.virAddr);
src_handle = importbuffer_virtualaddr(src.virAddr, &param);
#endif
} else {
src.fd = in->fd;
#if defined(TARGET_RK3588)
src_handle = importbuffer_fd(src.fd, &param);
LOGD("@%s,src fd:%d,width:%d,height:%d,format:%d",__FUNCTION__,src.fd,param.width,param.height,param.format);
#endif
}
src.mmuFlag = ((2 & 0x3) << 4) | 1 | (1 << 8) | (1 << 10);
if (in->rotation != 0) {
int zoom_cropW = in->width,zoom_cropH = in->height;
int ratio = 0;
int zoom_top_offset = in->offset_y,zoom_left_offset = in->offset_x;
switch (in->rotation) {
case 90:
src.rotation = DRM_RGA_TRANSFORM_ROT_270;
ratio = out->width * 1000 / out->height;
zoom_cropH = in->height & (~0x01);
zoom_cropW = (in->height * 1000 / ratio) & (~0x01);
zoom_left_offset=((in->width-zoom_cropW)>>1) & (~0x01);
zoom_top_offset=((in->height-zoom_cropH)>>1) & (~0x01);
in->width = zoom_cropW;
in->height = zoom_cropH;
in->offset_x = zoom_left_offset + in->offset_x;
in->offset_y = zoom_top_offset + in->offset_y;
break;
case 180:
src.rotation = DRM_RGA_TRANSFORM_ROT_180;
break;
case 270:
src.rotation = DRM_RGA_TRANSFORM_ROT_90;
ratio = out->width * 1000 / out->height;
zoom_cropH = in->height & (~0x01);
zoom_cropW = (in->height * 1000 / ratio) & (~0x01);
zoom_left_offset=((in->width-zoom_cropW)>>1) & (~0x01);
zoom_top_offset=((in->height-zoom_cropH)>>1) & (~0x01);
in->width = zoom_cropW;
in->height = zoom_cropH;
in->offset_x = zoom_left_offset + in->offset_x;
in->offset_y = zoom_top_offset + in->offset_y;
break;
}
LOGE("crop:%dx%d, offset:%dx%d", zoom_cropW, zoom_cropH, zoom_left_offset, zoom_top_offset);
}
#if defined(TARGET_RK3588)
param.width = out->width;
param.height = out->height;
param.format = out->fmt;
#endif
if (out->fd == -1 ) {
dst.fd = -1;
dst.virAddr = (void*)out->vir_addr;
#if defined(TARGET_RK3588)
LOGD("@%s,dst virtual:%p",__FUNCTION__,src.virAddr);
dst_handle = importbuffer_virtualaddr(dst.virAddr, &param);
#endif
} else {
dst.fd = out->fd;
#if defined(TARGET_RK3588)
dst_handle = importbuffer_fd(dst.fd, &param);
LOGD("@%s,dst fd:%d,width:%d,height:%d,format:%d",__FUNCTION__,dst.fd,param.width,param.height,param.format);
#endif
}
dst.mmuFlag = ((2 & 0x3) << 4) | 1 | (1 << 8) | (1 << 10);
rga_set_rect(&src.rect,
in->offset_x,
in->offset_y,
in->width,
in->height,
in->width_stride,
in->height_stride,
in->fmt);
rga_set_rect(&dst.rect,
out->offset_x,
out->offset_y,
out->width,
out->height,
out->width_stride,
out->height_stride,
out->fmt);
if (in->mirror) {
src.rotation |= DRM_RGA_TRANSFORM_FLIP_H;
LOGD("---zc rga mirror====");
}
if (in->flip) {
LOGD("---zc rga flip=====");
src.rotation |= DRM_RGA_TRANSFORM_FLIP_V;
}
#if defined(TARGET_RK3588)
src.handle = src_handle;
src.fd = 0;
dst.handle = dst_handle;
dst.fd = 0;
#endif
if (rkRga.RkRgaBlit(&src, &dst, NULL)) {
ALOGE("%s:rga blit failed", __FUNCTION__);
#if defined(TARGET_RK3588)
releasebuffer_handle(src_handle);
releasebuffer_handle(dst_handle);
#endif
return -1;
}
#if defined(TARGET_RK3588)
releasebuffer_handle(src_handle);
releasebuffer_handle(dst_handle);
#endif
return 0;
}
} /* namespace camera2 */
} /* namespace android */