ov4689
v4l2_ctrl_handler_free(&ov4689->ctrl_handler);
struct ov4689 *ov4689 = to_ov4689(sd);
v4l2_ctrl_handler_free(&ov4689->ctrl_handler);
#define to_ov4689(sd) container_of(sd, struct ov4689, subdev)
struct ov4689 *ov4689 = to_ov4689(sd);
ov4689_fill_fmt(ov4689->cur_mode, mbus_fmt);
static int ov4689_enable_test_pattern(struct ov4689 *ov4689, u32 pattern)
return cci_write(ov4689->regmap, OV4689_REG_TEST_PATTERN,
static int ov4689_setup_timings(struct ov4689 *ov4689)
const struct ov4689_mode *mode = ov4689->cur_mode;
struct regmap *rm = ov4689->regmap;
static int ov4689_setup_blc_anchors(struct ov4689 *ov4689)
struct regmap *rm = ov4689->regmap;
struct ov4689 *ov4689 = to_ov4689(sd);
struct device *dev = ov4689->dev;
sd_state = v4l2_subdev_lock_and_get_active_state(&ov4689->subdev);
ret = cci_multi_reg_write(ov4689->regmap,
ov4689->cur_mode->reg_list,
ov4689->cur_mode->num_regs,
ret = ov4689_setup_timings(ov4689);
ret = ov4689_setup_blc_anchors(ov4689);
ret = __v4l2_ctrl_handler_setup(&ov4689->ctrl_handler);
ret = cci_write(ov4689->regmap, OV4689_REG_CTRL_MODE,
cci_write(ov4689->regmap, OV4689_REG_CTRL_MODE,
static inline u32 ov4689_cal_delay(struct ov4689 *ov4689, u32 cycles)
DIV_ROUND_UP(ov4689->clock_rate, 1000));
struct ov4689 *ov4689 = to_ov4689(sd);
ret = clk_prepare_enable(ov4689->xvclk);
gpiod_set_value_cansleep(ov4689->reset_gpio, 1);
ov4689->supplies);
gpiod_set_value_cansleep(ov4689->reset_gpio, 0);
gpiod_set_value_cansleep(ov4689->pwdn_gpio, 0);
delay_us = ov4689_cal_delay(ov4689, 8192);
clk_disable_unprepare(ov4689->xvclk);
struct ov4689 *ov4689 = to_ov4689(sd);
gpiod_set_value_cansleep(ov4689->pwdn_gpio, 1);
clk_disable_unprepare(ov4689->xvclk);
gpiod_set_value_cansleep(ov4689->reset_gpio, 1);
ov4689->supplies);
static int ov4689_map_gain(struct ov4689 *ov4689, int logical_gain, int *result)
dev_warn_ratelimited(ov4689->dev,
struct ov4689 *ov4689 =
container_of(ctrl->handler, struct ov4689, ctrl_handler);
struct regmap *regmap = ov4689->regmap;
struct device *dev = ov4689->dev;
max_expo = ov4689->cur_mode->height + ctrl->val - 4;
__v4l2_ctrl_modify_range(ov4689->exposure,
ov4689->exposure->minimum, max_expo,
ov4689->exposure->step,
ov4689->exposure->default_value);
ret = ov4689_map_gain(ov4689, ctrl->val, &sensor_gain);
ctrl->val + ov4689->cur_mode->height, &ret);
ret = ov4689_enable_test_pattern(ov4689, ctrl->val);
(ctrl->val + ov4689->cur_mode->width) /
static int ov4689_initialize_controls(struct ov4689 *ov4689)
struct i2c_client *client = v4l2_get_subdevdata(&ov4689->subdev);
handler = &ov4689->ctrl_handler;
mode = ov4689->cur_mode;
ov4689->exposure =
dev_err(ov4689->dev, "Failed to init controls(%d)\n", ret);
ov4689->subdev.ctrl_handler = handler;
static int ov4689_check_sensor_id(struct ov4689 *ov4689,
struct device *dev = ov4689->dev;
ret = cci_read(ov4689->regmap, OV4689_REG_CHIP_ID, &id, NULL);
static int ov4689_configure_regulators(struct ov4689 *ov4689)
ov4689->supplies[i].supply = ov4689_supply_names[i];
return devm_regulator_bulk_get(ov4689->dev,
ov4689->supplies);
struct ov4689 *ov4689;
ov4689 = devm_kzalloc(dev, sizeof(*ov4689), GFP_KERNEL);
if (!ov4689)
ov4689->dev = dev;
ov4689->cur_mode = &supported_modes[OV4689_MODE_2688_1520];
ov4689->xvclk = devm_v4l2_sensor_clk_get(dev, NULL);
if (IS_ERR(ov4689->xvclk))
return dev_err_probe(dev, PTR_ERR(ov4689->xvclk),
ov4689->clock_rate = clk_get_rate(ov4689->xvclk);
if (ov4689->clock_rate != OV4689_XVCLK_FREQ) {
ov4689->clock_rate, OV4689_XVCLK_FREQ);
ov4689->regmap = devm_cci_regmap_init_i2c(client, 16);
if (IS_ERR(ov4689->regmap)) {
ret = PTR_ERR(ov4689->regmap);
ov4689->reset_gpio = devm_gpiod_get_optional(dev, "reset",
if (IS_ERR(ov4689->reset_gpio)) {
return PTR_ERR(ov4689->reset_gpio);
ov4689->pwdn_gpio = devm_gpiod_get_optional(dev, "pwdn", GPIOD_OUT_LOW);
if (IS_ERR(ov4689->pwdn_gpio)) {
return PTR_ERR(ov4689->pwdn_gpio);
ret = ov4689_configure_regulators(ov4689);
sd = &ov4689->subdev;
ret = ov4689_initialize_controls(ov4689);
ret = ov4689_check_sensor_id(ov4689, client);
ov4689->pad.flags = MEDIA_PAD_FL_SOURCE;
ret = media_entity_pads_init(&sd->entity, 1, &ov4689->pad);
sd->state_lock = ov4689->ctrl_handler.lock;