Lines Matching +full:four +full:- +full:lane
1 // SPDX-License-Identifier: GPL-2.0
26 #include <media/v4l2-cci.h>
27 #include <media/v4l2-ctrls.h>
28 #include <media/v4l2-device.h>
29 #include <media/v4l2-fwnode.h>
30 #include <media/v4l2-mediabus.h>
78 /* HBLANK control - read only */
157 /* V-timing */
164 /* To Access Addresses 3000-5fff, send the following commands */
206 /* 2-Lane CSI Mode */
220 /* 4-Lane CSI Mode */
267 * - no flip
268 * - h flip
269 * - v flip
270 * - h&v flips
285 * Initialisation delay between XCLR low->high and the moment when the sensor
298 * This start-up time can be optimized a bit more, if we start the writes
305 * case of DT for regulator-fixed one should define the startup-delay-us
360 /* Two or Four lanes */
381 i = (i & ~3) | (imx219->vflip->val ? 2 : 0) | in imx219_get_format_code()
382 (imx219->hflip->val ? 1 : 0); in imx219_get_format_code()
387 /* -----------------------------------------------------------------------------
394 container_of(ctrl->handler, struct imx219, ctrl_handler); in imx219_set_ctrl()
395 struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd); in imx219_set_ctrl()
400 state = v4l2_subdev_get_locked_active_state(&imx219->sd); in imx219_set_ctrl()
403 if (ctrl->id == V4L2_CID_VBLANK) { in imx219_set_ctrl()
407 exposure_max = format->height + ctrl->val - 4; in imx219_set_ctrl()
410 __v4l2_ctrl_modify_range(imx219->exposure, in imx219_set_ctrl()
411 imx219->exposure->minimum, in imx219_set_ctrl()
412 exposure_max, imx219->exposure->step, in imx219_set_ctrl()
420 if (pm_runtime_get_if_in_use(&client->dev) == 0) in imx219_set_ctrl()
423 switch (ctrl->id) { in imx219_set_ctrl()
425 cci_write(imx219->regmap, IMX219_REG_ANALOG_GAIN, in imx219_set_ctrl()
426 ctrl->val, &ret); in imx219_set_ctrl()
429 cci_write(imx219->regmap, IMX219_REG_EXPOSURE, in imx219_set_ctrl()
430 ctrl->val, &ret); in imx219_set_ctrl()
433 cci_write(imx219->regmap, IMX219_REG_DIGITAL_GAIN, in imx219_set_ctrl()
434 ctrl->val, &ret); in imx219_set_ctrl()
437 cci_write(imx219->regmap, IMX219_REG_TEST_PATTERN, in imx219_set_ctrl()
438 imx219_test_pattern_val[ctrl->val], &ret); in imx219_set_ctrl()
442 cci_write(imx219->regmap, IMX219_REG_ORIENTATION, in imx219_set_ctrl()
443 imx219->hflip->val | imx219->vflip->val << 1, &ret); in imx219_set_ctrl()
446 cci_write(imx219->regmap, IMX219_REG_VTS, in imx219_set_ctrl()
447 format->height + ctrl->val, &ret); in imx219_set_ctrl()
450 cci_write(imx219->regmap, IMX219_REG_TESTP_RED, in imx219_set_ctrl()
451 ctrl->val, &ret); in imx219_set_ctrl()
454 cci_write(imx219->regmap, IMX219_REG_TESTP_GREENR, in imx219_set_ctrl()
455 ctrl->val, &ret); in imx219_set_ctrl()
458 cci_write(imx219->regmap, IMX219_REG_TESTP_BLUE, in imx219_set_ctrl()
459 ctrl->val, &ret); in imx219_set_ctrl()
462 cci_write(imx219->regmap, IMX219_REG_TESTP_GREENB, in imx219_set_ctrl()
463 ctrl->val, &ret); in imx219_set_ctrl()
466 dev_info(&client->dev, in imx219_set_ctrl()
468 ctrl->id, ctrl->val); in imx219_set_ctrl()
469 ret = -EINVAL; in imx219_set_ctrl()
473 pm_runtime_put(&client->dev); in imx219_set_ctrl()
484 return (imx219->lanes == 2) ? IMX219_PIXEL_RATE : IMX219_PIXEL_RATE_4LANE; in imx219_get_pixel_rate()
490 struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd); in imx219_init_controls()
497 ctrl_hdlr = &imx219->ctrl_handler; in imx219_init_controls()
503 imx219->pixel_rate = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops, in imx219_init_controls()
509 imx219->link_freq = in imx219_init_controls()
512 ARRAY_SIZE(imx219_link_freq_menu) - 1, 0, in imx219_init_controls()
513 (imx219->lanes == 2) ? imx219_link_freq_menu : in imx219_init_controls()
515 if (imx219->link_freq) in imx219_init_controls()
516 imx219->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; in imx219_init_controls()
519 imx219->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops, in imx219_init_controls()
521 IMX219_VTS_MAX - mode->height, 1, in imx219_init_controls()
522 mode->vts_def - mode->height); in imx219_init_controls()
523 hblank = IMX219_PPL_DEFAULT - mode->width; in imx219_init_controls()
524 imx219->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops, in imx219_init_controls()
527 if (imx219->hblank) in imx219_init_controls()
528 imx219->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; in imx219_init_controls()
529 exposure_max = mode->vts_def - 4; in imx219_init_controls()
532 imx219->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops, in imx219_init_controls()
546 imx219->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops, in imx219_init_controls()
548 if (imx219->hflip) in imx219_init_controls()
549 imx219->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; in imx219_init_controls()
551 imx219->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops, in imx219_init_controls()
553 if (imx219->vflip) in imx219_init_controls()
554 imx219->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; in imx219_init_controls()
558 ARRAY_SIZE(imx219_test_pattern_menu) - 1, in imx219_init_controls()
576 if (ctrl_hdlr->error) { in imx219_init_controls()
577 ret = ctrl_hdlr->error; in imx219_init_controls()
578 dev_err_probe(&client->dev, ret, "Control init failed\n"); in imx219_init_controls()
582 ret = v4l2_fwnode_device_parse(&client->dev, &props); in imx219_init_controls()
591 imx219->sd.ctrl_handler = ctrl_hdlr; in imx219_init_controls()
603 v4l2_ctrl_handler_free(imx219->sd.ctrl_handler); in imx219_free_controls()
606 /* -----------------------------------------------------------------------------
622 switch (format->code) { in imx219_set_framefmt()
639 cci_write(imx219->regmap, IMX219_REG_X_ADD_STA_A, in imx219_set_framefmt()
640 crop->left - IMX219_PIXEL_ARRAY_LEFT, &ret); in imx219_set_framefmt()
641 cci_write(imx219->regmap, IMX219_REG_X_ADD_END_A, in imx219_set_framefmt()
642 crop->left - IMX219_PIXEL_ARRAY_LEFT + crop->width - 1, &ret); in imx219_set_framefmt()
643 cci_write(imx219->regmap, IMX219_REG_Y_ADD_STA_A, in imx219_set_framefmt()
644 crop->top - IMX219_PIXEL_ARRAY_TOP, &ret); in imx219_set_framefmt()
645 cci_write(imx219->regmap, IMX219_REG_Y_ADD_END_A, in imx219_set_framefmt()
646 crop->top - IMX219_PIXEL_ARRAY_TOP + crop->height - 1, &ret); in imx219_set_framefmt()
648 switch (crop->width / format->width) { in imx219_set_framefmt()
658 switch (crop->height / format->height) { in imx219_set_framefmt()
668 cci_write(imx219->regmap, IMX219_REG_BINNING_MODE_H, bin_h, &ret); in imx219_set_framefmt()
669 cci_write(imx219->regmap, IMX219_REG_BINNING_MODE_V, bin_v, &ret); in imx219_set_framefmt()
671 cci_write(imx219->regmap, IMX219_REG_X_OUTPUT_SIZE, in imx219_set_framefmt()
672 format->width, &ret); in imx219_set_framefmt()
673 cci_write(imx219->regmap, IMX219_REG_Y_OUTPUT_SIZE, in imx219_set_framefmt()
674 format->height, &ret); in imx219_set_framefmt()
676 cci_write(imx219->regmap, IMX219_REG_TP_WINDOW_WIDTH, in imx219_set_framefmt()
677 format->width, &ret); in imx219_set_framefmt()
678 cci_write(imx219->regmap, IMX219_REG_TP_WINDOW_HEIGHT, in imx219_set_framefmt()
679 format->height, &ret); in imx219_set_framefmt()
681 cci_write(imx219->regmap, IMX219_REG_CSI_DATA_FORMAT_A, in imx219_set_framefmt()
683 cci_write(imx219->regmap, IMX219_REG_OPPXCK_DIV, bpp, &ret); in imx219_set_framefmt()
691 return cci_multi_reg_write(imx219->regmap, in imx219_configure_lanes()
692 imx219->lanes == 2 ? imx219_2lane_regs : imx219_4lane_regs, in imx219_configure_lanes()
693 imx219->lanes == 2 ? ARRAY_SIZE(imx219_2lane_regs) : in imx219_configure_lanes()
700 struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd); in imx219_start_streaming()
703 ret = pm_runtime_resume_and_get(&client->dev); in imx219_start_streaming()
708 ret = cci_multi_reg_write(imx219->regmap, imx219_common_regs, in imx219_start_streaming()
711 dev_err(&client->dev, "%s failed to send mfg header\n", __func__); in imx219_start_streaming()
715 /* Configure two or four Lane mode */ in imx219_start_streaming()
718 dev_err(&client->dev, "%s failed to configure lanes\n", __func__); in imx219_start_streaming()
725 dev_err(&client->dev, "%s failed to set frame format: %d\n", in imx219_start_streaming()
731 ret = __v4l2_ctrl_handler_setup(imx219->sd.ctrl_handler); in imx219_start_streaming()
736 ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT, in imx219_start_streaming()
742 __v4l2_ctrl_grab(imx219->vflip, true); in imx219_start_streaming()
743 __v4l2_ctrl_grab(imx219->hflip, true); in imx219_start_streaming()
748 pm_runtime_put(&client->dev); in imx219_start_streaming()
754 struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd); in imx219_stop_streaming()
758 ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT, in imx219_stop_streaming()
761 dev_err(&client->dev, "%s failed to set stream\n", __func__); in imx219_stop_streaming()
763 __v4l2_ctrl_grab(imx219->vflip, false); in imx219_stop_streaming()
764 __v4l2_ctrl_grab(imx219->hflip, false); in imx219_stop_streaming()
766 pm_runtime_put(&client->dev); in imx219_stop_streaming()
791 fmt->code = imx219_get_format_code(imx219, code); in imx219_update_pad_format()
792 fmt->width = mode->width; in imx219_update_pad_format()
793 fmt->height = mode->height; in imx219_update_pad_format()
794 fmt->field = V4L2_FIELD_NONE; in imx219_update_pad_format()
795 fmt->colorspace = V4L2_COLORSPACE_RAW; in imx219_update_pad_format()
796 fmt->ycbcr_enc = V4L2_YCBCR_ENC_601; in imx219_update_pad_format()
797 fmt->quantization = V4L2_QUANTIZATION_FULL_RANGE; in imx219_update_pad_format()
798 fmt->xfer_func = V4L2_XFER_FUNC_NONE; in imx219_update_pad_format()
807 if (code->index >= (ARRAY_SIZE(imx219_mbus_formats) / 4)) in imx219_enum_mbus_code()
808 return -EINVAL; in imx219_enum_mbus_code()
810 code->code = imx219_get_format_code(imx219, imx219_mbus_formats[code->index * 4]); in imx219_enum_mbus_code()
822 if (fse->index >= ARRAY_SIZE(supported_modes)) in imx219_enum_frame_size()
823 return -EINVAL; in imx219_enum_frame_size()
825 code = imx219_get_format_code(imx219, fse->code); in imx219_enum_frame_size()
826 if (fse->code != code) in imx219_enum_frame_size()
827 return -EINVAL; in imx219_enum_frame_size()
829 fse->min_width = supported_modes[fse->index].width; in imx219_enum_frame_size()
830 fse->max_width = fse->min_width; in imx219_enum_frame_size()
831 fse->min_height = supported_modes[fse->index].height; in imx219_enum_frame_size()
832 fse->max_height = fse->min_height; in imx219_enum_frame_size()
850 fmt->format.width, fmt->format.height); in imx219_set_pad_format()
852 imx219_update_pad_format(imx219, mode, &fmt->format, fmt->format.code); in imx219_set_pad_format()
855 *format = fmt->format; in imx219_set_pad_format()
861 bin_h = min(IMX219_PIXEL_ARRAY_WIDTH / format->width, 2U); in imx219_set_pad_format()
862 bin_v = min(IMX219_PIXEL_ARRAY_HEIGHT / format->height, 2U); in imx219_set_pad_format()
865 crop->width = format->width * bin_h; in imx219_set_pad_format()
866 crop->height = format->height * bin_v; in imx219_set_pad_format()
867 crop->left = (IMX219_NATIVE_WIDTH - crop->width) / 2; in imx219_set_pad_format()
868 crop->top = (IMX219_NATIVE_HEIGHT - crop->height) / 2; in imx219_set_pad_format()
870 if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) { in imx219_set_pad_format()
876 __v4l2_ctrl_modify_range(imx219->vblank, IMX219_VBLANK_MIN, in imx219_set_pad_format()
877 IMX219_VTS_MAX - mode->height, 1, in imx219_set_pad_format()
878 mode->vts_def - mode->height); in imx219_set_pad_format()
879 __v4l2_ctrl_s_ctrl(imx219->vblank, in imx219_set_pad_format()
880 mode->vts_def - mode->height); in imx219_set_pad_format()
882 exposure_max = mode->vts_def - 4; in imx219_set_pad_format()
885 __v4l2_ctrl_modify_range(imx219->exposure, in imx219_set_pad_format()
886 imx219->exposure->minimum, in imx219_set_pad_format()
887 exposure_max, imx219->exposure->step, in imx219_set_pad_format()
891 * depends on mode->width only, and is not changeble in any in imx219_set_pad_format()
894 hblank = IMX219_PPL_DEFAULT - mode->width; in imx219_set_pad_format()
895 __v4l2_ctrl_modify_range(imx219->hblank, hblank, hblank, 1, in imx219_set_pad_format()
906 switch (sel->target) { in imx219_get_selection()
908 sel->r = *v4l2_subdev_state_get_crop(state, 0); in imx219_get_selection()
913 sel->r.top = 0; in imx219_get_selection()
914 sel->r.left = 0; in imx219_get_selection()
915 sel->r.width = IMX219_NATIVE_WIDTH; in imx219_get_selection()
916 sel->r.height = IMX219_NATIVE_HEIGHT; in imx219_get_selection()
922 sel->r.top = IMX219_PIXEL_ARRAY_TOP; in imx219_get_selection()
923 sel->r.left = IMX219_PIXEL_ARRAY_LEFT; in imx219_get_selection()
924 sel->r.width = IMX219_PIXEL_ARRAY_WIDTH; in imx219_get_selection()
925 sel->r.height = IMX219_PIXEL_ARRAY_HEIGHT; in imx219_get_selection()
930 return -EINVAL; in imx219_get_selection()
972 /* -----------------------------------------------------------------------------
983 imx219->supplies); in imx219_power_on()
990 ret = clk_prepare_enable(imx219->xclk); in imx219_power_on()
997 gpiod_set_value_cansleep(imx219->reset_gpio, 1); in imx219_power_on()
1004 regulator_bulk_disable(IMX219_NUM_SUPPLIES, imx219->supplies); in imx219_power_on()
1014 gpiod_set_value_cansleep(imx219->reset_gpio, 0); in imx219_power_off()
1015 regulator_bulk_disable(IMX219_NUM_SUPPLIES, imx219->supplies); in imx219_power_off()
1016 clk_disable_unprepare(imx219->xclk); in imx219_power_off()
1021 /* -----------------------------------------------------------------------------
1027 struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd); in imx219_get_regulators()
1031 imx219->supplies[i].supply = imx219_supply_name[i]; in imx219_get_regulators()
1033 return devm_regulator_bulk_get(&client->dev, in imx219_get_regulators()
1035 imx219->supplies); in imx219_get_regulators()
1041 struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd); in imx219_identify_module()
1045 ret = cci_read(imx219->regmap, IMX219_REG_CHIP_ID, &val, NULL); in imx219_identify_module()
1047 return dev_err_probe(&client->dev, ret, in imx219_identify_module()
1052 return dev_err_probe(&client->dev, -EIO, in imx219_identify_module()
1066 int ret = -EINVAL; in imx219_check_hwcfg()
1070 return dev_err_probe(dev, -EINVAL, "endpoint node not found\n"); in imx219_check_hwcfg()
1073 dev_err_probe(dev, -EINVAL, "could not parse endpoint\n"); in imx219_check_hwcfg()
1080 dev_err_probe(dev, -EINVAL, in imx219_check_hwcfg()
1084 imx219->lanes = ep_cfg.bus.mipi_csi2.num_data_lanes; in imx219_check_hwcfg()
1087 switch (imx219->lanes) { in imx219_check_hwcfg()
1115 ret = -EINVAL; in imx219_check_hwcfg()
1116 dev_err_probe(dev, -EINVAL, in imx219_check_hwcfg()
1130 struct device *dev = &client->dev; in imx219_probe()
1134 imx219 = devm_kzalloc(&client->dev, sizeof(*imx219), GFP_KERNEL); in imx219_probe()
1136 return -ENOMEM; in imx219_probe()
1138 v4l2_i2c_subdev_init(&imx219->sd, client, &imx219_subdev_ops); in imx219_probe()
1139 imx219->sd.internal_ops = &imx219_internal_ops; in imx219_probe()
1143 return -EINVAL; in imx219_probe()
1145 imx219->regmap = devm_cci_regmap_init_i2c(client, 16); in imx219_probe()
1146 if (IS_ERR(imx219->regmap)) in imx219_probe()
1147 return dev_err_probe(dev, PTR_ERR(imx219->regmap), in imx219_probe()
1151 imx219->xclk = devm_clk_get(dev, NULL); in imx219_probe()
1152 if (IS_ERR(imx219->xclk)) in imx219_probe()
1153 return dev_err_probe(dev, PTR_ERR(imx219->xclk), in imx219_probe()
1156 imx219->xclk_freq = clk_get_rate(imx219->xclk); in imx219_probe()
1157 if (imx219->xclk_freq != IMX219_XCLK_FREQ) in imx219_probe()
1158 return dev_err_probe(dev, -EINVAL, in imx219_probe()
1160 imx219->xclk_freq); in imx219_probe()
1167 imx219->reset_gpio = devm_gpiod_get_optional(dev, "reset", in imx219_probe()
1183 * Sensor doesn't enter LP-11 state upon power up until and unless in imx219_probe()
1185 * streaming -> standby in imx219_probe()
1187 ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT, in imx219_probe()
1195 ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT, in imx219_probe()
1207 imx219->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; in imx219_probe()
1208 imx219->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; in imx219_probe()
1211 imx219->pad.flags = MEDIA_PAD_FL_SOURCE; in imx219_probe()
1213 ret = media_entity_pads_init(&imx219->sd.entity, 1, &imx219->pad); in imx219_probe()
1219 imx219->sd.state_lock = imx219->ctrl_handler.lock; in imx219_probe()
1220 ret = v4l2_subdev_init_finalize(&imx219->sd); in imx219_probe()
1229 ret = v4l2_async_register_subdev_sensor(&imx219->sd); in imx219_probe()
1232 "failed to register sensor sub-device\n"); in imx219_probe()
1241 v4l2_subdev_cleanup(&imx219->sd); in imx219_probe()
1246 media_entity_cleanup(&imx219->sd.entity); in imx219_probe()
1264 media_entity_cleanup(&sd->entity); in imx219_remove()
1267 pm_runtime_disable(&client->dev); in imx219_remove()
1268 if (!pm_runtime_status_suspended(&client->dev)) { in imx219_remove()
1269 imx219_power_off(&client->dev); in imx219_remove()
1270 pm_runtime_set_suspended(&client->dev); in imx219_remove()