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()
324 			       dw9768->supplies);  in dw9768_runtime_suspend()
337 				    dw9768->supplies);  in dw9768_runtime_resume()
345 	 * I2C commands after power-up.  in dw9768_runtime_resume()
357 			       dw9768->supplies);  in dw9768_runtime_resume()
364 	struct dw9768 *dw9768 = container_of(ctrl->handler,  in dw9768_set_ctrl()
367 	if (ctrl->id == V4L2_CID_FOCUS_ABSOLUTE)  in dw9768_set_ctrl()
368 		return dw9768_set_dac(dw9768, ctrl->val);  in dw9768_set_ctrl()
381 	ret = pm_runtime_get_sync(sd->dev);  in dw9768_open()
383 		pm_runtime_put_noidle(sd->dev);  in dw9768_open()
392 	pm_runtime_put(sd->dev);  in dw9768_close()
406 	struct v4l2_ctrl_handler *hdl = &dw9768->ctrls;  in dw9768_init_controls()
411 	dw9768->focus = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_FOCUS_ABSOLUTE, 0,  in dw9768_init_controls()
415 	if (hdl->error)  in dw9768_init_controls()
416 		return hdl->error;  in dw9768_init_controls()
418 	dw9768->sd.ctrl_handler = hdl;  in dw9768_init_controls()
425 	struct device *dev = &client->dev;  in dw9768_probe()
432 		return -ENOMEM;  in dw9768_probe()
435 	v4l2_i2c_subdev_init(&dw9768->sd, client, &dw9768_ops);  in dw9768_probe()
437 	dw9768->aac_mode = DW9768_AAC_MODE_DEFAULT;  in dw9768_probe()
438 	dw9768->aac_timing = DW9768_AAC_TIME_DEFAULT;  in dw9768_probe()
439 	dw9768->clock_presc = DW9768_CLOCK_PRE_SCALE_DEFAULT;  in dw9768_probe()
442 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,aac-mode",  in dw9768_probe()
443 				 &dw9768->aac_mode);  in dw9768_probe()
445 	/* Optional indication of clock pre-scale select */  in dw9768_probe()
446 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,clock-presc",  in dw9768_probe()
447 				 &dw9768->clock_presc);  in dw9768_probe()
450 	fwnode_property_read_u32(dev_fwnode(dev), "dongwoon,aac-timing",  in dw9768_probe()
451 				 &dw9768->aac_timing);  in dw9768_probe()
453 	dw9768->move_delay_us = dw9768_cal_move_delay(dw9768->aac_mode,  in dw9768_probe()
454 						      dw9768->clock_presc,  in dw9768_probe()
455 						      dw9768->aac_timing);  in dw9768_probe()
458 		dw9768->supplies[i].supply = dw9768_supply_names[i];  in dw9768_probe()
461 				      dw9768->supplies);  in dw9768_probe()
473 	dw9768->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in dw9768_probe()
474 	dw9768->sd.internal_ops = &dw9768_int_ops;  in dw9768_probe()
476 	ret = media_entity_pads_init(&dw9768->sd.entity, 0, NULL);  in dw9768_probe()
480 	dw9768->sd.entity.function = MEDIA_ENT_F_LENS;  in dw9768_probe()
491 	ret = v4l2_async_register_subdev(&dw9768->sd);  in dw9768_probe()
505 	media_entity_cleanup(&dw9768->sd.entity);  in dw9768_probe()
507 	v4l2_ctrl_handler_free(&dw9768->ctrls);  in dw9768_probe()
517 	v4l2_async_unregister_subdev(&dw9768->sd);  in dw9768_remove()
518 	v4l2_ctrl_handler_free(&dw9768->ctrls);  in dw9768_remove()
519 	media_entity_cleanup(&dw9768->sd.entity);  in dw9768_remove()
520 	pm_runtime_disable(&client->dev);  in dw9768_remove()
521 	if (!pm_runtime_status_suspended(&client->dev))  in dw9768_remove()
522 		dw9768_runtime_suspend(&client->dev);  in dw9768_remove()
523 	pm_runtime_set_suspended(&client->dev);  in dw9768_remove()