Commit a3505755 authored by Guennadi Liakhovetski's avatar Guennadi Liakhovetski Committed by Mauro Carvalho Chehab
Browse files

[media] V4L: mt9t031: support the new mbus-config subdev ops 



Extend the driver to also support [gs]_mbus_config() subdevice video
operations.

Signed-off-by: default avatarGuennadi Liakhovetski <g.liakhovetski@gmx.de>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 0c0b446d

drivers/media/video/mt9t031.c

+33 −0
Original line number Diff line number Diff line
@@ -16,6 +16,7 @@ 
#include <linux/videodev2.h>



#include <media/soc_camera.h>

#include <media/soc_mediabus.h>

#include <media/v4l2-chip-ident.h>

#include <media/v4l2-subdev.h>
@@ -807,6 +808,36 @@ static int mt9t031_enum_fmt(struct v4l2_subdev *sd, unsigned int index, 
	return 0;

}



static int mt9t031_g_mbus_config(struct v4l2_subdev *sd,

				struct v4l2_mbus_config *cfg)

{

	struct i2c_client *client = v4l2_get_subdevdata(sd);

	struct soc_camera_device *icd = client->dev.platform_data;

	struct soc_camera_link *icl = to_soc_camera_link(icd);



	cfg->flags = V4L2_MBUS_MASTER | V4L2_MBUS_PCLK_SAMPLE_RISING |

		V4L2_MBUS_PCLK_SAMPLE_FALLING | V4L2_MBUS_HSYNC_ACTIVE_HIGH |

		V4L2_MBUS_VSYNC_ACTIVE_HIGH | V4L2_MBUS_DATA_ACTIVE_HIGH;

	cfg->type = V4L2_MBUS_PARALLEL;

	cfg->flags = soc_camera_apply_board_flags(icl, cfg);



	return 0;

}



static int mt9t031_s_mbus_config(struct v4l2_subdev *sd,

				const struct v4l2_mbus_config *cfg)

{

	struct i2c_client *client = v4l2_get_subdevdata(sd);

	struct soc_camera_device *icd = client->dev.platform_data;

	struct soc_camera_link *icl = to_soc_camera_link(icd);



	if (soc_camera_apply_board_flags(icl, cfg) &

	    V4L2_MBUS_PCLK_SAMPLE_FALLING)

		return reg_clear(client, MT9T031_PIXEL_CLOCK_CONTROL, 0x8000);

	else

		return reg_set(client, MT9T031_PIXEL_CLOCK_CONTROL, 0x8000);

}



static struct v4l2_subdev_video_ops mt9t031_subdev_video_ops = {

	.s_stream	= mt9t031_s_stream,

	.s_mbus_fmt	= mt9t031_s_fmt,
@@ -816,6 +847,8 @@ static struct v4l2_subdev_video_ops mt9t031_subdev_video_ops = { 
	.g_crop		= mt9t031_g_crop,

	.cropcap	= mt9t031_cropcap,

	.enum_mbus_fmt	= mt9t031_enum_fmt,

	.g_mbus_config	= mt9t031_g_mbus_config,

	.s_mbus_config	= mt9t031_s_mbus_config,

};



static struct v4l2_subdev_sensor_ops mt9t031_subdev_sensor_ops = {