Revert "media: rockchip: isp: set lgmean related regs for tmo in hdr isr"

This reverts commit ce801a9bb6.

Change-Id: Idfe306735460be39bda996e4a7996bb0e3a03bff
Signed-off-by: Xu Hongfei <xuhf@rock-chips.com>
This commit is contained in:
Xu Hongfei
2020-11-13 10:39:27 +08:00
parent b506c435ff
commit cf9f0f7046
3 changed files with 16 additions and 196 deletions

View File

@@ -5,7 +5,6 @@
#include <media/v4l2-ioctl.h>
#include <media/videobuf2-core.h>
#include <media/videobuf2-vmalloc.h> /* for ISP params */
#include <linux/delay.h>
#include <linux/rk-preisp.h>
#include "dev.h"
#include "regs.h"
@@ -3104,29 +3103,6 @@ isp_rawnr_enable(struct rkisp_isp_params_vdev *params_vdev,
rkisp_iowrite32(params_vdev, value, ISP_RAWNR_CTRL);
}
static void isp_hdrtmo_wait_first_line(struct rkisp_isp_params_vdev *params_vdev)
{
s32 retry = 8;
u32 value, line_cnt, frame_id;
struct v4l2_rect *out_crop = &params_vdev->dev->isp_sdev.out_crop;
rkisp_dmarx_get_frame(params_vdev->dev, &frame_id, NULL, true);
do {
value = rkisp_ioread32(params_vdev, ISP_HDRTMO_LG_RO5);
line_cnt = value & 0x1fff;
if (frame_id != 0 && (line_cnt < 1 || line_cnt == out_crop->height))
udelay(10);
else
break;
} while (retry-- > 0);
if (retry < 0)
dev_err(params_vdev->dev->dev, "hdr line_cnt(%d) < 1line\n",
line_cnt);
}
static void
isp_hdrtmo_config(struct rkisp_isp_params_vdev *params_vdev,
const struct isp2x_hdrtmo_cfg *arg, enum rkisp_params_type type)
@@ -3143,23 +3119,6 @@ isp_hdrtmo_config(struct rkisp_isp_params_vdev *params_vdev,
value = ISP2X_PACK_2SHORT(arg->lgscl, arg->lgscl_inv);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_SCL);
isp_hdrtmo_wait_first_line(params_vdev);
value = ISP2X_PACK_2SHORT(arg->set_palpha, arg->set_gainoff);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG0);
value = ISP2X_PACK_2SHORT(arg->set_lgmin, arg->set_lgmax);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG1);
value = ISP2X_PACK_2SHORT(arg->set_lgmean, arg->set_weightkey);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG2);
value = ISP2X_PACK_2SHORT(arg->set_lgrange0, arg->set_lgrange1);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG3);
value = arg->set_lgavgmax;
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG4);
}
if (type == RKISP_PARAMS_IMD || type == RKISP_PARAMS_ALL) {
@@ -3193,6 +3152,21 @@ isp_hdrtmo_config(struct rkisp_isp_params_vdev *params_vdev,
value |= arg->cfg_alpha & 0xFF;
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_CTRL_CFG);
value = ISP2X_PACK_2SHORT(arg->set_palpha, arg->set_gainoff);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG0);
value = ISP2X_PACK_2SHORT(arg->set_lgmin, arg->set_lgmax);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG1);
value = ISP2X_PACK_2SHORT(arg->set_lgmean, arg->set_weightkey);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG2);
value = ISP2X_PACK_2SHORT(arg->set_lgrange0, arg->set_lgrange1);
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG3);
value = arg->set_lgavgmax;
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG4);
value = (arg->clipgap1_i & 0x0F) << 28 |
(arg->clipgap0_i & 0x0F) << 24 |
(arg->clipratio1 & 0xFF) << 16 |
@@ -4462,137 +4436,6 @@ unlock:
spin_unlock(&params_vdev->config_lock);
}
static void isp_hdrtmo_palhpa_reconfig(struct rkisp_isp_params_vdev *params_vdev, u32 lgmean)
{
u16 set_lgmin, set_lgmax, palpha_0p18, max_palpha, palpha;
u32 cur_frame_id = 0;
u32 value = 0;
set_lgmin = params_vdev->cur_hdrtmo.set_lgmin;
set_lgmax = params_vdev->cur_hdrtmo.set_lgmax;
palpha_0p18 = params_vdev->cur_hdrtmo.palpha_0p18;
max_palpha = params_vdev->cur_hdrtmo.maxpalpha;
palpha = palpha_0p18 * (4 * lgmean - 3 * set_lgmin - set_lgmax) / (set_lgmax - set_lgmin);
palpha = min(palpha, max_palpha);
rkisp_dmarx_get_frame(params_vdev->dev, &cur_frame_id, NULL, true);
value = rkisp_ioread32(params_vdev, ISP_HDRTMO_LG_CFG0) & 0xfffffc00;
value |= palpha;
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG0);
v4l2_dbg(5, rkisp_debug, &params_vdev->dev->v4l2_dev,
"frame(%d), palpha(%d)\n",
cur_frame_id, palpha);
}
static void isp_hdrtmo_lgavgmax_reconfig(struct rkisp_isp_params_vdev *params_vdev,
s32 lgmean)
{
u8 weight_key;
u16 set_lgmax, lgavgmax;
s32 lgrange1 = 0;
u32 cur_frame_id, value;
set_lgmax = params_vdev->cur_hdrtmo.set_lgmax;
lgrange1 = params_vdev->cur_hdrtmo.set_lgrange1;
weight_key = params_vdev->cur_hdrtmo.set_weightkey;
if (params_vdev->cur_hdrtmo.predict.global_tmo) {
lgavgmax = lgmean;
} else {
lgavgmax = weight_key * set_lgmax + (256 - weight_key) * lgmean;
lgavgmax = min(lgavgmax / 256, lgrange1);
}
value = rkisp_ioread32(params_vdev, ISP_HDRTMO_LG_CFG4) & 0xffff0000;
value |= lgavgmax;
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG4);
rkisp_dmarx_get_frame(params_vdev->dev, &cur_frame_id, NULL, true);
v4l2_dbg(5, rkisp_debug, &params_vdev->dev->v4l2_dev,
"frame(%d), global_tmo(%d), lgavgmax(%d)\n",
cur_frame_id,
params_vdev->cur_hdrtmo.predict.global_tmo,
lgavgmax);
}
static void isp_hdrtmo_lgrange1_reconfig(struct rkisp_isp_params_vdev *params_vdev,
s32 lgmean)
{
if (params_vdev->cur_hdrtmo.predict.global_tmo) {
s32 lgrange1 = 0;
u32 cur_frame_id, value;
lgrange1 = lgmean;
value = rkisp_ioread32(params_vdev, ISP_HDRTMO_LG_CFG3) & 0xffff;
value |= lgrange1 << 16;
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG3);
rkisp_dmarx_get_frame(params_vdev->dev, &cur_frame_id, NULL, true);
v4l2_dbg(5, rkisp_debug, &params_vdev->dev->v4l2_dev,
"frame(%d), global_tmo(%d), lgrange1(%d)\n",
cur_frame_id,
params_vdev->cur_hdrtmo.predict.global_tmo,
lgrange1);
}
}
static u16 isp_hdrtmo_lgmean_reconfig(struct rkisp_isp_params_vdev *params_vdev)
{
u16 default_lgmean = 20000;
u16 lgmean = default_lgmean;
u32 value = 0;
s32 cur_frame_id = 0;
static s32 prev_lgmean = 20000;
rkisp_dmarx_get_frame(params_vdev->dev, &cur_frame_id, NULL, true);
if (params_vdev->cur_hdrtmo.predict.iir < params_vdev->cur_hdrtmo.predict.iir_max) {
u32 ro_lgmean;
s32 predict_lgmean = 0, iir = 0;
s32 global_tmo_strength = params_vdev->cur_hdrtmo.predict.global_tmo_strength;
value = rkisp_ioread32(params_vdev, ISP_HDRTMO_LG_RO2);
ro_lgmean = value & 0xffff;
iir = min(cur_frame_id + 1, params_vdev->cur_hdrtmo.predict.iir);
default_lgmean += global_tmo_strength;
ro_lgmean += global_tmo_strength;
if (params_vdev->cur_hdrtmo.predict.scene_stable) {
predict_lgmean = ro_lgmean + params_vdev->cur_hdrtmo.predict.k_rolgmean;
if (cur_frame_id == 0)
lgmean = default_lgmean;
else
lgmean = ((iir - 2) * prev_lgmean + ro_lgmean + predict_lgmean) / iir;
} else {
if (cur_frame_id == 0)
lgmean = default_lgmean;
else
lgmean = ((iir - 1) * prev_lgmean + ro_lgmean) / iir;
}
}
value = rkisp_ioread32(params_vdev, ISP_HDRTMO_LG_CFG2) & 0xffff0000;
value |= lgmean;
rkisp_iowrite32(params_vdev, value, ISP_HDRTMO_LG_CFG2);
prev_lgmean = lgmean;
v4l2_dbg(5, rkisp_debug, &params_vdev->dev->v4l2_dev,
"frame(%d), scene_stable(%d), k_rolgmean(%d), iir(%d), lgmean(%d)\n",
cur_frame_id,
params_vdev->cur_hdrtmo.predict.scene_stable,
params_vdev->cur_hdrtmo.predict.k_rolgmean,
params_vdev->cur_hdrtmo.predict.iir,
lgmean);
return lgmean;
}
static void
rkisp_params_isr_v2x(struct rkisp_isp_params_vdev *params_vdev,
u32 isp_mis)
@@ -4623,17 +4466,6 @@ rkisp_params_isr_v2x(struct rkisp_isp_params_vdev *params_vdev,
}
}
if (isp_mis & ISP2X_HDR_DONE) {
u16 lgmean = 0;
lgmean = isp_hdrtmo_lgmean_reconfig(params_vdev);
isp_hdrtmo_palhpa_reconfig(params_vdev, lgmean);
isp_hdrtmo_lgrange1_reconfig(params_vdev, lgmean);
isp_hdrtmo_lgavgmax_reconfig(params_vdev, lgmean);
writel(ISP2X_HDR_DONE, dev->base_addr + ISP_ISP_ICR);
}
if ((isp_mis & CIF_ISP_FRAME) && !IS_HDR_RDBK(dev->csi_dev.rd_mode))
rkisp_params_cfg_v2x(params_vdev, cur_frame_id, 0, RKISP_PARAMS_ALL);
}

View File

@@ -610,7 +610,7 @@ static int rkisp_config_isp(struct rkisp_device *dev)
/* interrupt mask */
irq_mask |= CIF_ISP_FRAME | CIF_ISP_V_START | CIF_ISP_PIC_SIZE_ERROR |
CIF_ISP_FRAME_IN | ISP2X_HDR_DONE;
CIF_ISP_FRAME_IN;
if (dev->isp_ver == ISP_V20)
irq_mask |= ISP2X_LSC_LUT_ERR;
rkisp_write(dev, CIF_ISP_IMSC, irq_mask, true);

View File

@@ -514,16 +514,6 @@ struct isp2x_goc_cfg {
u8 gamma_y[17];
} __attribute__ ((packed));
struct isp2x_hdrtmo_predict {
bool global_tmo;
s32 iir_max;
s32 global_tmo_strength;
bool scene_stable;
s32 k_rolgmean;
s32 iir;
} __attribute__ ((packed));
struct isp2x_hdrtmo_cfg {
u16 cnt_vsize;
u8 gain_ld_off2;
@@ -575,8 +565,6 @@ struct isp2x_hdrtmo_cfg {
u16 maxgain;
u16 maxpalpha;
struct isp2x_hdrtmo_predict predict;
} __attribute__ ((packed));
struct isp2x_hdrtmo_stat {