diff mbox

[v3] v4l: add new v4l2-subdev sensor operations, use g_skip_top_lines in soc-camera

Message ID Pine.LNX.4.64.0908260838551.5167@axis700.grange (mailing list archive)
State RFC
Headers show

Commit Message

Guennadi Liakhovetski Aug. 26, 2009, 6:41 a.m. UTC
Introduce new v4l2-subdev sensor operations, move .enum_framesizes() and
.enum_frameintervals() methods to it, add a new .g_skip_top_lines() method
and switch soc-camera to use it instead of .y_skip_top soc_camera_device
member, which can now be removed.

Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de>
---

Changes since v2: renamed skip_top_lines into g_skip_top_lines, made 
explanation comment hopefully clearer.

 drivers/media/video/mt9m001.c             |   30 ++++++++++++++++++++------
 drivers/media/video/mt9m111.c             |    1 -
 drivers/media/video/mt9t031.c             |    8 ++----
 drivers/media/video/mt9v022.c             |   32 ++++++++++++++++++++--------
 drivers/media/video/pxa_camera.c          |    9 ++++++-
 drivers/media/video/soc_camera_platform.c |    1 -
 include/media/soc_camera.h                |    1 -
 include/media/v4l2-subdev.h               |   13 +++++++++++
 8 files changed, 69 insertions(+), 26 deletions(-)

Comments

Hans Verkuil Aug. 26, 2009, 6:42 a.m. UTC | #1
On Wednesday 26 August 2009 08:41:00 Guennadi Liakhovetski wrote:
> Introduce new v4l2-subdev sensor operations, move .enum_framesizes() and
> .enum_frameintervals() methods to it, add a new .g_skip_top_lines() method
> and switch soc-camera to use it instead of .y_skip_top soc_camera_device
> member, which can now be removed.
> 
> Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de>
> ---
> 
> Changes since v2: renamed skip_top_lines into g_skip_top_lines, made 
> explanation comment hopefully clearer.
> 
>  drivers/media/video/mt9m001.c             |   30 ++++++++++++++++++++------
>  drivers/media/video/mt9m111.c             |    1 -
>  drivers/media/video/mt9t031.c             |    8 ++----
>  drivers/media/video/mt9v022.c             |   32 ++++++++++++++++++++--------
>  drivers/media/video/pxa_camera.c          |    9 ++++++-
>  drivers/media/video/soc_camera_platform.c |    1 -
>  include/media/soc_camera.h                |    1 -
>  include/media/v4l2-subdev.h               |   13 +++++++++++
>  8 files changed, 69 insertions(+), 26 deletions(-)
> 
> diff --git a/drivers/media/video/mt9m001.c b/drivers/media/video/mt9m001.c
> index 45388d2..17be2d4 100644
> --- a/drivers/media/video/mt9m001.c
> +++ b/drivers/media/video/mt9m001.c
> @@ -82,6 +82,7 @@ struct mt9m001 {
>  	int model;	/* V4L2_IDENT_MT9M001* codes from v4l2-chip-ident.h */
>  	unsigned int gain;
>  	unsigned int exposure;
> +	unsigned short y_skip_top;	/* Lines to skip at the top */
>  	unsigned char autoexposure;
>  };
>  
> @@ -222,7 +223,7 @@ static int mt9m001_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
>  	soc_camera_limit_side(&rect.top, &rect.height,
>  		     MT9M001_ROW_SKIP, MT9M001_MIN_HEIGHT, MT9M001_MAX_HEIGHT);
>  
> -	total_h = rect.height + icd->y_skip_top + vblank;
> +	total_h = rect.height + mt9m001->y_skip_top + vblank;
>  
>  	/* Blanking and start values - default... */
>  	ret = reg_write(client, MT9M001_HORIZONTAL_BLANKING, hblank);
> @@ -239,7 +240,7 @@ static int mt9m001_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
>  		ret = reg_write(client, MT9M001_WINDOW_WIDTH, rect.width - 1);
>  	if (!ret)
>  		ret = reg_write(client, MT9M001_WINDOW_HEIGHT,
> -				rect.height + icd->y_skip_top - 1);
> +				rect.height + mt9m001->y_skip_top - 1);
>  	if (!ret && mt9m001->autoexposure) {
>  		ret = reg_write(client, MT9M001_SHUTTER_WIDTH, total_h);
>  		if (!ret) {
> @@ -327,13 +328,13 @@ static int mt9m001_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
>  static int mt9m001_try_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
>  {
>  	struct i2c_client *client = sd->priv;
> -	struct soc_camera_device *icd = client->dev.platform_data;
> +	struct mt9m001 *mt9m001 = to_mt9m001(client);
>  	struct v4l2_pix_format *pix = &f->fmt.pix;
>  
>  	v4l_bound_align_image(&pix->width, MT9M001_MIN_WIDTH,
>  		MT9M001_MAX_WIDTH, 1,
> -		&pix->height, MT9M001_MIN_HEIGHT + icd->y_skip_top,
> -		MT9M001_MAX_HEIGHT + icd->y_skip_top, 0, 0);
> +		&pix->height, MT9M001_MIN_HEIGHT + mt9m001->y_skip_top,
> +		MT9M001_MAX_HEIGHT + mt9m001->y_skip_top, 0, 0);
>  
>  	if (pix->pixelformat == V4L2_PIX_FMT_SBGGR8 ||
>  	    pix->pixelformat == V4L2_PIX_FMT_SBGGR16)
> @@ -552,7 +553,7 @@ static int mt9m001_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
>  		if (ctrl->value) {
>  			const u16 vblank = 25;
>  			unsigned int total_h = mt9m001->rect.height +
> -				icd->y_skip_top + vblank;
> +				mt9m001->y_skip_top + vblank;
>  			if (reg_write(client, MT9M001_SHUTTER_WIDTH,
>  				      total_h) < 0)
>  				return -EIO;
> @@ -655,6 +656,16 @@ static void mt9m001_video_remove(struct soc_camera_device *icd)
>  		icl->free_bus(icl);
>  }
>  
> +static int mt9m001_g_skip_top_lines(struct v4l2_subdev *sd, u32 *lines)
> +{
> +	struct i2c_client *client = sd->priv;
> +	struct mt9m001 *mt9m001 = to_mt9m001(client);
> +
> +	*lines = mt9m001->y_skip_top;
> +
> +	return 0;
> +}
> +
>  static struct v4l2_subdev_core_ops mt9m001_subdev_core_ops = {
>  	.g_ctrl		= mt9m001_g_ctrl,
>  	.s_ctrl		= mt9m001_s_ctrl,
> @@ -675,9 +686,14 @@ static struct v4l2_subdev_video_ops mt9m001_subdev_video_ops = {
>  	.cropcap	= mt9m001_cropcap,
>  };
>  
> +static struct v4l2_subdev_sensor_ops mt9m001_subdev_sensor_ops = {
> +	.g_skip_top_lines	= mt9m001_g_skip_top_lines,
> +};
> +
>  static struct v4l2_subdev_ops mt9m001_subdev_ops = {
>  	.core	= &mt9m001_subdev_core_ops,
>  	.video	= &mt9m001_subdev_video_ops,
> +	.sensor	= &mt9m001_subdev_sensor_ops,
>  };
>  
>  static int mt9m001_probe(struct i2c_client *client,
> @@ -714,8 +730,8 @@ static int mt9m001_probe(struct i2c_client *client,
>  
>  	/* Second stage probe - when a capture adapter is there */
>  	icd->ops		= &mt9m001_ops;
> -	icd->y_skip_top		= 0;
>  
> +	mt9m001->y_skip_top	= 0;
>  	mt9m001->rect.left	= MT9M001_COLUMN_SKIP;
>  	mt9m001->rect.top	= MT9M001_ROW_SKIP;
>  	mt9m001->rect.width	= MT9M001_MAX_WIDTH;
> diff --git a/drivers/media/video/mt9m111.c b/drivers/media/video/mt9m111.c
> index 90da699..30db625 100644
> --- a/drivers/media/video/mt9m111.c
> +++ b/drivers/media/video/mt9m111.c
> @@ -1019,7 +1019,6 @@ static int mt9m111_probe(struct i2c_client *client,
>  
>  	/* Second stage probe - when a capture adapter is there */
>  	icd->ops		= &mt9m111_ops;
> -	icd->y_skip_top		= 0;
>  
>  	mt9m111->rect.left	= MT9M111_MIN_DARK_COLS;
>  	mt9m111->rect.top	= MT9M111_MIN_DARK_ROWS;
> diff --git a/drivers/media/video/mt9t031.c b/drivers/media/video/mt9t031.c
> index 6966f64..57e04e9 100644
> --- a/drivers/media/video/mt9t031.c
> +++ b/drivers/media/video/mt9t031.c
> @@ -301,9 +301,9 @@ static int mt9t031_set_params(struct soc_camera_device *icd,
>  		ret = reg_write(client, MT9T031_WINDOW_WIDTH, rect->width - 1);
>  	if (ret >= 0)
>  		ret = reg_write(client, MT9T031_WINDOW_HEIGHT,
> -				rect->height + icd->y_skip_top - 1);
> +				rect->height - 1);
>  	if (ret >= 0 && mt9t031->autoexposure) {
> -		unsigned int total_h = rect->height + icd->y_skip_top + vblank;
> +		unsigned int total_h = rect->height + vblank;
>  		ret = set_shutter(client, total_h);
>  		if (ret >= 0) {
>  			const u32 shutter_max = MT9T031_MAX_HEIGHT + vblank;
> @@ -656,8 +656,7 @@ static int mt9t031_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
>  		if (ctrl->value) {
>  			const u16 vblank = MT9T031_VERTICAL_BLANK;
>  			const u32 shutter_max = MT9T031_MAX_HEIGHT + vblank;
> -			unsigned int total_h = mt9t031->rect.height +
> -				icd->y_skip_top + vblank;
> +			unsigned int total_h = mt9t031->rect.height + vblank;
>  
>  			if (set_shutter(client, total_h) < 0)
>  				return -EIO;
> @@ -773,7 +772,6 @@ static int mt9t031_probe(struct i2c_client *client,
>  
>  	/* Second stage probe - when a capture adapter is there */
>  	icd->ops		= &mt9t031_ops;
> -	icd->y_skip_top		= 0;
>  
>  	mt9t031->rect.left	= MT9T031_COLUMN_SKIP;
>  	mt9t031->rect.top	= MT9T031_ROW_SKIP;
> diff --git a/drivers/media/video/mt9v022.c b/drivers/media/video/mt9v022.c
> index 995607f..b71898f 100644
> --- a/drivers/media/video/mt9v022.c
> +++ b/drivers/media/video/mt9v022.c
> @@ -97,6 +97,7 @@ struct mt9v022 {
>  	__u32 fourcc;
>  	int model;	/* V4L2_IDENT_MT9V022* codes from v4l2-chip-ident.h */
>  	u16 chip_control;
> +	unsigned short y_skip_top;	/* Lines to skip at the top */
>  };
>  
>  static struct mt9v022 *to_mt9v022(const struct i2c_client *client)
> @@ -265,7 +266,6 @@ static int mt9v022_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
>  	struct i2c_client *client = sd->priv;
>  	struct mt9v022 *mt9v022 = to_mt9v022(client);
>  	struct v4l2_rect rect = a->c;
> -	struct soc_camera_device *icd = client->dev.platform_data;
>  	int ret;
>  
>  	/* Bayer format - even size lengths */
> @@ -287,10 +287,10 @@ static int mt9v022_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
>  	if (ret >= 0) {
>  		if (ret & 1) /* Autoexposure */
>  			ret = reg_write(client, MT9V022_MAX_TOTAL_SHUTTER_WIDTH,
> -					rect.height + icd->y_skip_top + 43);
> +					rect.height + mt9v022->y_skip_top + 43);
>  		else
>  			ret = reg_write(client, MT9V022_TOTAL_SHUTTER_WIDTH,
> -					rect.height + icd->y_skip_top + 43);
> +					rect.height + mt9v022->y_skip_top + 43);
>  	}
>  	/* Setup frame format: defaults apart from width and height */
>  	if (!ret)
> @@ -309,7 +309,7 @@ static int mt9v022_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
>  		ret = reg_write(client, MT9V022_WINDOW_WIDTH, rect.width);
>  	if (!ret)
>  		ret = reg_write(client, MT9V022_WINDOW_HEIGHT,
> -				rect.height + icd->y_skip_top);
> +				rect.height + mt9v022->y_skip_top);
>  
>  	if (ret < 0)
>  		return ret;
> @@ -410,15 +410,15 @@ static int mt9v022_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
>  static int mt9v022_try_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
>  {
>  	struct i2c_client *client = sd->priv;
> -	struct soc_camera_device *icd = client->dev.platform_data;
> +	struct mt9v022 *mt9v022 = to_mt9v022(client);
>  	struct v4l2_pix_format *pix = &f->fmt.pix;
>  	int align = pix->pixelformat == V4L2_PIX_FMT_SBGGR8 ||
>  		pix->pixelformat == V4L2_PIX_FMT_SBGGR16;
>  
>  	v4l_bound_align_image(&pix->width, MT9V022_MIN_WIDTH,
>  		MT9V022_MAX_WIDTH, align,
> -		&pix->height, MT9V022_MIN_HEIGHT + icd->y_skip_top,
> -		MT9V022_MAX_HEIGHT + icd->y_skip_top, align, 0);
> +		&pix->height, MT9V022_MIN_HEIGHT + mt9v022->y_skip_top,
> +		MT9V022_MAX_HEIGHT + mt9v022->y_skip_top, align, 0);
>  
>  	return 0;
>  }
> @@ -787,6 +787,16 @@ static void mt9v022_video_remove(struct soc_camera_device *icd)
>  		icl->free_bus(icl);
>  }
>  
> +static int mt9v022_g_skip_top_lines(struct v4l2_subdev *sd, u32 *lines)
> +{
> +	struct i2c_client *client = sd->priv;
> +	struct mt9v022 *mt9v022 = to_mt9v022(client);
> +
> +	*lines = mt9v022->y_skip_top;
> +
> +	return 0;
> +}
> +
>  static struct v4l2_subdev_core_ops mt9v022_subdev_core_ops = {
>  	.g_ctrl		= mt9v022_g_ctrl,
>  	.s_ctrl		= mt9v022_s_ctrl,
> @@ -807,9 +817,14 @@ static struct v4l2_subdev_video_ops mt9v022_subdev_video_ops = {
>  	.cropcap	= mt9v022_cropcap,
>  };
>  
> +static struct v4l2_subdev_sensor_ops mt9v022_subdev_sensor_ops = {
> +	.g_skip_top_lines	= mt9v022_g_skip_top_lines,
> +};
> +
>  static struct v4l2_subdev_ops mt9v022_subdev_ops = {
>  	.core	= &mt9v022_subdev_core_ops,
>  	.video	= &mt9v022_subdev_video_ops,
> +	.sensor	= &mt9v022_subdev_sensor_ops,
>  };
>  
>  static int mt9v022_probe(struct i2c_client *client,
> @@ -851,8 +866,7 @@ static int mt9v022_probe(struct i2c_client *client,
>  	 * MT9V022 _really_ corrupts the first read out line.
>  	 * TODO: verify on i.MX31
>  	 */
> -	icd->y_skip_top		= 1;
> -
> +	mt9v022->y_skip_top	= 1;
>  	mt9v022->rect.left	= MT9V022_COLUMN_SKIP;
>  	mt9v022->rect.top	= MT9V022_ROW_SKIP;
>  	mt9v022->rect.width	= MT9V022_MAX_WIDTH;
> diff --git a/drivers/media/video/pxa_camera.c b/drivers/media/video/pxa_camera.c
> index 6952e96..a68de31 100644
> --- a/drivers/media/video/pxa_camera.c
> +++ b/drivers/media/video/pxa_camera.c
> @@ -1050,8 +1050,13 @@ static void pxa_camera_setup_cicr(struct soc_camera_device *icd,
>  {
>  	struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
>  	struct pxa_camera_dev *pcdev = ici->priv;
> +	struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
>  	unsigned long dw, bpp;
> -	u32 cicr0, cicr1, cicr2, cicr3, cicr4 = 0;
> +	u32 cicr0, cicr1, cicr2, cicr3, cicr4 = 0, y_skip_top;
> +	int ret = v4l2_subdev_call(sd, sensor, g_skip_top_lines, &y_skip_top);
> +
> +	if (ret < 0)
> +		y_skip_top = 0;
>  
>  	/* Datawidth is now guaranteed to be equal to one of the three values.
>  	 * We fix bit-per-pixel equal to data-width... */
> @@ -1117,7 +1122,7 @@ static void pxa_camera_setup_cicr(struct soc_camera_device *icd,
>  
>  	cicr2 = 0;
>  	cicr3 = CICR3_LPF_VAL(icd->user_height - 1) |
> -		CICR3_BFW_VAL(min((unsigned short)255, icd->y_skip_top));
> +		CICR3_BFW_VAL(min((unsigned short)255, y_skip_top));
>  	cicr4 |= pcdev->mclk_divisor;
>  
>  	__raw_writel(cicr1, pcdev->base + CICR1);
> diff --git a/drivers/media/video/soc_camera_platform.c b/drivers/media/video/soc_camera_platform.c
> index 1b6dd02..8b1c735 100644
> --- a/drivers/media/video/soc_camera_platform.c
> +++ b/drivers/media/video/soc_camera_platform.c
> @@ -128,7 +128,6 @@ static int soc_camera_platform_probe(struct platform_device *pdev)
>  	/* Set the control device reference */
>  	dev_set_drvdata(&icd->dev, &pdev->dev);
>  
> -	icd->y_skip_top		= 0;
>  	icd->ops		= &soc_camera_platform_ops;
>  
>  	ici = to_soc_camera_host(icd->dev.parent);
> diff --git a/include/media/soc_camera.h b/include/media/soc_camera.h
> index c5afc8c..218639f 100644
> --- a/include/media/soc_camera.h
> +++ b/include/media/soc_camera.h
> @@ -24,7 +24,6 @@ struct soc_camera_device {
>  	struct device *pdev;		/* Platform device */
>  	s32 user_width;
>  	s32 user_height;
> -	unsigned short y_skip_top;	/* Lines to skip at the top */
>  	unsigned char iface;		/* Host number */
>  	unsigned char devnum;		/* Device number per host */
>  	unsigned char buswidth;		/* See comment in .c */
> diff --git a/include/media/v4l2-subdev.h b/include/media/v4l2-subdev.h
> index 89a39ce..81b90d2 100644
> --- a/include/media/v4l2-subdev.h
> +++ b/include/media/v4l2-subdev.h
> @@ -225,8 +225,20 @@ struct v4l2_subdev_video_ops {
>  	int (*s_crop)(struct v4l2_subdev *sd, struct v4l2_crop *crop);
>  	int (*g_parm)(struct v4l2_subdev *sd, struct v4l2_streamparm *param);
>  	int (*s_parm)(struct v4l2_subdev *sd, struct v4l2_streamparm *param);
> +};
> +
> +/**
> + * struct v4l2_subdev_sensor_ops - v4l2-subdev sensor operations
> + * @enum_framesizes: enumerate supported framesizes
> + * @enum_frameintervals: enumerate supported frame format intervals
> + * @g_skip_top_lines: number of lines at the top of the image to be skipped.
> + *		      This is needed for some sensors, that always corrupt
> + *		      several top lines of the output image.
> + */
> +struct v4l2_subdev_sensor_ops {
>  	int (*enum_framesizes)(struct v4l2_subdev *sd, struct v4l2_frmsizeenum *fsize);
>  	int (*enum_frameintervals)(struct v4l2_subdev *sd, struct v4l2_frmivalenum *fival);
> +	int (*g_skip_top_lines)(struct v4l2_subdev *sd, u32 *lines);
>  };
>  
>  struct v4l2_subdev_ops {
> @@ -234,6 +246,7 @@ struct v4l2_subdev_ops {
>  	const struct v4l2_subdev_tuner_ops *tuner;
>  	const struct v4l2_subdev_audio_ops *audio;
>  	const struct v4l2_subdev_video_ops *video;
> +	const struct v4l2_subdev_sensor_ops *sensor;
>  };
>  
>  #define V4L2_SUBDEV_NAME_SIZE 32

Reviewed-by: Hans Verkuil <hverkuil@xs4all.nl>

Regards,

	Hans
Aguirre Rodriguez, Sergio Alberto Aug. 26, 2009, 11:42 a.m. UTC | #2
> -----Original Message-----
> From: Hans Verkuil [mailto:hverkuil@xs4all.nl]
> Sent: Wednesday, August 26, 2009 1:43 AM
> To: Guennadi Liakhovetski
> Cc: Laurent Pinchart; Aguirre Rodriguez, Sergio Alberto; Linux Media
> Mailing List
> Subject: Re: [PATCH v3] v4l: add new v4l2-subdev sensor operations, use
> g_skip_top_lines in soc-camera
>
> On Wednesday 26 August 2009 08:41:00 Guennadi Liakhovetski wrote:
> > Introduce new v4l2-subdev sensor operations, move .enum_framesizes() and
> > .enum_frameintervals() methods to it, add a new .g_skip_top_lines()
> method
> > and switch soc-camera to use it instead of .y_skip_top soc_camera_device
> > member, which can now be removed.
> >
> > Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de>
> > ---
> >
> > Changes since v2: renamed skip_top_lines into g_skip_top_lines, made
> > explanation comment hopefully clearer.
> >
> >  drivers/media/video/mt9m001.c             |   30 ++++++++++++++++++++--
> ----
> >  drivers/media/video/mt9m111.c             |    1 -
> >  drivers/media/video/mt9t031.c             |    8 ++----
> >  drivers/media/video/mt9v022.c             |   32 ++++++++++++++++++++--
> ------
> >  drivers/media/video/pxa_camera.c          |    9 ++++++-
> >  drivers/media/video/soc_camera_platform.c |    1 -
> >  include/media/soc_camera.h                |    1 -
> >  include/media/v4l2-subdev.h               |   13 +++++++++++
> >  8 files changed, 69 insertions(+), 26 deletions(-)
> >
> > diff --git a/drivers/media/video/mt9m001.c
> b/drivers/media/video/mt9m001.c
> > index 45388d2..17be2d4 100644
> > --- a/drivers/media/video/mt9m001.c
> > +++ b/drivers/media/video/mt9m001.c
> > @@ -82,6 +82,7 @@ struct mt9m001 {
> >     int model;      /* V4L2_IDENT_MT9M001* codes from v4l2-chip-ident.h */
> >     unsigned int gain;
> >     unsigned int exposure;
> > +   unsigned short y_skip_top;      /* Lines to skip at the top */
> >     unsigned char autoexposure;
> >  };
> >
> > @@ -222,7 +223,7 @@ static int mt9m001_s_crop(struct v4l2_subdev *sd,
> struct v4l2_crop *a)
> >     soc_camera_limit_side(&rect.top, &rect.height,
> >                  MT9M001_ROW_SKIP, MT9M001_MIN_HEIGHT,
> MT9M001_MAX_HEIGHT);
> >
> > -   total_h = rect.height + icd->y_skip_top + vblank;
> > +   total_h = rect.height + mt9m001->y_skip_top + vblank;
> >
> >     /* Blanking and start values - default... */
> >     ret = reg_write(client, MT9M001_HORIZONTAL_BLANKING, hblank);
> > @@ -239,7 +240,7 @@ static int mt9m001_s_crop(struct v4l2_subdev *sd,
> struct v4l2_crop *a)
> >             ret = reg_write(client, MT9M001_WINDOW_WIDTH, rect.width - 1);
> >     if (!ret)
> >             ret = reg_write(client, MT9M001_WINDOW_HEIGHT,
> > -                           rect.height + icd->y_skip_top - 1);
> > +                           rect.height + mt9m001->y_skip_top - 1);
> >     if (!ret && mt9m001->autoexposure) {
> >             ret = reg_write(client, MT9M001_SHUTTER_WIDTH, total_h);
> >             if (!ret) {
> > @@ -327,13 +328,13 @@ static int mt9m001_s_fmt(struct v4l2_subdev *sd,
> struct v4l2_format *f)
> >  static int mt9m001_try_fmt(struct v4l2_subdev *sd, struct v4l2_format
> *f)
> >  {
> >     struct i2c_client *client = sd->priv;
> > -   struct soc_camera_device *icd = client->dev.platform_data;
> > +   struct mt9m001 *mt9m001 = to_mt9m001(client);
> >     struct v4l2_pix_format *pix = &f->fmt.pix;
> >
> >     v4l_bound_align_image(&pix->width, MT9M001_MIN_WIDTH,
> >             MT9M001_MAX_WIDTH, 1,
> > -           &pix->height, MT9M001_MIN_HEIGHT + icd->y_skip_top,
> > -           MT9M001_MAX_HEIGHT + icd->y_skip_top, 0, 0);
> > +           &pix->height, MT9M001_MIN_HEIGHT + mt9m001->y_skip_top,
> > +           MT9M001_MAX_HEIGHT + mt9m001->y_skip_top, 0, 0);
> >
> >     if (pix->pixelformat == V4L2_PIX_FMT_SBGGR8 ||
> >         pix->pixelformat == V4L2_PIX_FMT_SBGGR16)
> > @@ -552,7 +553,7 @@ static int mt9m001_s_ctrl(struct v4l2_subdev *sd,
> struct v4l2_control *ctrl)
> >             if (ctrl->value) {
> >                     const u16 vblank = 25;
> >                     unsigned int total_h = mt9m001->rect.height +
> > -                           icd->y_skip_top + vblank;
> > +                           mt9m001->y_skip_top + vblank;
> >                     if (reg_write(client, MT9M001_SHUTTER_WIDTH,
> >                                   total_h) < 0)
> >                             return -EIO;
> > @@ -655,6 +656,16 @@ static void mt9m001_video_remove(struct
> soc_camera_device *icd)
> >             icl->free_bus(icl);
> >  }
> >
> > +static int mt9m001_g_skip_top_lines(struct v4l2_subdev *sd, u32 *lines)
> > +{
> > +   struct i2c_client *client = sd->priv;
> > +   struct mt9m001 *mt9m001 = to_mt9m001(client);
> > +
> > +   *lines = mt9m001->y_skip_top;
> > +
> > +   return 0;
> > +}
> > +
> >  static struct v4l2_subdev_core_ops mt9m001_subdev_core_ops = {
> >     .g_ctrl         = mt9m001_g_ctrl,
> >     .s_ctrl         = mt9m001_s_ctrl,
> > @@ -675,9 +686,14 @@ static struct v4l2_subdev_video_ops
> mt9m001_subdev_video_ops = {
> >     .cropcap        = mt9m001_cropcap,
> >  };
> >
> > +static struct v4l2_subdev_sensor_ops mt9m001_subdev_sensor_ops = {
> > +   .g_skip_top_lines       = mt9m001_g_skip_top_lines,
> > +};
> > +
> >  static struct v4l2_subdev_ops mt9m001_subdev_ops = {
> >     .core   = &mt9m001_subdev_core_ops,
> >     .video  = &mt9m001_subdev_video_ops,
> > +   .sensor = &mt9m001_subdev_sensor_ops,
> >  };
> >
> >  static int mt9m001_probe(struct i2c_client *client,
> > @@ -714,8 +730,8 @@ static int mt9m001_probe(struct i2c_client *client,
> >
> >     /* Second stage probe - when a capture adapter is there */
> >     icd->ops                = &mt9m001_ops;
> > -   icd->y_skip_top         = 0;
> >
> > +   mt9m001->y_skip_top     = 0;
> >     mt9m001->rect.left      = MT9M001_COLUMN_SKIP;
> >     mt9m001->rect.top       = MT9M001_ROW_SKIP;
> >     mt9m001->rect.width     = MT9M001_MAX_WIDTH;
> > diff --git a/drivers/media/video/mt9m111.c
> b/drivers/media/video/mt9m111.c
> > index 90da699..30db625 100644
> > --- a/drivers/media/video/mt9m111.c
> > +++ b/drivers/media/video/mt9m111.c
> > @@ -1019,7 +1019,6 @@ static int mt9m111_probe(struct i2c_client
> *client,
> >
> >     /* Second stage probe - when a capture adapter is there */
> >     icd->ops                = &mt9m111_ops;
> > -   icd->y_skip_top         = 0;
> >
> >     mt9m111->rect.left      = MT9M111_MIN_DARK_COLS;
> >     mt9m111->rect.top       = MT9M111_MIN_DARK_ROWS;
> > diff --git a/drivers/media/video/mt9t031.c
> b/drivers/media/video/mt9t031.c
> > index 6966f64..57e04e9 100644
> > --- a/drivers/media/video/mt9t031.c
> > +++ b/drivers/media/video/mt9t031.c
> > @@ -301,9 +301,9 @@ static int mt9t031_set_params(struct
> soc_camera_device *icd,
> >             ret = reg_write(client, MT9T031_WINDOW_WIDTH, rect->width -
> 1);
> >     if (ret >= 0)
> >             ret = reg_write(client, MT9T031_WINDOW_HEIGHT,
> > -                           rect->height + icd->y_skip_top - 1);
> > +                           rect->height - 1);
> >     if (ret >= 0 && mt9t031->autoexposure) {
> > -           unsigned int total_h = rect->height + icd->y_skip_top +
> vblank;
> > +           unsigned int total_h = rect->height + vblank;
> >             ret = set_shutter(client, total_h);
> >             if (ret >= 0) {
> >                     const u32 shutter_max = MT9T031_MAX_HEIGHT + vblank;
> > @@ -656,8 +656,7 @@ static int mt9t031_s_ctrl(struct v4l2_subdev *sd,
> struct v4l2_control *ctrl)
> >             if (ctrl->value) {
> >                     const u16 vblank = MT9T031_VERTICAL_BLANK;
> >                     const u32 shutter_max = MT9T031_MAX_HEIGHT + vblank;
> > -                   unsigned int total_h = mt9t031->rect.height +
> > -                           icd->y_skip_top + vblank;
> > +                   unsigned int total_h = mt9t031->rect.height + vblank;
> >
> >                     if (set_shutter(client, total_h) < 0)
> >                             return -EIO;
> > @@ -773,7 +772,6 @@ static int mt9t031_probe(struct i2c_client *client,
> >
> >     /* Second stage probe - when a capture adapter is there */
> >     icd->ops                = &mt9t031_ops;
> > -   icd->y_skip_top         = 0;
> >
> >     mt9t031->rect.left      = MT9T031_COLUMN_SKIP;
> >     mt9t031->rect.top       = MT9T031_ROW_SKIP;
> > diff --git a/drivers/media/video/mt9v022.c
> b/drivers/media/video/mt9v022.c
> > index 995607f..b71898f 100644
> > --- a/drivers/media/video/mt9v022.c
> > +++ b/drivers/media/video/mt9v022.c
> > @@ -97,6 +97,7 @@ struct mt9v022 {
> >     __u32 fourcc;
> >     int model;      /* V4L2_IDENT_MT9V022* codes from v4l2-chip-ident.h */
> >     u16 chip_control;
> > +   unsigned short y_skip_top;      /* Lines to skip at the top */
> >  };
> >
> >  static struct mt9v022 *to_mt9v022(const struct i2c_client *client)
> > @@ -265,7 +266,6 @@ static int mt9v022_s_crop(struct v4l2_subdev *sd,
> struct v4l2_crop *a)
> >     struct i2c_client *client = sd->priv;
> >     struct mt9v022 *mt9v022 = to_mt9v022(client);
> >     struct v4l2_rect rect = a->c;
> > -   struct soc_camera_device *icd = client->dev.platform_data;
> >     int ret;
> >
> >     /* Bayer format - even size lengths */
> > @@ -287,10 +287,10 @@ static int mt9v022_s_crop(struct v4l2_subdev *sd,
> struct v4l2_crop *a)
> >     if (ret >= 0) {
> >             if (ret & 1) /* Autoexposure */
> >                     ret = reg_write(client, MT9V022_MAX_TOTAL_SHUTTER_WIDTH,
> > -                                   rect.height + icd->y_skip_top + 43);
> > +                                   rect.height + mt9v022->y_skip_top + 43);
> >             else
> >                     ret = reg_write(client, MT9V022_TOTAL_SHUTTER_WIDTH,
> > -                                   rect.height + icd->y_skip_top + 43);
> > +                                   rect.height + mt9v022->y_skip_top + 43);
> >     }
> >     /* Setup frame format: defaults apart from width and height */
> >     if (!ret)
> > @@ -309,7 +309,7 @@ static int mt9v022_s_crop(struct v4l2_subdev *sd,
> struct v4l2_crop *a)
> >             ret = reg_write(client, MT9V022_WINDOW_WIDTH, rect.width);
> >     if (!ret)
> >             ret = reg_write(client, MT9V022_WINDOW_HEIGHT,
> > -                           rect.height + icd->y_skip_top);
> > +                           rect.height + mt9v022->y_skip_top);
> >
> >     if (ret < 0)
> >             return ret;
> > @@ -410,15 +410,15 @@ static int mt9v022_s_fmt(struct v4l2_subdev *sd,
> struct v4l2_format *f)
> >  static int mt9v022_try_fmt(struct v4l2_subdev *sd, struct v4l2_format
> *f)
> >  {
> >     struct i2c_client *client = sd->priv;
> > -   struct soc_camera_device *icd = client->dev.platform_data;
> > +   struct mt9v022 *mt9v022 = to_mt9v022(client);
> >     struct v4l2_pix_format *pix = &f->fmt.pix;
> >     int align = pix->pixelformat == V4L2_PIX_FMT_SBGGR8 ||
> >             pix->pixelformat == V4L2_PIX_FMT_SBGGR16;
> >
> >     v4l_bound_align_image(&pix->width, MT9V022_MIN_WIDTH,
> >             MT9V022_MAX_WIDTH, align,
> > -           &pix->height, MT9V022_MIN_HEIGHT + icd->y_skip_top,
> > -           MT9V022_MAX_HEIGHT + icd->y_skip_top, align, 0);
> > +           &pix->height, MT9V022_MIN_HEIGHT + mt9v022->y_skip_top,
> > +           MT9V022_MAX_HEIGHT + mt9v022->y_skip_top, align, 0);
> >
> >     return 0;
> >  }
> > @@ -787,6 +787,16 @@ static void mt9v022_video_remove(struct
> soc_camera_device *icd)
> >             icl->free_bus(icl);
> >  }
> >
> > +static int mt9v022_g_skip_top_lines(struct v4l2_subdev *sd, u32 *lines)
> > +{
> > +   struct i2c_client *client = sd->priv;
> > +   struct mt9v022 *mt9v022 = to_mt9v022(client);
> > +
> > +   *lines = mt9v022->y_skip_top;
> > +
> > +   return 0;
> > +}
> > +
> >  static struct v4l2_subdev_core_ops mt9v022_subdev_core_ops = {
> >     .g_ctrl         = mt9v022_g_ctrl,
> >     .s_ctrl         = mt9v022_s_ctrl,
> > @@ -807,9 +817,14 @@ static struct v4l2_subdev_video_ops
> mt9v022_subdev_video_ops = {
> >     .cropcap        = mt9v022_cropcap,
> >  };
> >
> > +static struct v4l2_subdev_sensor_ops mt9v022_subdev_sensor_ops = {
> > +   .g_skip_top_lines       = mt9v022_g_skip_top_lines,
> > +};
> > +
> >  static struct v4l2_subdev_ops mt9v022_subdev_ops = {
> >     .core   = &mt9v022_subdev_core_ops,
> >     .video  = &mt9v022_subdev_video_ops,
> > +   .sensor = &mt9v022_subdev_sensor_ops,
> >  };
> >
> >  static int mt9v022_probe(struct i2c_client *client,
> > @@ -851,8 +866,7 @@ static int mt9v022_probe(struct i2c_client *client,
> >      * MT9V022 _really_ corrupts the first read out line.
> >      * TODO: verify on i.MX31
> >      */
> > -   icd->y_skip_top         = 1;
> > -
> > +   mt9v022->y_skip_top     = 1;
> >     mt9v022->rect.left      = MT9V022_COLUMN_SKIP;
> >     mt9v022->rect.top       = MT9V022_ROW_SKIP;
> >     mt9v022->rect.width     = MT9V022_MAX_WIDTH;
> > diff --git a/drivers/media/video/pxa_camera.c
> b/drivers/media/video/pxa_camera.c
> > index 6952e96..a68de31 100644
> > --- a/drivers/media/video/pxa_camera.c
> > +++ b/drivers/media/video/pxa_camera.c
> > @@ -1050,8 +1050,13 @@ static void pxa_camera_setup_cicr(struct
> soc_camera_device *icd,
> >  {
> >     struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
> >     struct pxa_camera_dev *pcdev = ici->priv;
> > +   struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
> >     unsigned long dw, bpp;
> > -   u32 cicr0, cicr1, cicr2, cicr3, cicr4 = 0;
> > +   u32 cicr0, cicr1, cicr2, cicr3, cicr4 = 0, y_skip_top;
> > +   int ret = v4l2_subdev_call(sd, sensor, g_skip_top_lines,
> &y_skip_top);
> > +
> > +   if (ret < 0)
> > +           y_skip_top = 0;
> >
> >     /* Datawidth is now guaranteed to be equal to one of the three
> values.
> >      * We fix bit-per-pixel equal to data-width... */
> > @@ -1117,7 +1122,7 @@ static void pxa_camera_setup_cicr(struct
> soc_camera_device *icd,
> >
> >     cicr2 = 0;
> >     cicr3 = CICR3_LPF_VAL(icd->user_height - 1) |
> > -           CICR3_BFW_VAL(min((unsigned short)255, icd->y_skip_top));
> > +           CICR3_BFW_VAL(min((unsigned short)255, y_skip_top));
> >     cicr4 |= pcdev->mclk_divisor;
> >
> >     __raw_writel(cicr1, pcdev->base + CICR1);
> > diff --git a/drivers/media/video/soc_camera_platform.c
> b/drivers/media/video/soc_camera_platform.c
> > index 1b6dd02..8b1c735 100644
> > --- a/drivers/media/video/soc_camera_platform.c
> > +++ b/drivers/media/video/soc_camera_platform.c
> > @@ -128,7 +128,6 @@ static int soc_camera_platform_probe(struct
> platform_device *pdev)
> >     /* Set the control device reference */
> >     dev_set_drvdata(&icd->dev, &pdev->dev);
> >
> > -   icd->y_skip_top         = 0;
> >     icd->ops                = &soc_camera_platform_ops;
> >
> >     ici = to_soc_camera_host(icd->dev.parent);
> > diff --git a/include/media/soc_camera.h b/include/media/soc_camera.h
> > index c5afc8c..218639f 100644
> > --- a/include/media/soc_camera.h
> > +++ b/include/media/soc_camera.h
> > @@ -24,7 +24,6 @@ struct soc_camera_device {
> >     struct device *pdev;            /* Platform device */
> >     s32 user_width;
> >     s32 user_height;
> > -   unsigned short y_skip_top;      /* Lines to skip at the top */
> >     unsigned char iface;            /* Host number */
> >     unsigned char devnum;           /* Device number per host */
> >     unsigned char buswidth;         /* See comment in .c */
> > diff --git a/include/media/v4l2-subdev.h b/include/media/v4l2-subdev.h
> > index 89a39ce..81b90d2 100644
> > --- a/include/media/v4l2-subdev.h
> > +++ b/include/media/v4l2-subdev.h
> > @@ -225,8 +225,20 @@ struct v4l2_subdev_video_ops {
> >     int (*s_crop)(struct v4l2_subdev *sd, struct v4l2_crop *crop);
> >     int (*g_parm)(struct v4l2_subdev *sd, struct v4l2_streamparm
> *param);
> >     int (*s_parm)(struct v4l2_subdev *sd, struct v4l2_streamparm
> *param);
> > +};
> > +
> > +/**
> > + * struct v4l2_subdev_sensor_ops - v4l2-subdev sensor operations
> > + * @enum_framesizes: enumerate supported framesizes
> > + * @enum_frameintervals: enumerate supported frame format intervals
> > + * @g_skip_top_lines: number of lines at the top of the image to be
> skipped.
> > + *               This is needed for some sensors, that always corrupt
> > + *               several top lines of the output image.
> > + */
> > +struct v4l2_subdev_sensor_ops {
> >     int (*enum_framesizes)(struct v4l2_subdev *sd, struct
> v4l2_frmsizeenum *fsize);
> >     int (*enum_frameintervals)(struct v4l2_subdev *sd, struct
> v4l2_frmivalenum *fival);
> > +   int (*g_skip_top_lines)(struct v4l2_subdev *sd, u32 *lines);
> >  };
> >
> >  struct v4l2_subdev_ops {
> > @@ -234,6 +246,7 @@ struct v4l2_subdev_ops {
> >     const struct v4l2_subdev_tuner_ops *tuner;
> >     const struct v4l2_subdev_audio_ops *audio;
> >     const struct v4l2_subdev_video_ops *video;
> > +   const struct v4l2_subdev_sensor_ops *sensor;
> >  };
> >
> >  #define V4L2_SUBDEV_NAME_SIZE 32
>
> Reviewed-by: Hans Verkuil <hverkuil@xs4all.nl>

Now looks better :)

Reviewed-by: Sergio Aguirre <saaguirre@ti.com>

Thanks for hearing my opinion,
Sergio
>
> Regards,
>
>       Hans
>
> --
> Hans Verkuil - video4linux developer - sponsored by TANDBERG Telecom

--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
diff mbox

Patch

diff --git a/drivers/media/video/mt9m001.c b/drivers/media/video/mt9m001.c
index 45388d2..17be2d4 100644
--- a/drivers/media/video/mt9m001.c
+++ b/drivers/media/video/mt9m001.c
@@ -82,6 +82,7 @@  struct mt9m001 {
 	int model;	/* V4L2_IDENT_MT9M001* codes from v4l2-chip-ident.h */
 	unsigned int gain;
 	unsigned int exposure;
+	unsigned short y_skip_top;	/* Lines to skip at the top */
 	unsigned char autoexposure;
 };
 
@@ -222,7 +223,7 @@  static int mt9m001_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
 	soc_camera_limit_side(&rect.top, &rect.height,
 		     MT9M001_ROW_SKIP, MT9M001_MIN_HEIGHT, MT9M001_MAX_HEIGHT);
 
-	total_h = rect.height + icd->y_skip_top + vblank;
+	total_h = rect.height + mt9m001->y_skip_top + vblank;
 
 	/* Blanking and start values - default... */
 	ret = reg_write(client, MT9M001_HORIZONTAL_BLANKING, hblank);
@@ -239,7 +240,7 @@  static int mt9m001_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
 		ret = reg_write(client, MT9M001_WINDOW_WIDTH, rect.width - 1);
 	if (!ret)
 		ret = reg_write(client, MT9M001_WINDOW_HEIGHT,
-				rect.height + icd->y_skip_top - 1);
+				rect.height + mt9m001->y_skip_top - 1);
 	if (!ret && mt9m001->autoexposure) {
 		ret = reg_write(client, MT9M001_SHUTTER_WIDTH, total_h);
 		if (!ret) {
@@ -327,13 +328,13 @@  static int mt9m001_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
 static int mt9m001_try_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
 {
 	struct i2c_client *client = sd->priv;
-	struct soc_camera_device *icd = client->dev.platform_data;
+	struct mt9m001 *mt9m001 = to_mt9m001(client);
 	struct v4l2_pix_format *pix = &f->fmt.pix;
 
 	v4l_bound_align_image(&pix->width, MT9M001_MIN_WIDTH,
 		MT9M001_MAX_WIDTH, 1,
-		&pix->height, MT9M001_MIN_HEIGHT + icd->y_skip_top,
-		MT9M001_MAX_HEIGHT + icd->y_skip_top, 0, 0);
+		&pix->height, MT9M001_MIN_HEIGHT + mt9m001->y_skip_top,
+		MT9M001_MAX_HEIGHT + mt9m001->y_skip_top, 0, 0);
 
 	if (pix->pixelformat == V4L2_PIX_FMT_SBGGR8 ||
 	    pix->pixelformat == V4L2_PIX_FMT_SBGGR16)
@@ -552,7 +553,7 @@  static int mt9m001_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
 		if (ctrl->value) {
 			const u16 vblank = 25;
 			unsigned int total_h = mt9m001->rect.height +
-				icd->y_skip_top + vblank;
+				mt9m001->y_skip_top + vblank;
 			if (reg_write(client, MT9M001_SHUTTER_WIDTH,
 				      total_h) < 0)
 				return -EIO;
@@ -655,6 +656,16 @@  static void mt9m001_video_remove(struct soc_camera_device *icd)
 		icl->free_bus(icl);
 }
 
+static int mt9m001_g_skip_top_lines(struct v4l2_subdev *sd, u32 *lines)
+{
+	struct i2c_client *client = sd->priv;
+	struct mt9m001 *mt9m001 = to_mt9m001(client);
+
+	*lines = mt9m001->y_skip_top;
+
+	return 0;
+}
+
 static struct v4l2_subdev_core_ops mt9m001_subdev_core_ops = {
 	.g_ctrl		= mt9m001_g_ctrl,
 	.s_ctrl		= mt9m001_s_ctrl,
@@ -675,9 +686,14 @@  static struct v4l2_subdev_video_ops mt9m001_subdev_video_ops = {
 	.cropcap	= mt9m001_cropcap,
 };
 
+static struct v4l2_subdev_sensor_ops mt9m001_subdev_sensor_ops = {
+	.g_skip_top_lines	= mt9m001_g_skip_top_lines,
+};
+
 static struct v4l2_subdev_ops mt9m001_subdev_ops = {
 	.core	= &mt9m001_subdev_core_ops,
 	.video	= &mt9m001_subdev_video_ops,
+	.sensor	= &mt9m001_subdev_sensor_ops,
 };
 
 static int mt9m001_probe(struct i2c_client *client,
@@ -714,8 +730,8 @@  static int mt9m001_probe(struct i2c_client *client,
 
 	/* Second stage probe - when a capture adapter is there */
 	icd->ops		= &mt9m001_ops;
-	icd->y_skip_top		= 0;
 
+	mt9m001->y_skip_top	= 0;
 	mt9m001->rect.left	= MT9M001_COLUMN_SKIP;
 	mt9m001->rect.top	= MT9M001_ROW_SKIP;
 	mt9m001->rect.width	= MT9M001_MAX_WIDTH;
diff --git a/drivers/media/video/mt9m111.c b/drivers/media/video/mt9m111.c
index 90da699..30db625 100644
--- a/drivers/media/video/mt9m111.c
+++ b/drivers/media/video/mt9m111.c
@@ -1019,7 +1019,6 @@  static int mt9m111_probe(struct i2c_client *client,
 
 	/* Second stage probe - when a capture adapter is there */
 	icd->ops		= &mt9m111_ops;
-	icd->y_skip_top		= 0;
 
 	mt9m111->rect.left	= MT9M111_MIN_DARK_COLS;
 	mt9m111->rect.top	= MT9M111_MIN_DARK_ROWS;
diff --git a/drivers/media/video/mt9t031.c b/drivers/media/video/mt9t031.c
index 6966f64..57e04e9 100644
--- a/drivers/media/video/mt9t031.c
+++ b/drivers/media/video/mt9t031.c
@@ -301,9 +301,9 @@  static int mt9t031_set_params(struct soc_camera_device *icd,
 		ret = reg_write(client, MT9T031_WINDOW_WIDTH, rect->width - 1);
 	if (ret >= 0)
 		ret = reg_write(client, MT9T031_WINDOW_HEIGHT,
-				rect->height + icd->y_skip_top - 1);
+				rect->height - 1);
 	if (ret >= 0 && mt9t031->autoexposure) {
-		unsigned int total_h = rect->height + icd->y_skip_top + vblank;
+		unsigned int total_h = rect->height + vblank;
 		ret = set_shutter(client, total_h);
 		if (ret >= 0) {
 			const u32 shutter_max = MT9T031_MAX_HEIGHT + vblank;
@@ -656,8 +656,7 @@  static int mt9t031_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
 		if (ctrl->value) {
 			const u16 vblank = MT9T031_VERTICAL_BLANK;
 			const u32 shutter_max = MT9T031_MAX_HEIGHT + vblank;
-			unsigned int total_h = mt9t031->rect.height +
-				icd->y_skip_top + vblank;
+			unsigned int total_h = mt9t031->rect.height + vblank;
 
 			if (set_shutter(client, total_h) < 0)
 				return -EIO;
@@ -773,7 +772,6 @@  static int mt9t031_probe(struct i2c_client *client,
 
 	/* Second stage probe - when a capture adapter is there */
 	icd->ops		= &mt9t031_ops;
-	icd->y_skip_top		= 0;
 
 	mt9t031->rect.left	= MT9T031_COLUMN_SKIP;
 	mt9t031->rect.top	= MT9T031_ROW_SKIP;
diff --git a/drivers/media/video/mt9v022.c b/drivers/media/video/mt9v022.c
index 995607f..b71898f 100644
--- a/drivers/media/video/mt9v022.c
+++ b/drivers/media/video/mt9v022.c
@@ -97,6 +97,7 @@  struct mt9v022 {
 	__u32 fourcc;
 	int model;	/* V4L2_IDENT_MT9V022* codes from v4l2-chip-ident.h */
 	u16 chip_control;
+	unsigned short y_skip_top;	/* Lines to skip at the top */
 };
 
 static struct mt9v022 *to_mt9v022(const struct i2c_client *client)
@@ -265,7 +266,6 @@  static int mt9v022_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
 	struct i2c_client *client = sd->priv;
 	struct mt9v022 *mt9v022 = to_mt9v022(client);
 	struct v4l2_rect rect = a->c;
-	struct soc_camera_device *icd = client->dev.platform_data;
 	int ret;
 
 	/* Bayer format - even size lengths */
@@ -287,10 +287,10 @@  static int mt9v022_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
 	if (ret >= 0) {
 		if (ret & 1) /* Autoexposure */
 			ret = reg_write(client, MT9V022_MAX_TOTAL_SHUTTER_WIDTH,
-					rect.height + icd->y_skip_top + 43);
+					rect.height + mt9v022->y_skip_top + 43);
 		else
 			ret = reg_write(client, MT9V022_TOTAL_SHUTTER_WIDTH,
-					rect.height + icd->y_skip_top + 43);
+					rect.height + mt9v022->y_skip_top + 43);
 	}
 	/* Setup frame format: defaults apart from width and height */
 	if (!ret)
@@ -309,7 +309,7 @@  static int mt9v022_s_crop(struct v4l2_subdev *sd, struct v4l2_crop *a)
 		ret = reg_write(client, MT9V022_WINDOW_WIDTH, rect.width);
 	if (!ret)
 		ret = reg_write(client, MT9V022_WINDOW_HEIGHT,
-				rect.height + icd->y_skip_top);
+				rect.height + mt9v022->y_skip_top);
 
 	if (ret < 0)
 		return ret;
@@ -410,15 +410,15 @@  static int mt9v022_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
 static int mt9v022_try_fmt(struct v4l2_subdev *sd, struct v4l2_format *f)
 {
 	struct i2c_client *client = sd->priv;
-	struct soc_camera_device *icd = client->dev.platform_data;
+	struct mt9v022 *mt9v022 = to_mt9v022(client);
 	struct v4l2_pix_format *pix = &f->fmt.pix;
 	int align = pix->pixelformat == V4L2_PIX_FMT_SBGGR8 ||
 		pix->pixelformat == V4L2_PIX_FMT_SBGGR16;
 
 	v4l_bound_align_image(&pix->width, MT9V022_MIN_WIDTH,
 		MT9V022_MAX_WIDTH, align,
-		&pix->height, MT9V022_MIN_HEIGHT + icd->y_skip_top,
-		MT9V022_MAX_HEIGHT + icd->y_skip_top, align, 0);
+		&pix->height, MT9V022_MIN_HEIGHT + mt9v022->y_skip_top,
+		MT9V022_MAX_HEIGHT + mt9v022->y_skip_top, align, 0);
 
 	return 0;
 }
@@ -787,6 +787,16 @@  static void mt9v022_video_remove(struct soc_camera_device *icd)
 		icl->free_bus(icl);
 }
 
+static int mt9v022_g_skip_top_lines(struct v4l2_subdev *sd, u32 *lines)
+{
+	struct i2c_client *client = sd->priv;
+	struct mt9v022 *mt9v022 = to_mt9v022(client);
+
+	*lines = mt9v022->y_skip_top;
+
+	return 0;
+}
+
 static struct v4l2_subdev_core_ops mt9v022_subdev_core_ops = {
 	.g_ctrl		= mt9v022_g_ctrl,
 	.s_ctrl		= mt9v022_s_ctrl,
@@ -807,9 +817,14 @@  static struct v4l2_subdev_video_ops mt9v022_subdev_video_ops = {
 	.cropcap	= mt9v022_cropcap,
 };
 
+static struct v4l2_subdev_sensor_ops mt9v022_subdev_sensor_ops = {
+	.g_skip_top_lines	= mt9v022_g_skip_top_lines,
+};
+
 static struct v4l2_subdev_ops mt9v022_subdev_ops = {
 	.core	= &mt9v022_subdev_core_ops,
 	.video	= &mt9v022_subdev_video_ops,
+	.sensor	= &mt9v022_subdev_sensor_ops,
 };
 
 static int mt9v022_probe(struct i2c_client *client,
@@ -851,8 +866,7 @@  static int mt9v022_probe(struct i2c_client *client,
 	 * MT9V022 _really_ corrupts the first read out line.
 	 * TODO: verify on i.MX31
 	 */
-	icd->y_skip_top		= 1;
-
+	mt9v022->y_skip_top	= 1;
 	mt9v022->rect.left	= MT9V022_COLUMN_SKIP;
 	mt9v022->rect.top	= MT9V022_ROW_SKIP;
 	mt9v022->rect.width	= MT9V022_MAX_WIDTH;
diff --git a/drivers/media/video/pxa_camera.c b/drivers/media/video/pxa_camera.c
index 6952e96..a68de31 100644
--- a/drivers/media/video/pxa_camera.c
+++ b/drivers/media/video/pxa_camera.c
@@ -1050,8 +1050,13 @@  static void pxa_camera_setup_cicr(struct soc_camera_device *icd,
 {
 	struct soc_camera_host *ici = to_soc_camera_host(icd->dev.parent);
 	struct pxa_camera_dev *pcdev = ici->priv;
+	struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
 	unsigned long dw, bpp;
-	u32 cicr0, cicr1, cicr2, cicr3, cicr4 = 0;
+	u32 cicr0, cicr1, cicr2, cicr3, cicr4 = 0, y_skip_top;
+	int ret = v4l2_subdev_call(sd, sensor, g_skip_top_lines, &y_skip_top);
+
+	if (ret < 0)
+		y_skip_top = 0;
 
 	/* Datawidth is now guaranteed to be equal to one of the three values.
 	 * We fix bit-per-pixel equal to data-width... */
@@ -1117,7 +1122,7 @@  static void pxa_camera_setup_cicr(struct soc_camera_device *icd,
 
 	cicr2 = 0;
 	cicr3 = CICR3_LPF_VAL(icd->user_height - 1) |
-		CICR3_BFW_VAL(min((unsigned short)255, icd->y_skip_top));
+		CICR3_BFW_VAL(min((unsigned short)255, y_skip_top));
 	cicr4 |= pcdev->mclk_divisor;
 
 	__raw_writel(cicr1, pcdev->base + CICR1);
diff --git a/drivers/media/video/soc_camera_platform.c b/drivers/media/video/soc_camera_platform.c
index 1b6dd02..8b1c735 100644
--- a/drivers/media/video/soc_camera_platform.c
+++ b/drivers/media/video/soc_camera_platform.c
@@ -128,7 +128,6 @@  static int soc_camera_platform_probe(struct platform_device *pdev)
 	/* Set the control device reference */
 	dev_set_drvdata(&icd->dev, &pdev->dev);
 
-	icd->y_skip_top		= 0;
 	icd->ops		= &soc_camera_platform_ops;
 
 	ici = to_soc_camera_host(icd->dev.parent);
diff --git a/include/media/soc_camera.h b/include/media/soc_camera.h
index c5afc8c..218639f 100644
--- a/include/media/soc_camera.h
+++ b/include/media/soc_camera.h
@@ -24,7 +24,6 @@  struct soc_camera_device {
 	struct device *pdev;		/* Platform device */
 	s32 user_width;
 	s32 user_height;
-	unsigned short y_skip_top;	/* Lines to skip at the top */
 	unsigned char iface;		/* Host number */
 	unsigned char devnum;		/* Device number per host */
 	unsigned char buswidth;		/* See comment in .c */
diff --git a/include/media/v4l2-subdev.h b/include/media/v4l2-subdev.h
index 89a39ce..81b90d2 100644
--- a/include/media/v4l2-subdev.h
+++ b/include/media/v4l2-subdev.h
@@ -225,8 +225,20 @@  struct v4l2_subdev_video_ops {
 	int (*s_crop)(struct v4l2_subdev *sd, struct v4l2_crop *crop);
 	int (*g_parm)(struct v4l2_subdev *sd, struct v4l2_streamparm *param);
 	int (*s_parm)(struct v4l2_subdev *sd, struct v4l2_streamparm *param);
+};
+
+/**
+ * struct v4l2_subdev_sensor_ops - v4l2-subdev sensor operations
+ * @enum_framesizes: enumerate supported framesizes
+ * @enum_frameintervals: enumerate supported frame format intervals
+ * @g_skip_top_lines: number of lines at the top of the image to be skipped.
+ *		      This is needed for some sensors, that always corrupt
+ *		      several top lines of the output image.
+ */
+struct v4l2_subdev_sensor_ops {
 	int (*enum_framesizes)(struct v4l2_subdev *sd, struct v4l2_frmsizeenum *fsize);
 	int (*enum_frameintervals)(struct v4l2_subdev *sd, struct v4l2_frmivalenum *fival);
+	int (*g_skip_top_lines)(struct v4l2_subdev *sd, u32 *lines);
 };
 
 struct v4l2_subdev_ops {
@@ -234,6 +246,7 @@  struct v4l2_subdev_ops {
 	const struct v4l2_subdev_tuner_ops *tuner;
 	const struct v4l2_subdev_audio_ops *audio;
 	const struct v4l2_subdev_video_ops *video;
+	const struct v4l2_subdev_sensor_ops *sensor;
 };
 
 #define V4L2_SUBDEV_NAME_SIZE 32