[media] cpia2: convert to video_ioctl2

Unable to test this due to lack of hardware.

Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

diff --git a/drivers/media/video/cpia2/cpia2_v4l.c b/drivers/media/video/cpia2/cpia2_v4l.c
index 9bad398..363fe09 100644 (file)
--- a/drivers/media/video/cpia2/cpia2_v4l.c
+++ b/drivers/media/video/cpia2/cpia2_v4l.c
@@ -395,10 +395,14 @@ static int sync(struct camera_data *cam, int frame_nr)
  *
  *****************************************************************************/
 
-static int ioctl_set_gpio(void *arg, struct camera_data *cam)
+static long cpia2_default(struct file *file, void *fh, int cmd, void *arg)
 {
+       struct camera_data *cam = video_drvdata(file);
        __u32 gpio_val;
 
+       if (cmd != CPIA2_CID_GPIO)
+               return -EINVAL;
+
        gpio_val = *(__u32*) arg;
 
        if (gpio_val &~ 0xFFU)
@@ -415,11 +419,10 @@ static int ioctl_set_gpio(void *arg, struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_querycap(void *arg, struct camera_data *cam)
+static int cpia2_querycap(struct file *file, void *fh, struct v4l2_capability *vc)
 {
-       struct v4l2_capability *vc = arg;
+       struct camera_data *cam = video_drvdata(file);
 
-       memset(vc, 0, sizeof(*vc));
        strcpy(vc->driver, "cpia2");
 
        if (cam->params.pnp_id.product == 0x151)
@@ -479,22 +482,26 @@ static int ioctl_querycap(void *arg, struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_input(unsigned int ioclt_nr,void *arg,struct camera_data *cam)
+static int cpia2_enum_input(struct file *file, void *fh, struct v4l2_input *i)
 {
-       struct v4l2_input *i = arg;
-
-       if(ioclt_nr  != VIDIOC_G_INPUT) {
-               if (i->index != 0)
-                      return -EINVAL;
-       }
-
-       memset(i, 0, sizeof(*i));
+       if (i->index)
+               return -EINVAL;
        strcpy(i->name, "Camera");
        i->type = V4L2_INPUT_TYPE_CAMERA;
+       return 0;
+}
 
+static int cpia2_g_input(struct file *file, void *fh, unsigned int *i)
+{
+       *i = 0;
        return 0;
 }
 
+static int cpia2_s_input(struct file *file, void *fh, unsigned int i)
+{
+       return i ? -EINVAL : 0;
+}
+
 /******************************************************************************
  *
  *  ioctl_enum_fmt
@@ -503,9 +510,9 @@ static int ioctl_input(unsigned int ioclt_nr,void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_enum_fmt(void *arg,struct camera_data *cam)
+static int cpia2_enum_fmt_vid_cap(struct file *file, void *fh,
+                                           struct v4l2_fmtdesc *f)
 {
-       struct v4l2_fmtdesc *f = arg;
        int index = f->index;
 
        if (index < 0 || index > 1)
@@ -539,12 +546,10 @@ static int ioctl_enum_fmt(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_try_fmt(void *arg,struct camera_data *cam)
+static int cpia2_try_fmt_vid_cap(struct file *file, void *fh,
+                                         struct v4l2_format *f)
 {
-       struct v4l2_format *f = arg;
-
-       if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
-              return -EINVAL;
+       struct camera_data *cam = video_drvdata(file);
 
        if (f->fmt.pix.pixelformat != V4L2_PIX_FMT_MJPEG &&
            f->fmt.pix.pixelformat != V4L2_PIX_FMT_JPEG)
@@ -603,12 +608,17 @@ static int ioctl_try_fmt(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_set_fmt(void *arg,struct camera_data *cam, struct cpia2_fh *fh)
+static int cpia2_s_fmt_vid_cap(struct file *file, void *_fh,
+                                       struct v4l2_format *f)
 {
-       struct v4l2_format *f = arg;
+       struct camera_data *cam = video_drvdata(file);
+       struct cpia2_fh *fh = _fh;
        int err, frame;
 
-       err = ioctl_try_fmt(arg, cam);
+       err = v4l2_prio_check(&cam->prio, fh->prio);
+       if (err)
+               return err;
+       err = cpia2_try_fmt_vid_cap(file, _fh, f);
        if(err != 0)
                return err;
 
@@ -658,12 +668,10 @@ static int ioctl_set_fmt(void *arg,struct camera_data *cam, struct cpia2_fh *fh)
  *
  *****************************************************************************/
 
-static int ioctl_get_fmt(void *arg,struct camera_data *cam)
+static int cpia2_g_fmt_vid_cap(struct file *file, void *fh,
+                                       struct v4l2_format *f)
 {
-       struct v4l2_format *f = arg;
-
-       if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
-              return -EINVAL;
+       struct camera_data *cam = video_drvdata(file);
 
        f->fmt.pix.width = cam->width;
        f->fmt.pix.height = cam->height;
@@ -686,9 +694,9 @@ static int ioctl_get_fmt(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_cropcap(void *arg,struct camera_data *cam)
+static int cpia2_cropcap(struct file *file, void *fh, struct v4l2_cropcap *c)
 {
-       struct v4l2_cropcap *c = arg;
+       struct camera_data *cam = video_drvdata(file);
 
        if (c->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
               return -EINVAL;
@@ -715,9 +723,9 @@ static int ioctl_cropcap(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_queryctrl(void *arg,struct camera_data *cam)
+static int cpia2_queryctrl(struct file *file, void *fh, struct v4l2_queryctrl *c)
 {
-       struct v4l2_queryctrl *c = arg;
+       struct camera_data *cam = video_drvdata(file);
        int i;
 
        for(i=0; i<NUM_CONTROLS; ++i) {
@@ -783,12 +791,9 @@ static int ioctl_queryctrl(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_querymenu(void *arg,struct camera_data *cam)
+static int cpia2_querymenu(struct file *file, void *fh, struct v4l2_querymenu *m)
 {
-       struct v4l2_querymenu *m = arg;
-
-       memset(m->name, 0, sizeof(m->name));
-       m->reserved = 0;
+       struct camera_data *cam = video_drvdata(file);
 
        switch(m->id) {
        case CPIA2_CID_FLICKER_MODE:
@@ -837,9 +842,9 @@ static int ioctl_querymenu(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_g_ctrl(void *arg,struct camera_data *cam)
+static int cpia2_g_ctrl(struct file *file, void *fh, struct v4l2_control *c)
 {
-       struct v4l2_control *c = arg;
+       struct camera_data *cam = video_drvdata(file);
 
        switch(c->id) {
        case V4L2_CID_BRIGHTNESS:
@@ -955,9 +960,9 @@ static int ioctl_g_ctrl(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_s_ctrl(void *arg,struct camera_data *cam)
+static int cpia2_s_ctrl(struct file *file, void *fh, struct v4l2_control *c)
 {
-       struct v4l2_control *c = arg;
+       struct camera_data *cam = video_drvdata(file);
        int i;
        int retval = 0;
 
@@ -1031,9 +1036,9 @@ static int ioctl_s_ctrl(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_g_jpegcomp(void *arg,struct camera_data *cam)
+static int cpia2_g_jpegcomp(struct file *file, void *fh, struct v4l2_jpegcompression *parms)
 {
-       struct v4l2_jpegcompression *parms = arg;
+       struct camera_data *cam = video_drvdata(file);
 
        memset(parms, 0, sizeof(*parms));
 
@@ -1072,9 +1077,9 @@ static int ioctl_g_jpegcomp(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_s_jpegcomp(void *arg,struct camera_data *cam)
+static int cpia2_s_jpegcomp(struct file *file, void *fh, struct v4l2_jpegcompression *parms)
 {
-       struct v4l2_jpegcompression *parms = arg;
+       struct camera_data *cam = video_drvdata(file);
 
        DBG("S_JPEGCOMP APP_len:%d COM_len:%d\n",
            parms->APP_len, parms->COM_len);
@@ -1121,9 +1126,9 @@ static int ioctl_s_jpegcomp(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_reqbufs(void *arg,struct camera_data *cam)
+static int cpia2_reqbufs(struct file *file, void *fh, struct v4l2_requestbuffers *req)
 {
-       struct v4l2_requestbuffers *req = arg;
+       struct camera_data *cam = video_drvdata(file);
 
        if(req->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
           req->memory != V4L2_MEMORY_MMAP)
@@ -1144,9 +1149,9 @@ static int ioctl_reqbufs(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_querybuf(void *arg,struct camera_data *cam)
+static int cpia2_querybuf(struct file *file, void *fh, struct v4l2_buffer *buf)
 {
-       struct v4l2_buffer *buf = arg;
+       struct camera_data *cam = video_drvdata(file);
 
        if(buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
           buf->index > cam->num_frames)
@@ -1192,9 +1197,9 @@ static int ioctl_querybuf(void *arg,struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_qbuf(void *arg,struct camera_data *cam)
+static int cpia2_qbuf(struct file *file, void *fh, struct v4l2_buffer *buf)
 {
-       struct v4l2_buffer *buf = arg;
+       struct camera_data *cam = video_drvdata(file);
 
        if(buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
           buf->memory != V4L2_MEMORY_MMAP ||
@@ -1248,9 +1253,9 @@ static int find_earliest_filled_buffer(struct camera_data *cam)
  *
  *****************************************************************************/
 
-static int ioctl_dqbuf(void *arg,struct camera_data *cam, struct file *file)
+static int cpia2_dqbuf(struct file *file, void *fh, struct v4l2_buffer *buf)
 {
-       struct v4l2_buffer *buf = arg;
+       struct camera_data *cam = video_drvdata(file);
        int frame;
 
        if(buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
@@ -1296,210 +1301,56 @@ static int ioctl_dqbuf(void *arg,struct camera_data *cam, struct file *file)
        return 0;
 }
 
-/******************************************************************************
- *
- *  cpia2_ioctl
- *
- *****************************************************************************/
-static long cpia2_do_ioctl(struct file *file, unsigned int cmd, void *arg)
+static int cpia2_g_priority(struct file *file, void *_fh, enum v4l2_priority *p)
 {
-       struct camera_data *cam = video_drvdata(file);
-       long retval = 0;
-
-       if (!cam)
-               return -ENOTTY;
-
-       if (!cam->present)
-               return -ENODEV;
-
-       /* Priority check */
-       switch (cmd) {
-       case VIDIOC_S_FMT:
-       {
-               struct cpia2_fh *fh = file->private_data;
-               retval = v4l2_prio_check(&cam->prio, fh->prio);
-               if (retval)
-                       return retval;
-               break;
-       }
-       default:
-               break;
-       }
-
-       switch (cmd) {
-       /* CPIA2 extension to Video4Linux API */
-       case CPIA2_IOC_SET_GPIO:
-               retval = ioctl_set_gpio(arg, cam);
-               break;
-       case VIDIOC_QUERYCAP:
-               retval = ioctl_querycap(arg,cam);
-               break;
-
-       case VIDIOC_ENUMINPUT:
-       case VIDIOC_G_INPUT:
-       case VIDIOC_S_INPUT:
-               retval = ioctl_input(cmd, arg, cam);
-               break;
-
-       case VIDIOC_ENUM_FMT:
-               retval = ioctl_enum_fmt(arg,cam);
-               break;
-       case VIDIOC_TRY_FMT:
-               retval = ioctl_try_fmt(arg,cam);
-               break;
-       case VIDIOC_G_FMT:
-               retval = ioctl_get_fmt(arg,cam);
-               break;
-       case VIDIOC_S_FMT:
-               retval = ioctl_set_fmt(arg,cam,file->private_data);
-               break;
+       struct cpia2_fh *fh = _fh;
 
-       case VIDIOC_CROPCAP:
-               retval = ioctl_cropcap(arg,cam);
-               break;
-       case VIDIOC_G_CROP:
-       case VIDIOC_S_CROP:
-               // TODO: I think cropping can be implemented - SJB
-               retval = -EINVAL;
-               break;
-
-       case VIDIOC_QUERYCTRL:
-               retval = ioctl_queryctrl(arg,cam);
-               break;
-       case VIDIOC_QUERYMENU:
-               retval = ioctl_querymenu(arg,cam);
-               break;
-       case VIDIOC_G_CTRL:
-               retval = ioctl_g_ctrl(arg,cam);
-               break;
-       case VIDIOC_S_CTRL:
-               retval = ioctl_s_ctrl(arg,cam);
-               break;
-
-       case VIDIOC_G_JPEGCOMP:
-               retval = ioctl_g_jpegcomp(arg,cam);
-               break;
-       case VIDIOC_S_JPEGCOMP:
-               retval = ioctl_s_jpegcomp(arg,cam);
-               break;
-
-       case VIDIOC_G_PRIORITY:
-       {
-               struct cpia2_fh *fh = file->private_data;
-               *(enum v4l2_priority*)arg = fh->prio;
-               break;
-       }
-       case VIDIOC_S_PRIORITY:
-       {
-               struct cpia2_fh *fh = file->private_data;
-               enum v4l2_priority prio;
-               prio = *(enum v4l2_priority*)arg;
-               if(cam->streaming &&
-                  prio != fh->prio &&
-                  fh->prio == V4L2_PRIORITY_RECORD) {
-                       /* Can't drop record priority while streaming */
-                       retval = -EBUSY;
-               } else if(prio == V4L2_PRIORITY_RECORD &&
-                  prio != fh->prio &&
-                  v4l2_prio_max(&cam->prio) == V4L2_PRIORITY_RECORD) {
-                       /* Only one program can record at a time */
-                       retval = -EBUSY;
-               } else {
-                       retval = v4l2_prio_change(&cam->prio, &fh->prio, prio);
-               }
-               break;
-       }
-
-       case VIDIOC_REQBUFS:
-               retval = ioctl_reqbufs(arg,cam);
-               break;
-       case VIDIOC_QUERYBUF:
-               retval = ioctl_querybuf(arg,cam);
-               break;
-       case VIDIOC_QBUF:
-               retval = ioctl_qbuf(arg,cam);
-               break;
-       case VIDIOC_DQBUF:
-               retval = ioctl_dqbuf(arg,cam,file);
-               break;
-       case VIDIOC_STREAMON:
-       {
-               int type;
-               DBG("VIDIOC_STREAMON, streaming=%d\n", cam->streaming);
-               type = *(int*)arg;
-               if(!cam->mmapped || type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
-                       retval = -EINVAL;
-
-               if(!cam->streaming) {
-                       retval = cpia2_usb_stream_start(cam,
-                                         cam->params.camera_state.stream_mode);
-               } else {
-                       retval = -EINVAL;
-               }
-
-               break;
-       }
-       case VIDIOC_STREAMOFF:
-       {
-               int type;
-               DBG("VIDIOC_STREAMOFF, streaming=%d\n", cam->streaming);
-               type = *(int*)arg;
-               if(!cam->mmapped || type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
-                       retval = -EINVAL;
-
-               if(cam->streaming) {
-                       retval = cpia2_usb_stream_stop(cam);
-               } else {
-                       retval = -EINVAL;
-               }
-
-               break;
-       }
-
-       case VIDIOC_ENUMOUTPUT:
-       case VIDIOC_G_OUTPUT:
-       case VIDIOC_S_OUTPUT:
-       case VIDIOC_G_MODULATOR:
-       case VIDIOC_S_MODULATOR:
-
-       case VIDIOC_ENUMAUDIO:
-       case VIDIOC_G_AUDIO:
-       case VIDIOC_S_AUDIO:
+       *p = fh->prio;
+       return 0;
+}
 
-       case VIDIOC_ENUMAUDOUT:
-       case VIDIOC_G_AUDOUT:
-       case VIDIOC_S_AUDOUT:
+static int cpia2_s_priority(struct file *file, void *_fh, enum v4l2_priority prio)
+{
+       struct camera_data *cam = video_drvdata(file);
+       struct cpia2_fh *fh = fh;
 
-       case VIDIOC_ENUMSTD:
-       case VIDIOC_QUERYSTD:
-       case VIDIOC_G_STD:
-       case VIDIOC_S_STD:
+       if (cam->streaming && prio != fh->prio &&
+                       fh->prio == V4L2_PRIORITY_RECORD)
+               /* Can't drop record priority while streaming */
+               return -EBUSY;
 
-       case VIDIOC_G_TUNER:
-       case VIDIOC_S_TUNER:
-       case VIDIOC_G_FREQUENCY:
-       case VIDIOC_S_FREQUENCY:
+       if (prio == V4L2_PRIORITY_RECORD && prio != fh->prio &&
+                       v4l2_prio_max(&cam->prio) == V4L2_PRIORITY_RECORD)
+               /* Only one program can record at a time */
+               return -EBUSY;
+       return v4l2_prio_change(&cam->prio, &fh->prio, prio);
+}
 
-       case VIDIOC_OVERLAY:
-       case VIDIOC_G_FBUF:
-       case VIDIOC_S_FBUF:
+static int cpia2_streamon(struct file *file, void *fh, enum v4l2_buf_type type)
+{
+       struct camera_data *cam = video_drvdata(file);
 
-       case VIDIOC_G_PARM:
-       case VIDIOC_S_PARM:
-               retval = -EINVAL;
-               break;
-       default:
-               retval = -ENOIOCTLCMD;
-               break;
-       }
+       DBG("VIDIOC_STREAMON, streaming=%d\n", cam->streaming);
+       if (!cam->mmapped || type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
+               return -EINVAL;
 
-       return retval;
+       if (!cam->streaming)
+               return cpia2_usb_stream_start(cam,
+                               cam->params.camera_state.stream_mode);
+       return -EINVAL;
 }
 
-static long cpia2_ioctl(struct file *file,
-                      unsigned int cmd, unsigned long arg)
+static int cpia2_streamoff(struct file *file, void *fh, enum v4l2_buf_type type)
 {
-       return video_usercopy(file, cmd, arg, cpia2_do_ioctl);
+       struct camera_data *cam = video_drvdata(file);
+
+       DBG("VIDIOC_STREAMOFF, streaming=%d\n", cam->streaming);
+       if (!cam->mmapped || type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
+               return -EINVAL;
+
+       if (cam->streaming)
+               return cpia2_usb_stream_stop(cam);
+       return -EINVAL;
 }
 
 /******************************************************************************
@@ -1550,6 +1401,33 @@ static void reset_camera_struct_v4l(struct camera_data *cam)
        v4l2_prio_init(&cam->prio);
 }
 
+static const struct v4l2_ioctl_ops cpia2_ioctl_ops = {
+       .vidioc_querycap                    = cpia2_querycap,
+       .vidioc_enum_input                  = cpia2_enum_input,
+       .vidioc_g_input                     = cpia2_g_input,
+       .vidioc_s_input                     = cpia2_s_input,
+       .vidioc_enum_fmt_vid_cap            = cpia2_enum_fmt_vid_cap,
+       .vidioc_g_fmt_vid_cap               = cpia2_g_fmt_vid_cap,
+       .vidioc_s_fmt_vid_cap               = cpia2_s_fmt_vid_cap,
+       .vidioc_try_fmt_vid_cap             = cpia2_try_fmt_vid_cap,
+       .vidioc_queryctrl                   = cpia2_queryctrl,
+       .vidioc_querymenu                   = cpia2_querymenu,
+       .vidioc_g_ctrl                      = cpia2_g_ctrl,
+       .vidioc_s_ctrl                      = cpia2_s_ctrl,
+       .vidioc_g_jpegcomp                  = cpia2_g_jpegcomp,
+       .vidioc_s_jpegcomp                  = cpia2_s_jpegcomp,
+       .vidioc_cropcap                     = cpia2_cropcap,
+       .vidioc_reqbufs                     = cpia2_reqbufs,
+       .vidioc_querybuf                    = cpia2_querybuf,
+       .vidioc_qbuf                        = cpia2_qbuf,
+       .vidioc_dqbuf                       = cpia2_dqbuf,
+       .vidioc_streamon                    = cpia2_streamon,
+       .vidioc_streamoff                   = cpia2_streamoff,
+       .vidioc_g_priority                  = cpia2_g_priority,
+       .vidioc_s_priority                  = cpia2_s_priority,
+       .vidioc_default                     = cpia2_default,
+};
+
 /***
  * The v4l video device structure initialized for this device
  ***/
@@ -1559,7 +1437,7 @@ static const struct v4l2_file_operations cpia2_fops = {
        .release        = cpia2_close,
        .read           = cpia2_v4l_read,
        .poll           = cpia2_v4l_poll,
-       .unlocked_ioctl = cpia2_ioctl,
+       .unlocked_ioctl = video_ioctl2,
        .mmap           = cpia2_mmap,
 };
 
@@ -1567,6 +1445,7 @@ static struct video_device cpia2_template = {
        /* I could not find any place for the old .initialize initializer?? */
        .name =         "CPiA2 Camera",
        .fops =         &cpia2_fops,
+       .ioctl_ops =    &cpia2_ioctl_ops,
        .release =      video_device_release,
 };