621 static struct ov2640_priv *to_ov2640(const struct i2c_client *client)  in to_ov2640()  argument
623 	return container_of(i2c_get_clientdata(client), struct ov2640_priv,  in to_ov2640()
627 static int ov2640_write_array(struct i2c_client *client,  in ov2640_write_array()  argument
633 		ret = i2c_smbus_write_byte_data(client,  in ov2640_write_array()
635 		dev_vdbg(&client->dev, "array: 0x%02x, 0x%02x",  in ov2640_write_array()
645 static int ov2640_mask_set(struct i2c_client *client,  in ov2640_mask_set()  argument
648 	s32 val = i2c_smbus_read_byte_data(client, reg);  in ov2640_mask_set()
655 	dev_vdbg(&client->dev, "masks: 0x%02x, 0x%02x", reg, val);  in ov2640_mask_set()
657 	return i2c_smbus_write_byte_data(client, reg, val);  in ov2640_mask_set()
660 static int ov2640_reset(struct i2c_client *client)  in ov2640_reset()  argument
669 	ret = ov2640_write_array(client, reset_seq);  in ov2640_reset()
675 	dev_dbg(&client->dev, "%s: (ret %d)", __func__, ret);  in ov2640_reset()
691 	struct i2c_client  *client = v4l2_get_subdevdata(sd);  in ov2640_s_ctrl()  local
695 	ret = i2c_smbus_write_byte_data(client, BANK_SEL, BANK_SEL_SENS);  in ov2640_s_ctrl()
702 		return ov2640_mask_set(client, REG04, REG04_VFLIP_IMG, val);  in ov2640_s_ctrl()
705 		return ov2640_mask_set(client, REG04, REG04_HFLIP_IMG, val);  in ov2640_s_ctrl()
715 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in ov2640_g_register()  local
722 	ret = i2c_smbus_read_byte_data(client, reg->reg);  in ov2640_g_register()
734 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in ov2640_s_register()  local
740 	return i2c_smbus_write_byte_data(client, reg->reg, reg->val);  in ov2640_s_register()
746 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in ov2640_s_power()  local
747 	struct soc_camera_subdev_desc *ssdd = soc_camera_i2c_to_desc(client);  in ov2640_s_power()
748 	struct ov2640_priv *priv = to_ov2640(client);  in ov2640_s_power()
750 	return soc_camera_set_power(&client->dev, ssdd, priv->clk, on);  in ov2640_s_power()
772 static int ov2640_set_params(struct i2c_client *client, u32 *width, u32 *height,  in ov2640_set_params()  argument
775 	struct ov2640_priv       *priv = to_ov2640(client);  in ov2640_set_params()
786 		dev_dbg(&client->dev, "%s: Selected cfmt RGB565 BE", __func__);  in ov2640_set_params()
790 		dev_dbg(&client->dev, "%s: Selected cfmt RGB565 LE", __func__);  in ov2640_set_params()
794 		dev_dbg(&client->dev, "%s: Selected cfmt YUYV (YUV422)", __func__);  in ov2640_set_params()
799 		dev_dbg(&client->dev, "%s: Selected cfmt UYVY", __func__);  in ov2640_set_params()
804 	ov2640_reset(client);  in ov2640_set_params()
807 	dev_dbg(&client->dev, "%s: Init default", __func__);  in ov2640_set_params()
808 	ret = ov2640_write_array(client, ov2640_init_regs);  in ov2640_set_params()
813 	dev_dbg(&client->dev, "%s: Set size to %s", __func__, priv->win->name);  in ov2640_set_params()
814 	ret = ov2640_write_array(client, ov2640_size_change_preamble_regs);  in ov2640_set_params()
819 	ret = ov2640_write_array(client, priv->win->regs);  in ov2640_set_params()
824 	dev_dbg(&client->dev, "%s: Set cfmt", __func__);  in ov2640_set_params()
825 	ret = ov2640_write_array(client, ov2640_format_change_preamble_regs);  in ov2640_set_params()
830 	ret = ov2640_write_array(client, selected_cfmt_regs);  in ov2640_set_params()
841 	dev_err(&client->dev, "%s: Error %d", __func__, ret);  in ov2640_set_params()
842 	ov2640_reset(client);  in ov2640_set_params()
853 	struct i2c_client  *client = v4l2_get_subdevdata(sd);  in ov2640_get_fmt()  local
854 	struct ov2640_priv *priv = to_ov2640(client);  in ov2640_get_fmt()
889 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in ov2640_set_fmt()  local
914 		return ov2640_set_params(client, &mf->width,  in ov2640_set_fmt()
956 static int ov2640_video_probe(struct i2c_client *client)  in ov2640_video_probe()  argument
958 	struct ov2640_priv *priv = to_ov2640(client);  in ov2640_video_probe()
970 	i2c_smbus_write_byte_data(client, BANK_SEL, BANK_SEL_SENS);  in ov2640_video_probe()
971 	pid  = i2c_smbus_read_byte_data(client, PID);  in ov2640_video_probe()
972 	ver  = i2c_smbus_read_byte_data(client, VER);  in ov2640_video_probe()
973 	midh = i2c_smbus_read_byte_data(client, MIDH);  in ov2640_video_probe()
974 	midl = i2c_smbus_read_byte_data(client, MIDL);  in ov2640_video_probe()
981 		dev_err(&client->dev,  in ov2640_video_probe()
987 	dev_info(&client->dev,  in ov2640_video_probe()
1013 	struct i2c_client *client = v4l2_get_subdevdata(sd);  in ov2640_g_mbus_config()  local
1014 	struct soc_camera_subdev_desc *ssdd = soc_camera_i2c_to_desc(client);  in ov2640_g_mbus_config()
1047 	struct i2c_client *client = to_i2c_client(dev);  in ov2640_hw_power()  local
1048 	struct ov2640_priv *priv = to_ov2640(client);  in ov2640_hw_power()
1050 	dev_dbg(&client->dev, "%s: %s the camera\n",  in ov2640_hw_power()
1061 	struct i2c_client *client = to_i2c_client(dev);  in ov2640_hw_reset()  local
1062 	struct ov2640_priv *priv = to_ov2640(client);  in ov2640_hw_reset()
1074 static int ov2640_probe_dt(struct i2c_client *client,  in ov2640_probe_dt()  argument
1078 	priv->resetb_gpio = devm_gpiod_get_optional(&client->dev, "resetb",  in ov2640_probe_dt()
1081 		dev_dbg(&client->dev, "resetb gpio is not assigned!\n");  in ov2640_probe_dt()
1086 	priv->pwdn_gpio = devm_gpiod_get_optional(&client->dev, "pwdn",  in ov2640_probe_dt()
1089 		dev_dbg(&client->dev, "pwdn gpio is not assigned!\n");  in ov2640_probe_dt()
1096 	client->dev.platform_data = &priv->ssdd_dt;  in ov2640_probe_dt()
1104 static int ov2640_probe(struct i2c_client *client,  in ov2640_probe()  argument
1108 	struct soc_camera_subdev_desc *ssdd = soc_camera_i2c_to_desc(client);  in ov2640_probe()
1109 	struct i2c_adapter	*adapter = to_i2c_adapter(client->dev.parent);  in ov2640_probe()
1118 	priv = devm_kzalloc(&client->dev, sizeof(struct ov2640_priv), GFP_KERNEL);  in ov2640_probe()
1125 	priv->clk = v4l2_clk_get(&client->dev, "xvclk");  in ov2640_probe()
1129 	if (!ssdd && !client->dev.of_node) {  in ov2640_probe()
1130 		dev_err(&client->dev, "Missing platform_data for driver\n");  in ov2640_probe()
1136 		ret = ov2640_probe_dt(client, priv);  in ov2640_probe()
1141 	v4l2_i2c_subdev_init(&priv->subdev, client, &ov2640_subdev_ops);  in ov2640_probe()
1153 	ret = ov2640_video_probe(client);  in ov2640_probe()
1172 static int ov2640_remove(struct i2c_client *client)  in ov2640_remove()  argument
1174 	struct ov2640_priv       *priv = to_ov2640(client);  in ov2640_remove()