ov2659
struct ov2659 *ov2659 = to_ov2659(sd);
mutex_lock(&ov2659->lock);
mutex_unlock(&ov2659->lock);
mutex_lock(&ov2659->lock);
fmt->format = ov2659->format;
mutex_unlock(&ov2659->lock);
ov2659->format.code, ov2659->format.width,
ov2659->format.height);
struct ov2659 *ov2659 = to_ov2659(sd);
mutex_lock(&ov2659->lock);
if (ov2659->streaming) {
mutex_unlock(&ov2659->lock);
ov2659->frame_size = size;
ov2659->format = fmt->format;
ov2659->format_ctrl_regs =
if (ov2659->format.code != MEDIA_BUS_FMT_SBGGR8_1X8)
val = ov2659->pdata->link_frequency / 2;
val = ov2659->pdata->link_frequency;
ret = v4l2_ctrl_s_ctrl_int64(ov2659->link_frequency, val);
mutex_unlock(&ov2659->lock);
static int ov2659_set_frame_size(struct ov2659 *ov2659)
struct i2c_client *client = ov2659->client;
return ov2659_write_array(ov2659->client, ov2659->frame_size->regs);
static int ov2659_set_format(struct ov2659 *ov2659)
struct i2c_client *client = ov2659->client;
return ov2659_write_array(ov2659->client, ov2659->format_ctrl_regs);
struct ov2659 *ov2659 = to_ov2659(sd);
mutex_lock(&ov2659->lock);
if (ov2659->streaming == on)
ov2659_set_streaming(ov2659, 0);
ov2659->streaming = on;
ret = ov2659_set_pixel_clock(ov2659);
ret = ov2659_set_frame_size(ov2659);
ret = ov2659_set_format(ov2659);
ov2659_set_streaming(ov2659, 1);
ov2659->streaming = on;
mutex_unlock(&ov2659->lock);
static int ov2659_set_test_pattern(struct ov2659 *ov2659, int value)
struct i2c_client *client = v4l2_get_subdevdata(&ov2659->sd);
struct ov2659 *ov2659 =
container_of(ctrl->handler, struct ov2659, ctrls);
struct i2c_client *client = ov2659->client;
return ov2659_set_test_pattern(ov2659, ctrl->val);
struct ov2659 *ov2659 = to_ov2659(sd);
gpiod_set_value(ov2659->pwdn_gpio, 1);
clk_disable_unprepare(ov2659->clk);
struct ov2659 *ov2659 = to_ov2659(sd);
ret = clk_prepare_enable(ov2659->clk);
gpiod_set_value(ov2659->pwdn_gpio, 0);
if (ov2659->resetb_gpio) {
gpiod_set_value(ov2659->resetb_gpio, 1);
gpiod_set_value(ov2659->resetb_gpio, 0);
struct ov2659 *ov2659;
ov2659 = devm_kzalloc(&client->dev, sizeof(*ov2659), GFP_KERNEL);
if (!ov2659)
ov2659->pdata = pdata;
ov2659->client = client;
ov2659->clk = devm_v4l2_sensor_clk_get(&client->dev, "xvclk");
if (IS_ERR(ov2659->clk))
return dev_err_probe(&client->dev, PTR_ERR(ov2659->clk),
ov2659->xvclk_frequency = clk_get_rate(ov2659->clk);
if (ov2659->xvclk_frequency < 6000000 ||
ov2659->xvclk_frequency > 27000000)
ov2659->pwdn_gpio = devm_gpiod_get_optional(&client->dev, "powerdown",
if (IS_ERR(ov2659->pwdn_gpio))
return PTR_ERR(ov2659->pwdn_gpio);
ov2659->resetb_gpio = devm_gpiod_get_optional(&client->dev, "reset",
if (IS_ERR(ov2659->resetb_gpio))
return PTR_ERR(ov2659->resetb_gpio);
v4l2_ctrl_handler_init(&ov2659->ctrls, 2);
ov2659->link_frequency =
v4l2_ctrl_new_std(&ov2659->ctrls, &ov2659_ctrl_ops,
v4l2_ctrl_new_std_menu_items(&ov2659->ctrls, &ov2659_ctrl_ops,
if (ov2659->ctrls.error) {
__func__, ov2659->ctrls.error);
v4l2_ctrl_handler_free(&ov2659->ctrls);
return ov2659->ctrls.error;
ov2659->sd.ctrl_handler = &ov2659->ctrls;
sd = &ov2659->sd;
ov2659->pad.flags = MEDIA_PAD_FL_SOURCE;
ret = media_entity_pads_init(&sd->entity, 1, &ov2659->pad);
v4l2_ctrl_handler_free(&ov2659->ctrls);
mutex_init(&ov2659->lock);
ov2659_get_default_format(&ov2659->format);
ov2659->frame_size = &ov2659_framesizes[2];
ov2659->format_ctrl_regs = ov2659_formats[0].format_ctrl_regs;
ov2659_pll_calc_params(ov2659);
ret = v4l2_async_register_subdev(&ov2659->sd);
v4l2_ctrl_handler_free(&ov2659->ctrls);
mutex_destroy(&ov2659->lock);
struct ov2659 *ov2659 = to_ov2659(sd);
v4l2_ctrl_handler_free(&ov2659->ctrls);
mutex_destroy(&ov2659->lock);
static inline struct ov2659 *to_ov2659(struct v4l2_subdev *sd)
return container_of(sd, struct ov2659, sd);
static void ov2659_pll_calc_params(struct ov2659 *ov2659)
const struct ov2659_platform_data *pdata = ov2659->pdata;
struct i2c_client *client = ov2659->client;
actual = ov2659->xvclk_frequency;
ov2659->pll.ctrl1 = ctrl1_reg;
ov2659->pll.ctrl2 = ctrl2_reg;
ov2659->pll.ctrl3 = ctrl3_reg;
static int ov2659_set_pixel_clock(struct ov2659 *ov2659)
struct i2c_client *client = ov2659->client;
{REG_SC_PLL_CTRL1, ov2659->pll.ctrl1},
{REG_SC_PLL_CTRL2, ov2659->pll.ctrl2},
{REG_SC_PLL_CTRL3, ov2659->pll.ctrl3},
static void ov2659_set_streaming(struct ov2659 *ov2659, int on)
struct i2c_client *client = ov2659->client;