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, cfg, 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_get_sync(&client->dev); in ov2659_s_stream()
1192 pm_runtime_put_noidle(&client->dev); in ov2659_s_stream()
1205 ov2659->streaming = on; in ov2659_s_stream()
1209 mutex_unlock(&ov2659->lock); in ov2659_s_stream()
1215 struct i2c_client *client = v4l2_get_subdevdata(&ov2659->sd); in ov2659_set_test_pattern()
1239 container_of(ctrl->handler, struct ov2659, ctrls); in ov2659_s_ctrl()
1240 struct i2c_client *client = ov2659->client; in ov2659_s_ctrl()
1243 if (!pm_runtime_get_if_in_use(&client->dev)) in ov2659_s_ctrl()
1246 switch (ctrl->id) { in ov2659_s_ctrl()
1248 return ov2659_set_test_pattern(ov2659, ctrl->val); in ov2659_s_ctrl()
1251 pm_runtime_put(&client->dev); in ov2659_s_ctrl()
1270 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_power_off()
1272 gpiod_set_value(ov2659->pwdn_gpio, 1); in ov2659_power_off()
1274 clk_disable_unprepare(ov2659->clk); in ov2659_power_off()
1286 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_power_on()
1288 ret = clk_prepare_enable(ov2659->clk); in ov2659_power_on()
1290 dev_err(&client->dev, "%s: failed to enable clock\n", in ov2659_power_on()
1295 gpiod_set_value(ov2659->pwdn_gpio, 0); in ov2659_power_on()
1297 if (ov2659->resetb_gpio) { in ov2659_power_on()
1298 gpiod_set_value(ov2659->resetb_gpio, 1); in ov2659_power_on()
1300 gpiod_set_value(ov2659->resetb_gpio, 0); in ov2659_power_on()
1307 /* -----------------------------------------------------------------------------
1316 v4l2_subdev_get_try_format(sd, fh->pad, 0); in ov2659_open()
1318 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_open()
1362 dev_dbg(&client->dev, "%s:\n", __func__); in ov2659_detect()
1366 dev_err(&client->dev, "Sensor soft reset failed\n"); in ov2659_detect()
1367 return -ENODEV; in ov2659_detect()
1381 dev_err(&client->dev, in ov2659_detect()
1384 ret = -ENODEV; in ov2659_detect()
1386 dev_info(&client->dev, "Found OV%04X sensor\n", id); in ov2659_detect()
1401 if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node) in ov2659_get_pdata()
1402 return client->dev.platform_data; in ov2659_get_pdata()
1404 endpoint = of_graph_get_next_endpoint(client->dev.of_node, NULL); in ov2659_get_pdata()
1415 pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL); in ov2659_get_pdata()
1420 dev_err(&client->dev, in ov2659_get_pdata()
1421 "link-frequencies property not found or too many\n"); in ov2659_get_pdata()
1426 pdata->link_frequency = bus_cfg.link_frequencies[0]; in ov2659_get_pdata()
1442 dev_err(&client->dev, "platform data not specified\n"); in ov2659_probe()
1443 return -EINVAL; in ov2659_probe()
1446 ov2659 = devm_kzalloc(&client->dev, sizeof(*ov2659), GFP_KERNEL); in ov2659_probe()
1448 return -ENOMEM; in ov2659_probe()
1450 ov2659->pdata = pdata; in ov2659_probe()
1451 ov2659->client = client; in ov2659_probe()
1453 ov2659->clk = devm_clk_get(&client->dev, "xvclk"); in ov2659_probe()
1454 if (IS_ERR(ov2659->clk)) in ov2659_probe()
1455 return PTR_ERR(ov2659->clk); in ov2659_probe()
1457 ov2659->xvclk_frequency = clk_get_rate(ov2659->clk); in ov2659_probe()
1458 if (ov2659->xvclk_frequency < 6000000 || in ov2659_probe()
1459 ov2659->xvclk_frequency > 27000000) in ov2659_probe()
1460 return -EINVAL; in ov2659_probe()
1462 /* Optional gpio don't fail if not present */ in ov2659_probe()
1463 ov2659->pwdn_gpio = devm_gpiod_get_optional(&client->dev, "powerdown", in ov2659_probe()
1465 if (IS_ERR(ov2659->pwdn_gpio)) in ov2659_probe()
1466 return PTR_ERR(ov2659->pwdn_gpio); in ov2659_probe()
1468 /* Optional gpio don't fail if not present */ in ov2659_probe()
1469 ov2659->resetb_gpio = devm_gpiod_get_optional(&client->dev, "reset", in ov2659_probe()
1471 if (IS_ERR(ov2659->resetb_gpio)) in ov2659_probe()
1472 return PTR_ERR(ov2659->resetb_gpio); in ov2659_probe()
1474 v4l2_ctrl_handler_init(&ov2659->ctrls, 2); in ov2659_probe()
1475 ov2659->link_frequency = in ov2659_probe()
1476 v4l2_ctrl_new_std(&ov2659->ctrls, &ov2659_ctrl_ops, in ov2659_probe()
1478 pdata->link_frequency / 2, in ov2659_probe()
1479 pdata->link_frequency, 1, in ov2659_probe()
1480 pdata->link_frequency); in ov2659_probe()
1481 v4l2_ctrl_new_std_menu_items(&ov2659->ctrls, &ov2659_ctrl_ops, in ov2659_probe()
1483 ARRAY_SIZE(ov2659_test_pattern_menu) - 1, in ov2659_probe()
1485 ov2659->sd.ctrl_handler = &ov2659->ctrls; in ov2659_probe()
1487 if (ov2659->ctrls.error) { in ov2659_probe()
1488 dev_err(&client->dev, "%s: control initialization error %d\n", in ov2659_probe()
1489 __func__, ov2659->ctrls.error); in ov2659_probe()
1490 return ov2659->ctrls.error; in ov2659_probe()
1493 sd = &ov2659->sd; in ov2659_probe()
1494 client->flags |= I2C_CLIENT_SCCB; in ov2659_probe()
1498 sd->internal_ops = &ov2659_subdev_internal_ops; in ov2659_probe()
1499 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | in ov2659_probe()
1504 ov2659->pad.flags = MEDIA_PAD_FL_SOURCE; in ov2659_probe()
1505 sd->entity.function = MEDIA_ENT_F_CAM_SENSOR; in ov2659_probe()
1506 ret = media_entity_pads_init(&sd->entity, 1, &ov2659->pad); in ov2659_probe()
1508 v4l2_ctrl_handler_free(&ov2659->ctrls); in ov2659_probe()
1513 mutex_init(&ov2659->lock); in ov2659_probe()
1515 ov2659_get_default_format(&ov2659->format); in ov2659_probe()
1516 ov2659->frame_size = &ov2659_framesizes[2]; in ov2659_probe()
1517 ov2659->format_ctrl_regs = ov2659_formats[0].format_ctrl_regs; in ov2659_probe()
1519 ret = ov2659_power_on(&client->dev); in ov2659_probe()
1530 ret = v4l2_async_register_subdev(&ov2659->sd); in ov2659_probe()
1534 dev_info(&client->dev, "%s sensor driver registered !!\n", sd->name); in ov2659_probe()
1536 pm_runtime_set_active(&client->dev); in ov2659_probe()
1537 pm_runtime_enable(&client->dev); in ov2659_probe()
1538 pm_runtime_idle(&client->dev); in ov2659_probe()
1543 v4l2_ctrl_handler_free(&ov2659->ctrls); in ov2659_probe()
1544 ov2659_power_off(&client->dev); in ov2659_probe()
1545 media_entity_cleanup(&sd->entity); in ov2659_probe()
1546 mutex_destroy(&ov2659->lock); in ov2659_probe()
1555 v4l2_ctrl_handler_free(&ov2659->ctrls); in ov2659_remove()
1557 media_entity_cleanup(&sd->entity); in ov2659_remove()
1558 mutex_destroy(&ov2659->lock); in ov2659_remove()
1560 pm_runtime_disable(&client->dev); in ov2659_remove()
1561 if (!pm_runtime_status_suspended(&client->dev)) in ov2659_remove()
1562 ov2659_power_off(&client->dev); in ov2659_remove()
1563 pm_runtime_set_suspended(&client->dev); in ov2659_remove()