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)
18  * This sets the minimum granularity for the focus positions.
19  * A value of 1 gives maximum accuracy for a desired focus position
78  * DW9768 requires waiting time (delay time) of t_OPR after power-up,
82 #define DW9768_TVIB_MS_BASE10			(64 - 1)
88  * This acts as the minimum granularity of lens movement.
90  * uniformly adjusted for gradual lens movement, with desired
104 	struct v4l2_ctrl *focus;  member
199 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_mod_reg()
213 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_set_dac()
221 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_init()
245 			     dw9768->aac_mode << 5);  in dw9768_init()
250 	if (dw9768->clock_presc != DW9768_CLOCK_PRE_SCALE_DEFAULT) {  in dw9768_init()
253 				     dw9768->clock_presc);  in dw9768_init()
259 	if (dw9768->aac_timing != DW9768_AAC_TIME_DEFAULT) {  in dw9768_init()
261 						dw9768->aac_timing);  in dw9768_init()
266 	for (val = dw9768->focus->val % DW9768_MOVE_STEPS;  in dw9768_init()
267 	     val <= dw9768->focus->val;  in dw9768_init()
271 			dev_err(&client->dev, "I2C failure: %d", ret);  in dw9768_init()
274 		usleep_range(dw9768->move_delay_us,  in dw9768_init()
275 			     dw9768->move_delay_us + 1000);  in dw9768_init()
283 	struct i2c_client *client = v4l2_get_subdevdata(&dw9768->sd);  in dw9768_release()
286 	val = round_down(dw9768->focus->val, DW9768_MOVE_STEPS);  in dw9768_release()
287 	for ( ; val >= 0; val -= DW9768_MOVE_STEPS) {  in dw9768_release()
290 			dev_err(&client->dev, "I2C write fail: %d", ret);  in dw9768_release()
293 		usleep_range(dw9768->move_delay_us,  in dw9768_release()
294 			     dw9768->move_delay_us + 1000);  in dw9768_release()
318 			       dw9768->supplies);  in dw9768_runtime_suspend()
330 				    dw9768->supplies);  in dw9768_runtime_resume()
338 	 * I2C commands after power-up.  in dw9768_runtime_resume()
350 			       dw9768->supplies);  in dw9768_runtime_resume()
357 	struct dw9768 *dw9768 = container_of(ctrl->handler,  in dw9768_set_ctrl()
360 	if (ctrl->id == V4L2_CID_FOCUS_ABSOLUTE)  in dw9768_set_ctrl()
361 		return dw9768_set_dac(dw9768, ctrl->val);  in dw9768_set_ctrl()
372 	return pm_runtime_resume_and_get(sd->dev);  in dw9768_open()
377 	pm_runtime_mark_last_busy(sd->dev);  in dw9768_close()
378 	pm_runtime_put_autosuspend(sd->dev);  in dw9768_close()
392 	struct v4l2_ctrl_handler *hdl = &dw9768->ctrls;  in dw9768_init_controls()
397 	dw9768->focus = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FOCUS_ABSOLUTE, 0,  in dw9768_init_controls()
401 	if (hdl->error)  in dw9768_init_controls()
402 		return hdl->error;  in dw9768_init_controls()
404 	dw9768->sd.ctrl_handler = hdl;  in dw9768_init_controls()
411 	struct device *dev = &client->dev;  in dw9768_probe()
419 		return -ENOMEM;  in dw9768_probe()
422 	v4l2_i2c_subdev_init(&dw9768->sd, client, &dw9768_ops);  in dw9768_probe()
424 	dw9768->aac_mode = DW9768_AAC_MODE_DEFAULT;  in dw9768_probe()
425 	dw9768->aac_timing = DW9768_AAC_TIME_DEFAULT;  in dw9768_probe()
426 	dw9768->clock_presc = DW9768_CLOCK_PRE_SCALE_DEFAULT;  in dw9768_probe()
429 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,aac-mode",  in dw9768_probe()
430 				 &dw9768->aac_mode);  in dw9768_probe()
432 	/* Optional indication of clock pre-scale select */  in dw9768_probe()
433 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,clock-presc",  in dw9768_probe()
434 				 &dw9768->clock_presc);  in dw9768_probe()
437 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,aac-timing",  in dw9768_probe()
438 				 &dw9768->aac_timing);  in dw9768_probe()
440 	dw9768->move_delay_us = dw9768_cal_move_delay(dw9768->aac_mode,  in dw9768_probe()
441 						      dw9768->clock_presc,  in dw9768_probe()
442 						      dw9768->aac_timing);  in dw9768_probe()
445 		dw9768->supplies[i].supply = dw9768_supply_names[i];  in dw9768_probe()
448 				      dw9768->supplies);  in dw9768_probe()
460 	dw9768->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in dw9768_probe()
461 	dw9768->sd.internal_ops = &dw9768_int_ops;  in dw9768_probe()
463 	ret = media_entity_pads_init(&dw9768->sd.entity, 0, NULL);  in dw9768_probe()
467 	dw9768->sd.entity.function = MEDIA_ENT_F_LENS;  in dw9768_probe()
488 	ret = v4l2_async_register_subdev(&dw9768->sd);  in dw9768_probe()
507 	media_entity_cleanup(&dw9768->sd.entity);  in dw9768_probe()
509 	v4l2_ctrl_handler_free(&dw9768->ctrls);  in dw9768_probe()
518 	struct device *dev = &client->dev;  in dw9768_remove()
520 	v4l2_async_unregister_subdev(&dw9768->sd);  in dw9768_remove()
521 	v4l2_ctrl_handler_free(&dw9768->ctrls);  in dw9768_remove()
522 	media_entity_cleanup(&dw9768->sd.entity);  in dw9768_remove()