Lines Matching +full:gpio +full:- +full:ctrl2
1 // SPDX-License-Identifier: GPL-2.0-only
13 #include <linux/gpio/consumer.h>
20 #include <media/v4l2-ctrls.h>
21 #include <media/v4l2-event.h>
22 #include <media/v4l2-fwnode.h>
23 #include <media/v4l2-image-sizes.h>
24 #include <media/v4l2-subdev.h>
182 u8 ctrl2; member
833 msg.addr = client->addr; in ov2659_write()
834 msg.flags = client->flags; in ov2659_write()
838 ret = i2c_transfer(client->adapter, &msg, 1); in ov2659_write()
842 dev_dbg(&client->dev, in ov2659_write()
858 msg[0].addr = client->addr; in ov2659_read()
859 msg[0].flags = client->flags; in ov2659_read()
863 msg[1].addr = client->addr; in ov2659_read()
864 msg[1].flags = client->flags | I2C_M_RD; in ov2659_read()
868 ret = i2c_transfer(client->adapter, msg, 2); in ov2659_read()
874 dev_dbg(&client->dev, in ov2659_read()
893 const struct ov2659_platform_data *pdata = ov2659->pdata; in ov2659_pll_calc_params()
895 struct i2c_client *client = ov2659->client; in ov2659_pll_calc_params()
896 unsigned int desired = pdata->link_frequency; in ov2659_pll_calc_params()
898 u32 bestdelta = -1; in ov2659_pll_calc_params()
907 actual = ov2659->xvclk_frequency; in ov2659_pll_calc_params()
911 delta = actual - desired; in ov2659_pll_calc_params()
914 if ((delta < bestdelta) || (bestdelta == -1)) { in ov2659_pll_calc_params()
924 ov2659->pll.ctrl1 = ctrl1_reg; in ov2659_pll_calc_params()
925 ov2659->pll.ctrl2 = ctrl2_reg; in ov2659_pll_calc_params()
926 ov2659->pll.ctrl3 = ctrl3_reg; in ov2659_pll_calc_params()
928 dev_dbg(&client->dev, in ov2659_pll_calc_params()
935 struct i2c_client *client = ov2659->client; in ov2659_set_pixel_clock()
937 {REG_SC_PLL_CTRL1, ov2659->pll.ctrl1}, in ov2659_set_pixel_clock()
938 {REG_SC_PLL_CTRL2, ov2659->pll.ctrl2}, in ov2659_set_pixel_clock()
939 {REG_SC_PLL_CTRL3, ov2659->pll.ctrl3}, in ov2659_set_pixel_clock()
943 dev_dbg(&client->dev, "%s\n", __func__); in ov2659_set_pixel_clock()
950 format->width = ov2659_framesizes[2].width; in ov2659_get_default_format()
951 format->height = ov2659_framesizes[2].height; in ov2659_get_default_format()
952 format->colorspace = V4L2_COLORSPACE_SRGB; in ov2659_get_default_format()
953 format->code = ov2659_formats[0].code; in ov2659_get_default_format()
954 format->field = V4L2_FIELD_NONE; in ov2659_get_default_format()
959 struct i2c_client *client = ov2659->client; in ov2659_set_streaming()
964 dev_dbg(&client->dev, "%s: on: %d\n", __func__, on); in ov2659_set_streaming()
968 dev_err(&client->dev, "ov2659 soft standby failed\n"); in ov2659_set_streaming()
988 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_enum_mbus_code()
990 if (code->index >= ARRAY_SIZE(ov2659_formats)) in ov2659_enum_mbus_code()
991 return -EINVAL; in ov2659_enum_mbus_code()
993 code->code = ov2659_formats[code->index].code; in ov2659_enum_mbus_code()
1005 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_enum_frame_sizes()
1007 if (fse->index >= ARRAY_SIZE(ov2659_framesizes)) in ov2659_enum_frame_sizes()
1008 return -EINVAL; in ov2659_enum_frame_sizes()
1010 while (--i) in ov2659_enum_frame_sizes()
1011 if (fse->code == ov2659_formats[i].code) in ov2659_enum_frame_sizes()
1014 fse->code = ov2659_formats[i].code; in ov2659_enum_frame_sizes()
1016 fse->min_width = ov2659_framesizes[fse->index].width; in ov2659_enum_frame_sizes()
1017 fse->max_width = fse->min_width; in ov2659_enum_frame_sizes()
1018 fse->max_height = ov2659_framesizes[fse->index].height; in ov2659_enum_frame_sizes()
1019 fse->min_height = fse->max_height; in ov2659_enum_frame_sizes()
1031 dev_dbg(&client->dev, "ov2659_get_fmt\n"); in ov2659_get_fmt()
1033 if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { in ov2659_get_fmt()
1038 mutex_lock(&ov2659->lock); in ov2659_get_fmt()
1039 fmt->format = *mf; in ov2659_get_fmt()
1040 mutex_unlock(&ov2659->lock); in ov2659_get_fmt()
1043 return -EINVAL; in ov2659_get_fmt()
1047 mutex_lock(&ov2659->lock); in ov2659_get_fmt()
1048 fmt->format = ov2659->format; in ov2659_get_fmt()
1049 mutex_unlock(&ov2659->lock); in ov2659_get_fmt()
1051 dev_dbg(&client->dev, "ov2659_get_fmt: %x %dx%d\n", in ov2659_get_fmt()
1052 ov2659->format.code, ov2659->format.width, in ov2659_get_fmt()
1053 ov2659->format.height); in ov2659_get_fmt()
1066 while (i--) { in __ov2659_try_frame_size()
1067 int err = abs(fsize->width - mf->width) in __ov2659_try_frame_size()
1068 + abs(fsize->height - mf->height); in __ov2659_try_frame_size()
1069 if ((err < min_err) && (fsize->regs[0].addr)) { in __ov2659_try_frame_size()
1079 mf->width = match->width; in __ov2659_try_frame_size()
1080 mf->height = match->height; in __ov2659_try_frame_size()
1092 struct v4l2_mbus_framefmt *mf = &fmt->format; in ov2659_set_fmt()
1097 dev_dbg(&client->dev, "ov2659_set_fmt\n"); in ov2659_set_fmt()
1101 while (--index >= 0) in ov2659_set_fmt()
1102 if (ov2659_formats[index].code == mf->code) in ov2659_set_fmt()
1107 mf->code = ov2659_formats[index].code; in ov2659_set_fmt()
1110 mf->colorspace = V4L2_COLORSPACE_SRGB; in ov2659_set_fmt()
1111 mf->field = V4L2_FIELD_NONE; in ov2659_set_fmt()
1113 mutex_lock(&ov2659->lock); in ov2659_set_fmt()
1115 if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { in ov2659_set_fmt()
1117 mf = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad); in ov2659_set_fmt()
1118 *mf = fmt->format; in ov2659_set_fmt()
1123 if (ov2659->streaming) { in ov2659_set_fmt()
1124 mutex_unlock(&ov2659->lock); in ov2659_set_fmt()
1125 return -EBUSY; in ov2659_set_fmt()
1128 ov2659->frame_size = size; in ov2659_set_fmt()
1129 ov2659->format = fmt->format; in ov2659_set_fmt()
1130 ov2659->format_ctrl_regs = in ov2659_set_fmt()
1133 if (ov2659->format.code != MEDIA_BUS_FMT_SBGGR8_1X8) in ov2659_set_fmt()
1134 val = ov2659->pdata->link_frequency / 2; in ov2659_set_fmt()
1136 val = ov2659->pdata->link_frequency; in ov2659_set_fmt()
1138 ret = v4l2_ctrl_s_ctrl_int64(ov2659->link_frequency, val); in ov2659_set_fmt()
1140 dev_warn(&client->dev, in ov2659_set_fmt()
1145 mutex_unlock(&ov2659->lock); in ov2659_set_fmt()
1151 struct i2c_client *client = ov2659->client; in ov2659_set_frame_size()
1153 dev_dbg(&client->dev, "%s\n", __func__); in ov2659_set_frame_size()
1155 return ov2659_write_array(ov2659->client, ov2659->frame_size->regs); in ov2659_set_frame_size()
1160 struct i2c_client *client = ov2659->client; in ov2659_set_format()
1162 dev_dbg(&client->dev, "%s\n", __func__); in ov2659_set_format()
1164 return ov2659_write_array(ov2659->client, ov2659->format_ctrl_regs); in ov2659_set_format()
1173 dev_dbg(&client->dev, "%s: on: %d\n", __func__, on); in ov2659_s_stream()
1175 mutex_lock(&ov2659->lock); in ov2659_s_stream()
1179 if (ov2659->streaming == on) in ov2659_s_stream()
1185 ov2659->streaming = on; in ov2659_s_stream()
1186 pm_runtime_put(&client->dev); in ov2659_s_stream()
1190 ret = pm_runtime_resume_and_get(&client->dev); in ov2659_s_stream()
1203 ov2659->streaming = on; in ov2659_s_stream()
1207 mutex_unlock(&ov2659->lock); in ov2659_s_stream()
1213 struct i2c_client *client = v4l2_get_subdevdata(&ov2659->sd); in ov2659_set_test_pattern()
1237 container_of(ctrl->handler, struct ov2659, ctrls); in ov2659_s_ctrl()
1238 struct i2c_client *client = ov2659->client; in ov2659_s_ctrl()
1241 if (!pm_runtime_get_if_in_use(&client->dev)) in ov2659_s_ctrl()
1244 switch (ctrl->id) { in ov2659_s_ctrl()
1246 return ov2659_set_test_pattern(ov2659, ctrl->val); in ov2659_s_ctrl()
1249 pm_runtime_put(&client->dev); in ov2659_s_ctrl()
1268 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_power_off()
1270 gpiod_set_value(ov2659->pwdn_gpio, 1); in ov2659_power_off()
1272 clk_disable_unprepare(ov2659->clk); in ov2659_power_off()
1284 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_power_on()
1286 ret = clk_prepare_enable(ov2659->clk); in ov2659_power_on()
1288 dev_err(&client->dev, "%s: failed to enable clock\n", in ov2659_power_on()
1293 gpiod_set_value(ov2659->pwdn_gpio, 0); in ov2659_power_on()
1295 if (ov2659->resetb_gpio) { in ov2659_power_on()
1296 gpiod_set_value(ov2659->resetb_gpio, 1); in ov2659_power_on()
1298 gpiod_set_value(ov2659->resetb_gpio, 0); in ov2659_power_on()
1305 /* -----------------------------------------------------------------------------
1314 v4l2_subdev_get_try_format(sd, fh->state, 0); in ov2659_open()
1316 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_open()
1360 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_detect()
1364 dev_err(&client->dev, "Sensor soft reset failed\n"); in ov2659_detect()
1365 return -ENODEV; in ov2659_detect()
1379 dev_err(&client->dev, in ov2659_detect()
1381 ret = -ENODEV; in ov2659_detect()
1383 dev_info(&client->dev, "Found OV%04X sensor\n", id); in ov2659_detect()
1398 if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node) in ov2659_get_pdata()
1399 return client->dev.platform_data; in ov2659_get_pdata()
1401 endpoint = of_graph_get_next_endpoint(client->dev.of_node, NULL); in ov2659_get_pdata()
1412 pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL); in ov2659_get_pdata()
1417 dev_err(&client->dev, in ov2659_get_pdata()
1418 "link-frequencies property not found or too many\n"); in ov2659_get_pdata()
1423 pdata->link_frequency = bus_cfg.link_frequencies[0]; in ov2659_get_pdata()
1439 dev_err(&client->dev, "platform data not specified\n"); in ov2659_probe()
1440 return -EINVAL; in ov2659_probe()
1443 ov2659 = devm_kzalloc(&client->dev, sizeof(*ov2659), GFP_KERNEL); in ov2659_probe()
1445 return -ENOMEM; in ov2659_probe()
1447 ov2659->pdata = pdata; in ov2659_probe()
1448 ov2659->client = client; in ov2659_probe()
1450 ov2659->clk = devm_clk_get(&client->dev, "xvclk"); in ov2659_probe()
1451 if (IS_ERR(ov2659->clk)) in ov2659_probe()
1452 return PTR_ERR(ov2659->clk); in ov2659_probe()
1454 ov2659->xvclk_frequency = clk_get_rate(ov2659->clk); in ov2659_probe()
1455 if (ov2659->xvclk_frequency < 6000000 || in ov2659_probe()
1456 ov2659->xvclk_frequency > 27000000) in ov2659_probe()
1457 return -EINVAL; in ov2659_probe()
1459 /* Optional gpio don't fail if not present */ in ov2659_probe()
1460 ov2659->pwdn_gpio = devm_gpiod_get_optional(&client->dev, "powerdown", in ov2659_probe()
1462 if (IS_ERR(ov2659->pwdn_gpio)) in ov2659_probe()
1463 return PTR_ERR(ov2659->pwdn_gpio); in ov2659_probe()
1465 /* Optional gpio don't fail if not present */ in ov2659_probe()
1466 ov2659->resetb_gpio = devm_gpiod_get_optional(&client->dev, "reset", in ov2659_probe()
1468 if (IS_ERR(ov2659->resetb_gpio)) in ov2659_probe()
1469 return PTR_ERR(ov2659->resetb_gpio); in ov2659_probe()
1471 v4l2_ctrl_handler_init(&ov2659->ctrls, 2); in ov2659_probe()
1472 ov2659->link_frequency = in ov2659_probe()
1473 v4l2_ctrl_new_std(&ov2659->ctrls, &ov2659_ctrl_ops, in ov2659_probe()
1475 pdata->link_frequency / 2, in ov2659_probe()
1476 pdata->link_frequency, 1, in ov2659_probe()
1477 pdata->link_frequency); in ov2659_probe()
1478 v4l2_ctrl_new_std_menu_items(&ov2659->ctrls, &ov2659_ctrl_ops, in ov2659_probe()
1480 ARRAY_SIZE(ov2659_test_pattern_menu) - 1, in ov2659_probe()
1482 ov2659->sd.ctrl_handler = &ov2659->ctrls; in ov2659_probe()
1484 if (ov2659->ctrls.error) { in ov2659_probe()
1485 dev_err(&client->dev, "%s: control initialization error %d\n", in ov2659_probe()
1486 __func__, ov2659->ctrls.error); in ov2659_probe()
1487 return ov2659->ctrls.error; in ov2659_probe()
1490 sd = &ov2659->sd; in ov2659_probe()
1491 client->flags |= I2C_CLIENT_SCCB; in ov2659_probe()
1495 sd->internal_ops = &ov2659_subdev_internal_ops; in ov2659_probe()
1496 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | in ov2659_probe()
1501 ov2659->pad.flags = MEDIA_PAD_FL_SOURCE; in ov2659_probe()
1502 sd->entity.function = MEDIA_ENT_F_CAM_SENSOR; in ov2659_probe()
1503 ret = media_entity_pads_init(&sd->entity, 1, &ov2659->pad); in ov2659_probe()
1505 v4l2_ctrl_handler_free(&ov2659->ctrls); in ov2659_probe()
1510 mutex_init(&ov2659->lock); in ov2659_probe()
1512 ov2659_get_default_format(&ov2659->format); in ov2659_probe()
1513 ov2659->frame_size = &ov2659_framesizes[2]; in ov2659_probe()
1514 ov2659->format_ctrl_regs = ov2659_formats[0].format_ctrl_regs; in ov2659_probe()
1516 ret = ov2659_power_on(&client->dev); in ov2659_probe()
1527 ret = v4l2_async_register_subdev(&ov2659->sd); in ov2659_probe()
1531 dev_info(&client->dev, "%s sensor driver registered !!\n", sd->name); in ov2659_probe()
1533 pm_runtime_set_active(&client->dev); in ov2659_probe()
1534 pm_runtime_enable(&client->dev); in ov2659_probe()
1535 pm_runtime_idle(&client->dev); in ov2659_probe()
1540 v4l2_ctrl_handler_free(&ov2659->ctrls); in ov2659_probe()
1541 ov2659_power_off(&client->dev); in ov2659_probe()
1542 media_entity_cleanup(&sd->entity); in ov2659_probe()
1543 mutex_destroy(&ov2659->lock); in ov2659_probe()
1552 v4l2_ctrl_handler_free(&ov2659->ctrls); in ov2659_remove()
1554 media_entity_cleanup(&sd->entity); in ov2659_remove()
1555 mutex_destroy(&ov2659->lock); in ov2659_remove()
1557 pm_runtime_disable(&client->dev); in ov2659_remove()
1558 if (!pm_runtime_status_suspended(&client->dev)) in ov2659_remove()
1559 ov2659_power_off(&client->dev); in ov2659_remove()
1560 pm_runtime_set_suspended(&client->dev); in ov2659_remove()