ov9734
static inline struct ov9734 *to_ov9734(struct v4l2_subdev *subdev)
return container_of(subdev, struct ov9734, sd);
static int ov9734_read_reg(struct ov9734 *ov9734, u16 reg, u16 len, u32 *val)
struct i2c_client *client = v4l2_get_subdevdata(&ov9734->sd);
static int ov9734_write_reg(struct ov9734 *ov9734, u16 reg, u16 len, u32 val)
struct i2c_client *client = v4l2_get_subdevdata(&ov9734->sd);
static int ov9734_write_reg_list(struct ov9734 *ov9734,
ret = ov9734_write_reg(ov9734, r_list->regs[i].address, 1,
dev_err_ratelimited(ov9734->dev,
static int ov9734_update_digital_gain(struct ov9734 *ov9734, u32 d_gain)
ret = ov9734_write_reg(ov9734, OV9734_REG_GROUP_ACCESS, 1,
ret = ov9734_write_reg(ov9734, OV9734_REG_MWB_R_GAIN, 2, d_gain);
ret = ov9734_write_reg(ov9734, OV9734_REG_MWB_G_GAIN, 2, d_gain);
ret = ov9734_write_reg(ov9734, OV9734_REG_MWB_B_GAIN, 2, d_gain);
ret = ov9734_write_reg(ov9734, OV9734_REG_GROUP_ACCESS, 1,
ret = ov9734_write_reg(ov9734, OV9734_REG_GROUP_ACCESS, 1,
static int ov9734_test_pattern(struct ov9734 *ov9734, u32 pattern)
return ov9734_write_reg(ov9734, OV9734_REG_TEST_PATTERN, 1, pattern);
struct ov9734 *ov9734 = container_of(ctrl->handler,
struct ov9734, ctrl_handler);
exposure_max = ov9734->cur_mode->height + ctrl->val -
__v4l2_ctrl_modify_range(ov9734->exposure,
ov9734->exposure->minimum,
exposure_max, ov9734->exposure->step,
if (!pm_runtime_get_if_in_use(ov9734->dev))
ret = ov9734_write_reg(ov9734, OV9734_REG_ANALOG_GAIN,
ret = ov9734_update_digital_gain(ov9734, ctrl->val);
ret = ov9734_write_reg(ov9734, OV9734_REG_EXPOSURE,
ret = ov9734_write_reg(ov9734, OV9734_REG_VTS, 2,
ov9734->cur_mode->height + ctrl->val);
ret = ov9734_test_pattern(ov9734, ctrl->val);
pm_runtime_put(ov9734->dev);
static int ov9734_init_controls(struct ov9734 *ov9734)
ctrl_hdlr = &ov9734->ctrl_handler;
ctrl_hdlr->lock = &ov9734->mutex;
cur_mode = ov9734->cur_mode;
ov9734->link_freq = v4l2_ctrl_new_int_menu(ctrl_hdlr, &ov9734_ctrl_ops,
if (ov9734->link_freq)
ov9734->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
ov9734->pixel_rate = v4l2_ctrl_new_std(ctrl_hdlr, &ov9734_ctrl_ops,
ov9734->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &ov9734_ctrl_ops,
ov9734->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &ov9734_ctrl_ops,
if (ov9734->hblank)
ov9734->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;
exposure_max = ov9734->cur_mode->vts_def - OV9734_EXPOSURE_MAX_MARGIN;
ov9734->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &ov9734_ctrl_ops,
ov9734->sd.ctrl_handler = ctrl_hdlr;
static int ov9734_start_streaming(struct ov9734 *ov9734)
link_freq_index = ov9734->cur_mode->link_freq_index;
ret = ov9734_write_reg_list(ov9734, reg_list);
dev_err(ov9734->dev, "failed to set plls");
reg_list = &ov9734->cur_mode->reg_list;
ret = ov9734_write_reg_list(ov9734, reg_list);
dev_err(ov9734->dev, "failed to set mode");
ret = __v4l2_ctrl_handler_setup(ov9734->sd.ctrl_handler);
ret = ov9734_write_reg(ov9734, OV9734_REG_MODE_SELECT,
dev_err(ov9734->dev, "failed to start stream");
static void ov9734_stop_streaming(struct ov9734 *ov9734)
if (ov9734_write_reg(ov9734, OV9734_REG_MODE_SELECT,
dev_err(ov9734->dev, "failed to stop stream");
struct ov9734 *ov9734 = to_ov9734(sd);
mutex_lock(&ov9734->mutex);
ret = pm_runtime_resume_and_get(ov9734->dev);
mutex_unlock(&ov9734->mutex);
ret = ov9734_start_streaming(ov9734);
ov9734_stop_streaming(ov9734);
pm_runtime_put(ov9734->dev);
ov9734_stop_streaming(ov9734);
pm_runtime_put(ov9734->dev);
mutex_unlock(&ov9734->mutex);
struct ov9734 *ov9734 = to_ov9734(sd);
mutex_lock(&ov9734->mutex);
ov9734->cur_mode = mode;
__v4l2_ctrl_s_ctrl(ov9734->link_freq, mode->link_freq_index);
__v4l2_ctrl_s_ctrl_int64(ov9734->pixel_rate,
__v4l2_ctrl_modify_range(ov9734->vblank,
__v4l2_ctrl_s_ctrl(ov9734->vblank, vblank_def);
__v4l2_ctrl_modify_range(ov9734->hblank, h_blank, h_blank, 1,
mutex_unlock(&ov9734->mutex);
struct ov9734 *ov9734 = to_ov9734(sd);
mutex_lock(&ov9734->mutex);
ov9734_update_pad_format(ov9734->cur_mode, &fmt->format);
mutex_unlock(&ov9734->mutex);
struct ov9734 *ov9734 = to_ov9734(sd);
mutex_lock(&ov9734->mutex);
mutex_unlock(&ov9734->mutex);
static int ov9734_identify_module(struct ov9734 *ov9734)
ret = ov9734_read_reg(ov9734, OV9734_REG_CHIP_ID, 2, &val);
dev_err(ov9734->dev, "chip id mismatch: %x!=%x",
struct ov9734 *ov9734 = to_ov9734(sd);
pm_runtime_disable(ov9734->dev);
pm_runtime_set_suspended(ov9734->dev);
mutex_destroy(&ov9734->mutex);
struct ov9734 *ov9734;
ov9734 = devm_kzalloc(&client->dev, sizeof(*ov9734), GFP_KERNEL);
if (!ov9734)
ov9734->dev = &client->dev;
ov9734->clk = devm_v4l2_sensor_clk_get(ov9734->dev, NULL);
if (IS_ERR(ov9734->clk))
return dev_err_probe(ov9734->dev, PTR_ERR(ov9734->clk),
freq = clk_get_rate(ov9734->clk);
return dev_err_probe(ov9734->dev, -EINVAL,
v4l2_i2c_subdev_init(&ov9734->sd, client, &ov9734_subdev_ops);
ret = ov9734_identify_module(ov9734);
dev_err(ov9734->dev, "failed to find sensor: %d", ret);
mutex_init(&ov9734->mutex);
ov9734->cur_mode = &supported_modes[0];
ret = ov9734_init_controls(ov9734);
dev_err(ov9734->dev, "failed to init controls: %d", ret);
ov9734->sd.internal_ops = &ov9734_internal_ops;
ov9734->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
ov9734->sd.entity.ops = &ov9734_subdev_entity_ops;
ov9734->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
ov9734->pad.flags = MEDIA_PAD_FL_SOURCE;
ret = media_entity_pads_init(&ov9734->sd.entity, 1, &ov9734->pad);
dev_err(ov9734->dev, "failed to init entity pads: %d", ret);
pm_runtime_set_active(ov9734->dev);
pm_runtime_enable(ov9734->dev);
pm_runtime_idle(ov9734->dev);
ret = v4l2_async_register_subdev_sensor(&ov9734->sd);
dev_err(ov9734->dev, "failed to register V4L2 subdev: %d",
pm_runtime_disable(ov9734->dev);
pm_runtime_set_suspended(ov9734->dev);
media_entity_cleanup(&ov9734->sd.entity);
v4l2_ctrl_handler_free(ov9734->sd.ctrl_handler);
mutex_destroy(&ov9734->mutex);