/* Linux driver for Philips webcam USB and Video4Linux interface part. (C) 1999-2004 Nemosoft Unv. (C) 2004-2006 Luc Saillard (luc@saillard.org) NOTE: this version of pwc is an unofficial (modified) release of pwc & pcwx driver and thus may have bugs that are not present in the original version. Please send bug reports and support requests to . The decompression routines have been implemented by reverse-engineering the Nemosoft binary pwcx module. Caveat emptor. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #include #include #include #include #include #include #include #include "pwc.h" static struct v4l2_queryctrl pwc_controls[] = { { .id = V4L2_CID_BRIGHTNESS, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Brightness", .minimum = 0, .maximum = 128, .step = 1, .default_value = 64, }, { .id = V4L2_CID_CONTRAST, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Contrast", .minimum = 0, .maximum = 64, .step = 1, .default_value = 0, }, { .id = V4L2_CID_SATURATION, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Saturation", .minimum = -100, .maximum = 100, .step = 1, .default_value = 0, }, { .id = V4L2_CID_GAMMA, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Gamma", .minimum = 0, .maximum = 32, .step = 1, .default_value = 0, }, { .id = V4L2_CID_RED_BALANCE, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Red Gain", .minimum = 0, .maximum = 256, .step = 1, .default_value = 0, }, { .id = V4L2_CID_BLUE_BALANCE, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Blue Gain", .minimum = 0, .maximum = 256, .step = 1, .default_value = 0, }, { .id = V4L2_CID_AUTO_WHITE_BALANCE, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Auto White Balance", .minimum = 0, .maximum = 1, .step = 1, .default_value = 0, }, { .id = V4L2_CID_EXPOSURE, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Shutter Speed (Exposure)", .minimum = 0, .maximum = 256, .step = 1, .default_value = 200, }, { .id = V4L2_CID_AUTOGAIN, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Auto Gain Enabled", .minimum = 0, .maximum = 1, .step = 1, .default_value = 1, }, { .id = V4L2_CID_GAIN, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Gain Level", .minimum = 0, .maximum = 256, .step = 1, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_SAVE_USER, .type = V4L2_CTRL_TYPE_BUTTON, .name = "Save User Settings", .minimum = 0, .maximum = 0, .step = 0, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_RESTORE_USER, .type = V4L2_CTRL_TYPE_BUTTON, .name = "Restore User Settings", .minimum = 0, .maximum = 0, .step = 0, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_RESTORE_FACTORY, .type = V4L2_CTRL_TYPE_BUTTON, .name = "Restore Factory Settings", .minimum = 0, .maximum = 0, .step = 0, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_COLOUR_MODE, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Colour mode", .minimum = 0, .maximum = 1, .step = 1, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_AUTOCONTOUR, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Auto contour", .minimum = 0, .maximum = 1, .step = 1, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_CONTOUR, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Contour", .minimum = 0, .maximum = 63, .step = 1, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_BACKLIGHT, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Backlight compensation", .minimum = 0, .maximum = 1, .step = 1, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_FLICKERLESS, .type = V4L2_CTRL_TYPE_BOOLEAN, .name = "Flickerless", .minimum = 0, .maximum = 1, .step = 1, .default_value = 0, }, { .id = V4L2_CID_PRIVATE_NOISE_REDUCTION, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Noise reduction", .minimum = 0, .maximum = 3, .step = 1, .default_value = 0, }, }; static void pwc_vidioc_fill_fmt(const struct pwc_device *pdev, struct v4l2_format *f) { memset(&f->fmt.pix, 0, sizeof(struct v4l2_pix_format)); f->fmt.pix.width = pdev->view.x; f->fmt.pix.height = pdev->view.y; f->fmt.pix.field = V4L2_FIELD_NONE; if (pdev->pixfmt == V4L2_PIX_FMT_YUV420) { f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUV420; f->fmt.pix.bytesperline = (f->fmt.pix.width * 3)/2; f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline; } else { /* vbandlength contains 4 lines ... */ f->fmt.pix.bytesperline = pdev->vbandlength/4; f->fmt.pix.sizeimage = pdev->frame_size + sizeof(struct pwc_raw_frame); if (DEVICE_USE_CODEC1(pdev->type)) f->fmt.pix.pixelformat = V4L2_PIX_FMT_PWC1; else f->fmt.pix.pixelformat = V4L2_PIX_FMT_PWC2; } PWC_DEBUG_IOCTL("pwc_vidioc_fill_fmt() " "width=%d, height=%d, bytesperline=%d, sizeimage=%d, pixelformat=%c%c%c%c\n", f->fmt.pix.width, f->fmt.pix.height, f->fmt.pix.bytesperline, f->fmt.pix.sizeimage, (f->fmt.pix.pixelformat)&255, (f->fmt.pix.pixelformat>>8)&255, (f->fmt.pix.pixelformat>>16)&255, (f->fmt.pix.pixelformat>>24)&255); } /* ioctl(VIDIOC_TRY_FMT) */ static int pwc_vidioc_try_fmt(struct pwc_device *pdev, struct v4l2_format *f) { if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) { PWC_DEBUG_IOCTL("Bad video type must be V4L2_BUF_TYPE_VIDEO_CAPTURE\n"); return -EINVAL; } switch (f->fmt.pix.pixelformat) { case V4L2_PIX_FMT_YUV420: break; case V4L2_PIX_FMT_PWC1: if (DEVICE_USE_CODEC23(pdev->type)) { PWC_DEBUG_IOCTL("codec1 is only supported for old pwc webcam\n"); return -EINVAL; } break; case V4L2_PIX_FMT_PWC2: if (DEVICE_USE_CODEC1(pdev->type)) { PWC_DEBUG_IOCTL("codec23 is only supported for new pwc webcam\n"); return -EINVAL; } break; default: PWC_DEBUG_IOCTL("Unsupported pixel format\n"); return -EINVAL; } if (f->fmt.pix.width > pdev->view_max.x) f->fmt.pix.width = pdev->view_max.x; else if (f->fmt.pix.width < pdev->view_min.x) f->fmt.pix.width = pdev->view_min.x; if (f->fmt.pix.height > pdev->view_max.y) f->fmt.pix.height = pdev->view_max.y; else if (f->fmt.pix.height < pdev->view_min.y) f->fmt.pix.height = pdev->view_min.y; return 0; } /* ioctl(VIDIOC_SET_FMT) */ static int pwc_vidioc_set_fmt(struct pwc_device *pdev, struct v4l2_format *f) { int ret, fps, snapshot, compression, pixelformat; ret = pwc_vidioc_try_fmt(pdev, f); if (ret<0) return ret; pixelformat = f->fmt.pix.pixelformat; compression = pdev->vcompression; snapshot = 0; fps = pdev->vframes; if (f->fmt.pix.priv) { compression = (f->fmt.pix.priv & PWC_QLT_MASK) >> PWC_QLT_SHIFT; snapshot = !!(f->fmt.pix.priv & PWC_FPS_SNAPSHOT); fps = (f->fmt.pix.priv & PWC_FPS_FRMASK) >> PWC_FPS_SHIFT; if (fps == 0) fps = pdev->vframes; } if (pixelformat != V4L2_PIX_FMT_YUV420 && pixelformat != V4L2_PIX_FMT_PWC1 && pixelformat != V4L2_PIX_FMT_PWC2) return -EINVAL; if (pdev->iso_init) return -EBUSY; PWC_DEBUG_IOCTL("Trying to set format to: width=%d height=%d fps=%d " "compression=%d snapshot=%d format=%c%c%c%c\n", f->fmt.pix.width, f->fmt.pix.height, fps, compression, snapshot, (pixelformat)&255, (pixelformat>>8)&255, (pixelformat>>16)&255, (pixelformat>>24)&255); ret = pwc_set_video_mode(pdev, f->fmt.pix.width, f->fmt.pix.height, fps, compression, snapshot); PWC_DEBUG_IOCTL("pwc_set_video_mode(), return=%d\n", ret); if (ret) return ret; pdev->pixfmt = pixelformat; pwc_vidioc_fill_fmt(pdev, f); return 0; } static int pwc_querycap(struct file *file, void *fh, struct v4l2_capability *cap) { struct video_device *vdev = video_devdata(file); struct pwc_device *pdev = video_drvdata(file); strcpy(cap->driver, PWC_NAME); strlcpy(cap->card, vdev->name, sizeof(cap->card)); usb_make_path(pdev->udev, cap->bus_info, sizeof(cap->bus_info)); cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING | V4L2_CAP_READWRITE; return 0; } static int pwc_enum_input(struct file *file, void *fh, struct v4l2_input *i) { if (i->index) /* Only one INPUT is supported */ return -EINVAL; strcpy(i->name, "usb"); return 0; } static int pwc_g_input(struct file *file, void *fh, unsigned int *i) { *i = 0; return 0; } static int pwc_s_input(struct file *file, void *fh, unsigned int i) { return i ? -EINVAL : 0; } static int pwc_queryctrl(struct file *file, void *fh, struct v4l2_queryctrl *c) { int i, idx; u32 id; id = c->id; if (id & V4L2_CTRL_FLAG_NEXT_CTRL) { id &= V4L2_CTRL_ID_MASK; id++; idx = -1; for (i = 0; i < ARRAY_SIZE(pwc_controls); i++) { if (pwc_controls[i].id < id) continue; if (idx >= 0 && pwc_controls[i].id > pwc_controls[idx].id) continue; idx = i; } if (idx < 0) return -EINVAL; memcpy(c, &pwc_controls[idx], sizeof pwc_controls[0]); return 0; } for (i = 0; i < sizeof(pwc_controls) / sizeof(struct v4l2_queryctrl); i++) { if (pwc_controls[i].id == c->id) { PWC_DEBUG_IOCTL("ioctl(VIDIOC_QUERYCTRL) found\n"); memcpy(c, &pwc_controls[i], sizeof(struct v4l2_queryctrl)); return 0; } } return -EINVAL; } static int pwc_g_ctrl(struct file *file, void *fh, struct v4l2_control *c) { struct pwc_device *pdev = video_drvdata(file); int ret; switch (c->id) { case V4L2_CID_BRIGHTNESS: c->value = pwc_get_brightness(pdev); if (c->value < 0) return -EINVAL; return 0; case V4L2_CID_CONTRAST: c->value = pwc_get_contrast(pdev); if (c->value < 0) return -EINVAL; return 0; case V4L2_CID_SATURATION: ret = pwc_get_saturation(pdev, &c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_GAMMA: c->value = pwc_get_gamma(pdev); if (c->value < 0) return -EINVAL; return 0; case V4L2_CID_RED_BALANCE: ret = pwc_get_red_gain(pdev, &c->value); if (ret < 0) return -EINVAL; c->value >>= 8; return 0; case V4L2_CID_BLUE_BALANCE: ret = pwc_get_blue_gain(pdev, &c->value); if (ret < 0) return -EINVAL; c->value >>= 8; return 0; case V4L2_CID_AUTO_WHITE_BALANCE: ret = pwc_get_awb(pdev); if (ret < 0) return -EINVAL; c->value = (ret == PWC_WB_MANUAL) ? 0 : 1; return 0; case V4L2_CID_GAIN: ret = pwc_get_agc(pdev, &c->value); if (ret < 0) return -EINVAL; c->value >>= 8; return 0; case V4L2_CID_AUTOGAIN: ret = pwc_get_agc(pdev, &c->value); if (ret < 0) return -EINVAL; c->value = (c->value < 0) ? 1 : 0; return 0; case V4L2_CID_EXPOSURE: ret = pwc_get_shutter_speed(pdev, &c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_COLOUR_MODE: ret = pwc_get_colour_mode(pdev, &c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_AUTOCONTOUR: ret = pwc_get_contour(pdev, &c->value); if (ret < 0) return -EINVAL; c->value = (c->value == -1 ? 1 : 0); return 0; case V4L2_CID_PRIVATE_CONTOUR: ret = pwc_get_contour(pdev, &c->value); if (ret < 0) return -EINVAL; c->value >>= 10; return 0; case V4L2_CID_PRIVATE_BACKLIGHT: ret = pwc_get_backlight(pdev, &c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_FLICKERLESS: ret = pwc_get_flicker(pdev, &c->value); if (ret < 0) return -EINVAL; c->value = (c->value ? 1 : 0); return 0; case V4L2_CID_PRIVATE_NOISE_REDUCTION: ret = pwc_get_dynamic_noise(pdev, &c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_SAVE_USER: case V4L2_CID_PRIVATE_RESTORE_USER: case V4L2_CID_PRIVATE_RESTORE_FACTORY: return -EINVAL; } return -EINVAL; } static int pwc_s_ctrl(struct file *file, void *fh, struct v4l2_control *c) { struct pwc_device *pdev = video_drvdata(file); int ret; switch (c->id) { case V4L2_CID_BRIGHTNESS: c->value <<= 9; ret = pwc_set_brightness(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_CONTRAST: c->value <<= 10; ret = pwc_set_contrast(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_SATURATION: ret = pwc_set_saturation(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_GAMMA: c->value <<= 11; ret = pwc_set_gamma(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_RED_BALANCE: c->value <<= 8; ret = pwc_set_red_gain(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_BLUE_BALANCE: c->value <<= 8; ret = pwc_set_blue_gain(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_AUTO_WHITE_BALANCE: c->value = (c->value == 0) ? PWC_WB_MANUAL : PWC_WB_AUTO; ret = pwc_set_awb(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_EXPOSURE: c->value <<= 8; ret = pwc_set_shutter_speed(pdev, c->value ? 0 : 1, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_AUTOGAIN: /* autogain off means nothing without a gain */ if (c->value == 0) return 0; ret = pwc_set_agc(pdev, c->value, 0); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_GAIN: c->value <<= 8; ret = pwc_set_agc(pdev, 0, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_SAVE_USER: if (pwc_save_user(pdev)) return -EINVAL; return 0; case V4L2_CID_PRIVATE_RESTORE_USER: if (pwc_restore_user(pdev)) return -EINVAL; return 0; case V4L2_CID_PRIVATE_RESTORE_FACTORY: if (pwc_restore_factory(pdev)) return -EINVAL; return 0; case V4L2_CID_PRIVATE_COLOUR_MODE: ret = pwc_set_colour_mode(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_AUTOCONTOUR: c->value = (c->value == 1) ? -1 : 0; ret = pwc_set_contour(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_CONTOUR: c->value <<= 10; ret = pwc_set_contour(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_BACKLIGHT: ret = pwc_set_backlight(pdev, c->value); if (ret < 0) return -EINVAL; return 0; case V4L2_CID_PRIVATE_FLICKERLESS: ret = pwc_set_flicker(pdev, c->value); if (ret < 0) return -EINVAL; case V4L2_CID_PRIVATE_NOISE_REDUCTION: ret = pwc_set_dynamic_noise(pdev, c->value); if (ret < 0) return -EINVAL; return 0; } return -EINVAL; } static int pwc_enum_fmt_vid_cap(struct file *file, void *fh, struct v4l2_fmtdesc *f) { struct pwc_device *pdev = video_drvdata(file); /* We only support two format: the raw format, and YUV */ switch (f->index) { case 0: /* RAW format */ f->pixelformat = pdev->type <= 646 ? V4L2_PIX_FMT_PWC1 : V4L2_PIX_FMT_PWC2; f->flags = V4L2_FMT_FLAG_COMPRESSED; strlcpy(f->description, "Raw Philips Webcam", sizeof(f->description)); break; case 1: f->pixelformat = V4L2_PIX_FMT_YUV420; strlcpy(f->description, "4:2:0, planar, Y-Cb-Cr", sizeof(f->description)); break; default: return -EINVAL; } return 0; } static int pwc_g_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) { struct pwc_device *pdev = video_drvdata(file); PWC_DEBUG_IOCTL("ioctl(VIDIOC_G_FMT) return size %dx%d\n", pdev->image.x, pdev->image.y); pwc_vidioc_fill_fmt(pdev, f); return 0; } static int pwc_try_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) { struct pwc_device *pdev = video_drvdata(file); return pwc_vidioc_try_fmt(pdev, f); } static int pwc_s_fmt_vid_cap(struct file *file, void *fh, struct v4l2_format *f) { struct pwc_device *pdev = video_drvdata(file); return pwc_vidioc_set_fmt(pdev, f); } static int pwc_reqbufs(struct file *file, void *fh, struct v4l2_requestbuffers *rb) { int nbuffers; PWC_DEBUG_IOCTL("ioctl(VIDIOC_REQBUFS) count=%d\n", rb->count); if (rb->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) return -EINVAL; if (rb->memory != V4L2_MEMORY_MMAP) return -EINVAL; nbuffers = rb->count; if (nbuffers < 2) nbuffers = 2; else if (nbuffers > pwc_mbufs) nbuffers = pwc_mbufs; /* Force to use our # of buffers */ rb->count = pwc_mbufs; return 0; } static int pwc_querybuf(struct file *file, void *fh, struct v4l2_buffer *buf) { struct pwc_device *pdev = video_drvdata(file); int index; PWC_DEBUG_IOCTL("ioctl(VIDIOC_QUERYBUF) index=%d\n", buf->index); if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) { PWC_DEBUG_IOCTL("ioctl(VIDIOC_QUERYBUF) Bad type\n"); return -EINVAL; } index = buf->index; if (index < 0 || index >= pwc_mbufs) { PWC_DEBUG_IOCTL("ioctl(VIDIOC_QUERYBUF) Bad index %d\n", buf->index); return -EINVAL; } buf->m.offset = index * pdev->len_per_image; if (pdev->pixfmt != V4L2_PIX_FMT_YUV420) buf->bytesused = pdev->frame_size + sizeof(struct pwc_raw_frame); else buf->bytesused = pdev->view.size; buf->field = V4L2_FIELD_NONE; buf->memory = V4L2_MEMORY_MMAP; /*buf->flags = V4L2_BUF_FLAG_MAPPED;*/ buf->length = pdev->len_per_image; PWC_DEBUG_READ("VIDIOC_QUERYBUF: index=%d\n", buf->index); PWC_DEBUG_READ("VIDIOC_QUERYBUF: m.offset=%d\n", buf->m.offset); PWC_DEBUG_READ("VIDIOC_QUERYBUF: bytesused=%d\n", buf->bytesused); return 0; } static int pwc_qbuf(struct file *file, void *fh, struct v4l2_buffer *buf) { PWC_DEBUG_IOCTL("ioctl(VIDIOC_QBUF) index=%d\n", buf->index); if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) return -EINVAL; if (buf->memory != V4L2_MEMORY_MMAP) return -EINVAL; if (buf->index >= pwc_mbufs) return -EINVAL; buf->flags |= V4L2_BUF_FLAG_QUEUED; buf->flags &= ~V4L2_BUF_FLAG_DONE; return 0; } static int pwc_dqbuf(struct file *file, void *fh, struct v4l2_buffer *buf) { DECLARE_WAITQUEUE(wait, current); struct pwc_device *pdev = video_drvdata(file); int ret; PWC_DEBUG_IOCTL("ioctl(VIDIOC_DQBUF)\n"); if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) return -EINVAL; add_wait_queue(&pdev->frameq, &wait); while (pdev->full_frames == NULL) { if (pdev->error_status) { remove_wait_queue(&pdev->frameq, &wait); set_current_state(TASK_RUNNING); return -pdev->error_status; } if (signal_pending(current)) { remove_wait_queue(&pdev->frameq, &wait); set_current_state(TASK_RUNNING); return -ERESTARTSYS; } mutex_unlock(&pdev->modlock); schedule(); set_current_state(TASK_INTERRUPTIBLE); mutex_lock(&pdev->modlock); } remove_wait_queue(&pdev->frameq, &wait); set_current_state(TASK_RUNNING); PWC_DEBUG_IOCTL("VIDIOC_DQBUF: frame ready.\n"); /* Decompress data in pdev->images[pdev->fill_image] */ ret = pwc_handle_frame(pdev); if (ret) return -EFAULT; PWC_DEBUG_IOCTL("VIDIOC_DQBUF: after pwc_handle_frame\n"); buf->index = pdev->fill_image; if (pdev->pixfmt != V4L2_PIX_FMT_YUV420) buf->bytesused = pdev->frame_size + sizeof(struct pwc_raw_frame); else buf->bytesused = pdev->view.size; buf->flags = V4L2_BUF_FLAG_MAPPED; buf->field = V4L2_FIELD_NONE; do_gettimeofday(&buf->timestamp); buf->sequence = 0; buf->memory = V4L2_MEMORY_MMAP; buf->m.offset = pdev->fill_image * pdev->len_per_image; buf->length = pdev->len_per_image; pwc_next_image(pdev); PWC_DEBUG_IOCTL("VIDIOC_DQBUF: buf->index=%d\n", buf->index); PWC_DEBUG_IOCTL("VIDIOC_DQBUF: buf->length=%d\n", buf->length); PWC_DEBUG_IOCTL("VIDIOC_DQBUF: m.offset=%d\n", buf->m.offset); PWC_DEBUG_IOCTL("VIDIOC_DQBUF: bytesused=%d\n", buf->bytesused); PWC_DEBUG_IOCTL("VIDIOC_DQBUF: leaving\n"); return 0; } static int pwc_streamon(struct file *file, void *fh, enum v4l2_buf_type i) { struct pwc_device *pdev = video_drvdata(file); return pwc_isoc_init(pdev); } static int pwc_streamoff(struct file *file, void *fh, enum v4l2_buf_type i) { struct pwc_device *pdev = video_drvdata(file); pwc_isoc_cleanup(pdev); return 0; } static int pwc_enum_framesizes(struct file *file, void *fh, struct v4l2_frmsizeenum *fsize) { struct pwc_device *pdev = video_drvdata(file); unsigned int i = 0, index = fsize->index; if (fsize->pixel_format == V4L2_PIX_FMT_YUV420) { for (i = 0; i < PSZ_MAX; i++) { if (pdev->image_mask & (1UL << i)) { if (!index--) { fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; fsize->discrete.width = pwc_image_sizes[i].x; fsize->discrete.height = pwc_image_sizes[i].y; return 0; } } } } else if (fsize->index == 0 && ((fsize->pixel_format == V4L2_PIX_FMT_PWC1 && DEVICE_USE_CODEC1(pdev->type)) || (fsize->pixel_format == V4L2_PIX_FMT_PWC2 && DEVICE_USE_CODEC23(pdev->type)))) { fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; fsize->discrete.width = pdev->abs_max.x; fsize->discrete.height = pdev->abs_max.y; return 0; } return -EINVAL; } static int pwc_enum_frameintervals(struct file *file, void *fh, struct v4l2_frmivalenum *fival) { struct pwc_device *pdev = video_drvdata(file); int size = -1; unsigned int i; for (i = 0; i < PSZ_MAX; i++) { if (pwc_image_sizes[i].x == fival->width && pwc_image_sizes[i].y == fival->height) { size = i; break; } } /* TODO: Support raw format */ if (size < 0 || fival->pixel_format != V4L2_PIX_FMT_YUV420) return -EINVAL; i = pwc_get_fps(pdev, fival->index, size); if (!i) return -EINVAL; fival->type = V4L2_FRMIVAL_TYPE_DISCRETE; fival->discrete.numerator = 1; fival->discrete.denominator = i; return 0; } static long pwc_default(struct file *file, void *fh, bool valid_prio, int cmd, void *arg) { struct pwc_device *pdev = video_drvdata(file); return pwc_ioctl(pdev, cmd, arg); } const struct v4l2_ioctl_ops pwc_ioctl_ops = { .vidioc_querycap = pwc_querycap, .vidioc_enum_input = pwc_enum_input, .vidioc_g_input = pwc_g_input, .vidioc_s_input = pwc_s_input, .vidioc_enum_fmt_vid_cap = pwc_enum_fmt_vid_cap, .vidioc_g_fmt_vid_cap = pwc_g_fmt_vid_cap, .vidioc_s_fmt_vid_cap = pwc_s_fmt_vid_cap, .vidioc_try_fmt_vid_cap = pwc_try_fmt_vid_cap, .vidioc_queryctrl = pwc_queryctrl, .vidioc_g_ctrl = pwc_g_ctrl, .vidioc_s_ctrl = pwc_s_ctrl, .vidioc_reqbufs = pwc_reqbufs, .vidioc_querybuf = pwc_querybuf, .vidioc_qbuf = pwc_qbuf, .vidioc_dqbuf = pwc_dqbuf, .vidioc_streamon = pwc_streamon, .vidioc_streamoff = pwc_streamoff, .vidioc_enum_framesizes = pwc_enum_framesizes, .vidioc_enum_frameintervals = pwc_enum_frameintervals, .vidioc_default = pwc_default, }; /* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */