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: sc210iot support get real fps

Browse Source 
Signed-off-by: Zefa Chen <zefa.chen@rock-chips.com>
Change-Id: I076f76fc865832c6c32bc0948a3ac946f856a302
This commit is contained in:
Zefa Chen
2022-09-05 21:22:55 +08:00
committed by Tao Huang
parent 93205a19f3
commit 399f2b54c2
1 changed files with 23 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

27
drivers/media/i2c/sc210iot.c
View File

@@ -140,6 +140,8 @@ struct sc210iot {
struct v4l2_ctrl *link_freq;
struct v4l2_ctrl *pixel_rate;
struct mutex lock;
struct v4l2_fract cur_fps;
u32 cur_vts;
bool streaming;
bool power_on;
bool is_thunderboot;
@@ -363,6 +365,14 @@ static int sc210iot_set_exp(struct sc210iot *sc210iot, u32 exp)
return ret;
}
static void sc210iot_modify_fps_info(struct sc210iot *sc210iot)
{
const struct sc210iot_mode *mode = sc210iot->cur_mode;
sc210iot->cur_fps.denominator = mode->max_fps.denominator * sc210iot->cur_vts /
mode->vts_def;
}
static int sc210iot_set_ctrl(struct v4l2_ctrl *ctrl)
{
struct sc210iot *sc210iot = container_of(ctrl->handler,
@@ -394,8 +404,12 @@ static int sc210iot_set_ctrl(struct v4l2_ctrl *ctrl)
dev_dbg(sc210iot->dev, "set vblank 0x%x\n", ctrl->val);
ret = sc210iot_write_reg(sc210iot, SC210IOT_REG_VTS_H,
(ctrl->val + sc210iot->cur_mode->height) >> 8);
ret = sc210iot_write_reg(sc210iot, SC210IOT_REG_VTS_L,
ret |= sc210iot_write_reg(sc210iot, SC210IOT_REG_VTS_L,
(ctrl->val + sc210iot->cur_mode->height) & 0xff);
if (!ret)
sc210iot->cur_vts = ctrl->val + sc210iot->cur_mode->height;
if (sc210iot->cur_vts != sc210iot->cur_mode->vts_def)
sc210iot_modify_fps_info(sc210iot);
break;
case V4L2_CID_HFLIP:
regmap_update_bits(sc210iot->regmap, SC210IOT_REG_MIRROR_FLIP,
@@ -479,6 +493,8 @@ static int sc210iot_initialize_controls(struct sc210iot *sc210iot)
}
sc210iot->subdev.ctrl_handler = handler;
sc210iot->has_init_exp = false;
sc210iot->cur_fps = mode->max_fps;
sc210iot->cur_vts = mode->vts_def;
return 0;
err_free_handler:
v4l2_ctrl_handler_free(handler);
@@ -756,9 +772,10 @@ static int sc210iot_g_frame_interval(struct v4l2_subdev *sd,
struct sc210iot *sc210iot = to_sc210iot(sd);
const struct sc210iot_mode *mode = sc210iot->cur_mode;
mutex_lock(&sc210iot->lock);
fi->interval = mode->max_fps;
mutex_unlock(&sc210iot->lock);
if (sc210iot->streaming)
fi->interval = sc210iot->cur_fps;
else
fi->interval = mode->max_fps;
return 0;
}
@@ -854,6 +871,8 @@ static int sc210iot_set_fmt(struct v4l2_subdev *sd,
__v4l2_ctrl_modify_range(sc210iot->vblank, vblank_def,
SC210IOT_VTS_MAX - mode->height,
1, vblank_def);
sc210iot->cur_fps = mode->max_fps;
sc210iot->cur_vts = mode->vts_def;
}
mutex_unlock(&sc210iot->lock);
return 0;