3  * A V4L2 driver for Sony IMX219 cameras.
154 /* IMX219 native and active pixel array size. */
444 struct imx219 {  struct
449 	struct clk *xclk; /* system clock to IMX219 */
475 static inline struct imx219 *to_imx219(struct v4l2_subdev *_sd)  in to_imx219()  argument
477 	return container_of(_sd, struct imx219, sd);  in to_imx219()
481 static u32 imx219_get_format_code(struct imx219 *imx219, u32 code)  in imx219_get_format_code()  argument
492 	i = (i & ~3) | (imx219->vflip->val ? 2 : 0) |  in imx219_get_format_code()
493 	    (imx219->hflip->val ? 1 : 0);  in imx219_get_format_code()
500 	struct imx219 *imx219 =  in imx219_set_ctrl()  local
501 		container_of(ctrl->handler, struct imx219, ctrl_handler);  in imx219_set_ctrl()
502 	struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd);  in imx219_set_ctrl()
509 		exposure_max = imx219->mode->height + ctrl->val - 4;  in imx219_set_ctrl()
512 		__v4l2_ctrl_modify_range(imx219->exposure,  in imx219_set_ctrl()
513 					 imx219->exposure->minimum,  in imx219_set_ctrl()
514 					 exposure_max, imx219->exposure->step,  in imx219_set_ctrl()
527 		cci_write(imx219->regmap, IMX219_REG_ANALOG_GAIN,  in imx219_set_ctrl()
531 		cci_write(imx219->regmap, IMX219_REG_EXPOSURE,  in imx219_set_ctrl()
535 		cci_write(imx219->regmap, IMX219_REG_DIGITAL_GAIN,  in imx219_set_ctrl()
539 		cci_write(imx219->regmap, IMX219_REG_TEST_PATTERN,  in imx219_set_ctrl()
544 		cci_write(imx219->regmap, IMX219_REG_ORIENTATION,  in imx219_set_ctrl()
545 			  imx219->hflip->val | imx219->vflip->val << 1, &ret);  in imx219_set_ctrl()
548 		cci_write(imx219->regmap, IMX219_REG_VTS,  in imx219_set_ctrl()
549 			  imx219->mode->height + ctrl->val, &ret);  in imx219_set_ctrl()
552 		cci_write(imx219->regmap, IMX219_REG_TESTP_RED,  in imx219_set_ctrl()
556 		cci_write(imx219->regmap, IMX219_REG_TESTP_GREENR,  in imx219_set_ctrl()
560 		cci_write(imx219->regmap, IMX219_REG_TESTP_BLUE,  in imx219_set_ctrl()
564 		cci_write(imx219->regmap, IMX219_REG_TESTP_GREENB,  in imx219_set_ctrl()
584 static void imx219_update_pad_format(struct imx219 *imx219,  in imx219_update_pad_format()  argument
589 	fmt->code = imx219_get_format_code(imx219, code);  in imx219_update_pad_format()
601 	struct imx219 *imx219 = to_imx219(sd);  in imx219_init_cfg()  local
607 	imx219_update_pad_format(imx219, &supported_modes[0], format,  in imx219_init_cfg()
624 	struct imx219 *imx219 = to_imx219(sd);  in imx219_enum_mbus_code()  local
629 	code->code = imx219_get_format_code(imx219, imx219_mbus_formats[code->index * 4]);  in imx219_enum_mbus_code()
638 	struct imx219 *imx219 = to_imx219(sd);  in imx219_enum_frame_size()  local
644 	code = imx219_get_format_code(imx219, fse->code);  in imx219_enum_frame_size()
660 	struct imx219 *imx219 = to_imx219(sd);  in imx219_set_pad_format()  local
671 	imx219_update_pad_format(imx219, mode, &fmt->format, fmt->format.code);  in imx219_set_pad_format()
680 		imx219->mode = mode;  in imx219_set_pad_format()
682 		__v4l2_ctrl_modify_range(imx219->vblank, IMX219_VBLANK_MIN,  in imx219_set_pad_format()
685 		__v4l2_ctrl_s_ctrl(imx219->vblank,  in imx219_set_pad_format()
691 		__v4l2_ctrl_modify_range(imx219->exposure,  in imx219_set_pad_format()
692 					 imx219->exposure->minimum,  in imx219_set_pad_format()
693 					 exposure_max, imx219->exposure->step,  in imx219_set_pad_format()
701 		__v4l2_ctrl_modify_range(imx219->hblank, hblank, hblank, 1,  in imx219_set_pad_format()
708 static int imx219_set_framefmt(struct imx219 *imx219,  in imx219_set_framefmt()  argument
716 		return cci_multi_reg_write(imx219->regmap, raw8_framefmt_regs,  in imx219_set_framefmt()
723 		return cci_multi_reg_write(imx219->regmap, raw10_framefmt_regs,  in imx219_set_framefmt()
730 static int imx219_set_binning(struct imx219 *imx219,  in imx219_set_binning()  argument
733 	if (!imx219->mode->binning)  in imx219_set_binning()
734 		return cci_write(imx219->regmap, IMX219_REG_BINNING_MODE,  in imx219_set_binning()
742 		return cci_write(imx219->regmap, IMX219_REG_BINNING_MODE,  in imx219_set_binning()
749 		return cci_write(imx219->regmap, IMX219_REG_BINNING_MODE,  in imx219_set_binning()
787 static int imx219_configure_lanes(struct imx219 *imx219)  in imx219_configure_lanes()  argument
789 	return cci_write(imx219->regmap, IMX219_REG_CSI_LANE_MODE,  in imx219_configure_lanes()
790 			 imx219->lanes == 2 ? IMX219_CSI_2_LANE_MODE :  in imx219_configure_lanes()
794 static int imx219_start_streaming(struct imx219 *imx219,  in imx219_start_streaming()  argument
797 	struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd);  in imx219_start_streaming()
807 	ret = cci_multi_reg_write(imx219->regmap, imx219_common_regs,  in imx219_start_streaming()
815 	ret = imx219_configure_lanes(imx219);  in imx219_start_streaming()
822 	reg_list = &imx219->mode->reg_list;  in imx219_start_streaming()
823 	ret = cci_multi_reg_write(imx219->regmap, reg_list->regs,  in imx219_start_streaming()
830 	format = v4l2_subdev_get_pad_format(&imx219->sd, state, 0);  in imx219_start_streaming()
831 	ret = imx219_set_framefmt(imx219, format);  in imx219_start_streaming()
838 	ret = imx219_set_binning(imx219, format);  in imx219_start_streaming()
846 	ret =  __v4l2_ctrl_handler_setup(imx219->sd.ctrl_handler);  in imx219_start_streaming()
851 	ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT,  in imx219_start_streaming()
857 	__v4l2_ctrl_grab(imx219->vflip, true);  in imx219_start_streaming()
858 	__v4l2_ctrl_grab(imx219->hflip, true);  in imx219_start_streaming()
867 static void imx219_stop_streaming(struct imx219 *imx219)  in imx219_stop_streaming()  argument
869 	struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd);  in imx219_stop_streaming()
873 	ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT,  in imx219_stop_streaming()
878 	__v4l2_ctrl_grab(imx219->vflip, false);  in imx219_stop_streaming()
879 	__v4l2_ctrl_grab(imx219->hflip, false);  in imx219_stop_streaming()
886 	struct imx219 *imx219 = to_imx219(sd);  in imx219_set_stream()  local
892 	if (imx219->streaming == enable)  in imx219_set_stream()
900 		ret = imx219_start_streaming(imx219, state);  in imx219_set_stream()
904 		imx219_stop_streaming(imx219);  in imx219_set_stream()
907 	imx219->streaming = enable;  in imx219_set_stream()
918 	struct imx219 *imx219 = to_imx219(sd);  in imx219_power_on()  local
922 				    imx219->supplies);  in imx219_power_on()
929 	ret = clk_prepare_enable(imx219->xclk);  in imx219_power_on()
936 	gpiod_set_value_cansleep(imx219->reset_gpio, 1);  in imx219_power_on()
943 	regulator_bulk_disable(IMX219_NUM_SUPPLIES, imx219->supplies);  in imx219_power_on()
951 	struct imx219 *imx219 = to_imx219(sd);  in imx219_power_off()  local
953 	gpiod_set_value_cansleep(imx219->reset_gpio, 0);  in imx219_power_off()
954 	regulator_bulk_disable(IMX219_NUM_SUPPLIES, imx219->supplies);  in imx219_power_off()
955 	clk_disable_unprepare(imx219->xclk);  in imx219_power_off()
963 	struct imx219 *imx219 = to_imx219(sd);  in imx219_suspend()  local
965 	if (imx219->streaming)  in imx219_suspend()
966 		imx219_stop_streaming(imx219);  in imx219_suspend()
974 	struct imx219 *imx219 = to_imx219(sd);  in imx219_resume()  local
978 	if (imx219->streaming) {  in imx219_resume()
980 		ret = imx219_start_streaming(imx219, state);  in imx219_resume()
989 	imx219_stop_streaming(imx219);  in imx219_resume()
990 	imx219->streaming = false;  in imx219_resume()
995 static int imx219_get_regulators(struct imx219 *imx219)  in imx219_get_regulators()  argument
997 	struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd);  in imx219_get_regulators()
1001 		imx219->supplies[i].supply = imx219_supply_name[i];  in imx219_get_regulators()
1005 				       imx219->supplies);  in imx219_get_regulators()
1009 static int imx219_identify_module(struct imx219 *imx219)  in imx219_identify_module()  argument
1011 	struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd);  in imx219_identify_module()
1015 	ret = cci_read(imx219->regmap, IMX219_REG_CHIP_ID, &val, NULL);  in imx219_identify_module()
1056 static unsigned long imx219_get_pixel_rate(struct imx219 *imx219)  in imx219_get_pixel_rate()  argument
1058 	return (imx219->lanes == 2) ? IMX219_PIXEL_RATE : IMX219_PIXEL_RATE_4LANE;  in imx219_get_pixel_rate()
1062 static int imx219_init_controls(struct imx219 *imx219)  in imx219_init_controls()  argument
1064 	struct i2c_client *client = v4l2_get_subdevdata(&imx219->sd);  in imx219_init_controls()
1066 	unsigned int height = imx219->mode->height;  in imx219_init_controls()
1071 	ctrl_hdlr = &imx219->ctrl_handler;  in imx219_init_controls()
1077 	imx219->pixel_rate = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops,  in imx219_init_controls()
1079 					       imx219_get_pixel_rate(imx219),  in imx219_init_controls()
1080 					       imx219_get_pixel_rate(imx219), 1,  in imx219_init_controls()
1081 					       imx219_get_pixel_rate(imx219));  in imx219_init_controls()
1083 	imx219->link_freq =  in imx219_init_controls()
1087 				       (imx219->lanes == 2) ? imx219_link_freq_menu :  in imx219_init_controls()
1089 	if (imx219->link_freq)  in imx219_init_controls()
1090 		imx219->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;  in imx219_init_controls()
1093 	imx219->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops,  in imx219_init_controls()
1096 					   imx219->mode->vts_def - height);  in imx219_init_controls()
1097 	hblank = IMX219_PPL_DEFAULT - imx219->mode->width;  in imx219_init_controls()
1098 	imx219->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops,  in imx219_init_controls()
1101 	if (imx219->hblank)  in imx219_init_controls()
1102 		imx219->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;  in imx219_init_controls()
1103 	exposure_max = imx219->mode->vts_def - 4;  in imx219_init_controls()
1106 	imx219->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops,  in imx219_init_controls()
1120 	imx219->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops,  in imx219_init_controls()
1122 	if (imx219->hflip)  in imx219_init_controls()
1123 		imx219->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT;  in imx219_init_controls()
1125 	imx219->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx219_ctrl_ops,  in imx219_init_controls()
1127 	if (imx219->vflip)  in imx219_init_controls()
1128 		imx219->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT;  in imx219_init_controls()
1166 	imx219->sd.ctrl_handler = ctrl_hdlr;  in imx219_init_controls()
1176 static void imx219_free_controls(struct imx219 *imx219)  in imx219_free_controls()  argument
1178 	v4l2_ctrl_handler_free(imx219->sd.ctrl_handler);  in imx219_free_controls()
1181 static int imx219_check_hwcfg(struct device *dev, struct imx219 *imx219)  in imx219_check_hwcfg()  argument
1206 	imx219->lanes = ep_cfg.bus.mipi_csi2.num_data_lanes;  in imx219_check_hwcfg()
1215 	   (ep_cfg.link_frequencies[0] != ((imx219->lanes == 2) ?  in imx219_check_hwcfg()
1234 	struct imx219 *imx219;  in imx219_probe()  local
1237 	imx219 = devm_kzalloc(&client->dev, sizeof(*imx219), GFP_KERNEL);  in imx219_probe()
1238 	if (!imx219)  in imx219_probe()
1241 	v4l2_i2c_subdev_init(&imx219->sd, client, &imx219_subdev_ops);  in imx219_probe()
1244 	if (imx219_check_hwcfg(dev, imx219))  in imx219_probe()
1247 	imx219->regmap = devm_cci_regmap_init_i2c(client, 16);  in imx219_probe()
1248 	if (IS_ERR(imx219->regmap)) {  in imx219_probe()
1249 		ret = PTR_ERR(imx219->regmap);  in imx219_probe()
1255 	imx219->xclk = devm_clk_get(dev, NULL);  in imx219_probe()
1256 	if (IS_ERR(imx219->xclk)) {  in imx219_probe()
1258 		return PTR_ERR(imx219->xclk);  in imx219_probe()
1261 	imx219->xclk_freq = clk_get_rate(imx219->xclk);  in imx219_probe()
1262 	if (imx219->xclk_freq != IMX219_XCLK_FREQ) {  in imx219_probe()
1264 			imx219->xclk_freq);  in imx219_probe()
1268 	ret = imx219_get_regulators(imx219);  in imx219_probe()
1275 	imx219->reset_gpio = devm_gpiod_get_optional(dev, "reset",  in imx219_probe()
1286 	ret = imx219_identify_module(imx219);  in imx219_probe()
1291 	imx219->mode = &supported_modes[0];  in imx219_probe()
1297 	ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT,  in imx219_probe()
1305 	ret = cci_write(imx219->regmap, IMX219_REG_MODE_SELECT,  in imx219_probe()
1312 	ret = imx219_init_controls(imx219);  in imx219_probe()
1317 	imx219->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |  in imx219_probe()
1319 	imx219->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;  in imx219_probe()
1322 	imx219->pad.flags = MEDIA_PAD_FL_SOURCE;  in imx219_probe()
1324 	ret = media_entity_pads_init(&imx219->sd.entity, 1, &imx219->pad);  in imx219_probe()
1330 	imx219->sd.state_lock = imx219->ctrl_handler.lock;  in imx219_probe()
1331 	ret = v4l2_subdev_init_finalize(&imx219->sd);  in imx219_probe()
1337 	ret = v4l2_async_register_subdev_sensor(&imx219->sd);  in imx219_probe()
1351 	v4l2_subdev_cleanup(&imx219->sd);  in imx219_probe()
1354 	media_entity_cleanup(&imx219->sd.entity);  in imx219_probe()
1357 	imx219_free_controls(imx219);  in imx219_probe()
1368 	struct imx219 *imx219 = to_imx219(sd);  in imx219_remove()  local
1373 	imx219_free_controls(imx219);  in imx219_remove()
1382 	{ .compatible = "sony,imx219" },
1394 		.name = "imx219",
1405 MODULE_DESCRIPTION("Sony IMX219 sensor driver");