/*
|
* Rockchip isp1 driver
|
*
|
* Copyright (C) 2017 Rockchip Electronics Co., Ltd.
|
*
|
* This software is available to you under a choice of one of two
|
* licenses. You may choose to be licensed under the terms of the GNU
|
* General Public License (GPL) Version 2, available from the file
|
* COPYING in the main directory of this source tree, or the
|
* OpenIB.org BSD license below:
|
*
|
* Redistribution and use in source and binary forms, with or
|
* without modification, are permitted provided that the following
|
* conditions are met:
|
*
|
* - Redistributions of source code must retain the above
|
* copyright notice, this list of conditions and the following
|
* disclaimer.
|
*
|
* - Redistributions in binary form must reproduce the above
|
* copyright notice, this list of conditions and the following
|
* disclaimer in the documentation and/or other materials
|
* provided with the distribution.
|
*
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
* SOFTWARE.
|
*/
|
|
#include <media/v4l2-common.h>
|
#include "regs.h"
|
|
void rkisp_disable_dcrop(struct rkisp_stream *stream, bool async)
|
{
|
struct rkisp_device *dev = stream->ispdev;
|
u32 mask = stream->config->dual_crop.yuvmode_mask |
|
stream->config->dual_crop.rawmode_mask;
|
u32 val = CIF_DUAL_CROP_CFG_UPD;
|
|
if (async && dev->hw_dev->is_single)
|
val = CIF_DUAL_CROP_GEN_CFG_UPD;
|
rkisp_set_bits(dev, stream->config->dual_crop.ctrl, mask, val, false);
|
}
|
|
void rkisp_config_dcrop(struct rkisp_stream *stream,
|
struct v4l2_rect *rect, bool async)
|
{
|
struct rkisp_device *dev = stream->ispdev;
|
u32 val = stream->config->dual_crop.yuvmode_mask;
|
|
rkisp_write(dev, stream->config->dual_crop.h_offset, rect->left, false);
|
rkisp_write(dev, stream->config->dual_crop.v_offset, rect->top, false);
|
rkisp_write(dev, stream->config->dual_crop.h_size, rect->width, false);
|
rkisp_write(dev, stream->config->dual_crop.v_size, rect->height, false);
|
if (async && dev->hw_dev->is_single)
|
val |= CIF_DUAL_CROP_GEN_CFG_UPD;
|
else
|
val |= CIF_DUAL_CROP_CFG_UPD;
|
rkisp_set_bits(dev, stream->config->dual_crop.ctrl, 0, val, false);
|
}
|
|
void rkisp_dump_rsz_regs(struct rkisp_stream *stream)
|
{
|
struct rkisp_device *dev = stream->ispdev;
|
|
pr_info("RSZ_CTRL 0x%08x/0x%08x\n"
|
"RSZ_SCALE_HY %d/%d\n"
|
"RSZ_SCALE_HCB %d/%d\n"
|
"RSZ_SCALE_HCR %d/%d\n"
|
"RSZ_SCALE_VY %d/%d\n"
|
"RSZ_SCALE_VC %d/%d\n"
|
"RSZ_PHASE_HY %d/%d\n"
|
"RSZ_PHASE_HC %d/%d\n"
|
"RSZ_PHASE_VY %d/%d\n"
|
"RSZ_PHASE_VC %d/%d\n",
|
rkisp_read(dev, stream->config->rsz.ctrl, false),
|
rkisp_read(dev, stream->config->rsz.ctrl_shd, true),
|
rkisp_read(dev, stream->config->rsz.scale_hy, false),
|
rkisp_read(dev, stream->config->rsz.scale_hy_shd, true),
|
rkisp_read(dev, stream->config->rsz.scale_hcb, false),
|
rkisp_read(dev, stream->config->rsz.scale_hcb_shd, true),
|
rkisp_read(dev, stream->config->rsz.scale_hcr, false),
|
rkisp_read(dev, stream->config->rsz.scale_hcr_shd, true),
|
rkisp_read(dev, stream->config->rsz.scale_vy, false),
|
rkisp_read(dev, stream->config->rsz.scale_vy_shd, true),
|
rkisp_read(dev, stream->config->rsz.scale_vc, false),
|
rkisp_read(dev, stream->config->rsz.scale_vc_shd, true),
|
rkisp_read(dev, stream->config->rsz.phase_hy, false),
|
rkisp_read(dev, stream->config->rsz.phase_hy_shd, true),
|
rkisp_read(dev, stream->config->rsz.phase_hc, false),
|
rkisp_read(dev, stream->config->rsz.phase_hc_shd, true),
|
rkisp_read(dev, stream->config->rsz.phase_vy, false),
|
rkisp_read(dev, stream->config->rsz.phase_vy_shd, true),
|
rkisp_read(dev, stream->config->rsz.phase_vc, false),
|
rkisp_read(dev, stream->config->rsz.phase_vc_shd, true));
|
}
|
|
static void update_rsz_shadow(struct rkisp_stream *stream, bool async)
|
{
|
struct rkisp_device *dev = stream->ispdev;
|
u32 val = CIF_RSZ_CTRL_CFG_UPD;
|
|
if (async && dev->hw_dev->is_single)
|
val = CIF_RSZ_CTRL_CFG_UPD_AUTO;
|
rkisp_set_bits(dev, stream->config->rsz.ctrl, 0, val, false);
|
}
|
|
static void set_scale(struct rkisp_stream *stream, struct v4l2_rect *in_y,
|
struct v4l2_rect *in_c, struct v4l2_rect *out_y,
|
struct v4l2_rect *out_c)
|
{
|
struct rkisp_device *dev = stream->ispdev;
|
u32 scale_hy_addr = stream->config->rsz.scale_hy;
|
u32 scale_hcr_addr = stream->config->rsz.scale_hcr;
|
u32 scale_hcb_addr = stream->config->rsz.scale_hcb;
|
u32 scale_vy_addr = stream->config->rsz.scale_vy;
|
u32 scale_vc_addr = stream->config->rsz.scale_vc;
|
u32 rsz_ctrl_addr = stream->config->rsz.ctrl;
|
u32 scale_hy, scale_hc, scale_vy, scale_vc, rsz_ctrl = 0;
|
|
if (in_y->width < out_y->width) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_HY_ENABLE |
|
CIF_RSZ_CTRL_SCALE_HY_UP;
|
scale_hy = ((in_y->width - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(out_y->width - 1);
|
rkisp_write(dev, scale_hy_addr, scale_hy, false);
|
} else if (in_y->width > out_y->width) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_HY_ENABLE;
|
scale_hy = ((out_y->width - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(in_y->width - 1) + 1;
|
rkisp_write(dev, scale_hy_addr, scale_hy, false);
|
}
|
if (in_c->width < out_c->width) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_HC_ENABLE |
|
CIF_RSZ_CTRL_SCALE_HC_UP;
|
scale_hc = ((in_c->width - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(out_c->width - 1);
|
rkisp_write(dev, scale_hcb_addr, scale_hc, false);
|
rkisp_write(dev, scale_hcr_addr, scale_hc, false);
|
} else if (in_c->width > out_c->width) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_HC_ENABLE;
|
scale_hc = ((out_c->width - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(in_c->width - 1) + 1;
|
rkisp_write(dev, scale_hcb_addr, scale_hc, false);
|
rkisp_write(dev, scale_hcr_addr, scale_hc, false);
|
}
|
|
if (in_y->height < out_y->height) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_VY_ENABLE |
|
CIF_RSZ_CTRL_SCALE_VY_UP;
|
scale_vy = ((in_y->height - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(out_y->height - 1);
|
rkisp_write(dev, scale_vy_addr, scale_vy, false);
|
} else if (in_y->height > out_y->height) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_VY_ENABLE;
|
scale_vy = ((out_y->height - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(in_y->height - 1) + 1;
|
rkisp_write(dev, scale_vy_addr, scale_vy, false);
|
}
|
|
if (in_c->height < out_c->height) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_VC_ENABLE |
|
CIF_RSZ_CTRL_SCALE_VC_UP;
|
scale_vc = ((in_c->height - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(out_c->height - 1);
|
rkisp_write(dev, scale_vc_addr, scale_vc, false);
|
} else if (in_c->height > out_c->height) {
|
rsz_ctrl |= CIF_RSZ_CTRL_SCALE_VC_ENABLE;
|
scale_vc = ((out_c->height - 1) * CIF_RSZ_SCALER_FACTOR) /
|
(in_c->height - 1) + 1;
|
rkisp_write(dev, scale_vc_addr, scale_vc, false);
|
}
|
|
rkisp_write(dev, rsz_ctrl_addr, rsz_ctrl, false);
|
}
|
|
void rkisp_config_rsz(struct rkisp_stream *stream, struct v4l2_rect *in_y,
|
struct v4l2_rect *in_c, struct v4l2_rect *out_y,
|
struct v4l2_rect *out_c, bool async)
|
{
|
struct rkisp_device *dev = stream->ispdev;
|
int i = 0;
|
|
/* No phase offset */
|
rkisp_write(dev, stream->config->rsz.phase_hy, 0, true);
|
rkisp_write(dev, stream->config->rsz.phase_hc, 0, true);
|
rkisp_write(dev, stream->config->rsz.phase_vy, 0, true);
|
rkisp_write(dev, stream->config->rsz.phase_vc, 0, true);
|
|
/* Linear interpolation */
|
for (i = 0; i < 64; i++) {
|
rkisp_write(dev, stream->config->rsz.scale_lut_addr, i, true);
|
rkisp_write(dev, stream->config->rsz.scale_lut, i, true);
|
}
|
|
set_scale(stream, in_y, in_c, out_y, out_c);
|
|
update_rsz_shadow(stream, async);
|
}
|
|
void rkisp_disable_rsz(struct rkisp_stream *stream, bool async)
|
{
|
rkisp_write(stream->ispdev, stream->config->rsz.ctrl, 0, false);
|
|
if (!async)
|
update_rsz_shadow(stream, async);
|
}
|
