2  * Samsung S5K6A3 image sensor driver
25 #include <media/v4l2-async.h>
26 #include <media/v4l2-subdev.h>
48  * struct s5k6a3 - fimc-is sensor data structure
50  * @subdev: the image sensor's v4l2 subdev
52  * @supplies: image sensor's voltage regulator supplies
53  * @gpio_reset: GPIO connected to the sensor's reset pin
55  * @format: media bus format at the sensor's source pad
98 		if (mf->code == s5k6a3_formats[i].code)  in find_sensor_format()
108 	if (code->index >= ARRAY_SIZE(s5k6a3_formats))  in s5k6a3_enum_mbus_code()
109 		return -EINVAL;  in s5k6a3_enum_mbus_code()
111 	code->code = s5k6a3_formats[code->index].code;  in s5k6a3_enum_mbus_code()
120 	mf->code = fmt->code;  in s5k6a3_try_format()
121 	mf->field = V4L2_FIELD_NONE;  in s5k6a3_try_format()
122 	v4l_bound_align_image(&mf->width, S5K6A3_SENSOR_MIN_WIDTH,  in s5k6a3_try_format()
124 			      &mf->height, S5K6A3_SENSOR_MIN_HEIGHT,  in s5k6a3_try_format()
129 		struct s5k6a3 *sensor, struct v4l2_subdev_pad_config *cfg,  in __s5k6a3_get_format()  argument
133 		return cfg ? v4l2_subdev_get_try_format(&sensor->subdev, cfg, pad) : NULL;  in __s5k6a3_get_format()
135 	return &sensor->format;  in __s5k6a3_get_format()
142 	struct s5k6a3 *sensor = sd_to_s5k6a3(sd);  in s5k6a3_set_fmt()  local
145 	s5k6a3_try_format(&fmt->format);  in s5k6a3_set_fmt()
147 	mf = __s5k6a3_get_format(sensor, cfg, fmt->pad, fmt->which);  in s5k6a3_set_fmt()
149 		mutex_lock(&sensor->lock);  in s5k6a3_set_fmt()
150 		*mf = fmt->format;  in s5k6a3_set_fmt()
151 		mutex_unlock(&sensor->lock);  in s5k6a3_set_fmt()
160 	struct s5k6a3 *sensor = sd_to_s5k6a3(sd);  in s5k6a3_get_fmt()  local
163 	mf = __s5k6a3_get_format(sensor, cfg, fmt->pad, fmt->which);  in s5k6a3_get_fmt()
165 	mutex_lock(&sensor->lock);  in s5k6a3_get_fmt()
166 	fmt->format = *mf;  in s5k6a3_get_fmt()
167 	mutex_unlock(&sensor->lock);  in s5k6a3_get_fmt()
179 	struct v4l2_mbus_framefmt *format = v4l2_subdev_get_try_format(sd, fh->pad, 0);  in s5k6a3_open()
182 	format->width	= S5K6A3_DEFAULT_WIDTH;  in s5k6a3_open()
183 	format->height	= S5K6A3_DEFAULT_HEIGHT;  in s5k6a3_open()
192 static int __s5k6a3_power_on(struct s5k6a3 *sensor)  in __s5k6a3_power_on()  argument
197 	ret = clk_set_rate(sensor->clock, sensor->clock_frequency);  in __s5k6a3_power_on()
201 	ret = pm_runtime_get(sensor->dev);  in __s5k6a3_power_on()
205 	ret = regulator_enable(sensor->supplies[i].consumer);  in __s5k6a3_power_on()
209 	ret = clk_prepare_enable(sensor->clock);  in __s5k6a3_power_on()
214 		ret = regulator_enable(sensor->supplies[i].consumer);  in __s5k6a3_power_on()
219 	gpio_set_value(sensor->gpio_reset, 1);  in __s5k6a3_power_on()
221 	gpio_set_value(sensor->gpio_reset, 0);  in __s5k6a3_power_on()
223 	gpio_set_value(sensor->gpio_reset, 1);  in __s5k6a3_power_on()
225 	/* Delay needed for the sensor initialization */  in __s5k6a3_power_on()
230 	for (--i; i >= 0; --i)  in __s5k6a3_power_on()
231 		regulator_disable(sensor->supplies[i].consumer);  in __s5k6a3_power_on()
233 	pm_runtime_put(sensor->dev);  in __s5k6a3_power_on()
237 static int __s5k6a3_power_off(struct s5k6a3 *sensor)  in __s5k6a3_power_off()  argument
241 	gpio_set_value(sensor->gpio_reset, 0);  in __s5k6a3_power_off()
243 	for (i = S5K6A3_NUM_SUPPLIES - 1; i >= 0; i--)  in __s5k6a3_power_off()
244 		regulator_disable(sensor->supplies[i].consumer);  in __s5k6a3_power_off()
246 	clk_disable_unprepare(sensor->clock);  in __s5k6a3_power_off()
247 	pm_runtime_put(sensor->dev);  in __s5k6a3_power_off()
253 	struct s5k6a3 *sensor = sd_to_s5k6a3(sd);  in s5k6a3_s_power()  local
256 	mutex_lock(&sensor->lock);  in s5k6a3_s_power()
258 	if (sensor->power_count == !on) {  in s5k6a3_s_power()
260 			ret = __s5k6a3_power_on(sensor);  in s5k6a3_s_power()
262 			ret = __s5k6a3_power_off(sensor);  in s5k6a3_s_power()
265 			sensor->power_count += on ? 1 : -1;  in s5k6a3_s_power()
268 	mutex_unlock(&sensor->lock);  in s5k6a3_s_power()
284 	struct device *dev = &client->dev;  in s5k6a3_probe()
285 	struct s5k6a3 *sensor;  in s5k6a3_probe()  local
289 	sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);  in s5k6a3_probe()
290 	if (!sensor)  in s5k6a3_probe()
291 		return -ENOMEM;  in s5k6a3_probe()
293 	mutex_init(&sensor->lock);  in s5k6a3_probe()
294 	sensor->gpio_reset = -EINVAL;  in s5k6a3_probe()
295 	sensor->clock = ERR_PTR(-EINVAL);  in s5k6a3_probe()
296 	sensor->dev = dev;  in s5k6a3_probe()
298 	sensor->clock = devm_clk_get(sensor->dev, S5K6A3_CLK_NAME);  in s5k6a3_probe()
299 	if (IS_ERR(sensor->clock))  in s5k6a3_probe()
300 		return PTR_ERR(sensor->clock);  in s5k6a3_probe()
302 	gpio = of_get_gpio_flags(dev->of_node, 0, NULL);  in s5k6a3_probe()
311 	sensor->gpio_reset = gpio;  in s5k6a3_probe()
313 	if (of_property_read_u32(dev->of_node, "clock-frequency",  in s5k6a3_probe()
314 				 &sensor->clock_frequency)) {  in s5k6a3_probe()
315 		sensor->clock_frequency = S5K6A3_DEFAULT_CLK_FREQ;  in s5k6a3_probe()
317 					sensor->clock_frequency);  in s5k6a3_probe()
321 		sensor->supplies[i].supply = s5k6a3_supply_names[i];  in s5k6a3_probe()
323 	ret = devm_regulator_bulk_get(&client->dev, S5K6A3_NUM_SUPPLIES,  in s5k6a3_probe()
324 				      sensor->supplies);  in s5k6a3_probe()
328 	sd = &sensor->subdev;  in s5k6a3_probe()
330 	sensor->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in s5k6a3_probe()
331 	sd->internal_ops = &s5k6a3_sd_internal_ops;  in s5k6a3_probe()
333 	sensor->format.code = s5k6a3_formats[0].code;  in s5k6a3_probe()
334 	sensor->format.width = S5K6A3_DEFAULT_WIDTH;  in s5k6a3_probe()
335 	sensor->format.height = S5K6A3_DEFAULT_HEIGHT;  in s5k6a3_probe()
337 	sd->entity.function = MEDIA_ENT_F_CAM_SENSOR;  in s5k6a3_probe()
338 	sensor->pad.flags = MEDIA_PAD_FL_SOURCE;  in s5k6a3_probe()
339 	ret = media_entity_pads_init(&sd->entity, 1, &sensor->pad);  in s5k6a3_probe()
349 		pm_runtime_disable(&client->dev);  in s5k6a3_probe()
350 		media_entity_cleanup(&sd->entity);  in s5k6a3_probe()
360 	pm_runtime_disable(&client->dev);  in s5k6a3_remove()
362 	media_entity_cleanup(&sd->entity);  in s5k6a3_remove()
391 MODULE_DESCRIPTION("S5K6A3 image sensor subdev driver");