3  * Driver for the OV5645 camera sensor.
10  * - the OV5645 driver from QC msm-3.10 kernel on codeaurora.org:
12  *       media/platform/msm/camera_v2/sensor/ov5645.c?h=LA.BR.1.2.4_rb1.41
85 struct ov5645 {  struct
114 static inline struct ov5645 *to_ov5645(struct v4l2_subdev *sd)  in to_ov5645()  argument
116 	return container_of(sd, struct ov5645, sd);  in to_ov5645()
541 static int ov5645_write_reg(struct ov5645 *ov5645, u16 reg, u8 val)  in ov5645_write_reg()  argument
550 	ret = i2c_master_send(ov5645->i2c_client, regbuf, 3);  in ov5645_write_reg()
552 		dev_err(ov5645->dev, "%s: write reg error %d: reg=%x, val=%x\n",  in ov5645_write_reg()
560 static int ov5645_read_reg(struct ov5645 *ov5645, u16 reg, u8 *val)  in ov5645_read_reg()  argument
568 	ret = i2c_master_send(ov5645->i2c_client, regbuf, 2);  in ov5645_read_reg()
570 		dev_err(ov5645->dev, "%s: write reg error %d: reg=%x\n",  in ov5645_read_reg()
575 	ret = i2c_master_recv(ov5645->i2c_client, val, 1);  in ov5645_read_reg()
577 		dev_err(ov5645->dev, "%s: read reg error %d: reg=%x\n",  in ov5645_read_reg()
585 static int ov5645_set_aec_mode(struct ov5645 *ov5645, u32 mode)  in ov5645_set_aec_mode()  argument
587 	u8 val = ov5645->aec_pk_manual;  in ov5645_set_aec_mode()
595 	ret = ov5645_write_reg(ov5645, OV5645_AEC_PK_MANUAL, val);  in ov5645_set_aec_mode()
597 		ov5645->aec_pk_manual = val;  in ov5645_set_aec_mode()
602 static int ov5645_set_agc_mode(struct ov5645 *ov5645, u32 enable)  in ov5645_set_agc_mode()  argument
604 	u8 val = ov5645->aec_pk_manual;  in ov5645_set_agc_mode()
612 	ret = ov5645_write_reg(ov5645, OV5645_AEC_PK_MANUAL, val);  in ov5645_set_agc_mode()
614 		ov5645->aec_pk_manual = val;  in ov5645_set_agc_mode()
619 static int ov5645_set_register_array(struct ov5645 *ov5645,  in ov5645_set_register_array()  argument
627 		ret = ov5645_write_reg(ov5645, settings->reg, settings->val);  in ov5645_set_register_array()
638 	struct ov5645 *ov5645 = to_ov5645(sd);  in ov5645_set_power_off()  local
640 	ov5645_write_reg(ov5645, OV5645_IO_MIPI_CTRL00, 0x58);  in ov5645_set_power_off()
641 	gpiod_set_value_cansleep(ov5645->rst_gpio, 1);  in ov5645_set_power_off()
642 	gpiod_set_value_cansleep(ov5645->enable_gpio, 0);  in ov5645_set_power_off()
643 	clk_disable_unprepare(ov5645->xclk);  in ov5645_set_power_off()
644 	regulator_bulk_disable(OV5645_NUM_SUPPLIES, ov5645->supplies);  in ov5645_set_power_off()
652 	struct ov5645 *ov5645 = to_ov5645(sd);  in ov5645_set_power_on()  local
655 	ret = regulator_bulk_enable(OV5645_NUM_SUPPLIES, ov5645->supplies);  in ov5645_set_power_on()
659 	ret = clk_prepare_enable(ov5645->xclk);  in ov5645_set_power_on()
661 		dev_err(ov5645->dev, "clk prepare enable failed\n");  in ov5645_set_power_on()
662 		regulator_bulk_disable(OV5645_NUM_SUPPLIES, ov5645->supplies);  in ov5645_set_power_on()
667 	gpiod_set_value_cansleep(ov5645->enable_gpio, 1);  in ov5645_set_power_on()
670 	gpiod_set_value_cansleep(ov5645->rst_gpio, 0);  in ov5645_set_power_on()
674 	ret = ov5645_set_register_array(ov5645, ov5645_global_init_setting,  in ov5645_set_power_on()
677 		dev_err(ov5645->dev, "could not set init registers\n");  in ov5645_set_power_on()
690 static int ov5645_set_saturation(struct ov5645 *ov5645, s32 value)  in ov5645_set_saturation()  argument
695 	ret = ov5645_write_reg(ov5645, OV5645_SDE_SAT_U, reg_value);  in ov5645_set_saturation()
699 	return ov5645_write_reg(ov5645, OV5645_SDE_SAT_V, reg_value);  in ov5645_set_saturation()
702 static int ov5645_set_hflip(struct ov5645 *ov5645, s32 value)  in ov5645_set_hflip()  argument
704 	u8 val = ov5645->timing_tc_reg21;  in ov5645_set_hflip()
712 	ret = ov5645_write_reg(ov5645, OV5645_TIMING_TC_REG21, val);  in ov5645_set_hflip()
714 		ov5645->timing_tc_reg21 = val;  in ov5645_set_hflip()
719 static int ov5645_set_vflip(struct ov5645 *ov5645, s32 value)  in ov5645_set_vflip()  argument
721 	u8 val = ov5645->timing_tc_reg20;  in ov5645_set_vflip()
729 	ret = ov5645_write_reg(ov5645, OV5645_TIMING_TC_REG20, val);  in ov5645_set_vflip()
731 		ov5645->timing_tc_reg20 = val;  in ov5645_set_vflip()
736 static int ov5645_set_test_pattern(struct ov5645 *ov5645, s32 value)  in ov5645_set_test_pattern()  argument
745 	return ov5645_write_reg(ov5645, OV5645_PRE_ISP_TEST_SETTING_1, val);  in ov5645_set_test_pattern()
756 static int ov5645_set_awb(struct ov5645 *ov5645, s32 enable_auto)  in ov5645_set_awb()  argument
763 	return ov5645_write_reg(ov5645, OV5645_AWB_MANUAL_CONTROL, val);  in ov5645_set_awb()
768 	struct ov5645 *ov5645 = container_of(ctrl->handler,  in ov5645_s_ctrl()  local
769 					     struct ov5645, ctrls);  in ov5645_s_ctrl()
772 	mutex_lock(&ov5645->power_lock);  in ov5645_s_ctrl()
773 	if (!pm_runtime_get_if_in_use(ov5645->dev)) {  in ov5645_s_ctrl()
774 		mutex_unlock(&ov5645->power_lock);  in ov5645_s_ctrl()
780 		ret = ov5645_set_saturation(ov5645, ctrl->val);  in ov5645_s_ctrl()
783 		ret = ov5645_set_awb(ov5645, ctrl->val);  in ov5645_s_ctrl()
786 		ret = ov5645_set_agc_mode(ov5645, ctrl->val);  in ov5645_s_ctrl()
789 		ret = ov5645_set_aec_mode(ov5645, ctrl->val);  in ov5645_s_ctrl()
792 		ret = ov5645_set_test_pattern(ov5645, ctrl->val);  in ov5645_s_ctrl()
795 		ret = ov5645_set_hflip(ov5645, ctrl->val);  in ov5645_s_ctrl()
798 		ret = ov5645_set_vflip(ov5645, ctrl->val);  in ov5645_s_ctrl()
805 	pm_runtime_mark_last_busy(ov5645->dev);  in ov5645_s_ctrl()
806 	pm_runtime_put_autosuspend(ov5645->dev);  in ov5645_s_ctrl()
807 	mutex_unlock(&ov5645->power_lock);  in ov5645_s_ctrl()
847 __ov5645_get_pad_format(struct ov5645 *ov5645,  in __ov5645_get_pad_format()  argument
854 		return v4l2_subdev_get_try_format(&ov5645->sd, sd_state, pad);  in __ov5645_get_pad_format()
856 		return &ov5645->fmt;  in __ov5645_get_pad_format()
866 	struct ov5645 *ov5645 = to_ov5645(sd);  in ov5645_get_format()  local
868 	format->format = *__ov5645_get_pad_format(ov5645, sd_state,  in ov5645_get_format()
875 __ov5645_get_pad_crop(struct ov5645 *ov5645,  in __ov5645_get_pad_crop()  argument
881 		return v4l2_subdev_get_try_crop(&ov5645->sd, sd_state, pad);  in __ov5645_get_pad_crop()
883 		return &ov5645->crop;  in __ov5645_get_pad_crop()
893 	struct ov5645 *ov5645 = to_ov5645(sd);  in ov5645_set_format()  local
899 	__crop = __ov5645_get_pad_crop(ov5645, sd_state, format->pad,  in ov5645_set_format()
911 		ret = v4l2_ctrl_s_ctrl_int64(ov5645->pixel_clock,  in ov5645_set_format()
916 		ret = v4l2_ctrl_s_ctrl(ov5645->link_freq,  in ov5645_set_format()
921 		ov5645->current_mode = new_mode;  in ov5645_set_format()
924 	__format = __ov5645_get_pad_format(ov5645, sd_state, format->pad,  in ov5645_set_format()
955 	struct ov5645 *ov5645 = to_ov5645(sd);  in ov5645_get_selection()  local
960 	sel->r = *__ov5645_get_pad_crop(ov5645, sd_state, sel->pad,  in ov5645_get_selection()
967 	struct ov5645 *ov5645 = to_ov5645(subdev);  in ov5645_s_stream()  local
971 		ret = pm_runtime_resume_and_get(ov5645->dev);  in ov5645_s_stream()
975 		ret = ov5645_set_register_array(ov5645,  in ov5645_s_stream()
976 					ov5645->current_mode->data,  in ov5645_s_stream()
977 					ov5645->current_mode->data_size);  in ov5645_s_stream()
979 			dev_err(ov5645->dev, "could not set mode %dx%d\n",  in ov5645_s_stream()
980 				ov5645->current_mode->width,  in ov5645_s_stream()
981 				ov5645->current_mode->height);  in ov5645_s_stream()
984 		ret = v4l2_ctrl_handler_setup(&ov5645->ctrls);  in ov5645_s_stream()
986 			dev_err(ov5645->dev, "could not sync v4l2 controls\n");  in ov5645_s_stream()
990 		ret = ov5645_write_reg(ov5645, OV5645_IO_MIPI_CTRL00, 0x45);  in ov5645_s_stream()
994 		ret = ov5645_write_reg(ov5645, OV5645_SYSTEM_CTRL0,  in ov5645_s_stream()
999 		ret = ov5645_write_reg(ov5645, OV5645_IO_MIPI_CTRL00, 0x40);  in ov5645_s_stream()
1003 		ret = ov5645_write_reg(ov5645, OV5645_SYSTEM_CTRL0,  in ov5645_s_stream()
1012 	pm_runtime_put_sync(ov5645->dev);  in ov5645_s_stream()
1016 	pm_runtime_mark_last_busy(ov5645->dev);  in ov5645_s_stream()
1017 	pm_runtime_put_autosuspend(ov5645->dev);  in ov5645_s_stream()
1043 	struct ov5645 *ov5645;  in ov5645_probe()  local
1049 	ov5645 = devm_kzalloc(dev, sizeof(struct ov5645), GFP_KERNEL);  in ov5645_probe()
1050 	if (!ov5645)  in ov5645_probe()
1053 	ov5645->i2c_client = client;  in ov5645_probe()
1054 	ov5645->dev = dev;  in ov5645_probe()
1063 					 &ov5645->ep);  in ov5645_probe()
1072 	if (ov5645->ep.bus_type != V4L2_MBUS_CSI2_DPHY) {  in ov5645_probe()
1078 	ov5645->xclk = devm_clk_get(dev, NULL);  in ov5645_probe()
1079 	if (IS_ERR(ov5645->xclk)) {  in ov5645_probe()
1081 		return PTR_ERR(ov5645->xclk);  in ov5645_probe()
1097 	ret = clk_set_rate(ov5645->xclk, xclk_freq);  in ov5645_probe()
1104 		ov5645->supplies[i].supply = ov5645_supply_name[i];  in ov5645_probe()
1107 				      ov5645->supplies);  in ov5645_probe()
1111 	ov5645->enable_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_HIGH);  in ov5645_probe()
1112 	if (IS_ERR(ov5645->enable_gpio)) {  in ov5645_probe()
1114 		return PTR_ERR(ov5645->enable_gpio);  in ov5645_probe()
1117 	ov5645->rst_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);  in ov5645_probe()
1118 	if (IS_ERR(ov5645->rst_gpio)) {  in ov5645_probe()
1120 		return PTR_ERR(ov5645->rst_gpio);  in ov5645_probe()
1123 	mutex_init(&ov5645->power_lock);  in ov5645_probe()
1125 	v4l2_ctrl_handler_init(&ov5645->ctrls, 9);  in ov5645_probe()
1126 	v4l2_ctrl_new_std(&ov5645->ctrls, &ov5645_ctrl_ops,  in ov5645_probe()
1128 	v4l2_ctrl_new_std(&ov5645->ctrls, &ov5645_ctrl_ops,  in ov5645_probe()
1130 	v4l2_ctrl_new_std(&ov5645->ctrls, &ov5645_ctrl_ops,  in ov5645_probe()
1132 	v4l2_ctrl_new_std(&ov5645->ctrls, &ov5645_ctrl_ops,  in ov5645_probe()
1134 	v4l2_ctrl_new_std(&ov5645->ctrls, &ov5645_ctrl_ops,  in ov5645_probe()
1136 	v4l2_ctrl_new_std_menu(&ov5645->ctrls, &ov5645_ctrl_ops,  in ov5645_probe()
1139 	v4l2_ctrl_new_std_menu_items(&ov5645->ctrls, &ov5645_ctrl_ops,  in ov5645_probe()
1143 	ov5645->pixel_clock = v4l2_ctrl_new_std(&ov5645->ctrls,  in ov5645_probe()
1147 	ov5645->link_freq = v4l2_ctrl_new_int_menu(&ov5645->ctrls,  in ov5645_probe()
1152 	if (ov5645->link_freq)  in ov5645_probe()
1153 		ov5645->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;  in ov5645_probe()
1155 	ov5645->sd.ctrl_handler = &ov5645->ctrls;  in ov5645_probe()
1157 	if (ov5645->ctrls.error) {  in ov5645_probe()
1159 		       __func__, ov5645->ctrls.error);  in ov5645_probe()
1160 		ret = ov5645->ctrls.error;  in ov5645_probe()
1164 	v4l2_i2c_subdev_init(&ov5645->sd, client, &ov5645_subdev_ops);  in ov5645_probe()
1165 	ov5645->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in ov5645_probe()
1166 	ov5645->pad.flags = MEDIA_PAD_FL_SOURCE;  in ov5645_probe()
1167 	ov5645->sd.dev = &client->dev;  in ov5645_probe()
1168 	ov5645->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;  in ov5645_probe()
1170 	ret = media_entity_pads_init(&ov5645->sd.entity, 1, &ov5645->pad);  in ov5645_probe()
1180 	ret = ov5645_read_reg(ov5645, OV5645_CHIP_ID_HIGH, &chip_id_high);  in ov5645_probe()
1186 	ret = ov5645_read_reg(ov5645, OV5645_CHIP_ID_LOW, &chip_id_low);  in ov5645_probe()
1193 	dev_info(dev, "OV5645 detected at address 0x%02x\n", client->addr);  in ov5645_probe()
1195 	ret = ov5645_read_reg(ov5645, OV5645_AEC_PK_MANUAL,  in ov5645_probe()
1196 			      &ov5645->aec_pk_manual);  in ov5645_probe()
1203 	ret = ov5645_read_reg(ov5645, OV5645_TIMING_TC_REG20,  in ov5645_probe()
1204 			      &ov5645->timing_tc_reg20);  in ov5645_probe()
1211 	ret = ov5645_read_reg(ov5645, OV5645_TIMING_TC_REG21,  in ov5645_probe()
1212 			      &ov5645->timing_tc_reg21);  in ov5645_probe()
1223 	ov5645_entity_init_cfg(&ov5645->sd, NULL);  in ov5645_probe()
1225 	ret = v4l2_async_register_subdev(&ov5645->sd);  in ov5645_probe()
1244 	media_entity_cleanup(&ov5645->sd.entity);  in ov5645_probe()
1246 	v4l2_ctrl_handler_free(&ov5645->ctrls);  in ov5645_probe()
1247 	mutex_destroy(&ov5645->power_lock);  in ov5645_probe()
1255 	struct ov5645 *ov5645 = to_ov5645(sd);  in ov5645_remove()  local
1257 	v4l2_async_unregister_subdev(&ov5645->sd);  in ov5645_remove()
1258 	media_entity_cleanup(&ov5645->sd.entity);  in ov5645_remove()
1259 	v4l2_ctrl_handler_free(&ov5645->ctrls);  in ov5645_remove()
1260 	pm_runtime_disable(ov5645->dev);  in ov5645_remove()
1261 	if (!pm_runtime_status_suspended(ov5645->dev))  in ov5645_remove()
1262 		ov5645_set_power_off(ov5645->dev);  in ov5645_remove()
1263 	pm_runtime_set_suspended(ov5645->dev);  in ov5645_remove()
1264 	mutex_destroy(&ov5645->power_lock);  in ov5645_remove()
1268 	{ "ov5645", 0 },
1274 	{ .compatible = "ovti,ov5645" },
1286 		.name  = "ov5645",
1296 MODULE_DESCRIPTION("Omnivision OV5645 Camera Driver");