204 struct mt9m111 {  struct
220 static const struct mt9m111_datafmt *mt9m111_find_datafmt(struct mt9m111 *mt9m111,  in mt9m111_find_datafmt()  argument
228 	return mt9m111->fmt;  in mt9m111_find_datafmt()
231 static struct mt9m111 *to_mt9m111(const struct i2c_client *client)  in to_mt9m111()
233 	return container_of(i2c_get_clientdata(client), struct mt9m111, subdev);  in to_mt9m111()
240 	struct mt9m111 *mt9m111 = to_mt9m111(client);  in reg_page_map_set()  local
243 	if (page == mt9m111->lastpage)  in reg_page_map_set()
250 		mt9m111->lastpage = page;  in reg_page_map_set()
311 static int mt9m111_set_context(struct mt9m111 *mt9m111,  in mt9m111_set_context()  argument
314 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_set_context()
318 static int mt9m111_setup_rect_ctx(struct mt9m111 *mt9m111,  in mt9m111_setup_rect_ctx()  argument
322 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_setup_rect_ctx()
333 static int mt9m111_setup_geometry(struct mt9m111 *mt9m111, struct v4l2_rect *rect,  in mt9m111_setup_geometry()  argument
336 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_setup_geometry()
351 			ret = mt9m111_setup_rect_ctx(mt9m111, &context_b,  in mt9m111_setup_geometry()
354 			ret = mt9m111_setup_rect_ctx(mt9m111, &context_a,  in mt9m111_setup_geometry()
365 static int mt9m111_enable(struct mt9m111 *mt9m111)  in mt9m111_enable()  argument
367 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_enable()
371 static int mt9m111_reset(struct mt9m111 *mt9m111)  in mt9m111_reset()  argument
373 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_reset()
389 	struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);  in mt9m111_s_crop()  local
396 	if (mt9m111->fmt->code == MEDIA_BUS_FMT_SBGGR8_1X8 ||  in mt9m111_s_crop()
397 	    mt9m111->fmt->code == MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE) {  in mt9m111_s_crop()
411 	width = min(mt9m111->width, rect.width);  in mt9m111_s_crop()
412 	height = min(mt9m111->height, rect.height);  in mt9m111_s_crop()
414 	ret = mt9m111_setup_geometry(mt9m111, &rect, width, height, mt9m111->fmt->code);  in mt9m111_s_crop()
416 		mt9m111->rect = rect;  in mt9m111_s_crop()
417 		mt9m111->width = width;  in mt9m111_s_crop()
418 		mt9m111->height = height;  in mt9m111_s_crop()
426 	struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);  in mt9m111_g_crop()  local
428 	a->c	= mt9m111->rect;  in mt9m111_g_crop()
453 	struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);  in mt9m111_g_fmt()  local
455 	mf->width	= mt9m111->width;  in mt9m111_g_fmt()
456 	mf->height	= mt9m111->height;  in mt9m111_g_fmt()
457 	mf->code	= mt9m111->fmt->code;  in mt9m111_g_fmt()
458 	mf->colorspace	= mt9m111->fmt->colorspace;  in mt9m111_g_fmt()
464 static int mt9m111_set_pixfmt(struct mt9m111 *mt9m111,  in mt9m111_set_pixfmt()  argument
467 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_set_pixfmt()
538 	struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);  in mt9m111_try_fmt()  local
540 	struct v4l2_rect *rect = &mt9m111->rect;  in mt9m111_try_fmt()
543 	fmt = mt9m111_find_datafmt(mt9m111, mf->code);  in mt9m111_try_fmt()
582 	struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);  in mt9m111_s_fmt()  local
583 	struct v4l2_rect *rect = &mt9m111->rect;  in mt9m111_s_fmt()
587 	fmt = mt9m111_find_datafmt(mt9m111, mf->code);  in mt9m111_s_fmt()
590 	ret = mt9m111_setup_geometry(mt9m111, rect, mf->width, mf->height, mf->code);  in mt9m111_s_fmt()
592 		ret = mt9m111_set_pixfmt(mt9m111, mf->code);  in mt9m111_s_fmt()
594 		mt9m111->width	= mf->width;  in mt9m111_s_fmt()
595 		mt9m111->height	= mf->height;  in mt9m111_s_fmt()
596 		mt9m111->fmt	= fmt;  in mt9m111_s_fmt()
637 static int mt9m111_set_flip(struct mt9m111 *mt9m111, int flip, int mask)  in mt9m111_set_flip()  argument
639 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_set_flip()
643 		ret = mt9m111_reg_set(client, mt9m111->ctx->read_mode, mask);  in mt9m111_set_flip()
645 		ret = mt9m111_reg_clear(client, mt9m111->ctx->read_mode, mask);  in mt9m111_set_flip()
650 static int mt9m111_get_global_gain(struct mt9m111 *mt9m111)  in mt9m111_get_global_gain()  argument
652 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_get_global_gain()
662 static int mt9m111_set_global_gain(struct mt9m111 *mt9m111, int gain)  in mt9m111_set_global_gain()  argument
664 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_set_global_gain()
680 static int mt9m111_set_autoexposure(struct mt9m111 *mt9m111, int val)  in mt9m111_set_autoexposure()  argument
682 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_set_autoexposure()
689 static int mt9m111_set_autowhitebalance(struct mt9m111 *mt9m111, int on)  in mt9m111_set_autowhitebalance()  argument
691 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_set_autowhitebalance()
700 	struct mt9m111 *mt9m111 = container_of(ctrl->handler,  in mt9m111_s_ctrl()  local
701 					       struct mt9m111, hdl);  in mt9m111_s_ctrl()
705 		return mt9m111_set_flip(mt9m111, ctrl->val,  in mt9m111_s_ctrl()
708 		return mt9m111_set_flip(mt9m111, ctrl->val,  in mt9m111_s_ctrl()
711 		return mt9m111_set_global_gain(mt9m111, ctrl->val);  in mt9m111_s_ctrl()
713 		return mt9m111_set_autoexposure(mt9m111, ctrl->val);  in mt9m111_s_ctrl()
715 		return mt9m111_set_autowhitebalance(mt9m111, ctrl->val);  in mt9m111_s_ctrl()
721 static int mt9m111_suspend(struct mt9m111 *mt9m111)  in mt9m111_suspend()  argument
723 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_suspend()
726 	v4l2_ctrl_s_ctrl(mt9m111->gain, mt9m111_get_global_gain(mt9m111));  in mt9m111_suspend()
739 static void mt9m111_restore_state(struct mt9m111 *mt9m111)  in mt9m111_restore_state()  argument
741 	mt9m111_set_context(mt9m111, mt9m111->ctx);  in mt9m111_restore_state()
742 	mt9m111_set_pixfmt(mt9m111, mt9m111->fmt->code);  in mt9m111_restore_state()
743 	mt9m111_setup_geometry(mt9m111, &mt9m111->rect,  in mt9m111_restore_state()
744 			mt9m111->width, mt9m111->height, mt9m111->fmt->code);  in mt9m111_restore_state()
745 	v4l2_ctrl_handler_setup(&mt9m111->hdl);  in mt9m111_restore_state()
748 static int mt9m111_resume(struct mt9m111 *mt9m111)  in mt9m111_resume()  argument
750 	int ret = mt9m111_enable(mt9m111);  in mt9m111_resume()
752 		ret = mt9m111_reset(mt9m111);  in mt9m111_resume()
754 		mt9m111_restore_state(mt9m111);  in mt9m111_resume()
759 static int mt9m111_init(struct mt9m111 *mt9m111)  in mt9m111_init()  argument
761 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_init()
764 	ret = mt9m111_enable(mt9m111);  in mt9m111_init()
766 		ret = mt9m111_reset(mt9m111);  in mt9m111_init()
768 		ret = mt9m111_set_context(mt9m111, mt9m111->ctx);  in mt9m111_init()
774 static int mt9m111_power_on(struct mt9m111 *mt9m111)  in mt9m111_power_on()  argument
776 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_power_on()
780 	ret = soc_camera_power_on(&client->dev, ssdd, mt9m111->clk);  in mt9m111_power_on()
784 	ret = mt9m111_resume(mt9m111);  in mt9m111_power_on()
787 		soc_camera_power_off(&client->dev, ssdd, mt9m111->clk);  in mt9m111_power_on()
793 static void mt9m111_power_off(struct mt9m111 *mt9m111)  in mt9m111_power_off()  argument
795 	struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);  in mt9m111_power_off()
798 	mt9m111_suspend(mt9m111);  in mt9m111_power_off()
799 	soc_camera_power_off(&client->dev, ssdd, mt9m111->clk);  in mt9m111_power_off()
804 	struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);  in mt9m111_s_power()  local
807 	mutex_lock(&mt9m111->power_lock);  in mt9m111_s_power()
813 	if (mt9m111->power_count == !on) {  in mt9m111_s_power()
815 			ret = mt9m111_power_on(mt9m111);  in mt9m111_s_power()
817 			mt9m111_power_off(mt9m111);  in mt9m111_s_power()
822 		mt9m111->power_count += on ? 1 : -1;  in mt9m111_s_power()
823 		WARN_ON(mt9m111->power_count < 0);  in mt9m111_s_power()
826 	mutex_unlock(&mt9m111->power_lock);  in mt9m111_s_power()
889 	struct mt9m111 *mt9m111 = to_mt9m111(client);  in mt9m111_video_probe()  local
893 	ret = mt9m111_s_power(&mt9m111->subdev, 1);  in mt9m111_video_probe()
915 	ret = mt9m111_init(mt9m111);  in mt9m111_video_probe()
919 	ret = v4l2_ctrl_handler_setup(&mt9m111->hdl);  in mt9m111_video_probe()
922 	mt9m111_s_power(&mt9m111->subdev, 0);  in mt9m111_video_probe()
929 	struct mt9m111 *mt9m111;  in mt9m111_probe()  local
951 	mt9m111 = devm_kzalloc(&client->dev, sizeof(struct mt9m111), GFP_KERNEL);  in mt9m111_probe()
952 	if (!mt9m111)  in mt9m111_probe()
955 	mt9m111->clk = v4l2_clk_get(&client->dev, "mclk");  in mt9m111_probe()
956 	if (IS_ERR(mt9m111->clk))  in mt9m111_probe()
960 	mt9m111->ctx = &context_b;  in mt9m111_probe()
962 	v4l2_i2c_subdev_init(&mt9m111->subdev, client, &mt9m111_subdev_ops);  in mt9m111_probe()
963 	v4l2_ctrl_handler_init(&mt9m111->hdl, 5);  in mt9m111_probe()
964 	v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,  in mt9m111_probe()
966 	v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,  in mt9m111_probe()
968 	v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,  in mt9m111_probe()
970 	mt9m111->gain = v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,  in mt9m111_probe()
972 	v4l2_ctrl_new_std_menu(&mt9m111->hdl,  in mt9m111_probe()
975 	mt9m111->subdev.ctrl_handler = &mt9m111->hdl;  in mt9m111_probe()
976 	if (mt9m111->hdl.error) {  in mt9m111_probe()
977 		ret = mt9m111->hdl.error;  in mt9m111_probe()
982 	mt9m111->rect.left	= MT9M111_MIN_DARK_COLS;  in mt9m111_probe()
983 	mt9m111->rect.top	= MT9M111_MIN_DARK_ROWS;  in mt9m111_probe()
984 	mt9m111->rect.width	= MT9M111_MAX_WIDTH;  in mt9m111_probe()
985 	mt9m111->rect.height	= MT9M111_MAX_HEIGHT;  in mt9m111_probe()
986 	mt9m111->fmt		= &mt9m111_colour_fmts[0];  in mt9m111_probe()
987 	mt9m111->lastpage	= -1;  in mt9m111_probe()
988 	mutex_init(&mt9m111->power_lock);  in mt9m111_probe()
998 	mt9m111->subdev.dev = &client->dev;  in mt9m111_probe()
999 	ret = v4l2_async_register_subdev(&mt9m111->subdev);  in mt9m111_probe()
1006 	v4l2_ctrl_handler_free(&mt9m111->hdl);  in mt9m111_probe()
1008 	v4l2_clk_put(mt9m111->clk);  in mt9m111_probe()
1015 	struct mt9m111 *mt9m111 = to_mt9m111(client);  in mt9m111_remove()  local
1017 	v4l2_async_unregister_subdev(&mt9m111->subdev);  in mt9m111_remove()
1018 	v4l2_clk_put(mt9m111->clk);  in mt9m111_remove()
1019 	v4l2_ctrl_handler_free(&mt9m111->hdl);  in mt9m111_remove()