1 // SPDX-License-Identifier: GPL-2.0
10 #include <media/v4l2-ctrls.h>
11 #include <media/v4l2-device.h>
30  * DW9807 separates two registers to control the VCM position.
61 		dev_err(&client->dev, "I2C write STATUS address fail ret = %d\n",  in dw9807_i2c_check()
68 		dev_err(&client->dev, "I2C read STATUS value fail ret = %d\n",  in dw9807_i2c_check()
85 	 * write VCM position. This ensure that we really write the value  in dw9807_set_dac()
93 			dev_warn(&client->dev,  in dw9807_set_dac()
94 				"Cannot do the write operation because VCM is busy\n");  in dw9807_set_dac()
97 		return ret ? -EBUSY : val;  in dw9807_set_dac()
100 	/* Write VCM position to registers */  in dw9807_set_dac()
103 		dev_err(&client->dev,  in dw9807_set_dac()
114 	struct dw9807_device *dev_vcm = container_of(ctrl->handler,  in dw9807_set_ctrl()
117 	if (ctrl->id == V4L2_CID_FOCUS_ABSOLUTE) {  in dw9807_set_ctrl()
118 		struct i2c_client *client = v4l2_get_subdevdata(&dev_vcm->sd);  in dw9807_set_ctrl()
120 		dev_vcm->current_val = ctrl->val;  in dw9807_set_ctrl()
121 		return dw9807_set_dac(client, ctrl->val);  in dw9807_set_ctrl()
124 	return -EINVAL;  in dw9807_set_ctrl()
135 	rval = pm_runtime_get_sync(sd->dev);  in dw9807_open()
137 		pm_runtime_put_noidle(sd->dev);  in dw9807_open()
146 	pm_runtime_put(sd->dev);  in dw9807_close()
160 	v4l2_async_unregister_subdev(&dw9807_dev->sd);  in dw9807_subdev_cleanup()
161 	v4l2_ctrl_handler_free(&dw9807_dev->ctrls_vcm);  in dw9807_subdev_cleanup()
162 	media_entity_cleanup(&dw9807_dev->sd.entity);  in dw9807_subdev_cleanup()
167 	struct v4l2_ctrl_handler *hdl = &dev_vcm->ctrls_vcm;  in dw9807_init_controls()
169 	struct i2c_client *client = v4l2_get_subdevdata(&dev_vcm->sd);  in dw9807_init_controls()
176 	dev_vcm->sd.ctrl_handler = hdl;  in dw9807_init_controls()
177 	if (hdl->error) {  in dw9807_init_controls()
178 		dev_err(&client->dev, "%s fail error: 0x%x\n",  in dw9807_init_controls()
179 			__func__, hdl->error);  in dw9807_init_controls()
180 		return hdl->error;  in dw9807_init_controls()
191 	dw9807_dev = devm_kzalloc(&client->dev, sizeof(*dw9807_dev),  in dw9807_probe()
194 		return -ENOMEM;  in dw9807_probe()
196 	v4l2_i2c_subdev_init(&dw9807_dev->sd, client, &dw9807_ops);  in dw9807_probe()
197 	dw9807_dev->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in dw9807_probe()
198 	dw9807_dev->sd.internal_ops = &dw9807_int_ops;  in dw9807_probe()
204 	rval = media_entity_pads_init(&dw9807_dev->sd.entity, 0, NULL);  in dw9807_probe()
208 	dw9807_dev->sd.entity.function = MEDIA_ENT_F_LENS;  in dw9807_probe()
210 	rval = v4l2_async_register_subdev(&dw9807_dev->sd);  in dw9807_probe()
214 	pm_runtime_set_active(&client->dev);  in dw9807_probe()
215 	pm_runtime_enable(&client->dev);  in dw9807_probe()
216 	pm_runtime_idle(&client->dev);  in dw9807_probe()
221 	v4l2_ctrl_handler_free(&dw9807_dev->ctrls_vcm);  in dw9807_probe()
222 	media_entity_cleanup(&dw9807_dev->sd.entity);  in dw9807_probe()
232 	pm_runtime_disable(&client->dev);  in dw9807_remove()
240  * This function sets the vcm position, so it consumes least current
252 	for (val = dw9807_dev->current_val & ~(DW9807_CTRL_STEPS - 1);  in dw9807_vcm_suspend()
253 	     val >= 0; val -= DW9807_CTRL_STEPS) {  in dw9807_vcm_suspend()
263 		dev_err(&client->dev, "I2C write CTL fail ret = %d\n", ret);  in dw9807_vcm_suspend()
271  * This function sets the vcm position to the value set by the user
287 		dev_err(&client->dev, "I2C write CTL fail ret = %d\n", ret);  in dw9807_vcm_resume()
291 	for (val = dw9807_dev->current_val % DW9807_CTRL_STEPS;  in dw9807_vcm_resume()
292 	     val < dw9807_dev->current_val + DW9807_CTRL_STEPS - 1;  in dw9807_vcm_resume()
305 	{ .compatible = "dongwoon,dw9807-vcm" },
317 		.name = "dw9807",
328 MODULE_DESCRIPTION("DW9807 VCM driver");