media/i2c/dw9768.c

1 // SPDX-License-Identifier: GPL-2.0
9 #include <media/v4l2-async.h>
10 #include <media/v4l2-ctrls.h>
11 #include <media/v4l2-device.h>
12 #include <media/v4l2-fwnode.h>
13 #include <media/v4l2-subdev.h>
16 #define DW9768_MAX_FOCUS_POS			(1024 - 1)
56  * Bit[2:0] Namely PRESC[2:0], set the internal clock dividing rate as follow.
70  * Bit[5:0] Defined as VCM rising periodic time (Tvib) together with PRESC[2:0]
72  * Dividing Rate is the internal clock dividing rate that is defined at
78  * DW9768 requires waiting time (delay time) of t_OPR after power-up,
82 #define DW9768_TVIB_MS_BASE10			(64 - 1)
204 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_mod_reg()
218 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_set_dac()
226 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_init()
250 			     dw9768->aac_mode << 5);  in dw9768_init()
254 	/* Set clock presc */  in dw9768_init()
255 	if (dw9768->clock_presc != DW9768_CLOCK_PRE_SCALE_DEFAULT) {  in dw9768_init()
258 				     dw9768->clock_presc);  in dw9768_init()
264 	if (dw9768->aac_timing != DW9768_AAC_TIME_DEFAULT) {  in dw9768_init()
266 						dw9768->aac_timing);  in dw9768_init()
271 	for (val = dw9768->focus->val % DW9768_MOVE_STEPS;  in dw9768_init()
272 	     val <= dw9768->focus->val;  in dw9768_init()
276 			dev_err(&client->dev, "I2C failure: %d", ret);  in dw9768_init()
279 		usleep_range(dw9768->move_delay_us,  in dw9768_init()
280 			     dw9768->move_delay_us + 1000);  in dw9768_init()
288 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_release()
291 	val = round_down(dw9768->focus->val, DW9768_MOVE_STEPS);  in dw9768_release()
292 	for ( ; val >= 0; val -= DW9768_MOVE_STEPS) {  in dw9768_release()
295 			dev_err(&client->dev, "I2C write fail: %d", ret);  in dw9768_release()
298 		usleep_range(dw9768->move_delay_us,  in dw9768_release()
299 			     dw9768->move_delay_us + 1000);  in dw9768_release()
323 			       dw9768->supplies);  in dw9768_runtime_suspend()
335 				    dw9768->supplies);  in dw9768_runtime_resume()
343 	 * I2C commands after power-up.  in dw9768_runtime_resume()
355 			       dw9768->supplies);  in dw9768_runtime_resume()
362 	struct dw9768 *dw9768 = container_of(ctrl->handler,  in dw9768_set_ctrl()
365 	if (ctrl->id == V4L2_CID_FOCUS_ABSOLUTE)  in dw9768_set_ctrl()
366 		return dw9768_set_dac(dw9768, ctrl->val);  in dw9768_set_ctrl()
377 	return pm_runtime_resume_and_get(sd->dev);  in dw9768_open()
382 	pm_runtime_put(sd->dev);  in dw9768_close()
396 	struct v4l2_ctrl_handler *hdl = &dw9768->ctrls;  in dw9768_init_controls()
401 	dw9768->focus = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FOCUS_ABSOLUTE, 0,  in dw9768_init_controls()
405 	if (hdl->error)  in dw9768_init_controls()
406 		return hdl->error;  in dw9768_init_controls()
408 	dw9768->sd.ctrl_handler = hdl;  in dw9768_init_controls()
415 	struct device *dev = &client->dev;  in dw9768_probe()
423 		return -ENOMEM;  in dw9768_probe()
426 	v4l2_i2c_subdev_init(&dw9768->sd, client, &dw9768_ops);  in dw9768_probe()
428 	dw9768->aac_mode = DW9768_AAC_MODE_DEFAULT;  in dw9768_probe()
429 	dw9768->aac_timing = DW9768_AAC_TIME_DEFAULT;  in dw9768_probe()
430 	dw9768->clock_presc = DW9768_CLOCK_PRE_SCALE_DEFAULT;  in dw9768_probe()
433 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,aac-mode",  in dw9768_probe()
434 				 &dw9768->aac_mode);  in dw9768_probe()
436 	/* Optional indication of clock pre-scale select */  in dw9768_probe()
437 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,clock-presc",  in dw9768_probe()
438 				 &dw9768->clock_presc);  in dw9768_probe()
441 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,aac-timing",  in dw9768_probe()
442 				 &dw9768->aac_timing);  in dw9768_probe()
444 	dw9768->move_delay_us = dw9768_cal_move_delay(dw9768->aac_mode,  in dw9768_probe()
445 						      dw9768->clock_presc,  in dw9768_probe()
446 						      dw9768->aac_timing);  in dw9768_probe()
449 		dw9768->supplies[i].supply = dw9768_supply_names[i];  in dw9768_probe()
452 				      dw9768->supplies);  in dw9768_probe()
464 	dw9768->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in dw9768_probe()
465 	dw9768->sd.internal_ops = &dw9768_int_ops;  in dw9768_probe()
467 	ret = media_entity_pads_init(&dw9768->sd.entity, 0, NULL);  in dw9768_probe()
471 	dw9768->sd.entity.function = MEDIA_ENT_F_LENS;  in dw9768_probe()
492 	ret = v4l2_async_register_subdev(&dw9768->sd);  in dw9768_probe()
509 	media_entity_cleanup(&dw9768->sd.entity);  in dw9768_probe()
511 	v4l2_ctrl_handler_free(&dw9768->ctrls);  in dw9768_probe()
520 	struct device *dev = &client->dev;  in dw9768_remove()
522 	v4l2_async_unregister_subdev(&dw9768->sd);  in dw9768_remove()
523 	v4l2_ctrl_handler_free(&dw9768->ctrls);  in dw9768_remove()
524 	media_entity_cleanup(&dw9768->sd.entity);  in dw9768_remove()