168 #define to_dev(sensor) \  argument
169 	(&((struct i2c_client *)v4l2_get_subdevdata(&(sensor)->subdev))->dev)
181 static u32 mt9m032_row_time(struct mt9m032 *sensor, unsigned int width)  in mt9m032_row_time()  argument
187 	ns = div_u64(1000000000ULL * effective_width, sensor->pix_clock);  in mt9m032_row_time()
188 	dev_dbg(to_dev(sensor),	"MT9M032 line time: %u ns\n", ns);  in mt9m032_row_time()
192 static int mt9m032_update_timing(struct mt9m032 *sensor,  in mt9m032_update_timing()  argument
195 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in mt9m032_update_timing()
196 	struct v4l2_rect *crop = &sensor->crop;  in mt9m032_update_timing()
202 		interval = &sensor->frame_interval;  in mt9m032_update_timing()
204 	row_time = mt9m032_row_time(sensor, crop->width);  in mt9m032_update_timing()
228 static int mt9m032_update_geom_timing(struct mt9m032 *sensor)  in mt9m032_update_geom_timing()  argument
230 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in mt9m032_update_geom_timing()
234 			    sensor->crop.width - 1);  in mt9m032_update_geom_timing()
237 				    sensor->crop.height - 1);  in mt9m032_update_geom_timing()
240 				    sensor->crop.left);  in mt9m032_update_geom_timing()
243 				    sensor->crop.top);  in mt9m032_update_geom_timing()
245 		ret = mt9m032_update_timing(sensor, NULL);  in mt9m032_update_geom_timing()
249 static int update_formatter2(struct mt9m032 *sensor, bool streaming)  in update_formatter2()  argument
251 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in update_formatter2()
262 static int mt9m032_setup_pll(struct mt9m032 *sensor)  in mt9m032_setup_pll()  argument
280 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in mt9m032_setup_pll()
281 	struct mt9m032_platform_data *pdata = sensor->pdata;  in mt9m032_setup_pll()
293 	sensor->pix_clock = pdata->pix_clock;  in mt9m032_setup_pll()
354 __mt9m032_get_pad_crop(struct mt9m032 *sensor, struct v4l2_subdev_pad_config *cfg,  in __mt9m032_get_pad_crop()  argument
359 		return v4l2_subdev_get_try_crop(&sensor->subdev, cfg, 0);  in __mt9m032_get_pad_crop()
361 		return &sensor->crop;  in __mt9m032_get_pad_crop()
376 __mt9m032_get_pad_format(struct mt9m032 *sensor, struct v4l2_subdev_pad_config *cfg,  in __mt9m032_get_pad_format()  argument
381 		return v4l2_subdev_get_try_format(&sensor->subdev, cfg, 0);  in __mt9m032_get_pad_format()
383 		return &sensor->format;  in __mt9m032_get_pad_format()
393 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_get_pad_format()  local
395 	mutex_lock(&sensor->lock);  in mt9m032_get_pad_format()
396 	fmt->format = *__mt9m032_get_pad_format(sensor, cfg, fmt->which);  in mt9m032_get_pad_format()
397 	mutex_unlock(&sensor->lock);  in mt9m032_get_pad_format()
406 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_set_pad_format()  local
409 	mutex_lock(&sensor->lock);  in mt9m032_set_pad_format()
411 	if (sensor->streaming && fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) {  in mt9m032_set_pad_format()
417 	fmt->format = *__mt9m032_get_pad_format(sensor, cfg, fmt->which);  in mt9m032_set_pad_format()
421 	mutex_unlock(&sensor->lock);  in mt9m032_set_pad_format()
429 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_get_pad_selection()  local
434 	mutex_lock(&sensor->lock);  in mt9m032_get_pad_selection()
435 	sel->r = *__mt9m032_get_pad_crop(sensor, cfg, sel->which);  in mt9m032_get_pad_selection()
436 	mutex_unlock(&sensor->lock);  in mt9m032_get_pad_selection()
445 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_set_pad_selection()  local
454 	mutex_lock(&sensor->lock);  in mt9m032_set_pad_selection()
456 	if (sensor->streaming && sel->which == V4L2_SUBDEV_FORMAT_ACTIVE) {  in mt9m032_set_pad_selection()
478 	__crop = __mt9m032_get_pad_crop(sensor, cfg, sel->which);  in mt9m032_set_pad_selection()
484 		format = __mt9m032_get_pad_format(sensor, cfg, sel->which);  in mt9m032_set_pad_selection()
493 		ret = mt9m032_update_geom_timing(sensor);  in mt9m032_set_pad_selection()
496 	mutex_unlock(&sensor->lock);  in mt9m032_set_pad_selection()
503 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_get_frame_interval()  local
505 	mutex_lock(&sensor->lock);  in mt9m032_get_frame_interval()
507 	fi->interval = sensor->frame_interval;  in mt9m032_get_frame_interval()
508 	mutex_unlock(&sensor->lock);  in mt9m032_get_frame_interval()
516 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_set_frame_interval()  local
519 	mutex_lock(&sensor->lock);  in mt9m032_set_frame_interval()
521 	if (sensor->streaming) {  in mt9m032_set_frame_interval()
530 	ret = mt9m032_update_timing(sensor, &fi->interval);  in mt9m032_set_frame_interval()
532 		sensor->frame_interval = fi->interval;  in mt9m032_set_frame_interval()
535 	mutex_unlock(&sensor->lock);  in mt9m032_set_frame_interval()
541 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_s_stream()  local
544 	mutex_lock(&sensor->lock);  in mt9m032_s_stream()
545 	ret = update_formatter2(sensor, streaming);  in mt9m032_s_stream()
547 		sensor->streaming = streaming;  in mt9m032_s_stream()
548 	mutex_unlock(&sensor->lock);  in mt9m032_s_stream()
561 	struct mt9m032 *sensor = to_mt9m032(sd);  in mt9m032_g_register()  local
562 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in mt9m032_g_register()
581 	struct mt9m032 *sensor = to_mt9m032(sd);  in mt9m032_s_register()  local
582 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in mt9m032_s_register()
595 static int update_read_mode2(struct mt9m032 *sensor, bool vflip, bool hflip)  in update_read_mode2()  argument
597 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in update_read_mode2()
606 static int mt9m032_set_gain(struct mt9m032 *sensor, s32 val)  in mt9m032_set_gain()  argument
608 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in mt9m032_set_gain()
647 	struct mt9m032 *sensor =  in mt9m032_set_ctrl()  local
649 	struct i2c_client *client = v4l2_get_subdevdata(&sensor->subdev);  in mt9m032_set_ctrl()
654 		return mt9m032_set_gain(sensor, ctrl->val);  in mt9m032_set_ctrl()
658 		return update_read_mode2(sensor, sensor->vflip->val,  in mt9m032_set_ctrl()
659 					 sensor->hflip->val);  in mt9m032_set_ctrl()
718 	struct mt9m032 *sensor;  in mt9m032_probe()  local
736 	sensor = devm_kzalloc(&client->dev, sizeof(*sensor), GFP_KERNEL);  in mt9m032_probe()
737 	if (sensor == NULL)  in mt9m032_probe()
740 	mutex_init(&sensor->lock);  in mt9m032_probe()
742 	sensor->pdata = pdata;  in mt9m032_probe()
744 	v4l2_i2c_subdev_init(&sensor->subdev, client, &mt9m032_ops);  in mt9m032_probe()
745 	sensor->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in mt9m032_probe()
758 	sensor->frame_interval.numerator = 1;  in mt9m032_probe()
759 	sensor->frame_interval.denominator = 30;  in mt9m032_probe()
761 	sensor->crop.left = MT9M032_COLUMN_START_DEF;  in mt9m032_probe()
762 	sensor->crop.top = MT9M032_ROW_START_DEF;  in mt9m032_probe()
763 	sensor->crop.width = MT9M032_COLUMN_SIZE_DEF;  in mt9m032_probe()
764 	sensor->crop.height = MT9M032_ROW_SIZE_DEF;  in mt9m032_probe()
766 	sensor->format.width = sensor->crop.width;  in mt9m032_probe()
767 	sensor->format.height = sensor->crop.height;  in mt9m032_probe()
768 	sensor->format.code = MEDIA_BUS_FMT_Y8_1X8;  in mt9m032_probe()
769 	sensor->format.field = V4L2_FIELD_NONE;  in mt9m032_probe()
770 	sensor->format.colorspace = V4L2_COLORSPACE_SRGB;  in mt9m032_probe()
772 	v4l2_ctrl_handler_init(&sensor->ctrls, 5);  in mt9m032_probe()
774 	v4l2_ctrl_new_std(&sensor->ctrls, &mt9m032_ctrl_ops,  in mt9m032_probe()
777 	sensor->hflip = v4l2_ctrl_new_std(&sensor->ctrls,  in mt9m032_probe()
780 	sensor->vflip = v4l2_ctrl_new_std(&sensor->ctrls,  in mt9m032_probe()
784 	v4l2_ctrl_new_std(&sensor->ctrls, &mt9m032_ctrl_ops,  in mt9m032_probe()
788 	v4l2_ctrl_new_std(&sensor->ctrls, &mt9m032_ctrl_ops,  in mt9m032_probe()
792 	if (sensor->ctrls.error) {  in mt9m032_probe()
793 		ret = sensor->ctrls.error;  in mt9m032_probe()
798 	v4l2_ctrl_cluster(2, &sensor->hflip);  in mt9m032_probe()
800 	sensor->subdev.ctrl_handler = &sensor->ctrls;  in mt9m032_probe()
801 	sensor->pad.flags = MEDIA_PAD_FL_SOURCE;  in mt9m032_probe()
802 	ret = media_entity_init(&sensor->subdev.entity, 1, &sensor->pad, 0);  in mt9m032_probe()
813 	ret = mt9m032_setup_pll(sensor);  in mt9m032_probe()
818 	ret = v4l2_ctrl_handler_setup(&sensor->ctrls);  in mt9m032_probe()
823 	ret = mt9m032_update_geom_timing(sensor);  in mt9m032_probe()
839 	if (sensor->pdata->invert_pixclock) {  in mt9m032_probe()
854 	ret = update_formatter2(sensor, false);  in mt9m032_probe()
861 	media_entity_cleanup(&sensor->subdev.entity);  in mt9m032_probe()
863 	v4l2_ctrl_handler_free(&sensor->ctrls);  in mt9m032_probe()
865 	mutex_destroy(&sensor->lock);  in mt9m032_probe()
872 	struct mt9m032 *sensor = to_mt9m032(subdev);  in mt9m032_remove()  local
875 	v4l2_ctrl_handler_free(&sensor->ctrls);  in mt9m032_remove()
877 	mutex_destroy(&sensor->lock);  in mt9m032_remove()