shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-06 10:58:48 +09:00
Code Issues Packages Projects Releases Wiki Activity

media: i2c: rk628_csi: add set quick stream

Browse Source 
Change-Id: I986db277914a26168049905e50572b07ba99cc69
Signed-off-by: Jianwei Fan <jianwei.fan@rock-chips.com>
This commit is contained in:
Jianwei Fan
2023-12-16 03:14:50 +00:00
committed by Tao Huang
parent 39b63d0caa
commit 6d6f06bbd9
1 changed files with 72 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

72
drivers/media/i2c/rk628/rk628_csi_v4l2.c
View File

@@ -2173,6 +2173,65 @@ static void rk628_csi_get_module_inf(struct rk628_csi *rk628_csi,
strscpy(inf->base.lens, rk628_csi->len_name, sizeof(inf->base.lens));
}
static void rk628_csi_reset_streaming(struct v4l2_subdev *sd, int on)
{
struct rk628_csi *csi = to_csi(sd);
if (on) {
if (csi->plat_data->tx_mode == CSI_MODE) {
rk628_csi_soft_reset(sd);
usleep_range(5000, 5500);
if (csi->continues_clk) {
rk628_i2c_update_bits(csi->rk628, CSITX_SYS_CTRL3_IMD,
CONT_MODE_CLK_CLR_MASK | CONT_MODE_CLK_SET_MASK |
NON_CONTINUOUS_MODE_MASK, CONT_MODE_CLK_CLR(0) |
CONT_MODE_CLK_SET(1) | NON_CONTINUOUS_MODE(0));
if (csi->rk628->version >= RK628F_VERSION)
rk628_i2c_update_bits(csi->rk628, CSITX1_SYS_CTRL3_IMD,
CONT_MODE_CLK_CLR_MASK | CONT_MODE_CLK_SET_MASK |
NON_CONTINUOUS_MODE_MASK, CONT_MODE_CLK_CLR(0) |
CONT_MODE_CLK_SET(1) | NON_CONTINUOUS_MODE(0));
} else {
rk628_i2c_update_bits(csi->rk628, CSITX_SYS_CTRL3_IMD,
CONT_MODE_CLK_CLR_MASK | CONT_MODE_CLK_SET_MASK |
NON_CONTINUOUS_MODE_MASK, CONT_MODE_CLK_CLR(0) |
CONT_MODE_CLK_SET(0) | NON_CONTINUOUS_MODE(1));
if (csi->rk628->version >= RK628F_VERSION)
rk628_i2c_update_bits(csi->rk628, CSITX1_SYS_CTRL3_IMD,
CONT_MODE_CLK_CLR_MASK | CONT_MODE_CLK_SET_MASK |
NON_CONTINUOUS_MODE_MASK, CONT_MODE_CLK_CLR(0) |
CONT_MODE_CLK_SET(0) | NON_CONTINUOUS_MODE(1));
}
rk628_i2c_update_bits(csi->rk628, CSITX_CSITX_EN,
DPHY_EN_MASK | CSITX_EN_MASK, DPHY_EN(1) | CSITX_EN(1));
rk628_i2c_write(csi->rk628, CSITX_CONFIG_DONE, CONFIG_DONE_IMD);
if (csi->rk628->version >= RK628F_VERSION) {
rk628_i2c_update_bits(csi->rk628, CSITX1_CSITX_EN,
DPHY_EN_MASK | CSITX_EN_MASK, DPHY_EN(1) | CSITX_EN(1));
rk628_i2c_write(csi->rk628, CSITX1_CONFIG_DONE, CONFIG_DONE_IMD);
}
rk628_csi_enable_csi_interrupts(sd, true);
} else {
enable_dsitx(sd);
}
csi->is_streaming = true;
} else {
if (csi->plat_data->tx_mode == CSI_MODE) {
rk628_csi_enable_csi_interrupts(sd, false);
msleep(20);
rk628_csi_disable_stream(sd);
} else {
rk628_dsi_enable_stream(sd, false);
}
csi->is_streaming = false;
}
v4l2_info(sd, "%s: on: %d, %dx%d@%d\n", __func__, on,
csi->timings.bt.width,
csi->timings.bt.height,
fps_calc(&csi->timings.bt));
}
static long rk628_csi_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
{
struct rk628_csi *csi = to_csi(sd);
@@ -2180,6 +2239,7 @@ static long rk628_csi_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
struct rkmodule_csi_dphy_param *dphy_param;
struct rkmodule_capture_info *capture_info;
u32 val;
u32 stream = 0;
switch (cmd) {
case RKMODULE_GET_MODULE_INFO:
@@ -2213,6 +2273,10 @@ static long rk628_csi_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
capture_info->multi_dev = csi->multi_dev_info;
}
break;
case RKMODULE_SET_QUICK_STREAM:
stream = *((u32 *)arg);
rk628_csi_reset_streaming(sd, !!stream);
break;
case RKMODULE_GET_CSI_DSI_INFO:
if (csi->plat_data->tx_mode == DSI_MODE)
*(int *)arg = RKMODULE_DSI_INPUT;
@@ -2334,6 +2398,7 @@ static long rk628_csi_compat_ioctl32(struct v4l2_subdev *sd,
int *seq;
struct rkmodule_csi_dphy_param *dphy_param;
struct rkmodule_capture_info *capture_info;
u32 stream = 0;
switch (cmd) {
case RKMODULE_GET_MODULE_INFO:
@@ -2410,6 +2475,13 @@ static long rk628_csi_compat_ioctl32(struct v4l2_subdev *sd,
}
kfree(capture_info);
break;
case RKMODULE_SET_QUICK_STREAM:
ret = copy_from_user(&stream, up, sizeof(u32));
if (!ret)
ret = rk628_csi_ioctl(sd, cmd, &stream);
else
ret = -EFAULT;
break;
case RKMODULE_GET_CSI_DSI_INFO:
seq = kzalloc(sizeof(*seq), GFP_KERNEL);
if (!seq) {