media: rockchip: isp: fix resume mi no enable

Change-Id: Ic7aa8eb5528e97b4d425971d5189ef85c0c1c6c9
Signed-off-by: Cai YiWei <cyw@rock-chips.com>
This commit is contained in:
Cai YiWei
2024-01-05 18:03:39 +08:00
parent 982e655deb
commit ce956f7a33
2 changed files with 40 additions and 2 deletions

View File

@@ -441,6 +441,9 @@ void rkisp_hw_reg_restore(struct rkisp_hw_dev *dev)
}, {
.base = MI_GAIN_WR_BASE,
.shd = MI_GAIN_WR_BASE_SHD,
}, {
.base = MI_WR_CTRL,
.shd = MI_WR_CTRL_SHD,
}
};
@@ -495,7 +498,34 @@ void rkisp_hw_reg_restore(struct rkisp_hw_dev *dev)
reg = reg_buf + backup[j].base;
reg1 = reg_buf + backup[j].shd;
backup[j].val = *reg;
writel(*reg1, base + backup[j].base);
if (backup[j].base == MI_WR_CTRL) {
val = *reg1 & 0xf;
val |= (*reg & ~0xf);
} else {
val = *reg1;
}
writel(val, base + backup[j].base);
}
if (dev->isp_ver == ISP_V30) {
reg = reg_buf + ISP32_MI_WR_CTRL2_SHD;
reg1 = reg_buf + ISP3X_MI_BP_WR_CTRL;
if ((*reg & ISP32_BP_EN_IN_SHD) != (*reg1 & ISP3X_BP_ENABLE)) {
val = *reg & ISP32_BP_EN_IN_SHD;
val |= *reg1 & ~ISP3X_BP_ENABLE;
writel(val, base + ISP3X_MI_BP_WR_CTRL);
}
reg1 = reg_buf + ISP32_MI_MPDS_WR_CTRL;
if ((*reg & ISP32_MPDS_EN_IN_SHD) != (*reg1 & ISP32_DS_ENABLE)) {
val = *reg & ISP32_MPDS_EN_IN_SHD;
val |= *reg1 & ~ISP32_DS_ENABLE;
writel(val, base + ISP32_MI_MPDS_WR_CTRL);
}
reg1 = reg_buf + ISP32_MI_BPDS_WR_CTRL;
if ((*reg & ISP32_BPDS_EN_IN_SHD) != (*reg1 & ISP32_DS_ENABLE)) {
val = *reg & ISP32_BPDS_EN_IN_SHD;
val |= *reg1 & ~ISP32_DS_ENABLE;
writel(val, base + ISP32_MI_BPDS_WR_CTRL);
}
}
/* update module */
@@ -522,6 +552,14 @@ void rkisp_hw_reg_restore(struct rkisp_hw_dev *dev)
/* config base_reg */
for (j = 0; j < ARRAY_SIZE(backup); j++)
writel(backup[j].val, base + backup[j].base);
if (dev->isp_ver == ISP_V30) {
reg = reg_buf + ISP3X_MI_BP_WR_CTRL;
writel(*reg, base + ISP3X_MI_BP_WR_CTRL);
reg = reg_buf + ISP32_MI_MPDS_WR_CTRL;
writel(*reg, base + ISP32_MI_MPDS_WR_CTRL);
reg = reg_buf + ISP32_MI_BPDS_WR_CTRL;
writel(*reg, base + ISP32_MI_BPDS_WR_CTRL);
}
/* base_reg = shd_reg, write is base but read is shd */
val = rkisp_read_reg_cache(isp, ISP_MPFBC_HEAD_PTR);
writel(val, base + ISP_MPFBC_HEAD_PTR);

View File

@@ -203,7 +203,7 @@ int rkisp_rockit_buf_queue(struct rockit_cfg *input_rockit_cfg)
isprk_buf->isp_buf.buff_addr[0], isprk_buf->isp_buf.buff_addr[1]);
/* single sensor with pingpong buf, update next if need */
if (stream->ispdev->hw_dev->is_single &&
if (ispdev->hw_dev->is_single && !ispdev->is_suspend &&
stream->id != RKISP_STREAM_VIR &&
stream->id != RKISP_STREAM_LUMA &&
stream->streaming && !stream->next_buf) {