3  * Driver for IMX296 CMOS Image Sensor from Sony
219 static int imx296_read(struct imx296 *sensor, u32 addr)  in imx296_read()  argument
224 	ret = regmap_raw_read(sensor->regmap, addr & IMX296_REG_ADDR_MASK, data,  in imx296_read()
232 static int imx296_write(struct imx296 *sensor, u32 addr, u32 value, int *err)  in imx296_write()  argument
240 	ret = regmap_raw_write(sensor->regmap, addr & IMX296_REG_ADDR_MASK,  in imx296_write()
243 		dev_err(sensor->dev, "%u-bit write to 0x%04x failed: %d\n",  in imx296_write()
253 static int imx296_power_on(struct imx296 *sensor)  in imx296_power_on()  argument
257 	ret = regulator_bulk_enable(ARRAY_SIZE(sensor->supplies),  in imx296_power_on()
258 				    sensor->supplies);  in imx296_power_on()
264 	ret = gpiod_direction_output(sensor->reset, 0);  in imx296_power_on()
270 	ret = clk_prepare_enable(sensor->clk);  in imx296_power_on()
286 	gpiod_direction_output(sensor->reset, 1);  in imx296_power_on()
288 	regulator_bulk_disable(ARRAY_SIZE(sensor->supplies), sensor->supplies);  in imx296_power_on()
292 static void imx296_power_off(struct imx296 *sensor)  in imx296_power_off()  argument
294 	clk_disable_unprepare(sensor->clk);  in imx296_power_off()
295 	gpiod_direction_output(sensor->reset, 1);  in imx296_power_off()
296 	regulator_bulk_disable(ARRAY_SIZE(sensor->supplies), sensor->supplies);  in imx296_power_off()
318 	struct imx296 *sensor = container_of(ctrl->handler, struct imx296, ctrls);  in imx296_s_ctrl()  local
324 	if (!sensor->streaming)  in imx296_s_ctrl()
327 	state = v4l2_subdev_get_locked_active_state(&sensor->subdev);  in imx296_s_ctrl()
328 	format = v4l2_subdev_get_pad_format(&sensor->subdev, state, 0);  in imx296_s_ctrl()
333 		vmax = format->height + sensor->vblank->cur.val;  in imx296_s_ctrl()
335 		imx296_write(sensor, IMX296_SHS1, vmax - ctrl->val, &ret);  in imx296_s_ctrl()
339 		imx296_write(sensor, IMX296_GAIN, ctrl->val, &ret);  in imx296_s_ctrl()
343 		imx296_write(sensor, IMX296_VMAX, format->height + ctrl->val,  in imx296_s_ctrl()
349 			imx296_write(sensor, IMX296_PGHPOS, 8, &ret);  in imx296_s_ctrl()
350 			imx296_write(sensor, IMX296_PGVPOS, 8, &ret);  in imx296_s_ctrl()
351 			imx296_write(sensor, IMX296_PGHPSTEP, 8, &ret);  in imx296_s_ctrl()
352 			imx296_write(sensor, IMX296_PGVPSTEP, 8, &ret);  in imx296_s_ctrl()
353 			imx296_write(sensor, IMX296_PGHPNUM, 100, &ret);  in imx296_s_ctrl()
354 			imx296_write(sensor, IMX296_PGVPNUM, 100, &ret);  in imx296_s_ctrl()
355 			imx296_write(sensor, IMX296_PGDATA1, 0x300, &ret);  in imx296_s_ctrl()
356 			imx296_write(sensor, IMX296_PGDATA2, 0x100, &ret);  in imx296_s_ctrl()
357 			imx296_write(sensor, IMX296_PGHGSTEP, 0, &ret);  in imx296_s_ctrl()
358 			imx296_write(sensor, IMX296_BLKLEVEL, 0, &ret);  in imx296_s_ctrl()
359 			imx296_write(sensor, IMX296_BLKLEVELAUTO,  in imx296_s_ctrl()
361 			imx296_write(sensor, IMX296_PGCTRL,  in imx296_s_ctrl()
366 			imx296_write(sensor, IMX296_PGCTRL,  in imx296_s_ctrl()
368 			imx296_write(sensor, IMX296_BLKLEVEL, 0x3c, &ret);  in imx296_s_ctrl()
369 			imx296_write(sensor, IMX296_BLKLEVELAUTO,  in imx296_s_ctrl()
386 static int imx296_ctrls_init(struct imx296 *sensor)  in imx296_ctrls_init()  argument
392 	ret = v4l2_fwnode_device_parse(sensor->dev, &props);  in imx296_ctrls_init()
396 	v4l2_ctrl_handler_init(&sensor->ctrls, 9);  in imx296_ctrls_init()
398 	v4l2_ctrl_new_std(&sensor->ctrls, &imx296_ctrl_ops,  in imx296_ctrls_init()
400 	v4l2_ctrl_new_std(&sensor->ctrls, &imx296_ctrl_ops,  in imx296_ctrls_init()
412 	sensor->hblank = v4l2_ctrl_new_std(&sensor->ctrls, &imx296_ctrl_ops,  in imx296_ctrls_init()
415 	if (sensor->hblank)  in imx296_ctrls_init()
416 		sensor->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;  in imx296_ctrls_init()
418 	sensor->vblank = v4l2_ctrl_new_std(&sensor->ctrls, &imx296_ctrl_ops,  in imx296_ctrls_init()
423 	 * The sensor calculates the MIPI timings internally to achieve a bit  in imx296_ctrls_init()
429 	v4l2_ctrl_new_std(&sensor->ctrls, NULL, V4L2_CID_PIXEL_RATE,  in imx296_ctrls_init()
431 	v4l2_ctrl_new_std_menu_items(&sensor->ctrls, &imx296_ctrl_ops,  in imx296_ctrls_init()
436 	v4l2_ctrl_new_fwnode_properties(&sensor->ctrls, &imx296_ctrl_ops,  in imx296_ctrls_init()
439 	if (sensor->ctrls.error) {  in imx296_ctrls_init()
440 		dev_err(sensor->dev, "failed to add controls (%d)\n",  in imx296_ctrls_init()
441 			sensor->ctrls.error);  in imx296_ctrls_init()
442 		v4l2_ctrl_handler_free(&sensor->ctrls);  in imx296_ctrls_init()
443 		return sensor->ctrls.error;  in imx296_ctrls_init()
446 	sensor->subdev.ctrl_handler = &sensor->ctrls;  in imx296_ctrls_init()
507 static int imx296_setup(struct imx296 *sensor, struct v4l2_subdev_state *state)  in imx296_setup()  argument
514 	format = v4l2_subdev_get_pad_format(&sensor->subdev, state, 0);  in imx296_setup()
515 	crop = v4l2_subdev_get_pad_crop(&sensor->subdev, state, 0);  in imx296_setup()
518 		imx296_write(sensor, imx296_init_table[i].reg,  in imx296_setup()
523 		imx296_write(sensor, IMX296_FID0_ROI,  in imx296_setup()
525 		imx296_write(sensor, IMX296_FID0_ROIPH1, crop->left, &ret);  in imx296_setup()
526 		imx296_write(sensor, IMX296_FID0_ROIPV1, crop->top, &ret);  in imx296_setup()
527 		imx296_write(sensor, IMX296_FID0_ROIWH1, crop->width, &ret);  in imx296_setup()
528 		imx296_write(sensor, IMX296_FID0_ROIWV1, crop->height, &ret);  in imx296_setup()
530 		imx296_write(sensor, IMX296_FID0_ROI, 0, &ret);  in imx296_setup()
533 	imx296_write(sensor, IMX296_CTRL0D,  in imx296_setup()
548 	 * In the vertical direction the sensor outputs the following:  in imx296_setup()
558 	imx296_write(sensor, IMX296_HMAX, 1100, &ret);  in imx296_setup()
559 	imx296_write(sensor, IMX296_VMAX,  in imx296_setup()
560 		     format->height + sensor->vblank->cur.val, &ret);  in imx296_setup()
562 	for (i = 0; i < ARRAY_SIZE(sensor->clk_params->incksel); ++i)  in imx296_setup()
563 		imx296_write(sensor, IMX296_INCKSEL(i),  in imx296_setup()
564 			     sensor->clk_params->incksel[i], &ret);  in imx296_setup()
565 	imx296_write(sensor, IMX296_GTTABLENUM, 0xc5, &ret);  in imx296_setup()
566 	imx296_write(sensor, IMX296_CTRL418C, sensor->clk_params->ctrl418c,  in imx296_setup()
569 	imx296_write(sensor, IMX296_GAINDLY, IMX296_GAINDLY_NONE, &ret);  in imx296_setup()
570 	imx296_write(sensor, IMX296_BLKLEVEL, 0x03c, &ret);  in imx296_setup()
575 static int imx296_stream_on(struct imx296 *sensor)  in imx296_stream_on()  argument
579 	imx296_write(sensor, IMX296_CTRL00, 0, &ret);  in imx296_stream_on()
581 	imx296_write(sensor, IMX296_CTRL0A, 0, &ret);  in imx296_stream_on()
586 static int imx296_stream_off(struct imx296 *sensor)  in imx296_stream_off()  argument
590 	imx296_write(sensor, IMX296_CTRL0A, IMX296_CTRL0A_XMSTA, &ret);  in imx296_stream_off()
591 	imx296_write(sensor, IMX296_CTRL00, IMX296_CTRL00_STANDBY, &ret);  in imx296_stream_off()
598 	struct imx296 *sensor = to_imx296(sd);  in imx296_s_stream()  local
605 		ret = imx296_stream_off(sensor);  in imx296_s_stream()
607 		pm_runtime_mark_last_busy(sensor->dev);  in imx296_s_stream()
608 		pm_runtime_put_autosuspend(sensor->dev);  in imx296_s_stream()
610 		sensor->streaming = false;  in imx296_s_stream()
615 	ret = pm_runtime_resume_and_get(sensor->dev);  in imx296_s_stream()
619 	ret = imx296_setup(sensor, state);  in imx296_s_stream()
628 	sensor->streaming = true;  in imx296_s_stream()
630 	ret = __v4l2_ctrl_handler_setup(&sensor->ctrls);  in imx296_s_stream()
634 	ret = imx296_stream_on(sensor);  in imx296_s_stream()
648 	pm_runtime_put_sync(sensor->dev);  in imx296_s_stream()
649 	sensor->streaming = false;  in imx296_s_stream()
658 	struct imx296 *sensor = to_imx296(sd);  in imx296_enum_mbus_code()  local
663 	code->code = sensor->mono ? MEDIA_BUS_FMT_Y10_1X10  in imx296_enum_mbus_code()
692 	struct imx296 *sensor = to_imx296(sd);  in imx296_set_format()  local
726 	format->code = sensor->mono ? MEDIA_BUS_FMT_Y10_1X10  in imx296_set_format()
851 static int imx296_subdev_init(struct imx296 *sensor)  in imx296_subdev_init()  argument
853 	struct i2c_client *client = to_i2c_client(sensor->dev);  in imx296_subdev_init()
856 	v4l2_i2c_subdev_init(&sensor->subdev, client, &imx296_subdev_ops);  in imx296_subdev_init()
858 	ret = imx296_ctrls_init(sensor);  in imx296_subdev_init()
862 	sensor->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in imx296_subdev_init()
863 	sensor->pad.flags = MEDIA_PAD_FL_SOURCE;  in imx296_subdev_init()
864 	sensor->subdev.entity.function = MEDIA_ENT_F_CAM_SENSOR;  in imx296_subdev_init()
865 	ret = media_entity_pads_init(&sensor->subdev.entity, 1, &sensor->pad);  in imx296_subdev_init()
867 		v4l2_ctrl_handler_free(&sensor->ctrls);  in imx296_subdev_init()
871 	sensor->subdev.state_lock = sensor->subdev.ctrl_handler->lock;  in imx296_subdev_init()
873 	v4l2_subdev_init_finalize(&sensor->subdev);  in imx296_subdev_init()
878 static void imx296_subdev_cleanup(struct imx296 *sensor)  in imx296_subdev_cleanup()  argument
880 	media_entity_cleanup(&sensor->subdev.entity);  in imx296_subdev_cleanup()
881 	v4l2_ctrl_handler_free(&sensor->ctrls);  in imx296_subdev_cleanup()
892 	struct imx296 *sensor = to_imx296(subdev);  in imx296_runtime_resume()  local
894 	return imx296_power_on(sensor);  in imx296_runtime_resume()
901 	struct imx296 *sensor = to_imx296(subdev);  in imx296_runtime_suspend()  local
903 	imx296_power_off(sensor);  in imx296_runtime_suspend()
916 static int imx296_read_temperature(struct imx296 *sensor, int *temp)  in imx296_read_temperature()  argument
921 	ret = imx296_write(sensor, IMX296_TMDCTRL, IMX296_TMDCTRL_LATCH, NULL);  in imx296_read_temperature()
925 	tmdout = imx296_read(sensor, IMX296_TMDOUT);  in imx296_read_temperature()
934 	return imx296_write(sensor, IMX296_TMDCTRL, 0, NULL);  in imx296_read_temperature()
937 static int imx296_identify_model(struct imx296 *sensor)  in imx296_identify_model()  argument
943 	model = (uintptr_t)of_device_get_match_data(sensor->dev);  in imx296_identify_model()
945 		dev_dbg(sensor->dev,  in imx296_identify_model()
946 			"sensor model auto-detection disabled, forcing 0x%04x\n",  in imx296_identify_model()
948 		sensor->mono = model & IMX296_SENSOR_INFO_MONO;  in imx296_identify_model()
953 	 * While most registers can be read when the sensor is in standby, this  in imx296_identify_model()
954 	 * is not the case of the sensor info register :-(  in imx296_identify_model()
956 	ret = imx296_write(sensor, IMX296_CTRL00, 0, NULL);  in imx296_identify_model()
958 		dev_err(sensor->dev,  in imx296_identify_model()
959 			"failed to get sensor out of standby (%d)\n", ret);  in imx296_identify_model()
965 	ret = imx296_read(sensor, IMX296_SENSOR_INFO);  in imx296_identify_model()
967 		dev_err(sensor->dev, "failed to read sensor information (%d)\n",  in imx296_identify_model()
976 		sensor->mono = ret & IMX296_SENSOR_INFO_MONO;  in imx296_identify_model()
984 		dev_err(sensor->dev, "invalid device model 0x%04x\n", ret);  in imx296_identify_model()
989 	ret = imx296_read_temperature(sensor, &temp);  in imx296_identify_model()
993 	dev_info(sensor->dev, "found IMX%u%s (%u.%uC)\n", model,  in imx296_identify_model()
994 		 sensor->mono ? "LL" : "LQ", temp / 1000, (temp / 100) % 10);  in imx296_identify_model()
997 	imx296_write(sensor, IMX296_CTRL00, IMX296_CTRL00_STANDBY, NULL);  in imx296_identify_model()
1020 	struct imx296 *sensor;  in imx296_probe()  local
1030 	sensor = devm_kzalloc(&client->dev, sizeof(*sensor), GFP_KERNEL);  in imx296_probe()
1031 	if (!sensor)  in imx296_probe()
1034 	sensor->dev = &client->dev;  in imx296_probe()
1037 	for (i = 0; i < ARRAY_SIZE(sensor->supplies); ++i)  in imx296_probe()
1038 		sensor->supplies[i].supply = imx296_supply_names[i];  in imx296_probe()
1040 	ret = devm_regulator_bulk_get(sensor->dev, ARRAY_SIZE(sensor->supplies),  in imx296_probe()
1041 				      sensor->supplies);  in imx296_probe()
1043 		dev_err_probe(sensor->dev, ret, "failed to get supplies\n");  in imx296_probe()
1047 	sensor->reset = devm_gpiod_get_optional(sensor->dev, "reset",  in imx296_probe()
1049 	if (IS_ERR(sensor->reset))  in imx296_probe()
1050 		return dev_err_probe(sensor->dev, PTR_ERR(sensor->reset),  in imx296_probe()
1053 	sensor->clk = devm_clk_get(sensor->dev, "inck");  in imx296_probe()
1054 	if (IS_ERR(sensor->clk))  in imx296_probe()
1055 		return dev_err_probe(sensor->dev, PTR_ERR(sensor->clk),  in imx296_probe()
1058 	clk_rate = clk_get_rate(sensor->clk);  in imx296_probe()
1061 			sensor->clk_params = &imx296_clk_params[i];  in imx296_probe()
1066 	if (!sensor->clk_params) {  in imx296_probe()
1067 		dev_err(sensor->dev, "unsupported clock rate %lu\n", clk_rate);  in imx296_probe()
1071 	sensor->regmap = devm_regmap_init_i2c(client, &imx296_regmap_config);  in imx296_probe()
1072 	if (IS_ERR(sensor->regmap))  in imx296_probe()
1073 		return PTR_ERR(sensor->regmap);  in imx296_probe()
1078 	 * the sensor on manually here, identify it, and fully initialize it.  in imx296_probe()
1080 	ret = imx296_power_on(sensor);  in imx296_probe()
1084 	ret = imx296_identify_model(sensor);  in imx296_probe()
1089 	ret = imx296_subdev_init(sensor);  in imx296_probe()
1097 	pm_runtime_set_active(sensor->dev);  in imx296_probe()
1098 	pm_runtime_get_noresume(sensor->dev);  in imx296_probe()
1099 	pm_runtime_enable(sensor->dev);  in imx296_probe()
1102 	ret = v4l2_async_register_subdev(&sensor->subdev);  in imx296_probe()
1111 	pm_runtime_set_autosuspend_delay(sensor->dev, 1000);  in imx296_probe()
1112 	pm_runtime_use_autosuspend(sensor->dev);  in imx296_probe()
1113 	pm_runtime_put_autosuspend(sensor->dev);  in imx296_probe()
1118 	pm_runtime_disable(sensor->dev);  in imx296_probe()
1119 	pm_runtime_put_noidle(sensor->dev);  in imx296_probe()
1120 	imx296_subdev_cleanup(sensor);  in imx296_probe()
1122 	imx296_power_off(sensor);  in imx296_probe()
1129 	struct imx296 *sensor = to_imx296(subdev);  in imx296_remove()  local
1133 	imx296_subdev_cleanup(sensor);  in imx296_remove()
1139 	pm_runtime_disable(sensor->dev);  in imx296_remove()
1140 	if (!pm_runtime_status_suspended(sensor->dev))  in imx296_remove()
1141 		imx296_power_off(sensor);  in imx296_remove()
1142 	pm_runtime_set_suspended(sensor->dev);  in imx296_remove()