[media] zr364xx: add support for control events
Signed-off-by: Hans Verkuil <hans.verkuil@cisco.com> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
parent
df462902ea
commit
5d317abe7b
|
@ -39,6 +39,8 @@
|
|||
#include <media/v4l2-ioctl.h>
|
||||
#include <media/v4l2-device.h>
|
||||
#include <media/v4l2-ctrls.h>
|
||||
#include <media/v4l2-fh.h>
|
||||
#include <media/v4l2-event.h>
|
||||
#include <media/videobuf-vmalloc.h>
|
||||
|
||||
|
||||
|
@ -195,7 +197,6 @@ struct zr364xx_camera {
|
|||
|
||||
const struct zr364xx_fmt *fmt;
|
||||
struct videobuf_queue vb_vidq;
|
||||
enum v4l2_buf_type type;
|
||||
};
|
||||
|
||||
/* buffer for one video frame */
|
||||
|
@ -473,8 +474,7 @@ static ssize_t zr364xx_read(struct file *file, char __user *buf, size_t count,
|
|||
if (mutex_lock_interruptible(&cam->lock))
|
||||
return -ERESTARTSYS;
|
||||
|
||||
if (cam->type == V4L2_BUF_TYPE_VIDEO_CAPTURE &&
|
||||
zr364xx_vidioc_streamon(file, cam, cam->type) == 0) {
|
||||
if (zr364xx_vidioc_streamon(file, cam, V4L2_BUF_TYPE_VIDEO_CAPTURE) == 0) {
|
||||
DBG("%s: reading %d bytes at pos %d.\n", __func__, (int) count,
|
||||
(int) *ppos);
|
||||
|
||||
|
@ -1146,14 +1146,8 @@ static int zr364xx_vidioc_streamon(struct file *file, void *priv,
|
|||
|
||||
DBG("%s\n", __func__);
|
||||
|
||||
if (cam->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
|
||||
dev_err(&cam->udev->dev, "invalid fh type0\n");
|
||||
if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
|
||||
return -EINVAL;
|
||||
}
|
||||
if (cam->type != type) {
|
||||
dev_err(&cam->udev->dev, "invalid fh type1\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (!res_get(cam)) {
|
||||
dev_err(&cam->udev->dev, "stream busy\n");
|
||||
|
@ -1183,14 +1177,8 @@ static int zr364xx_vidioc_streamoff(struct file *file, void *priv,
|
|||
struct zr364xx_camera *cam = video_drvdata(file);
|
||||
|
||||
DBG("%s\n", __func__);
|
||||
if (cam->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
|
||||
dev_err(&cam->udev->dev, "invalid fh type0\n");
|
||||
if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
|
||||
return -EINVAL;
|
||||
}
|
||||
if (cam->type != type) {
|
||||
dev_err(&cam->udev->dev, "invalid fh type1\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
zr364xx_stop_acquire(cam);
|
||||
res = videobuf_streamoff(&cam->vb_vidq);
|
||||
if (res < 0)
|
||||
|
@ -1203,7 +1191,6 @@ static int zr364xx_vidioc_streamoff(struct file *file, void *priv,
|
|||
/* open the camera */
|
||||
static int zr364xx_open(struct file *file)
|
||||
{
|
||||
struct video_device *vdev = video_devdata(file);
|
||||
struct zr364xx_camera *cam = video_drvdata(file);
|
||||
struct usb_device *udev = cam->udev;
|
||||
int i, err;
|
||||
|
@ -1218,6 +1205,10 @@ static int zr364xx_open(struct file *file)
|
|||
goto out;
|
||||
}
|
||||
|
||||
err = v4l2_fh_open(file);
|
||||
if (err)
|
||||
goto out;
|
||||
|
||||
for (i = 0; init[cam->method][i].size != -1; i++) {
|
||||
err =
|
||||
send_control_msg(udev, 1, init[cam->method][i].value,
|
||||
|
@ -1226,19 +1217,18 @@ static int zr364xx_open(struct file *file)
|
|||
if (err < 0) {
|
||||
dev_err(&cam->udev->dev,
|
||||
"error during open sequence: %d\n", i);
|
||||
v4l2_fh_release(file);
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
|
||||
cam->skip = 2;
|
||||
cam->users++;
|
||||
file->private_data = vdev;
|
||||
cam->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
|
||||
cam->fmt = formats;
|
||||
|
||||
videobuf_queue_vmalloc_init(&cam->vb_vidq, &zr364xx_video_qops,
|
||||
NULL, &cam->slock,
|
||||
cam->type,
|
||||
V4L2_BUF_TYPE_VIDEO_CAPTURE,
|
||||
V4L2_FIELD_NONE,
|
||||
sizeof(struct zr364xx_buffer), cam, &cam->lock);
|
||||
|
||||
|
@ -1301,7 +1291,6 @@ static int zr364xx_close(struct file *file)
|
|||
}
|
||||
|
||||
cam->users--;
|
||||
file->private_data = NULL;
|
||||
|
||||
for (i = 0; i < 2; i++) {
|
||||
send_control_msg(udev, 1, init[cam->method][i].value,
|
||||
|
@ -1314,7 +1303,7 @@ static int zr364xx_close(struct file *file)
|
|||
*/
|
||||
mdelay(100);
|
||||
mutex_unlock(&cam->lock);
|
||||
return 0;
|
||||
return v4l2_fh_release(file);
|
||||
}
|
||||
|
||||
|
||||
|
@ -1342,12 +1331,11 @@ static unsigned int zr364xx_poll(struct file *file,
|
|||
{
|
||||
struct zr364xx_camera *cam = video_drvdata(file);
|
||||
struct videobuf_queue *q = &cam->vb_vidq;
|
||||
unsigned res = v4l2_ctrl_poll(file, wait);
|
||||
|
||||
_DBG("%s\n", __func__);
|
||||
|
||||
if (cam->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
|
||||
return POLLERR;
|
||||
|
||||
return videobuf_poll_stream(file, q, wait);
|
||||
return res | videobuf_poll_stream(file, q, wait);
|
||||
}
|
||||
|
||||
static const struct v4l2_ctrl_ops zr364xx_ctrl_ops = {
|
||||
|
@ -1379,6 +1367,9 @@ static const struct v4l2_ioctl_ops zr364xx_ioctl_ops = {
|
|||
.vidioc_querybuf = zr364xx_vidioc_querybuf,
|
||||
.vidioc_qbuf = zr364xx_vidioc_qbuf,
|
||||
.vidioc_dqbuf = zr364xx_vidioc_dqbuf,
|
||||
.vidioc_log_status = v4l2_ctrl_log_status,
|
||||
.vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
|
||||
.vidioc_unsubscribe_event = v4l2_event_unsubscribe,
|
||||
};
|
||||
|
||||
static struct video_device zr364xx_template = {
|
||||
|
|
Loading…
Reference in New Issue