Lines Matching +full:vdddo +full:- +full:supply
1 // SPDX-License-Identifier: GPL-2.0
3 * imx214.c - imx214 sensor driver
17 #include <media/media-entity.h>
18 #include <media/v4l2-ctrls.h>
19 #include <media/v4l2-fwnode.h>
20 #include <media/v4l2-subdev.h>
31 "vdddo",
439 ret = regulator_bulk_enable(IMX214_NUM_SUPPLIES, imx214->supplies); in imx214_power_on()
441 dev_err(imx214->dev, "failed to enable regulators: %d\n", ret); in imx214_power_on()
447 ret = clk_prepare_enable(imx214->xclk); in imx214_power_on()
449 regulator_bulk_disable(IMX214_NUM_SUPPLIES, imx214->supplies); in imx214_power_on()
450 dev_err(imx214->dev, "clk prepare enable failed\n"); in imx214_power_on()
454 gpiod_set_value_cansleep(imx214->enable_gpio, 1); in imx214_power_on()
466 gpiod_set_value_cansleep(imx214->enable_gpio, 0); in imx214_power_off()
468 clk_disable_unprepare(imx214->xclk); in imx214_power_off()
470 regulator_bulk_disable(IMX214_NUM_SUPPLIES, imx214->supplies); in imx214_power_off()
480 if (code->index > 0) in imx214_enum_mbus_code()
481 return -EINVAL; in imx214_enum_mbus_code()
483 code->code = IMX214_MBUS_CODE; in imx214_enum_mbus_code()
492 if (fse->code != IMX214_MBUS_CODE) in imx214_enum_frame_size()
493 return -EINVAL; in imx214_enum_frame_size()
495 if (fse->index >= ARRAY_SIZE(imx214_modes)) in imx214_enum_frame_size()
496 return -EINVAL; in imx214_enum_frame_size()
498 fse->min_width = fse->max_width = imx214_modes[fse->index].width; in imx214_enum_frame_size()
499 fse->min_height = fse->max_height = imx214_modes[fse->index].height; in imx214_enum_frame_size()
510 return regmap_write(imx214->regmap, reg->reg, reg->val); in imx214_s_register()
520 reg->size = 1; in imx214_g_register()
521 ret = regmap_read(imx214->regmap, reg->reg, &aux); in imx214_g_register()
522 reg->val = aux; in imx214_g_register()
543 return v4l2_subdev_get_try_format(&imx214->sd, sd_state, pad); in __imx214_get_pad_format()
545 return &imx214->fmt; in __imx214_get_pad_format()
557 mutex_lock(&imx214->mutex); in imx214_get_format()
558 format->format = *__imx214_get_pad_format(imx214, sd_state, in imx214_get_format()
559 format->pad, in imx214_get_format()
560 format->which); in imx214_get_format()
561 mutex_unlock(&imx214->mutex); in imx214_get_format()
573 return v4l2_subdev_get_try_crop(&imx214->sd, sd_state, pad); in __imx214_get_pad_crop()
575 return &imx214->crop; in __imx214_get_pad_crop()
590 mutex_lock(&imx214->mutex); in imx214_set_format()
592 __crop = __imx214_get_pad_crop(imx214, sd_state, format->pad, in imx214_set_format()
593 format->which); in imx214_set_format()
597 format->format.width, in imx214_set_format()
598 format->format.height); in imx214_set_format()
600 __crop->width = mode->width; in imx214_set_format()
601 __crop->height = mode->height; in imx214_set_format()
603 __format = __imx214_get_pad_format(imx214, sd_state, format->pad, in imx214_set_format()
604 format->which); in imx214_set_format()
605 __format->width = __crop->width; in imx214_set_format()
606 __format->height = __crop->height; in imx214_set_format()
607 __format->code = IMX214_MBUS_CODE; in imx214_set_format()
608 __format->field = V4L2_FIELD_NONE; in imx214_set_format()
609 __format->colorspace = V4L2_COLORSPACE_SRGB; in imx214_set_format()
610 __format->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(__format->colorspace); in imx214_set_format()
611 __format->quantization = V4L2_MAP_QUANTIZATION_DEFAULT(true, in imx214_set_format()
612 __format->colorspace, __format->ycbcr_enc); in imx214_set_format()
613 __format->xfer_func = V4L2_MAP_XFER_FUNC_DEFAULT(__format->colorspace); in imx214_set_format()
615 format->format = *__format; in imx214_set_format()
617 mutex_unlock(&imx214->mutex); in imx214_set_format()
628 if (sel->target != V4L2_SEL_TGT_CROP) in imx214_get_selection()
629 return -EINVAL; in imx214_get_selection()
631 mutex_lock(&imx214->mutex); in imx214_get_selection()
632 sel->r = *__imx214_get_pad_crop(imx214, sd_state, sel->pad, in imx214_get_selection()
633 sel->which); in imx214_get_selection()
634 mutex_unlock(&imx214->mutex); in imx214_get_selection()
654 struct imx214 *imx214 = container_of(ctrl->handler, in imx214_set_ctrl()
663 if (!pm_runtime_get_if_in_use(imx214->dev)) in imx214_set_ctrl()
666 switch (ctrl->id) { in imx214_set_ctrl()
668 vals[1] = ctrl->val; in imx214_set_ctrl()
669 vals[0] = ctrl->val >> 8; in imx214_set_ctrl()
670 ret = regmap_bulk_write(imx214->regmap, 0x202, vals, 2); in imx214_set_ctrl()
672 dev_err(imx214->dev, "Error %d\n", ret); in imx214_set_ctrl()
677 ret = -EINVAL; in imx214_set_ctrl()
680 pm_runtime_put(imx214->dev); in imx214_set_ctrl()
697 for (; table->addr != IMX214_TABLE_END ; table++) { in imx214_write_table()
698 if (table->addr == IMX214_TABLE_WAIT_MS) { in imx214_write_table()
699 usleep_range(table->val * 1000, in imx214_write_table()
700 table->val * 1000 + 500); in imx214_write_table()
710 ret = regmap_bulk_write(imx214->regmap, table->addr, vals, i); in imx214_write_table()
713 dev_err(imx214->dev, "write_table error: %d\n", ret); in imx214_write_table()
717 table += i - 1; in imx214_write_table()
728 mutex_lock(&imx214->mutex); in imx214_start_streaming()
731 dev_err(imx214->dev, "could not sent common table %d\n", ret); in imx214_start_streaming()
737 imx214->fmt.width, imx214->fmt.height); in imx214_start_streaming()
738 ret = imx214_write_table(imx214, mode->reg_table); in imx214_start_streaming()
740 dev_err(imx214->dev, "could not sent mode table %d\n", ret); in imx214_start_streaming()
743 ret = __v4l2_ctrl_handler_setup(&imx214->ctrls); in imx214_start_streaming()
745 dev_err(imx214->dev, "could not sync v4l2 controls\n"); in imx214_start_streaming()
748 ret = regmap_write(imx214->regmap, 0x100, 1); in imx214_start_streaming()
750 dev_err(imx214->dev, "could not sent start table %d\n", ret); in imx214_start_streaming()
754 mutex_unlock(&imx214->mutex); in imx214_start_streaming()
758 mutex_unlock(&imx214->mutex); in imx214_start_streaming()
766 ret = regmap_write(imx214->regmap, 0x100, 0); in imx214_stop_streaming()
768 dev_err(imx214->dev, "could not sent stop table %d\n", ret); in imx214_stop_streaming()
778 if (imx214->streaming == enable) in imx214_s_stream()
782 ret = pm_runtime_resume_and_get(imx214->dev); in imx214_s_stream()
793 pm_runtime_put(imx214->dev); in imx214_s_stream()
796 imx214->streaming = enable; in imx214_s_stream()
800 pm_runtime_put(imx214->dev); in imx214_s_stream()
807 fival->interval.numerator = 1; in imx214_g_frame_interval()
808 fival->interval.denominator = IMX214_FPS; in imx214_g_frame_interval()
819 if (fie->index != 0) in imx214_enum_frame_interval()
820 return -EINVAL; in imx214_enum_frame_interval()
824 fie->width, fie->height); in imx214_enum_frame_interval()
826 fie->code = IMX214_MBUS_CODE; in imx214_enum_frame_interval()
827 fie->width = mode->width; in imx214_enum_frame_interval()
828 fie->height = mode->height; in imx214_enum_frame_interval()
829 fie->interval.numerator = 1; in imx214_enum_frame_interval()
830 fie->interval.denominator = IMX214_FPS; in imx214_enum_frame_interval()
868 imx214->supplies[i].supply = imx214_supply_name[i]; in imx214_get_regulators()
871 imx214->supplies); in imx214_get_regulators()
886 return -EINVAL; in imx214_parse_fwnode()
900 dev_err(dev, "link-frequencies %d not supported, Please review your DT\n", in imx214_parse_fwnode()
902 ret = -EINVAL; in imx214_parse_fwnode()
918 if (imx214->streaming) in imx214_suspend()
931 if (imx214->streaming) { in imx214_resume()
941 imx214->streaming = 0; in imx214_resume()
947 struct device *dev = &client->dev; in imx214_probe()
964 return -ENOMEM; in imx214_probe()
966 imx214->dev = dev; in imx214_probe()
968 imx214->xclk = devm_clk_get(dev, NULL); in imx214_probe()
969 if (IS_ERR(imx214->xclk)) { in imx214_probe()
971 return PTR_ERR(imx214->xclk); in imx214_probe()
974 ret = clk_set_rate(imx214->xclk, IMX214_DEFAULT_CLK_FREQ); in imx214_probe()
986 imx214->enable_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_LOW); in imx214_probe()
987 if (IS_ERR(imx214->enable_gpio)) { in imx214_probe()
989 return PTR_ERR(imx214->enable_gpio); in imx214_probe()
992 imx214->regmap = devm_regmap_init_i2c(client, &sensor_regmap_config); in imx214_probe()
993 if (IS_ERR(imx214->regmap)) { in imx214_probe()
995 return PTR_ERR(imx214->regmap); in imx214_probe()
998 v4l2_i2c_subdev_init(&imx214->sd, client, &imx214_subdev_ops); in imx214_probe()
1004 imx214_power_on(imx214->dev); in imx214_probe()
1006 pm_runtime_set_active(imx214->dev); in imx214_probe()
1007 pm_runtime_enable(imx214->dev); in imx214_probe()
1008 pm_runtime_idle(imx214->dev); in imx214_probe()
1010 v4l2_ctrl_handler_init(&imx214->ctrls, 3); in imx214_probe()
1012 imx214->pixel_rate = v4l2_ctrl_new_std(&imx214->ctrls, NULL, in imx214_probe()
1016 imx214->link_freq = v4l2_ctrl_new_int_menu(&imx214->ctrls, NULL, in imx214_probe()
1018 ARRAY_SIZE(link_freq) - 1, in imx214_probe()
1020 if (imx214->link_freq) in imx214_probe()
1021 imx214->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; in imx214_probe()
1033 imx214->exposure = v4l2_ctrl_new_std(&imx214->ctrls, &imx214_ctrl_ops, in imx214_probe()
1037 imx214->unit_size = v4l2_ctrl_new_std_compound(&imx214->ctrls, in imx214_probe()
1041 ret = imx214->ctrls.error; in imx214_probe()
1043 dev_err(&client->dev, "%s control init failed (%d)\n", in imx214_probe()
1048 imx214->sd.ctrl_handler = &imx214->ctrls; in imx214_probe()
1049 mutex_init(&imx214->mutex); in imx214_probe()
1050 imx214->ctrls.lock = &imx214->mutex; in imx214_probe()
1052 imx214->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; in imx214_probe()
1053 imx214->pad.flags = MEDIA_PAD_FL_SOURCE; in imx214_probe()
1054 imx214->sd.dev = &client->dev; in imx214_probe()
1055 imx214->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; in imx214_probe()
1057 ret = media_entity_pads_init(&imx214->sd.entity, 1, &imx214->pad); in imx214_probe()
1063 imx214_entity_init_cfg(&imx214->sd, NULL); in imx214_probe()
1065 ret = v4l2_async_register_subdev_sensor(&imx214->sd); in imx214_probe()
1074 media_entity_cleanup(&imx214->sd.entity); in imx214_probe()
1076 mutex_destroy(&imx214->mutex); in imx214_probe()
1077 v4l2_ctrl_handler_free(&imx214->ctrls); in imx214_probe()
1078 pm_runtime_disable(imx214->dev); in imx214_probe()
1088 v4l2_async_unregister_subdev(&imx214->sd); in imx214_remove()
1089 media_entity_cleanup(&imx214->sd.entity); in imx214_remove()
1090 v4l2_ctrl_handler_free(&imx214->ctrls); in imx214_remove()
1092 pm_runtime_disable(&client->dev); in imx214_remove()
1093 pm_runtime_set_suspended(&client->dev); in imx214_remove()
1095 mutex_destroy(&imx214->mutex); in imx214_remove()