[media] cx25821: add output format ioctls

Signed-off-by: Hans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

diff --git a/drivers/media/pci/cx25821/cx25821-video.c b/drivers/media/pci/cx25821/cx25821-video.c
index dca3391..70e33b1 100644 (file)
--- a/drivers/media/pci/cx25821/cx25821-video.c
+++ b/drivers/media/pci/cx25821/cx25821-video.c
@@ -851,6 +851,48 @@ static int cx25821_vidioc_s_output(struct file *file, void *priv, unsigned int o
        return o ? -EINVAL : 0;
 }
 
+static int cx25821_vidioc_try_fmt_vid_out(struct file *file, void *priv,
+                                  struct v4l2_format *f)
+{
+       struct cx25821_channel *chan = video_drvdata(file);
+       struct cx25821_dev *dev = chan->dev;
+       const struct cx25821_fmt *fmt;
+
+       fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
+       if (NULL == fmt)
+               return -EINVAL;
+       f->fmt.pix.width = 720;
+       f->fmt.pix.height = (dev->tvnorm & V4L2_STD_625_50) ? 576 : 480;
+       f->fmt.pix.field = V4L2_FIELD_INTERLACED;
+       f->fmt.pix.bytesperline = (f->fmt.pix.width * fmt->depth) >> 3;
+       f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
+       f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
+       f->fmt.pix.priv = 0;
+       return 0;
+}
+
+static int vidioc_s_fmt_vid_out(struct file *file, void *priv,
+                               struct v4l2_format *f)
+{
+       struct cx25821_channel *chan = video_drvdata(file);
+       int err;
+
+       err = cx25821_vidioc_try_fmt_vid_out(file, priv, f);
+
+       if (0 != err)
+               return err;
+
+       chan->fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
+       chan->vidq.field = f->fmt.pix.field;
+       chan->width = f->fmt.pix.width;
+       chan->height = f->fmt.pix.height;
+       if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_Y41P)
+               chan->pixel_formats = PIXEL_FRMT_411;
+       else
+               chan->pixel_formats = PIXEL_FRMT_422;
+       return 0;
+}
+
 static const struct v4l2_ctrl_ops cx25821_ctrl_ops = {
        .s_ctrl = cx25821_s_ctrl,
 };
@@ -905,6 +947,10 @@ static const struct v4l2_file_operations video_out_fops = {
 
 static const struct v4l2_ioctl_ops video_out_ioctl_ops = {
        .vidioc_querycap = cx25821_vidioc_querycap,
+       .vidioc_enum_fmt_vid_out = cx25821_vidioc_enum_fmt_vid_cap,
+       .vidioc_g_fmt_vid_out = cx25821_vidioc_g_fmt_vid_cap,
+       .vidioc_try_fmt_vid_out = cx25821_vidioc_try_fmt_vid_out,
+       .vidioc_s_fmt_vid_out = vidioc_s_fmt_vid_out,
        .vidioc_g_std = cx25821_vidioc_g_std,
        .vidioc_s_std = cx25821_vidioc_s_std,
        .vidioc_enum_output = cx25821_vidioc_enum_output,